Closed-loop control of soft continuum manipulators under tip follower actuation

1. Introduction

Continuum manipulators, defined as flexible devices which take on curvilinear shapes as they are actuated, have proven useful in a variety of industries, from medicine to military applications (Singh and Krishna, 2014). The design of these devices is often biologically inspired, with motions mimicking those of elephant trunks or octopus tentacles (Walker et al., 2005). In comparison with traditional rigid robots, continuum robots possess several unique capabilities, such as whole-arm grasping and manipulation (Giri and Walker, 2011), navigation through complex and unpredictable environments (Chirikjian and Burdick, 1995), and passive compliance which can make them safer for interacting with humans (Sanan et al., 2011).

In the medical field especially, non-robotic versions of continuum devices have long been used in the form of steerable catheters for cardiovascular interventions, flexible endoscopes for inspecting the digestive tract and lungs, and providing access to remote surgical sites via small openings and non-linear pathways. When coupled with robotic actuation, these devices can become more precise, more dexterous and easier to use. Continuum robots for medical applications include robotic catheters (Rafii-Tari et al., 2014), robotic flexible endoscopes (Yeung and Chiu, 2016), multi-backbone snake robots (Simaan et al., 2009), concentric tube robots (Dupont et al., 2010; Garriga-Casanovas and Rodriguez y Baena, 2018; Gilbert et al., 2016; Rucker et al., 2010), and steerable needles (Scali et al., 2017; Webster et al., 2006). Although the flexibility of continuum robots provides many advantages for minimally invasive surgery, many designs are still too stiff for certain clinical applications, in which insufficient compliance of the manipulator increases the risk of inadvertent tissue damage (Bajo and Simaan, 2012; Mahvash and Dupont, 2011).

As the demand for more flexible robots has increased particularly within the medical industry, the field of “soft continuum robotics” has grown significantly. The use of soft, elastomeric materials for the construction of continuum robots has enabled researchers in this field to develop continuum manipulators with extremely low stiffnesses. As reviewed by Trivedi et al. (2008) and by Marchese and Rus (2016), soft manipulators are typically considered to be a subclass of continuum robots, though there is no widely agreed upon stiffness value which separates “soft continuum robots” from “hard continuum robots.” In this article, we focus on the subclass of soft continuum manipulators whose body is composed exclusively by soft elastic material (having Young’s modulus lower than 10⁵ Pa) without the presence of any metallic components.

The vast majority of soft continuum manipulators presented to date can be categorized into one of two primary morphologies: (1) arms actuated through tension applied to tendons or cables running along their length (e.g., Calisti et al., 2011; Ranzani et al., 2015; Wang et al., 2013); and (2) arms composed of multiple chambers which can be pressurized by air or fluid to produce bending as a result of pressure differences within the robot’s cross-section (e.g., Deimel and Brock, 2013; Martinez et al., 2013). These two distinct morphologies have been investigated extensively in the literature from both modeling and control standpoints. They are similar in that they both involve distributed loads along a central “backbone.” Although in-plane bending often allows for the simplifying assumption that these actuation mechanisms apply only a tip moment to the backbone, this assumption breaks down when out-of-plane bending occurs, whether due to the actuation itself, such as in the case of non-linear tendon-routing, or due to external loads, such as those due to gravity (Rucker and Webster, 2011b).

In contrast, designs recently presented in Campisano et al. (2017) and Slawinski et al. (2017) involve forces and/or moments located only at the tip of the robot, which do not produce any significant distributed loads along the length of the backbone, even when out-of-plane bending occurs. In Slawinski et al. (2017), the soft manipulator is steered via a tip wrench generated by a permanent magnet mounted on and controlled via an industrial robot arm; in Campisano et al. (2017), the soft manipulator is actuated by water jets of controllable flow rates which spray out from the tip of the manipulator, producing a force on the tip. We refer to these designs as soft continuum manipulators under tip follower actuation (TFA) to highlight that the only source of actuation is a tip wrench, which follows along with the tip frame as the robot moves, and to differentiate them from the other two categories described previously.

