Skip to main content

ORIGINAL RESEARCH article

Front. Neurosci., 26 March 2024
Sec. Neuroprosthetics
This article is part of the Research Topic Human-in-the-loop System Design and Control Adaptation for Behavior-Assistant Robots View all 10 articles

Adaptive fuzzy control for tendon-sheath actuated bending-tip system with unknown friction for robotic flexible endoscope

\r\nFan RenFan Ren1Xiangyu Wang,
Xiangyu Wang1,2*Ningbo Yu,Ningbo Yu1,2Jianda Han,Jianda Han1,2
  • 1The Tianjin Key Laboratory of Intelligent Robotics, College of Artificial Intelligence, Institute of Robotics and Automatic Information Systems, Nankai University, Tianjin, China
  • 2The Institute of Intelligence Technology and Robotic Systems, Shenzhen Research Institute of Nankai University, Shenzhen, China

Introduction: The tendon-sheath actuated bending-tip system (TAB) has been widely applied to long-distance transmission scenes due to its high maneuverability, safety, and compliance, such as in exoskeleton robots, rescue robots, and surgical robots design. Due to the suitability of operation in a narrow or tortuous environment, TAB has demonstrated great application potential in the area of minimally invasive surgery. However, TAB involves highly non-linear behavior due to hysteresis, creepage, and non-linear friction existing on the tendon routing, which is an enormous challenge for accurate control.

Methods: Considering the difficulties in the precise modeling of non-linearity friction, this paper proposes a novel fuzzy control scheme for the Euler-Lagrange dynamics model of TAB for achieving tracking performance and providing accurate friction compensation. Finally, the asymptotic stability of the closed-loop system is proved theoretically and the effectiveness of the controller is verified by numerical simulation carried out in MATLAB/Simulink.

Results: The desired angle can be reached quickly within 3 s by adopting the proposed controller without overshoot or oscillation in Tracking Experiment, demonstrating the regulation performance of the proposed control scheme. The proposed method still achieves the desired trajectory rapidly and accurately without steady-state errors in Varying-friction Experiment. The angle errors generated by external disturbances are < 1 deg under the proposed controller, which returns to zero in 2 s in Anti-disturbance Experiment. In contrast, comparative controllers take more time to be steady and are accompanied by oscillating and residual errors in all experiments.

Discussion: The proposed method is model-free control and has no strict requirement for the dynamics model and friction model. It is proved that advanced tracking performance and real-time response can be guaranteed under the presence of unknown bounded non-linear friction and time-varying non-linear dynamics.

1 Introduction

The tendon-sheath mechanisms (TSM) have attracted widespread interest in the field of surgery, pipeline inspection, and rehabilitation due to their flexibility, safety, and dexterity, such as applied in the neurosurgery surgical robot, the otolaryngology robot, the cardiac surgical robot, etc. (Burgner-Kahrs et al., 2015; Do et al., 2015a, 2016; Kang et al., 2020; Yin et al., 2020; Wang et al., 2023). The flexible characteristics of TSM make it highly versatile and applicable in narrow scenarios (Berthet-Rayne et al., 2018; Wang et al., 2020, 2021; Rho et al., 2021). Consequentially, numerous studies have focused on the application of TSM in the field of tendon-sheath actuated bending-tip (TAB) systems for natural orifice transluminal endoscopic surgeries (NOTES) as shown in Figure 1 in which bronchi is provided by Servier Medical Art (https://smart.servier.com) under CC BY 3.0 license. Due to the fact that the TAB can be deformed to fit the shape of the channel to avoid damaging the inner organ. However, the unknown friction existing in the tendon routing introduces motion backlash and persistent residual errors, which in turn increases the difficulties in the accurate tracking task of TAB systems. Therefore, it still requires extra effort to address the control issues of TAB systems.

Figure 1
www.frontiersin.org

Figure 1. Illustration of TAB utilized in flexible bronchoscopy.

The hysteresis effect is a crucial issue for the precise control of TAB systems. Most previous studies focused on improving the model accuracy of the hysteresis phenomenon in the TSM. For example, Do et al. (2015a,c, 2016) modified the Coleman-Hodgdon model for the hysteresis phenomenon of TSM and proposed a series of control methods, where no exact value of model parameters are required. Moreover, Thai et al. (2021) developed a simplified hysteresis model based on the generalized Bouc-Wen hysteresis model, while providing higher accuracy than previous Bouc-Wen models. Legrand et al. (2018) and Zhang et al. (2014) built piecewise models for the TAB systems. Similarly, Lee et al. (2021) proposed a simplified piecewise linear model to construct both backlash hysteresis and dead zone compensators together. Their research suggested that the errors from backlash hysteresis and dead zone are considerably reduced and therefore the accuracy of robotic control is improved.

Friction in the tendon-sheath actuator brings significant effects on the control performance of the objective system, such as additional chattering and input backlash. Previous research has focused on developing specific friction models for TSM to improve the modeling precision of the TAB. For example, inspired by the static Coulomb friction model and Hill muscle model, Zhang et al. (2017) presented a high-accuracy transmission model for the TSM. Moreover, Do et al. (2015b) developed a dynamic friction model to predict friction force for small displacement by using the LuGre model, which can capture the asymmetric loops and dead zone accurately. With consideration of the interaction continuity, Norouzi-Ghazbi and Janabi-Sharifi (2020) successfully proposed an equivalent model to estimate forces and moments applied to the sheath of the TSM. Furthermore, Jung and Bae (2016) proposed a feedforward scheme based on the force transmission model to compensate for the friction in a double-tendon-sheath actuated system. However, the TAB system has unknown dynamics and time-varying parameters, and it is very difficult to compensate for friction in real time precisely. In addition, whenever there is a change in working conditions caused by variations in TSM/TAB configurations, the friction model needs to be reidentified to achieve optimal results, which is challenging to apply in dynamic environments. Hence, there still remain open issues with design controllers that can overcome these model uncertainties for TAB systems.

Various control schemes have been proposed for TAB systems based on the concept of hysteresis compensation for TSM (Wu et al., 2014). Considerable works have focused on the perfect cancellation of backlash-like hysteresis using nonlinear adaptive algorithms and machine learning. Nguyen et al. (2014) developed an adaptive control scheme without requiring prior information of TAB systems to eliminate the hysteresis effects. To realize the position control of the TAB system Without sensory feedback, Wang et al. (2018) proposed a non-collocated position control method based on the inverse model of the TSM and 3-D reconstruction algorithm. Besides, Jiang et al. (2015) provided an adaptive PID controller with friction compensation for accurate position control of the dynamic model of TSM. Machine learning has also demonstrated its effectiveness in position control of the TAB system in recent years. For example, based on the kinematic model, Porto et al. (2019) proposed a learning-based hysteresis compensation technique, which directly employed the off-line parameters. Furthermore, Wu et al. (2019) proposed a neural-network-based sliding-mode control scheme by applying the radial basis function network to improve the position-control accuracy of the TAB system with modeling uncertainties and external disturbances. It is noteworthy that the integration of visual servoing with neural networks has recently become a research hotspot (Huang et al., 2022; Li et al., 2023; Cui et al., 2024). To ensure the tip of an instrument remains consistently centered in the camera, Huang et al. (2024) proposed an error learning-based sliding mode control, realizing the 4-DOF visual servo control in the robotic flexible endoscope system. The aforementioned research is impressive and offers a novel research perspective. However, these control schemes rely on an accurate reference model, and the updated process may be time-consuming in training. Therefore, developing a model-free adaptive controller to handle unknown friction for the TAB system is a worthwhile study.

In this paper, to achieve robust control of the TAB system with time-varying dynamics model parameters, a novel adaptive fuzzy controller is proposed. In particular, the complex frictional force between the tendon and sheath may be affected by the sheath deformation and lumina pressure, which brings difficulties to the accurate modeling of the TAB system. To handle this issue, the fuzzy logic system is utilized to compensate for the time-varying dynamics associated with unknown friction. The stability of the closed-loop system is guaranteed by Lyapunov-based analysis. Then, numerical simulations are implemented to further validate the tracking performance of the proposed control scheme. The main contributions of this manuscript can be summarized as follows:

1) By lumping the unknown friction, a novel dynamics model of TAB is established. It's worth mentioning that the proposed model diminishes its reliance on a priori information regarding friction and obviates the necessity for model-based linearization or supplementary linear parameterization conditions for global dynamics, thus rendering it more versatile.

