I. Introduction
Snake robots are a class of hyper-redundant mechanisms capable of achieving different types of locomotion by coordinated flexing of their bodies. One of the well-established snake robot designs is composed of alternating one degree of freedom (DOF) pitch and yaw bending joints (as shown in Fig. 1), which allows 3D versatile motion [1]–[4]. Such a robot design is also called “twist-free” since it does not have direct actuation of the twist (rotation about the longitudinal axis of the body) DOF [5]. Inspired by the shapes of biological snakes with many vertebrae, finite-length continuous backbone curves are designed to capture desired macroscopic shapes of robots [6], [7]. Often, the motion of a snake robot is planned kinematically by a chronological sequence of backbone curves [8], [9]. Once properly designed, these sequences of backbone curves have been shown by prior work to generate effective, biologically-inspired, locomotion such as lateral undulation, sidewinding, and sinus lifting [6], [10], [11]. In order to replicate those motions on the physical robot, we have to match the shape of a robot made up of discrete segments to the continuous curves. These backbone curves lie in 3D space, but the geometric arrangement of single-axis rotary joints creates constraints on the rotations in the robot, making this shape-matching problem challenging for twist-free snake robots. When the body shape does not match the desired backbone curve, the desired robot-environment contacts are not achieved. The robot may then have undesired contacts with the environment, impeding locomotion. This letter presents a method for twist-free snake robots to accurately reconstruct desired 3D backbone curves via a constrained optimization problem. This enables the robot to locomote effectively by following a sequence of backbone curves.