Vous êtes sur la page 1sur 6

Fractional order multicontroller design applied

to control the wrist of a Robot Manipulator


Youcef ZENNIR1 Adel MAKHBOUCHE2
Automatic Laboratory of Skikda Automatic Laboratory of Skikda
Skikda Univesity, Skikda Univesity,
Skikda 21000, Algeria Skikda 21000, Algeria
youcef.zennir@univ-skikda.dz adel.makhbouche@univ-skikda.dz

Lekhdar BOURAS3 Riad BENDIB4


Electrical Engineering Laboratory of Skikda Automatic Laboratory of Skikda
Skikda University, Skikda Univesity,
Skikda 21000, Algeria Skikda 21000, Algeria
l.bouras@univ-skikda.dz Riad.bendib@univ-skikda.dz

Abstract the paper presents a new multi-controllers


approach applied to control the wrist of a robot manipulator
(Staubli RX-90). A brief overview of the process with non-linear
and linear mathematical modeling. Principle of multi-controllers
approach is briefly presented. Our new proposals concerning the
type of the controllers used in the multi-controller approach,
which are robust fractional order controllers (as FOPID and
FOPI) to improve the robustness of the control. Two
approximation methods used to approximate the fractional order
(recursive approximation method (ORA) of Oustaloup for
FOPID and singularity function method of Charef for FOPI).
Controllers synthesis with the principle of approximation
methods is presented. Different simulations were performed to
illustrate the effectiveness of the new multi-controllers structures Fig. 1. Structure of muli-controller approach of control.
and also to differentiate approximations methods with the
settings parameters controller and the approximation order, To tracking correct of the trajectory, the control error must
followed by a conclusion and some perspectives for future work. be calculated between output of process and reference model.
Different solution can be envisaged to obtained the command
KeywordsModeling, Robot Manipulateur, CRONE Control, signal applied on process [1][18]:
Apporximaion fractional order methods, FOPID, FOPI.

I. INTRODUCTION (HEADING 1) Frank Switching between controllers: in this case, for


each instant only one controller used to develop the
Invariant linear model for a physical process can only be an command signal applied on process.
approximation. Indeed, the physical process behavior has
generally many non-linearity [5] that are not taken into account Fuzzy switching between controllers: in this case, for
in the modeling process. In the each operating point each instant all controllers used to develop the
(equilibrium point) of the physical process we can developed a command signal (ponderation sum of all local command
local linear model. Two ways can be used to derive these signals) applied on process.
linear models the first is based on the priori knowledge of the
process and the second method using identification. Then the We focus in this study on the use of frank switching
objective of multi-controller control approach (Balakrishnan controllers. The multi-controller control approach is used to
1997)[1] is to control the process in operational space using the specify [7][8]:
local information [2][3]. The object of the multi-controllers
control approach is to control the process output in the Controllers Structure's and switching type's [7][4].
variation space of the parameters using commands developed
Different solutions are possible such as:
by the various local controllers. The diagram block of the
multi-controllers control approach is represented as follows: FOPID, FOPI, RST and Adaptive controllers [11]
[6][2].
Frank or fuzzy switching [8][9][10] and Direct or The motor torque is given by: = () (3)
indirect approach [7].
Ke: is the torque constant and u (t) the voltage applied in
In our work we have choose the use of an indirect approach process. Then the nonlinear model is given by:
based on fractional-order local controllers like PID (or PI) 1 () = ()
() = [ ] 1 () = 2 () (4)
and frank switching to control the wrist of robot manipulator 2 () = ()
(Staubli robot RX 90). We propose in the first step in the m (t) x1 (t)
following figure, the diagram block modified of multi- yp (t) = s (t) = = (5)
N N
controller approach of control.
This is the state space representation for the nonlinear
model. To find the linear structure of local parametric models,
we applied the tangent linearization methods and the linear
local model is as follows [18]:
Kp
() = (6)
p2 +ap1 p+ap2

After identification of the linear system near operating


point s0=0 [18]. The corresponding continuous linear model
is as follows:

operating points, s0=0 :


111.5
() = (7)
Fig. 2. Structure of control using muli-controller approach. 2 +11.25+79.14

II. PROCESSUS MODELING operating points, s0=/3 and s0=2/3 respectively:


The Robot manipulator Stubli Rx-90 has coupling 111.5 111.5
G(p) = ; (p) = (8)
between axis 5 and 6. The actuators are brushless motors and p2 +11.25p+39.57 p2 +11.25p39.57
the engine control uses the rotor position to magnetic flux
rotate to achieve desired torque value and generally this motor
as a DC motor behave [7][8]. Our process corresponds to a III. LOCAL CONTROLLEURS STRUCTURES
wrist of a robot (axis 6) can be represented by the following The structure type of the local controllers is Fractional
figure: order controller P and P . In control theory, the general
conclusion about fractional control system is that it could
enlarge the stability region and robustness [14] moreover it
gives performance at least as good as its integer counterpart. In
the other hand another important advantage is that fractional
integrals or derivatives are hereditary functional while the
ordinary ones are point functional. Here we should mention
that for Fractional order PID or PI controllers, many
contributions and studies are presented in the past years [15],
particularly in the tuning rules [16],[ 17], approximation [19]
and stability conditions [20]. In generally Fractional-order
calculus is an area of mathematics that deals with derivatives
and integrals from non-integer orders. In other words, it is a
generalization of the traditional calculus that leads to similar
concepts and tools, but with a much wider applicability. In
Fig. 3. Process (wrist of a robot) model. recent years, according to the advances in the field of fractional
calculus, there had been a great interest to develop a new
Mathematic Process dynamic model is given by the generation of PID (PI) controllers, which is commonly known
following equations: as the fractional- order PID (FOPID) or P controller. The
+.2 transfer function of a FOPID controller, which was initially
= ( + 2 ) + ( + 2 )

(1)
proposed by Podlubny in 1999 [14][24], is given by:
+.2
With: = ( + ) and = ( + ) (2)
2 2 () 1
() = = + + , (, > 0) (9)
()
Jm, Js: Inertia moment applied in the motor shaft and the
output shaft (output shaft with mass) respectively. Where Kp,KI, KD R and , R+ are the tuning
m, s : Viscous friction applied in the motor shaft and the parameters and the controller design problem is to determine
output shaft respectively. the suitable value of these unknown parameters such that a
predetermined set of control objectives is met [19]. Note that

in (9) if Kd=0 we find FOPI controller. We can note too that 2 = 2
=0 () () (18)
the fractional order of the Laplace variable p are commonly With: yi: derived from the transfer function Gp(s) compared to
interpreted in the time domain using the PI Grunwald- the variable s at the point u; N: many samples.
Letnikov, Riemann-Liouville or the Caputo definition [30]. It
should be noted that any conventional PID controller is a
particular case of the FOPID controller (9) with =1 and =1. Step 3: calculate the parameters xi for 0 i 2
.
Assuming =1 and =0, or =0 and =1 respectively 0 = (10 ) 1 = (11 )2 0 1 (19)
0 0 0 0 0
corresponds conventional or PD controllers are the special
cases of the fractional PID controller given by (9). Many 2 21 2 2.1 .1 +0 .2
2 = + (20)
methods in literature has been proposed for FOPID 0 (10 )2 0 (10 )3 0
approximation [19]. In this work we used two approximation
method of p. The first is Oustaloup recursive approximation
method (ORA) applied in FOPID controller [20] [23] and With: xi: derived from the controller transfer function C (p)
second is singularity function method of Charef [19] applied
in FOPI controller. In the first method, the fractional-order
differentiator p , R+ is approximated as: Step 4: calculate the parameters Kc, Ti,
() = , + (10)
By a following rational function: .2 (1+) .1
= 1 , = , = 0 . (21)
1
1+

() =
= (11) Concerning the approximation of fractional action we used
1+
the approximation method developed by Charef [22]. The
With: 0 = 0.5 ; 0 = 0.5 ; transfer function in closed loop for rotors speed is regarded as
stable. The problem systems design is thus to regulate the
+1 +1
= = > 1 (12) three parameters of fractional controller to guarantee that the

transfer function in closed loop behaves the frame of reference

+1 log( ) which itself answers the specifications of the fractional control
0
= > 0; = > 0; = ; (13) system (transfer function in closed loop). The frame of
log()
reference fractional model used is:
log
= log() (14) 1
() =
1 < < 2 (22)
1+( )
With being the unit gain frequency and the central

frequency of a band of frequencies geometrically distributed The transfer function of reference model is given by the
around it .That is, = , where , are the high and following function:
2
the low transitional frequencies. The parameters used in the () = (+)2 () = () () (23)
Oustaloup approximation are:
2
With: () = (24)
G (p): Transfer function of local model of process. 2 +1 +0

N: Approximation order.
r1=- & r2=: Integration & derivative order IV. SIMULATION
respectively.
The simulation is done in continuous time around the
l=10-2; low transitional frequency following operating points s0=0rad, s0=/3rad and
h=103; high transitional frequency s0=2/3rad. the parameters (Kp, Ki, Kd) of FOPID and FOPI
u=10; Cutoff frequency are by determined with =1 and =1. The FOPID and FOPI
For the adjustment fractional parameters controller PI (Kc, structure is represented by the following figure.
Ti, ) we us the following algorithm [22][23]:
Step1: calculate the parameters i for 0 i 2
1
0 = , 1 =2
, 2 =
42 4
(15)

u: frequency of the profit unit of the reference model; m: the


derivation fractional order of the reference model; i: derived
from the transfer function of the reference model Gd (p)
Step 2: calculate the parameters yi for 0 i 2

0 =
=0 () (16) Fig. 4.Diagram Block of FOPID and FOPI controller.


The simulation parameters around the operating points
1 =
=0() () (17) chosen are:
TABLE I. PARAMETERS OF THE LOCAL CONTROLLER

PID (N=5, = =0.5) PI (= 0.5)


s=0 Kp=-2, Ki=-5, Kd=-0.7 Kp=-20, Ki=5
s=/3 Kp=-2, Ki=-0.4, Kd=-0.4 Kp=-25, Ki=3
s=2/3 Kp=-3, Ki=0.1, Kd=-0.4 Kp=-35, Ki=0.5

The simulation is organized as is:


Each FOPI applied to control the nonlinear model
(process). Fig. 7. Pole Zero map for closed loop. (s=0)
Variation of simulation parameter (approximation
order) and the Fractional order.
We applied the same simulation with each FOPID
controller.

The object of this simulation is the illustration of fractional


order controller efficiency and the stability of closed loop
control. Comparison between FOPID and FOPI controllers.
Finally the effect of approximation method in control lows.
The simulation around the operating point s0=0 rad. For the Fig. 8. Pole Zero map for closed loop. (s =/3)
validation of the use of these parameters the controller around
the operating point s0=0rad, the reference signal r (t) is equal
to:

() = 0.1 (5) (25)

.Fig. 9. Pole Zero map for closed loop. (s=2/3)

Fig. 5. Control error ec (t). with FOPI controller

Fig. 10. Frequency response of each local FOPI Controller.

Fig. 6. Outputs of the process and the reference model with FOPI controller.
Fig. 11. Frequency response of each closed loop local system with FOPI.
Fig. 16. Pole Zero map for closed loop. (s=2/3) with FOPID controller.
Fig. 12. Control error ec (t) with FOPID controller.

Fig. 17. Frequency y response of each local FOPID controller.

Fig. 13.Output of process and reference model with FOPID controller.

Fig. 18. Frequency response of each closed loop local system with FOPID.
Fig. 14. Pole Zero map for closed loop. (s =0) with FOPID controller.

