compute world terrain pts
Merge branch 'swing-kinematics' of github.com:mitdrc/drake into swing-kinematics