Adaptive fuzzy-based motion generation and control of mobile under-actuated manipulators

https://doi.org/10.1016/j.engappai.2013.12.013Get rights and content

Abstract

In this paper, adaptive fuzzy-based motion generation and control are investigated for nonholonomic mobile manipulators with an under-actuated dyanmics model, in the presence of parametric and functional uncertainties. It is well known that the constraints of this kind of system consist of kinematic constraints for the mobile platform and dynamic constraints for the under-actuated manipulator with a passive joint. Through using dynamic coupling property of nonholonomic mobile manipulators, we can decouple the dynamics into a fully actuated subsystem and an unactuated subsystem. Then adaptive control is employed for the fully actuated subsystem using fuzzy logic approximation. Since the non-actuated subsystem cannot be directly manipulated by torque inputs but can be indirectly affected by the motion of the actuated subsystem, the reference trajectory of the actuated subsystem is planned by the fuzzy logic system based motion generator. Rigorous theoretic analysis has been established to show that the proposed trajectory generation and control are able to achieve dynamic stability, motion tracking and optimized dynamics. Simulation studies have further validated the efficiency of the developed scheme.

Introduction

Mobile manipulators with the full-actuated joints have been extensively investigated (Lin and Goldenberg, 2001, Li et al., 2007, Li and Chen, 2008). Mobile under-actuated manipulators first appeared in Li et al. (2006), by simultaneously integrating both kinematic constraints and dynamic constraints. Moreover, they are also different from mobile wheeled inverted pendulums (Li and Luo, 2009) or pendulums (Zhang and Tarn, 2002), whose dynamic balances in the vertical plane are achieved due to the gravity.

In robotics (Hsu, 2013, Du et al., 2013), nonholonomic constraints are formulated as non-integrable differential equations containing time-derivatives of generalized coordinates (velocity, acceleration, etc.) (Oya et al., 2003). Due to Brockett's theorem (Brockett, 1983), it is well known that nonholonomic systems with restricted mobility cannot be stabilized to a desired configuration nor posture-via differentiable, or even continuous, pure state feedback. In general, such nonholonomic constraints include (i) only kinematic constraints which geometrically restrict the direction of mobility, i.e., wheeled mobile robots (Su and Stepanenko, 1994); (ii) only dynamic constraints due to dynamic balance at passive degrees of freedom where no force or torque is applied, i.e., the manipulators with passive link (Arai and Tanie, 1998, De Luca and Oriolo, 2002, Bergerman et al., 1995); (iii) not only kinematic constraints but also dynamic constraints (Li et al., 2006), such as mobile underactuated manipulators investigated in this paper. The common features of these systems are governed by under-actuated configuration, i.e., the number of control inputs is less than the number of degrees of freedom, which makes it difficult to apply the conventional robotics approaches for controlling Euler–Lagrange systems. For a mobile under-actuated manipulator, there exist not only kinematic constraints but also dynamic constraints. For the nonholonomic constraints, there exists a first-order non-integrable differential equation in a Pfaffian form, A(q)q̇=0, where A(q) denotes nonholonomic constraints, and q and q̇ are the generalized coordinate vector and the velocity vector, respectively. For dynamic constraints, there exist a class of dynamic constraints formulated as a second-order differential equation, for example, M(q)q¨+V(q,q̇)=0 with the inertia matrix M(q) and the Centripetal and Coriolis matrix V(q,q̇), which includes the generalized acceleration q¨ and cannot be transformed into a Pfaffian form. These constraints are called second-order nonholonomic constraints. The zero torques of the under-actuated joints result in second-order nonholonomic constraints (Arai and Tanie, 1998, De Luca and Oriolo, 2002, Spong, 1995, Bergerman et al., 1995).

For mobile under-actuated manipulators, the development of intelligent control approach is important since the dynamics uncertainties cause unknown coupling among the joints. The mobile under-actuated manipulator is a strong dynamic coupled nonlinear system, and there exists strong dynamic coupling between the mobile platform and the manipulator, which is beyond the fixed manipulators. In the previous works, the adaptive model reference control of robots has been extensively investigated. In Klancar and Skrjanc (2007), a model-predictive trajectory-tracking control was applied to a mobile robot, where linearized tracking-error dynamics are used to predict future system behavior and a control law is derived from a quadratic cost function with the system tracking error and the control effort. In Li et al. (2007), a model reference adaptive control design was proposed for mobile manipulators. In Takubo et al. (2002), the cooperation between mobile manipulator and human was developed using an impedance model. But it is noted that they require the precise knowledge of the robot structure, which is often difficult to obtain in practice. To solve this problem, several methods that require little dynamics information are proposed in Ge et al. (1998) and Li et al. (2012a).

Recently, fuzzy logic control has found extensive applications for complex and ill-defined systems, especially in the presence of incomplete knowledge of the plant or the situation where precise control action is unavailable. Based on the universal approximation theorem (Zhao and Gao, 2012), stable fuzzy schemes have been developed for unknown single-input and single-output (SISO) nonlinear systems (Li et al., 2012b, Xia et al., 2011, Liu et al., 2009), and multiple-input and multiple-output (MIMO) nonlinear systems (Chang and Chen, 2000, Liu et al., 2010, Liu et al., 2011), and achieve stable performance criteria.

Pioneered by Hogan (1985), impedance control has been embedded in extensive research on interaction control, which does not attempt to track the motion or force trajectory but rather to regulate the mechanical impedance specified by a target model. Based on our previous work (Li et al., 2006; Yang et al., 2013) and considering unknown dynamics, in this paper, we first break down nonlinear mobile underactuated manipulators dynamics into the fully actuated dynamic subsystem and the zero dynamic subsystem. Aiming at minimizing optimal motion tracking errors and state variable accelerations, we employ the linear quadratic regulation (LQR) optimization technique to obtain an optimal reference model. The property of the optimized mass-spring-damper reference model guarantee smooth velocities. In addition, due to the under-actuated mechanism of mobile underactuated manipulators, the zero dynamics cannot be independently controlled. In our previous works (Li et al., 2010), the vehicle forward velocity dynamics are regarded as zero dynamics. Zero dynamics theories have been used to analyze the stability. As the vehicle forward velocity dynamics are directly affected by the under-actuated joint dynamics, in this paper, we manipulate the forward velocity by using the reference trajectory of the under-actuated joint angle as a virtual “controller”. A fuzzy logic system based reference trajectory generator has been designed for the zero dynamics, such that the vehicle forward velocity can be indirectly manipulated to follow the desired forward velocity.

The main contributions of this paper lie in:

  • (i)

    a reference model for the actuated subsystems of the mobile underactuated manipulators system using the LQR optimization approach is employed for motion tracking and improves smoothness of the tracking performance;

  • (ii)

    sliding mode has been utilized to design the adaptive fuzzy control in order to make the controlled dynamics to match the reference model dynamics in finite time;

  • (iii)

    instead of leaving the unactuated dynamics uncontrolled, the reference trajectory for the under-actuated joint angle is designed to indirectly affect the forward velocity such that the desired tracking can be achieved.

Section snippets

Preliminaries

For a linear time-invariant (LTI) system ẋ(t)=Ax(t), the system is stable if and only if there exists a symmetric positive definite solution PL to the Lyapunov equation ATPL+PLA=QL, where QL is an arbitrary symmetric positive-definite matrix.

Lemma 2.1

Anderson, 1990

Given a linear system with completely stabilizable pair [A,B], ẋ=Ax+Bu, x(t0)=x0, xRn,uRn, the optimal control u(t), t>0, that minimizes the following performance index J=t0tf(xTQx+uTRu)dt,R=RT>0,Q=QT0, is given by u=R1BTPx, where P is the

Dynamics