The strategy adopted for modeling and control of a particular continuum manipulator, whether soft or hard, depends on many variables, including the type of actuation, material properties, and design geometry. The simplest modeling method for tendon-driven and pressurized chamber-actuated devices is the constant curvature (CC) model (for a review, see Webster and Jones, 2010). This approximation is based on the assumption that each degree of freedom (DoF) is independent and the deflected shape can be modeled as a perfect circular arc. Depending on the robot design and the required level of accuracy for the application, this modeling approach may suffice. However, as the device stiffness decreases and deflection increases, accuracy of the CC approximation is typically reduced, making it unsuitable for many applications, at least in the absence of a closed-loop controller (Marchese et al., 2014). An extension of the CC approximation is to discretize the manipulator into many short CC sections (Roesthuis and Misra, 2016; Rolf and Steil, 2014). In this approach, finer discretization provide more accurate models, but also present many more parameters in need of calibration.

Non-linear finite element analysis (FEA) has also proven useful for modeling the kinematics of soft continuum manipulators. Largilliere et al. (2015) showed that this method can accurately predict the displacement of a pressurized chamber-actuated soft continuum manipulator based on pre-computed strain maps for varying input pressures. However, this method proves to be highly sensitive to uncertainties in model parameters, as well as external disturbances, such as a change of the robot orientation with respect to gravity, making it challenging to apply this approach in a variety of practical applications.

A rigid-body approximation approach has been used extensively for devices commonly referred to as soft-tethered endoscopic capsules (Slawinski et al., 2015), whose body is characterized by a passive flexible tether attached to a capsule experiencing a point wrench. These devices, proposed as an alternative to endoluminal endoscopes, provide access to remote surgical sites by entering the human body via natural orifices. Taddese et al. (2016) steered the device within the colon through the application of a magnetic wrench on the capsule. For this application, the spatial configuration of the soft tether is not modeled, and the forces generated by the presence of the tether are treated as an external disturbance to the pose of the capsule’s body and compensated through the use of pose feedback. This has proven effective for motion in a closed lumen, where tissue interaction forces dominate over the loads applied on the capsule by the tether; however, when tip motion due to a TFA is controlled in free space, the forces applied on the capsule by the tether become relevant.

Given the limitations of these modeling approaches, forward kinematic models based on Cosserat rod theory have emerged as some of the most accurate models available for continuum manipulators. This approach involves integrating the constitutive differential equations for a rod-type structure subject to certain boundary conditions, as described for soft pressurized chamber-actuated robots in Trivedi et al. (2008). As in Trivedi’s work, Cosserat rod theory has been applied to tendon-actuated robots (Rucker and Webster, 2011b), concentric tube robots (Dupont et al., 2010; Rucker et al., 2010), and elastic rods with permanent magnets at the tip subject to spatially varying magnetic fields (Edelmann et al., 2017; Kratchman et al., 2017). Although Cosserat rod theory can be directly adapted to compute forward kinematics of these manipulators, it typically does not allow for direct inversion. Instead, a differential kinematics approach is typically used, in which the Jacobian matrix is used to map desired task space velocities into desired actuator space velocities. This forward kinematic model and resolved rates approach has proven effective, even without pose feedback, for stiff continuum robots (Fallahi et al., 2016; Khadem et al., 2016; Rucker et al., 2013). However, many of the simplifying assumptions used to make calibration and real-time control via this model feasible (such as linear elastic materials, uniform precurvature, and uniform and isotropic material properties) do not hold up well for soft elastomeric manipulators. Another challenge of applying the resolved rates approach to continuum robots emerges as the stiffness becomes extremely low, such that the singular values in the Jacobian matrix mapping tip wrenches to tip motion are very large. This implies that for soft robots, small changes in actuation forces can result in very large changes in manipulator pose. As a result, effective control of the robot’s task space requires extremely precise control of the actuator space, which may be difficult to achieve for certain TFA designs, depending on the mechanism used to generate the tip wrench. For example, in the case of the device described in Campisano et al. (2017), the system used to deliver water through the jets possesses its own non-linear dynamics, making it difficult to accurately control flow rate without actuation feedback.

In this article, we propose a modeling and control framework designed to address the unique challenges of low stiffness, TFA soft continuum manipulators being actuated in free space, under quasi-static deployment conditions. We achieve this through a combination of a kinematics model based on Cosserat rod theory with known external loads due to gravity, closed-loop control with respect to the manipulator pose, and closed-loop control with respect to the actuators. The use of a Cosserat rod model provides a more accurate description of the kinematics when compared with simpler models such as CC-based models, though due to many simplifying assumptions used to reduce the calibration problem and increase computational speed (such as uniform precurvature, isotropic stiffness, and linear elastic material), it is still not sufficiently accurate in the absence of feedback. Manipulator pose feedback is utilized to account for these modeling approximations, while actuator space feedback is used to account for non-linearities of the actuation system that can lead to incorrect tip wrench estimation that would produce error in the kinematic model. This drastically improves accuracy for the case of a manipulator of extremely low stiffness. The contributions of this work can be summarized as follows.

