People in space robotics have been working on that (moon and mars rovers need to deal with this). Perception is also a bottleneck; you have to see rocks, root, grass, mud and predict the effects on the dynamics.