Professional Documents
Culture Documents
net/publication/314673438
Computed Torque Control of the Stewart Platform with Uncertainty for Lower
Extremity Robotic Rehabilitation
CITATION READS
1 230
4 authors:
Some of the authors of this publication are also working on these related projects:
All content following this page was uploaded by Arman Dabiri on 18 October 2018.
Abstract— Parallel manipulators play a key role in robotic from important properties such as high stiffness, high accu-
rehabilitation. In reality, such systems operate under uncer- racy, and large load-to-weight ratio. These qualities make it
tainty due to the changes in the characteristics of the patients a good candidate for being used as a rehabilitation robot.
and lack of knowledge about the physical and geometrical
properties of the system. In this paper, we present a robust Stewart platform was first used for rehabilitation purposes at
control scheme to control a six-degree-of-freedom Stewart Rutgers University [15]. This robot is also able to be operated
platform. In this application, it is aimed to follow a desired at home using telerahabilitation [2] which provides the ability
pure rotational motion required in the robotic rehabilitation of for remote monitoring and periodic reassessment. Several
the foot for patients with diabetic neuropathy. It is assumed that approaches can be used to perform the dynamic analysis and
uncertainty exists in the mass of the foot of the patients (the
proposed approach can also be used when disturbance exists). control [16] of the Stewart mechanism [17] including: virtual
To perform this, the method of polynomial chaos expansion work [18], Lagrange method [19], Newton Euler approach
(PCE) is extended and integrated with the computed torque [9], and Hamilton’s principle [11]. Therefore, the detail of
control law (CTCL) to control the system. In PCE scheme, deriving the dynamic equations of motion is not provided in
uncertainty is introduced to the system by compactly projecting this paper.
each stochastic response output and random input onto the
space of appropriate independent orthogonal polynomial basis In real applications, these systems operate under the in-
functions. CTCL uses a feedback linearization technique which fluence of uncertainty in the characteristics of the patients.
provides the necessary force/torque to enforce the system to In addition, lack of knowledge about the physical and
follow a prescribed trajectory. This papers presents a successful geometrical properties of the system is another source of
implementation of the PCE-base CTCL on a Stewart platform. uncertainty. Essentially, the designed platform is intended
Finally, a comparison between the efficiency and accuracy of
the Monte Carlo and PCE is conducted. to be used for the foot rehabilitation of the patients with
neuropathy. One of the most important uncertainties observed
I. I NTRODUCTION in this application is in the mass of the foot of the patient.
As such, the modeling scheme and controller should be
Multibody dynamics plays a key role in the modeling, robust enough to be able to model and control the platform
simulation, design, and control of many engineering prob- under uncertainty in the mass of the foot of the patients.
lems. One of the applications of multibody systems is in Considering uncertainty in the dynamic analysis and control
robotic rehabilitation. In this scheme, patients’ efforts can of multibody systems is relatively new. Polynomial Chaos
be evaluated, and therefore the training process can be Expansion (PCE) was first applied to the dynamic modeling
conducted to help them more effectively. Utilizing parallel of the nondeterministic systems by Sandu in [20], [21]. A
robots for rehabilitation purposes is relatively new [1], [2]. highly parallelizable divide-and-conquer based PCE has been
These robots are capable of doing repeated tasks with high developed in [22] to reduce the computational complexity
precision. Valuable efforts and advances have been conducted of the simulation of nondeterministic multibody systems
to the development of the parallel mechanisms [3]–[11]. [23]. In the field of control of multibody systems, PCE
Among parallel mechanisms, the Stewart platform is the most was first applied to control nondeterministic systems in
celebrated one which was introduced in 1965 [12]. Major 2003 [24]. Templeton has applied the same technique to an
industrial applications of this device are flight simulators, au- H2 optimal control problem [25]. Voglewede et. al., have
tomobile simulators, alignment mechanisms. In our case, the applied polynomial chaos theory to control a SCARA robot
Stewart platform is used as a neurorehabilitative exergaming manipulator with uncertainties in the mass of the constituent
platform [13], [14]. This complex multibody system benefits bodies [26]. A general scheme to apply PCE based CTCL
to nondeterministic multibody systems has provided in [23].
1 Sahand Sabet is with the Aerospace and Mechanical
Engineering Department, University of Arizona, AZ 85721, USA
This paper considers the control of this platform with
sahandsabet@email.arizona.edu uncertainty in the mass of the foot of the patient. As such,
2 Arman Dabiri is with the Aerospace and Mechanical Engineering
the Stewart platform with the 6-UPS mechanical structure
Department, University of Arizona, AZ 85721, USA (corresponding author: as shown in Fig. 1 is used for this analysis. It consists of a
Phone: 520-561-5612; armandabiri@email.arizona.edu)
3 Prof. Armstrong is with the Department of Surgery, top platform, a base platform, and six linear actuators (legs).
College of Medicine, University of Arizona, AZ 85721, USA Each actuator is connected to the base plate and the top
dga@email.arizona.edu plate with a universal joint and a spherical joint, respectively.
4 Prof. Poursina is with the Aerospace and Mechanical
Engineering Department, University of Arizona, AZ 85721, USA The radius of the top plate, the radius of the platform base,
mpoursina@gmail.com the height of the system, and the length of the links are
Nt
R(t, ζ) ∼
X
= ri (t)Λi (ζ). (2)
i=0
For a case with Nu number of uncertain parameters ζ =
(ζ1 , ζ2 , ..., ζNu ), the total number of terms Nt + 1 in (2)
with maximum order of polynomial P can be evaluated as
[20], [22]
(Nu + P )!
Nt + 1 = . (3)
Nu !P !
The orthogonal base functions presented in (1) can
be chosen based on the type of random variable and the
support range as can be seen in Tab. I. According to [29],
these polynomials establish a complete orthogonal basis for
the Hilbert space of square integrable random variables.
Therefore, the weighted inner product of two base functions
Fig. 1: A Stewart platform with the 6-UPS parallel manipulators. for one-dimensional random variable can be evaluated as
Z
< λi (ζ), λj (ζ) > , λi (ζ)λj (ζ)w(ζ)dζ = h2i δij , (4)
denoted by r, R, h, and li , i = 1, 2, · · · , 6, respectively. The
offset angles θt and θb on the both top and base plates are where δij is the Kronecker delta and h2i is a positive number.
also illustrated in the figure. Herein, the method of PCE is When considering n-dimensional random variable, (4) can
extended and integrated with the Computed Torque Control be represented as
Law (CTCL). In PCE scheme, uncertainty is introduced to < Λ (ζ), Λj (ζ) >=
the system by compactly projecting each stochastic response Z iZ
output and random input onto the space of appropriate ... Λi (ζ)Λj (ζ)w(ζ1 )...w(ζn )dζ1 ...dζn = c2i δij , (5)
independent orthogonal polynomial basis functions. CTCL
where c2i is a positive number.
presents a feedback linearization technique which provides
Eventually, having the PCE-series coefficients ri corre-
the necessary force/torque to enforce the system to follow
sponding to the orthogonal base functions Λi (ζ1 , ..., ζn ), one
a prescribed trajectory. A general scheme is introduced to
can easily evaluate the stochastic response of the system
solve the stochastic equations of motion. At the end, this
including expected value and standard deviation using the
method is applied to control a Stewart mechanism with the
following equations
uncertainty described previously. Herein, a PD controller is
used. However, using the proposed method, a PID controller E[R] = r0 , (6)
could be utilized when disturbance exists. Finally, the results ∞
X
of the comparison between the traditionally used Monte V ar(R) = E[R2 ] − (E[R])2 = ri2 < Λ2i > . (7)
Carlo method and the intrusive PCE in the context of the i=1
time efficiency and accuracy is presented. A detail explanation to find the PCE-series expansion
coefficients ri will be provided in this paper.
II. P OLYNOMIAL C HAOS E XPANSION FOR U NCERTAINTY
A NALYSIS III. C OMPUTED T ORQUE C ONTROL L AW FOR
PCE provides a convenient framework to compactly D ETERMINISTIC S YSTEMS
project each stochastic response output and random input This section explains the Computed Torque Control Law to
onto the space of orthogonal base functions as [20], [27] control deterministic multibody systems. CTCL is a feedback
∞
X linearization method which uses inverse dynamic to find
R(t, ζ) = ri (t)Λi (ζ). (1) the required force to make the system follow a prescribed
i=0 trajectory [30]. The dynamic equations of a fully-actuated
In this equation, R(t, ζ) is a random quantity, ri rep- deterministic multibody system can be stated as
resents the time-dependent coefficients, and Λi (ζ1 , ..., ζn )
M (q)q̈ + N (q, q̇) + fd = f, (8)
(usually denoted as λi (ζ) in case of one-dimensional random
variable) contain the time-invariant generalized polynomial where M (q) is the inertia matrix of the entire system, q
chaos. These multidimensional polynomials are expressed in denotes the column matrix of the joint variables, and f
terms of random variables ζ(ζ1 , ..., ζn ). The series shown in represents column matrix of the generalized driving/control
(1) converges to any random process in L2 sense [28]. One force [31] at each joint. The term N (q, q̇) includes the non-
might truncate this infinite expansion at a finite number of control generalized forces due to Coriolis/centripetal and
terms Nt as gravity terms [32] and fd denotes the disturbance vector
TABLE I: RELATION BETWEEN BASE FUNCTIONS, SUPPORTS, AND DISTRIBUTION FUNCTIONS
−x2 −x2
Normal √1 e 2 Hermite (−∞, ∞) e 2
2π
−x
Exponential e Laguerre [0, ∞) e−x
xα e−x
Gamma Γ(α+1) Generalized Laguerre [0, ∞) xα e−x
which is assumed to be zero. Defining the prescribed joint input w can be substituted into (16) to compute the driving
trajectory as qd (t), one can express the tracking error at force f as
position, velocity and acceleration levels as [23]
f = M (q)(q̈d + Kv ė + Kp e) + N (q, q̇). (20)
e(t) = qd (t) − q(t), (9)
The driving force f in (20) can be substituted into (17),
ė(t) = q̇d (t) − q̇(t), (10) resulting in the closed-loop dynamic equation as
ë(t) = q̈d (t) − q̈(t). (11)
M (q)q̈ + N (q, q̇) = M (q)(q̈d + Kv ė + Kp e) + N (q, q̇), (21)
The dynamic equation of system (8) can be solved for q̈ and
the result can be substituted into (11), resulting in which can be simplified as
0.5
-80
Trajectory of the Center of Mass
-100
0.4
-120
Trajectory of the -rst joint x1 ( from PCE and Monte Carlo)
0.3 Desirable trajectory of the -rst joint x1 = 0 -140
Trajectory of the -rst joint 31 ( from PCE and Monte Carlo)
Mean Value of f~1 from Monte Carlo
Desirable trajectory of the -rst joint 31 = 30:/180sin(2t:/4)
-160 Mean Valueof f~1 from PCE
0.2 Mean Valueof f~6 from Monte Carlo
-180 Mean Valueof f~6 from PCE
0.1 -200
-220
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2
0 Time (sec)
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2
Time (sec)