1. This is the first archival article to apply Cosserat-rod theory to soft continuum manipulators undergoing TFA and external loading.

2. We present a novel closed-loop control scheme that uses both tip orientation feedback and actuator feedback. The actuator feedback compensates for non-linearities of the actuation system that can lead to incorrect tip wrench estimation which is common in soft continuum manipulators under TFA, whereas pose feedback enables accurate path following.

3. The design of the soft body for a water-jet-actuated soft continuum endoscope, including proposed medical application and calibration procedure, is described for the first time in this article.

4. Lastly, we contribute an experimental validation of the proposed controller to achieve orientation control of a soft continuum manipulator under TFA in free space.

The article is organized as follows: First, the differential equations governing a TFA manipulator are derived from the Cosserat rod theory. Second, a closed-loop control scheme implementing a resolved rates approach is described. Finally, both open-loop and closed-loop approaches are tested experimentally, showing the advantages of the proposed closed-loop controller with respect to the open-loop case alone when commanding pre-planned desired trajectories to the “HydroJet,” a soft continuum endoscope that uses water-jet propulsion to control tip motion.

2. Modeling background

Based on Cosserat rod theory, a quasi-static deflection model for continuum manipulators with configuration space parameters q, and under a six-DoF follower wrench w, can be written in the following form (Jones et al., 2009; Rucker et al., 2010):

where g(s) ∈ SE(3) describes the homogeneous transformation defining the position and orientation of an arc-length parameterized reference frame along the arc coordinate s (Figure 1), $\widehat{\xi }\in se(3)$ is a body frame twist describing how g evolves in s (Murray et al., 1994), and the operator ′ denotes a derivative with respect to s. A set of variables y describe the equilibrium equations governing the behavior of the manipulator.

Solving for the deflection of a generic soft continuum manipulator requires the knowledge of a subset of elements of y that is usually in the form of boundary conditions at the base (s = 0) and at the tip (s = l). These may be expressed in the form of Rucker and Webster (2011a), with the conditions at the base being

where y_u represents a set of unknown elements of y and y_k represents a known set of conditions at s = 0. Similarly, at the tip of the robot (s = l) the boundary conditions assume a more general form:

Equation (3) is in a generic form and may account for multiple connected continuum elements, each with different properties. Assuming a single continuum element whose spatial configuration can only be altered through the application of a follower wrench, as in Figure 1, the boundary conditions can be simplified to

where $w^{*}=w_a(q)+\overline{w}$ represents the effect from both a time-varying localized wrench which is a function of the joint parameters, w_a(q), and an external constant wrench $\overline{w}$, e.g., gravity. By integrating Equations (1) using the boundary conditions (4) (i.e., solving the forward kinematic model), it is possible to estimate the deflection of the rod caused by a wrench applied at a specific location along its body. The solution of the forward kinematic model represents a geometric configuration in which all forces and moments applied on the body are in equilibrium. In order to accurately control tip motion with a soft structure, it is advantageous to apply a wrench in close proximity to the tip while constraining the base. A schematic representation of a soft continuum manipulator under these constraints is presented in Figure 1, and the associated boundary conditions can be expressed as

where it is assumed that the deformation of the soft body is caused exclusively by a wrench w_a generated by the actuators and a tip load $\overline{w}(l)$. The next section presents the static equations describing the equilibrium of the rod under the boundary conditions (5).

3. Kinematic modeling of a soft continuum manipulator under TFA

As introduced in Dill (1992), the centerline of an unloaded precurved rod can be described by an arc-length parametrized space curve $\tilde{p}(s)\in {ℝ}^3$, expressed with respect to a base coordinate frame attached at the proximal end of the rod. A frame is assigned to each point on the rod $\tilde{p}(s)$, with the orientation of the frame represented by a rotation matrix $\tilde{R}(s)$ corresponding to the rotation of the base frame unit vectors ${\left[\begin{array}{ccc}{\tilde{e}}_x& {\tilde{e}}_y& {\tilde{e}}_z\end{array}\right]}^{\text{T}}$. Under an external load, the parametric curve $\tilde{p}(s)$ deflects to the curve p(s) and $\tilde{R}(s)$ rotates to R(s). In this article, the homogeneous frames are assigned so that the z-axis of each frame is tangent to the curve. By differentiating the arc-length parametrized curve with respect to the parameter s, we obtain

