T-S Fuzzy-Based Optimal Control for Minimally Invasive Robotic Surgery with Input Saturation

A minimally invasive surgery robot is difficult to control when actuator saturation exists. In this paper, a Takagi-Sugeno fuzzy model-based controller is designed for a minimally invasive surgery robot with actuator saturation, which is difficult to control. The contractively invariant ellipsoid theorem is applied for the actuator saturation. The proposed scheme can be derived using the H-infinity control theorem and parallel distributed compensation. The result is rebuilt in the form of linear matrix inequalities for easier calculation by computer. Meanwhile, the uniformly ultimately bounded stable and the prescribed H-infinity control performance can be guaranteed. The proposed scheme is simulated in a Novint Falcon haptic device system.


Introduction
In minimally invasive robotic surgery, the work space is limited precisely.The mechanical structure and the electrical characteristics can be additional constraint boundaries for system inputs and outputs.Therefore, the controller of the surgery robot has a rigid input saturation requirement.However, if input saturation occurs, the output performance of the controlled object cannot satisfy the designed requirement, which can result in the decline of the closed-loop system response.The output overshoot cannot be suppressed well, even becoming unstable [1,2].This situation is prohibited in a minimally invasive robotic surgery.
Many researchers investigated the input saturation problem and provided some solutions.Buckley [3] proposed an anti-reset windup method for the integral saturation problem.The error between the controller output and object input was used as a complementary feedback for the controlled system.Hanus et al. [4] proposed the condition technique, where the controller output continuously tracks for a new reference input and is located out of the saturation area to avoid the saturation case.The pole-placement method was applied to the antiwindup control, which assigns the poles of nonlinear system in the desired disk for stable analysis in [5].Although the variable structure antiwindup controller showed a good performance in the integrator windup case [6], some preset parameters were needed that were difficult to determine because expert knowledge was required.Some antiwindup controllers were also based on observer [7], internal model control [8], saturation feedback control [9], and dynamic complement [10].
The T-S fuzzy theorem, which is an important part of the fuzzy control theorem, was proposed by Takagi and Sugeno in 1985 [11].It is utilized in both system stable control and model identification [11,12].Specifically, it has a good performance in nonlinear system control [12].The T-S fuzzy model, which is the summation of the product of the T-S fuzzy local models and their corresponding membership functions, can approximate the nonlinear system under an arbitrary degree of accuracy [12].The T-S fuzzy model is nonlinear, and its controller design is difficult.Consequently, a procedure called parallel distributed compensation (PDC) makes the T-S fuzzy controller design easier.PDC was proposed by Wang et al. in 1995 [13].The fuzzy sets of the PDC controller are similar with the fuzzy model.Under each controller rule, a controller can be designed for the local T-S model.By summation of the product of these controllers and their corresponding membership functions, the total controller of a nonlinear system can be represented.System stability is usually considered by the Lyapunov function.Although PDC provides a design procedure for the T-S fuzzy controller, the calculation of controller gains for global stability is still difficult, particularly in the presence of many controller rules.A numerical optimization method called linear matrix inequalities (LMIs) solved this kind of problem.LMI was defined by Willems in 1971 [14].Neestorv and Nemirovskii [15] proposed an interior point method, which can directly solve the LMI convex optimization problem.LMI was first applied to the T-S fuzzy system stabilization analysis in [16].In the succeeding years, LMI became the focus of increasing number of researchers [17].Except for a few special cases without analytical solution, LMIs are generally efficient [11].Furthermore, the LMI toolbox software provides a direct shortcut to the computer solution of LMIs.Because PDC and LMIs provide a better T-S fuzzy system controller design, they are applied in the proposed controller design in this paper.
For the advantage of the T-S fuzzy theorem, it was widely used to deal with the actuator saturation problem.In [18], based on the T-S fuzzy model, a robust dissipative controller was designed for the multiple-input multipleoutput (MIMO) system with saturated time-delay input and parameter uncertainty.Their results show that the closedloop system can be stable, but the stabilization time cannot be guaranteed.For this problem, [19,20] provided a finitetime control by optimal control and estimated the attraction domain.The combination of the T-S fuzzy model and optimal control show an animated controller design of a nonlinear system with actuator saturation [21].For optimal control, Hu et al. [22] provided a useful control method for the saturation system with actuator saturation based on a contractively invariant ellipsoid.This study was continued in her work by BMIs [8].Consequently, many researchers focused on actuator saturation problems, where the T-S fuzzy based controller design method was popular.The Lyapunov stability criterion-based PDC fuzzy controller was designed for the actuator saturation system [23,24].Many researchers contributed in completing this theorem [25,26].In this paper, the result in Hu et al. [22] was adopted and rebuilt into a set of LMIs.Meanwhile, a predetermined H ∞ norm was satisfied.
This paper is organized as follows.The basic T-S fuzzy theorem is presented in Section 2. The proposed solution for the actuator saturation problem is presented in Section 3. The simulation is presented in Section 4. The paper concludes in Section 5.

