Dynamics and Computed-Muscle-Force Control of a Planar Muscle-Driven Snake Robot

Abstract

This paper presents the dynamic formulation of an artificial-muscle-driven and computed-muscle–force control for the planar locomotion of a snake robot. The snake robot uses a series of antagonistic pneumatic artificial muscles, assembled at the joints, to generate the locomotion. Kinematics of the artificial-muscle-driven robot in the joint and Cartesian spaces was derived with respect to the muscles’ motion. The Lagrangian mechanics was employed for the formulation of the dynamic model of the robot and deriving the equations of motion. A model-based computed-muscle-force control was designed to track the desired paths/trajectories in Cartesian space. The feedback linearization method based on a change of coordinate was utilized to determine an equivalent linear (input-to-state) system. Then, a full state feedback control law was designed, which satisfies the stability and tracking problems. The performance of the dynamic model and the controller were successfully demonstrated in simulation studies for tracking a circle-shape path and a square-shape path with a constant linear velocity while generating the lateral undulation gait. The results indicate a low magnitude of tracking errors where the controlled muscle force are bounded to the actual pneumatic artificial muscle’s limitations.