Raycast Heightmap

* Do not test if the quads are valid in the diagonal cases. They must be
valid because we already tested the current quad and the previous quad.

* Remove the test ofthe previous quad when going diagonaly. This quad
was already tested during the previous iteration.

* Initialize the previous values of x and y to the current values +1 to
avoid a first iteration where the diagonal case is tested.