Professional Documents
Culture Documents
Control of A Two-Link Rigid-Flexible Manipulator
Control of A Two-Link Rigid-Flexible Manipulator
Abstract—This paper investigates the motion control of two with the tip output which is introduced in [3]. In order to
link (rigid-flexible) manipulator through analysis, computer sim- deal with the exact tracking problem many researchers have
ulation. An explicit nonlinear dynamic model is developed using been proposed the non-causal controllers for the purpose of
assumed mode method. The balance of moments and shear forces trajectory tracking.
are represented by using the boundary conditions. The dynamic
model is linearized around the operating point of the system. The goal of this study is to present an approach to the
The linear feedback plus model based feed-forward control is control of two link rigid-flexible manipulators moving along
developed as well, based on three different measurements. The predefined paths, based on joints angles and tip deflection
joint angles and the tip deflection are used in this study. The feedbacks. Spectral approximation methods for modelling of
control inputs are generated using linear dynamic model. The rigid flexible manipulators are studied in [5]. The Lagrange
simulation results of proposed control are compared with those of
PD control, in order to show the efficiency of the developed model
equation is approximated then an experimental setup is done
and the proposed controller. As a future work; the proposed to validate the derived mathematical model. Various control
controller will be tested using two link (rigid-flexible) test-rig. strategies have been proposed for rigid-flexible manipulators
as reviewed in [6].The performance of joint proportional,
I. I NTRODUCTION derivative (PD) controller using of a non-model based is
demonstrated also in [6]. Trajectory tracking and various
The modeling and motion control of flexible link manipu- implementation issues are also discussed in the research. A
lators have been studied interestingly by many researchers in controller design used a quantitative feedback theory for two
the last two decades. Several reasons made the field attractive link rigid-flexible manipulators is presented in [7]. The end
for the researchers such as: low weight to payload ratio, point deflection is compensated using piezoelectric transducer.
power consumption, high-speed manipulation and increased An adaptive control based on motors and transducer actuators
productivity [1] . On the other hand, the main problem related using a nonlinear dynamic model is presented in [8]. The
to flexible manipulator in operation is mainly due to the stability of the proposed controller is studied using lyponov
requirement of having a stable closed-loop system [4]. In order theory.
to have less control problems the designers of conventional
robots have designed the manipulators more rigid using bulky In this paper the nonlinear mathematical model is derived
structures. The desirable objectives to be achieved for flexible using Lagrange method and assumed mode method to express
manipulators are exact, high-speed manipulation. This means the deflection in the second link. The dynamic model is
precise and stable control of flexible manipulator end effector; linearized around the operating point of the system for the
which requires the elastic deflection effects due to the flexi- sake of controller design. The state space model form is
bility of the arms to be included in the dynamic equations of used in this work for simulation. The controller proposed
motion. In general, the analysis and design of flexible robot in this work consists of an output feedback controller plus
control is more complicated in comparison to rigid robots. model based feed-forward controller. The desired trajectory is
In flexible link manipulators, more difficulty will arise when designed to test the efficiency proposed controller. The paper is
trying to follow a specific tip position trajectory by applying organized as follows: the mathematical model derivation will
the torque to the joints actuators. be presented, in the next section (II) . The proposed controller
model will be detailed later in section (III). Then the case
Several control strategies have been presented by many study parameters and simulations will be discussed in details
researchers in order to solve the control problem of flexible (IV). Finally, some conclusion regarding this work addressed
link robot. The end-point vibration compensation problem in the last section.
through the output redefinition to reduce tracking errors is
addressed in [2]. The authors in [2] have been shown that II. M ATHEMATICAL M ODEL
the nonlinear flexible-link system is not globally linearizable,
however the system is locally input-state feedback linearizable. The dynamic model of two link (rigid-flexible) robot shown
The control objective is not just to drive the manipulator to in Figure (1) is outlined in this section. The motion of the robot
a specific point and stabilize the vibrations. The controller is assumed as a rotation on a horizontal plane. The first link
should concern about the specified path to follow. For a single is rigid and the joint variable is 𝜃1 (𝑡). The second link of the
link flexible arm, an optimal control approach is candidate robot is flexible. The variables related to the flexible link are
to succeed [3]. The non-minimum phase property of flexible 𝑤(𝑥, 𝑡) and 𝜃2 (𝑡), which are the deformation of the flexible
robot has not addressed in pseudo link concept associated link and the joint’s angle respectively. The axis 𝑂 − 𝑥, of the
Authorized licensed use limited to: Ritsumeikan University. Downloaded on April 20,2023 at 10:08:34 UTC from IEEE Xplore. Restrictions apply.
𝑥2 The dynamic model is derived using Lagrangian technique
in conjunction with assumed mode method [12]. The model
𝑦2 𝑥 , 𝑡) consists of nonlinear partial differential equations, which can
𝑤( be obtained using some approximation. The equations of mo-
tion is derived using the Lagrangian technique, the constrained
motion of the rigid-flexible can be described as:
𝑀 (𝑞)¨
𝑞 + 𝐻(𝑞, 𝑞)
˙ 𝑞˙ + 𝐾𝑞 + 𝐷𝑞˙ = 𝑢.
𝑙2
(5)
721
Authorized licensed use limited to: Ritsumeikan University. Downloaded on April 20,2023 at 10:08:34 UTC from IEEE Xplore. Restrictions apply.
[ ]
𝐶 = 𝐶1 03×4 . The control law of equation (10) will lead to a full
compensation of the rigid body interactions, the desired joint
In (8) the state vector is written as: 𝑧 = acceleration calculation will be explained later. The control
[Δ𝜃1 Δ𝜃2 Δ𝛿1 Δ𝛿2 Δ𝜃˙1 Δ𝜃˙2 Δ𝛿˙1 Δ𝛿˙2 ]T . Matrix 𝐺 is law schematic diagram is shown in figure (3).
a constant matrix related to the input signals which is chosen
in this work as: In order to obtain an improved joint error; a full dynamic
[ ] has been taken into account (𝐶𝑇 𝐹 ). By inverting the state
1 0 0 𝜙´1 (0) space dynamic model (8) at the joint level a new control
𝐺= .
0 1 0 𝜙´2 (0) law can be computed. Substituting the 𝜃 = 𝜃𝑑 in (8), the
state vector can be integrated using zero initial conditions to
The state space form is used later for the simulation of estimate 𝛿𝑑 and 𝛿˙𝑑 off-line. Then the control law in this case
the robot system. Then the feedback can be changed to be can be rewritten as:
appropriate with the control type.
𝑢𝑓 (𝑡) = 𝑀𝜃𝜃 𝜃¨𝑑 + 𝑀𝜃𝛿 𝛿¨𝑑 + 𝑢𝑃 𝐷 (𝑡). (11)
III. C ONTROLLER D ESIGN
Since the zero dynamics of the system exponentially stable
The computed torque method based on PD feedback con- [4]; a bounded solution for the deformation variables is pro-
trol plus model based feed-forward signals is used in this work duced. The schematic diagram for the control law shown in
to control the motion of the robot system. With the addition of figure (4).
a feed-forward term tracking accuracy can be improved and the
compensation of dynamic non-linearity and interactions will be 𝜃¨𝑑
𝑀𝜃𝜃
relaxed [13]. Different alternatives are possible, based either on
a part or on the whole available model. Two computed torque
𝜃𝑑 ,𝜃˙𝑑 State Space 𝛿¨𝑑
methods are presented in this section, the compensation of 𝑀𝜃𝛿
the rigid body interactions is included in the first one. In the Model
second the full dynamic model is used in order to improve the + +
Desired + PD + Robot
joint error. Controller 𝑢𝑃 𝐷 𝑢𝑓 Plant 𝑦𝑚
Value
-
The proportional-derivative (PD) control law for tracking
𝜃 , 𝜃˙
joint trajectory error [2] is:
𝑢𝑃 𝐷 (𝑡) = 𝐾𝑃 (𝜃𝑑 (𝑡) − 𝜃(𝑡)) + 𝐾𝐷 (𝜃˙𝑑 (𝑡) − 𝜃(𝑡)).
˙ (9) Fig. 4. PD plus feed-forward controller includes full dynamic model.
722
Authorized licensed use limited to: Ritsumeikan University. Downloaded on April 20,2023 at 10:08:34 UTC from IEEE Xplore. Restrictions apply.
[ ]
878.03 0 the system. The initial motion of the joint angles are due to
𝐾𝛿𝛿 = , and 𝐷𝛿𝛿 =
[ ] 0 8180.6 initial deflection of the second flexible link; still the controller
0.07𝑤1 0 compensates the initial deflection of the link well very fast.
.
0 0.03𝑤2
(a)
(a) 100
100
𝜃1 [deg]
𝜃𝑑 [deg]
50
50
0
0 0 2 4 6 8 10
0 1 2 3 4 5
(b) (b)
80
1
𝜃˙𝑑 [rad/sec]
60
𝜃2 [deg]
0.5
40
0
20
−0.5
0 1 2 3 4 5
0
0 2 4 6 8 10
(c)
2
(c)
𝜃¨𝑑 [rad/sec2 ]
1
Tip-deflection [m] 0.1
0
0
−1
−0.1
−2
0 1 2 3 4 5
−0.2
Time[sec]
0 2 4 6 8 10
Time[sec]
Fig. 5. The desired joint angles and derivatives, joint1, joint2.
723
Authorized licensed use limited to: Ritsumeikan University. Downloaded on April 20,2023 at 10:08:34 UTC from IEEE Xplore. Restrictions apply.
(a) (a)
5
10
𝑃 𝐷 [N.m]
𝑃 𝐷 [deg]
0
0
−10
−20
−5
0 2 4 6 8 10 0 2 4 6 8 10
(b) (b)
5
𝐶𝑇 𝑅 [N.m]
0
𝐶𝑇 𝑅 [deg]
0
−10
−20 −5
0 2 4 6 8 10 0 2 4 6 8 10
(c) (c)
5
𝐶𝑇 𝐹 [N.m]
0
𝐶𝑇 𝐹 [deg]
0
−10
−20 −5
0 2 4 6 8 10 0 2 4 6 8 10
Time[sec] Time[sec]
Fig. 7. Joints error 𝜃𝑑 − 𝜃𝑖 for the controlled behavior of robot system, Fig. 8. Controlled joint torques, joint1, joint2.
joint1, joint2.
724
Authorized licensed use limited to: Ritsumeikan University. Downloaded on April 20,2023 at 10:08:34 UTC from IEEE Xplore. Restrictions apply.