Beruflich Dokumente
Kultur Dokumente
Abstract—Robots are now an integral part of automation of manufacturing and the power consumption of the system.
sector, thus indicating the importance of the associated control But with flexibility come a varying degree of inaccuracies in
strategies. In contrast with conventional rigid manipulators, the robotic arm such as increased settling time, especially at
flexible arms offer several benefits in terms of light weight and
power efficient structure, safe operation due to reduced inertia, the end point. Fig. 1 illustrates a hardware benchmark with a
low manufacturing cost and faster movements. The present paper flexible joint module developed by Quanser.
proposes a linear control law based on Proportional Integral
Derivative (PID) technique to control flexible manipulators. In Springs Link
particular, flexibility in joint is discussed highlighting the control
challenges. Tuning of the controller is based on the derived dy-
namic model using Lagrange approach. The proposed control law
is then implemented on a custom-developed platform. Trajectory
tracking results witnessed effectiveness of the developed control
strategy in terms of reducing undesirable vibrations thereby
increasing precision in the flexible manipulator. It is anticipated
DC Motor
that the results obtained have enormous potential in applications
involving flexible manipulator. Gears
Rotary Base
Index Terms—Robotics, Flexible robotic arm, Control tech-
niques, Proportional Integral Derivative, Control.
978-1-5386-0922-4/18/$31.00 ⃝
c 2018 IEEE
gain margin. However, it cannot deal systematic uncertainties By substituting (2) and (3), the difference of energies can be
like 𝜇-synthesis and 𝐻∞ [23]. Linear approaches because rewritten as
of their simplicity are still the main workhorse in industry 1 1 1
even today [24]. The objective of the paper is to design a 𝐿 = 𝐽𝑒𝑞 𝜃˙2 + 𝐽𝐿 (𝜃˙ + 𝛼) ˙ 2 − 𝐾𝑠 (𝛼2 ) (4)
2 2 2
PID controller for a flexible robotic arm in order to reduce The Euler Lagrange equation is given by
undesirable vibrations at the end-point. ( )
𝑑 ∂𝐿 ∂𝐿
− = 𝑄𝑖 (5)
The remaining paper constitutes of following sections: Sec- 𝑑𝑡 ∂𝑞𝑖 ∂𝑞𝑖
tion II explains the details and categorization of flexible robotic [ ]𝑇 [ ]
where, 𝑞𝑖 = 𝜃 𝛼 and 𝑄𝑖 = 𝜏 − 𝐵𝑒𝑞 𝜃˙ 𝐵𝐿 𝛼˙ are
arm, while Section III presents the proposed control design
generalized coordinates and forces acting on the arm. Taking
for a flexible robotic arms. Section IV explains the design
partial derivative of L with respect to 𝑄𝑖 and putting in (5),
and fabrication of prototype. The software and hardware
we get:
simulations are provided in section V. Finally Section VI
presents some comments and conclusions. 𝐽𝑒𝑞 𝜃¨ + 𝐽𝐿 (𝜃¨ + 𝛼
¨ ) = 𝜏 − 𝐵𝑒𝑞 𝜃 (6)
𝐽𝐿 (𝜃¨ + 𝛼
¨ ) + 𝐾𝑠 𝛼 = 𝐵𝐿 𝛼˙ (7)
II. M ATHEMATICAL M ODEL
Using kirchhoff’s laws, the load torque cab be written as
Euler Lagrangian method is utilized to develop the mathe-
matical model for the flexible robot system as shown in Fig.2. 𝑘𝑔 𝑘𝑚 𝑉 − 𝑘𝑚 𝑘𝑡 𝑘𝑔2 𝜃˙
𝜏= (8)
𝑅𝑚
By substituting (8), (6) can be written as
𝑘𝑔 𝑘𝑚 𝑉 − 𝑘𝑚 𝑘𝑡 𝑘𝑔2 𝜃˙
𝐽𝑒𝑞 𝜃¨ + 𝐽𝐿 (𝜃¨ + 𝛼
¨) = − 𝐵𝑒𝑞 𝜃 (9)
𝑅𝑚
Fig. 2: Schematic model of flexible robotic arm (7) and (9) can be a
represented in state space form as
Various parameters used in modelling are listed in Table 1. 𝑥˙ 1 =𝑥2
𝐾𝑠 𝐵𝐿 𝐾𝑠 𝐵𝐿
TABLE I: Nomenclature 𝑥˙ 2 = − 𝑥1 + 𝑥2 + 𝑥3 − 𝑥4
𝐽𝐿 𝐽𝐿 𝐽𝐿 𝐽𝐿
Symbol Description Units 𝑥˙ 3 =𝑥4
𝐼 Current flowing inside the motor A ( )
𝑉𝑚 Voltage applied to the motor V 𝐾𝑠 𝐵 𝐿 𝐾𝑆 𝑘𝑚 𝑘𝑡 𝑘𝑔2 𝐵𝐿 + 𝐵𝑒𝑞
𝑅𝑚 Ω 𝑥˙ 4 = − 𝑥1 + 𝑥2 𝑥3 − − 𝑥4
Armature resistance 𝐽𝑒𝑞 𝐽𝑒𝑞 𝐽𝑒𝑞 𝑅𝑚 𝐽𝑒𝑞 𝐽𝑒𝑞
𝑘𝑚 Motor back EMF constant V.s
𝑘𝑔 High gear ratio of motor – 𝑦 =𝑥1 + 𝑥2 (10)
𝑉𝑚 Motor voltage V
𝜏 Motor torque N.m Generally, (10) can be written as
𝜃 Angle of DC gear motor rad
𝛼 Angle of flexible joint rad 𝑥˙ =𝐴𝑥 + 𝐵𝑢
𝐵𝑒𝑞 Viscous fraction coefficient of manipulator N.m.s/rad
𝐵𝐿 Viscous fraction coefficient of the link N.m.s/rad 𝑦 =𝐶𝑥 + 𝐷𝑢 (11)
𝐾𝑠 Stiffness of spring N/m ⎡ ⎤
𝐽𝑒𝑞 Total moment of inertia of manipulator 𝐾𝑔𝑚2 0 1 0 0
𝐽𝐿 𝐾𝑔𝑚2 ⎢ − 𝐾 𝑠 𝐵𝐿 𝐾 𝑠 −𝐵 𝐿 ⎥
moment of inertia of the link ⎢ 𝐽 𝐽𝐿 𝐽𝐿 𝐽𝐿 ⎥
where 𝐴 = ⎢ 0 𝐿 0 0 1 ⎥,
⎣ ⎦
𝐾𝑠 𝐵𝐿 𝐾𝑠 𝑘𝑚 𝑘𝑡 𝑘𝑔2 𝐵𝐿 +𝐵𝑒𝑞
Lagrange equation deals with the difference of kinetic and − 𝐽𝑒𝑞 𝐽𝑒𝑞 𝐽𝑒𝑞 −
⎡ ⎤ 𝑅𝑚 𝐽𝑒𝑞 𝐽𝑒𝑞
the potential energies and is given by 0
⎢ 0 ⎥ [ ] [ ]
𝐿=𝑇 −𝑉 (1) ⎢ ⎥
𝐵 = ⎢ 𝑘𝑔 𝑘𝑚 ⎥, 𝐶 = 1 1 0 0 and 𝐷 = 0
⎣ 𝑅𝑚 𝐽𝑒𝑞 ⎦
where 𝑇 and 𝑉 are rotational kinetic energy and elastic 𝑘𝑔 𝑘𝑚
− 𝑅𝑚 𝐽𝑒𝑞
energies respectively and can be expressed as
III. C ONTROL D ESIGN
1
𝑇 = 𝐽𝜔 2 Among the linear control techniques, PID is most commonly
2
1 1 used in industry nowadays because of simplicity and ease
= 𝐽𝑒𝑞 𝜃˙2 + 𝐽𝐿 (𝜃˙ + 𝛼)
˙ 2 (2) in control. In the present work, simulations were carried
2 2
out in MATLAB/Simulink to show the performance of PID
and
1 controller. The PID-Tuner block tunes the values of the PID
𝑉 = 𝐾𝑠 (𝛼2 ) (3) constants i.e. 𝐾𝑝 , 𝐾𝑖 and 𝐾𝑑 to find the appropriate values
2
which would produce a stable response. Fig. 3 illustrates the the pseudo code given in Algorithm 1. The output of this
block diagram of PID control scheme. block is passed to a Pulse Width Modulation (PWM) function
which controls motor speed. This process continues until the
reference angle is achieved where the loop breaks.
IV. D ESIGN AND FABRICATION OF P ROTOTYPE
The simulated control law is then implemented on a custom-
designed indigenously developed platform. The first step is to
design the CAD model of the flexible robotic arm shown in
Fig. 5.
Angle (degree)
Custom
Screws developed Reference position
rotating 40 Motor position
base Link deflection
Shaft 20
Metal base
DC Motor
0
Encoder
−20
(a) 0 2 4 6 8 10
Springs Time (sec)
Rotary Base
Fig. 7: Simulated trajectory tracking of flexible robotic arm
Rotary Encoder
using step input
Shaft Aluminum rod
Gear Box
Motor
Fixed Base 100
Motor Encoder Reference position
Electronic Components Motor position
Link deflection
50