Documente Academic
Documente Profesional
Documente Cultură
highlights
An adaptive control formulation for underactuated robotic systems with unmodeled dynamics is proposed.
The design allows for fast estimation while guaranteeing bounded deviation from a nonadaptive reference system.
The proposed formulation is independent of detailed information about the system model.
The proof of stability is established by the analysis based on inputoutput maps.
The systems robustness to measurement noise and time delay is demonstrated.
article
info
Article history:
Received 12 October 2013
Received in revised form
3 June 2014
Accepted 13 October 2014
Available online 13 November 2014
Keywords:
Adaptive control
Underactuated robots
Unmodeled dynamics
Moving platforms
abstract
This paper develops an adaptive controller for underactuated robotic systems with unmodeled dynamics.
The control scheme is motivated by the applications of manipulators operating on dynamic platforms.
The design decouples the systems adaptation and control loops to allow for fast estimation rates, while
guaranteeing bounded deviation from a nonadaptive reference system. The proposed formulation is
independent of detailed information about the system model. The control scheme is tested in different
trajectory-tracking scenarios: (i) a manipulator installed on a ship operating in a high-sea state with
uncertain environmental disturbances and (ii) a mobile manipulator moving across a rough terrain of
unknown geometry. The simulation results illustrate the tracking performance of the proposed control
algorithm, its ability to deal with unmodeled dynamics, and its robustness to measurement noise and
time delay, while maintaining smooth control signals.
2014 Elsevier B.V. All rights reserved.
1. Introduction
Robot manipulators are widely used in industry and have long
been considered as testbeds for research in nonlinear control theory. Early work on adaptive control of fixed-base manipulators
was mostly based on model-reference adaptive-control architectures [13], the linear-in-parameter property of dynamic structure
[46] and the passivity of rigid robot dynamics [79]. Under relevant assumptions on the robots dynamic properties, these controllers were demonstrated to estimate successfully certain types
of unknown model parameters and achieve desired performance.
The extension of these classical control schemes to the context of a manipulator installed on a dynamic platform, however,
is challenging and still an ongoing research area. Such systems are
very popular in space robots, mobile manipulators, as well as underwater and offshore robotic systems [1012]. Manipulators are
Corresponding author.
E-mail address: knguyen9@illinois.edu (K.-D. Nguyen).
http://dx.doi.org/10.1016/j.robot.2014.10.009
0921-8890/ 2014 Elsevier B.V. All rights reserved.
used in space applications to perform maintenance operation, construction of structures, scientific experiments, or to collect debris.
Mobile manipulators have a growing range of applications from
exploration, such as the Mars rovers, to rescue missions, deactivation of explosive devices, and removal of hazardous materials.
Recently, offshore and underwater platforms have become the new
application territories for robotic technology, especially in rapidlychanging and challenging environments [13,14]. Examples include
moving loads, maintenance, construction, and other unmanned
tasks on ships, seaborne platforms, and underwater vehicles.
When the actuators driving certain degrees of freedom of the
robotic systems in the aforementioned scenarios are turned off, the
robotic systems become underactuated. In addition, the dynamics
of the manipulator and the platform are mutually coupled due to
conservation of momentum. This adds tremendous challenges as
compared with fixed-based manipulators [15]. Firstly, the equations of motion for the unactuated degrees of freedom now act as
constraints on the control design. As these are intrinsically nonholonomic, it is not possible to solve for the underactuated states
in terms of the controlled states. Consequently, model-reduction
methods fail to reduce the system dimension [16]. Moreover,
according to Brocketts theorem [17], it is impossible to asymptotically stabilize a nonholonomic system to an equilibrium point by a
continuous and time-invariant state-feedback control law, despite
its controllability. Secondly, with complicated platform structures,
or unknown terrain geometries in the case of mobile manipulators,
or in challenging environments, including manipulators operating
on ships and offshore platforms in high sea states, the platform dynamics are usually unmodeled and add large inertial terms and
disturbances to the description of the manipulator dynamics.
Example control designs include switching schemes based on
support-vector-machine regression [18], a combination of fuzzy
and backstepping control [19], adaptive control based on estimation of a bounded parameterization of the unknown dynamics
[20,21], and adaptive variable structure control [22].
The most popular methods for controlling underactuated
moving-base manipulators involve adopting the adaptive-control
frameworks for fixed-base manipulators. Recent examples of control schemes in this category for free-floating space manipulators
include [23] which constructs a dynamically equivalent model for
parameterization and control of the original system dynamics, [24]
which assumes passivity and other structure properties to eliminate the need for measuring the platform acceleration, [25] which
proposes an adaptive controller based on the reaction dynamics between the active and passive parts in the system, and [26]
which combines a recursive formulation of control torque and the
platforms reference velocity and acceleration to achieve desirable tracking performance. For mobile manipulators, work in [27]
designs an interaction control scheme, which is composed of an
adaptation algorithm and an inputoutput linearizing controller. A
trajectory and force tracking control problem is addressed in [28],
which presents an adaptive controller based on a suitably reduced
dynamic model to control a system with some unknown inertia parameters. Work in [29] employs a Frent-like description
to transform the kinematics of nonholonomic mobile platforms
to generic driftless dynamics, which are then stabilized by two
control schemes for the kinematics and dynamics, respectively.
In the presence of disturbances, [30] combines a regressor-based
adaptive scheme with an estimator for the disturbance to improve
tracking performance of mobile manipulators. Work in [31] develops an image-based visual controller for mobile manipulators to
track objects in three-dimensional space. The adaptive laws are designed based on the assumption that the robot dynamics can be
parameterized linearly in terms of the unknown parameters in the
model. In the context of marine robotics, an adaptive controller,
which assumes passivity in the robot structure, and an adaptivesliding control scheme are presented in [32] to compensate for
model uncertainties. The analysis in [33,34] decomposes the system dynamics into control elements of individual bodies to derive
a modular controller for manipulators mounted to an underwater vehicle. The control scheme in [35] allows underwater vehiclemanipulator systems to track both a prescribed sub-region as well
as uncertain tasks.
The adaptive-control algorithms in [2335] rely on the linearin-parameter property of Lagrangian systems. Specifically, they
exploit the dynamic structure and the passivity of rigid robot dynamics to factor the model description in terms of a regression
matrix and a vector of unknown parameters, and proceed to implement adaptive laws to estimate these parameters. While the
linear-in-parameter property is an acceptable model parameterization for many fixed-based manipulators, it is not applicable
to others, such as robots with complicated link and/or joint geometries, unknown lengths, or with nonlinear mass distribution,
stiffness, or damping. Furthermore, these controllers require construction of a well-defined and complicated model regression
matrix, which involves correct selection of the joint velocity coefficient matrix from among several options [36]. The use of the model
85
86
Mau (q)
Muu (q)
C (q, q )
Ga (q)
q + a
q +
Cu (q, q )
Gu (q)
M (q)
u
D (t )
+ aa
,
0
Duu (t )
(1)
Maa (q)
T
Mau
(q)
Mau (q)
C (q, q )
Ga (q)
q + a
q +
Cu (q, q ) r
Gu (q)
Muu (q) r
Y (q, q , q , q )
= a r r a
Yu (q, q, qr , qr )
(2)
(3)
T
a = Ya (q, q , q r , q r ) (q q r )
Yu (q, q , q r , q r )
(4)
with being an adaptation gain. More detailed analysis, for example in [24,25,30], shows that if an adaptive law drives a in Eq. (3) to
a in Eq. (2), then when u in (3) is substituted in (1), qa will track qar .
Two fundamental assumptions are used in the formulation
of the adaptive control strategy described above, namely (i) the
existence of a factorization of the left-hand side of Eq. (2) in terms
of a product of a matrix and a vector of model parameters, and
(ii) that the matrix is known and the vector can be estimated. For
fixed-base manipulators, these assumptions often apply, i.e., the
unknown model parameters may be collected in a vector and the
dynamics appropriately factored.
When the unknown parameters appear as nonlinear terms, factorization is no longer possible. Even in cases where factorization
is possible in principle, the complexity of the geometry and mass
distribution of the overall manipulator-and-platform system may
make it prohibitively difficult to construct the regression matrices
Ya and Yu , especially when the number of degrees of freedom is
large. This is particularly common for moving-base manipulators,
mounted on platforms whose structure may change in time and involve many uncalibrated parameters. In this case, the design of the
controller for the manipulator requires detailed information about
the geometry and mass distribution of the platform, which may
not be available or even predictable, as changes to the latter are
imposed by other control loops.
In the absence of certain knowledge of the regression matrices Ya and Yu , uncertainty associated with large variations in the
inertial and geometric properties of the platform enters the control problem as disturbances that are not accommodated within
the adaptive control design. Examples include significant platform
motions driven by unknown environmental factors, such as uneven terrain for ground vehicles, or high sea states and uncertain wind and current conditions for manipulators based on ships
or off-shore platforms, all of which may vary with location and
time. In these cases, disturbance rejection must be handled by the
design of upd , typically by using very large numerical values for
the proportional and derivative gains, with likely loss of system
robustness.
To address these observations, the control design in this paper
avoids the linear-in-parameter factorization entirely. Here, all
modeling terms in Eq. (1), including Maa , Mau , Muu , Ca , Cu , Ga , Gu ,
Daa , and Duu , are considered unknown functions of time. Before
deriving the control scheme, the equations of motion in Eq. (1) are
converted to a reduced form to demonstrate the reasoning behind
the controller design that follows. Specifically, by solving for q u in
the bottom component of Eq. (1), we get
1
T
q u = Muu
(q) Mau
(q)qa Cu (q, q )q Gu (q) + Duu (t ) .
(5)
(6)
where
1
T
Ma (q) = Maa (q) Mau (q)Muu
(q)Mau
(q).
(7)
1
Na (q, q ) = Ca (q, q )q + Ga (q) Mau (q)Muu
(q)
(Cu (q, q )q + Gu (q)) ,
(8)
1
Da (q, t ) = Daa (t ) Mau (q)Muu
(q)Duu (t ).
(9)
Since
Maa (q)
T
Mau (q)
Mau (q)
= |Ma (q)| |Muu (q)|
Muu (q)
(10)
(11)
87
(17)
and
u (t ) = k(t ) k t , (t ) ,
u(0) = 0
(18)
to Eqs. (12) and (13). Let v be the unique solution to the initialvalue problem
v (t , t ) = kMa1 v(t ) v (t , t ),
t
v (t , t ) = I.
(19)
It follows that
u(t ) = Fv [(t , (t ))] , k
v (t , t )(t , (t )) dt
(20)
and
(21)
Let the desired time histories for the robots actuated degrees
of freedom be described by the vector-valued function qad (t ) and
suppose that this is bounded with bounded derivatives. In the
definition of the auxiliary kinematic variable (cf. the sliding control
formulation in [5])
bF , sup Fv L1 < .
r , q a q ad + (qa qad ) ,
(12)
(13)
(t , ) , Ma
+ (qa q ad (t )) Am r
(24)
where
k
u (s)
(25)
u(s) =
s+k
that
1
1
s(sI Am ) L
1
s + k
u L
L1
(14)
2
k
(mh + 1)bF + 1 L ,
(26)
i.e., that
(t , )
d ( ) < ,
t
t
(t , )
d ( ) <
(23)
q ad (t ) + 2 qad (t )
r L
(22)
b1 <
(16)
(mh + 1)bF + 1 .
(27)
k
Let Z and Lref be defined as in Eqs. (B.1) and (B.5) in Appendix B,
respectively. Since b1 0 uniformly in v as k , it follows
that there exists a K , such that the stability condition
b1
(28)
is satisfied for some ref > H [r (0)(t )]L provided that k > K .
Then, from the remarks following Lemma B.1 and the result of
Lemma B.2 in Appendix B, we conclude that if r (0) < ref , then
the bounds r L < ref and uL < bF (Lref ref +Z ) must hold
for Rv , independently of v . In particular, this conclusion must hold
for the nonadaptive reference system obtained by substituting the
actual time histories q(t ) for v(t ), and we arrive at
88
4. Performance bounds
(29)
(30)
r (t ) H [r (0)(t )]L = O k1
(31)
for k . We obtain
r r L ,
rref r L = O (),
uref uL = O (),
provided that 2 C .
Lemma 3.1 implies that the response of the nonadaptive reference system will converge to a neighborhood of 0 exponentially
fast. The size of the neighborhood is inversely proportional to the
filter bandwidth k.
r L < ref + 1,
(32)
and
u ref = k uref + ref rref ,t L + ref ,
(33)
where
u L < .
(40)
r L
C / ,
(41)
(qa,ref q) L Q1 (rref r ) L ,
where Q1 = (s + )
(39)
(42)
L1 = 1/ 1. It follows that
(ref ) L (rref r ) L
(43)
and, consequently,
(34)
is similarly bounded.
We proceed to consider an adaptive control design for the
original dynamics in Eqs. (12) and (13) in lieu of Eq. (18). Analogous
to Eqs. (32) and (33), consider the state predictor
rt L + + Asp r ,
r = Am r + u +
r (0) = r0 ,
(35)
(45)
where
u = k u + rt L + ,
(44)
u(0) = 0,
(36)
= Proj , P r rt L ; b , ,
(0) = 0 ,
= Proj , P r ; b , ,
(0) = 0 ,
= Fq [ref ] + Fq [Asp r ] + k Fq Mq + I [r ].
These result in the bounds
(38)
where
(47)
and
(37)
(46)
(48)
(49)
vRm+n
and
b3 , sup Fv Asp + k(Fv Mv + I)L1
vRm+n
(50)
89
(rref r ) L
b2
1 b1 Lref
r L
(51)
and
(uref u) L
b2 bF Lref
+ b3 r L .
(52)
The claim follows by choosing and such that the product in Eq.
(51) is strictly less than 1.
The objectives of a practical implementation based on the described control design are to choose the parameter values ,
Am , Asp , , and k in order to achieve desirable performance
bounds on the prediction error r , as well as to drive r sufficiently
close to zero so that qa approaches the desired value qad within
some desired bound. The adaptation gain and the loop-shaping
gain Asp decide the rate of adaptation. The matrix Am characterizes proportionalderivative feedback terms for fine-tuning the
performance.
1 b1 Lref
l(1) =
(1)
(1)
(1)
l1 , l2 , l3
position vector r
l(2) =
(2)
(2)
(2)
l1 , l2 , l3
and rBE := L2 l3 .
90
We model the platform as a body with mass mship and moment of inertia about the w2 axis equal to Jship . A linear spring
massdamper model is used to describe partially the dynamic
interaction between the sea and the ship with effective stiffness
and damping coefficient given by K and C for the ship rolling angle b , by Kx and Cx for the displacement xb , and by Kz and Cz for
the displacement zb . In each case, the reference value equals 0. The
masses of links 1 and 2 and the payload at the end-effector are m1 ,
m2 and me , respectively. The links are assumed to be homogeneous
cylinders with radius equal to one fifth of the corresponding length.
With this system set-up, the kinetic energy, the potential
energy and the generalized nonconservative forces of the system are shown in Appendix D. The equations of motion are of
the exact form in Eq. (1) with the actuated degrees of freedom
qa = [q1 , q2 , q3 ] and the unactuated degrees of freedom qu =
[b , xb , zb ]. In these equations, the ships mass and moment of inertia matrix, as well as the effective stiffnesses and damping coefficients along the ships degrees of freedom, only appear in the
Muu , Cu and Gu components. In this particular case study, on the
one hand, since the mass and size of the ship are significantly larger
than those of the manipulator, the dominance of these terms in the
bottom part of Eq. (1) implies that the motions of the manipulator
have very little effect on the ships dynamics. On the other hand,
the ships motions enter the top part of Eq. (1) not only via the components of the mass matrices Maa and Mau , but also through nonlinearity contributions to the acceleration-dependent terms with
the same magnitude of influence as the manipulators dynamics.
In the numerical results reported below, and in a set of consistent units (the SI system is used throughout the paper), the
link lengths, the masses of the two links, the payload at the
end-effector, and the acceleration of gravity are given by L1 =
0.25; L2 = 0.2; m1 = 6; m2 = 4; me = 5; g = 9.81. The
distance between Cship and A is dA = 3. The ships effective mass
and moment of inertia about the w2 -axis equal mship = 105 and
Jship = 1.25 105 . The effective stiffnesses and damping coefficients parameterizing the dynamic interaction between the sea
and the ship are given by K = 107 , Kx = 3 105 , Kz =
3 105 , C = 108 , Cx = 2 105 , and Cz = 2 105 . The disturbances from the environment are assumed to be given by
3 107 sin(0.5t )
Duu (t ) = 3 105 sin(0.5t )
3 105 cos(0.5t )
(53)
91
Fig. 4. Performance of the proposed controller under ideal working conditions for various step inputs.
Fig. 5. Performance of the proposed controller under ideal working conditions for sinusoidal inputs.
92
Fig. 6. Performance of the proposed controller in the presence of 50 ms actuator time delay and velocity measurement noise in the range [0.15, 0.15] rad/s and with
sample time of 0.01 s.
Fig. 7. The dependence of the critical time delay on the adaptation rate for different
values of filter bandwidth. The values of dcrit for case of finite bandwidth are
obtained with a roundoff error of 5 104 . In the case of the model-reference
controller (corresponding to infinite filter bandwidth), the roundoff error is 5
105 .
93
(1)
(1)
(1)
l1 , l2 , l3
(2)
(2)
(2)
l1 , l2 , l3
(1)
and rDE := L2 l3 .
From this set-up, relative to the platform, the manipulator has
two degrees of freedom, represented by the relative joint angles
q1 and q2 . The configuration of the platform relative to the inertial
reference frame is described by the position coordinates xv and yv ,
the heading angle h , and the pitching angle p . The platform is
attached to the chassis of a rover via a suspension system to smooth
oscillations of the platform that might be induced by an uneven
terrain. The chassis configuration relative to the inertial frame is
assumed to be identical to that of the platform other than in its
pitching angle, which is here assumed to be an explicit function
of time that is unknown to the control design. Finally, the motion
of the chassis is constrained in such a way that the velocity of the
platforms center of mass is perpendicular to the axis of the driving
wheels, i.e., parallel to b1 .
We assume generalized forces associated with the q1 and
q2 degrees of freedom, given by the control torques u1 and u2
applied at the joints A and D, respectively. Under the assumption
that the pitching motion of the platform is unactuated, the
generalized force corresponding to p equals 0. The generalized
forces corresponding to the remaining degrees of freedom, xv ,
yv , and h , are assumed to be obtained from a matrix product
B(qv )uv . Here, the control input uv may be parameterized by two
independent control signals representing, for example, the torques
applied to the left and right driving wheels, respectively.
Based on the expressions for the kinetic and potential energies,
as well as the nonconservative generalized forces in Appendix D,
and in terms of the vector of generalized coordinates q , [qTr , qTv ]T ,
where qr , [q1 , q2 , p ]T and qv , [xv , yv , h ]T , the equations of
motion of the mobile manipulator then take the form
Mrr (q)
MrTv (q)
Mr v (q)
Mvv (q)
q r
Nrr (q, q )
+
q v
Nvv (q, q )
0
ur
D
=
+ T
+ rr ,
B(qv )uv
Dpp
A (h )
Mr v (q)S (h )
S T (h )Mvv (q)S (h )
q r
v
Nrr (q, q )
D
u
= r + T rr
,
uv
S (h )Dpp
S (h )Nvv (q, q )
Maa (q)
Mas (q)
T
Mas
T
Mau
ua
Daa
Duu
Mau (q)
Na (q, q )
q a
Msu (q) s + Ns (q, q )
q u
Nu (q, q )
Muu (q)
= us + Dss ,
(54)
(58)
q q ad + (qa qad )
= a
.
s sd
r
r , a
rs
q v = S (h )v,
(55)
(57)
(59)
Elimination of q u using the bottom part of Eq. (58), and noting the
absence of explicit dependence of the equations of motion on xv
and yv , then again yields
r = Am r + Ma1 u + ,
r (0) = r0 ,
(60)
functions
Ma and (t , ), where T , [r T , T ] and ,
forT some
qa , qTu , q Tu . Here, it follows that
(61)
qa,t L (sI + )1 L ra,t L
1
1
v = S T (h )S (h ) S T (h )qv .
Now,
from Eqs. (61) and (62) together with the observations that
ra,t
rt L and the assumption that the unactuated
L
(56)
(62)
94
7. Conclusion
t L Q1 rt L + Q2 ,
(63)
Traditional control architectures employ the linear-in-parameter property of Lagrangian systems to obtain the factorization
in Eq. (2) in terms of a model regression matrix and a vector
of unknown parameters, which is to be estimated by relevant
adaptive laws, of which Eq. (4) is an example. The construction of
the regression matrices in Eq. (2) requires information about the
structure/geometry of the ship such as the position of the ships
center of mass, the ships moment of inertia, the location of the
manipulator relative to the ship center of mass, and so on. If the
other dynamic factors, for example the movements of humans or
equipments in the ship, is integrated in the equations of motion,
then the modeling process to construct such regression matrices
may not be feasible.
In contrast, this paper has described a robust adaptive controller, inspired by the framework proposed in [41] with a lowpass filter in the control input, for an underactuated system of a
robot installed on a (moving) platform. The controller does not require the construction of regression matrices, while the dynamics of the entire system are unmodeled. We restrict our focus to
those robotic systems operating in challenging environments, such
as free-floating space manipulators, robots on ships or off-shore
platforms, and mobile manipulators moving across rough terrains.
As evidenced by fundamental theoretical results on the existence
of computable performance bounds, this framework successfully
separates the adaptation loop from the control loop, thereby allowing for arbitrary increases in the adaptation rate (bounded only by
hardware constraints) without sacrificing the systems robustness,
and allows for a predictable transient response with smooth and
implementable control signals. With the introduction of a variable
transformation, inspired by earlier work in [5], and an innovative
control design, the formulation is able to compensate for the nonlinearity and uncertainties in the dynamic model without assuming any knowledge of the system modeling.
Numerical simulations were used to illustrate the control
paradigm in trajectory tracking tasks imposed on two scenarios:
(1) a robot arm mounted on a ship operating in a high-sea state,
and (2) a mobile manipulator moving across a rough terrain. In
the first context, the ship has three unactuated degrees of freedom,
which are disturbed by unknown environmental factors, e.g., wind,
waves, and ocean currents. In the context of the mobile manipulator operating on a rough terrain, the disturbances from the unmodeled geometry of the terrain are transmitted to the platform via
the suspension system of the rover. In contrast to traditional adaptive controllers, for which the lack of knowledge about the ship dynamics and rover motion violates basic assumptions of the control
design, the proposed controller is independent of the system modeling, and therefore especially useful for systems with unmodeled
dynamics. The results demonstrate desirable tracking performance
and clean and smooth control signals with different types of disturbances, including measurement noise and unknown time delay.
The successful design of the proposed control architecture relies upon a key parameterization of the nonlinear contribution to
the robot equations of motion in terms of two time-varying parameters with the L norm of the sliding state as a regressor. The controller further employs projection operators in the adaptive laws to
impose bounds on the parameter estimates, and uses a low-pass
filter in the control signal to keep the control-signal frequencies
below the available control-system bandwidth. In this case, Theorem 4.1 implies close agreement between the system response and
the control signal, on the one hand, and the corresponding time histories for a suitably formulated nonadaptive reference system, on
the other hand, provided that the adaptation gain is chosen sufficiently large. Any deviation between the system response and the
desired trajectory observed in the numerical results may be traced
95
Fig. 10. Performance of the proposed controller in the presence of 50 ms actuator time delay and velocity measurement noise in the range [0.15, 0.15] rad/s and with
sample time of 0.01 s.
to the need to maintain a finite filter bandwidth, in order to guarantee robustness. This is the design trade-off between performance
and robustness of the proposed control architecture.
The control scheme proposed in this paper for underactuated
robotic systems is relatively simple with the state predictor in Eq.
(35), the adaptive control signal in Eq. (36), and the adaptation laws
in Eqs. (37) and (38). In addition, the control formulation is independent of system modeling. Hence, the same control structure can
be used for any Lagrangian system, including serial manipulators
or parallel robots, while current adaptive controllers for manipulators require reconstruction of the regression matrix for each application, or accurate estimation of the system model. Furthermore,
though the control scheme is demonstrated for a robot mounted
on a ship and a mobile manipulator, it can be directly implemented
for free-floating space manipulators whose dynamics have the exact form in Eq. (1), as well as any fixed-base manipulators whose
equations of motion are simpler than those considered here.
We finally comment on the observations made regarding the
critical time delay during the two trajectory-tracking tasks considered above. As seen in [41] in the case of a linear, constantcoefficient, single-input system, the basic control architecture
supports the formulation of theoretical lower bounds on the time
delay margin, through the use of a suitably formulated equivalent
LTI system. Some degree of robustness is therefore guaranteed provided that the adaptation gain is sufficiently large. Work is currently underway (cf. [49]) to adapt these theoretical results to the
manipulator context. For static and periodic reference inputs, a systematic analysis of the dependence on the actual critical time delay on the control parameters may be obtained, for example, using
techniques of numerical continuation. We will return to these considerations in a future publication.
Acknowledgments
This work was partially supported by a NASA SBIR Phase I
contract, order no. NNX12CE97P, awarded to CU Aerospace, L.L.C.
We gratefully acknowledge Naira Hovakimyan, Evgeny Kharisov,
and Enric Xargay for instructing the authors on the overall control
methodology, and for their feedback and contributions to an earlier
technical report on this topic.
v (t , t ) = kMa1 v(t ) v (t , t ),
t
v (t , t ) = I,
(A.1)
(A.2)
tr vT (t , t )v (t , t ) ne2kml (t t )
(A.3)
Fv : k
v (t , t )(t ) dt
(A.4)
is then given by
Fv L1 , max
1in
sup
+
j=1 t t ,t R
t
t
k v,ij (t , t ) dt
n n
ml
(A.5)
independently of v .
Let Mv [] , Ma1 (v). Since the matrix Ma1 is bounded, it follows that the compositions Mv Fv and Fv Mv also have bounded
norm, independently of v . Moreover, since v (t , t )/ t =
v (t , t )kMa1 (v(t )), it follows by integration by parts that
Fv []
= k (Fv Mv + I) [],
provided that (0) = 0.
(A.6)
96
(t , 0) Z <
(B.1)
(B.2)
t L Q1 rt L + Q2 ,
t [0, ]
r (t ) < , t [0, ),
r L = r ( ) = .
and
(t , )
t dt ( ) < ,
(t , )
d ( ) <
r L A L + B < ,
and define
()
L ,
d ()
(B.5)
(B.6)
x2 (xb )2
2 xb 2
(C.1)
f (x)
f (x)
y f (x) yT
f (x) f (x)
Proj : (x, y; xb , )
y otherwise
(t , (t )) (t , 0) + (t , 0) < L + Z
(B.7)
x = Proj(x, y; xb , ) and
x(0) xb x(t ) xb ,
(C.3)
t .
Lemma B.1. There exist continuous, piecewise-differentiable functions (t ) Rn and (t ) Rn such that
t , (t ) = (t )rt L + (t ),
t [0, ].
(B.8)
The conclusions
of Lemma
(B.10)
where Q1 = (s + )1 L1 = 1 and
(B.11)
Proj(x, y; xb , ) y 0.
(C.4)
(C.5)
and
r = Am r + + rt L + + Asp r ,
r (0) = r0 ,
= Proj , P r rt L ; b , ,
(0) = 0 ,
= Proj , P r ; b , ,
(0) = 0 ,
(C.6)
(C.7)
(C.8)
Lemma C.1. Let min (S ) and max (S ) denote the smallest and largest
eigenvalue, respectively, of a positive-definite symmetric matrix S.
Then,
r L
(B.12)
where (t ) , r (t ), (t ) , and A and B are linear integral operators such that AL1 = A < , and B [r (0)(t )]L = B < .
Then,
where r , r r, 0 b , and 0 b .
x x
r = Am r + + rt L + ,
(B.9)
for > 0 and some bounded function qad (t ) with all bounded
derivatives. Indeed, in this case
+ max{qu,t L , qu,t L }.
(C.2)
(B.14)
(B.13)
(B.3)
()
, max{ + 1, Q1 ( + 1) + Q2 },
and
m
,
min (P )
(C.9)
where
m , 4(b2 + b2 ) + 4
max (P )
b d + b d .
min (Q )
(C.10)
( T + T ).
(C.11)
m
b2 + b2 <
.
(C.12)
V , r T P r +
It follows that
V (0)
m
,
t [0, ].
(C.13)
r ( )2 >
min (Q )
b d + b d .
(C.14)
T + T
r 2 min (Q ) +
b d + b d
m
.
min (P )
(C.15)
(C.16)
By repeating this analysis for each subsequent interval of continuity of and , we conclude that (C.16) holds with replaced by
.
Suppose
that the
function (t , ) satisfies (B.1) and (B.2). Let
(t ) := r (t ), (t ) , where
r (t ) = Am r (t ) + (t ) + (t , (t )),
r (0) = r0
(C.17)
+ +
)
J1 J2 L21 m4
5 J2 L22 m5 q22
+ 0. ( +
L22 m5
2L1 L2 m2 c2 q21
4 + L22 m
5 (J1 J1p + L21 m
4 )c122 + 2L1 L2 m
2 c2
+ L21 m
2
2
5 )c12 22 2L1 L2 m
2 c12 2
(J2 + J2p L2 m
2 c1 c12 + 0.25c12
q 23 + 0.5Jship + L1 L2 m
2
4 + J1 c32 ) + 0.25c12
2 + J2 c32 )
(J1 + 2L21 m
(J2 + L22 m
2
2
2
1 + dA L2 s12 s3 m
3 + dA L1 s1 s3 m
+ sb 0.5dA m
2 + 0.5L22 s212 m
5 ) b2
4 + L1 L2 s1 s12 m
+ s23 (0.5L21 s21 m
2 c12 cb
1 c1 cb + L2 m
3 (x2b + zb2 ) + L1 m
+ 0.5m
2 s12 s3 )sb x b b
1 s 1 s 3 + L2 m
3 + L1 m
(dA m
1
2 s12 s3 ) + (L1 c1 m
1 s 1 s 3 + L2 m
3 + L1 m
cb (dA m
1 s 1 + L2 m
2 s12 )xb
2 c12 )sb zb b + c3 q 3 cb (L1 m
+ L2 m
1 s 1 + L2 m
2 s12 )sb zb + 0.5(J1 J1p
(L1 m
5 )s12 22
4 )s12 + 0.5(J2 J2p + L22 m
+ L21 m
2
2 c2 q 2
5 + L1 L2 m
2 s12 2 b + q 1 J2 + L2 m
+ L1 L2 m
2 c2 )sb )
1 + L2 m
2 cb s2 s3 (L1 m
+ s1 (L2 m
1 + L2 m
2 c2 )cb s3 L2 m
2 s2 sb ) x b
+ c1 ((L1 m
1 cb s1 L2 m
2 (c2 cb s1 + c1 cb s2 + c1 c2 s3 sb
(L1 m
1 c1 s3 sb )zb + dA L1 m
1 s1
s 1 s 2 s 3 s b ) L1 m
r L
97
2 c2 s3 b + q 2 L2 m
2 s1 (cb s2 s3 + c2 sb )
+ 2L1 L2 m
2 c2 cb s3 m
2 s2 sb ) x b + L2 m
2 c2 (cb s1
+ c1 (m
2 c1 cb + m
2 s1 s3 sb ) zb
+ c1 s3 sb ) + s2 (m
2 c1 s2 + (J2 + L22 m
5 ) s3
+ (dA L2 m
2 c2 (dA s1 + L1 s3 )) b ,
+ L2 m
(D.1)
1 c1 cb + L2 m
2 c12 cb dA (m1 + m2 + me )sb
U = g (L1 m
3 zb ) + 0.5(K b2 + Kx x2b + Kz zb2 ),
+m
(D.2)
Cx x b + Duu,2 , Cz zb + Duu,3 ].
(D.3)
1 = 0.5m1 + m2 + me , m
2 = 0.5m2 + me , m
3 = m1 +
Here, m
4 = 0.25m1 + m2 + me , m
5 = 0.25m2 + me ,
m2 + me + mship , m
cb = cos b , ci = cos qi , cik j = cos(kqi + qj ), and so on.
The mechanical model studied in Section 6 is described in
terms of the generalized coordinates q1 , q2 , p , h , xb and yb . The
equations of motion are obtained from Lagranges equations of the
first kind in terms of the total kinetic energy
5 + L21 m
4 + 2L1 L2 m
2 c2 )q21
T = 0.5(J1 + J2 + L22 m
6 + L22 m
5
(s12 + s12p2 ) h2 + 0.5 J1 + J2 + Jp + L2BA m
4 + 2L1 L2 m
2 c2 + 2LBA (L1 m
7 s1
+ L21 m
2
2
2
2 c2 )q1 q 2 + p J1 + J2 + L22 m
5 + L21 m
4
+ L1 L2 m
98
7 s1 + 0.5L2 m2 s12 ) q 1
2 c2 + LBA (L1 m
+ 2L1 L2 m
2 c2 + 0.5L2 LBA m2 s12 )q2
+ (J2 + + L1 L2 m
1 c1p + L2 m
2 c12p LBA m
6 sp ) p
+ ch (L1 m
1 c1p + L2 m
2 c12p )q1 + L2 m
2 c12p q 2 x b
+ (L1 m
2 s12p ) h y b
1 s1p + L2 m
6 cp + L1 m
+ (LBA m
6 cp L1 m
1 s1p + L2 m
2 s12p ) h x b
+ sh (LBA m
6 sp ) p
2 c12p LBA m
1 c1p + L2 m
+ ((L1 m
2 c12p q 2 )yb
2 c12p )q1 + L2 m
1 c1p + L2 m
+ (L1 m
L22 m5
(D.4)
1 c1 + L2 m
2 c12 )
U = 0.5Kp p2 + g (cp (L1 m
3LBA me sp ),
(D.5)
Fq =
2rw
(ur ul ) + Dpp,1 ,
+ Dpp,2 ,
sin h
rw
cos h
rw
(ur + ul ) sin h
(D.6)
1 through m
5 are defined in the same way as before, and
Here, m
6 = m1 + m2 , m
7 = 0.5m1 + m2 , m
8 = m1 + m2 + me +
m
mb . The quantity is the Lagrange multiplier associated with the
nonholonomic constraint, ur and ul are the input torques to the
right and left wheels, respectively, rw = 0.1 is the driving wheels
radius, and b = 0.5 is the width of the platform.
References
[1] S. Dubowsky, D.T. DesForges, The application of model reference adaptive
control to robotic manipulators, J. Dyn. Syst. Meas. Control 101 (1979)
193200.
[2] S. Nicosia, P. Tomei, Model reference adaptive control algorithms for industrial
robots, Automatica 20 (5) (1984) 635644.
[3] R. Horowitz, M. Tomizuka, An adaptive control scheme for mechanical
manipulatorscompensation of nonlinearity and decoupling control, J. Dyn.
Syst. Meas. Control 108 (1986) 127136.
[4] J.J. Craig, P. Hsu, S.S. Sastry, Adaptive control of mechanical manipulators, Int.
J. Robot. Res. 6 (2) (1987) 1628.
[5] J.J.E. Slotine, W. Li, On the adaptive control of robot manipulators, Int. J. Robot.
Res. 6 (3) (1987) 4959.
[6] R. Ortega, M. Spong, Adaptive motion control of rigid robots: a tutorial,
Automatica 25 (6) (1989) 877888.
[7] G. Niemeyer, J.J.E. Slotine, Stable adaptive teleoperation, IEEE J. Oceanic Eng.
16 (1) (1991) 152162.
[8] H. Berghuis, H. Nijmeijer, A passivity approach to controller-observer design
for robots, IEEE Trans. Robot. Automat. 9 (6) (1993) 740754.
[9] R. Ortega, A.J. van de Schaft, B. Maschke, G. Escobar, Interconnection and
damping assignment passivity-based control of port-controlled Hamiltonian
systems, Automatica 38 (4) (2002) 585596.
[10] I. Fantoni, R. Lozano, Non-Linear Control for Underactuated Mechanical
Systems, Springer-Verlag, London, 2002.
[11] C.M. Wronka, M.W. Dunnigan, Derivation and analysis of a dynamic model of
a robotic manipulator on a moving base, Robot. Auton. Syst. 59 (10) (2011)
758769.
[12] Y. Liu, H. Yu, A survey of underactuated mechanical systems, IET Control
Theory Appl. 7 (7) (2013) 153.
[13] L.J. Love, J.F. Jansen, F.G. Pin, On the modeling of robots operating on ships,
in: Proceeding of IEEE International Conference on Robotics and Automation,
New Orleans, USA, 2004, pp. 24362443.
[14] P.J. From, V. Duindam, J.T. Gravdahl, S. Sastry, Modeling and motion planning
for mechanisms on a non-inertial base, in: Proceeding of IEEE International
Conference on Robotics and Automation, Kobe, Japan, 2009, pp. 33203326.
[15] M. Reyhanoglu, A.J. van der Schaft, N.H. McClamroch, I. Kolmanovsky,
Dynamics and control of a class of underactuated mechanical systems, IEEE
Trans. Automat. Control 44 (9) (1999) 16631671.
99