where e_z = R(s) k, and k = [0 0 1]^T is the versor associated with the z-axis of the base coordinate frame. The continuous homogeneous transformation for the deflected rod may be defined as

A similar expression may also be defined for the initial state $\tilde{g}(s)$. The rotation of each point on the rod may be expressed in terms of a local curvature vector u(s), which can be found using the relationship (Murray et al., 1994)

where the operator ∨ denotes conversion of an element of $\mathfrak{s}\mathfrak{o}(3)$ to its corresponding element in ${ℝ}^3$. The curvature at each material point with respect to the initial state $\tilde{u}(s)$ represents the local strains within the rod, and can be obtained using $\Delta u(s)=u(s)-\tilde{u}(s)$. The constitutive relationship between the curvature vector and internal moments, expressed in the local coordinate frame at s, is

where M_b(s) is the internal moment and K represents the stiffness matrix, defined as

where E is the Young’s modulus, I_x and I_y are the second moment of area of the tube cross-section, G is the shear modulus, and J is the polar moment of inertia of the tube cross-section. The equilibrium equations for the rod under external forces and moments were derived following a similar process to that described in Rucker et al. (2010). The resulting equations that govern the distribution of forces and moments along the rod can be expressed as

where Q(s) is the internal force, M(s) is the internal moment, f(s) represents the distributed force, m(s) represents the distributed moment along the rod, and Pδ(s − l) represents the concentrated force due to the tip concentrated mass at s = l. As the follower wrench is geometrically located at the tip of the manipulator, remaining always fixed with respect to the tip frame, it is convenient to express equations (11) with respect to the local coordinate frame. By recalling the derivative of vector v, expressed in moving coordinate frame in s, is v′ = u × v, than

where f_b(s) = R(s)^T f(s), P_b = R(s)^T P, ${\widehat{e}}_z$, and $\widehat{u}$ are the skew-symmetric matrices associated with the vectors e_z and u, respectively. The effect of both the distributed force and of the weight at the tip can be easily estimated by knowing the orientation of the base and tip frames with respect to a global frame aligned with gravity:

where m_t is the total concentrated mass at the tip and m_b(s) is the distributed mass of the body and R_g represents the rotation of the base frame with respect to gravity. Substituting (9) in (12) and then solving for u′ yields

Equations (6), (9), (12), and (14) represent the model equations that need to be integrated from s = 0 to s = l in order to determine the state variables [p(s) R(s) u(s) Q_b(s)] in the form expressed by (1) where y = [u(s) Q_b(s)]. Boundary conditions for systems constrained at the base with TFA are expressed with respect to the proximal and distal ends of the soft body. Therefore, at s = 0, the position of the rod and the rotation of the attached frame at its base are defined respectively as

The boundary condition applied to the distal tip contains the discrete point wrench generated by the actuators, w_a. The generic form for this boundary expression is

where w_a|_f and w_a|_m respectively represent the force and the moment components of the follower wrench expressed with respect to the tip frame.

4. Closed-loop control in task space

In this section, we propose a control scheme that can be applied to a soft manipulator actuated by a follower wrench in free space. During the motion, the body of the soft manipulator is acted upon by various forces and moments, including the TFA wrench, external distributed and point loads owing to gravity, and internal forces and moments within the elastic structure. The goal of the control scheme is to select and apply the tip follower wrench required to produce a static equilibrium corresponding to a desired manipulator pose.

In addition to achieving a desired pose, reducing oscillations enough to smoothly transition from one desired equilibrium state to another is challenging for soft continuum robots under TFA. These oscillations result primarily from two factors: (1) unmodeled dynamic effects that result from the acceleration of the body, and (2) the sensitivity of the manipulator pose to small changes in applied follower actuation, both of which are significant for soft compliant bodies. In addition, intrinsic model error due to inaccuracies in model parameters precludes accurate open-loop control, even in the case of very slow accelerations.

To address these challenges, the proposed quasi-static control scheme includes feedback from both the actuators and the tip pose. The actuator feedback is utilized to both regulate the follower load, in order to reduce any noise or overshoot in the input signal which can produce oscillations in the soft manipulator, and to compensate for non-linearities of the actuation system that can lead to incorrect tip wrench estimation, and thereby introduce kinematic model error. Pose feedback is required to compensate for modeling uncertainties and approximations in order to achieve the desired pose. In addition, we choose to command only small accelerations to the system in order to keep dynamic effects negligible. All three of these features work in conjunction to enable quasi-static path following.

