New function finds point on a plane.
Better ground height detection.