Shape Control of a Snake Robot With Joint Limit and Self-Collision Avoidance

摘要

This paper proposes a shape control method for a snake robot, which maintains head position and orientation, and avoids joint limits and self-collision. We used a passive wheeled snake robot that can switch the grounded/lifted status of its wheels. We derived a kinematic model of the robot that represents its redundancy as both joint angles [the shape controllable points (SCPs)] and the null space of the control input. In the control method, the shape is changed by sequential control of the SCPs, and the null space of the control input is used for joint limit and self-collision avoidance. Jumps in control input do not occur, although the controlled variable and the model are switched. Simulations and an experiment were used to demonstrate the effectiveness of the proposed method.