Head-Trajectory-Tracking Control of a Snake Robot and Its Robustness Under Actuator Failure

This brief considers the problem of trajectory tracking of a planar snake robot without a lateral constraint. The reference trajectory of the head position and the orientation of link 1 are given, and torque control is determined to reduce tracking errors. The performance of the controller was tested in a number of simulations. The robustness during actuator failure was also studied. We assumed that one of the actuators was broken and the corresponding joint became passive. Furthermore, as a more realistic situation, we considered an instance when some of the states were not readily accessible from the sensor readings and needed to be estimated by an observer. The extended Kalman filter was employed for this purpose, and the performance of the closed-loop system with the observer was also tested in simulations.