2) To the best of our knowledge, this paper first applies fuzzy logic in the estimation of nonlinear dynamics due to unknown friction in TAB. By combining robust control with fuzzy logic regulated by an adaptive method, satisfactory performance can still be achieved under unknown time-varying friction and external perturbations.

3) The asymptotic stability of the closed-loop system is rigorously proven stable using the Lyapunov method, and the effectiveness and robustness of the controller under perturbations are verified through simulation experiments.

The rest of this paper is arranged as follows: Section 2 introduces the problem formulation including the dynamics model of the TAB system and control objective. Next, A robust fuzzy-based controller is given in Section 3 with the Lyapunov stability analysis in Section 4. Then, Section 5 describes the simulation results and analysis of the proposed method. Finally, Section 6 provides the conclusion of this research.

2 Problem formulation

In this paper, the control problem for the bending motion of the TAB system was focused on. As shown in Figure 2, TAB consists of two sections of soft materials with different elastic modulus, and two symmetrically distributed actuators are built in as tendons. To facilitate the analysis of the dynamics, the bending tip is assumed to be a part of a constant curvature arc. Then, based on the Lagrangian theory, the dynamics model of the TAB system can be depicted as the following form as studied in Wang et al. (2023):

M(α)α¨+C(α,α˙)α˙+G(α)=μ-Ff    (1)

where M(α), C(α,α˙), G(α) represent the inertia matrix, centripetal and Coriolis force, and the gravitational force, respectively. The detailed physical meaning of parameters in Equation (2) are given in Table 1. μ represents the input control, Ff denotes the unknown friction. M(α), C(α,α˙), G(α) in Equation (1) are depicted, respectively, as follows:

M(α)=mLf23α2, C(α,α˙)=-mLf2α˙3α3, G(α)=5πED4α64Lf    (2)

where α, α˙, Lf, D, m, and E represent the bending angle, the bending angular velocity, the length, the diameter, the mass of the bending part, and Young's modulus of the scope's epidermis, respectively. For simplicity, the term M(α), C(α,α˙), and G(α) will be abbreviated as M, C and G respectively. According to Equation 2, it can be found that they satisfy the following properties.

Figure 2
www.frontiersin.org

Figure 2. The driving principle of TAB system.

Table 1
www.frontiersin.org

Table 1. Nomenclature and symbols in nominal dynamics model.

Property 1. In this paper, α is the system output, and M(α) is positive and bounded, which can be described as follows:

x1>0,x2>0,x1M(α)x2    (3)

Property 2. In Equation 2, M(α) and C(α,α˙) are associated and satisfy

αRn,12M˙(α)-C(α,α˙)=0    (4)

