 Open Access
 Total Downloads : 184
 Authors : Victor Renan Bolzon, Thamiris Lima Costa, Edson Hideki Koroishi, Fabian Andres LaraMolina
 Paper ID : IJERTV5IS090581
 Volume & Issue : Volume 05, Issue 09 (September 2016)
 Published (First Online): 28092016
 ISSN (Online) : 22780181
 Publisher Name : IJERT
 License: This work is licensed under a Creative Commons Attribution 4.0 International License
Dynamic Model and Optimal Control of a Fully Parallel Manipulator
Victor Renan Bolzon1, Thamiris Lima Costa2, Edson Hideki Koroishi3, Fabian Andres LaraMolina4
Department of Mechanical Engineering, Federal University of Technology – ParanÃ¡ CornÃ©lio ProcÃ³pio, ParanÃ¡, Brazil
Abstract The purpose of this paper is to analyze the dynamics and also to project the optimal control system of the full six parallel manipulator StewartGough Platform. Based on the full dynamic model and simulations, the position control is design based on the Linear Quadratic Regulator (LQR) and the Computed Torque Control (CTC) techniques, these techniques are applied in order to reduce the trajectory tracking error at the workspace. Also a Proportional Derivative Controller (PD) together with the CTC technique was set to evaluate the trajectory tracking performance of the LQR controller.
KeywordsDynamic Modeling; Position Control; Linear Quadratic Regulator, Computed Torque Control;

INTRODUCTION
Recently, the parallel robots have been widely applied in several fields of the engineering, as for example: flight simulators, industrial machines and due its high precision of movements, they have also been applied as surgical robots [1]. For this aims, it is necessary to improve the performance of these manipulators, to increase the stability and efficiency, although with low operational costs. For this reason, many researches have been realized in this field. As [2], that proposed through two proposed parameters, with the genetic algorithm to optimize the dynamic project of a parallel manipulator. [3] presented a controller based on the adaptive law, where the constant feedback gains of the PD controller was substituted into other noliner time variables.
Reference [4] implemented the direct dynamic of the StewartGough manipulator by using MatlabÂ®, based on the Kane equation, where the forces for each actuator and the initial conditions are given, so its obtained the position and orientation of the manipulator and for the actuators are found the linear velocity and the position. [5] used a cascade control system to track the trajectory of 6DOF parallel robot. It was considered not only the mechanical dynamic, but also the dynamics of hydraulic actuators.
Fuzzy control was used by [6] for the setpoint regulation of a twolink planar robot with flexible joints. This setpoint regulation control is applied to find a feedback control law to reduce the vibration on the joints. [7] used a Neurofuzzy adaptive control in a StewartGough manipulator with rotary actuators, each revolute link was trained under different loadings and maneuvers. So, they learned how to collaborate with the others to complete a task, for example, a desired trajectory.
Reference [8] made a review of StewartGough manipulator control schemes, in order to obtain a high performance control strategy design. Based on some analysis
of the systems a Incremental Nonlinear Dynamic Inversion controller is used to deal with the hydraulic actuator. Recently,
[9] proposed a selfcalibration method to improve the accuracy performance of a 6DOF parallel manipulator. The numerical simulations of this paper showed a considerable reduction on the parameters errors as in the position and orientation accuracy of the manipulator.On an Orthoglide robot, [10] used a generalized predictive control technique (GPC) to check the benefits of the strategy on the dynamic performance of the robot in terms of accuracy, disturbance rejection. This strategy, is composed of two control loops. The inner loop linearize the nonlinear dynamics using feedback linearization. And the outer loop tracks the desired trajectory based on the GPC method.
The dynamic model of a parallel manipulator allows implementing the computational simulation, where the main characteristics from the kinematics and dynamics movement can be known and studied. Based on the dynamic simulation of the robot, it is possible to project the motion control system. As an additional benefit, the computer simulations decrease the project costs, because they permit to know previously the dynamic behavior, singularities and potential errors of the manipulator project before its construction.
The purpose of this paper is to analyze the dynamic response and to project the position control system of the StewartGough manipulator. Initially, in order to analyze the complete dynamics and computational simulations of the manipulator, step forces are applied on the actuators to simulate the dynamic response. Then, the position control system is design based on the LQR and CTC control techniques.
The remain of this paper is organized as follows. Section II presents the StewartGough manipulator model. The LQR and CTC methods are presented in Section III. Section IV gives the numerical results. Finally, some conclusion and further work are enumerated.

