Next Article in Journal
A Two-Phase Approach for Single Container Loading with Weakly Heterogeneous Boxes
Previous Article in Journal
High-Precision Combined Tidal Forecasting Model
 
 
Font Type:
Arial Georgia Verdana
Font Size:
Aa Aa Aa
Line Spacing:
Column Width:
Background:
Article

An Approach to the Dynamics and Control of Uncertain Robot Manipulators

1
College of Information Engineering, Nanchang University, Nanchang 330031, China
2
Department of Systems and Computer Engineering, Carleton University, Ottawa, ON K1S 5B6, Canada
*
Author to whom correspondence should be addressed.
Algorithms 2019, 12(3), 66; https://doi.org/10.3390/a12030066
Submission received: 3 December 2018 / Revised: 26 February 2019 / Accepted: 11 March 2019 / Published: 26 March 2019

Abstract

:
In this paper, a novel constraint-following control for uncertain robot manipulators that is inspired by analytical dynamics is developed. The motion can be regarded as external constraints of the system. However, it is not easy to obtain explicit equations for dynamic modeling of constrained systems. For a multibody system subject to motion constraints, it is a common practice to introduce Lagrange multipliers, but using these to obtain explicit dynamical equations is a very difficult task. In order to obtain such equations more simply, motion constraints are handled here using the Udwadia-Kalaba equation(UKE). Then, considering real-life robot manipulators are usually uncertain(but bounded), by using continuous controllers compensate for the uncertainties. No linearizations/approximations of the robot manipulators systems are made throughout, and the tracking errors are bounds. A redundant manipulator of the SCARA type as the example to illustrates the methodology. Numerical results are demonstrates the simplicity and ease of implementation of the methodology.

1. Introduction

The main methods currently used for dynamic modeling of robot manipulators with motion constraints are the Newton–Euler method [1,2,3], Lagrange’s method [4,5], and Kane’s method [6]. The Newton–Euler method describes motion and force through the use of vectors. In the modeling procedure, every component of the mechanism is isolated and the corresponding Newton and Euler equations are established. The calculations involved are quite efficient, but it is hard to use this approach when attempting to design control systems for manipulators. For a multibody system with motion constraints, Lagrange’s method can be used, generally with the introduction of Lagrange multipliers, a widely used technique for constrained systems. However, controlling these multipliers is difficult, and the approach is not very well suited for symbolic considerations. Kane’s method combines the advantages of vector mechanics and analytical mechanics, with a generalized rate being used as an independent variable in the equations of motion of the system. The fundamental vector projection of the main force and the inertial force of the system is extended directly to derive the equations of motion. However, with this method, these dynamical equations cannot be obtained in the appropriate analytical form for a constrained mechanical system. All of these approaches share the common fundamental problem that they cannot provide explicit expressions for the dynamical equations of the constrained system. As is well known, the generation of dynamical equations for constrained systems in symbolic form has a number of advantages with regard to issues of both control and mechanical design [7].
To address the control of robot manipulators, valuable control approaches have been presented, such as Jacobian-Matrix-Adaption (JMA) Method [8], sliding mode control (SMC) [9], Robust adaptive control [10], and adaptive neural network control [11]. Unlike most control methods for the control problem of robot manipulators, the present paper does not make any linearizations or approximations. Our methodology is based on the Udwadia–Kalaba equation (UKE) [12,13,14,15,16,17]. The Udwadia–Kalaba equation is obtained by using Gauss’s principle rather than the more commonly used principles of Lagrange, Hamilton, Gibbs, and Appell [18]. This equation takes constraints into account in the dynamical equation and involves the generalized Moore–Penrose inverse [19]. It provides a simple and general explicit equation of motion for constrained mechanical systems without the need for Lagrange multipliers [14,20]. This relatively simple approach allows detailed dynamical analysis of such systems and should improve fundamental understanding of constrained motion in multibody dynamics. Based on UKE, many researchers have used this method to solve problems in the dynamics analysis of constrained systems. Pennestri et al. [21] use UKE to study the slider-crank mechanism and compared the numerical efficiency with the coordinate partitioning (CPE) equation. Chen et al. [22] applied the approach to the trajectory tracking control of the mobile robot, by solving UKE to obtain the control input not make any linearization or approximations. For additional applications using UKE see [23,24,25,26,27,28].
In this paper, we regard the desired trajectory as constraints, by using the UK equation to obtain the control input. Considering the moment of inertial of the robot manipulators are uncertain, a nonlinear controller was adopted to make nonlinear system to track the given trajectory. In the control methodology, this nonlinear controller is augmented by an additional additive controller based on a generalization of the notion of sliding surfaces [15,16,17,29]. It’s important to notice that the control obtained relies on recent advances in analytical dynamics rather than on control theory.
The paper is organized as follows. In Section 2, we introduce the Udwadia–Kalaba equation. In Section 3, we introduce our new approach based on UKE to tracking control of robot manipulator with uncertain dynamics. In Section 4, the proposed method is applied to a redundant SCARA-type manipulator, and illustrative numerical simulation results are presented in Section 3. Finally, this paper is concluded in Section 5.

