Abstract
Continuum robots with redundant degrees of freedom and postactuated devices are suitable for application in aerospace, nuclear facilities, and other narrow and multiobstacle special environments. The development of a snake-inspired continuum robot is presented in this study. The morphological skeleton structure of the snake body is simulated using underactuated continuum joints, which include several rigid-body joints in series. Each rigid-body joint is driven by the traction of a wire rope. Based on the layered-drive principle, angular synchronous motion can be realized in space with multiple rigid-body joints in a single continuous joint, which can considerably reduce the complexity of the inverse kinematics solution, terminal drive box, and control system. The static and dynamic characteristics of the snake-inspired robot are obtained through torque balance and an equivalent transformation. Finally, we demonstrate trajectory planning and load capacity testing in two robot prototypes with arm lengths of 1500 and 2300 mm (including two and four continuous joints, respectively). The rationality of the structure and the correctness of the control of the layered-drive snake-inspired robot are verified.
Introduction
Compared with the discrete robotics associated with industrial robots1,2 and hyper-redundant robots with more kinematically executable degrees of freedom,3−5 continuous robots exhibit a large number of kinematic degrees of freedom; however, not all of them can be driven directly.6−8 The design of continuum robots is mainly inspired by natural vertebrates such as snakes and their trunks and tails, as well as invertebrates such as octopuses.9−13 A continuous robot is more flexible than a classical rigid linkage robot when performing a specific task in a highly limited working environment. It can be used in complex environments involving multiple obstacles by means of encircling and other techniques, 14 offering a simpler, smoother, and more real-time motion than those offered by the hyper-redundant robot structure, kinematic solution, or terminal drive box and control system.15−17 Therefore, such robots are suitable for application in nuclear power and other high-risk or narrow-space operations. 18
A continuum robot can be continuously bent along its length. It is usually manufactured using soft and flexible materials that can be deformed by external forces and that are highly adaptable to the environment.19,20 The local bending and rotating movement of the continuum is realized using the driving system, mainly comprising the stretching deformation of ropes, tendons, and pneumatic muscles.21,22 This is still a new field and can meet the needs of special environments in applications such as search and rescue, radioactive waste disposal, outer-space assistance, and minimally invasive surgery.23−29 This study focuses on the detection requirements of a small operating space within the dense environment of the China Fusion Engineering Test Reactor (CFETR) vacuum chamber and the upper window pipe. 30 An underactuated continuum robot with a layered-driven configuration is designed by analyzing the snake's skeletal characteristics and its body morphology. Multisegmented rigid joints are used to form a continuum. Subsequently, this continuum is connected in series to form the whole snake-inspired continuum robot, exhibiting high space curvature, position accuracy, and load capacity. The driving system, control system, and kinematic model are also simplified.
The inverse kinematics solution and trajectory planning of the snake-inspired robot are realized by establishing an accurate kinematic model. The working space and cable drive signal of the snake robot are calculated, and the static and dynamic characteristics of the snake robot are then obtained using torque balance and an equivalent transformation. Finally, trajectory planning and load experiments are conducted on snake-inspired robots with different arm lengths (1500 and 2300 mm).
Design of the Layer-Driven Continuum Robot
Snake-crawling bionic mechanism
The skeleton structure of a snake is presented in Figure 1A. It mainly comprises vertebrae, ribs, and a skull, and its winding movement is mainly completed using the skeleton structure of the body, ventral scales, and related muscles. Most of the time, the body morphology of a snake exhibits multiple continuous “S”-shaped geometric configurations during movement. Therefore, for the body morphology of a segment of snake skeleton bending into a single “S” shape, the segment can be regarded as a continuum robot comprising two segments of continuous spine with the same curvature and opposite bending directions. The morphological characteristics of a whole snake can be simulated by the motion path of a snake-inspired robot comprising multiple continuous joints in series.

Design of the snake-inspired continuum robot configuration.
In this study, a new snake-inspired continuum robot was designed by structurally analyzing the snake skeleton and bionic design of the muscle traction, as shown in Figure 1B. This robot adopts a layered-drive design. A single continuous joint contains three rigid-body joints. Through the composite capstan, as shown in Figure 1C, three steel wires are driven to pull the three rigid-body joints in a single continuous joint to achieve angular synchronous movement in space.
Prototype
In response to the actual use requirements of the CFETR fusion reactor, the prototype of the new continuum snake robot (arm length = 2300 mm) was designed as shown in Figure 2A; the prototype mainly comprises a terminal drive box and several continuum joints. The entire snake arm contains 10 rigid joints, which are divided into four continuum joint groups according to the ratio of 3:3:2:2 for layered-drive design.