Consider an n DOF fixed manipulator mounted on a two-wheeled driven mobile platform, which can be subdivided into the active, passive and vehicles joints, the dynamics can be described asM(q)q¨+C(q,q̇)q̇+G(q)+d(t)=B(q)τ+fwhere M(q)=[MvMvaMvpMavMaMapMpvMpaMp],G(q)=[GvGaGp],C(q,q̇)=[CvCvaCvpCavCaCapCpvCpaCp],JT=[JvT00]T, d(t)=[dvTdaTdpT], B(q)τ=[τvTτaT0]T, f=JTλ, q are the generalized coordinates for the mobile manipulators with q=[qvT,qaT,qpT]TRn, qa are the coordinates of the active joints

Functional universal approximation using FLSs

Consider an n-inputs, single-output fuzzy logic system (Liu et al., 2010) with the product-inference rule, singleton fuzzifier, center average defuzzifier, and Gaussian membership function given by m fuzzy IF–THEN rules R(j):IFx1isA1jandandxnisAnjTHENyisWj,j=1,,m, where Rj denotes the jth rule, 1jm, (x1,x2,,xn)TURn and yR are the linguistic variables associated with the inputs and output of the fuzzy logic system, respectively, Aij and Wj denote the fuzzy sets in U and R. The fuzzy

Controller structure

Define the trajectories ξr and ξ̇r asξ̇r=ξ̇dΛeξ¨r=ξ¨dΛė

Since ξ̇=ξ̇r+r, ξ¨=ξ¨r+ṙ, considering the decomposition (19), Eq. (18) becomesM1ṙ+C˜1r=M1ξ¨rC1ξ̇rC^1rD1+B1Λ1U1where r=[r3T,r2T]T, ξ¨r=[ζ¨3rT,ζ¨2rT]T.

Let M0, C0, C^0, D0, and B10 be nominal parameter vectors which give the corresponding nominal function M0ξ¨r+C0ξ̇r+C^0r+D0 and (B10)1, respectively. The unknown continuous function M1ξ¨r+C1ξ̇r+C^1r+D1 in (44) can be approximated by FLSs to any arbitrary accuracy asM1ξ¨r+C1ξ̇r+C^1r+D1=

Motion generation for indirectly controlling ζ1 subsystem

We see that r=0 and subsequently w=0 for t>tz have been guaranteed by the adaptive controller developed in the previous section. From the definition of w in (33), the solution of Kd and Cd in (31), (32), it is clear that e¨=0 for t>tf, i.e., ξ¨=ξ¨d. The ζ1-subsystem (21) can be rewritten asφ̇1=φ2φ̇2=f(φ,ξd,ξ̇d,μ,ν)where it is assumed that ξ has converged to ξd, φ=[φ1T,φ2T]T=[ζ1T,ζ̇1T]T, μ=ζ¨3d, ν=ζ¨2d.

Consider the desired position and velocity of the first generalized coordinate ζ1 as φd=[ζ1dT,ζ

Simulation

The overall control system scheme combining both adaptive controller and fuzzy-based motion generation is shown in Fig. 3. For the given ζ2d and ζ3d, we can obtain optimal reference model (23). Using the filter (37), we can construct the controller (47). Through the augmented motion subsystem (18), we can produce the actual ζ2 and ζ3. For the given ζ1d, we use trajectory generation (72) to produce the desired ζ2d, the error between the actual ζ1 and the desired ζ1d is used to update the fuzzy

Conclusion

In this paper, adaptive fuzzy-based motion generation and control are investigated for nonholonomic mobile manipulators with an under-actuated joint, in the presence of parametric and functional uncertainties. Although in the previous works, nonlinear approximator such as NN and SVM was used to emulate the system dynamics and the unactuated subsystem is usually treated as zero dynamics, in this work, adaptive control has been employed for the fully actuated subsystem using fuzzy logic

References (33)

  • A. De Luca et al.

    Trajectory planning and control for planar robots with passive last joint

    Int. J. Robot. Res.

    (2002)
  • Du, J., Abrahama, A., Yu, S., Zhao, J., 2013. Adaptive dynamic surface control with Nussbaum gain for course-keeping of...
  • S.S. Ge et al.

    Adaptive Neural Network Control of Robot Manipulators

    (1998)
  • S.S. Ge et al.

    Stable Adaptive Neural Network Control

    (2002)
  • N. Hogan

    Impedance controlan approach to manipulation-Part I: Theory; Part II: Implementation; Part III: Applications

    Trans. ASME J. Dyn. Syst. Meas. Control

    (1985)
  • H. Li et al.

    Optimal state feedback integral control using network-based measurements

    IEEE Trans. Instrum. Meas.

    (2012)
  • Cited by (28)

    • A survey on underactuated robotic systems: Bio-inspiration, trajectory planning and control

      2020, Mechatronics
      Citation Excerpt :

      The second issue is dealing with the problem of upward pendulum stabilization [164–166], including stabilizing the system around its unstable equilibrium point, on condition that the pendulum is initially above the horizontal plane, or lies inside an open vicinity of zero, i.e. the attraction region of the closed-loop system. Numerous control schemes have been developed, e.g. Bang-Bang Control [119,167,168], Fuzzy Logic [149,169–171], energy based [163], state feedback based [172], Sliding Mode [173], Backstepping, PID adaptive [53], Time Optimal [174], Switching [175], Neural Network [176], Prediction [177], etc. The issues of trajectory planning and optimized adaptive control was investigated in [84] for a class of WIP vehicle models.

    • Adaptive robust control for planar n-link underactuated manipulator based on radial basis function neural network and online iterative correction method

      2018, Journal of the Franklin Institute
      Citation Excerpt :

      However, the linear approximation model of the PUM at any equilibrium point is uncontrollable, so the robust control methods of linear systems cannot be used here. Although some nonlinear robust control methods have been presented to realize the robust control of the fully actuated manipulator by designing the robust controller for each joint (e.g., HJI-based method [21], Fuzzy-logic-based method [22] and NN-based method [23]), the robust control of the PUM cannot be realized by simply employing these methods due to the lack of actuator. As a result, the robust control of the PUM is a big challenge.

    • Adaptive fuzzy control for full states constrained systems with nonstrict-feedback form and unknown nonlinear dead zone

      2017, Information Sciences
      Citation Excerpt :

      In the past decades, adaptive backstepping fuzzy control has become one of the most popular design methods to solve the regulation and tracking control problems for various nonlinear systems with completely unknown system functions, e.g., see [1–5,12,13,17,21–26,38,48,49,51,53] and references therein.

    • Simultaneous balancing and trajectory tracking control for two-wheeled inverted pendulum vehicles: A composite control approach

      2016, Neurocomputing
      Citation Excerpt :

      This kind of vehicle is similar to the cart-pendulum platform which is extensively investigated to verify the effectiveness of the nonlinear control methodologies, but compared with the cart-pendulum platform, the vehicle has more application value, especially in the unknown, dynamic and unstructured environment. However, high performance motion control of the wheeled inverted pendulum vehicle is still a challenging work for the control community up to now [6–8]. On the one hand, when the vehicle moves, it is always hypothesized that the ground can provide sufficient friction to prevent the slipping and sliding (i.e., pure rolling), and then the nonholonomic constraint is taken place.

    • State-dependent differential Riccati equation to track control of time-varying systems with state and control nonlinearities

      2015, ISA Transactions
      Citation Excerpt :

      Adaptive PID controller was also used for tracking control of non-holonomic robots [23]. Simpler structures of controllers are available with satisfactory performance (see [22–25] etc.), nonetheless the easy trade-off between energy consumption and tracking error, optimal nature of the controller, precise output and additional impact on final boundary condition were the motivation of SDDRE selection as the main subject of this work. Although the method is a little complicated, the ultimate precise results persuade anyone in full sway to try it.

    View all citing articles on Scopus

    This work is supported in part by the Foundation of Key Laboratory of Autonomous Systems and Networked Control (Chinese Ministry of Education) Grant nos. 2012A04, 2013A04, the National Natural Science Foundation of China Grants 61174045, U1201244, the Fundamental Research Funds for the Central Universities under Grant 2013ZG0035, the Program for New Century Excellent Talents in University under Grant NCET-12-0195, and the Ph.D. Programs Foundation of Ministry of Education of China under Grant 20130172110026.

    View full text