Implemented draft 1 of the heightmap collision code