Fig. 15. Pole Zero map for closed loop. (s =/3) with FOPID controller. Fig. 19. Error control with FOPID and FOPI controller in (s=0).
With the obtained results with the FOPI we can noted: [4] J-M. Duchamp, "Commutation Floue de lois de Commande applique la
Robotique". Rapport de DEA , LAMII /CESALP, 1998.
Each local system is stable (fig.7, fig.8 and fig.9) and error
[5] J.J.E. Slotine, "Applied Nonlinear Control". Prentice-Hall
control given by closed loop system around s0=0 is very International, 1991, ISBN: 0-13-040049.
small compared other local system (fig.5, fig.6) [6] A. Karimi and I-D. Landau, "Robust Adaptive Control of a Flexible
The closed output loop of the local system around s0=0 has Transmi ssion System Using Multiple Models". Laboratoire
the same curve although the output of the reference model dAutomatique de Grenoble (CNRS-INPG-UJF). Design-CSD, 1998.
compared with other local system (fig.5.b, fig.6.b, fig7.b). [7] O. Pags, P. Mouille and B. Caron, "Two approaches of the multi-
The local controller around s0=0 is more robust model control. Real time Implementation for a wrist of a Robot".
Mechatronics 2000, 1s t IFAC Conference on mechatronic systems,
compared with other local controller fig.10 and more stable in
Darmstadt, Allemagne, Septembre, 2000.
closed loop system fig 11 and the order of FOPI controller
[8] R Toscano., D. Martin-Calle and P. Passerieu, "Adaptation
equal 4 and 6 for closed Function transfer loop. paramtrique floue dune commande au premier ordre en fonction du
With the obtained results with FOPID controller we can point dquilibre courant". Laboratoire dAutomatique E.N.I St
observed that: ETIENNE LFA97 -Lyon-dcembre, pp.3-10.
The same illustrated results with the FOPI controller on [9] A. Djouambi, A. Charef, A.V. Bensanon, Optimal approxi mation,
stability, robustness and precision (fig.12 until fig.18). simulation and analog realization of the fundamental fractional order
The order of FOPID controller equal 22 and 24 for transfer function. International Journal Applied
Math.Comput.Sci.,2007, vol 17, N 4, pp.455-462.
closed Function transfer loop
[10] B. Vinagre, A. Podlubny, A.Hernandez, V. Feliu, Some
The order of FOPID controller equal : approximations of fractional operators used in control theory and
applications, Fractional calculus App. Anal. Vol. 3, no 3, pp 231-248,
N=1 N=2 N=3 N=4 N=6 2000.
order 6 10 14 18 22 [11] W. Yuquan, Fractional Order PID design for Nonlinear Motion
We also found that the change of and don't affect the Control Based on adept 550 Robot. . Proceedings of The 2011 IAJC-
ASEE International Conference. ISBN 978-1-60643-379-9, P.17.
order controller.
[12] R.L. Bagley and R.A. Calico, "Fractional Order State Equations for the
Control of Viscoelastically Damped Structures". J.Guidance, vol. 14,
V. CONCLUSION no. 5 pp.304-311, 1991.
In this work, we have presented the modeling of nonlinear [13] D. Matignon, "Generalized Fractional Differential and Difference
process (wrist of RX90 Stubli Robot). After that the local Equations: Stability Properties and Modelling Issues". Proc. of
linear model near each considered operating points has been Math.Theory of Net works and Systems Symposi um, Padova, Italy,
calculated. We have describe the Fractional-order PID and PI 1998.
controller principal with Oustaloup recursive approximation [14] I. Podlubny, "Fractional-Order Systems and Fractional-Order
method (ORA) and method of Charef (singularity function Controllers", Inst. Exp. Phys., Slovak Acad. Sci., Vol.4, No.2, 1994,
pp.28-34.
method) respectively. After simulation we noted that the
[15] Y. Luo, Y.Q. Chen, "Fractional-order [proportional derivative]
application of CRON structure control is very interesting in this controller for robust motion control: Tuning procedure and validation,"
case of system but we need more optimal approximation for American Control Conference, 2009. ACC '09. , vol., no., pp.1412-1417,
order minimization and chose of FOPID or of PI parameters. 10-12 June 2009.
The results obtained allow concluding that the local controllers [16] D. Xue, C. Zhao, Y.Q. Chen, "A Modified Approximation Method of
give good results around the operating points. The results Fractional Order System," Mechatronics and Automation, Proceedings
obtained allow concluding too that the results obtained with of the 2006 IEEE International Conference on , vol., no., pp.1043-1048,
25-28 June 2006
FOPID are more interesting as compared FOPI. But the results
[17] Y.Zennir, P. Mouille, Multi-controllers approach applied to a wrist of
are local. Therefore, we must seek a collaborative approach a robot .25 European Modeling and Simulation Symposium
these local control laws to obtain good results in all operating (EMSS2013),p.6.
space. Finally we will study at the future work other [18] K. Hamdaoui, " Implmentation analogique et numrique de
approximation Fractional-order controller method with drivateur et intgrateur d'ordre fractionnaire", Mmoire de Magister,
optimization chose of parameters controller. And frank Universit de Constantine, 2006, p65.
switching with the indirect approach (collaboration between [19] A. Oustaloup, "La drivation non entire: thorie, synthse et
controller), then the same category with other type of controller applications". Hermes. Paris, 1995.
as example Digital Fractional - order PID controller or RST [20] K. Bettou, "Analyse et ralisation de correcteurs analogiques d'ordre
controller. fractionnaire", Mmoire de thse, Universit de Constantine, 2011,
p.111.
REFERENCES [21] Bettou, K. Charef, K.A, 2008. "A New design method for fractional
PID controller", IJSTA, vol.2, N 1, pp 414-429.
[1] J. Balakrishnan and S. Narendra, "Improving Transient Response of
[22] L. Bouras, Y. Zennir and F. Bourourou. 2013. "Direct torque control
Adaptive Control Systems Using Multiple Models and Switching". IEEE
with SVM based a fractional controller : Applied to the induction
Trans. on Automatic Control, Vol. 39, n9, Septembre 1994, pp. 1861-
motor". Proceeding of the 3rd IEEE international conference on system
1866.
and control 29-31 October. Algeria, .pp.702-707 .
[2] J. Balakrishnan and S. Narendra, "Adaptive Control using Multiple
[23] A. Djari, T. Bouden and A. Boulkroune. Design of a fractional order
Models". IEEE Trans. on Automatic Control, Vol. 42, n2, Fvrier 1997,
PID controller (FOPID) for a class of fractional order MIMO systems. J.
pp. 171-187.
Automation & Systems Engineering 8-1 (2014): pp. 25-39.
[3] J. Chebassier, "Mthadologies pour la conception dun systme de
[24] F. Merrikh-Bayat* A. Jamshidi. Comparing the Performance of Optimal
comma nde par calculateur". Thse Laboratoire dAutomatique de
PID and Optimal Fractional-Order PID Controllers Applied to the
grenoble (INPG) , 1999.
Nonlinear Boost Converter. Dec 31 2013 math.oc arXiv:1312.7517v1,
pp.6.

Vous aimerez peut-être aussi