simpler computation of terrain height
Merge branch 'drake-heel-raise' of github.com:mitdrc/drake into drake-heel-raise