Professional Documents
Culture Documents
Simulation of Industrial Robots' Six Axes Manipulator Arms - A Case Study
Simulation of Industrial Robots' Six Axes Manipulator Arms - A Case Study
(3)
In the control chain shown in Figure 1, there is a
control circuit "Power amplifier" between the
converter DAC and the Motors as presented in
Fig.1 The control chain of a manipulator arm Fig.2.
This article presents an overview of basic
knowledge on control techniques for serial rigid
robots in a free and constrained spaces, where a
contribution of a case study to control a 6 axes
(DOF) manipulator arm using the classical PID Fig.2 The control circuit in the control chain
control will be highlighted, the comparing results This circuit guarantees the proportionality
between the open-loop of system and closed-loop between the input voltage Uev of the power
will prove the efficiency of the method in order to amplifier and the electric current , in the case
maintain the desired trajectory of the robot arm. where in the case of small variations of .
2 GENERAL CONTROL CHAIN FOR Consequently, the control chain will be as extended
INDUSTRIAL ROBOT in Figure 2, and the following relation can be
written:
The main purpose of the control chain is to (4)
calculate the joints torque vector applied to the (5)
mechanical system input, which allows getting the Where:
joints position vector q as an output, as shown in (6)
Figure 1, this chain is composed of a “Computer” - : the electric current
which calculates a numerical value N, these - Proportional gain
“Numbers” will be transformed into analog electric - : the parameter of the actuating chain j
signal by the Digital - Analog - Converter (“DAC”) - : the desired input to the actuator chain.
block. These analog signals represent the - : the reduction ratio
“Voltages” required for the “Motors” that generate - : the amplifier gain
the actuation “Torques” passing through “Gears” - : the torque constant
block, that represents the gear ratio which will
The control synthesis consists in calculating ,
produce the final joint torque value for the
then in calculating the signal Uev allowing to follow
“Mechanical robot” to perform the “Motion q”.
the desired input (Muhammad & al, 2018).
Determining the control scheme of a robot arm
with n degrees of freedom (DOF) requires 3 THEORY OF DYNAMIC CONTROL
knowledge of certain equations and some FOR SERIAL ROBOTS
relationship between torque and position given by
the dynamic model presented (Khalil & al, 2007): The control of the robot arm stands on two
classifications regarding the movement of the
mechanical structure in the workspace (De Wit &
(1) al, 1996): the first type considers the movements
More simplified: necessary to a defined task executed in joint or free
(2) space (Gorla & al, 1984). The second type considers
specific movements with forces of contact for the
Where:
terminal organ which moves in a constrained space.
- : the vector (n × 1) of the joint torques.
- and , : are position, velocity and 3.1 Control in joint space
acceleration vectors (n × 1) respectively. In the following, a general description of the
- : the inertia matrix (n × n), determined various techniques reported in the literature applied
positive and symmetrical. in the joint space is highlighted.
- : the vector regrouping the forces of
gravity and friction. 3.1.1 PID control
- : the vector (n × 1) of gravity. This technique is applied for the manipulator
- : Diagonal of matrix. robots that use servomotors with strong reduction
- and Fs: the vectors of the viscous and dry ratios. When the system has a linear behavior,
friction parameters respectively, in this paper movement control can be achieved by classic
will be neglected. control techniques. A decentralized order PID type
- : the nonlinear limits represented by: is considered here (proportional–integral–
90
ACADEMIC JOURNAL OF MANUFACTURING ENGINEERING, VOL.19, ISSUE 1/2021
derivative) type. In articles (De Wit & al, 1996; formalism of Hamilton, the control seeks to
Whitney, 1969) the classical scheme is improved minimize the energy of the system by using a
with anticipation. passive nonlinear block in the return loop. Passive
control tends to be more robust than non-linear
3.1.2 Jacobian control
decoupling, when the technique does not seek to
This technique has been used since the work of cancel nonlinearities (Li & al, 2018).
Whitney (Whitney, 1969) where its name refers to
the reverse Jacobian matrix of the manipulator arm 3.1.6 Adaptive control
to calculate the target speeds at the joints. It is also This type of technique aims to correct
known as resolved motion control. The most deficiencies in decoupling control nonlinear, such
common approaches are of type: movement at as
resolved velocity, movement at resolved approximate knowledge of the parameters of the
acceleration and movement by resolved force. robot model or to adapt to different operating
Resolved motion technique controls the position of conditions (Deng & al, 2020). This kind of
the end effector of robot arm in Cartesian space diagrams seeks to estimate or adjust online the
“Task space” by combining the movements of values of the parameters used in the calculation of
several joints, this type of diagrams can be as the control law. One of the most interesting works
following: the velocities calculated at the joints are on this subject is the command offered by called
used directly as a set point for the control loops of Slotine-Li command or command adaptive passive
each joint, or in the form of a dynamic diagram, (Slotine, 1987). The advantages of this type of
when the diagram uses the dynamic model to technique are obvious, unfortunately the computing
decouple the joints. Its main drawback is the use of power required from the system present a big issue.
the inverse Jacobian matrix, which can become
3.1.7 Predictive control
singular under certain conditions.
This type of diagram uses the system model and
3.1.3 Non-linear decoupling control set points to be capable to predict its evolution,
This technique is also known as dynamic control where it is able to act according to the prediction
or calculated torque. When the application requires error. Three different schemes are proposed in
rapid development with dynamic constraints, the (Hedjar, 2002), the advantage of this type of
command must take into account the forces of approach is linked to the fact that the prediction
interaction. This type of technique considers all of error is not contaminated by measurement noises,
the joints and for decouple them, uses the theory of where the dependence on the model remains strong.
non-linear decoupling. This theory uses the
3.1.8 Robust control
dynamic model of the robot for calculating the
control law, which leads to non-linear centralized In the case of fixed parameters, it is known that
control laws. Anticipation signals can be used to the nonlinear decoupling technique can become
minimize non-linear effects (Er, 1993). This type of unstable in the presence of uncertainties. If the
technique allows the command in the articular space parameters of the model are not known precisely
or in the Cartesian space, with the advantage the and if the uncertainty on the parameters admits
joints are decoupled and can move at high speeds known bounds, then robust control techniques can
with strong inertias. This method strongly depends be used. The work of Slotine (Slotine, 1985)
on the system model; it is very sensitive to model considers the technique of modes sliding, also
inaccuracies which lead to decoupling imperfect. called variable structure command. This technique
uses a sliding surface where the system’s stability is
3.1.4 Control Lyapunov function guaranteed.
Methods based on a Lyapunov function have
been used for the control of the manipulator arms in 3.2 Control in task space
order to follow-up tasks. Particularly when the goal Executing a robotic task often requires an
is to try to guarantee asymptotic convergence and interaction between the manipulator and its
not to linearize the system or to obtain decoupling workspace. Typical examples can be seen in
(Sontag, 1999). automotive industry as painting, welding,
assembling, etc. During the interaction, the
3.1.5 Passive control workspace of a robot arm somehow imposes certain
This technique considers a robot as a passive constraints on the trajectories that the robot tool can
system, i.e. a system that dissipates energy. Such track. Therefore, the use of position controls like
control laws allow modification the robot’s natural those described before is not possible unless the tool
energy to be able to execute the task. Using path is planned precisely, and the control ensures a
91
ACADEMIC JOURNAL OF MANUFACTURING ENGINEERING, VOL.19, ISSUE 1/2021
perfect follow-up of this trajectory. To achieve The implementation of the simulation process in
these two objectives, it is essential to have a precise MATLAB Simulink requires, first of all, calculating
analysis model of the robot arm, also concerning the the dynamic model for the robot, the dynamic
workspace (geometry and mechanical charac- model will be expressed in symbolic function in
teristics). It is clear that the second constraint can be MATLAB Simulink.
encountered very rarely, where it is necessary to
implement controls that are not "pure" controls in
position. In this section, we will present two main
types of these controls (Khalil & al, 2002).
3.2.1 Impedance control
A control strategy that ensures that the robot is
subjected to an external force, in which the relation
between this effort and the effector's position is
controlled, this strategy consists in regulating the
robot which behaves like a mechanical system of
variable Z impedance depending on the different
phases of the task. In general, we assume the robot
is equivalent to a second order mass , spring ,
shock absorber system (Paul, 1981).
3.2.2. Hybrid position/ force control
It consists of effort and position set points Fig.3 Structure of the 6 DOF robotic arm
simultaneously, defined according to the following
4.1 4.1. Open-loop simulation
rule: the directions which are contrary in position
are controlled in force, while those which are 4.1.1. Open-loop simulation result for 6 DOF
constrained in force are controlled in position or Figure 4 presents blocks of Simulink scheme for
velocity. Hybrid control schemes thus reveal two 6 degrees of freedom. The block diagram Simulink
loops parallel, one for the position, the other for the describes (1), where the first block tau includes the
force. Because each articulation contributes both to torque vectors for six joints, and by adding Coriolis
the achievement of position control and force vector C and viscous friction vectors and gravity
control, the outputs of these loops are summed vector. We can calculate the elements of the inertia
before being sent to the robot in the form of a global matrix A and the acceleration vector.
control vector. The implementation of this synthesis
requires the determination the forward dynamic
model of the robot arm i.e. obtaining accelerations
as a function of articulated torques. Its elements are
calculated by the dynamic equations of Lagrange.
4 SIMULATION OF THE SIX DOF
(AXES) ARTICULATED ROBOT
ARM – CASE STUDY
It is well known that simulation of the
manipulator arm is based on the mechanical
parameters calculated by the dynamic analysis Fig.4 Block diagram of Simulink software for the
modeling, where the exact mathematical model can dynamic model
guarantee the exact results for the simulation The simulation was not completed due to the
(Straka & al, 2014). MATLAB Simulink software dynamic model of six degrees of freedom which is
presents a powerful tool to build a virtual simulation larger regarding the calculations of its parameters in
by transforming each mathematical equation in symbolic function, where the simulation takes a
block function. The case study presented in this large time (2 days to execute 1% of the results).
article is about simulation of a six axes manipulator Therefore, in this article, we present the simulation
arm, the robot has six rotation joints and seven result for the three first joints (Waist-Shoulder-
links. Figure 3 shows the structure of the 6 DOF Elbow). The study will cover the behavior of the
robotic arm. robot model in open-loop and closed-loop using
PID controller.
92
ACADEMIC JOURNAL OF MANUFACTURING ENGINEERING, VOL.19, ISSUE 1/2021
In order to see the dynamic behavior of the In open-loop simulation, we supposed that we
robot, we started by simulating each joint in open- know the torque value for each joint, and we
loop, as we mentioned before, because of the large implement the inverse dynamic model to calculate
inertia matrix of the 6 DOF (degree of freedom) the acceleration.
robot dynamic model. We supposed that the joints As shown in Figure 6, each joint block is a
j4, j5, j6 (Forearm – Wrist pitch – Wrist roll) are function that describes the mechanical property of
zero and neglecting Coriolis – gravity – viscous that joint, it is an element from the A inertia matrix
friction vectors, in order to reduce the inertia matrix presented in (1), the signal output is an acceleration
and focus only on studying j1, j2, j3. or , entering signal in an integrator, we
can calculate the velocity or and by integrating
4.1.2. Open-loop simulation result for 3 DOF
the velocity signal, we get the position .
The open-loop simulation for the three degrees Figures 7 and 8 illustrate respectively, the
of freedom is done by giving the applied torques positions and velocities executed by all three first
constant values as "steps". Figure 5 shows the joints. From the curves in Figure 6, we notice that
Simulink diagram for 3 DOF open-loop. the joints operate abruptly, where the joints exceed
The subsystem block shown in Figure 6 presents their limits angle, they vary in an amplitude range [-
the internal blocks of Simulink diagram presented 5 - 8 rad] while for velocities in Figure 7, the
in Figure 5. The subsystem in Figure 6 calculates velocity for three joints vary within a range of [-1 -
the accelerations (j= 1..3) for the three joints 5 rad/s] at most.
of the robot where the blocks scheme in Figure 5
calculates the position and the velocity.
(11)
94
ACADEMIC JOURNAL OF MANUFACTURING ENGINEERING, VOL.19, ISSUE 1/2021
(12)
97