2. Udwadia–Kalaba Equation

Consider the unconstrained mechanical system, moving under the influence of gravity alone, described by n generalized coordinates q : = q 1 , q 2 , , q n T , and with equations of motion expressed in Newtonian or Lagrangian form as
M q , t q ¨ = Q q , q ˙ , t ,
with initial conditions
q 0 = q 0 , q ˙ 0 = q ˙ 0 .
Here t R is the time, M is an n × n matrix that can be either positive-semidefinite M 0 or positive-definite M > 0 at each instant of time. q ˙ is the n × 1 velocity vector, q ¨ is the n × 1 acceleration vector, and Q q , q ˙ , t , called the given force, collects together the normal and Coriolis inertial terms and the applied forces related to q, q ˙ , and t. From (1), when q, q ˙ , and t are known, the acceleration can be obtained as follows:
a q , q ˙ , t : = M 1 q , t   Q q , q ˙ , t .
Suppose the mechanical system is subject to l ( l < n ) Paffian (holonomic or non-holonomic) constraints [23]:
i = 1 n A l i ( q , t ) q ˙ i = c l ( q , t ) , l = 1 , 2 , , m ,
in which A l i ( ) : R n × R R are both C 1 , m n . By differentiating the Equation (4), we can obtain the second-order form constraints as
i = 1 n ( d d t A l i ( q , t ) ) q ˙ i + i = 1 n ( d d t A l i ( q , t ) ) q ¨ i = d d t c l ( q , t ) ,
in which
d d t A l i ( q , t ) = k = 1 n A l i ( q , t ) q k q ˙ k + A l i ( q , t ) t , d d t c l ( q , t ) = k = 1 n c l ( q , t ) q k q ˙ k + c l ( q , t ) t .
Let
b l ( q , q ˙ , t ) : = d d t c l ( q , t ) i = 1 n ( d d t A l i ( q , t ) ) q ˙ i .
Then Equation (5) can be written as the matrix form
A ( q , q ˙ , t ) q ¨ = b ( q , q ˙ , t ) ,
where b = [ b 1 , b 2 , , b m ] T .
When the system is constrained, an additional set of forces act on the manipulator system, and the equation of motion of this constrained manipulator system can then be written as
M q , t q ¨ = Q q , q ˙ , t + Q c q , t ˙ , t ,
where Q c q , q ˙ , t is an n × 1 vector, which is present because of the additional constraint force and satisfies the constraint conditions.
In Lagrangian mechanics, when the constraints are ideal, Q c q , q ˙ , t is governed by the usual D’Alembert principle. However, the constraints can also be nonideal, and the constrained system can be subject to both ideal and nonideal constraints at the same time, in which case Q c q , q ˙ , t can be written as
Q c q , q ˙ , t = Q id c q , q ˙ , t + Q nid c q , q ˙ , t ,
where Q id c q , q ˙ , t is the ideal constraint force and Q nid c q , q ˙ , t the nonideal constraint force.
Assuming that the virtual displacement is ν , the work done by the ideal constraint force is zero, i.e.,
ν T Q id c = 0 ,
while the work done by the nonideal constraint force Q nid c q , q ˙ , t is nonzero. i.e.,
ν T Q nid c 0 .
Udwadia and Kalaba showed that the ideal constraint force is given by
Q id c q , q ˙ , t = M 1 2 B + b A M 1 Q ,
and the nonideal constraint force by
Q nid c q , q ˙ , t = M 1 2 B + I B + B M 1 2 c ,
where the matrix B = A M 1 2 and the superscript “+” indicates the Moore–Penrose inverse matrix. The vector c is a known vector, which can be obtained experimentally or by observation for a given mechanical system.
From (9), (10), (13), and (14), the general equation describing the dynamics of the constrained system is
M q ¨ = Q + M 1 2 B + b A M 1 Q + M 1 2 B + I B + B M 1 2 c .
If the work done by constraint forces under virtual displacements is zero, then Q nid c = 0 , and the general equation of the constrained system is then simplified to
M q ¨ = Q + M 1 2 B + b A M 1 Q = Q + Q c .
Premultiplying both sides of Equation (16) with M 1 , the acceleration of the nominal system that satisfies the constraint in Equation (5)
q ¨ = a + M 1 Q c ( t ) .

