Xian-Jie Zheng(郑先杰), Meng Ding(丁萌), Liao-Xue Liu(刘辽雪), Lu Wang(王璐), and Yu Guo(郭毓)
School of Automation,Nanjing University of Science and Technology,Nanjing 210094,China
Keywords: static-to-kinematic modeling scheme,tendon-driven quasi continuum robot,nonconstant subsegment stiffness,tension attenuation effect
Continuum robots, inspired by the natural structures of octopus and elephant trunks, are manipulators composed of multiple flexible segments with slender structure and high flexibility.Different from conventional rigid-link manipulators, continuum robots have the ability to manipulate in complex and constrained environments and are widely used in aero-engine maintenance,[1]nuclear facility inspection,[2]manipulation in confined and cluttered space,[3]human-robot collaboration,[4]and medical applications,[5]etc.
Generally, actuation methods of continuum robots can be mainly divided into hydraulic/pneumatic driven,[6]smart material driven,[7]and tendon-driven.[8]As for tendon-driven continuum robots(TDCRs),the flexible segments are usually equipped with multiple driving tendons.Pulling the tendons results in bending motions of the segments, and the superposition of multisegment bending movements produces the serpentine motion in 3-D space.In 1985,Hemami[9]designed a light weight flexible manipulator composed of multiple flexible subsegments, which is one of the earliest publications on TDCRs.Some continuum manipulators adopt the central backbone structure[10,11]and the backbones can be flexible beams,[12]elastomers,[13,14]springs,[15,16]and bellows;[17,18]while the other designs use multiple flexible backbones with a push-pull actuation,which is a modification of the single backbone structure.[19,20]Nevertheless, robotic arms with flexible skeleton structures tend to have poor load capacity.To address this limitation,Yeshmukhametovet al.[21]presented a discrete continuum arm combined with rigid joints and springs,which greatly improved the robot rigidity.Wanget al.[22]proposed a novel extra-slender dual-stage continuum robot with various rigid-compliant combined joints to enable different flexibility and stiffness.These rigid-flexible coupling structures offer a good balance between the flexibility and stiffness of the robot and have good development prospects.
The non-constant subsegment stiffness (NSS) structure designed in this paper is a modification of the rigid-flexible coupling structure.Implementing the NSS structure allows one continuum robotic section to be divided into several subsections with variable stiffness,providing desired stiffness for carrying different payloads.Therefore,users can find a tradeoff between the load capacity and dexterity depending on the requirements of different tasks.
To achieve the desired performance of continuum robots,fundamental kinematics and statics are required.Note that the soft components of TDCRs make their configuration space representation theoretically require infinite parameters, accurate modeling has always been challenging.On kinematic modeling, most researchers use simplified assumptions to reduce the model complexity.The existing methods usually assume that each segment is bent to an arc of constant curvature with no torsion.[23,24]Based on the piecewise-constantcurvature(PCC)assumption,Santinaet al.[25]proposed an improved state parametrization for soft robots.The parametrization approach can reduce computational burden without incurring in spikes and discontinuous behaviors.Another model simplification approach is to approximate the continuum robot configuration as ann-link manipulator,[26]which is the socalled pseudo rigid body(PRB)modeling method.The main advantage of geometric analysis modeling methods is that robot kinematics can be derived by Denavit–Hartenberg(D-H)parameters,Frenet–Serret frames,and product of exponentials(PoE)formula,etc.However,models based on PCC assumption and PRB method often lead to non-negligible modeling errors.
Considering gravity,inner friction,and robot constitutive laws, static models can deeply reveal the quasi-static characteristics of the manipulator.By applying the Cosserat rod theory,Joneset al.[27]introduced a variable curvature model for computing the shape configuration of a continuum robot in 3-D space.Considering inter-subsegment coupling and external disturbance, Chenet al.[28]proposed a variable curvature model for quasi continuum robots.Deformation of the manipulator can be determined by using force-torque balance equations.Aiming at ensuring the model accuracy while reducing the computational complexity, discrete Cosserat rod models were derived.[29,30]Additionally, Venkiteswaranet al.[31]developed an optimized PRB model,which can estimate the reaction forces and shape of a continuum manipulator.Different from the non-linear Cosserat rod theory, the PRB models use finite elements to represent the robot deformation.However,the iterative solution of static model is time-consuming and difficult to be directly applied to motion control scenarios.
Different from mechanism-based modeling method,datadriven approach is another way to solve the modeling problems of continuum manipulators.In Ref.[32], the inverse kinematic model was obtained by training a multilayer perceptron with a single hidden layer, containing both position and attitude.Giorellet al.[33]presented a supervised learning method(feedforward neural network)to solve the inverse static model of non-curvature flexible manipulators, which is faster and more accurate than the iterative inverse algorithm of the Jacobian-based method.In Ref.[34], Elgeneidyet al.proposed an empirical model by using regression analysis and artificial neural network.The model is validated by using the new data set generated under untrained operating conditions.However,the data-driven modeling method usually requires a large amount of input and output data.In addition,it is hard to obtain the system model in full space,which limits its further applications.
For a novel TDQCR with the NSS structure designed in this study, the quasi continuum segments composed of stainless steel springs and rigid-flexible coupling subsegments further complicate the robot model.Due to the proposed NSS structure, the change of spring stiffness will result in abrupt changes in subsegment bending properties.In order to achieve comprehensive understanding of the robot motion characteristics,we propose a static-to-kinematic modeling scheme,which can be used in real-time motion control.Contribution details are listed as follows:
1.We design a novel TDQCR with the NSS structure.Different from the existing TDCRs with rigid-flexible coupling units,the novel NSS structure divides one continuum robotic section into several subsections of variable stiffness, facilitating users to find a trade-off between load capacity and dexterity depending on the requirements of different tasks.
2.We derive a static model which can predict deformations of the TDQCR in 3-D space,and the experiments show good consistency between the model and our robot prototype.A novel static-to-kinematic modeling scheme is proposed to reveal the angular mapping characteristics between the configuration space and the subsegment space of the TDQCR, and to validate the feasibility of the model through motion control experiments.
The rest of this paper is organized as follows: Section 2 introduces the kinematics of the TDQCR based on the screw theory.The static model considering gravity loading, tendon tension,multibackbone constitutive laws and tension attenuation effect is then derived by using the Newton–Euler formula in Section 3.In Section 4, experimental results are provided to validate the kinematic and static model.Finally,the conclusions are given in Section 5.
The prototype of a TDQCR section is presented in Fig.1.Each robotic section contains several 2-DoF rigid-flexible coupling subsegments.Through the push-pull actuation of the tendons, the robotic section can be bent to the corresponding configurations.The subsegments are connected by universal joints,which constitutes the rigid backbone of the continuum arm.The flexible backbone springs are symmetrically arranged in the subsegments and fixed with the upper and lower joint disks.
Fig.1.Schematic diagram of a robotic section of the TDQCR with the NSS structure.
In order to increase load capacity of the manipulator while ensuring the manipulation flexibility,a novel NSS structure is proposed.The wire diameter of backbone springs assembled in the proximal subsegments in each robotic section is larger than that of the distal subsegments.Consequently,one robotic section is divided into several subsections with decreasing stiffness,ensuring the flexibility of the robot motions with fewer actuation units.
For the TDQCR discussed in this paper, firstly the kinematics of a single subsegment is analyzed.As the displacements of the driven tendons result in the uniform deformations of the subsegment springs, the constant curvature (CC)assumption is then established.By using the screw theory,[35]we develop a concise subsegment-based kinematic model for the continuum manipulator.
As shown in Fig.2, the configuration of theithsubsegment in thejthsection is uniquely determined by the
We define the spatial twistSi,j=(ωi,j,υi,j).Unlike the D-H representation, the need of establishing link coordinates is eliminated.By using matrix exponential,the transformation matrix of the adjacent disk frames can be calculated by
wherecφi,j=cos(φi,j),sφi,j=sin(φi,j),cθi,j=cos(θi,j),sθi,j=sin(θi,j),for the sake of simplification.In this way,the transformation matrix is parameterized by (φi,j,θi,j,li,j).Evaluating the PoE formula from the base frame{O0,1}to the tip frame, we have the subsegment-based forward kinematics of the continuum manipulator as follows:
wherenis the number of robot sections,andsjis the number of subsegments of thejthsection.
The kinematic mapping of the TDQCR is illustrated in Fig.3.Although the forward kinematics from subsegment space to task space is derived by Eq.(3), it is difficult to obtain the subsegment parameterθi,j.For one robotic section of a TDQCR, its underactuated subsegments move passively with the robotic section.Taking gravity, inner friction, and other non-negligible factors into account, obviously the configuration of the robotic section with the NSS structure is difficultly described with simple geometric relations.Even if the configuration parameterΘj(j=1,...,n) is known, the subsegment bending angles of thejthsection remains unknown and the tendon displacement Δlkin actuation space could not be calculated.To address the bending angle mapping between configuration space and subsegment space, a static model is established under the quasi-static condition.
Fig.3.Kinematic mapping of the TDQCR.
In order to improve the accuracy of the static model,tension attenuation effect caused by routing channel friction should be considered when modeling the quasi continuum manipulator.On the basis of considering gravity loading, tendon tensions and constitutive laws generated by the backbone springs,the mechanical modeling of the manipulator is established.
3.1.1.Gravity loading by the manipulator
For a comprehensive static model, the gravity effect caused by the joint disks, the universal joints and the backbone springs is non-negligible.As illustrated in Fig.4,gravity is along the negative direction ofz-axis of world frame{S}.The transformation matrix between world frame{S}and robot base frame{O0,1}is defined as
where the rotation matrixRSand translation vectorPSare determined by the assembly configuration of the manipulator.Considering the gravity termsandcaused by the joint disk, the universal joint and the backbone spring in theithsubsegment of sectionj, the gravity termGSin frame{S}can be calculated as
wherei=1,...,sj,j=1,...,n;mdi,j,mui,j,msi,jare the mass of the joint disk, the universal joint and the backbone spring respectively;ts jis the number of springs in a subsegment in sectionj.With the help of Eq.(3), the gravity terms can be expressed in the local frame{Oi−1,j}as follows:
wheredi,j,ui,j,andare the center of mass of the joint disk,the universal joint,and thekthbackbone spring.
Fig.4.Force analysis diagram of two adjacent subsegments.
3.1.2.Actuation loading by the driving tendons
Specially,the total tension applied to the last subsegment disk of each section(i.e.,i=sj,j=1,...,n)is calculated by
The total moment provided by the tensions is expressed as
Most static models for tendon driving systems assume that the tension is the same everywhere in a single tendon.However, this is inconsistent with the physical system.Friction between the driving tendon and the routing channel is affected by many factors,such as material properties,geometric dimensions and lubrication effect.Figure 5 shows the tension attenuation effect of routing channelin theithsubsegment disk of sectionj.
Fig.5.The sketch chart of tension attenuation effect.
As the continuum robot often works at a slow speed, it is assumed in this study that the sliding friction is approximately equal to the static friction.When the bending angleθi,jvaries, the positive pressurethat the tendon applies on the routing channel becomes different,leading to a change in the deformation of the tendon in contact with the routing channel.According to the force balance equation,we have
whereµis the static friction coefficient.Substituting Eq.(15)into Eq.(14), we can obtain the attenuated tendon tension through the routing channel:
Dividing the bending angleθi,jinto infinitesimal angle micro elements,the tension attenuation coefficientαi,jcan be calculated by
When the robotic arm bends,the backbone springs in the subsegments are stretched or compressed,creating forces and bending moments on the attached disks.The forceon theithdisk of sectionjin thekthrouting channel can be calculated by adding forcesandfrom the adjacent spring deformations:
wherei=1,...,sj −1,j=1,...,n;ki,jandki+1,jare the stiffness coefficients of the springs;Δlki,jand Δlki+1,jare the spring deformations.
Special cases need to be considered.The force on the last subsegment disk of each section (i.e.,i=sj,j=1,...,n) is calculated by
whereI3denotes the third order identity matrix.is the translation vector between the origin of frame{Oi−1,j}and routing channel.Using Eqs.(2)and(20),we have
The lateral bending moment of a spring is a function of angular deflectionθi,j, material properties, elastic modulesEand Poisson’s ratiov,[36]which can be calculated as
wheredsi,jis the wire diameter of the spring in theithsubsegment in sectionj,Di,jis the coil diameter,andNsi,jis the number of active coils.The homogeneous vector of lateral bending moment.As the springs in a single subsegment share the same bending angleθi,j,the moment in frame{Oi−1,j}is
Combining with Eqs.(4)–(23),we can analyze the statics of the TDQCR comprehensively.Equilibrium equations are derived based on the Newton–Euler formula as follows:
As for the tip frame(i.e.,i=sn,j=n),the recursive termsFOi,jandMOi,jin Eqs.(24)and(25)are equal to zero.The problem is transformed into solving the subsegment parametersθi,jandφi,jaccording to the actuation forces.With the help of the functionfsolveimplemented in software Octave,the nonlinear equations are solved by recursive calculations.
To verify the feasibility and accuracy of the proposed static model, experimental validation was conducted for the TDQCR designed in this paper[robotic prototype is shown in Fig.6(a)].Diameter of the subsegment disk is 0.06 m and the diameter-to-length ratio is 0.12.The static friction coefficientµis set to 0.2.Detailed parameters of the TDQCR are listed in Table 1.In Fig.6(a), specific tendon tensions were generated by attaching standard weights to the end of the driving tendons.The pose of each joint disk was measured by the AprilTags visual fiducial system.[37]The tags from tag family Tag36h11 were detected by a 1920×1080 pixel camera(Intel®RealSenseTMDepth Camera D435i).The camera was placed at the lab table,facing the robot arm along the negative direction ofy-axis of world frame{S}.Before experiments,the camera was calibrated and precision of the vision measuring system is±0.2 mm.Figure 6(b)illustrates the simplified static simulation visualization model of the TDQCR constructed in Octave.
Table 1.Parameters of the proposed TDQCR.
Fig.6.Experimental setup: (a)the testbed with AprilTags visual fiducial system,(b)the static simulation model of the TDQCR.
To specify the novel NSS structure utilized in the robot design, the parameters of backbone springs are listed in Table 2.Note that the springs are made of stainless steel and Young’s modulusE ≈190 GPa,Poisson’s ratiov ≈0.35.
Table 2.Parameters of the backbone springs.
4.2.1.Single tendon actuation
Here two experiment sets were performed under single tendon actuation.Due to the symmetry of the robotic structure, the effect of driving any tendon of a robotic section is essentially the same.Tendont12in the first section and tendont22in the second section were chosen,and detailed results are presented.
The snapshots of the manipulator under different pulling forces are overlapped in Fig.7.The weight applied to tendont12was increased from 100 g to 1700 g with intervals of 200 g,and a total of 9 groups of data were obtained.The first robotic section was bent to the positive direction ofx-axis while the second section remained almost straight.The manipulator was continuously bent with the increase of tendon tension.Meanwhile, due to the influence of gravity and the nonlinearity of flexible components,the bending angle of the first section did not increase uniformly.
Figure 8 shows the comparison of experimental measurement positions and model-based positions under the actuation of tendont12.It is clear that the model results are highly consistent with the prototype.The proposed static model can predict the manipulator deformation with high accuracy.The calculated root-mean-square error (RMSE) is 3.7×10−3m and the maximum error is 5.3×10−3m, which only account for 0.77%and 1.11%of the entire arm length(i.e.,0.50 m).
Fig.7.Single tendon actuation by tendon t12.
Fig.8.Comparison between the experimental results and the model results (TDQCR deformations caused by tendon tension t12 varied from 100 g to 1700 g with intervals of 200 g).
Figures 7 and 8 represent the in-plane results.Figure 9 and 10 show the results of the out-of-plane cases.The weight applied to tendont22was increased from 200 g to 1600 g with intervals of 200 g,and totally 8 groups of data were obtained.The tendon tensiont22was increased gradually, and the second section was bent.The first section was passively bent due to the coupling effect between the sections (see Fig.9).As shown in Fig.10,the static model can still well predict the deformation of the robotics arm.The obtained RMSE and maximum error are 7.8×10−3m and 1.13×10−2m,respectively,accounting for 1.63% and 2.35% of the entire length of the manipulator.
Fig.9.Single tendon actuation by tendon t22.
Fig.10.Comparison between the experimental results and the model results(TDQCR deformations caused by tendon tension t22 varied from 200 g to 1600 g with intervals of 200 g).
4.2.2.Symmetrical tendon actuation
To further verify the proposed static model, experiments of symmetric tendon actuation were carried out.The overlays of the experiment snapshots are similar to those of the previous subsegment and are not repeated below.As shown in Fig.11,one tendon tension was fixed,and the other tendon tension was increased gradually.The outputs of the static model and experimental system reflect good symmetry properties of the manipulator.The RMSE and maximum error are 4.4×10−3m and 6.7×10−3m, respectively, accounting for 0.92% and 1.39%of the entire length of the manipulator,which are almost consistent with the cases of single tendon actuation.
The out-of-plane experiments by symmetrical tendon actuation are shown in Fig.12.Similar to Fig.10, the errors of out-of-plane experiments are larger than those of the inplane cases.The obtained RMSE and maximum error are 5.9×10−3m and 1.0×10−2m, respectively, accounting for 1.23%and 2.08%of the entire length of the manipulator.The accuracy of the proposed static model is still maintained at a high level.
Fig.11.Symmetrical tendon actuation by tendons t12 and t14: one tendon tension was fixed at 300 g and the other tendon tension varied from 300 g to 1700 g with intervals of 200 g.
Fig.12.Symmetrical tendon actuation by tendons t22 and t24: one tendon tension was fixed at 400 g and the other tendon tension varied from 400 g to 1600 g with intervals of 200 g.
Implementing the NSS structure allows one continuum robotic section to be divided into multiple subsections with variable stiffness,providing selective stiffness for carrying different payloads.We conducted a simulation to analyze its load ability.We set high and medium spring stiffness(same parameters as high stiffness spring and medium stiffness spring of the NSS structure)and constructed the TDQCR for two stiffness configurations.As shown in Fig.13,the tension of tendont22was gradually increased from 0 g to 2000 g,with intervals of 10 g.HeighttZof the tip of the medium stiffness TDQCR is the first to drop below 0 m, and the corresponding tendon tension is 670 g.Similarly,the corresponding tendon tensions for the NSS and high stiffness TDQCR are 1390 g and 1600 g,respectively.Furthermore, we applied a load of 100 g at the robot tip of different stiffness configurations to compare the load effect (see Fig.14).When the tendon tensiont22gradually increased from 0 g to 500 g, the height deflection of the TDQCR with medium stiffness configuration is the largest one.The maximum deviation exceeds 0.17 m(34%of the arm length), which is far greater than the other two stiffness configurations.The load capacity of the NSS structure is close to that of the high stiffness configuration.
Fig.13.Height tZ of the robot tip under the tensioning of tendon t22.
Fig.14.Height deflection of the robot tip caused by 100 g load under the same tendon tension.
In summary,the flexibility and load capacity of a TDCR are always contradictory.High stiffness configurations can effectively increase the load capacity but place an additional burden on the actuation unit and sacrifice the flexibility of the manipulator.In contrast, low stiffness configurations are generally more flexible,but the load capacity are greatly decreased.Our new NSS structure is a trade-off between load capacity and dexterity,allowing users to set the number of sections and stiffness configuration of the robot to meet different task requirements.
The results of the statics validation are summarized in Table 3.The static model can well reflect the quasi-static characteristics of the manipulator and provide a theoretical basis for the optimal design and kinematic motion control.
Table 3.Errors between experimental results and the proposed static model.
Fig.15.Bending angle of the subsegments: (a) deflection of the first section under the tensioning of tendon t12,(b)deflection of the second section under the tensioning of tendon t22.
In order to find the bending angle mapping between the configuration space and the subsegment space, two bending angle datasets were produced in quasi-static workspace based on numerical calculations.As shown in Figs.15(a)and 16(a),the tendon tensiont12was gradually increased from 50 g to 2000 g with intervals of 10 g, constituting one dataset.Under the same tendon tension, the bending angle of subsegments from 1 to 2 in the first robotic section decreases, and the bending angle of subsegments from 3 to 5 decreases [see Fig.15(a)].Moreover, the bending angle increases sharply at the third subsegment bending angle, and the first section is then divided into two subsections,which is consistent with the proposed NSS structure.The proportion of the bending angle of each subsegment is approximately linear to the total bending angle[Fig.16(a)].Similarly,the other dataset was obtained by increasing the tendon tensiont22from 50 g to 2000 g with intervals of 10 g.Figure 15(b)shows that under the same tendon tension,the bending angle of subsegments from 1 to 3 in the second robotic section decreases, and the bending angle of subsegments from 4 to 5 decreases.A steep increase is shown at the fourth subsegment bending angle.The proportion of the bending angle of each subsegment is also approximately linear to the total bending angle of the second section[Fig.16(b)].
The above results reveal the abrupt change of subsegment bending angle caused by the NSS structure.Using our static simulation model, one can obtain sufficient static workspace which includes the mapping of manipulator configuration and subsegment bending angles.The static-to-kinematic model was proposed by combining the static workspace with the kinematic model.On the basis, the bending angle mapping between the configuration space and the subsegment space was found,and the actuation variables Δlkwere calculated by configuration variablesΘjand subsegment variablesθi,j(see Fig.3).
Fig.16.The proportion of bending angle of each subsegment: (a)tendon tension t12 gradually increased from 50 g to 2000 g with intervals of 10 g,(b)tendon tension t22 gradually increased from 50 g to 2000 g with intervals of 10 g.
To verify the static-to-kinematic model, motion control experiments were conducted on our TDQCR system (see Fig.17(a)).The control of the robotic arm is facilitated by an Arduino Uno R3 microcontroller board, which receives commands from the PC and governs the arm’s motion.The robotic arm consists of two sections,with each section comprising five 2-DOF subsegments.The length of the driving tendons is determined according to the desired manipulator configuration,and a lead screw is employed to convert rotational motion into linear motion,enabling a push-pull actuation mechanism[see Fig.17(b)].The manipulator is actuated to specific configurations by controlling the length of the tendons.Real-time tendon tension data is continuously collected using force sensors, enabling analysis of the manipulator’s movement process.Once the manipulator reaches the desired configuration and maintains stability, the collected tendon tension is employed in the proposed static model to calculate the manipulator’s bending.This calculated configuration is then compared with the output of our robotic prototype system.
Fig.17.Robot system and motion control results: (a) tendon-driven quasi continuum robot system, (b) actuation system, and (c) motion control data and static-to-kinematic model results.
We controlled the two-section TDQCR for C-shaped and S-shaped bending motions.The segmental bending angle was increased from 10°to 70°.By utilizing the proposed staticto-kinematic model, it becomes possible to calculate the subsegmental bending angles corresponding to various robot arm shapes, thereby achieving a more precise calculation of the driving tendon length.It can be seen from Fig.17(c) that the results of our static-to-kinematic model are in good agreement with the actual robot configurations.Under the C-shaped configurations, the outputs of our model are almost consistent with the outputs of the actual robot system.However,in S-shaped configurations, as the bending angle increases,the mismatching phenomenon becomes relatively significant.This discrepancy can be attributed to the amplified influence of coupling among robotic sections in complex configurations.For different stiffness designs of the manipulator, one need only change the mechanical parameters of the robotic arm in the static model to obtain the subsegment bending characteristics.Therefore,this static-to-kinematic modeling scheme is of good generality for the modeling of continuum manipulators.
This paper presents a TDQCR manipulator with the innovative NSS structure, which can provide desired stiffness for carrying different payloads.To analyze the kinematics and statics of the TDQCR,the subsegment-based kinematics is derived by using screw theory.Considering gravity loading,tendon tension, multibackbone constitutive laws, and tension attenuation effect, the static model is established and validated by experiments.The results indicate that the theoretical model is highly consistent with the prototype.
To solve the bending angle mapping problem between the configuration space and the subsegment space, the staticto-kinematic model is proposed.Motion control experiments show the superiority of our static-to-kinematic model.Moreover, this modeling scheme can be possibly applied to various types of continuum manipulators, demonstrating a solid foundation for the robot motion control.Future work will focus on the dynamic modeling and the motion planning of the TDQCR.
Acknowledgements
Project supported by the National Natural Science Foundation of China(Grant No.61973167)and the Jiangsu Funding Program for Excellent Postdoctoral Talent.