Structure of the snake-inspired continuum robot.
We take the joint group 2 in Figure 2A as an example to analyze the principle of layer driving, as shown in Figure 2B. The wire rope layout is shown in Figure 2e, where blue, red, and green represent the positions at which the wire rope is fixed for each joint. As shown in Figure 2f, the outermost green wire rope is fixed at the first rigid-body joint, the intermediate red wire rope is fixed at the second rigid-body joint, and the innermost blue wire rope is fixed at the third rigid-body joint. To realize the angular synchronous motion in the space of three rigid-body joints in a single continuous joint, a composite capstan with different diameters was used to drive it, as shown in Figure 2g. The capstan is arranged along the axis with three winding slots having different diameters. The capstan drives the green, red, and blue wire ropes from top to bottom. The wire rope passes through a continuous joint, and the green, red, and blue wire ropes are fixed successively on the first, second, and third rigid-body joints in the continuous joint, respectively. Thus, angular synchronous motion of the single continuous joint group is realized.
Kinematic and Dynamic Characteristics
Forward kinematic modeling
In this study, the forward kinematic solution of the snake robot adopts the method shown in Figure 3A, where

Method for establishing the coordinate system for the kinematic solution of the continuum robot.
The kinematic matrix transformation from joint i + 1 to joint i and the transformation rule are as follows:
where
Thus, the relationship between the base coordinate system of the snake robot and the end coordinate system of the i-th continuum joint can be written as
Based on the rotation angle
Algorithm of wire rope elongation
For the general case in which neither