3. Tracking Control of Robot Manipulators with Uncertain Dynamics

We suppose this framework in the joint space of the robot. The task description is given by the end-effector of robot manipulators trajectory as constraint with h ( q , t ) = f ( q ( t ) ) x d ( t ) = x ( t ) x d ( t ) = 0 , in which x = f ( q ) denotes the forward kinematics [30]. We make use of the differential forward kinematics,
x ˙ = J ( q ) q ˙ , x ¨ = J ( q ) q ¨ + J ˙ q ˙ ,
and we bring Equation (18) into Equation (8) with
A ( q , q ˙ , t ) = J , b ( q , q ˙ , t ) = x ¨ d J ˙ q ˙ .
We considered the uncertainties in the modeling of the moments of inertia of the robot manipulators by using the concept of a sliding surface [15,16,17]. The equation of motion of the controlled “actual” system is
M a q ¨ c = Q a ( q c , q ˙ c , t ) + Q c ( t ) + Q u ( q c , q ˙ c , t ) ,
in which q c is the generalized coordinate vector of the controlled actual system; the subscript a denotes the actual, real-life system whose knowledge is uncertain, but bounded; the actual “given” force vector is Q a ; Q c is obtained from Equation (16) and Q u is the additional control force vector that compensates for the actual system.
The tracking errors (position and velocity) between the actual and the nominal system is
e x a ( t ) = x a ( t ) x d ( t ) , e ˙ x a ( t ) = x ˙ a ( t ) x ˙ d ( t ) .
For a sliding surface defined as
s ( t ) = e ˙ x a ( t ) + k e x a ( t ) ,
when the sliding surface s = 0 , it tracks the desired trajectories of the manipulator system exactly, using a smooth function [15] (instead of the traditional signum function or saturation function), and we can only ensure that the actual system stays within a small region around the origin, s Ω ϵ . This region Ω ϵ defined as
Ω ϵ : = { s R n | s ϵ }
can be made arbitrarily small. The method requires the computation of the following estimates:
( i ) λ min : = min ( e i g e n v a l u e s o f A M a 1 A + ) , ( i i ) β A δ q ¨ + ( A ˙ + k A ) e ˙ a λ m i n , t > 0 .
in which
δ q ¨ = M a 1 ( Q a + Q c ) M 1 ( Q + Q c ) .
In the above relations, means the L 2 norm. The additional control force is given as
Q u = β A + ( s / ϵ ) ,
where ϵ is a positive number, which can be chosen by the user. The tracking errors boundary is given by (for a Proof, see Ref. [15]):
| e x a , i | ϵ k , | e ˙ x a , i | 2 ϵ , i = 1 , 2 , , n .
Proof Equation (26).
Define the tracking errors on position as
e x a = f ( q a ) f ( q ) = x ˙ x ˙ d = A e ˙ a .
The derivative of Equation (22) is evaluated as
s ˙ = e ¨ x a + k e ˙ x a = x ¨ a x ¨ d + k ( x ˙ a x ˙ d ) = A e ¨ a + A ˙ e ˙ a x ¨ a x ¨ d + k A e ˙ a k ( x ˙ a x ˙ d ) .
Upon differentiating the tracking errors e a ( t ) = q a ( t ) q d ( t ) twice, we have
e ¨ a = q ¨ a ( t ) q ¨ d ( t ) .
Using Equation (16), and the controlled actual system (Equation (20)), Equation (30) becomes
e ¨ a = M a 1 ( Q a + Q c ) M 1 ( Q + Q c ) + M a 1 Q u = δ q ¨ + M a 1 Q u .
Therefore, the time derivative of the sliding manifold by using Equations (31) and (29) can be simplified as:
s ˙ = e ¨ x a + k e ˙ x a = A e ¨ a + A ˙ e ˙ a + k A e ˙ a = A ( δ q ¨ + M a 1 Q u ) + A ˙ e ˙ a + k A e ˙ a .
Considering the Lyapunov function
V a = 1 2 s T s ,
suppose s Ω ϵ and compute
V ˙ a = s T s ˙ = s T A ( δ q ¨ + M a 1 Q u ) + A ˙ e ˙ a + k A e ˙ a = s T A ( δ q ¨ M a 1 β A + ( s ϵ ) ) + A ˙ e ˙ a + k A e ˙ a = s T ( A δ q ¨ β A M a 1 A + ( s ϵ ) + A ˙ e ˙ a + k A e ˙ a ) .
Observing that s T A M a 1 A + s λ m i n s 2 , we have
V ˙ a s ( A δ q ¨ β λ m i n s ϵ + A ˙ + k A ) e ˙ a = s A ( δ q ¨ β λ m i n s A ϵ + A ˙ + k A A e ˙ a ) .
Thus, when β A δ q ¨ + ( A ˙ + k A ) e ˙ a λ m i n , t > 0 , Equation (35) is strictly negative. □