A block diagram of the proposed control system is shown in Figure 2. The first feedback line senses the state of the actuator, whereas the second indicates the current configuration of the rod. Actuator feedback is used to estimate the current tip wrench to compute the forward kinematics model and the Jacobian matrix which maps changes in the wrench applied by the actuators to changes in the body configuration. The sensed configuration of the rod is used to calculate the error x_err between the current pose x_obs and the desired input pose x_des. The pose error and actuator feedback are utilized within the linearized controller in order to solve for the desired actuator states q.

Figure 3 shows the linearized controller in detail. The control signal x_cntr is obtained using a proportional–derivative feedback control scheme such as

where K_p and K_d are the proportional and derivative feedback gains and x_err is the pose error defined as

where x_obs = [p(l) θ_e ψ_e γ_e]^T and θ_e, ψ_e, γ_e represent the orientation of the tip with respect to the base frame. The control signal is then converted into change in tip wrench by using

where R^h(l) C^b is inverted with a least-squares method such as the Moore–Penrose pseudoinverse, indicated by ^† (Horn and Johnson, 1985), C^b is the body Jacobian matrix that maps changes in tip pose with changes in tip wrench $(C^b=\left[{\left(g^{-1}\frac{\partial g}{\partial w_1^b}\right)}^{\vee }\dots {\left(g^{-1}\frac{\partial g}{\partial w_6^b}\right)}^{\vee }\right]$ as described in Rucker and Webster (2011a)), and R^h(l) represents the hybrid transformation between body frame and base frame. The hybrid transformation is required exclusively for the purpose of commanding desired tip trajectories expressed with respect to the base frame. This transformation can be removed if the application requires tip frame velocities to be commanded. A resolved motion rate approach (Whitney, 1969) is then used to obtain the required wrench to be produced at the tip.

The DoF that can be controlled depend on the mapping between configuration parameters and generated wrench. In general, the wrench can be expressed as a system: w_a,des(q) = Aq, where A is a matrix constituted of either linear or non-linear terms. If A is directly invertible, then the configuration parameters can be found analytically by q = A⁻¹w_a,des. If the actuator values are redundant or the matrix is not directly invertible, quadratic programming methods can be used to find the configuration parameters that minimize the norm squared of the error between the desired follower wrench to be applied by the actuators w_a,des(q) and the applied follower wrench detected by the sensors w_a, as

where q_min and q_max represent the lower and the upper limit of the actuator value, respectively. The pseudo-code of the closed-loop motion control algorithm is shown in Algorithm 1.

5. Soft continuum manipulator under TFA: example and application

The modeling and control framework described in Sections 3 and 4 respectively can be applied to any soft continuum manipulator under TFA and known tip load, such as soft robots actuated by tendons or magnetic fields. In order to experimentally assess the proposed approach, we apply it to control the motion of a specific soft continuum manipulator (called “the HydroJet”) that uses water jet propulsion to maneuver a tethered capsule within the stomach for upper gastrointestinal cancer screening (Campisano et al., 2017). Three miniature water-jet nozzles, spaced approximately 120° apart from each other along the diameter (Figure 4), are embedded in the endoscope tip. Pressurized water is carried through a multi-lumen catheter and laterally expelled through the nozzles. The resulting lateral reaction forces constitute a TFA and are used to generate bending in the structure, adjusting the pose of the endoscope camera. The number of controllable Cartesian DoFs depends on the mapping between joint space and generated wrenches. For this specific case, the three water-jets produce a resultant force in a plane perpendicular to the endoscopic tip axis (Figure 4). Owing to their physical arrangement, the water-jets are redundant, such that the robot can only carry out a 2-DoF task (variables ϑ and φ as shown in Figure 7). Thus, the achievable 3D workspace for the manipulator forms approximately an hemisphere with center at the base frame. This specific soft robot morphology, owing to its low-stiffness body and high sensitivity to both unmodeled effects and changes in actuation, constitutes one of the clearest examples of tip follower actuated device to assess the performance of the proposed control algorithm.

6. Experimental methods

7. Experimental validation

