Heightmap

Loads collision elements from sdf (resolves #638)
implements plane geometry (resolves #634)
fixes a few other parsing bugs.
updates drc terrain example for atlas to walk on heightmaps instead of bullet geometry.