Abstract
The hybrid joints of manipulators can be switched to either active (actuated) or passive (underactuated) mode as needed. Consider the property of hybrid joints, the system switches stochastically between active and passive systems, and the dynamics of the jump system cannot stay on each trajectory errors region of subsystems forever; therefore, it is difficult to determine whether the closed-loop system is stochastically stable. In this paper, we consider stochastic stability and sliding mode control for mobile manipulators using stochastic jumps switching joints. Adaptive parameter techniques are adopted to cope with the effect of Markovian switching and nonlinear dynamics uncertainty and follow the desired trajectory for wheeled mobile manipulators. The resulting closed-loop system is bounded in probability and the effect due to the external disturbance on the tracking errors can be attenuated to any preassigned level. It has been shown that the adaptive control problem for the Markovian jump nonlinear systems is solvable if a set of coupled linear matrix inequalities (LMIs) have solutions. Finally, a numerical example is given to show the potential of the proposed techniques.
1. Introduction
The hybrid joint shown in Figure 1 was first proposed in [1–5], which is with one clutch and one brake. When the clutch is released, the link is free, and the passive link is directly controlled by the dynamic coupling of mobile manipulators; when it is on, the joint is actuated by the motor. Moreover, the passive link can be locked by the brake embedded in the joint as needed. The robot with hybrid joints is called the hybrid actuated robot.
One of the advantages of using hybrid actuated robots is that they may consume less energy than the fully-actuated ones. For example, hyperredundant robots, such as snake-like robots or multilegged mobile robots [6], need large redundancy for dexterity and specific task completion while underactuation structure allows a more compact design and much simpler control and communication schemes. The hybrid actuated robot concept is also useful for the reliability or fault-tolerant design of fully-actuated robots working in hazardous areas or with dangerous materials. If any of the joint actuators of such a device fails, one degree of freedom of the system would be lost. It is important, in these cases, that the passive (failed) joint can still be controlled via the dynamic coupling with the active ones, so the system can still make use of all of its degrees of freedom originally planned.
Hybrid actuated mobile manipulator is the robot manipulator consisting of hybrid joints mounting on a wheeled mobile robot, which first appeared in [1–5]. Hybrid actuated mobile manipulators are different from full-actuated mobile manipulators in [7–26], due to simultaneously integrating both kinematic constraints and dynamic constraints. For these reasons, increasing effort needs to be made towards control design that guarantee stability and robustness for hybrid actuated mobile manipulators with the consideration of joint switching. The hybrid joint is also with the characteristic of underactuated the joints [27–34], for example, the hybrid joints in the free mode, which can rotate freely, can be indirectly driven by the effect of the dynamic coupling between the active and passive joints. The zero torque at the hybrid joints results in a second-order nonholonomic constraint [35, 36].
The mobile manipulator using Markovian switching hybrid joint can be loosely defined as a system that involves the interaction of both discrete events (represented by finite automata) and continuous-time dynamics (represented by differential equations). The joint switching seems to be stochastic and the switching may appear in any joints of the robot which need to develop Markovian jump linear system (MJLS) [37] to incorporate abrupt changes in the joints of mobile manipulators and use the Markovian jumping systems to guarantee the stochastic stability. Therefore, the discrete part (switching part) can be regarded as a continuous-time Markov process representing the modes of the system and the continuous part represents the dynamics state of the system, which evolves according to the differential dynamic equation when the mode is fixed. The hybrid formulation provides a powerful framework for modeling and analyzing the systems subject to abrupt joint switching variations, which are partly due to the inherently vulnerability to abrupt changes caused by component failures, sudden environmental disturbances, abrupt variation of the operation point of mobile manipulator, and so on.
The joint switching seems to be stochastic and the switching may appear in any joints of the robot, while simple switching approach cannot handle all the possibility. In this paper, to avoid the necessity of stopping the robot as the joint switches, MJLS method used to model and analyze switching robotic systems is an effective but challenging work.
To our best knowledge, there are few works considering MJLS method used to model and analyze switching robotic systems. In this paper, we consider the problem of adaptive control for stochastic jump systems with matched uncertainties and disturbances. The jumping parameters are treated as continuous-time discrete-state Markov process. Note that adaptive control method is one of the most popular techniques of nonlinear control design [8]. However, adaptive control for stochastic nonlinear mechanical dynamics systems with Markovian switching has received relatively little attention. Therefore, this paper will be concerned with the design of adaptive control for mobile manipulators using Markovian switching joints. There exist parameter uncertainties, nonlinearities, and external disturbance in the systems and environments under consideration. First, we design a reduced model for the wheeled mobile manipulator with switching joints. After introducing continuous-time Markov chain, adaptive control is adopted to cope with the effect of Markovian switching and nonlinear dynamics uncertainty and drive wheeled mobile manipulators following the desired trajectory. The resulting closed-loop system is bounded in probability and the effect due to the external disturbance on the tracking error can be attenuated to any pre-assigned level. Moreover, unknown upper bounds of dynamics uncertainties and disturbances can be estimated by adaptive updated law. The mechanical system with matched disturbances and Markov jumping is solved in terms of a finite set of coupled LMIs. It has been shown that the adaptive control problem for the Markovian jump nonlinear systems is solvable if a set of coupled LMIs have solutions. Finally, a numerical example is given to show the potential of the proposed techniques.
The main contributions of this paper lie in: (i)developing a reduced model for mobile manipulators such that it could be transformed into the framework of MJLS with modeling system dynamics uncertainties; (ii)designing an adaptive sliding mode control (SMC) for wheeled mobile manipulators with hybrid joints with Markovian switching; (iii)the system with matched disturbances and Markov jumping is solved in terms of a finite set of coupled LMIs.
2. Preliminary
Lemma 2.1 (see [38]). Let with representing an -dimensional strictly proper exponentially stable transfer function, and denoting its input and output, respectively. Then implies that , is continuous, and as . If, in addition, as , then .
Lemma 2.2 (see [39]). For the matrix and with appropriate dimensions, if is nonsingular, then .
Theorem 2.3. Given a Markov jump linear system with the system parameter matrices , , , , and , for , is unknown but satisfying , if there exits satisfies the following inequality for each , then the system (2.1) is stable in the mean square sense.
Proof. If there exists a positive definite matrix satisfying Lyapunov inequality (2.3), then the indefinite system (2.1) is asymptotically stable: Let , then can be represented as . Then, from the inequality , we can achieve . Since Assume that , using inequality (2.4) and Lemma 2.1, there is If the following inequality stands, then inequality (2.3) holds: With Schur Complement, it is easy to transfer (2.6) into (2.2), namely, the system (2.1) is stable. The proof is completed.
Definition 2.4. A stochastic process is said to be bounded in probability if the random variables are bounded in probability uniformly in , that is,
3. System Description
3.1. Dynamics
Consider an DOF robotic manipulator mounted on a two-wheeled driven mobile platform, the dynamics can be described as: where with denoting the generalized coordinates for the mobile platform and denoting the coordinates of the robotic manipulator joints, and . The symmetric positive definite inertia matrix , the Centripetal and Coriolis torques , the gravitational torque vector , the known input transformation matrix , the control inputs , and the generalized constraint forces could be represented as, respectively, where and describe the inertia matrices for the mobile platform and the links, respectively, and are the coupling inertia matrices of the mobile platform and the links; , denote the Centripetal and Coriolis torques for the mobile platform, the links, respectively; , are the coupling Centripetal and Coriolis torques of the mobile platform, the links. and are the gravitational torque vectors for the mobile platform, the links, respectively; is the input vector associated with the left driven wheel and the right driven wheel, respectively; and are the control input vectors for the joints of the manipulator; , denote the external disturbances on the mobile platform, the links, respectively; is the kinematic constraint matrix related to nonholonomic constraints; is the associated Lagrangian multipliers with the generalized nonholonomic constraints. We assume that the mobile manipulator is subject to known nonholonomic constraints. A method of modeling the dynamics of wheeled robots considering wheel-soil interaction mechanics is presented in [40, 41]. For the reason of simplification, we can adopt the methods of producing enough friction between the wheels of the mobile platform and the ground.
3.2. Reduced System
When the system is subjected to nonholonomic constraints, the nonintegrable and independent velocity constraints can be expressed as The constraint (3.3) is referred to as the classical nonholonomic constraint when it is not integrable. In the paper, constraint (3.3) is assumed to be completely nonholonomic and exactly known.
Since introduce , and , such that it is possible to find a rank matrix formed by a set of smooth and linearly independent vector fields spanning the null space of , that is, where . Define an auxiliary time function , and such that Equation (3.5) is the kinematic model for the wheeled inverted pendulums. Usually, has physical meaning, consisting of the angular velocity , the linear velocity , and the joint angle vector , that is, . Equation (3.5) describes the kinematic relationship between the motion vector and the velocity vector .
Differentiating (3.5) yields From (3.5), can be obtained from and as The dynamic equation (3.1), which satisfies the nonholonomic constraint (3.3), can be rewritten in terms of the internal state variable as with , .
Substituting (3.5) and (3.6) into (3.1), and then premultiplying (3.1) by , the constraint matrix can be eliminated by virtue of (3.4). As a consequence, we have the transformed nonholonomic system where , , , , , which is more appropriate for the controller design as the constraint has been eliminated from the dynamics.
Remark 3.1. In this paper, we choose , where , denote the rotation angle of the left wheel and the right wheel of the mobile platform, respectively, and denote the joint angles of the link , respectively, and .
Remark 3.2. The total degree of freedom for a two-wheeled driven mobile manipulator is .
3.3. Switching Dynamics
The hybrid joint is within each actuator of the wheels and links of the mobile manipulator, such that switching may appear in every joint independently. Since the left wheel and right wheel are symmetric, for simplification, we assume that the switching appears in the left wheel and each joint of the manipulator independently. Therefore, there are modes of operation, which are listed in Table 1 depending on which hybrid joint is in the active (actuated) or passive (underactuated) mode.
Let be the number of passive hybrid joints that have not already reached their set point in a given instant. If , passive joints are controlled and grouped in the vector , the remaining passive hybrid joints, if any, are kept locked by the brakes, and the active joints are grouped in the vector . If , the passive hybrid joints are controlled applying torques in active hybrid joints. In this case, and . The strategy is to control all passive hybrid joints until they reach the desired position, considering the conditions exposed above, and then turn on the clutch. After that, all the active hybrid joints are controlled by themselves as a fully-actuated robot.
The dynamics (3.9) can be partitioned into two parts, the actuated part and the passive part, represented by “” and “,” respectively. Then we can rewrite the dynamics (3.9) as where (i), : the inertia matrices of the actuated parts and the passive parts, respectively; (ii), : the coupling inertia matrices of the actuated parts and the passive parts, respectively; (iii), : the Centripetal and Coriolis torque matrices of the actuated parts and the passive parts, respectively; (iv), : the coupling Centripetal and Coriolis torques of the actuated parts and the passive parts, respectively; (v), : the gravitational torque vector for the actuated parts and the passive parts, respectively; (vi), : the bounded external disturbance from the environments on the actuated parts and the passive parts, respectively; (vii): the control input torque vector for the actuated parts of the joints; (viii): the control input torque vector for the passive parts of the joints satisfying .
After some simple manipulation, we can further obtain where
4. Control Design
4.1. Model-Based Control with Unmodeled Dynamics
Define the tracking errors as where , and denote the desired trajectories vectors of passive joint accelerations, velocities, and positions, respectively.
The parameters , , and in dynamical model (3.11) are functions of physical parameters of mobile manipulators like links masses, links lengths, moments of inertial, and so on. The precise values of these parameters are difficult to acquire due to measuring errors and environment and payloads variations. Therefore, it is assumed that actual value , and can be separated as nominal parts denoted by , , and and uncertain parts denoted by , and , respectively. These variables satisfy the following relationships: Suppose that the dynamical models of robot manipulators are known precisely and unmodeled dynamics are excluded, that is, , , and in (3.11) are all zeros. At this time, dynamical models (3.11) can be converted into the following nominal models:
Consider the control law as where and are positive definite matrices. Substituting (4.4) into (4.3) yields From Lemma 2.1, it is obvious that errors and will asymptotically if proportional gain and derivative gain are chosen in the favorable situation.
According to (4.4), the proposed control is effective based on the strong assumptions that exact knowledge of robot dynamics is precisely known and unmodeled dynamics has to be ignored, which is difficult to obtain in practices. Therefore, we need to approximate dynamics nonlinear functions. One can imagine that model-based control is used to control nominal system and another adaptive based control attaching to model-based control for uncertain system can be designed. In this way, applying (4.4) to original systems (3.11) yields which is a function of joint variables, physical parameters, parameters variations, unmodeled dynamics, and so on and denotes the structured uncertainty and unstructured uncertainty.
Up to now, the control objective can be restated as: seek a control law based on nominal parameters and adaptive-based compensator such that joint motions of robotic systems (3.11) can follow desired trajectories. The overall control law can be written as where is an adaptive-based controller serving as a compensator for model-based control and designed later. Using control law (4.8), the closed-loop system becomes:
Supposed that the state vector is defined as , the state space equation has form as
4.2. Stochastic Control Design
Since the hybrid joints can be switched among different modes, considering the Markovian jumping, we can rewrite (4.10) by integrating Markovian jumping parameters as where , and is one of the Markovian jumping parameters in the limited set with the mode transition rate matrix . The jump transition probability can be defined as where . Here, and . The model of the form (4.12) is a hybrid system in which one state takes values continuously and another state , referred to as the mode or operating form, takes values discretely in .
For , let us introduce the weak infinitesimal operator of the process at the point ,
For each possible value , , we will denote the system matrices associated with mode by where , are known real constant matrices of appropriate dimensions which describe the nominal system.
Theorem 4.1. If the linear matrix inequalities (4.16) have the solution for given , , , and and define the sliding surface as Consider the adaptive control as with the adaptive law where , and , , is positive definite, and ( ) satisfying: , , , with the constants and , and will be defined later. Then, a stable sliding mode exists from the initial time, and the sliding dynamics is stable.
Proof. Define the transfer matrix and the related vector , we have
where , and , is any basis of the null space of , that is, is an orthogonal complement of , Note that given any , is not unique. Moreover, .
Consider (4.22), it is easy to have
From the definition of , we have
Consider (4.11) and (4.18), we can rewrite (4.24) as
with .
Consider (4.7), and with and , we can rewrite it as
Let , then we have
Let us consider the Lyapunov function as
Taking the derivative (4.28) and integrating (4.27), we have
Substituting (4.19) into (4.29), we have
Assumption 4.2. There exist some finite positive constants such that , , , , .Remark 4.3. For simplification, we assume that . There exist the minimum and maximum eigenvalues and , such that , there exists the known positive parameter satisfying , that is, . Remark 4.4. In reality, these constants cannot be obtained beforehand. Although any fixed large can guarantee good performance, it is not practical as large imply, in general, high noise amplification and high cost of control. Therefore, it is necessary to develop an adaptive law which can approximate the knowledge of .
Choose the Lyapunov function candidate with
where , and , , therefore, we have
Integrating (4.20) into (4.32), we have
with . Therefore, . Since is bounded, there exists , with the finite constant , when , then . For , and will converge to a compact set denoted by
From all the above, converges to a small set containing the origin as . Moreover, as because of , , therefore, converges to the origin, there , therefore, and .
Consider (4.21) and (4.22), we have
Consider Theorem 2.3 and (4.23), and let , it is easy to have
where
Therefore, we can partition the state equation as as
Since and , we only consider the stability of . It is easy to obtain that if there exists a positive-define matrix enabling the following inequality to hold:
where , then the system
is asymptotically stable, where is a solution matrix to the LMIs (4.16), which implies that the sliding-mode dynamics (4.36) is asymptotically stable. This implies that (4.39) holds if the matrix inequality shown in (4.16) holds.
Remark 4.5. Note that Theorem 4.1 provides a solution to the problem of adaptive control for mechanical nonlinear systems with Markovian jump parameters. It is worth mentioning that the work conducted in this paper is the attempt to overcome the dynamics uncertainty arising in the sliding mode control for dynamics nonlinear systems with Markovian jump parameters and adopt adaptive control for dynamics nonlinear systems with Markovian jump parameters. The results obtained could be extended to general dynamics systems.
4.3. Switching Stability
For the system switching stability between the two different modes, we give the following theorems.
Theorem 4.6. Consider the switching system (4.13) if the system is both stable before and after the switching phase using the control law (4.19). Assume that there exists no external impacts during the switching, the system is also stable during the switching phase.
Proof. Since and are decreasing from Theorem 4.1, we know the system is stable no matter the hybrid joint is either actuated or underactuated. In the preceding, we have shown that the Lyapunov function is nonincreasing during the switching. Let and denote the Lyapunov function before and after the switching, and and represent the post- and preswitch velocities, respectively. The Lyapunov function change during the switching can be simplified as follows: There is no external impact during the switching, which means that there are no extra energy injected into the system. Since the inertia properties of the switching joint and link exist, during the switching joint, if the switching joint is switched from the active mode to the passive mode without considering the friction, the motion of the link should be continuous, that is, . Therefore, during the switching, the Lyapunov function is nonincreasing. If considering the friction, the Lyapunov function is decreasing, that is, , the motion is stable during the switching. Similarly, if the switching joint is switched from the passive mode to the active mode, although the joint torque is added, since the motion of the system is continuous because of the inertia, that is, , the motion of the system is also stable.
5. Simulation Studies
To verify the effectiveness of the proposed control algorithm, let us consider a wheeled mobile underactuated manipulator shown in Figure 2.
The following variables have been chosen to describe the vehicle (see also Figure 2), (i): the torques of two wheels; (ii): the torques of joint 1; (iii), : the rotation angle of the left wheel and the right wheel of the mobile platform; (iv): the forward velocity of the mobile platform; (v): the direction angle of the mobile platform; (vi): the rotation velocity of the mobile platform, and ; (vii): the joint angle of the underactuated link; (viii): the mass, the inertia moment, and the length for the link; (ix): the radius of the wheels; (x): the distance of the wheels; (xi): the distance between the wheel and joint 1; (xii): the mass of the mobile platform; (xiii): the inertia moment of the mobile platform; (xiv): the inertia moment of each wheel; (xv): gravity acceleration.
The mobile underactuated manipulator is subject to the following constraint: . Using the Lagrangian approach, we can obtain the dynamic model with , then we could obtain where
As discussed in Section 2, we set the fully operational configuration represented by OOO while three possible configurations can occur: , , and , where represents actuated joints and represents passive joints. For example, if we find that a switching occurs in , then the switching configuration to validate the proposed methodology is the configuration. We consider a workspace with a positioning domain which range from −8° to , with the velocities set to , and use 2 sectors of position in each joint, denoted as I() and II(), to map the mobile manipulator workspace. The linearization points with respect to I and II are chosen as −3° and 7°, respectively. Then, according to Section 3.2, 8 linearization points with 32 modes are found. For simplification, we select the 8 modes in simulation, which are shown in Table 2. There exist 8 modes for the simulation example, which means an dimension transition rate matrix is needed, so is defined as The system parameters are chosen as , , , , , , , , , , .
Assume that the nominal models are obtained as: The parameters in (4.19) are set as , for , , , , , , . The initial condition we used for simulation is . Via LMI optimization with the data , we can get the following solution to the LMIs (4.16) as: So we can obtain the solution of , for . Torque disturbances are introduced to verify the robustness of the controllers The disturbance is turned off after the switching introduction in corresponding joint or wheel.
The system switches among the 8 modes randomly during operation. From Figure 3, we can see that firstly the system switches from mode 1 to mode 4, then from mode 4 to mode 1, finally, it switches from mode 1 to modes 4, 6, and 7. Figure 4 shows that the system is stabilized during operation. From Figures 5, 6, and 7, it can be noticed that the torque inputs are bounded. The simulation results demonstrate the tracking error decays to the equilibrium point under the designed mode-dependent controller.
6. Conclusion
In this paper, we consider stochastic stability and sliding mode control for mobile manipulators using stochastic jumps switching joints. Adaptive parameter techniques are adopted to cope with the effect of the Markovian switching and nonlinear dynamics uncertainty and follow the desired trajectory for wheeled mobile manipulators. The resulting closed-loop system is bounded in probability and the effect due to the external disturbance on the tracking errors can be attenuated to any preassigned level. It has been shown that the adaptive control problem for the Markovian jump nonlinear systems is solvable if a set of coupled LMIs have solutions. Finally, a numerical example is given to show the potential of the proposed techniques.
7. Acknowledgment
This study was partially supported by the National Natural Science Foundation of China (Grant no. 61005080), Special Postdoctoral Foundation of China (Grant no. 201104405), Postdoctoral Foundation of China (20100480994), and the “111” Project (B07018). The authors would like to express their acknowledgment to Dr. Z. J. Li for his help in theory and literature.