Mobile robots in rough terrain :estimation, motion planning, and control with application to planetary rovers