It is generally accepted that certain models take major friction effects into account, notably encompassing Coulomb friction and Stribeck effects in tandem, with the aim of achieving a more precise representation of friction. Regrettably, owing to the material creepage and the time-varying contact force between the tendon and the sheath, attaining a precise description of friction distribution in TAB solely reliant on existing models is a formidable challenge (Zhang et al., 2017; Norouzi-Ghazbi and Janabi-Sharifi, 2020; Yin et al., 2022). Moreover, the static controller struggles to effectively handle dynamic uncertainties caused by the bending of soft material. In practical application, the time-varying friction between the tendon and sheath is typically assumed to change slowly and without abrupt variations. Nevertheless, the friction Ff and model parameters M(α), C(α,α˙), G(α) are also unknown but bounded (UBB). The basic control task is to estimate dynamic parameters in real-time to achieve the tracking control of the bending part under the disturbances of unknown friction. Specifically, the control task can be quantified as follows:

limte(t)=limtα(t)-αd=0    (5)

where αd represents the desired angle.

3 Controller design

An angle control algorithm based on fuzzy adaptive sliding mode control is presented in this paper. In order to facilitate the subsequent procedure, from Equation 5, the angle tracking errors, angular velocity tracking errors, and angular acceleration tracking errors of the bending part are defined respectively as follows:

e=αd-αe˙=α˙d-α˙e¨=α¨d-α¨    (6)

where α¨, αd, α˙d and α¨d represent the angular acceleration, desired angle, angular velocity, and angular acceleration, respectively. An intermediate variable α˙a is defined as follows:

α˙a=α˙d+c(αd-α)    (7)

where c is a known positive constant. From Equations 6 and 7, the sliding surface is defined as follows:

s=e˙+ce=α˙a-α˙    (8)

Then, the derivative of the sliding mode variable is derived as follows:

s˙=e¨+ce˙=α¨a-α¨    (9)

From Equation 1, the dynamics model can be written as follows:

α¨=M-1(μ-Cα˙-G-Ff)    (10)

From Equations 810, it can be presented as follows:

Ms˙=Mα¨a-Mα¨      =Mα¨a-μ+Cα˙+G+Ff      =-Cs-μ+Ff+Mα¨a+Cα˙a+G    (11)

The unknown dynamics in Equation 11 is defined as a nonlinear function P=Mα¨a+Cα˙a+G. Then, it can be simplified that

α¨a=M-1(P-Cα˙a-G)    (12)

The fuzzy approximation is widely recognized as an effective technique to estimate the nonlinear and uncertainty of the system in robot control, owing to its strong capability for approximations and fault tolerance (Zhao et al., 2023). In this article, the problem of time-varying dynamics and unknown friction in TAB can be effectively solved by constructing a fuzzy system to approximate the intricate nonlinear dynamics and utilizing a model-free sliding mode control scheme.

Lemma 1. The nonlinear dynamics P can be approximated by the constructed fuzzy system with reasonable errors, it is expressed as the following continuous equation (Wang, 1994).

P=θ*Tϕ(ξ)+ε    (13)
|ε|εU    (14)

where θ* represents adaptive weight vector, ϕ(ξ) is the fuzzy basic function, ε is the approximation error, εU represents the upper boundary of fuzzy approximation errors. Define input states of fuzzy system as x=[α;α˙]T, then fuzzy basic function ϕ(ξ) is constructed as follow:

ϕ(ξ)=ϕl1l2(x)=i=12μAili(xi)l1=1lMl2=1lN(i=12μAili(xi))    (15)

where li(i = 1, 2) represents the number of membership, lM and lN represent the maximum number and the minimum number of membership, respectively, Aili is Fuzzy set of input variables xi, μAili(xi) represents the membership function of input variables xi(i = 1, 2).

According to the former description of the friction between tendon and sheath, the sampling time can be selected small enough to reduce the estimation errors to ensure the validity of the method (Elmali and Olgac, 1996; Wu et al., 2019). The unknown friction is estimated by the following equation:

F^f=μt-T-Mα¨-Cα˙-G    (16)

where F^f represents the estimated friction, μtT is control input in the previous time step. The estimation errors F~f are described as F~f=Ff-F^f. As a result, it is reasonable to assume that the estimated errors are bounded, and the boundary can be given as follows:

|F~f|<ρ    (17)

where ρ is a positive constant representing the upper boundary. In order to solve the chattering problem, the saturated function sat(s) and the control law are elaborately designed as follows respectively:

sat(s)={1s>Δs/Δ|s|Δ-1s<-Δ    (18)
μ=θ^Tϕ(ξ)+F^f+a·s+b·sat(s)    (19)

where θ^ is the approximation value of θ*, a and b are two positive constants. And the approximation value θ^ will be estimated by the following update law:

θ^˙=Lϕ(ξ)s    (20)

where L is a known positive constant. By utilizing the designed controller 19 with update law 20, time-varying dynamics and unknown friction will be compensated in real-time. The overall block diagram of the proposed strategy is shown in Figure 3.

Figure 3
www.frontiersin.org

Figure 3. The block diagram of proposed controller.

4 Closed-loop stability analysis

TAB system with the proposed control law is asymptotic stable in the Lyapunov sense. The Lyapunov stability criteria was used to verify the closed-loop stability of the TAB system under the proposed adaptive fuzzy robust control strategy.

Proof. A Lyapunov candidate function is adopted as follows:

V=12(Ms2+L-1θ~Tθ~)    (21)

where the errors between the ideal value and approximation are represented as θ~=θ*-θ^. Differentiating Equation 21 and substituting Equations 10 and 11, for the ease of derivation, the auxiliary terms are added to the last two terms, V˙ can be arranged as:

V˙=Mss˙+12M˙s2-L-1θ~Tθ^˙   =Ms{α¨a-M-1(μ-Cα˙-G-Ff)}        -L-1θ~Tθ^˙+12M˙s2-Cs2+Cs2    (22)

According to the designed controller, based on Equation 16, by inserting Equations 19 into 22 it can be indicated as follows:

V˙=Ms{α¨a-M-1[θ^Tϕ(ξ)+a·s+b·sat(s)-Cα˙-G        +F^f-Ff]}-L-1θ~Tθ^˙+12M˙s2-Cs2+Cs2    (23)

Then, for eliminating time-varying model parameters M and G, according to Equations 1315, substitute Equations 12 and 13 for α¨ and P respectively, Equation 23 can be re-expressed as:

V˙=Ms{M-1(P-Cα˙a-G)-M-1[θ^Tϕ(ξ)+a·s+b·sat(s)        -Cα˙-G-F~f]}-L-1θ~Tθ^˙+12M˙s2-Cs2+Cs2   =Ms{M-1[θ*Tϕ(ξ)+ε-Cα˙a-G]-M-1[θ^Tϕ(ξ)+a·s        +b·sat(s)-Cα˙-G-F~f]}-L-1θ~Tθ^˙+12M˙s2-Cs2+Cs2   =s[θ*Tϕ(ξ)-θ^Tϕ(ξ)+ε-C(α˙a-α˙)-a·s        -b·sat(s)+F~f]-L-1θ~Tθ^˙+12M˙s2-Cs2+Cs2    (24)

Further simplification, by combining Equations 8 and the definition of θ~ to Equation 24, the added positive auxiliary term Cs2 is offset, V˙ can be derived as:

V˙=s[θ~Tϕ(ξ)+ε-Cs-a·s-b·sat(s)+F~f]-L-1θ~Tθ^˙+12M˙s2-Cs2+Cs2   =s[ε-Cs-a·s-b·sat(s)+F~f]+sθ~Tϕ(ξ)-L-1θ~Tθ^˙+12M˙s2-Cs2+Cs2   =s[ε-b·sat(s)+F~f]-(C+a)s2+sθ~Tϕ(ξ)-L-1θ~Tθ^˙+12M˙s2-Cs2+Cs2   =s[ε-b·sat(s)+F~f]-a·s2+sθ~Tϕ(ξ)-L-1θ~Tθ^˙+12M˙s2-Cs2    (25)

After that, by substituting update law Equation 20, and according to Property 1 and Property 2, i.e. Equations 3 and 4 the last four terms will be eliminated, and Equation (25) is deduced as:

V˙=s[ε-b·sat(s)+F~f]-a·s2    (26)

Finally, a is a positive constant, and according to Equations 17, 18, Equation 26 can be expressed as follows:

V˙s[ε-b·sat(s)+F~f]   |s|[|ε|+|F~f|-b·sat(|s|)]   |s|(|ε|+ρ-b)    (27)

If the positive gain b satisfies

b|ε|+ρ    (28)

By inserting Equations 28 into 27, V˙ is obtained as

V˙0    (29)

Equations 21 and 29 indicate that the chosen Lyapunov candidate V is positive definite, and V˙ is negative definite. As a result, the asymptotic stability of the TAB system under the proposed control law has been proved. The angle-tracking errors gradually converge to 0 and approach the sliding surface (i.e., s = 0) in finite time.     

5 Simulation and analysis

In this section, simulation experiments and results are provided to validate the performance of the proposed control scheme. Firstly, three different tracking trajectories are designed to evaluate the tracking performance of the control scheme. Then, experiments on varying-friction with and anti-disturbance experiments are conducted to compare the performance and robustness of the proposed scheme with the standard PID controller, sliding mode-PI (SMPI) controller, and linear quadratic regulator (LQR) controller. The reason for choosing PID-based methods and LQR as the controllers for comparison is because they have been widely applied and demonstrated good performance in the field of robotic flexible endoscope (Jiang et al., 2020; Kong et al., 2023). It should be pointed out that the three comparative control methods have been modified according to the dynamics model of this paper, and the control gains have been correspondingly adjusted by trial and error to guarantee tracking accuracy. The three controllers and their elaborately tuned control gains are adopted as follows respectively:

1. Standard PID controller

μ=Kpe+Kiedt+Kde˙    (30)

where Kp, Ki, Kd are positive gains. After appropriate optimization adjustments, they are selected as Kp = 1000, Ki = 3000, Kd = 200.

2. SMPI controller

s=e˙+ceμ=Ksps+Ksisdt    (31)

where e = αd − α, c, Ksp and Ksi are positive gains. They are chosen as c = 1.5, Ksp = 3, Ksi = 3000.

3. LQR controller

J=0eTQe+μTRμdtμ=-Ke    (32)

where e = [e, ė]T, Q and R are weighting matrix. They are selected as Q = diag{1, 20}, R = diag{0.01}.

5.1 Tracking experiments in different cases

To validate the effectiveness of the proposed control algorithm, a series of numerical simulations were carried out in a MATLAB/Simulink environment. To ensure the fidelity of the simulation, parameters in the dynamics model were selected to align with the actual material parameters of the real TAB system, as presented in previous work (Wang et al., 2023).

m=0.01kg, E=500Pa, D=0.003mLf=0.15m, α(0)=5 deg    (33)

Then, to achieve satisfactory tracking performance, the control gains in Equations 19 and 20 are elaborately tuned as:

a=5,b=2,c=2,L=2    (34)

Considering both computational accuracy and computational cost, the membership function of each state is set to 5 fuzzy subsets corresponding to its value range. Then, the fuzzy logic system with 2 input states α and α˙ can produce 25 fuzzy rules. Based on the operational constraints of α and α˙ applied in real robotic flexible endoscope, the Gaussian membership functions are selected as follows respectively by trial and error.

{f(α,σ1,vi)=e-(α-vi)22σ12f(α˙,σ2,wi)=e-(α˙-wi)22σ22    (35)

where σ1, σ2, vi and wi (i = 1, 2, 3, 4, 5) are prechosen coefficients. The values of them are selected as σ1=1.39,σ2=0.93,vi=[5(9-π)2,5(18-π)4,22.5,5(18+π)4,5(9+π)2],wi=[5π3,5π6,0,-5π6,-5π3].

Remark 1. In this article, the parameters in the control law are tuned by trial and error to guarantee optimal performance. Fine-tuning a and c will reduce response time, L is closely associated with the steady-state error of the system, and proper b can effectively prevent system oscillations or overshoot. Parameters in fuzzy logic are empirically tuned by trial and error to ensure the accuracy of approximation. σ1 and σ2 influence the shape of the membership functions, thereby affecting the results of fuzzy inference. vi and wi are empirically partitioned into equal intervals based on the operational range.

To verify the tracking performance of the proposed controller, three different tracking cases are chosen as follows:

1) Case 1: (step trajectory) The amplitude of the step trajectory is set as 20 deg.

2) Case 2: (sine trajectory) The frequency, the initial phase, the amplitude, and the offset of the desired sine trajectory are set as π rad/sec, 0 deg, 5 deg, and 15 deg, respectively.

yd(t)=5sin(t)+15    (36)

3) Case 3: (triangular-wave trajectory) The frequency, amplitude, and offset of the desired triangular-wave trajectory are set as 0.1 Hz, 7.5 deg, and 17.5 deg, respectively.

In Tracking experiments: Case 1, the parameters of the proposed method are set as in Equations 33 and 34. Also, the initial and target angles are set to 5 deg and 20 deg respectively. The simulation results of Tracking experiments: Case 1 are shown in Figure 4, the desired angle can be reached quickly within 3 s by adopting the proposed controller without overshoot or oscillation, demonstrating the regulation performance of the proposed control scheme. In contrast, comparative methods, i.e. Equations 3032 take more time to be steady and are accompanied by oscillating and residual errors.

Figure 4
www.frontiersin.org

Figure 4. Simulation results in Tracking experiment: Case 1 (reference values-blue solid line; proposed controller-orange dashed line; PID controller-yellow dotted line; SMPI controller-green dash-dot line; LQR controller-purple solid line).

In Tracking experiments: Case 2, to further confirm the tracking performance of the proposed method, the same parameters are set as Case 1. The initial angle and desired trajectory are set to 5 deg and Equation 36, respectively. The results of Tracking experiments: Case 2 are given in Figure 5, the angle errors can be quickly converged to 0 within 3 s without overshoot or oscillation by adopting the proposed control method. In contrast, as shown in Figure 5, comparative methods take a longer time to achieve the desired trajectory, and there are obvious overshooting and oscillations. Therefore, the simulation results show that the proposed method has a faster response and smaller steady-state errors than comparative controllers.

Figure 5
www.frontiersin.org

Figure 5. Simulation results in Tracking experiment: Case 2 (reference values-blue solid line; proposed controller-orange dashed line; PID controller-yellow dotted line; SMPI controller-green dash-dot line; LQR controller-purple solid line).

The simulation results of Tracking experiments: Case 3 are shown in Figure 6, the bending-tip can reach the desired trajectory within 3 s by using the proposed control method. For comparative methods, the response time is longer. Besides, oscillations still exist for comparative methods at 5, 10, and 15 s. In contrast, the proposed method guarantees regulation stability without any residual errors. Therefore, the simulation results of three different cases in tracking experiments show that the proposed method has satisfactory tracking performance and acceptable steady response.

Figure 6
www.frontiersin.org

Figure 6. Simulation results in Tracking experiment: Case 3 (reference values-blue solid line; proposed controller-orange dashed line; PID controller-yellow dotted line; SMPI controller-green dash-dot line; LQR controller-purple solid line).

5.2 Varying-friction experiment

In order to test the dynamic adaptability of the proposed controller, in this experiment, the friction force is set as a time-varying signal with constant amplitude and varying offset for simulating the switching of working conditions. Three bounded sets of unidentified friction, each representing different working conditions due to different ranges were employed. It is worth mentioning that the form of friction in this experiment is just selected as an example, the controller proposed in this paper only requires the friction force to be bounded without a specific model, which is a contribution of this paper. The specific form of friction force is as follows:

Ff={sint0t<6.28sin(t+π/2)-16.28t<12.56sin(t-π/2)+112.56t20    (37)

The simulation results of Varying-friction experiment are shown in Figure 7, the same parameters are set as in Tracking experiments: Case 3. As shown in Figure 7, the proposed method still achieves the desired trajectory rapidly and accurately without steady-state errors. In contrast, the PID controller and SMPI controller have obvious oscillations near 6.28 s and 12.56 s, and the LQR controller has a much slower transient response. In consequence, the proposed method can effectively cope with varying friction Equation 37 under different working conditions.

Figure 7
www.frontiersin.org

Figure 7. Simulation results in Varying-friction experiment (reference values-blue solid line; proposed controller-orange dashed line; PID controller-yellow dotted line; SMPI controller-green dash-dot line; LQR controller-purple solid line).

5.3 Anti-disturbance experiment

To verify the robustness of the controller suffering episodic disturbances in the unstructured environment, a constant external force of 1N lasting 1 second is added at the 10th second on the basis of Tracking experiments: Case 1, and the simulation results of Anti-disturbance experiment are shown in Figure 8. The angle errors generated by external disturbances are less than 1 deg under the proposed controller, which returns to zero in 2 s. In contrast, the same disturbances under comparative methods excite larger amplitudes (LQR) and sharper force fluctuations (PID, SMPI). In summary, the proposed method is non-sensitive to disturbances and fast-tracking of the desired trajectory without steady-state errors. As a result, it is possible to conclude with certainty that the proposed controller has both excellent tracking performance and satisfactory robustness.

Figure 8
www.frontiersin.org

Figure 8. Simulation results in Anti-disturbance experiment (reference values-blue solid line; proposed controller-orange dashed line; PID controller-yellow dotted line; SMPI controller-green dash-dot line; LQR controller-purple solid line).

Remark 2. Although the method proposed in this paper achieves effective tracking and compensation of unknown bounded friction, there are still some limitations. One concern about the proposed controller is that the setting of fuzzy logic membership functions and fuzzy rules relies on empirical knowledge and requires considerable effort to tune for satisfactory performance. It is worth mentioning that reinforcement learning has demonstrated significant performance in finding optimal control policy in recent years (Goharimanesh et al., 2020). As a consequence, fuzzy control based on reinforcement learning is poised to become a further improvement for our method in the future.

6 Conclusions

Based on the Lagrangian dynamics model for the TAB systems, this paper proposed a robust controller for tracking tasks. Specifically, the nonlinear friction with consideration of its boundary is described according to the dynamics model of TAB. Then, the fuzzy logic system is used to achieve the estimation of nonlinear time-varying dynamics. At last, a sliding mode control method was designed, which achieved effective tracking performance and compensation of the unknown boundary friction. Lyapunov stability criteria was also utilized to prove the asymptotic stability of the proposed controller. Simulations are also carried out to validate the efficiency of the proposed method. The proposed method is model-free control and has no strict requirement for the dynamics model and friction model. It is proved that advanced tracking performance and real-time response can be guaranteed under the presence of unknown bounded nonlinear friction and time-varying nonlinear dynamics. In future research, we will further investigate the universal applicability of the proposed method in addressing unknown friction and its practical utilization in experiments involving flexible endoscope robots.

Data availability statement

The raw data supporting the conclusions of this article will be made available by the authors, without undue reservation.

Author contributions

FR: Data curation, Methodology, Software, Writing – original draft, Conceptualization. XW: Funding acquisition, Project administration, Supervision, Writing – review & editing. NY: Funding acquisition, Writing – review & editing. JH: Funding acquisition, Writing – review & editing.

Funding

The author(s) declare that financial support was received for the research, authorship, and/or publication of this article. This work was supported by National Key R&D Program of China (Grant No. 2022YFB4702800), National Natural Science Foundation of China (Grant No. 62303248), Guanddong Basic and Applied Basic Research Foundation (Grant Nos. 2024A1515010102 and 2023A1515110678), and China Postdoctoral Science Foundation Funded Project (Grant No. 2023M731804).

Conflict of interest

The authors declare that the research was conducted in the absence of any commercial or financial relationships that could be construed as a potential conflict of interest.

Publisher's note

All claims expressed in this article are solely those of the authors and do not necessarily represent those of their affiliated organizations, or those of the publisher, the editors and the reviewers. Any product that may be evaluated in this article, or claim that may be made by its manufacturer, is not guaranteed or endorsed by the publisher.

References

Berthet-Rayne, P., Leibrandt, K., Kim, K., Seneci, C. A., Shang, J., and Yang, G.-Z. (2018). “Rolling-joint design optimization for tendon driven snake-like surgical robots,” in 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) (Madrid: IEEE), 4964–4971.

Google Scholar

Burgner-Kahrs, J., Rucker, D. C., and Choset, H. (2015). Continuum robots for medical applications: a survey. IEEE Trans. Robot. 31, 1261–1280. doi: 10.1109/TRO.2015.2489500

Crossref Full Text | Google Scholar

Cui, Z., Huang, Y., Li, W., Chiu, P. W. Y., and Li, Z. (2024). Noise-resistant adaptive gain recurrent neural network for visual tracking of redundant flexible endoscope robot with time-varying state variable constraints. IEEE Trans Ind Electron. 71, 2694–2704. doi: 10.1109/TIE.2023.3270533

Crossref Full Text | Google Scholar

Do, T., Tjahjowidodo, T., Lau, M., and Phee, S. (2015a). Adaptive control for enhancing tracking performances of flexible tendon-sheath mechanism in natural orifice transluminal endoscopic surgery. Mechatronics 28, 67–78. doi: 10.1016/j.mechatronics.2015.04.002

Crossref Full Text | Google Scholar

Do, T., Tjahjowidodo, T., Lau, M. W. S., and Phee, S. J. (2015b). A new approach of friction model for tendon-sheath actuated surgical systems: nonlinear modelling and parameter identification. Mechan. Mach. Theory 85, 14–24. doi: 10.1016/j.mechmachtheory.2014.11.003

Crossref Full Text | Google Scholar

Do, T. N., Tjahjowidodo, T., Lau, M. W. S., and Phee, S. J. (2015c). “Enhanced performances for cable-driven flexible robotic systems with asymmetric backlash profile,” in 2015 IEEE International Conference on Technologies for Practical Robot Applications (TePRA) (Woburn, MA: IEEE), 1–6.

Google Scholar

Do, T. N., Tjahjowidodo, T., Lau, M. W. S., and Phee, S. J. (2016). “Adaptive tracking approach of flexible cable conduit-actuated notes systems for early gastric cancer treatments,” in Informatics in Control, Automation and Robotics: 11th International Conference, ICINCO 2014. (Vienna: Springer), 79–97.

Google Scholar

Elmali, H., and Olgac, N. (1996). Implementation of sliding mode control with perturbation estimation (smcpe). IEEE Trans. Control Syst. Technol. 4, 79–85. doi: 10.1109/87.481770

Crossref Full Text | Google Scholar

Goharimanesh, M., Mehrkish, A., and Janabi-Sharifi, F. (2020). A fuzzy reinforcement learning approach for continuum robot control. J. Intellig, Robot, Syst, 100, 809–826. doi: 10.1007/s10846-020-01237-6

Crossref Full Text | Google Scholar

Huang, Y., Li, J., Zhang, X., Xie, K., Li, J., Liu, Y., et al. (2022). A surgeon preference-guided autonomous instrument tracking method with a robotic flexible endoscope based on dvrk platform. IEEE Robot. Autom. Lett. 7, 2250–2257. doi: 10.1109/LRA.2022.3143305

Crossref Full Text | Google Scholar

Huang, Y., Li, W., Zhang, X., Li, J., Li, Y., Sun, Y., et al. (2024). 4-dof visual servoing of a robotic flexible endoscope with a predefined-time convergent and noise-immune adaptive neural network. IEEE/ASME Trans. Mechatron. 29, 576–587. doi: 10.1109/TMECH.2023.3286850

Crossref Full Text | Google Scholar

Jiang, S., Lou, J., Yang, Z., Dai, J., and Yu, Y. (2015). Design, analysis and control of a novel tendon-driven magnetic resonance-guided robotic system for minimally invasive breast surgery. Proc. Institut. Mech. Eng. Part H. 229, 652–669. doi: 10.1177/0954411915599018

PubMed Abstract | Crossref Full Text | Google Scholar

Jiang, W., Zhou, Y., Wang, C., Peng, L., Yang, Y., and Liu, H. (2020). Navigation strategy for robotic soft endoscope intervention. Int. J. Med. Robot. Comput. Assist. Surg. 16, e2056. doi: 10.1002/rcs.2056

PubMed Abstract | Crossref Full Text | Google Scholar

