Multi-sensor, high speed autonomous stair climbing

Small, tracked mobile robots designed for general urban mobility have been developed for the purpose of reconnaissance and/or search and rescue missions in buildings and cities. Autonomous stair climbing is a significant capability required for many of these missions. In this paper we present the design and implementation of a new set of estimation and control algorithms that increase the speed and effectiveness of stair climbing. We have developed: (1) a Kalman filter that fuses visual/laser data with inertial measurements and provides attitude estimates of improved accuracy at a high rate; and (2) a physics based controller that minimizes the heading error and maximizes the effective velocity of the vehicle during stair climbing. Experimental results using a tracked vehicle validate the improved performance of this control and estimation scheme over previous approaches.