General T-S Fuzzy Model and Control
In this paper, the considered nonlinear system with disturbance W t is , and W t ≤ W b and W b is the boundary of disturbance.In the T-S fuzzy model, the premise variables of the T-S fuzzy rules must be measurable, and they can represent some properties of the nonlinear system.Therefore, a suitable selection of these variables is very important for the accuracy and reliability of the T-S fuzzy model.When the T-S fuzzy premise variables have been defined, a corresponding local model can be provided by these variable values.The ith rule of the T-S fuzzy system for a nonlinear system is as follows: The ith rule: If are the premise variables, and M i1 , … , M ip are the fuzzy sets.
The nonlinear system can be approximated by the overall T-S fuzzy system where t is the grade of the membership of z j t in M ij .Note that the membership function should satisfy the following equation: Currently, the nonlinear system of ( 1) is changed to the T-S fuzzy model (3).Because the local T-S model of ( 2) is linear, its feedback controller can be designed easily as where K j ∈ R m×n and j = 1, 2, … , L. By PDC and similar fuzzy rules of (2), the overall T-S fuzzy controller is designed as

H ∞ Robust Controller Design for Input Saturation
The traditional T-S fuzzy theorem cannot provide results in the control problem for a nonlinear system with input saturation.In this study, the proposed method can solve the input saturation problem.The controlled closed-loop system can be uniformly ultimately bounded (UUB) stable, and the prescribed H-infinity norm can be guaranteed.Furthermore, the result is shown in LMIs, which can be directly solved by programming.
Considering the saturation and uncertainty, the nonlinear system of (1) can be where b > 0, is the boundary value of the saturation function, and the other symbols are similar with (1).Following (3), the T-S fuzzy model can be where Based on the work of Hu et al. [1], for the feedback controller, U j t = K j X t , if the ellipsoid ε P, 1 is contractively invariant, and matrixes P > 0, K i , and H (m × n matrix) make the initial value of X 0 ∈ ε P, 1 and where D r is an m-by-m diagonal matrix (diagonal elements are 0 or 1) and D − r = I − D r with r ∈ 1, 2 m .If it is only applied to the T-S fuzzy local model, the global stability of the nonlinear system cannot be satisfied.For global stability, some changes are needed.By ( 7) and ( 9), the nonlinear system with disturbance is as follows: Equation ( 12) can be guaranteed if each D r satisfies the following inequality: where , and B t can be found and satisfy the following inequality: where H ∞ control performance is defined as

Journal of Sensors
where t f is the terminal time, Q is a positive-definite matrix, and ρ is the prescribed H ∞ norm, which is greater than 0 and less than 1.If ρ is minimized, the effect of W t on X t is minimized.Considering the initial condition, (17) can be changed as where P is some symmetric positive-definite weighting matrix.Set the Lyapunov function as where P > 0. For simplicity, (t) is omitted in the following sections.Then, the following theorem can be obtained.
Theorem 1.Under condition (11), if controller ( 12) is applied to a nonlinear system (7) and there exists a positive-definite matrix P > 0, such that the following matrix inequalities are satisfied for each i, j, and r, then the closed-loop system is UUB, and the H ∞ control performance (18) is guaranteed as prescribed ρ 2 .Proof 1.Using ( 14), the derivative of V t is

