The boulder height never goes above the truth. A tilt is present from the first iteration and never gets removed.
Heat Maps (x and y is in units of pixels, z is deviation from truth and has units of meters)
Iteration 1 and 10:
Iteration 20 and 30:
Iteration 50 and 75: