Mobile Robots in Rough Terrain: Estimation, Motion Planning, and Control with Application to Planetary Rovers. Springer Science & Business Media, 2004.