4. Application Example: A Redundant SCARA-Type Manipulator

In this section, the proposed Equation (26) is tested on a redundant SCARA-type manipulator [31]. The manipulator is shown in Figure 1.

4.1. Kinematics Analysis

The DH parameters can be used to write the transformations for each link. The general transformation between link i 1 and i can be written as:
i 1 T i = cos θ i sin θ i cos α i sin θ i sin α i a i cos θ i sin θ i cos θ i cos α i cos θ i sin α i a i sin θ i 0 sin α i cos α i d i 0 0 0 1 .
For the redundant manipulator, the DH parameters are shown in Table 1.
It is straightforward to write the transformation matrix for each link of the manipulator by inserting the DH parameters from Table 1 in Equation (36). Then, the transformation matrix can be easily obtained from
T = C 234 S 234 0 l 2 C 2 + l 3 C 23 + l 4 C 234 S 234 C 234 0 l 2 S 2 + l 3 S 23 + l 4 S 234 0 0 1 l 1 + d 1 l 5 d 5 0 0 0 1 ,
where S 2 = sin θ 2 , S 23 = sin ( θ 2 + θ 3 ) , S 234 = sin ( θ 2 + θ 3 + θ 4 ) , C 2 = cos θ 2 , C 23 = cos ( θ 2 + θ 3 ) , C 234 = cos ( θ 2 + θ 3 + θ 4 ) .
From Equation (37), we can obtain the position of the end-effector of the manipulator
x = l 2 C 2 + l 3 C 23 + l 4 C 234 , y = l 2 S 2 + l 3 S 23 + l 4 S 234 , z = l 1 + d 1 l 5 d 5 .
Then, the constraint encountered by the manipulator can be written as the following:
x = r x = η cos ( t / 2 ) cos ( t ) + x 0 , y = r y = η sin ( t / 2 ) cos ( t ) + y 0 , z = r z = 0.2 , θ 1 = 0.1 + 0.1 sin ( t ) , θ 3 = π / 2 .
By differentiating Equation (39) with respect to time t twice and combining with Equation (8), we write the constraints in matrix form:
A = 0 l 2 S 2 l 3 S 23 l 4 S 234 l 3 S 23 l 4 S 234 l 4 S 234 0 0 C 2 l 2 + l 3 C 23 + l 4 C 234 C 23 l 3 + l 4 C 234 l 4 C 234 0 1 0 0 0 1 1 0 0 0 0 0 0 1 0 0 , b = l 2 C 2 θ ˙ 2 2 + l 3 ( θ ˙ 2 + θ ˙ 3 ) 2 C 23 + l 4 ( θ ˙ 2 + θ ˙ 3 + θ ˙ 4 ) 2 C 234 5 4 η cos t 2 cos t + η sin t 2 sin t l 2 S 2 θ ˙ 2 2 + l 3 ( θ ˙ 2 + θ ˙ 3 ) 2 S 23 + l 4 ( θ ˙ 2 + θ ˙ 3 + θ ˙ 4 ) 2 S 234 5 4 η sin t 2 cos t η cos t 2 sin t 0 0.1 sin ( t ) 0 .

4.2. Dynamics Analysis