22
Under the ith rule, if there is where Q i > 0 and ∑ L i=1 h i Q i > 0, there is ) can be the H ∞ control performance defined in (17).Therefore, for each simulation time, the H ∞ control performance defined as ( 17) can be guaranteed.Then, in the total simulation, a prescribed H ∞ norm can be guaranteed.Meanwhile, ( 18) can be as follows: By integrating ( 27), the following result can be obtained: The Lyapunov function ( 19) can be 0 when the system is stable.Therefore, The above equation is the H ∞ performance defined in (25), which satisfies (18).Note that the H ∞ norm is changed to ρ 2 .
End of proof.
In Theorem 1, it is difficult to find the solution for (20).Therefore, the transformation of inequality (20) into LMIs is necessary.By setting R = P −1 and left and right multiplication of R, (20) can be Schur complements, (30) can changed as and Ĥ j are unknown.Condition ( 11) is equal to where Ĥik is the kth row of Ĥi .Therefore, the following theorem is given.

33
then the closed-loop system is UUB and the H ∞ control performance ( 18) is guaranteed as prescribed ρ 2 .
By this theorem, the H ∞ optimization problem can be changed to a constrained optimization problem by LMIs.

Numerical Example
In minimally invasive surgery, haptic tracking is very important.Novint Falcon is a simple arm robot with force feedback ability, which benefited from parallel architecture, and can be applied in minimally invasive surgery.The Novint Falcon structure is shown in Figure 1.
The Novint Falcon consists of the base, motion platform, and 3 chains.The single chain can be abstract presented in Figure 2.
Based on [27] and ignoring some nonessentials, the ith chain dynamic equation is where τ = τ 1 , τ 2 , τ 3 T is the moment of driving force for each link; θ = θ 1i , θ 2i , θ 3i T is shown in Figure 2; , where I T is the moment of inertia and m b and m c are masses of links b and c; H θ, θ is the Jacobian matrix; J i1 = cos θ 2i sin θ 3i cos ϕ i − cos θ 3i sin ϕ i , J i2 = cos θ 3i cos ϕ i + cos θ 2i sin θ 3i sin ϕ i , J i3 = sin θ 2i sin θ 3i , α i = sin θ 2i − θ 1i sin θ 3i , and ϕ are the angle between the chain and the coordinate frame (x, y, z).Because the exact parameters are difficult to determine, set I T and M g as identity matrices and 3m b + m c = 1 in this example.This is reasonable in this paper because the error between the actual value and the required value can be distributed in the disturbance or parameter uncertainty for this system.Therefore, the matrix D θ is invertible.Set θ 1i = x 1 t , θ 2i = x 2 t , θ 3i = x 3 t , τ = u t , and

36
The θ of the other chains are set to be closed to require values, and the errors are distributed in the disturbance.Therefore, the system (34) can be as follows: where

Journal of Sensors
A max θ 1i , min θ 2i , min θ 3i , and A 8 = A min θ 1i , min θ 2i , min θ 3i ; B i is calculated similarly, and E is treated as a disturbance.Although A i depends on θ, the values of max θ and min θ do not depend on the system input.Therefore, they can be used for the fuzzy rule definition.Set θ 1i ∈ 0, 0 7854 , θ 2i ∈ 0, 0 7854 , and θ 3i ∈ 1 9199, 2 2689 .
Sat u t = sgn u t ⋅ min u t , 10 .The H ∞ norm is 0.3.The reference value is x 1r x 2r x 3r x 4r x 5r x 6r = 0 7 0 7 2 2 0 0 39 Using Theorem 2, the error system feedback controller gains can be calculated as follows: To test the robustness of the controller, a disturbance is added in (38).For comparison, a controller designed by Theorem 2 of [18] is applied.In [18], the controller was designed for the system with input saturation and disturbance.If the time delay is ignored in [18], its results can be applied in this example.The simulation results are shown in the following figures.
From Figures 3-5, less overshooting can be observed compared with the reference paper.The proposed controller performed well with input saturation, and the H ∞ performance can be achieved.

Conclusion
In this paper, the T-S fuzzy control theorem and the ability of contractively invariant ellipsoid were applied for nonlinear systems with input saturation.The proposed method was The proposed theorem was tested using the Novint Falcon, and a good result was achieved.Comparing the results, the proposed method of this paper has given a better result.Meanwhile, the prescribed H-infinity norm was satisfied.In the example, only eight rules of the T-S fuzzy system were applied; there were still more than one hundred LMIs that need to be calculated.Although a feasible solution of the LMIs can be guaranteed using the proposed method, a method with less LMIs is still necessary for further study.

Figure 3 :
Figure 3: The error of x 1 .
Considering actuator saturation, the corresponding ith fuzzy rule is as follows: