Volume 2019, Issue 1 5627271
Research Article
Open Access

Dynamic Modeling and Development of Symbolic Calculation Software for N-DOF Flexible-Link Manipulators Incorporating Lumped Mass

Feng Yu

Feng Yu

Key Laboratory of Metallurgical Equipment and Control Technology (Wuhan University of Science and Technology), Ministry of Education, Wuhan, China moe.edu.cn

Hubei Key Laboratory of Mechanical Transmission and Manufacturing Engineering, Wuhan University of Science and Technology, Wuhan, China wust.edu.cn

Search for more papers by this author
Xinyuan Chen

Corresponding Author

Xinyuan Chen

Key Laboratory of Metallurgical Equipment and Control Technology (Wuhan University of Science and Technology), Ministry of Education, Wuhan, China moe.edu.cn

Hubei Key Laboratory of Mechanical Transmission and Manufacturing Engineering, Wuhan University of Science and Technology, Wuhan, China wust.edu.cn

Wuhan University of Science and Technology, Peace Avenue, Qingshan District, Wuhan, Hubei 430081, China wust.edu.cn

Search for more papers by this author
First published: 2019
Citations: 3
Academic Editor: Hassan Haddadpour

Abstract

Considering the complex dynamic modeling of multi-DOF planar flexible manipulators, a general-purpose method for the rigid-flexible coupling dynamic modeling of N-DOF flexible manipulators is proposed in this paper, and symbolic calculation software is developed. The modeling method is based on the Lagrange equation and assumed mode method (AMM). First, the N-DOF flexible manipulator is divided into two parts, which are assumed to be rigid and flexible. On this basis, the rigid part and the flexible part are coupled, and the calculation process of the model is further simplified. Then, the simplest general symbolic expression of the dynamic model of the N-DOF flexible manipulator is obtained with the induction method. According to the modeling method, “symbolic expression computation software for dynamic equations of N-DOF flexible manipulators” is developed using the symbolic calculation software Mathematica. Finally, the dynamic modeling method and the symbolic calculation software are verified by a trajectory tracking experiment with a PD control applied to a 2-DOF flexible manipulator. Compared with the traditional modeling method, the calculation time can be reduced by more than 90% using the modeling method proposed in this paper, which significantly reduces the complexity of the modeling process.

1. Introduction

Robotic manipulators are widely used in environments that are hazardous to humans and in situations where there are substantial amounts of repetitive work to reduce the burden on humans and to assist in accomplishing special tasks. To ensure sufficient positioning accuracy at the end of a manipulator, the links of the manipulator can generally be stiffened by a bulky structure to prevent the links from vibrating and to avoid elastic deflection during operation [14]. However, heavy links limit the speed of the manipulator’s movement and consume excessive amounts of energy. In some cases, thickening the structure of the links to ensure the positioning accuracy of the end of the manipulator may not be practical. For example, the weight of a manipulator operating on the space station must be as light as possible because of launch costs [5]. In addition, to ensure that the manipulator can perform in a greater workspace, the boom of a concrete pump truck structure should be more slender [6]. Robotic manipulators are also used in nuclear maintenance [7, 8], for spraying large aircraft [9], etc. Under these circumstances, these robotic manipulators have to be designed as flexible-link manipulators (FLMs) with a slender structure.

FLMs have been found in extensive applications because of their advantages in terms of being lightweight and having high load ratios (the ratio of load mass to manipulator mass), high movement speeds, and low energy consumption [1012]. Moreover, in human-robot interactions, a lightweight FLM is safer to humans and has smaller workload requirements on joint drivers, sensors [13, 14], etc. However, such an FLM experiences vibration and elastic deformation during movement, which will greatly affect the stability of the entire system and the positioning accuracy of the end [15, 16]. Therefore, it is important to study the effects of the dynamic characteristics of FLMs, in terms of the vibration suppression and elastic deformation compensation of the flexible links. For example, the dynamic model of a single-joint flexible manipulator has been developed to suppress the vibration of the flexible manipulator [3, 13].

Because multijoint FLMs are highly nonlinear, strongly coupled, multi-degree-of-freedom (DOF) systems, the dynamic modeling is complex. In addition, considering the payload mass at the end of the manipulator and the lumped mass (for example, the mass of the actuators) on each link, multi-DOF rigid-flexible coupling dynamic modeling is more complicated. These challenging topics have attracted a large number of excellent researchers, who have conducted a considerable amount of research on the dynamic modeling of FLMs. In Giorgio and Del Vescovo’s work [17], the lumped parameter method is used to model the dynamics of flexible links, and although this modeling method is simple, the number of elements must be as large as possible to obtain an adequate model accuracy. The modeling and control of a special class of single-link, an arbitrary number of lumped masses, flexible arms is presented in [18], in which the arm consists of massless flexible structures. Subudhi and Morris adopted the Lagrange equation and the assumed mode method (AMM) to establish the dynamic model of a manipulator with flexible links and joints [19]. A dynamic model of 3-PRR parallel manipulator with flexible links based on AMM was proposed in [20]. Wei et al. provided a global mode method for dynamic modeling of a flexible arm flexible joint manipulator with a tip mass [21]. Some other modeling methods, such as the finite element method (FEM), are also commonly used. For example, the dynamic modeling of the flexible links using FEM is presented in [22]. The FEM is used to derive the dynamic equations for finding the maximum allowable dynamic load of flexible-link mobile manipulators [23]. In addition, the Newton–Euler method is also used to dynamically model the flexible arms [24]. Nonlinear dynamics of motion are developed for flexible manipulator links consisting of rotary joints that connect pairs of flexible links [25]. Bascetta et al. developed a closed-form dynamic model of flexible manipulators based on the Newton–Euler equations [26]. However, the dynamic modeling in the above studies only considers flexible arms with a certain number of DOFs or flexible links without payload mass, and the expressions of the dynamic model are still very computationally expensive in practice.

Considering the complexity of the dynamic modeling of multi-DOF FLMs with a lumped mass on the links, a general-purpose dynamic modeling method for N-DOF FLMs based on the Lagrange equation is presented in this paper, and the symbolic expression computation software for the dynamic equations of N-DOF flexible manipulators is developed. In a more general situation, where the lumped mass is located not only on the end of the links but also at other positions of the links (for example, the flexible arms composed of functionally graded materials (FGM) in the fields of spacecraft, nuclear industries, robotics, etc., the flexibility of the arms can be increased or changed, or changing the vibration frequency of the flexible arm structure by adding concentrated mass to the intermediate position of flexible arms, see [27]) is also considered in this paper. The modeling method is as follows. First, the flexible arms are divided into imaginary rigid and flexible parts and modeled separately. Then, the rigid and flexible parts are coupled, and the dynamic model is further simplified. Finally, the simplest general expression of the dynamic model of the flexible arm with N-DOFs is obtained by the induction method, and “symbolic expression computation software for dynamic equations of N-DOF flexible manipulators” is developed using the symbolic calculation software Mathematica. The test results indicate that compared with the traditional modeling method, the proposed modeling method can reduce the computation time by more than 90% and the software can quickly calculate and generate the dynamic model of the flexible manipulator, thereby greatly reducing the difficulty of the dynamic modeling of the flexible manipulator. Finally, the position tracking control experiment of a 2-DOF flexible manipulator is taken as an example and the dynamic model is generated automatically by the program. Meanwhile, a physical model is also constructed. In an experiment on the end effector of the manipulator tracking a trajectory of a circle, the numerical simulation results of the dynamic model are compared with the experimental results. The dynamic model and the dynamic modeling method are both verified to be correct.

The remainder of this paper is organized as follows. In Section 2, the motion of N-DOF FLM systems is described. Then, in Section 3, the dynamic equations of N-DOF FLMs are derived and established. “The symbolic expression computation software for dynamic equations of N-DOF flexible manipulators” is developed in Section 4, in which the dynamic equations of two-DOF FLMs are automatically generated by the program, and the experiments are conducted. Finally, conclusions are drawn in Section 5.

2. Motion of Flexible Links

To study the general situation of dynamic modeling for serial multijoint FLMs and to simplify the derivation process, fixed-base and small-deformation flexible manipulators moving in the vertical plane are the focus of this paper. Before we derive and establish the dynamic model of the multi-DOF FLM, the appropriate float frame for each flexible link should be assigned, as shown in Figure 1.

Details are in the caption following the image
Deformation of link i represented in the float frame {i} and inertial reference frame {0}.
The fixed base of the manipulator is typically treated as the global inertial reference frame and denoted {0}, and the i-th flexible link is associated with the float frame {i}. The x-axis of the float frame {i} passes through the start and end points of the i-th flexible link, and its origin coincides with the end point of the i-th flexible link. Assuming that the length of the i-th flexible link without deformation is Li, the angle between the i-th and i − 1-th links along the x-axis is θi. Thus, according to reference [28], the homogeneous transformation matrix from frame {i} to the coordinate system {i − 1} is derived as
A i i 1 = cos θ i sin θ i L i cos θ i sin θ i cos θ i L i sin θ i 0 0 1 . (1)
In equation (1), the superscript i − 1 of the homogeneous transformation matrix A i i 1 represents the reference frame {i − 1} and the subscript i represents the current frame {i}. Thus, the position vector of an arbitrary point Pi on link i can be expressed in the global inertial frame {0} as
r i 0 = A i 0 r i i , (2)
where A i 0 = A 1 0 A 2 1 A i i 1 , r i i is the position vector of point Pi on link i in float frame {i}, and r i i = x i y i 1 T .
According to the aforementioned assumption, the flexible link here is considered to be an Euler beam with a constant cross section. For a small deformation of the link, because the deflection of the flexible links in the length direction is very small, we can ignore it and only consider the transverse deformation. Because the exact mathematical description and calculation of the flexible link deformation are complex given that the flexible link deformation is infinite dimensional, a finite-dimensional deformation is generally introduced to approximate the link deformation. The assumed mode method (AMM) is adopted in this paper. In the AMM, the elastic displacements yi are generally described by a truncated modal series function and time-dependent mode amplitudes (for example, see [29]) as
y i x i , t = k = 1 s φ i k x i f i k t , (3)
where φik is a k-th-order mode shape function, fik are generalized coordinates with respect to the φik of link i, and s is the number of modes used to describe the deflection of link i.
Generally, this method has sufficient approximation accuracy for small deformations of flexible links when we truncate yi at s = 2. Thus, in the following, we only consider the first second-order mode shape function and its generalized coordinates. For the Euler beam with clamped boundary conditions at both ends of the link, we choose the mode shape function φik = sin(kπxi/Li),   k = 1,2. Thus, equation (3) can be rewritten as
y i = sin π x i L i f i 1 + sin 2 π x i L i f i 2 . (4)
The velocity vector of Pi in frame {0} can be expressed as
r ˙ i 0 = d d t r i 0 = d d t A i 0 r i i = A ˙ 1 0 A 2 1 A i i 1 r i i + A 1 0 A ˙ 2 1 A i i 1 r i i + + A 1 0 A ˙ i i 1 r i i + A i 0 r ˙ i i = j = 1 i A i 0 θ j θ ˙ j r i i + A i 0 r ˙ i i . (5)

In general, the elements in matrix A i 0 are a function of (θ1  θ2   ⋯   θi) and the elements in vector r i i are a function of (fi1  fi2).

Note that the partial derivative of A i 0 with respect to θi can be calculated as
A i i 1 θ i = Q i A i i 1 , (6)
where, for a revolute joint, the matrix Qi is defined as
Q i = 0 1 0 1 0 0 0 0 0 . (7)
The advantage of using Qi is that we can transform the differential operation of A i i 1 / θ i into a constant matrix Qi multiplying the A i i 1 matrix, which can still be used; then, we can obtain
A i 0 θ j = A 1 0 A 2 1 A j 1 j 2 Q j A j j 1 A i j 1 , j i , 0 , j > i . (8)
To simplify the derivation of dynamic equations of multi-DOF FLMs, we can divide the flexible link system into two parts: an imaginary rigid part and an imaginary flexible part. The expressions include the variables θi, representing the rigid part, and the variables fi1 or fi2, representing the flexible part. Now, we imagine that the x-axis of frame {i} from the start point to the end point of flexible link i is a virtual rigid link i, which can be regarded as a rigid link of the flexible link i without deformation; thus, equation (8) can be interpreted as the effect of the motion of joint j on all the points on virtual rigid link i. To simplify the notations, we define
U i j = A i 0 θ j = A j 1 0 Q j A i j 1 , j i , 0 , j > i . (9)
Thus, equation (5) can be rewritten as
r ˙ i 0 = j = 1 i U i j θ ˙ j r i i + A i 0 r ˙ i i . (10)
For multi-DOF manipulators, the dynamic equations are a strongly coupled system; thus, considering the interaction effects between virtual rigid links, we can obtain
U i j k = U i j θ k = A j 1 0 Q j A k 1 j 1 Q k A i k 1 , j k i , A k 1 0 Q k A j 1 k 1 Q j A i j 1 , k j i , 0 , i < j i < k . (11)

Equation (11) can be interpreted as the interaction effects of the motions of joint j and joint k on all points on virtual link i.

3. Derivation of Dynamic Equations for Flexible Links with Lumped Mass

3.1. Calculation of Kinetic Energy

After obtaining the velocity of points on link i, we can calculate the kinetic energy of link i. Assuming that the mass of flexible link i is mi, let T i m be the kinetic energy of link i and let d T i m be the kinetic energy of a particle with differential mass dm on link i; then, we can obtain that
d T i m = 1 2 Tr r ˙ i 0 r ˙ i 0 T d m = 1 2 Tr j = 1 i U i j θ ˙ j r i i + A i 0 r ˙ i i × j = 1 i U i j θ ˙ j r i i + A i 0 r ˙ i i T d m = 1 2 p = 1 i r = 1 i Tr U i p r i i r i i T d m U i r T θ ˙ p θ ˙ r + j = 1 i Tr U i j r i i r ˙ i i T d m A i 0 T θ ˙ j + 1 2 Tr A i 0 r ˙ i i r ˙ i i T d m A i 0 T , (12)
where Tr is a trace operator and Tr X i = 1 n x i i . Now, let us compute the kinetic energy of lumped mass T i M on flexible link i. We assume that the lumped mass can locate at any position on flexible link i. Similarly, we use the same method as equations (10) and (12) and obtain
T i M = 1 2 Tr R ˙ i 0 R ˙ i 0 T M i = 1 2 p = 1 i r = 1 i Tr U i p R i i R i i T M i U i r T θ ˙ p θ ˙ r + j = 1 i Tr U i j R i i R ˙ i i T M i A i 0 T θ ˙ j + 1 2 Tr A i 0 R ˙ i i R ˙ i i T M i A i 0 T , (13)
where Mi is the lumped mass and R i 0 and R ˙ i 0 are the position vector and velocity vector of the lumped mass Mi in the global inertial reference frame {0}, respectively. R i i and R ˙ i i are the position vector and velocity vector of lumped mass Mi in float frame {i}, respectively. Thus, we let R i i = X i Y i 1 T , as shown in Figure 2.
Details are in the caption following the image
Position of lumped mass Mi with different value of μi.
Because we ignore the deformation of the flexible link in the longitudinal direction, the length of flexible link i is always Li. To simplify the derivation, we define Xi = μiLi, μ i 1 , 0 . When μi = 0, lumped mass Mi locates on the end of flexible link i if μi = −(1/2) represents Mi at the middle of flexible link i. Thus, we can obtain R i i = μ i L i Y i 1 T , and according to equation (4), we can obtain
Y i = sin π μ i f i 1 + sin 2 π μ i f i 2 = k = 1 2 f i k S k i . (14)
To simplify the notation, we define Ski = sin(kπμi), k = 1,2. The total kinetic energy of flexible link i and lumped mass Mi can be computed as
T i = L i 0 d T i m + T i M = 1 2 p = 1 i r = 1 i Tr U i p J u i U i r T θ ˙ p θ ˙ r + j = 1 i Tr U i j J v i A i 0 T θ ˙ j + 1 2 Tr A i 0 J w i A i 0 T , (15)
where J u i = J u i m + J u i M , J v i = J v i m + J v i M , and J w i = J w i m + J w i M . Additionally, J u i m is the pseudoinertia matrix of flexible link i, which, for a homogeneous Euler beam, can be calculated as
J u i m = L i 0 r i i r i i T d m = L i 0 x i y i 1 x i y i 1 d m = L i 0 x i 2 x i y i x i x i y i y i 2 y i x i y i 1 d m = L i 2 3 L i 2 f i 1 f i 2 2 π L i 2 L i 2 f i 1 f i 2 2 π 1 2 f i 1 2 + f i 2 2 2 f i 1 π L i 2 2 f i 1 π 1 m i . (16)
As shown, the pseudoinertia matrix J u i m is a function of generalized coordinates f. The variation in the generalized coordinates f can reflect the deformation of the flexible link. Similarly, J u i M is calculated as
J u i M = R i i R i i T M i = X i Y i 1 X i Y i 1 M i = X i 2 X i Y i X i X i Y i Y i 2 Y i X i Y i 1 M i = L i 2 μ i 2 L i μ i k = 1 2 f i k S k i L i μ i L i μ i k = 1 2 f i k S k i k = 1 2 f i k S k i 2 k = 1 2 f i k S k i L i μ i k = 1 2 f i k S k i 1 M i . (17)
Note that x ˙ i = 0 , and we can easily obtain J v i m and J w i m :
J v i m = L i 0 r i i r ˙ i i T d m = 0 L i 2 f ˙ i 1 f ˙ i 2 2 π 0 0 1 2 k = 1 2 f i k f ˙ i k 0 0 2 f ˙ i 1 π 0 m i , J w i m = L i 0 r ˙ i i r ˙ i i T d m = 0 0 0 0 1 2 f ˙ i 1 2 + f ˙ i 2 2 0 0 0 0 m i . (18)
J v i M and J w i M are computed in the same manner:
J v i M = R i i R ˙ i i T M i = 0 L i μ i k = 1 2 f i k S k i 0 0 k = 1 2 f i k S k i k = 1 2 f ˙ i k S k i 0 0 k = 1 2 f ˙ i k S k i 0 M i , J w i M = R ˙ i i R ˙ i i T M i = 0 0 0 0 k = 1 2 f ˙ i k S k i 2 0 0 0 0 M i . (19)

3.2. Calculation of Potential Energy

Let the gravitational potential energy of flexible link i with lumped mass Mi be P i ¯ ; thus,
P i ¯ = m i g r ¯ i 0 + M i g R i 0 = m i g A i 0 r ¯ i i + M i g A i 0 R i i , (20)
where g = g x g y 0 = 0 g 0 is a gravity vector expressed in the inertial reference frame {0} and g is the gravitational constant. Because of the small deformation of the flexible link, the variation in the gravitational potential energy of the flexible link caused by the flexible link’s deformation can be neglected and is small compared with the total gravitational potential energy of the flexible link. Let r ¯ i 0 and r ¯ i i be the mass center vector of flexible link i without deformation in inertial frame {0} and float frame {i}, respectively.
Meanwhile, the elastic potential energy of flexible link i caused by deformation can be expressed as
K i = E i I i 2 L i 0 2 y i x i 2 2 d x i = π 4 E i I i f i 1 2 + 16 f i 2 2 4 L i 3 , (21)
where Ei and Ii are Young’s modulus and the second moment of the area of flexible link i, respectively. Now, from equations (12) to (21), we define the Lagrangian function of FLMs with N-DOFs as
L = i = 1 n T i K i P i ¯ = 1 2 i = 1 n p = 1 i r = 1 i Tr U i p J u i U i r T θ ˙ p θ ˙ r + i = 1 n j = 1 i Tr U i j J v i A i 0 T θ ˙ j + 1 2 i = 1 n Tr A i 0 J w i A i 0 T + i = 1 n m i g A i 0 r ¯ i i + M i g A i 0 R i i 1 2 i = 1 n π 4 E i I i f i 1 2 + 16 f i 2 2 2 L i 3 . (22)
We now apply the Lagrange–Euler formulation to the Lagrangian function of the N-DOF FLM equation (22) to obtain the necessary generalized torque to drive the manipulators:
d d t L q ˙ L q = τ , (23)
where q and q ˙ are a vector of generalized coordinates and its derivative with respect to time, respectively. We define generalized coordinates q = θ f T , θ = θ 1 θ n , and f = f 11 f 12 f n 1 f n 2 , and τ is a 3n × 1 generalized torque vector.

Before we apply the Lagrange–Euler formulation to the Lagrangian function of equation (22), we should note that the transformation matrix A i 0 and the matrix Uij are only functions of generalized coordinates θi,   i = 1,2, …, n; thus, the derivation of A i 0 or Uij with respect to fiλ,   i = 1,2, …, n,   λ = 1,2 will be zero. The matrices Jui, Jvi, and Jwi are only functions of the generalized coordinates fiλ,   λ = 1,2 and generalized velocity f ˙ i λ , λ = 1,2 ; thus, the derivatives of Jui, Jvi, and Jwi with respect to θi,   i = 1,2, …, n will be zero.

First, we only consider the generalized coordinate θ; thus, take θ 1 θ n T as q and substitute equation (22) into equation (23) to obtain the rigid generalized torque vector Fθ:
F θ i = j = i n k = 1 j Tr U j k J u j U j i T θ ¨ k + j = i n λ = 1 2 Tr U j i J v j λ A j 0 T f ¨ j λ + j = i n k = 1 j m = 1 j Tr U j k m J u j U j i T θ ˙ k θ ˙ m + j = i n k = 1 j λ = 1 2 Tr U j k J u j λ U j i T θ ˙ k f ˙ j λ j = i n m j g U j i r ¯ j j j = i n M j g U j i R j j , (24)
where i = 1,2, …, n. Then, we derive the flexible generalized torque vector Ff by substituting equation (22) into equation (23) when considering f 11 f 12 f n 1 f n 2 T as q
F f i λ = j = 1 i Tr U i j J v i λ A i 0 T θ ¨ j + 1 2 m i f ¨ i λ + j = 1 i k = 1 i Tr U i j k J v i λ A i 0 T + U i j J v i λ 1 2 J u i λ U i k T θ ˙ j θ ˙ k + π 4 E i I i 2 λ f i λ + 16 λ 1 f i λ 2 L i 3 M i g A i 0 R i λ . (25)

For i = 1,2, …, n,   λ = 1,2, where Riλ is a partial derivative of R i i with respect to the generalized coordinate fiλ and R i λ = 0 sin λ π μ i 0 T .

Equations (24) and (25) are the dynamic equations of FLMs with N-DOFs. Because the entire process of deriving the dynamic equations from equations (23) to (25) is very complex, we divide the equations into two parts: a rigid part with respect to the generalized coordinate θ and a flexible part with respect to the generalized coordinate f. Therefore, the complexity is greatly reduced. Note that in equations (24) and (25), we should calculate the derivative of the matrices Jui, Jvi, and Jwi with respect to time t because
d J x j d t = J x j f j λ f ˙ j λ , (26)
where x = u, v, w and j = 1,2, …, n and λ = 1,2 because the (Jwj)/fjλ is canceled during the calculation, and thus, we define
J u j λ = J u j f j λ = J u j m f j λ + J u j M f j λ , J v j λ = J v j f j λ = J v j m f j λ + J v j M f j λ . (27)
It is easy to calculate Jujλ and Jvjλ according to the expressions of Juj and Jvj for j = 1,2, …, n,   λ = 1,2:
J u j λ = 2 λ 0 L j π 0 L j π f j λ 2 π 0 2 π 0 m j + 2 λ 0 L j μ j 0 L j μ j 2 k = 1 2 f j k S k j 1 0 1 0 S 1 j + λ 1 0 L j 2 π 0 L j 2 π f j λ 0 0 0 0 m j + λ 1 0 L j μ j 0 L j μ j 2 k = 1 2 f j k S k j 1 0 1 0 S 2 j , J v j λ = 2 λ 0 L j π 0 0 f j λ 2 0 0 2 π 0 m j + 2 λ 0 L j μ j 0 0 k = 1 2 f j k S k j 0 0 1 0 S 1 j + λ 1 0 L j 2 π 0 0 f j λ 2 0 0 0 0 m j + λ 1 0 L j μ j 0 0 k = 1 2 f j k S k j 0 0 1 0 S 2 j . (28)

From equations (24) and (25), we find that there are not only rigid motion terms with θ ¨ i but also flexible motion terms with f ¨ i λ , in addition to the coupling terms between rigid motion θ ˙ i θ ˙ j and rigid motion and flexible link deformation θ ˙ i f ˙ i λ . Notably, there are no flexible deformation coupling terms, which should have been f ˙ i λ f ˙ j λ . This makes solving the dynamic equations easier, and this is an important reason for establishing such float frames to describe the FLMs. In essence, the two equations also reflect the vibration of the FLMs during movement.

3.3. Relationship between the Generalized Forces and Actual Driving Forces

We continue to discuss the relationship between the generalized forces corresponding to the generalized coordinates and the actual forces applied to the manipulator’s joints. As shown in Figure 3, τi,i−1 is the actual force applied to joint i, where the first subscript i denotes the link that the force acts on and the second subscript i − 1 denotes the link that the force reacts on. According to the principle of virtual work, the virtual work acting on link i is
δ W i = τ i , i 1 δ θ i + δ α i + τ i + 1 , i δ β i , (29)
where α i = y i / x i x i = 0 and β i = y i / x i x i = L i ; thus, the total virtual work on all joints is
δ W = i = 1 n τ i , i 1 δ θ i + λ = 1 2 τ n , n 1 φ i λ 0 δ f n λ + i = 1 n 1 λ = 1 2 τ i , i 1 φ i λ 0 + τ i , i + 1 φ i λ L i δ f i λ , (30)
where φ i λ 0 = d φ i λ / d x i x i = 0 and φ i λ L i = d φ i λ / d x i x i = L i , and the generalized forces corresponding to the generalized coordinates θi are
F θ i = τ i , i 1 , i = 1,2 , , n . (31)
Details are in the caption following the image
Torques applied at link i.
The generalized forces corresponding to the generalized coordinates fiλ are
F f i λ = τ i , i 1 φ i λ 0 + τ i + 1 , i φ i λ L i , F f n λ = τ n , n 1 φ n λ 0 , (32)
where i = 1,2, …, n − 1,   λ = 1,2.

3.4. Matrix Form of Dynamic Equations for FLM

To make the dynamic equations easy to understand, we rewrite the equations from equations (24) to (31) in matrix form as
M θθ M θf M M ff θ ¨ f ¨ + H θθ H θf H f 0 22 n × n θ ˙ f ˙ + C r Kf+ C f = F θ F f , (33)
where Mθθn×n, Mθfn×2n, M2n×n, and Mff2n×2n are mass matrices and Hθθn×n, Hθfn×2n, and Hf2n×n are Coriolis and centrifugal matrices. Crn×1 and Cf2n×1 are gravity vectors. K2n×2n is a diagonal stiffness matrix. The detailed expressions are as follows:
M θθ i , k = j = max i , k n Tr U j k J u j U j i T , (34)
where i = 1,2, …, n and k = 1,2, …, n and
M θf i , j , λ = Tr U j i J v j λ A j 0 T , (35)
where i = j = 1,2, …, n,   λ = 1,2. Because we only take the first two mode shape functions and generalized coordinates, we can regard every two-column vector as one group in the matrix Mθfn×2n, and “λ” means the λ-th column vector in the j-th group. Hence, Mθf(i, j, λ) represents the i-th row, j-th group, and λ-th element in the matrix Mθf:
M i , j , λ = Tr U i j J v i λ A i 0 T , (36)
where i = j = 1,2, …, n,   λ = 1,2. From the expression, we find that the matrix M is the transpose of Mθf:
M ff i , i = 1 2 m j , (37)
where i = 1,2, …, 2n,   j = (2i + 1 + (−1)i+1)/4, and mff2n×2n is a diagonal matrix.
H θθ i , k = m = 1 n h θθ i , k , m θ ˙ m , (38)
where i = 1,2, …, n,   k = 1,2, ⋯, n, with
h θθ i , k , m = j = max i , k , m n Tr U j k m J u j U j i T , H θf i , j , λ = k = 1 j Tr U j k J u j λ U j i T θ ˙ k , (39)
where i = j = 1,2, …, n,   λ = 1,2. The computation of the matrix Hθf is the same as that of Mθf:
H f i , j , λ = k = 1 i Tr U i j k J v i λ A i 0 T + U i j J v i λ 1 2 J u i λ U i k T θ ˙ k , (40)
where i = j = 1,2, …, n,   λ = 1,2. The calculation of the matrix Hf is the same as that of the matrix M:
C r i = j = i n m j g U j i r ¯ j j j = i n M j g U j i R j j , (41)
where i = 1,2, …, n.
K i , i = diag π 4 E i I i 2 L i 3 , 16 π 4 E i I i 2 L i 3 , (42)
where i = 1,2, …, n. K2n×2n is a diagonal matrix, and the element K(i, i) is also a 2 × 2 diagonal matrix.
C f i , λ = M i g A i 0 R i λ , (43)
where i = 1,2, …, n,   λ = 1,2. Here, we also regard every two-row vector as one group, similar to equation (35). Thus, Cf(i, λ) represents the i-th group, λ-th element of the matrix Cf.
We now rewrite equation (33) in a more compact and general matrix form as
M q ¨ + H q , q ˙ q ˙ + N q = F , (44)
where M3n×3n is the mass matrix, the matrix H3n×3n consists of the centrifugal force and Coriolis force, the column vector N3n×1 denotes the gravitational and elastic force, and F3n×1 is a generalized force.

3.5. Symbolic Expression Calculation Procedure

The complete symbolic expression of the rigid-flexible coupling dynamic equation of the N-DOF flexible manipulator with the lumped mass on an arbitrary location of links has been obtained. According to the whole derivation process of this paper and from equations (33) to (44), software that can automatically generate the rigid-flexible coupling dynamic equation of an N-DOF flexible manipulator is developed by using Wolfram Mathematica symbolic calculation software. The operating interface of the software is shown in Figure 4.

Details are in the caption following the image
Operating interface of symbolic expressions calculation software.
In the program interface, only the number of N-DOFs, the arm length, the section inertia moment, the elastic modulus, the mass of the flexible arm, the symbolic parameters of the end mass, and the location of the lumped mass are input. According to the program, the symbolic expression of the dynamic equation of the flexible manipulator with N-DOFs can be obtained conveniently and quickly. Here, we rearrange the symbolic expression computation procedures as follows:
  • (i)

    Step 0. Initialization of the algorithm

  • The number of DOFs and the parameters of the FLM, such as N, mi, Mi, Li, Ei, Ii, θi, μi, are predefined

  • Computation of

  • Jui, Jvi, Jwi, Juiλ, Juiλ, Q, g are predefined

  • A i i 1 and A i 0 from (1); r i 0 from (2)

  • Uij from (9); Uijk from (11)

  • (ii)

    Step 1. Computation of the global mass matrix

  • Computation of

  • Mθθ from (34); Mθf from (35)

  • M from (36); Mff from (37)

  • (iii)

    Step 2. Computation of the global matrices of the centrifugal and Coriolis forces

  • Computation of

  • Hθθ from (38); Hθf from (39)

  • Hf from (40)

  • (iv)

    Step 3. Computation of the global vector of the gravity, stiffness matrix, and generalized force

  • Computation of

  • Cr from (41); Cf from (43)

  • K from (42)

  • Fθ from (31); Ff from (32)

  • (v)

    Step 4. Postprocessing of the result

  • Simplicity of the dynamic model: some terms can be ignored for special situations

  • Output of the symbolic expression for the model.

The flowchart of the symbolic expression computation procedures of the dynamic equation of the flexible manipulator with N-DOFs is shown in Figure 5.

Details are in the caption following the image
Flowchart of symbolic expressions calculation procedures.

3.6. Comparison with Traditional Modeling Methods

The traditional dynamic modeling methods of flexible manipulators include the Lagrange method, Newton–Euler method, and Kane method, which have their advantages and disadvantages. In this paper, the traditional modeling method is compared with the proposed method, which is also based on the Lagrange equation. The traditional modeling method is as shown in [19].

The traditional modeling method is relatively simple, but it is quite complex in terms of the actual calculation process for solving the dynamic model expression and there is no general formula for flexible manipulators with different DOFs. Therefore, it often takes substantial time to calculate the dynamic model of various types of flexible manipulators in practice.

Here, the program developed in Section 3.5 is tested. Additionally, according to the modeling method in [19], the calculation programs for flexible manipulators with different DOFs developed using Mathematica are also tested. The time required for the two modeling methods to run the computational program (on a PC with a i3-7100 3.90 GHz CPU with 8 GB of RAM) was tested when N = 1, 2, …, 5. The comparison results are shown in Table 1.

Table 1. Required computation time of two modeling methods for different DOF models.
DOF Proposed method (s) Traditional method (s) Time saved (%)
N = 1 t = 0.36 t = 41.63 99.12
N = 2 t = 0.92 t = 106.28 99.17
N = 3 t = 4.21 t = 212.57 98.01
N = 4 t = 21.3 t = 365.28 94.14
N = 5 t = 114.6 t = 1316.45 91.29

As shown in Table 1, the modeling method proposed in this paper can reduce the modeling time by more than 90% compared with the traditional modeling method. This result is mainly because in the traditional modeling process, the Lagrange energy function of the manipulator system requires a large number of integral operations; then, in the derivation of the generalized coordinates, there are many differential operations. Moreover, there are many repeated intermediate calculations in the differential calculations. The method proposed in this paper eliminates the repetitive intermediate calculation process theoretically and directly derives the simplest expression of the dynamic model equation.

Note that to explain the modeling method proposed in this paper, the simplest planar flexible manipulator is selected as the research object. However, from the entire modeling process shown above, the flexibility characteristics of rigid-flexible coupling manipulators are related only to the matrices Jui, Jvi, and Jwi and their derivatives. Thus, for the dynamic modeling of complex spatial flexible manipulators, large-deformation flexible arms, or even irregularly shaped flexible links, we only need to modify the matrices Jui, Jvi, and Jwi and their derivatives. The structure of the symbolic expressions remains unchanged; thus, this dynamic modeling approach also has good portability. It can be predicted that to satisfy the increasingly complex working conditions, the structure of the flexible arm will be more complex, and it will be a difficult problem to establish a sufficiently accurate dynamic model. Therefore, the modeling method proposed in this paper will have substantial advantages in terms of modeling convenience and computational efficiency.

4. Experimental Study

To verify the correctness of the modeling method proposed in this paper, the dynamic model of a 2-DOF flexible manipulator is automatically generated using the software. Simultaneously, a flexible manipulator experimental platform is set up, as shown in Figure 6. Figure 7 is a schematic diagram of the assembly structure of the flexible arm device.

Details are in the caption following the image
Physical model of 2-DOF flexible manipulators.
Details are in the caption following the image
Schematic diagram of the assembly structure of 2-DOF flexible manipulators.

The expressions of the dynamic equations for the 2-DOF flexible manipulator are shown in the appendix. The symbols in the formula are the same as those in the derivation process.

In this experiment, the two arms of the flexible manipulator are controlled to follow the given trajectories. The torque τref output from the controller and the angles q of the joints of the flexible manipulator measured by the encoders are recorded. Simultaneously, the angles are transmitted to the dynamics simulation model, and the estimations of the control torques τest are calculated for comparison with the actual situation. The whole experimental scheme and recorded data are shown in Figure 8. Figure 9 is a schematic diagram of the experimental signal acquisition and control.

Details are in the caption following the image
Experimental scheme and data recording.
Details are in the caption following the image
Schematic diagram of the experimental signal acquisition and control.

According to the scheme shown in Figure 8, the Simulink control model is established and compiled into a “.so file,” the input and output (IO) interface between the control model and the real manipulator is configured using VeriStand, and finally, all the related control model files are downloaded to the real-time cRIO-9035 controller. The output torque calculated by the controller is converted into a PWM signal by dividing the motor torque constant and the gear ratio of the reducer. A 40 MHz FPGA chip is mounted onto the back of the control slot to acquire the high-speed pulse signal produced by the encoders through the digital IO interface. The motors, gears, and drivers are manufactured by Times Brilliant in China. The type of brushless DC motor 1 with the power of 150 W and brushless DC motor 2 with the power of 100 W is 57BL95S15-230TF9B and 57BL75S10-230TF9, respectively. The type of driver 1 and driver 2 is ZM-6610M. Reduction ratios of PX series planetary gears matched with motors are 64 and 32, respectively. The other specific parameters of the components in the experimental device are listed in Table 2.

Table 2. Parameters of components in the experimental devices.
Parameters Values
Length of arms (L1, L2(m)) 0.475, 0.435
Mass of arms (m1, m2(kg))  0.374, 0.29
Young’s modulus of arms (E1, E2(GPa)) 2.06 × 1011
Second moment of area of arms (I1(m4)) 16 × 10−11
Second moment of area of arms (I2(m4)) 6.75 × 10−11
Lumped mass of joints (M1, M2(Kg)) 2.94, 0.343
Torque values of motors (τ1, τ2(Nm)) 0.5, 0.32
Gear reduction ratio (r1, r2) 64,32
Coulomb friction of actuators (kc1, kc2(Nm)) 0.0345, 0.0226
Viscous friction of actuators (kv1, kv2(Nms/rad)) 0.0037, 0.0023

4.1. Case 1: Free Vibration of the End

In the experiment, the initial working positions of the flexible manipulator are selected as θ1 = 45 and θ2 = −45. At the beginning, the external support makes the manipulator as free as possible from gravity and the second flexible manipulator keeps the horizontal position. Then, the flexible manipulator system is allowed to vibrate freely under the force of gravity, and the acceleration of the end of the flexible manipulator under free vibration is observed and recorded. In addition, the accelerometer type is WT901C485, the acquisition time and sampling time are 10 s and 20 ms, respectively, and the simulation interval of Simulink is 0.001 s. The measured acceleration graph is compared with the simulation graph, as shown in Figure 10(a). It is apparent that there are very good correlations between the measured values and simulated values and the amplitude of simulation is smaller, which can be due to model approximation and initial attitude error between the simulation model and the physical model. The spectrum of the end acceleration curve of the simulation model is obtained by fast Fourier transform, as shown in Figure 10(b). It can be seen that the first-order vibration frequency is ω1 = 12.246 rad/s and the second-order vibration frequency is ω2 = 40.82 rad/s. From the experiment, it is obvious that the simulation curves are basically consistent with the experimental curves, which verifies the correctness of the proposed modeling method to some extent. The similar results of vibration characteristics of flexible manipulators can be referred to [30], which can be used to compare with these experimental results.

Details are in the caption following the image
(a) Acceleration of flexible link’s tip. (b) The spectrum of the flexible link’s tip acceleration.
Details are in the caption following the image
(a) Acceleration of flexible link’s tip. (b) The spectrum of the flexible link’s tip acceleration.

4.2. Case 2: End Effector Tracking a Trajectory of Circle