The dynamics equation of the manipulator can be written as:
M q q ¨ + C q , q ˙ + G q , q ˙ = τ ,
where τ represents the generalized forces vector, M is the inertia matrix, C is the centrifugal and Coriolis forces vector, and G is the gravitational force vector.
The inertia matrix is a symmetric positive definite matrix, which means M i j = M j i . The inertia matrix for the manipulator system is given as follows:
M 11 = m 1 + m 2 + m 3 + m 4 + m 5 , M 15 = m 5 , M 12 = M 13 = M 14 = M 25 = M 35 = M 45 = 0 , M 22 = l c 2 2 m 2 + ( l 2 2 + l c 3 2 + 2 l 2 l c 3 C 3 ) m 3 + ( l 2 2 + l 3 2 + l c 4 2 + 2 l 2 l 3 ) m 4 + 2 ( l 3 l c 4 C 4 + l 2 l c 4 C 34 ) m 4 + ( l 2 2 + l 3 2 + l 4 2 + 2 l 2 l 3 C 3 ) m 5 + 2 ( l 3 l 4 C 4 + l 2 l 4 C 34 ) m 5 + I 2 z z + I 3 z z + I 4 z z , M 23 = ( l c 3 2 + l 3 l c 3 C 3 ) m 3 + ( l 3 2 + l c 4 2 + l 2 l 3 C 3 + 2 l 3 l c 4 C 4 ) m 4 + l 2 l 4 C 34 m 5 , + ( l 3 2 + l 4 2 + l 2 l 3 C 3 + 2 l 3 l 4 C 4 ) m 5 + I 3 z z + I 4 z z , M 24 = ( l c 4 2 + l 3 l c 4 C 4 + l 2 l c 4 C 34 ) m 4 + ( l 4 2 + l 3 l 4 C 4 + l 2 l 4 C 34 ) m 5 + I 4 z z , M 33 = l c 3 2 m 3 + ( l 3 2 + l c 4 2 + 2 l 3 l c 4 C 4 ) m 4 + ( l 3 2 + l 4 2 + 2 l 3 l 4 C 4 ) m 5 + I 3 z z + I 4 z z , M 34 = ( l c 4 2 + l 3 l c 4 C 4 ) m 4 + ( l 4 2 + l 3 l 4 C 4 ) m 5 + I 4 z z , M 44 = l c 4 2 m 5 + l 4 2 m 5 + I 4 z z , M 55 = m 5 .
The components of centrifugal and Coriolis forces C are given as:
C 11 = C 15 = 0 , C 12 = ( l 2 S 3 θ ˙ 3 2 + 2 l 2 S 3 θ ˙ 2 θ ˙ 3 ) ( l c 3 m 3 + l 4 m 4 + l 3 m 5 ) + ( l 2 S 34 θ ˙ 3 2 2 ( l 3 S 4 + l 2 S 34 ) θ ˙ 3 θ ˙ 4 ) ( l c 4 m 4 + l 4 m 5 ) , + ( l 2 S 34 θ ˙ 2 θ ˙ 3 ( θ ˙ 4 2 + 2 θ ˙ 2 θ ˙ 4 ) ( l 2 S 34 ) ) ( l c 4 m 4 + l 4 m 5 ) , C 13 = ( l c 3 m 3 + l 3 m 4 + l 3 m 5 ) l 2 S 3 θ ˙ 2 2 + ( l 2 S 34 θ ˙ 2 2 ( 2 ( θ ˙ 2 + θ ˙ 3 ) + θ ˙ 4 ) l 3 S 4 θ ˙ 4 ) ( l c 4 m 4 + l 4 m 5 ) , C 14 = ( l c 4 m 4 + l 4 m 5 ) ( l 3 S 4 + l 2 S 34 ) θ ˙ 2 2 + ( l 3 S 4 θ ˙ 3 2 + 2 l 3 θ ˙ 2 θ ˙ 3 ) ( l c 4 m 4 + l 4 m 5 ) .
The components of the gravitational force are given by:
G = ( m 1 + m 2 + m 3 + m 4 + m 5 ) g , 0 , 0 , 0 , m 5 g T .
According to the UK equation, the constraint force, which represents the inverse dynamics of the manipulator, can be written in the form
Q c = M 1 2 ( A M 1 2 ) + ( b A M 1 ( C G ) ) .

4.3. Numerical Simulation