Jung, Y., and Bae, J. (2016). “Simulation analysis on friction compensation of a double tendon-sheath actuation system,” in 2016 13th International Conference on Ubiquitous Robots and Ambient Intelligence (URAI) (Xi'an: IEEE), 510–514.

Google Scholar

Kang, B. B., Kim, D., Choi, H., Jeong, U., Kim, K. B., Jo, S., et al. (2020). Learning-based fingertip force estimation for soft wearable hand robot with tendon-sheath mechanism. IEEE Robot. Autom. Lett. 5, 946–953. doi: 10.1109/LRA.2020.2966391

Crossref Full Text | Google Scholar

Kong, X., Mo, H., Dong, E., Liu, Y., and Sun, D. (2023). Automatic tracking of surgical instruments with a continuum laparoscope using data-driven control in robotic surgery. Adv. Intellig. Syst. 5, 2200188. doi: 10.1002/aisy.202200188

Crossref Full Text | Google Scholar

Lee, D.-H., Kim, Y.-H., Collins, J., Kapoor, A., Kwon, D.-S., and Mansi, T. (2021). Non-linear hysteresis compensation of a tendon-sheath-driven robotic manipulator using motor current. IEEE Robot. Autom. Lett. 6, 1224–1231. doi: 10.1109/LRA.2021.3057043

Crossref Full Text | Google Scholar

Legrand, J., Ourak, M., Javaux, A., Gruijthuijsen, C., Ahmad, M. A., Van Cleynenbreugel, B., et al. (2018). From a disposable ureteroscope to an active lightweight fetoscope characterization and usability evaluation. IEEE Robot. Autom. Lett. 3, 4359–4366. doi: 10.1109/LRA.2018.2866204

PubMed Abstract | Crossref Full Text | Google Scholar

Li, J., Huang, Y., Zhang, X., Xie, K., Xian, Y., Luo, X., et al. (2023). An autonomous surgical instrument tracking framework with a binocular camera for a robotic flexible laparoscope. IEEE Robot. Autom. Lett. 8, 4291–4298. doi: 10.1109/LRA.2023.3281934

Crossref Full Text | Google Scholar

Nguyen, T., Do, T., Lau, M., and Phee, S. (2014). “Modelling, design, and control of a robotic running foot for footwear testing with flexible actuator,” in Proceedings of the the 1th International Conference in Sports Science &Technology (ICSST) (Singapore: ICSST), 11–12.

Google Scholar

Norouzi-Ghazbi, S., and Janabi-Sharifi, F. (2020). Dynamic modeling and system identification of internally actuated, small-sized continuum robots. Mech. Mach. Theory 154, 104043. doi: 10.1016/j.mechmachtheory.2020.104043

Crossref Full Text | Google Scholar

Porto, R. A., Nageotte, F., Zanne, P., and Mathelin, M. (2019). “Position control of medical cable-driven flexible instruments by combining machine learning and kinematic analysis,” in 2019 International Conference on Robotics and Automation (ICRA) (Montreal, QC: IEEE), 7913–7919. doi: 10.1109/ICRA.2019.8793692

Crossref Full Text | Google Scholar

Rho, E., Kim, D., Lee, H., and Jo, S. (2021). Learning fingertip force to grasp deformable objects for soft wearable robotic glove with tsm. IEEE Robot. Autom. Lett. 6, 8126–8133. doi: 10.1109/LRA.2021.3102968

Crossref Full Text | Google Scholar

Thai, M. T., Phan, P. T., Hoang, T. T., Low, H., Lovell, N. H., and Do, T. N. (2021). Design, fabrication, and hysteresis modeling of soft microtubule artificial muscle (smam) for medical applications. IEEE Robot. Autom. Lett. 6, 5089–5096. doi: 10.1109/LRA.2021.3072599

Crossref Full Text | Google Scholar

Wang, L.-X. (1994). Adaptive fuzzy Systems and Control: Design and Stability Analysis. Hoboken: Prentice-Hall Inc.

Google Scholar

Wang, X., Bie, D., Han, J., and Fang, Y. (2020). Active modeling and compensation for the hysteresis of a robotic flexible ureteroscopy. IEEE Access 8, 100620–100630. doi: 10.1109/ACCESS.2020.2984424

Crossref Full Text | Google Scholar

Wang, X., Yu, N., Bie, D., Han, J., and Fang, Y. (2021). A novel esmf-based observer and control scheme for a type of tendon-sheath hysteresis system. Automatica 131, 109800. doi: 10.1016/j.automatica.2021.109800

Crossref Full Text | Google Scholar

Wang, X., Yu, N., Han, J., and Fang, Y. (2023). Modeling and adaptive control for tendon sheath artificial muscle actuated bending-tip systems with unknown parameters and input hysteresis: An experimental research. IEEE Trans Ind Electron. 70, 10588–10597. doi: 10.1109/TIE.2022.3219105

Crossref Full Text | Google Scholar

Wang, X., Zhang, Q., Shen, X., and Li, J. (2018). Noncollocated position control of tendon-sheath actuated slender manipulator. IEEE Trans. Control Syst. Technol. 28, 688–696. doi: 10.1109/TCST.2018.2884222

Crossref Full Text | Google Scholar

Wu, Q., Wang, X., Chen, B., and Wu, H. (2019). Neural network-based sliding-mode control of a tendon sheath-actuated compliant rescue manipulator. Proc. Instit. Mech. Eng. 233, 1055–1066. doi: 10.1177/0959651819825984

Crossref Full Text | Google Scholar

Wu, Q., Wang, X., Chen, L., and Du, F. (2014). Transmission model and compensation control of double-tendon-sheath actuation system. IEEE Trans Ind Electron 62, 1599–1609. doi: 10.1109/TIE.2014.2360062

Crossref Full Text | Google Scholar

Yin, M., Huang, B., Yi, Z., and Cai, S. (2022). Rbf network-based adaptive sliding mode control strategy for the tendon-sheath driven joint of a prosthetic hand. Technol. Health Care 30, 1155–1165. doi: 10.3233/THC-213242

PubMed Abstract | Crossref Full Text | Google Scholar

Yin, M., Xu, Z., Zhao, Z., and Wu, H. (2020). Mechanism and position tracking control of a robotic manipulator actuated by the tendon-sheath. J. Intellig. Robot. Syst. 100, 849–862. doi: 10.1007/s10846-020-01245-6

Crossref Full Text | Google Scholar

Zhang, L. A., Khare, R., Wilson, E., Wang, S. X., Peters, C. A., and Cleary, K. (2014). “Robotic assistance for manipulating a flexible endoscope,” in 2014 IEEE International Conference on Robotics and Automation (ICRA)I (Hong Kong: IEEE), 5380–5385.

Google Scholar

Zhang, Q., Wang, X., Tian, M., Shen, X., and Wu, Q. (2017). Modeling of novel compound tendon-sheath artificial muscle inspired by hill muscle model. IEEE Trans Ind Electron 65, 6372–6381. doi: 10.1109/TIE.2017.2784377

Crossref Full Text | Google Scholar

Zhao, W., Liu, Y., and Yao, X. (2023). Adaptive fuzzy containment and vibration control for multiple flexible manipulators with model uncertainties. IEEE Trans. Fuzzy Syst. 31, 1315–1326. doi: 10.1109/TFUZZ.2022.3199573

Crossref Full Text | Google Scholar

Keywords: tendon-sheath mechanism, fuzzy control, friction compensation, robust control, robotic flexible endoscope

Citation: Ren F, Wang X, Yu N and Han J (2024) Adaptive fuzzy control for tendon-sheath actuated bending-tip system with unknown friction for robotic flexible endoscope. Front. Neurosci. 18:1330634. doi: 10.3389/fnins.2024.1330634

Received: 31 October 2023; Accepted: 11 March 2024;
Published: 26 March 2024.

Edited by:

Yingbai Hu, The Chinese University of Hong Kong, China

Reviewed by:

Rong Song, Sun Yat-sen University, China
Yisen Huang, The Chinese University of Hong Kong, China

Copyright © 2024 Ren, Wang, Yu and Han. This is an open-access article distributed under the terms of the Creative Commons Attribution License (CC BY). The use, distribution or reproduction in other forums is permitted, provided the original author(s) and the copyright owner(s) are credited and that the original publication in this journal is cited, in accordance with accepted academic practice. No use, distribution or reproduction is permitted which does not comply with these terms.

*Correspondence: Xiangyu Wang, wangxyu@nankai.edu.cn

Disclaimer: All claims expressed in this article are solely those of the authors and do not necessarily represent those of their affiliated organizations, or those of the publisher, the editors and the reviewers. Any product that may be evaluated in this article or claim that may be made by its manufacturer is not guaranteed or endorsed by the publisher.