Abstract

This paper focuses on the position/force tracking control problem for constrained multiple flexible joint manipulators system with nonlinear input of hysteresis loop. Firstly, the dynamic model is given in the task space and the input of hysteresis loop model is approximated by a differential equation. Secondly, considering the disturbance with unknown bounds, a robust adaptive control strategy based on the sliding mode which consists of constraint force error and position error is designed. The proposed approach can not only compensate the model error, external disturbance, and flexible parameter uncertainties, but also drive the closed-loop system variables to reach the sliding model surface. Then it can be proved that both position and constraint force errors can be guaranteed to converge to zero. Finally, the simulation results can verify the effectiveness of the proposed method.

1. Introduction

The position and force control of the multiple manipulators system have been widely concerned in recent years [1, 2]. Although the multiple manipulators system, adapted to the complex industrial environment, has great advantages for grasping the heavier object, it also has many complex control problems such as parametric uncertainty and gear clearance.

For the position/force control problem, many control strategies have been proposed for single manipulator system. A sliding mode variable structure control was designed to drive the closed-loop system states to reach the adopted sliding model surface in [3]. To deal with the force tracking problem, a new adaptive sliding mode control based on a sliding mode consisting of force error was proposed in [4], in which the controller can guarantee the asymptotic convergence of the position and force errors. To discuss the time delay, an adaptive position/force control based on the backstepping for flexible joint manipulator with time delay was investigated in [5]. Many robot control strategies have been proposed for the weak flexible joint robots system [6, 7]. A singular perturbation (SP) analysis was proposed to guarantee the stability of system in [8], but it cannot ensure the stability for the strong flexible joint manipulators system. Based on the backstepping method, a robust adaptive control strategy was proposed for the unknown joint stiffness and unknown motor inertia in [9]. A new method for flexible joint robots with model uncertainties in both robot dynamics and actuator dynamics was presented in [10], in which the uniformly ultimate boundedness in a closed-loop adaptive system was proved. Considering the position and force control issues of constrained flexible joint robots with parametric uncertainty, a new adaptive and sliding mode control scheme was developed in [11]. In order to compensate the uncertainty caused by the model error, robust control, adaptive control, and neural network control were adopted in [1214]. But only the single flexible joint manipulator system was considered in the above researches, while the multimanipulators system with object was not considered.

For the multiple manipulators system, the main control approaches can be classified into two directions: the master-slave control [15] and the hybrid position/force control [16]. Compared with the master-slave control, the task space can be decomposed into two orthogonal subspaces, where the position of the object was controlled in a certain direction of the workspace and the force was controlled in the other direction. A decentralized adaptive fuzzy control scheme was presented in paper [17], and position error and internal forces error can be can be guaranteed to converge zero. An adaptive position/force control of coordinated multiple manipulators based on a new sliding mode was presented in the paper [18]. Considering the time delay, a robust adaptive control strategy based on a sliding mode is designed for the motion synchronization of multiple flexible joint manipulators with time delay in [1].

Due to the running for a long time in the actual system, the gear clearance of joint manipulators will occur which will influence system tracking performance. The performance of the gear clearance can be described by a hysteresis loop as in Figure 1.

It is well known that the stability of the system cannot be guaranteed and the system will have a poor tracing performance as a result of the existence of gear clearance.

Considering the existence of gear clearance in the multiple manipulators system, we proposed a robust adaptive control strategy based on a sliding mode to overcome the gear clearance. The performance of the gear clearance can be described by a hysteresis loop whose model is approximated by a differential equation. Then, the dynamic model including a hysteresis loop is obtained. It is proved that the controller can not only guarantee the stability of system, but also guarantee that the position and constraint force errors asymptotically converge to zero. Finally, the simulation results illustrate the validity and the feasibility of the proposed method in this paper.

2. Dynamical Model

Consider flexible joint manipulators holding a rigid object moving along constraint surface. To facilitate the study, the following assumptions are made.

Assumption 1. The number of degrees of freedom and the number of joints are equal for each manipulator, the objects are rigid, and the joints are flexible.