The numerical values of the parameters used for simulation were: m 1 = 0.524 kg, m 2 = m 3 = m 4 = 1.023 kg, m 5 = 0.14 kg, m 1 = 0.1 m 1 sin ( t ) , m 2 = 0.1 m 2 sin ( t ) , m 3 = 0.1 m 3 sin ( t ) , m 4 = 0.1 m 4 sin ( t ) , m 5 = 0.1 m 5 sin ( t ) , l 1 = 0.524 m, l 2 = l 3 = l 4 = 0.2 m, l 5 = 0.14 m, l 1 z z = l 2 z z = l 3 z z = 0.0058 kg · m 2 , l c 2 = l c 3 = l c 4 = 0.0229 m, η = 0.1 , x 0 = y 0 = 0.2 , g = 9.8 m / s 2 . The initial conditions of the system are given as: q ( 0 ) = 0.1 , 0.6435 , π / 2 , 0 , 0.284 T , q ˙ ( 0 ) = 0.1 , 0.4 , 0 , 0.5 , 0.1 T . We chose the control parameters as follows: k = 10 , β = 1000 , ϵ = 0.001 . We can guarantee that the tracking errors of position and velocity as given by Equation (27) were | e x a , i | ϵ k = 10 4 , | e ˙ x a , i | 2 ϵ = 2 × 10 3 . The equation of the controlled system given by Equation (20) was numerically integrated for 20 s using ODE15s on the MATLAB platform.
Figure 2, Figure 3 and Figure 4 show the numerical simulation results for the tracking control of the SCARA-type manipulator. By using the MATLAB Robotics toolbox [32], the trajectories of the end-effector of the manipulator are shown in Figure 2. From Figure 2, we can see that the end-effector of the manipulator can move on the desired trajectory. Figure 3 shows the errors in tracking the position and the velocity of the end-effector of manipulator of the nominal system. These values are bounded within 10 4 and 2 × 10 3 . The required servo joint forces are shown in Figure 4, where Q c denotes the control input, and Q u denotes the additional control torques for uncertainties of the actual system.

5. Conclusions

In this paper, problems in the dynamic modeling and control of a robot manipulators system with uncertain dynamics were considered. The dynamical equations and the constraint torque forces were obtained from the Udwadia–Kalaba equation, using the additional controller to compensate uncertainties in the nominal system. No linearizations/approximations of the robot manipulators systems were made throughout, and the tracking errors were bounded. A SCARA-type manipulator was used as an application example. Numerical simulation demonstrated the simplicity and ease of implementation.

Author Contributions

X.Y. designed the whole research method. X.Z. wrote the draft. S.X. gave a detailed revision. Y.D. designed the experiment. K.Z. provided experimental data. P.X.L. provided important guidance for this paper. All authors have read and approved the final manuscript.

Funding

This work was supported in part by the National Science Foundation of China (51765042, 61463031, 61662044, 61862044).

Conflicts of Interest

The authors declare no conflict of interest.

