Dynamic Modeling of A 3-DOF Articulated Robotic Manipulator Based On Independent Joint Scheme
Dynamic Modeling of A 3-DOF Articulated Robotic Manipulator Based On Independent Joint Scheme
Dynamic Modeling of A 3-DOF Articulated Robotic Manipulator Based On Independent Joint Scheme
Authors’ contributions
This work was carried out in collaboration between all authors. Author ECA designed the study,
performed the simulation, analysis and wrote the first draft of the manuscript. Authors HCI and CCO
managed the analyses of the study. All authors read and approved the final manuscript.
Article Information
DOI: 10.9734/PSIJ/2017/33578
Editor(s):
(1) Yang-Hui He, Professor of Mathematics, City University London, UK and Chang-Jiang Chair Professor in Physics and Qian-
Ren Scholar, Nan Kai University, China; & Tutor and Quondam-Socius in Mathematics, Merton College, University of Oxford,
UK.
(2) Christian Brosseau, Distinguished Professor, Department of Physics, Université de Bretagne Occidentale, France.
Reviewers:
(1) André Fenili, Federal University of ABC, Santo André (SP), Brazil.
(2) Qingjuan Duan, Xidian University, China.
(3) Rajinder Tiwari, Amity University, Lucknow, U.P. India.
Complete Peer review History: http://www.sciencedomain.org/review-history/19826
st
Received 21 April 2017
Original Research Article Accepted 8th June 2017
Published 3rd July 2017
ABSTRACT
Joint torque control of a robotic manipulator requires a close dynamic description model involving
the non negligible dynamics of the subsystems making up the system. The mathematical model for
joint torque control of the robotic manipulator has been identified as one of the major sources of
failures of commercial robots. The manipulator is basically made up of links connected by joints,
and the torque that moves the links connected to a joint is produced by the joint actuator and also
in practice, the control law is fed into the actuator inputs, therefore the actuator dynamics becomes
non negligible dynamics in the dynamic modeling of the manipulator for robust joint torque control.
Hence, a complete dynamic model of the manipulator which involves the link dynamics plus
actuator dynamics was proposed. This paper focuses on the modeling of a 3DOF articulated
manipulator based on independent joint (decentralized) scheme and the determination of the
viscous damping coefficient for the joint torque control model. The independent joint model
provides closer mathematical description of the manipulator and also enhances robust controller
design. Joint damping coefficient B, was determined through experiment based on bode plot of the
open loop gain. From the results, it was concluded that joints I and II achieved the best
performance when B is 0.001N.m/rad /sec and 0.01N.m/rad /sec respectively.
_____________________________________________________________________________________________________
Keywords: Decentralized control; robotic manipulator modeling; independent joint control; link; joint
torque control; 3DOF; dynamic model; articulated robotic manipulator.
2
Agbaraji et al.; PSIJ, 15(1): 1-10, 2017; Article no.PSIJ.33578
Helal et al. [23], actuators model are computed to and by the actuation system. He also explained
merge it with the dynamic model of the robot. that there are two types of robot control
Conversely, the dynamic model they presented schemes: Decentralized (or independent) control
did not include the inertia of the robot link. Thus, schemes and Centralized control schemes. The
the consideration of the manipulator link inertia decentralized control scheme also known as
into this model would give a more complete independent joint control (IJC) model has Single
dynamical description of the robotic manipulator. Input Single Output (SISO) configuration while
In addressing the problems in robot force control the centralized control scheme has a Multiple
as presented in [24], the actuator model is Input Multiple Output (MIMO) configuration. From
coupled to the rigid body model of the robotic the review, SISO configuration (which can
manipulator. Fateh [7] modeled the robotic equally be in the form of multiple SISO) is more
manipulator based on the independent joint common and simpler than the MIMO in practice.
control approach which is based on the joint According to Alassar [6], the basis of IJC is that
actuator dynamic model and the torque due to the robotic manipulator is treated as a set of
link. Ovy et al. [15] designed an articulated robot independent actuators working independently.
arm for precise positioning based on joint This means that each link of the robotic
dynamic model instead of the Lagrangian-Euler manipulator is considered as single input single
dynamic model of the arm. In order to achieve a output (SISO) system with an independent
complete dynamic model for a closer dynamic controller.
description for the robotic manipulator modeling
and control therefore, the actuator dynamics plus Independent joint control scheme is widely
the link dynamics must be considered and this adopted in most industrial manipulator controller
can be achieved by the deployment of because of its simplicity [27]. According to
decentralized control also known as independent Richter [28], to derive the independent joint
joint control approach. control model, it is assumed that the DC motor is
connected to a gear reduction of ratio r : 1 and
2.1 Robotic Manipulator Kinematic moment of inertia Jg. The reduced-speed shaft
Arrangements drives a rotational inertia Jl, which represents the
The industrial robots are basically composed of link driven by the motorized joint. The motion of
rigid links, connected in series by joints, having the other links should influence the DC motor as
one end fixed (base) and another free to move well. For the independent joint model, however,
and perform useful work when properly tooled the influences of the other links are treated as
(end-effector). The structure of the robot consists disturbances and then the controller is designed
of a number of links and joints, a joint will allow to be robust (tolerant) against them [28]. When
relative motion between two links [25]. The applying the independent joint scheme,
different arrangements of the rigid links and the Melchiorri [26] stated that each joint of the robotic
term d ( = ) is considered as an external
type of joints applied in the design of a robotic manipulator is considered independently, and the
arm gave rise to the types of arms of the
manipulator. There are five types of manipulator disturbance. These considerations can be
arm configurations commonly used by industrial applied with proficiency when there is no
robotic manipulators: cartesian, cylindrical, polar, direct coupling between the actuator and the
SCARA and revolution. Although there are many joint.
possible ways prismatic and revolute joints are
used to construct kinematic chains, in practice Fig. 1 illustrates the independent control scheme
only a few of these are commonly used [14]. where the actuator and link dynamics are
Crowder [25] stated that the basic robot arm has considered. Where Ja, Jg and Jl are respectively,
three joints, this allows the tool at the end of the the actuator, gear, and load inertias. Bm is the
position .
order system from input voltage V(s) to output
Milchiorri [26] stated that the robot performances
are mainly influenced by the mechanical design
3
Agbaraji et al.; PSIJ, 15(1): 1-10, 2017;; Article no.PSIJ.
no.PSIJ.33578
4
Agbaraji et al.; PSIJ, 15(1): 1-10, 2017;; Article no.PSIJ.
no.PSIJ.33578
,
=
,
,, therefore:
manipulator are very important for the
development of the system. To achieve robust
,
=
joint torque control, the robotic manipulator
analysis must involve the source of the joint (2)
torque. The development of mathematical model
,
= (3)
= (4)
The dynamics of an n-DOF robot manipulator is Taking the Laplace transform of equation 5
governed by the following
ing equation [29]:
[29] yields;
,
= (1) = (6)
5
Agbaraji et al.; PSIJ, 15(1): 1-10, 2017; Article no.PSIJ.33578
The electrical circuit of the actuator provides the as velocity increases. He also stated that the
following equation [13]: dynamic model involving the actuator dynamics
is preferred to equation 2 in the robotic
= # $% &
! '
!"
manipulator design. This is because all
(7)
feedbacks belong to the actuator (motor). Also,
manipulator model is not required to form the
Taking the Laplace transform of equation 7
control law. As a result, the control law is simple,
!" = # $% &
fast, and more accurate in comparison with the
(8)
equation 2. The control law requires only a
feedback of actuator current and position.
Where ω is the angular velocity
Moreover, the electrical signals can be measured
more convenient and more precise than
Resolving the equations with the help of the
mechanical signals. This control law can be used
actuator block diagram in Fig. 3 and solving for
for tracking control of a high-speed robot since
the relationship between voltage input Vin and
this approach is free of manipulator model. The
the position of the shaft θm in the closed loop
actuator dynamic equation is used for precise
system yields the actuator dynamic model as
control of each degree of freedom of a robotic
derived in [6,15]. When the motor is not
arm as applied in [16].
connected to the robotic manipulator joint
mechanism (i.e. Tl=0), its dynamic model does
not include the inertia due to the linkage or load.
Combining the mechanical and electrical
subsystem dynamics of the motor, therefore
actuator dynamic model becomes:
=
( *
= # $% & θ )
(9)
!"
= $% + #% $% ,
#-./0−1/ 2) (10)
Where, Jm is the motor inertia, Ra is the actuator Fig. 5. Mechanical subsystems of the motor
resistance, La is the actuator inductance, Kt is the and link gears
torque constant, Ke is the back emf constant, Bm
∑ /4
50 -/ /ℎ0 .4/4 0- =
equation 2. This control law is not complete since
some terms such as frictional torques have been
− 8 =
−
omitted for simplicity and reducing the computing
8 =
time, and some terms are not precise. Therefore,
applying this control law cannot provide a perfect (11)
linear and decoupled system, and due to
inaccuracy in model, errors will be produced. The sum of torques at the robot arm gear gives:
∑ /4
50 -/ /ℎ0 92: 0- =
Moreover, implementing the control law requires
8 −
=
feedbacks of all joint positions and their
= 8
derivatives. Also, the control strategy is complex
since the system is highly coupled and multi- (12)
input/multi-output. The tracking error increases
6
Agbaraji et al.; PSIJ, 15(1): 1-10, 2017; Article no.PSIJ.33578
8 =
/ (13) = @< = A
<
(16)
'
= @ <= A
Substituting equation 13 into equation 11 yields;
<'
=
(17)
<'
<
(14)
= @ = A
<
<'
(18)
The gear kinematics for the motor gear and link
gear is as follows
Substituting equations 16, 17 and 18 into
= = =
<' >' ? ? equation 14, yields:
<= >= '
(15)
'
@< = A
@< = A
=
< <' < <'
<= <=
(19)
Where rm is the radius of motor gear, rl is the ' '
@
<=
<'
A
@
<=
<'
A
=
Therefore, the angular position of the link is
B <' <= <' <= *
= # $% &
<= (20)
!"
derived from the motor position and the gear
<'
ratio of motor and link gears as:
The dynamic model for joint torque control relating angular position of the link and the voltage input
into the actuator becomes:
GH
= C DC@ A @ AE $% # & FE Κ
<= <' <= <'
<' <= <' <=
(22)
The multiple SISO model for the articulated robotic manipulator dynamic description becomes:
GH
H = C DC@ H H , A @ H H AE $%H #H &H H FE ΚH
<=I <'I <=I <'I
<'I <=I <'I <=I
GH
, = C DC@ , , A @ , , AE $%, #, &, , FE Κ,
<= <' <= <'
<' <= <' <=
In order to determine the effective viscous damping coefficient at the joints, the following design
specifications must be met.
• Peak gain>>0 (i.e., peak gain must be very much greater than zero)
• Both Gain Margin (GM) and Phase Margin (PM) must exist
• PM should be greater than GM
7
Agbaraji et al.; PSIJ, 15(1): 1-10, 2017; Article no.PSIJ.33578
The arm parameters are as follows: mass of link N.m/rad/sec, 0.01N.m/rad/sec and 0.001 N.m/
1 (m1) =1kg, mass of link 1 (m2)=0.06kg, length rad/sec the system satisfied the design
Inductance $-
Resistance (R) 2.5Ω 3.5Ω B (N.m/rad/sec) GM PM Peak
0.004H 0.001H (dB) (Degree) gain
Current (i) 1A 1A (dB)
Torque 0.1N.m/A 0.05N.m/A 10 128 - 352
constant (km) 0.1 65.5 89.8 392
Electromotive 0.1V.s/rad 0.05V.s/rad 0.01 46.9 78.5 409
force constant 0.001 37.9 42.3 418
(Ke) 0.00001 35.9 34.6 420
-50
Magnitude (dB)
-100
-150
-200
-250
-300
-90
G11(B=10)
G12(B=0.1)
-135 G13(B=0.01)
Phase (deg)
G14(B=0.001)
G15(B=0.00001)
-180
-225
-270
-1 0 1 2 3 4 5 6
10 10 10 10 10 10 10 10
Frequency (rad/s)
8
Agbaraji et al.; PSIJ, 15(1): 1-10, 2017; Article no.PSIJ.33578
Bode Diagram
50
-50
Magnitude (dB)
-100
-150
-200
-250
-300
-90
G21(B=10)
G22(B=0.1)
-135 G23(0.01)
Phase (deg)
G24(0.001)
G25(0.0001)
-180
-225
-270
-1 0 1 2 3 4 5 6
10 10 10 10 10 10 10 10
Frequency (rad/s)
9
Agbaraji et al.; PSIJ, 15(1): 1-10, 2017; Article no.PSIJ.33578
Peer-review history:
The peer review history for this paper can be accessed here:
http://sciencedomain.org/review-history/19826
10