To validate the proposed control scheme for soft continuum manipulators under TFA and external loading, two sets of experiments were performed, each using both open-loop and closed-loop schemes. The first experiment consisted of controlling manipulator tip orientations along a spiral path while having the z-axis of the base connector aligned with the direction of gravity, as shown in Figure 8(a). In the second experiment, the base connector was rotated by 30 degrees around its local x-axis, and the same spiral path was commanded to the manipulator. Owing to this change in the alignment with respect to gravity, the forces and moments along the soft body under static equilibrium result in an initial shape (w_a = 0) that bends toward the direction of gravity (Figure 8(b)). Both of these experimental setup angles fall within the expected range of deployment angles for the intended application of gastroscopy.

8. Discussion

The results suggest that the Cosserat rod equations can be successfully implemented to model and control a soft continuum manipulator under TFA in free space. The presented closed-loop scheme improves the tracking capability when compared to the open-loop test cases, as evidenced by the large reduction in orientation error when moving from the open-loop to the closed-loop case (from 0.096 to 0.034 rad for 0° base angle and from 0.181 to 0.035 rad for 30° base angle). The open-loop oscillations are particularly prominent at larger pitch angles, demonstrating the importance of using feedback to compensate model and parameter inaccuracies intrinsic to soft manipulators under TFA. In particular, the use of a closed-loop scheme is important when considering possible clinical applications that require accurate and repeatable poses, such as camera positioning or autonomous screening. Thus, future work that focuses on adding a human in the loop through teleoperation would be interesting from both a clinical and technical standpoint.

The closed-loop scheme presented requires measurement of the tip orientation, which in the presented case was achieved using EM sensors. The idea of using orientation feedback enables control using inexpensive feedback sensors. For example, orientations can also be tracked via lower-cost sensors, such as inertial measurement units (IMUs), embedded into the base and tip of the manipulator, without significantly reducing accuracy (Madgwick et al., 2011). This is relevant for clinical applications, where pairing cheap manufacturing of soft continuum bodies with inexpensive sensors enables the whole system to be used as a low-cost disposable medical device.

The model and control strategy can be generalized for other applications to account for, for example, a full 6-DoF wrench applied at any location along the body or a connection of multiple soft bodies with different stiffness characteristics. In addition, the Cosserat rod framework has been used in other types of continuum robots for contact detection with external bodies (Mahvash and Dupont, 2010) and/or implementation of state constraints (Tully et al., 2012), suggesting these goals should also be possible for soft manipulators under TFA. Furthermore, in this work we have not considered external disturbance loads owing to the environment. In the proposed application of gastroscopy, this is a reasonable assumption, as the HydroJet system is intended to operate within the open cavity of the stomach for the purposes of inspection only, which does not require significant interaction with the surrounding environment. In this type of scenario, the ability to accurately control the device in free space can enable the user to avoid contact with the tissue in order to maintain model accuracy. Still, the ability to compensate for unknown external loads using this method remains an area for future work.

Lastly, the framework presented in this article has its limitations for applications that require fast transitions between equilibrium states. In that case the non-linear dynamics of the soft body may result in excessive oscillations, even under the presented closed-loop scheme, rendering the quasi-static model described in this article insufficient. A possible solution was presented in Rucker and Webster (2011b), where a Cosserat-rod-based dynamic model was developed for a continuum robot which might be extended for the soft manipulator case. A real-time implementation of the Cosserat rod dynamic model for the soft manipulator case would enable better control schemes, particularly in the case of fast motions of the manipulator. Accurate models for both soft body and actuators dynamics, will also enable full dynamic stability analysis of the control scheme proposed in this article. Another possible solution to reduce oscillations while keeping the static model is to improve the design of the hydraulic actuation system in order to obtain a more nearly linear relationship between current and flow rate. This would reduce hysteresis in the actuation system, thus enabling even more precise control of the applied wrench.

9. Conclusions

This article has presented a method for employing real-time control of the equilibrium configurations of soft continuum manipulators actuated via a follower wrench and experiencing external loading. The proposed method couples Cosserat-rod-based modeling with integrated sensing and efficient numerical determination of the Jacobian matrix at each time step to deliver a practically viable, closed-loop control system for application to soft continuum manipulators. Closed-loop performance was demonstrated on a soft continuum endoscope (the HydroJet), and was shown to be effective in reducing orientation error and increasing system stability even under the influence of gravity. The stable closed-loop path following as demonstrated has the potential to enable semi- and fully autonomous manipulation tasks in the next generation of soft continuum robots under TFA.