In this experiment, the initial working positions of the flexible manipulator are selected as θ1 = 45 and θ2 = −45. A circle with a radius of 0.1 m in the XOY plane is selected as the end track of the flexible arm, as shown in Figure 11. The equations of the circle are x = x0 + 0.1 cos(0.2πt), y = y0 + 0.1 sin(0.2πt), whereas the center coordinate of the circle is (x0, y0), x0 = 0.67m , y0 = 0.34m . The end of the flexible arm is substituted into the inverse equation of rigid kinematics, and the desired joint angles are obtained by real-time operation. In addition, the simple PD control is adopted in the cRIO-9035 controller to make the joints track the desired angles, in which kp and k  d were debugged through repeated simulation experiments and finally determined to be kp = 125 and k  d = 25, and the calculation interval is 0.001 s. Figures 12(a) and 12(b) are the angle curves of joint 1 and joint 2. It can be seen from the figures that when the flexible arm starts to move, the experimental curve and the simulation curve have some errors, and then the errors gradually decreases and the curves tracking effect is better. The input torque curves of the joint 1 and the joint 2 are as shown in Figures 13(a) and 13(b), and the vertical acceleration curves of the flexible arm 1 and the flexible arm 2 are as shown in Figures 14(a) and 14(b). It can be seen that the torque simulation curves and the experimental curves follow the same trend, and there are small tracking errors, due to the inevitable vibration of the flexible mechanical arm during the tracking process, the acceleration will cause frequent fluctuations, but the simulation curve and the experimental curve can also achieve a better tracking effect on the whole. The main cause of some vibration of the manipulator during movement is that, to simplify the control model, the distance between the output shafts of two motors is regarded as the arm length of the flexible arms, the mass of the motor reducers is treated as the lumped mass, and the unavoidable clearance of the motor reducers makes the simulation model and the actual model have certain errors, but these errors are within acceptable ranges.

Details are in the caption following the image
Reference trajectory in the workspace.
Details are in the caption following the image
(a) Angle of joint 1. (b) Angle of joint 2.
Details are in the caption following the image
(a) Angle of joint 1. (b) Angle of joint 2.
Details are in the caption following the image
(a) Torque of joint 1. (b) Torque of joint 2.
Details are in the caption following the image
(a) Torque of joint 1. (b) Torque of joint 2.
Details are in the caption following the image
(a) Acceleration of tip of link 1. (b) Acceleration of tip of link 2.
Details are in the caption following the image
(a) Acceleration of tip of link 1. (b) Acceleration of tip of link 2.

5. Conclusions

A general modeling method for the dynamic equations of an N-DOF flexible manipulator based on the Lagrange equation and the small deformation assumption of an Euler beam is proposed in this paper. According to this modeling method, symbolic calculation software for the dynamic equations of N-DOF flexible manipulators is developed, greatly reducing the computational complexity. Compared with the traditional modeling method, the modeling time can be reduced by more than 90%. Finally, the correctness of the modeling method is verified by experiments.

The modeling method proposed in this paper takes the planar flexible manipulator as the research object, but according to the modeling process, it can be applied to the more complex rigid-flexible coupling dynamic modeling of flexible manipulators only through modifying the corresponding matrices of the flexible part. This is also future work that needs to be studied. Simultaneously, the modeling method proposed in this paper is also helpful for the dynamic modeling of N-DOF spatial flexible manipulators, large deformation flexible manipulators, etc.

Conflicts of Interest

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

Acknowledgments

This work was supported by the Development and Demonstration of Intelligent Slag Feeder Robot for Continuous Casting Crystallizer, Hubei Science and Technology Support Plan (grant no. 2015BAA023).

    Appendix

    The dynamic equations for the 2-DOF flexible manipulator are shown as follows:
    M θ θ = 2 A ¯ + B ¯ + C ¯ A ¯ + B ¯ A ¯ + B ¯ B ¯ , (A.1)
    M θ f = L 1 m 1 π L 1 m 1 2 π m 2 L 2 + 2 L 1 cos  θ 2 π L 2 m 2 2 π 0 0 L 2 m 2 π L 2 m 2 2 π , (A.2)
    M f f = diag m 1 , m 1 , m 2 , m 2 , (A.3)
    H θ θ = D ¯ 1 2 π L 1 θ ˙ 2 2 θ ˙ 1 + θ ˙ 2 1 2 π L 1 θ ˙ 1 2 , (A.4)
    H θ f = m 1 θ ˙ 1 i = 1 2 f ˙ 1 i f 1 i + E ¯ + F ¯ 2 θ ˙ 1 + θ ˙ 2 E ¯ + F ¯ θ ˙ 1 , (A.5)
    H f = m 1 θ ˙ 1 2 f 11 2 m 1 θ ˙ 1 2 f 12 2 m 2 2 π 4 L 1 sin  θ 2 θ ˙ 1 2 + π θ ˙ 1 + θ ˙ 2 2 f 21 m 2 θ ˙ 1 + θ ˙ 2 2 f 22 2 , (A.6)
    C = 1 2 g L 1 m 1 + 222 m 2 + M 1 + M 2 cos  θ 1 + G ¯ G ¯ , (A.7)
    K = diag π 4 E 1 I 1 2 L 1 3 , 8 π 4 E 1 I 1 L 1 3 , π 4 E 2 I 2 2 L 2 3 , 8 π 4 E 2 I 2 L 2 3 , (A.8)
    F = τ 1 , τ 2 , π τ 1 τ 2 L 1 , 2 π τ 1 + τ 2 L 1 , π τ 2 L 2 , 2 π τ 2 L 2 T . (A.9)
    The matrix Mfθ is omitted in the above expressions because M f θ = M f θ T , which yields
    A ¯ = m 2 + 2 M 2 L 1 L 2 π  cos  θ 2 2 + 2 L 1 m 2  sin  θ 2 f 21 π , B ¯ = m 2 + 3 M 2 L 2 2 3 + m 2 f 21 2 + f 22 2 2 , C ¯ = m 1 3 + m 2 + M 1 + M 2 L 1 2 + 1 2 m 1 f 11 2 + f 12 2 , D ¯ = m 2 + 2 M 2 L 2 π  sin  θ 2 4 m 2  cos  θ 2 f 21 , E ¯ = m 2 θ ˙ 1 + θ ˙ 2 i = 1 2 f ˙ 2 i f 2 i , F ¯ = 2 m 2 L 1 f ˙ 21 θ ˙ 1  sin  θ 2 π , G ¯ = 1 2 g L 2 m 2 + 2 M 2 cos θ 1 + θ 2 . (A.10)

    Data Availability

    The data used to support the findings of this study are available from the corresponding author upon request.

      The full text of this article hosted at iucr.org is unavailable due to technical difficulties.