Use heightmap driver for ground-following

Still could use some cleanup of the calls to getTerrainHeight that send more parameters than necessary