Coordinate systems of a single continuum joint of the continuum robot.
We set point A as the base coordinate system (
In this study, the coordinates of point D in the base coordinate system A (
where r is the distance between the cable hole and the midline of the joint. Using Equation (6), the coordinates of point H in the base coordinate system A (
According to the distance formula between two points, the length of l1 can be obtained as
Snake robot workspace
Setting the extreme rotation angle of each joint of the snake robot to

Geometric and Monte Carlo calculations in the workspace:
Snake robot statics
The cable distribution of each joint group of the snake robot is shown in Figure 6A. Assuming that the minimum traction force of any joint cable is 1 N, the cable can be kept tight at all times, ignoring friction and flexible deformation everywhere. The end limit load was set to 5 kg, and the static analysis of each traction cable of the snake-shaped robot was performed through the force balance, torque balance, and equivalent transformation, as shown in Figure 6D. The static force characteristics can guide the selection of joint components and the research of extreme force optimization.

Static force analysis of each cable of the snake robot.
Snake robot dynamics
Because of the strong coupling characteristics among the joints, end effectors, and drive motors of the snake robot, the mapping relationships among these components cannot be directly obtained. Therefore, an accurate dynamic model that calculates the real-time driving force of the rope is difficult to establish, especially when the arm is long and the number of degrees of freedom becomes high. This article proposes a twice-equivalent transformation method for calculating the cable driving force of the snake robot. First, the traction force of the cable is considered equivalent to the joint torque, and the dynamic equation is established using a traditional approach such as the Lagrangian method. The dynamic equation of the joint torque is then converted using the force balance, torque balance, and equivalent transformation. The joint torque is converted into the driving force of each cable to realize the decoupling calculation.
Figure 7 shows the force analysis of the end joint. The cable traction forces

Force analysis of end joints in any posture. Color images are available online.
The coordinates of points B and E in the coordinate system
where
The unit direction vector of
Decomposing
By analogy,
The torque produced by
From the equivalent transformation of
By analogy, the equivalent torque of
Combining Equations (18) and (19), we can solve
Performance Tests and Validation
Trajectory-planning experiment
Two prototypes with different arm lengths (1500 and 2300 mm) were designed for open-loop trajectory planning through the layered-drive principle. According to the snake robot arm length from short to long, the generalized inverse matrix and backbone curve methods were used to perform inverse kinematics solution and trajectory planning.31–34 See Supplementary Videos S1–S6 for the captured simulation and experimental results. The tracking accuracy of the snake robot was measured using a Leica laser-tracking measurement system, as shown in Figure 8. The position error and repeated-position accuracy were measured under different loads. The experimental results are shown in Figure 9. The trajectory-tracking errors of the end points of the snake robots with the 1500- and 2300-mm arm lengths were maximized at 12 mm in the space of the circular trajectory-planning process and at 18 mm in the rectangular trajectory-planning process.

Snake robot end position accuracy experiment.

Trajectory planning and error analysis of snake robots with different arm lengths:
Joint-angle measurement experiment
Figure 10A shows the space-rotation angle data of each joint group of the snake robot with an arm length of 2300 mm. The backbone curve method was used to conduct the rectangular and sinusoidal trajectory experiments, and the data recorded using a gyroscope angle sensor are shown in Figure 10b and c. The snake robot moved smoothly, and no oscillations developed in the joint angles. In several experiments, the maximum repeated joint-angle error along the three coordinate axes in the end joint group of the snake arm (measured by the gyroscope) was

Snake robot positioning accuracy experiment.
Load test of continuum joints
The end-position errors and repeated-position accuracies of the snake robot with an arm length of 1500 mm were measured under different loads using the laser-tracking measurement system. The initial position of the snake robot is shown in Figure 8C. We set the snake robot to perform multiple horizontal sine trajectory tests. The position error of the end along the Z axis is shown in Figure 10d. The position error was maximized (15 mm) at the swing limit corner. Set the snake robot to perform multiple horizontal and vertical sinusoidal trajectory tests; the repeated-position error of the end is shown in Figure 10e. The maximum absolute position error was 11 mm.
The abovementioned experimental results and Supplementary Videos S1–S6 confirm that the entire trajectory control processes were smooth, fluent, and free of oscillations or noise. In the trajectory-planning process of the open-loop inverse kinematics, the maximum position errors of the end points of the snake robots with arm lengths of 1500 and 2300 mm were 12 and 18 mm, respectively. The error has several likely causes. First, the continuum-designed robot based on the layered drive is an underactuated configuration, so each joint group needs high-precision coordinated motion capability. The position error is increased by the flexible deformation of the steel wire rope and the slight change in the diameter of the composite capstan. Second, under the action of gravity, the uneven forces in the cables of the snake robot introduce static position errors in each joint. In addition, errors in the open-loop inverse solution affect the coordinated motion of multiple motors, amplifying the end-position error. When the end-position error of the snake robot is large, it can be compensated using a nonlinear least-squares algorithm to improve the position accuracy. 35 In general, the layered-drive snake robot has a simplified drive and control system but stronger load capacity and position accuracy than traditional flexible continuum robots. Therefore, it realizes accurate kinematics models and meets the requirements of CFETR's narrow-space visual navigation.
Conclusion
In this study, we developed an underactuated continuum robot with layered-driven configuration. The continuous joints of this robot comprised several rigid-body joints in series, and angular synchronization was achieved in the spaces of these rigid-body joints. The robot combines the structural characteristics of a hyper-redundant robot and a continuum robot and has the characteristics of high freedom of movement, strong carrying capacity, and simple driving and control systems. The end-drive system of the layered-drive snake robot is designed based on the driving principle of the composite capstan. The motion-control system is designed based on a high-performance motion-control card, and robotic motion control and video image data transmission are realized. The snake robot workspace is calculated using the kinematics model. The static and dynamic force characteristics of the cables are analyzed. The rationality of the structural design and the accuracy of the control system of the snake robot are verified through open-loop trajectory planning and load tests. The maximum trajectory-tracking errors of the end points of the snake robots with arm lengths of 1500 and 2300 mm are 12 and 18 mm, respectively. The position error mainly comes from cable flexibility, initial position error, external force imbalance, and insufficient multimotor coordinated movement ability. In general, compared with the flexible continuum robot, the motion process of the proposed robot is smooth, and without oscillation, position accuracy and load capacity are significantly improved.
In the future, the application of the snake-inspired continuum robot will be improved. Furthermore, a compensation mechanism will be added based on the open-loop position error of the robot to improve the position accuracy. Furthermore, trajectory tracking and a master–slave teleoperation control algorithm of the layer-driven snake robot will be further developed for operational capability in extremely narrow working environments.
Footnotes
Acknowledgments
The authors are very grateful to the editors and reviewers for their valuable comments, which have improved the article.
Author Disclosure Statement
No competing financial interests exist.
Funding Information
This work is supported by the National Key R&D program of China (grant nos. 2019YFB1309600), National Natural Science Foundation of China (grant nos. 11802305, 51875281, and 51861135306), and China National Special Project for Magnetic Confinement Fusion Science Program (grant no. 2017YFE0300503).
References
Supplementary Material
Please find the following supplemental material available below.
For Open Access articles published under a Creative Commons License, all supplemental material carries the same license as the article it is associated with.
For non-Open Access articles published, all supplemental material carries a non-exclusive license, and permission requests for re-use of supplemental material or any part of supplemental material shall be sent directly to the copyright owner as specified in the copyright notice associated with the article.