Assumption 2. The system for each manipulator is nonredundant.

Assumption 3. All transformation matrices are of full rank.

2.1. Dynamic Modeling of Multiple Flexible Joint Manipulators

The dynamic equations of flexible joint manipulators with the disturbance can be described as follows [19]:where is the manipulator number, are the joint position, joint velocity, and joint acceleration of the manipulator, is the inertia matrix, are the centrifugal and Coriolis forces, is the gravity matrix, is the Jacobian matrix from the end-effector to joint space, is the force exerted on the object by the end-effector, is the input control torque for manipulator, is the motor shafts angle, is the symmetric positive definite inertia matrix of the actuator, is the joint stiffness matrix, is the input torque of the manipulator, are the transmission torques, and is the vector of the motor torques.

Utilizing block diagonal metrics, then we have the dynamic equation as follows:where

2.2. The Dynamic Model of the Object

The dynamic model of the object can be obtained by the Newton-Euler method:where is the position of object, is the inertia matrix, are the centrifugal and Coriolis forces, is the gravity matrix, is the Jacobian matrix from end-effectors to the center of mass of object, is the force exerted on the object by end-effector, is the external force which contributes to the motion of object, and is the constraint force exerted on the object by end-effector.

Based on Assumptions 13, the environmental constraint can be expressed as where , constraint surface is holonomic and frictionless, and is twice continuously differentiable.

Differentiating (8) with respect to time:where donate the Jacobian matrix from the object coordinates to the constraint surface contact coordinates.

Then the constraint force of the object can be expressed as follows:where donate the generalized Lagrange multiplexer.

The external force and the internal force are defined in [17]; then can be decomposed into the external force and the internal force :where does not affect the position of the object motion, and it can be cancel out by , where

2.3. Dynamic Modeling of Coordinated Multiple Manipulators

The position of end-effectors can be expressed aswhere is the transformation matrix from end-effectors to joint space.

Differentiating (12) with respect to time yields we havewhere

Then the velocity of end-effectors can be expressed by joint space variable and task space variable, respectively:

From (15) and (16) and the fact that is invertible matrix, then the joint velocity and joint acceleration of the manipulator can be described by

Substituting (17) into subsystem (1), then the dynamic model can be expressed as follows:where

Multiplying (18) by , we can havewhere

In a similar way, utilizing block diagonal metrics, the flexible joint dynamic system can be expressed aswhere ,

Consider the constraints surface, the dimension of the object will be reduced to ; then the object position can be decomposed into , where , , and there exists a function , where can be expressed as

Definingwhere , , then position velocity and acceleration of the object can be described as

Substituting (26) and (27) into (20), then we can have

Multiplying (28) by , we can have

Consider the problems of the nonlinear input of hysteresis loop; the model can be expressed as [16] wherewhere donate the positive.

The dynamic equations have the following properties.

Property 4. and are symmetric and positive definite matrices.

Property 5.

Some basic knowledge should be noted.

Lemma 6 (see [17]). If is square integrable, that is, , and if , , exists and is bounded, then .

3. Controller Design

In this section, an adaptive controller is designed based on neural network by using sliding mode which consists of position error and force error for the multiple flexible joint manipulators.

Consider the model parameter uncertainties; then we can have , , , where , , donate the nominal part of the model; , , donate the norm-bounded uncertainties of the model; the dynamic equations can be expressed aswhere ,

Multiplying (33) by , we can have

By the assumption we can have

Multiplying (34) by , we can havewhere , ,

The desired position trajectory, desired constraint force multiplier, and desired internal force are denoted as , , . The objective of the controller is to make the position errors and force errors converge to zero, and the internal force error can also be bounded.

Considering the influence of flexible joint and input of the hysteresis loop, the controller design is divided into three steps. First, a desired input torque of the manipulator is designed to make the position errors and force errors converge to zero. Second, a desired transmission torque is designed to achieve the boundedness of input torque errors. Third, the motor torque is obtained to make the transmission torque track the desired expected values. Therefore, multimanipulator system stability can be guaranteed.

The object position error, generalized force multiplier error, internal force error, and control error are defined as follows:

The auxiliary variable is designed as

Then the sliding mode is designed aswhere , donate the positive definite diagonal matrix.

Then the desired input torque of the manipulator, desired transmission torque, and the motor torques are proposed as follows:where , , , donate the positive definite diagonal matrix, and adaptive law is given by

and donate the error upper bound for the .

From the proposed control scheme, we have the following theorem.

Theorem 7. Consider the multiple flexible joint robotic manipulator system with input of the hysteresis loop described by (34), (30), and (22), based on Assumptions 13, the asymptotic convergence of object position errors and constraint force errors will be ensured by controls (39), (40), and (41) with the adaptive law (42), and internal force errors can be bounded.

Proof. Consider the following Lyapunov function:Differentiating (43) with respect to time ,Substituting (34) into (38), we haveSubstituting the desired input torque of the manipulator (39) into (45), we haveSubstituting the adaptive law (42) and (46) into (44), the following can be obtained: According to (30) and (40), we can have Substituting (48) into (47) and choosing appropriate , the following can be obtained:Substituting the motor torques (41) into (49), we can havewhereBecause of , , the Lyapunov stability is guaranteed and , , , , , , are bounded.
Substituting into (34), we can haveMultiplying (52) by , it can be expressed aswhereBecause is bounded, according to the analysis, we can obtain the fact that is bounded, and is also bounded. From (52), we can obtain the fact that is bounded; then is bounded. According to (50), is square integrable, and is bounded. According to Lemma 6, can be guaranteed to converge to zero, because is bounded. Then can be guaranteed to converge to zero. Then both and errors can be guaranteed to converge to zero. The asymptotic convergence of the position error and constraint force error can be ensured.
Substituting into (32), we can havewhereAccording to the analysis, we can obtain the fact that is bounded, and is full rank; then the convergence of internal force error can be ensured, and the internal force error can be reduced as small as required by changing the gain .

4. Simulation

A multiple flexible joint manipulators system with two manipulators is considered to verify the validity of the proposed controller, and each manipulator has two joints; the dynamic equation of the system can be shown as follows:

The dynamic equation of the object:

The manipulator parameters: = 1.0 m, = 1.0 kg., and = 1.0 kg.

The object parameters: = 2.0 kg, = 9.8 m/s2, = 0.2 m., and = 0.2 m.

Desired internal force: .

Desired position of object:

Initial values of position of object: = 0.1 m, and = −0.1 m..

Controller parameters: , , , and

The time delay: = 0.07 s.

The simulation results are shown in Figures 29. Figures 2, 4, and 6 show the position tracking performances of the object, the position errors, and the constraint force errors with no hysteresis loop compensation, respectively. From these figures, one can see that the convergence of tracking errors, both position and constraint force, can be guaranteed, but position and constraint force errors cannot converge to zero. Figures 3, 5, and 7 show the position tracking performances of the object, the position errors, and the constraint force errors with hysteresis loop compensation, respectively. We can see that the tracking errors, both position and constraint force, can converge to zero.

The constraint force errors for linear sliding mode are shown in Figure 8. We can see that the force errors are bounded in Figure 8 compared with Figure 7. The internal force errors are shown in Figure 8. We can see that the internal force errors are bounded. The simulation results show that the proposed method can make the position errors and force errors converge to zero.

5. Conclusions

In this paper, a robust adaptive position/force control strategy based on sliding mode is proposed for multiple flexible joint manipulators system. The major contribution of this paper is that the nonlinear input of hysteresis loop is considered, which is approximated as a differential equation. Then the modified sliding mode consisting of position error and constraint force error is adopted for coordinated multiple manipulators system. Considering the uncertainties consist of model parameter and distraction, a control strategy based on sliding mode is designed. By the Lyapunov theory, the control strategy can guarantee that both position and constraint force errors converge to zero. And the boundedness of parameters errors and internal force errors can be guaranteed. Finally, the simulation results illustrate the feasibility of the proposed method.

Conflicts of Interest

The authors declare that there are no conflicts of interest regarding the publication of this paper.