References

  1. He, W.; Ge, W.; Li, Y.; Liu, Y.J.; Yang, C.; Sun, C. Model identification and control design for a humanoid robot. IEEE Tran. Syst. Man Cybern. Syst. 2017, 47, 45–57. [Google Scholar] [CrossRef]
  2. Antonello, A.; Valverde, A.; Tsiotras, P. Dynamics and Control of Spacecraft Manipulators with Thrusters and Momentum Exchange Devices. J. Guid. Control Dyn. 2018, 42, 15–29. [Google Scholar] [CrossRef]
  3. Yang, C.; Jiang, Y.; He, W.; Na, J.; Li, Z.; Xu, B. Adaptive parameter estimation and control design for robot manipulators with finite-time convergence. IEEE Trans. Ind. Electron. 2018, 65, 8112–8123. [Google Scholar] [CrossRef]
  4. Pradhan, S.; Modi, V.; Misra, A.K. Order N formulation for flexible multibody systems in tree topology: Lagrangian approach. J. Guid. Control Dyn. 1997, 20, 665–672. [Google Scholar] [CrossRef]
  5. Korayem, M.; Basu, A. Automated fast symbolic modeling of robotic manipulators with compliant links. Math. Comput. Model. 1995, 22, 41–55. [Google Scholar] [CrossRef]
  6. Banerjee, A.K. Block-diagonal equations for multibody elastodynamics with geometric stiffness and constraints. J. Guid. Control Dyn. 1993, 16, 1092–1100. [Google Scholar] [CrossRef]
  7. Kovecses, J.; Piedboeuf, J.C.; Lange, C. Dynamics modeling and simulation of constrained robotic systems. IEEE/ASME Trans. Mechatron. 2003, 8, 165–177. [Google Scholar] [CrossRef]
  8. Chen, D.; Zhang, Y.; Li, S. Tracking Control of Robot Manipulators with Unknown Models: A Jacobian-Matrix-Adaption Method. IEEE Trans. Ind. Informat. 2018, 14, 3044–3053. [Google Scholar] [CrossRef]
  9. Xiao, B.; Yin, S. Exponential Tracking Control of Robotic Manipulators With Uncertain Dynamics and Kinematics. IEEE Trans. Ind. Informat. 2018, 15, 689–698. [Google Scholar] [CrossRef]
  10. Fateh, M.M. Nonlinear control of electrical flexible-joint robots. Nonlinear Dyn. 2012, 67, 2549–2559. [Google Scholar] [CrossRef]
  11. Sung, J.Y.; Jin, B.P.; Yoon, H.C. Adaptive Output Feedback Control of Flexible-Joint Robots Using Neural Networks: Dynamic Surface Design Approach. IEEE Trans. Neural Netw. 2008, 19, 1712–1726. [Google Scholar] [CrossRef] [PubMed]
  12. Udwadia, F.E. Optimal tracking control of nonlinear dynamical systems. Proc. R. Soc. A Math. Phys. Eng. Sci. 2008, 464, 2341–2363. [Google Scholar] [CrossRef]
  13. Udwadia, F.E.; Kalaba, R.E. Explicit equations of motion for mechanical systems with nonideal constraints. J. Appl. Mech. 2001, 68, 462–467. [Google Scholar] [CrossRef]
  14. Udwadia, F.E. On constrained motion. Appl. Math. Comput. 2005, 164, 313–320. [Google Scholar] [CrossRef]
  15. Udwadia, F.E.; Koganti, P.B. Dynamics and control of a multi-body planar pendulum. Nonlinear Dyn. 2015, 81, 845–866. [Google Scholar] [CrossRef]
  16. Udwadia, F.E.; Wanichanon, T.; Cho, H. Methodology for Satellite Formation-Keeping in the Presence of System Uncertainties. J. Guid. Control Dyn. 2014, 37, 1611–1624. [Google Scholar] [CrossRef]
  17. Udwadia, F.E.; Wanichanon, T. Control of Uncertain Nonlinear Multibody Mechanical Systems. J. Appl. Mech. 2013, 81, 041020. [Google Scholar] [CrossRef]
  18. Korayem, M.; Dehkordi, S. Derivation of motion equation for mobile manipulator with viscoelastic links and revolute–prismatic flexible joints via recursive Gibbs–Appell formulations. Robot. Auton. Syst. 2018, 103, 175–198. [Google Scholar] [CrossRef]
  19. De Falco, D.; Pennestri, E.; Vita, L. Investigation of the influence of pseudoinverse matrix calculations on multibody dynamics simulations by means of the Udwadia-Kalaba formulation. J. Aerosp. Eng. 2009, 22, 365–372. [Google Scholar] [CrossRef]
  20. Nuchkrua, T.; Chen, S.L. Precision Contouring Control of 5 DoF Robot Manipulators with Unknown Environment. In Proceedings of the 2017 11th Asian Control Conference (ASCC) IEEE, Gold Coast, Australia, 17–20 December 2017; pp. 976–981. [Google Scholar]
  21. Pennestrì, E.; Paolo Valentini, P.; de Falco, D. An application of the Udwadia-Kalaba dynamic formulation to flexible multibody systems. J. Frankl. Inst. 2010, 347, 173–194. [Google Scholar] [CrossRef]
  22. Chen, X.; Chen, Y.H.; Zhao, H.; Sun, H.; Zhao, F.; Huang, K.; Zhen, S. Application of the Udwadia–Kalaba approach to tracking control of mobile robots. Nonlinear Dyn. 2015, 83, 389–400. [Google Scholar]
  23. Hui, J.; Pan, M.; Zhao, R.; Luo, L.; Wu, L. The closed-form motion equation of redundant actuation parallel robot with joint friction: An application of the Udwadia–Kalaba approach. Nonlinear Dyn. 2018, 93, 689–703. [Google Scholar] [CrossRef]
  24. Huang, J.; Chen, Y.H.; Zhong, Z. Udwadia-Kalaba approach for parallel manipulator dynamics. J. Dyn. Syst. Meas. Control 2013, 135, 061003. [Google Scholar] [CrossRef]
  25. Nielsen, M.C.; Eidsvik, O.A.; Blanke, M.; Schjølberg, I. Constrained multi–body dynamics for modular underwater robots—Theory and experiments. Ocean Eng. 2018, 149, 358–372. [Google Scholar] [CrossRef]
  26. Liang, D.; Song, Y.; Sun, T.; Jin, X. Rigid-flexible coupling dynamic modeling and investigation of a redundantly actuated parallel manipulator with multiple actuation modes. J. Sound Vib. 2017, 403, 129–151. [Google Scholar] [CrossRef]
  27. Spada, R.P.; Nicoletti, R. The Udwadia–Kalaba Trajectory Control Applied to a Cantilever Beam—Experimental Results. J. Dyn. Syst. Meas. Control 2017, 139, 091002. [Google Scholar] [CrossRef]
  28. Cho, H.; Udwadia, F.E. Explicit solution to the full nonlinear problem for satellite formation-keeping. Acta Astron. 2010, 67, 369–387. [Google Scholar] [CrossRef]
  29. Udwadia, F.; Wanichanon, T. A Closed-Form Approach to Tracking Control of Nonlinear Uncertain Systems Using the Fundamental Equation; American Society of Civil Engineers: Reston, VA, USA, 2012; pp. 1339–1348. [Google Scholar]
  30. Peters, J.; Mistry, M.; Udwadia, F.; Nakanishi, J.; Schaal, S. A unifying framework for robot control with redundant DOFs. Auton. Robots 2008, 24, 1–12. [Google Scholar] [CrossRef]
  31. Urrea, C.; Kern, J. Trajectory tracking control of a real redundant manipulator of the SCARA type. J. Electr. Eng. Technol. 2016, 11, 215–226. [Google Scholar] [CrossRef]
  32. Corke, P. Robotics, Vision and Control: Fundamental Algorithms in MATLA B; Springer: New York, NY, USA, 2011. [Google Scholar]
Figure 1. A redundant manipulator of the SCARA type.
Figure 1. A redundant manipulator of the SCARA type.
Algorithms 12 00066 g001
Figure 2. The end-effector of the SCARA-type manipulator tracks the Rhodonea path in Cartesian space.
Figure 2. The end-effector of the SCARA-type manipulator tracks the Rhodonea path in Cartesian space.
Algorithms 12 00066 g002
Figure 3. Tracking error. (a) The error of tracking the nominal system on position; (b) The error of tracking the nominal system on velocity.
Figure 3. Tracking error. (a) The error of tracking the nominal system on position; (b) The error of tracking the nominal system on velocity.
Algorithms 12 00066 g003
Figure 4. The control input torques. Control input obtained from Equation (16); Additional controller to compensate for the uncertainties by using Equation (26).
Figure 4. The control input torques. Control input obtained from Equation (16); Additional controller to compensate for the uncertainties by using Equation (26).
Algorithms 12 00066 g004
Table 1. DH parameters of a redundant manipulator.
Table 1. DH parameters of a redundant manipulator.
i a i α i d i θ i
100 l 1 + d 1 0
2 l 2 00 θ 2
3 l 3 00 θ 3
4 l 4 π 0 θ 4
500 l 5 + d 5 0

Share and Cite

MDPI and ACS Style

Yang, X.; Zhang, X.; Xu, S.; Ding, Y.; Zhu, K.; Liu, P.X. An Approach to the Dynamics and Control of Uncertain Robot Manipulators. Algorithms 2019, 12, 66. https://doi.org/10.3390/a12030066

AMA Style

Yang X, Zhang X, Xu S, Ding Y, Zhu K, Liu PX. An Approach to the Dynamics and Control of Uncertain Robot Manipulators. Algorithms. 2019; 12(3):66. https://doi.org/10.3390/a12030066

Chicago/Turabian Style

Yang, Xiaohui, Xiaolong Zhang, Shaoping Xu, Yihui Ding, Kun Zhu, and Peter Xiaoping Liu. 2019. "An Approach to the Dynamics and Control of Uncertain Robot Manipulators" Algorithms 12, no. 3: 66. https://doi.org/10.3390/a12030066

Note that from the first issue of 2016, this journal uses article numbers instead of page numbers. See further details here.

Article Metrics

Back to TopTop