STEWARTGOUGH MANIPULATOR MODEL The parallel manipulator used in this contribution is the
StewartGough platform, as can be seen at the Fig. 1, has six identical legs, that connects a fixed base to a movable platform by passive universal joints represented by U on the points , at the points are the passive spherical joints, defined as , where = 1, , 6, subsequently. The legs are divided in an upper and a lower member by Prismatic joints, showed at Fig. 1 as P. The Prismatic joint has a motor that extend and retract the leg. The movable platform has six degrees of freedom (DOF), which are three angular motions expressed as Euler
angles with respect to xyzaxes and three longitudinal linear motions at the xyz axes. According to the paper developed by [11], will be demonstrated, based on the NewtonEuler approach, the model kinematic and dynamic model of the StewartGough Platform.
Fig. 1. StewartGough Manipulator.

Legs Kinematics and Dynamics
The inverse kinematics represent the six legs length = [1, , 6] as function of the position p and orientation of the Euler angles of the movable platform. So, = [ ] and
= [ ] results in a rotational matrix =
( ()(). In this way, considering the close vector chain {}{}. Thus, the inverse kinematic model for each leg is:
= + + =   (1)
the dynamic analysis, the Euler equation is applied for the rotational equilibrium of the entire leg, thus:
. Ã— . Ã— + (. + . ) Ã— ( + ). Ã— ( + ). + . + Ã—
= 0 (5)
is the acceleration of the leg, is the constraint force at the spherical joint acting on the leg, represents the moment of viscous friction at the ith spherical joint = (
) and is the input force at the ith leg. For the upper part of the leg, the translational equilibrium is:
+ . . . . = 0 (6)
Fig. 2. Leg of the StewartGough Manipulator.
The equation that expresses, results of some substitution between equations above, it has a lot of terms almost all depends on the constraint force at the spherical joint
The unit vector along
is
= / . The velocity at the
acting on the leg, results substitution between the equations
point
from the movable
o is
presented before, where many terms are dependent of . Thus,
platf rm :
in order to use this expression in the dynamic equations of the platform, all these terms are grouped in the form (Q, a 3 Ã— 3
/p>
= Ã— + (2)
matrix), thus:
where is the angular velocity of the movable platform. The relative velocity between the upper and the lower member of the legs = . ; similarly, the angular velocity of the legs
Where,
= + . (7)
is = Ã— /. Consequently, the acceleration at points
2.. .2 +.2
of the movable platform is:
= [. (1 +
)
2
] . . +
.2 +.2 . ( . +
. ) 1 [
. ( Ã—
=
+ + + Ã— ( Ã— )
(3)
2
2
1
The acceleration of the center of gravity lower and upper parts of the legs are respectively:
). ( Ã— ) + . ( Ã— ). ( Ã— ) . ( )]
Finally, after some substitution of by its expression in (3), this equation represents the reaction force of the ith (see Fig.2) point of connection of the platform:
= 1 ( Ã— ) Ã— +
3
= . . . + . (8)
= (. ). + 1 ( Ã— ) Ã— + 4 (4)
where and are the centers of gravity of lower and upper part,= 2 Ã— + ( Ã— ) and 4 = + 2 Ã— +

Dynamics and kinematics of the movable platform
By applying the expression of (8) for the six legs (i =
1,…,6), the dynamic equations of the platform can be
Ã— ( Ã— ) + 2
, 2 = 1 ( Ã— 1 2). Considering
formulated. The acceleration of the center of gravity of the
platform respect to the reference frame is:
= Ã— + Ã— ( Ã— ) + (9)
where, = and expresses the distance of the center of gravity of the platform to the frame {A}.
Applying the Newton equation for translational equilibrium and the Euler equation for rotational equilibrium of the platform, we have respectively:
=
=
. + . 6 6( ) = 0 (10)
So is the new input control vector. Where this equation represents the inverse dynamic control scheme, which the dynamic direct model is turned into a double set of integrators. In this way, the control method can be used to project the tracking position control. Assuming that the requested trajectory is described with the desire position , velocity
and the acceleration . So, the control law for the PD
controller is:
.
Ã— + . Ã— . Ã— . +
= + ( ) + ( ) (17)
6 1[ Ã— ] + 6 1 = 0 (11)
=
=
Where
= (
1
, ,
6
) and =
represents the mass and = the inertia of platform and payload. Finally, the expressions of and are substituted into the Newton equations and Euler equations
and the complete dynamic of the platform is obtained:
(1, , 6) are the controller gain matrices.
The gain of the controller are obtained to have the closed
loop characteristic equation of the controlled system: (2 + 2 + 2) = 0, s represents the Laplace variable. Thus,
= 2, = .
. [ ] + = . (12)
where, = + 6 1 ; = + 6 1
e =
=
. .
[],
=
= [ ],
.
+ ( 2. .
. . .
. [ Ã— ( Ã— ) ]
= [ Ã— . + Ã— [(. ). ]
] , =
[Ã—
1 6
], = (
], = (
Ã— 1 6 Ã— 6
), this matrix
Fig. 3. CTC and PD Control
describes the Jacobian matrix of the manipulator, and = [ 6] . The jointspace dynamic equations are obtained with using the sliding acceleration of a prismatic joint of the ith leg:
B. Linear Quadratic Regulator
The quadratic optimal control method is a systematic form to determinate the feedback control gain of the state matrix
[] =
( ) (13)
form. In the LQR controller project, is considered a time invariant, which is given by the state space system
Finally, it is obtained the dynamic equation of the Stewart Gough robot in joint space is:
1 + 1( ) = (14)


CONTROL SYSTEM
A. Computed Torque Control
It is necessary to apply the CTC method, linearize the non linear dynamic (14). As () = 1and (, ) =
1( ), the dynamic nonlinear equation of the manipulator can be represented as:
= () + (, ) (15)
0
0
Thus, the manipulator dynamic equation is linearized and decoupled by nonlinear feedback. So, () and (, ) can be estimated as () and (, ). Considering that () = ()
representation:
() = () + () (18)
() = () + () (19)
where A, B, C and D represent the state matrices, x(t) is the model state vector, u(t) is input vector, y(t) is the generic system output. [6]. Thus, the state feedback is defined as:
() = () (20)
K is the state feedback matrix. Substituting (20) into (18), it is obtained the closedloop response:
() = ( )() (21)
To obtain the optimal gain, the following equation must be minimized:
and (, ) = (, ), so is reduced to a linear control on decoupled doubleintegrators, where:
= (16)
= [() () + ()()]
(22)
Where the matrices Q and R are responsible for the error and the energy consumption. With Q and R, the feedback matrix is represented by:
= 1, (23)
which = 0 must satisfied the Riccati algebraic equation. [6].
+ 1 + = 0 (25)

RESULTS
In order to study the dynamic response by the influence of the actuators action, six pulse generators applied a 1N force during 0.5 seconds at each leg of the StewartGough manipulator, which was at a determined initial position. This is important to understand the dynamic characteristics of the manipulator and to project the controller.
For the control simulations, both controller were tuned using the methods presented at section III. To analyze the performance of the techniques, two simulations were realized. First, a simulation to evaluate the tracking position for a determined circular trajectory. The second simulation was about the reaction of the controllers, when the manipulator at fixed initial position suffer a perturbation and had to return to the initial position. The parameters used in the simulations (see Tab. I), were obtained at [12].

Dynamic Analysis
To the dynamic analysis was implemented in a computational simulation, through the Matlab/SimulinkÂ® software. A simulation, where six pulse generators applied a force, to imitate the action from the actuators, which is applied a 1N force for 0.5 seconds in each leg of the StewartGough manipulator. At the Fig. 4, it is possible to see, the initial position of the mechanism and after the application of the force, the final position.

(b)
Fig. 4. Initial and Final position of the Stewart Platform.
It is showed at the Fig. 5, the initial positions of the legs and the displacement of the legs during the actuators force application. The Fig. 6 shows the velocity of the six legs of the manipulator from the repose and during the application of the force, in a pulse form, during 0.5 seconds. With these results, is possible to see the reaction of the legs of the StewartGough manipulator, during the applicationof the forces from the actuators.


Control
The control methods previous presented, were used to determinate the gain of the controllers. To the computational simulation was used again the parameters of [1] and the dynamic equation presented previously.
TABLE I.
Dynamic Parameters for Simulation
Parameter
Value
ai
0.3 0.0 0.1
0.3 0.2 0.0
0.0 0.3 0.0
0.2 0.1 0.1
0.15 0.2 0.05
[ 0.15 0.15 0.05]bi
0.6 0.2 0.0
0.1 0.5 0.1
0.3 0.3 0.1
0.3 0.4 0.0
0.2 0.3 0.05
[ 0.5 0.2 0.0 ]mp
40 kg
md
3 kg
mu
1 kg
rd
[0.4 0.14 0.18] ru
[6 0.08 0.08] rp
[0.04 0.03 0.06] Id
0.010 0.005 0.007
[0.005 0.002 0.003] . 20.007 0.003 0.001
Iu
0.005 0.002 0.002
[0.002 0.002 0.001] . 20.002 0.001 0.003
Ip
0.05 0.003 0.004
[0.003 0.004 0.003] . 20.004 0.003 0.100
Fig. 5. Legs Displacement.
The PD controller was tuned to obtain a stable response without overshoot, = 35 / e = 1. Thus, the gains was obtained with the equations presented at the chapter III,
= [1225 1225 1225 1225 1225 1225] and
= [35 35 35 35 35 35].
Fig. 6. Legs Displacement.
The LQR was tuned to satisfy similar characteristics of the PD. Based on the linearized model for each joint of the Eq. 16, the system matrices of the Eq. 18 and Eq.19, was defined as: = [0 1] , = [0 1], = [1 0] e = [0]. To
0 0
define the LQR control matrices, the values of Q and R, were
(a)
obtained after simulations as = [160000 0 ] and =
0 253
[0,1]. Consequently, we get the gain of the controller = [1264 1264 1264 1264 1264 1264] and = [71 71 71 71 71 71]. In the next figure, it is possible to seethe circular trajectory of the movable platform at the workspace, which is used to evaluate the controllers:
Fig. 7. Tracking trajetory.
The Fig 8. shows the error in the tracking of the joints for the PD and the LQR methods, respectively. It can be observed that both controllers have a similar result. At the Fig 9. and Fig 10. are presented the behavior of the forces of the six actuators through the control methods PD and LQR, for the trajectory showed on the Fig.7. On both cases, the results are equivalent, because of the gains obtained for these methods are similar.
The last test simulation shows the disturbance reaction, when the movable platform is in a fixed initial position = [0 0 0,395 0 0 0]and is applied a 5N step force at zaxis. How it can be seen, at Fig. 11, for the both controls techniques, which the Fig. 11(a) on represents the PD and Fig. 11(b) is the LQR. Comparing the PD with the LQR result, it is possible to see a light attenuation on the overshooting during the stabilization, because the LQR method has a better damping compared with the PD method.
(b)
Fig. 8. Tracking error of the joints.
Fig. 9. Force control for the six atuators using CTC method.


CONCLUSION
First, in this contribution was presented the StewartGough manipulator model, where the kinematic and dynamics equations were showed. After this, was introduced the controller methods used to tune the controller on this paper With the model was possible to do some numerical simulations and also project the of the controllers.
The dynamic simulations showed how the behavior of the StewartGough manipulator during the force application, in a pulse form, in each leg of the manipulator. This was fundamental to project the controller. The results of the
controller simulations were similar, but it is important the optimal tuned way with the LQR method.
Fig. 10. Force control for the six atuators using CTC method.
(a)
(b)
Fig. 11. Disturbance reaction for both methods.
ACKNOWLEDGMENT
The authors express their acknowledgements to the Graduate Program of Mechanical Engineering, jointly funded by CAPES.
REFERENCES

M. Wapler, V. Urban, T. Weisener, J. Stallkamp, M. Durr, and A. Hiller,A Stewart platform for precision surgery, Transactions of the Institute of Measurement and Control, vol. 25, no. 4, pp. 329334, 2003.

J. Kilaru, M.K. Karnam, S. Agarwal and S. Bandyopadhyay, Optimal design of parallel manipulators based on their dynamic performance, In Proceedings of the 14th IFToMM World Congress, 2015, pp. 406 412.

Bennehar, M., Chemori, A.; Pierrot, F. A new revised desired compensation adaptive control for enhanced tracking: application to ra pkms. Advanced Robotics, Taylor & Francis, pp. 116, 2016.

M. Liu, C. LI, C. LI, Dynamics analysis of the goughstewart platform manipulator, IEEE Transactions on Robotics and Automation, v. 16, n. 1, p. 9498, 2000.J. Clerk Maxwell, A Treatise on Electricity and Magnetism, vol. 2, Oxford: Clarendon, 1892, pp.6873.

H. Guo, Y. Liu, G. Liu, and H. Li, Cascade control of a hydraulically
driven 6DOF parallel robot manipulator based on a sliding mode. Control Engineering Practice, v. 16, n. 9, p. 10551068, 2008.

F.A. LaraMolina, K.A. Takano, and E.H. Koroishi. "SetPoint Regulation of a Robot Manipulator with Flexible Joints Using Fuzzy Control." 2015 12th Latin American Robotics Symposium and 2015 3rd Brazilian Symposium on Robotics (LARSSBR). IEEE, 2015.

M. Eftekhari, M. Eftekhari, and H. Karimpour. "Neurofuzzy adaptive control of a revolute stewart platform carrying payloads of unknown inertia." Robotica 33.09 (2015): 20012024.

Y. Huang, D. M. Pool, O. Stroosma, Q. P. Chu, and M. Mulder, A Review of Control Schemes for Hydraulic Stewart Platform Flight Simulator Motion Systems, AIAA Modeling and Simulation Technologies Conference, California, pp. 14361450, January 2016

C. Gao, D. Cong, J. Han, Z. Yang and X. Wang, SelfCalibration of a 6DOF Redundantly Actuated Parallel Mechanism, 2016 IEEE International Conference on Mechatronics and Automation, Japan, pp. 128132, August 2016.

F. A. LaraMolina, J.M. RosÃ¡rio, D. Dumur and P. Wenger, Robust generalized predictive control of the Orthoglide robot, Industrial Robot: An International Journal, 41(3), p. 275285, 2014.

F.A. LaraMolina, J.M RosÃ¡rio and D. Dumur, "Robust generalized predictive control of StewartGough platform," Robotics Symposium, 2011 IEEE IX Latin American and IEEE Colombian Conference on Automatic Control and Industry Applications (LARC), p. 16, 2011.

B. Dasgupta, and T. S. Mruthyunjaya. "Closedform dynamic equations of the general Stewart platform through the NewtonEuler approach."Mechanism and machine theory 33.7 (1998): 9931012.