Beruflich Dokumente
Kultur Dokumente
A STEWART PLATFORM
FOR VEHICLE EMULA TOR SYSTEMS
by YOUHONG
GONG M.S., Materials
Engineering
Shanghai Jiao Tong University
(1984)
MASTER OF SCIENCE
IN ENGINEERING
at the
Massachusetts Institute of Technology
January 1992
© 1992 Massachusetts Institute of Technology
Ali rights reserved
Ain A. Sonin
Chairman, Departmental Graduate Committee
f L-. 8 ;~ o 1992
UBFMfHES
DESIGN ANALYSIS OF A STEWART PLATFORM
FOR VEHICLE EMULA TOR SYSTEMS
by
YOUHONG GONG
ABSTRACT
Abstract 2
To My Wife Xiaoyan
3
ACKNOWLEDGEMENTS
Acknowledgements 4
Tl.\BLE OF CONTEN1,S
Abstract 2
Acknowledgements 4
Table of Contents 5
List of Figures 6
List of Tables 7
l. Introduction 8
1.1 Overview 8
1.2 Vehicle Emulator System 8
1.3 Contents and Organizations 10
2. Design Specifications 12
2.1 Design Considerations 12
2.2 Admittance Emulation Accuracy Analysis 13
2.3 Stiffness Analysis 23
3. Kinematic Analysis 35
3 .1 Kinemaric Models 35
3.2 Forward Kinematics 38
3 .3 Kinematic Constraints 44
4. Graphical Simulation 48
4.1 Interactive Format 48
4.2 Design Tool 50
4.2.l Workspace 51
4.2.2 Joint Angle 54
4.2.3 Flow Rate 56
4.3 Validation of Controller 57
5. Kinematics Error Correction 58
5 .1 Error Calibration 59
5 .2 Error Compensation 63
6. Conclusion and Recommendations 65
Appendix 68
References 98
Table of Contents 5
LIST OF FIGURES
List of Figures 6
LIST OF TABLES
List of Tables 7
CHAPTER 1
INTRODUCTION
1.1 OVERVIEW
Chapter 1: Introduction 8
robotic manipulator
\
computer
Stewart platform
Chapter 1: lntroduction 9
Toe force sensor measures the forces acting on the platform due to the
motion of the manipulator. The platform controller model, the dynamic
response of the system to those forces, i.e. the trajectory which the
modeled system would follow if it were subjected to those forces, and
controls the six hydraulic actuators to achieve the leg Iengths
corresponding to each desired platform motion and thus imposes the
trajectory of the modeled system on platform. Because VES is
prograrnmable, the platform can emulate a wide range of different
dynamic system.
Chapter 1: Introduction 10
concludes the investigation of design of Stewart platform use as VES and
suggests areas where further work is needed. The appendices contain
derivations which are too lengthy to be included in the main body.
Chapter 1: Introduction 11
CHAPTER2
this set of design specifications was not complete. Toe performance of the
platform designed only considering these specifications sometime was not
so satisfactory, e.g. MIT first platform was floppy in horizontal direction.
E= tracking error
the range of motion Eqn. (2.1)
Relative error was used here, because absolute error is not a good measure
for simulation, e.g, a 2 inch error for simulation with a range of 2 feet
motion is large but maybe not so bad for a 20 feet motion.
where ~ and 'Y are coefficients representing the quality of the force sensor,
and Js and fsrriax are dynamic force the sensor measures and its maximum
value respectively,
me -----¡--¡--
- ---- 1
1
1
yi 1
1
I Z
m --.-· 1
1
1
x: 1
1
1
Eqn. (2.4a)
eg = L\zz = _ 1rne
m Eqn. (2.4b)
\a
\
J=mr¡
Figure 2.2 One-Degree-Of-Freedom Rotation Model of VES
Using the sarne initial conditions, and assuming small motion of the base,
we obtain very similar results. (see Appendix 1.2)
Eqn. (2.6a)
Eg
_ ~a _
----y-
le _ mel2
--y-
a. J mr2g
Eqn. (2.6b)
rf
J=
fg =~=-y~[l +E-+~]
z tn r2g rnr28 Eqn. (2.7b)
The results shows that the both offset error or gain error consists of
pure translational term, pure rotational term and a coupling term, which
reflects the difficulty of accuracy analysis when the degrees of freedom of
the system increases. However, this simple VES model relates the
simulation error with masses or inertias of the system, quality of force
sensor, frequency of robot motion and simulation time, and thus gives a
rough measure of the accuracy of the simulation for a given system
especially for the simulation of a robot working in space, and it provides
very helpful information for selecting a proper force sensor.
For VES to simulate more general base system, e.g., the suspension
system of a vehicle, the stiffness of the base system is a very important fact,
so, it should be considered in the base model in addition to the inertial
effect of the base, this two-degrees-of-freedom VES model is shown in
Figure 2.4. In the model the stiffness of the base system includes both
translational stiffness k and rotational stiffness kr. Since stiffness exists in
the base systern, the base will produce a restoring force to balance the
error force caused by the offset error of the force sensor. Therefore, in
vehicle emulation case, the offset error is static and negligible and the gain
error will dominate.
x' 1
1
------------~-------
Figure 2.4 Two-Degrees-Of-Freedom Model of VES
Using the same method and same conditions, the accuracy of VES
for the vehicle emulation could be obtained. (see Appendix 1.4)
M= ro2
ro2-~ Eqn. (2.9a)
Eqn. (2.9b)
Eqn. (2.1Ob)
This model is consistent with previous models, e.g., let k--+0, and
kr--+0, so, ron--+O, CJ>nr--+0, M--+l and Mr--+1, and the result will be the same as
12 II1el2ro2
Eg = -L\z
z
2 I
= -ymero G-- - - +
k kr kkr
]
Eqn. (2.12)
(a) (b)
Figure 2.5 A Symmetric Stewart Platf orm
(a) Model of Platform (b) Top View
R ,(y)Ry(i3)Rx(a) ; ] [ D 1 D2 03 Yzxl ]
[D] = [D(x)] = z =
[
o o o 11 o o o Eqn. (2.14)
where
0 \ f cosñcosy \
f
D1 = { D~~ = \ cos~siny
031 . A
-sm p I Eqn. (2.15a)
fO f
D2 = \ gi~ } sinnsinjícosy-cosnsiny \
= \ sinasin~siny+cosacosy
\ sinncosf I Eqn. (2.15b)
0 ¡ cosusinjicosy+sinnsiny \
D3 = { g~ } = \ coscsínüsínj-sínccosy
Chapter 2: Design Specifications 25
cosacos~ I Eqn. (2.15c)
/ l¡x\ = P1 - B
11 = l¡y I
J lix } f l 1• D 1 \
11=\t =\ lrD2 f Eqn. (2. l 6b)
lrD 3
substitute Eqn. (2.13) - Eqn. (2.15) into Eqn. (2.16a), we obtain
Eqn. (2.17)
Eqn. (2.18)
l=(~)=l(x)
Eqn. (2.19)
are end-effector force vector and leg force vector respectively, as shown in
Figure 2.6. [1]1 is the transpose of the manipulator J acobian matrix, which
is defined as
If we neglect gravity and friction, we can relate the, leg force to leg
deflection .11 = [.11 l , .112, · · ·, .1l6]T by the individual stiffness, which is
modeled as
Eqn. (2.23)
where f¡ is the force produced by leg i and .11¡ is the deflection of leg i. k,
is the spring constant. Eqn (2.6) could be rewritten in vector form
P~\
ti/ ={F}1
Leg Force
where
[S] = [JJT [K][J] Eqn. (2.29)
7t
x11 = rsin( ~ + <?2); YJI = reos( 6
+ <?2);
7t
x12 = rsin( : - 4>2); Y12 = reos( 6
- 4>2);
*
X¡ = XJ¡ - Xs¡ Eqn. (2.3 la)
Chapter 2: Design Specifications 30
Yt
• = Y1t • Ye1 Eqn. (2.31b)
f
i•I
Xe1 = ±
i•I
Y e1 = f
i•l
x11 = f
i•l
YJl = O
Eqn. (2.32a)
f xi = f Yi = ± xi Yi = O
i==I i=I i•l Eqn. (2.32b)
±
i=I
(X1i = ±
i=l
(Y¡¡}2 = 3R2
Eqn. (2.3 2e)
L 6
x1¡Xa¡ =L YJiYa¡ = - 1
6
. 1 2
(r* 2 -r2-R)
2
l. = 1 t= Eqn. (2.32f)
6_ 6
L 2
XJ¡Y Bi = L YJiXB¡YBi= -~rR2sin(1t/6+<p2-2<pl)
i=l i=l Eqn. (2.32g)
6 6
L y¡¡XBi = L XJ¡ynYe¡= fr2Rsin(7t/6+cpl-2<p2)
Eqn. (2.32h)
i=l i=l
L6 yy¡XBi2 = L6 Xf¡YB¡=
2
ir2R2[3+2cos2(cpl+<p2)-v3sin(2<pl+2<p2)]
i=l i=l
Eqn. (2.3 2i)
Chapter 2: Design Specifications 31
t
i•I
XJ ¡y 11X Bi Y BI = -¡r2R 2sin( ff/6- 2<¡, t -2cp2)
Eqn. (2.32j)
From Eqn. (2.17). (2.18) and (2.30), each term of Jacobian matrix
[J] can be given by (see Appendix 2.2),
ol¡_1x, _D11XJ¡+D12YJ¡+x-X9¡
ax - l¡ - l¡ Eqn. (2.33a)
di¡ lr(y1¡sincxD1-x1¡sincxD2-x1¡cosaD3)
d~ I¡ Eqn. (2.33e)
o 10 20 30 40 so 60 70 80 90
Chapter 2: Design.Specifications 33
This stiffness analysis explains why the old platfonn is so floppy in
horizontal direction, because the design parameter 9 was 74 °, so the ratio
of vertical stiffness to horizontal stiffness for the previous platfonn was
about 20. The stiffness analysis also provides us some guidelines for
detennining the shape of the platfonn in tenns of the locations of the joint
attachments to base, in other words, for a given home height of the
platform, z0, another design parameter cp 1 should be chosen as small as
possible, so that angle 0 could be smaller to improve the horizontal
stiffness,
J1 (PI)/
Leg i
X
SA/
I~
81
Eqn. (3.1)
where h is the pitch. From skew theory, given the displacement and
velocity of the platform, the velocities of the legs can be obtained. (see
Fichter [ 111)
The origin of xyz, is joint B¡ and the axis x¡ points towards joint J ¡.
The y¡ axis is parallel to the cross product of -Z and I¡, and the axis z¡ is
defined by the right hand rule. Thus the motion of the leg i could be
described by the referen ce frame xyz, with respect to XYZ.
These three models are essentially the same, because they represent
the same physical plant, just different in the mapping of the coordinates
from one vector space to another one. However, a different model is more
than just a varying representation of the platform, it can elucidate aspects
of the underlying theory and suggest results that might be otherwise go
unsolvable or unnoticed. Model 1 is an easy, straight-forward and efficient
model for calculation of inverse or forward kinematics and for real time
control of the platfonn. But, model 1 does not consider the rotation of the
legs, so generally it could not be extended to a dynamic, model. Model 2
takes consideration of the rotation of the legs and skew theory provides
qualitative and physical insight into underlying geometry of the platform
while quantitative calculation could be easier via coordinate map. Model 2
is used to calculate the rate change of the leg velocity, to determine the
singular positions of the platform and to do dynamic analysis based on
screw theory. However, the calculation using model 2 is complicated and
time consuming. Model 3 puts emphasis on each leg, so it is easy to
X = i'
'º
[Jj1dl +xo
Eqn. (3.3)
ar
f (x +Ax)= f(x) + dX Ax = f(x) + dxa1 Ax
= f'(x) + [J]A X Eqn. (3.5)
Eqn. (3.8)
so if we chose
Eqn. (3.11)
then, we obtain
Eqn. (3.12)
GRAPHICAL SIMULATION
4.2.1 WORKSPACE
o.
-30.
-100. o. +100.
9v (deg.)
+90.
0h(deg.) O.
-90.
-30. o. +30.
Horizontal axis (in)
g/J D '.
. , , ··-.
. "" ~•. .· .. . .
·.
,,
· .. ..
... ·.
,··,
'ií
·
·"
-.
-. ,•
100
90
80
.- Average Flow
:a
Q...
70
- 60
o
~
so
(U
~ 40
~ 30
o
ti: 20
10
o
0.35
....
-
o
(U
0.25
Flow In
:i
c..
E E
:,
0.15
:::,
Q..
u
(U ~ o.os
~ Q...
,..s... o -o.os
:, o
Flow Out
~! -0.15
o<B
......
-
o
~
-0.25
ü: -0.35
o.o 0.5 1.0 1.5 2.0 2.5 3.0 3.5 4.0
Time (sec)
C = e, + ~C Eqn. (5.1)
where ~e is the parameter variations. For the real platform, leg length
vector is the function of geometric parameter e and the configuration of
the platform x, i.e.
which is exact Eqn. (2.22). For the desired end-effector position vector
xd, we have
Eqn. (5.S)
Eqn. (5.6)
therefore, even the VES controller is good enough to drive the legs to
reach exactly the desired lengths, there still exists an error between the
configuration of the platform and the desired configuration, i.e.
Eqn. (5.7)
Eqn. (S.8)
where
Eqn. (5.9)
is the configuration deviation of the real platform when its leg length is Id.
If we expand Eqn. (5.8) in Taylor series and neglect the higher order
tenns, we obtain
Eqn. (5.10)
substitute Eqn. (5.4) and Eqn. (5.5) into the above equation,
Eqn. (5.11)
Ac • -[~r [J]
1
Ax
Eqn. (S.13)
difficulty of calculation of matrix [t~] and its inverse matrix, and the
data not being "persistently excitíng", Since we only deal with the
deviation of geometric parameters, how to delete the effects of non-
geometric factors such as backlash and joint compliance should be very
carefully considered in the experiments, In order to obtain an accurate and
stable solution, a parameter identification procedure including the method
of statistical approximation must also be applied.
Eqn. (5.14)
where
Eqn. (5.15)
• = 1 d + l\ Id
Id Eqn. (5.16)
where
Eqn. (5.17)
From the analysis in previous section, it is shown that both approaches are
equivalent in terms of the compensation effect if the geometric parameter
variations are sufficiently small. However, the second method does not
require computation of the inverse Jacobian matrix and thus can be used in
the singular configurations of the platform. In addition, this method is
superior in terms of time efficiency.
yi 1
1
I Z
1
.... m~----.-·
1
1
x:
1
1
1
where Y is the magnitude of robot motion and (JJ is the frequency of robot
motion, we have
y =Yrocosrot and y= -Yo>2sinrot = -o:,2y
We also assume zero initial conditions, i.e.,
Appendix 1.1 68
x • O, x = o, y = O, y = o when t = o .
(i)Due to the offset error of the force sensor l\fo = Pfsmax = Pmxmax, and from
the equation m(l\x) = l\fo = ~mxmax= -P~Ymax, we integrate twice and get
Since VES uses admittance model, the l\x won't affect y, i.e., l\ylAr = O 0
and also we have Zmax = m~e Y, so, the error of simulation due to offset
error of the force sensor is
(ii) Due to the gain error of the force sensor l\f8 = 'YÍs = -yf = ymx = -1r:;;)i,
and from the equation m(l\x) = L\f 8 = ymx, integration gives us
L'.\xlAf
'
= -y m+111e
I11e y= yx
therefore, the error of simulation due to gain error of the force sensor is
-'Ytne
E =--'z L\zlAr L\xl¿1r
=--' z
m+m/
= _m_y
me
=-y- m_
g
rn+m,
Appendix 1.1 69
Appendix 1.2
A
J mr2g
If we modify the one-degree-of-freedom model as shown in
Appendix 1.1 to analyze VES rotational motion, and consider robot motion
9 = 9sinrot, we have
2 ....
a = 0+cp , Jei:i = 111el2a = 't, :. Illel (0+<p) = r, since 'ts = -t
.. 2··
:. J<p = mr8<p = ts = -'t
..
(mel2+mr¡)<p = -mel20
Appendix 1 .2 70
(i)Due to the offset error of the force sensor L\fo • Pi,mu • PJ<pmu, and from
4q>l41o = p.A-ec.o2t2
J+Je
sínce i.\8l4fo = o
and also we have <Xmax = 'IÍ:¡;0, therefor, the error of simulation due to
offset error of the force sensor is
(ii) Due to the gain error of the force sensor Af 11 = rts = -re = yJip = -11~je i:i,
and from the equation J(.1<p) = .1f8 = yJqi, integration gives us
yJ e 1"lel2
L\<pfAf, = yq> = - ~ = 9
.1a1Af 1
= .1<p1Ar. +.191Ar. = .1<p1Ar. +O=
1.1, 1.11 1
~cplAr. 1
so, the error of simulation due to gain error of the force sensor is
E =~ =-yJe0/(Je+J) = -l:-=-ytlle(J_)2
g a JO/(Je+J) J m rg
Appendix 1 .2 71
Appendix 1.3
J= ri .:.::;I<.p__
1
1
1
XI
J
1
--~---------L--------
a= 9+q> z = x+ln
for the base system,
.. 2··
J<p = mrg<p = 'ts
since r, = -'t and fs = -mez = -me(x +la)
..
:. (111eI2+mr¡)~ = -111eI20 and (m + me)x = -mela
Appendix 1 .3 72
Assuming zero initial condítlons, integration gives us
cp • _..lt..e • - m,12 e
J,+J (me12+mri>
and also
x = _ m,I a = -(111el)(mrj) 9
m+111e (m+n1e)(mel2+mri)
Check the solution. Since initial conditions are ali zero, the center of the
system must remain zero, i.e.,
l,c =O or L m¡z¡ = O
i
i.e. 111ez + mx = O
sin ce z = x+ la = - mel
m+111e
a + la = mi a
m+m,
••• llleZ = 111e(x+la) = 111e+m la
m m,
mx = m( m
... "C-la ) = -111ez
m+111e
:. 111ez + mx =O
(i)Assuming offset error of the force sensor is
·· _ _ _ ·· _ J Je · · _ J Je 2 ...
J Aq> -A'to - f3tsmax - ~J<i>max - -~Je+J 0max - ~Je+J CO 0
Appendix 1.3 73
since 491Ar. = o
:. 4a1Ar.
•
= 4q>I A•r. = P~co
J+Je
2t2 = ~ 111e12 em2t2
nuj+me12
so, we have
= ¡3c.o212 9mel [ 1 + 12 1
Oe+J) (111e+m)
7_ -
AJJTI8X -
mi
m+m,
Q
rnax -
- mi _l_
m+me J +]e
e
so, the error of simulation due to offset error of the force· sensor is
Appendix 1.3 74
lntegrating the equation
A<pl4i
•
= yq, = -y.l....e
J+Je
since .10111,1 =o
••• Aa111r,
•
= Acp14r, • = -y11+e1 e9
Assuming zero initial conditions and integrating the following equation
• A-111'• - y 111el J 0
•• UA - - (II1e+m) Oe+J)
so, we have
therefore, the error of simulation due to gain error of the force sensor is
Appendix 1.3 75
Appendix 1.4
Por VES to simulate more general base system, e.g., the suspension
system of a vehicle, the stiffness of the base system is a very irnportant fact,
so, it should be considered in the base model in addition to the inertial
effect of the base. On the basis of simple two-degrees-of -freedom model,
which is discussed in Appendix 1.3, we include stiffness of base system and
establish a two-degrees-of-freedom VES model. In the model, the stiffness
of the base system includes both translational stiffness k and rotational
stiffness k,. Since stiffness exists in the base system, the base will produce a
restoring force to balance the error force caused by the offset error of the
force sensor. Therefore, in vehicle emulation case, the offset error is static
and negligible and the gain error will domínate.
J= mrj
Appendix 1.4 76
a• e+cp z • x+la
for the base system,
mx· + kx • r. •-f. -mez =-me<x+ta>
.. ..
... (Je+J)~ + k,cp = -Jea or (n1c12+ rnrj)ép + k,cp = -111et28
Define
Define
~ - kr and M= ro2 = 1
- (llle+m) co2-~ 1-(~)2
e.o
Appendix 1.4 77
... X. - Mm,1 (J+(1-M,)Je1e
(m+111e) (J,+J)
Mmel
:. I t\x } ='Y{; l = -ye I
J +(1-Mr)Je )
(m.,+m) [MJ:e+J) ]
\ Aq, \ (].+])
Since .10 = o
Appendix 1.4 78
Let's discuss sorne special cases.
(1) k = O and kr = O , SO <a>n = 0, COnr = O, M = 1 and Mr • 1
:. ea= ~z -+ -y!!m
!!.
L\z - - ? -1 ¡2 IDel2ro2
Eg =-= -YIDeW-[- - -+ ]
z k kr kkr
Appendix 1.4 79
Appendix 2.1
(t •X
xn = rsin(1t/6+<p2); Yn = rcos(1t/6+<p2);
x12 = rsin(1t/6-<p2); YJ2 = rcos(1t/6-<p2);
XJ3 = -reos( q>2); YJ3 = rsin( <p2);
XJ4 = X13; YJ4 = -Yn;
XJ5 = XJ2; YJS = -y12;
XJ6 = Xn; YJ6 = -Yn;
Let X*¡=x1¡- X Bi an d Yi* =y1¡- YBi, i=l , ... 6., and denote
so f
i•l
X¡¡=x11+x12+x13+x14+x1s+X16=x11 +x12+x13+(x13+x12+x11)
=2(xn+x12+x13) = O
=2(Xa1+Xa2+Xa3) = O
6
L y1¡=yn+y12+y13+y14+y1s+yJ6=<y11+y12+Yn>+<-y13-y12-Y11>=o
i=l
6
L Ys¡=Ye1+Ye2+Ye3+YB4+Yes+Ye6
i=l
Appendix 21 81
z: X¡• Yi• = X1Y1+X2Y2+x3y3+x4y4+XsYs+X6Y6
• • • • • • * • • • • •
i=I
* • • • • • • • *( • • •
= X1Y1+X2Y2+x3y3+x3(-y3)+x2 -y2)+x1(-y1) = O
i=l
= 2 [(xn-Xa1>2+(x12-Xa2>2+(x13-Xe3)2]
= 2 [X.f¡+xr2+XJ3+Xü1+XA2+X§3-2xnXa1-2x12Xai-2x13Xa3]
= 2 (r2[s2(1t/6+cp2)+s2(1t/6-<p2)+c2(<p2)]+R2[c2(<pl)+s2(1t/6-<pl)
+s2(1t/6+cpl)]-2rR[s(1t/6+<p2)c(<pl)-s(1t/6-<p2)s(1t/6-<pl)
+c(cp2)s(1t/6+<pl)]}
= 2 { r2 r¡c2c cp2)+¡s2(<p2)+íf s( cp2)e( <p2)+¡c2c cp2)+¡s2( <p2)
-ífs( <p2)c(<p2)+c2( <p2)]+R 2[ c2(<p I)+ic2( <p 1 )+¡s2( <p 1)
-fl-s( <p 1 )e(<p 1 )+ic2( <p 1 )+f s2( <p 1 )+ífsc<p 1 )e(<p 1)]
- 2rR[ tc(<pl)c(cp2)+frc(cpl)s(cp2)-ic(cpl)c(cp2)
+t¡-s( <p 1 )e( <p2)+ifc( <p 1 )s( <p2)-¡s( cp 1 )s( <p2)+!é( <p 1 )e( cp2)
+ífs(cpl)c(<p2)]}
= 2{fr2+fR2-2rR}[ !c(<pl+<p2)+ífs(<pl+<p2)]}
= 3[r2+R2-2rRs(1t/6+<pl+<p2)] = 3[r2+R2-2rRc(1t/3-cpl-<p2)]
= 3r*2
where r*2= r2+R2-2rRsin(1t/6+cpl+cp2) = r2+R2-2rRcos(1t/3-cpl-cp2)
Appendix 21 82
i•l
= 2 [(y11-Ya1)2+(YJ2-Ys2)2+(yJ3-Ye3)2]
= 2 [Y11+Yr2+Yt3+ YA1+ Yi2+ Yfi3-2yJ1 y s1-2YJ2 y s2-2YJ3 y 93)
= 2 { r2[c2(1t/6+<p2)+c2(1t/6-<p2)+s2(q>2)]+R2[s2(cpl)+c2(1t/6-<pl)
+c2(1t/6+<pl)]-2rR[c(1t/6+<p2)s(q>l)+c(1t/6-<p2)c(1t/6-<pl)
+s(<p2)C(7t/6+<pl)]}
= 2 { r2[¡c2(<p2 )+¡s2(<p2 )-f[-s( <p2 )e(<p2 )+¡<=2( <p2 )+¡s2( <p2)
+fs(q>2)c( <p2)+s2( <p2) ]+R2[s2( <p 1 )+¡<=2( <pl)+¡s2( <p 1)
+íf s( <p 1 )e( <p 1 )+¡<=2( <p 1 )+}s2( <p 1 )-f s< <p 1 )e( <p 1)]
- 2rR[ q.s(<pl)c(<p2)-fs(<pl)s(<p2)+¡<:(<Pl)c(<p2)
+ij-s( <pl )e( <p2)+t¡.c( <pl)s( cp2)+ ¡s( <p I)s( <p2)+q:.c( q> l)s( <p2)
-}s(<pl)s(<p2)]}
= 3[r2+R2-2rRs(1t/6+cpl+q>2)] = 3[r2+R2-2rRc(1t/3-cpl-<p2)]
= 3r*2
±
i=l
(Xs;)2 = 2[Xs/+Xs/+Xs/] = 3R2
Appendix 21 83
f (Ya1)2 = 2[Yai2+Ya22+Ya32) = 3R2
i•I
= 3rRsin(1t/6+<pl+<p2)
= 3rRsin(1t/6+<P 1 +q,2)
+c2(1t/6-<pl)s(1t/6-<p2)-c2(1t/6+q)l)c(<p2)]= 2rR2[-r:(<p2)c2(cpl)
+¡c(<p2)s2(cpl)-3fs(<p2)c2(cpl)+3fs(cp2)s2(<pl)+¡'s(<pl)c(<pl)v!c(<p2)
-~(<pl)c(<pl)s(<p2)]=2rR2[-¡c(2<pl)s(1t/6+<p2)+~(2<pl)c(1t/6+<p2)]
= _lrR 2s(1t/6+cp2-2cp 1)
2
i=l ,
-c2(1t/6-q>2)s(1t/6-<pl)-s2( cp2)s(1t/6+<pl)] = t"2Rs(x/6+cpl-2<p2)
(permutation of the subscripts)
6
L XJiYJiYBi = 2(xnYn Ya1+X12Y12Y a2+x13y13Y a3)
i=l
=2r2R[s(1t/6+cp2)c(1t/6+<p2)s(<pl)+s(x/6-<p2)c(1t/6-<p2)c(1t/6-<pl)
-c(q>2)s( <p2)c(1t/6+<p 1) = 2r2R[3fs< <pl)c(2<p2)--3fc(cpl )s(2<p2)
Appendix 21 84
-s(2cp2)c(ff/6+cpl)J • fr2Rs(n/6+cp1-2<p2)
t
i•I
Y11Xs1Ys1 = 2(yJ1Xs1Ys1+Y12Xs2Ys:z+YJ3Xs3Ys3)
=2rR2[c(1t/6+cp2)c(<pl)s(cp1)-C(ff/6-q>2)s(ff/6-cpt)c(ff/6-cpl)
-s( <p2)s( 1r./6+ q> 1 )c(7C/6+ tp 1)] = -rR 2s(1t/6+q>2-2cp 1)
t
i=l
Yi1Xi1 = 2 (yJ,Xi1+Yi2~2+yJ3Xi3} =2r2R2[ c2(<¡,l)c2(lt/6+cp2)
+c2(1t/6-q>2)s2(1r./6-q>l)+s2( q>2)s2( 'IC/6 ~ ·.f' ~ )] = 2r2R2[~2(q>1 )c2(q>2)
*2( q> 1 )s2(<p2)+fts2( q> 1 )s2(<p2)~s2(<p 1 )c2(<p2)+Jfc2( q> 1 )s( <p2)c(<p2)
~2( <p 1 )s( <p2}c( <p2)~2( <p2)s( q, 1 )e{ q> 1 >-3fc2<q,2 )s( <p 1 )e( <p 1)
-i5(<pl)s(q>2)c(q>l)c(<p2) = 2r2R2fli(c(q>l)c(<p2)-s(<pl)s(<p2)]2
~ e( q> 1 )s( q>2 )+ s(q> 1 )e( q>2)]2-3{l-[s(2q> 1 )c(2q>2)+ c(2q>1 )s(2cp2)] )
i=l
+c2(1t/6-<p l)s2(1t/6-<p2)+c2( <p2)c2( 1t/6+<p 1 )]
= ¡r2R2[3+2c2(<pl +<p2)-\"! s(2<pl +2<p2)]
(pennutation of the subscripts)
6
L XJiYJiXB¡YBi=2(x11ynXa1Y a1+x12y12Xa2Y a2+x13y13Xa3Ya3)
i=l
= 2r2R 2[ ! s(it/3+2q>2)s(2(j) 1 )- } s(lt/3-2q>2)s(it/3-2q> 1 >+t5(2q>2)s(lt/3+2q> 1)]
Appendix 21 85
[f
•tr2R 2 s(2<p 1 )s(2q>2>-ic(2cp 1 )cs(2q>2)~s(2q, 1 )c(2q>2)
~(2q) 1 )s(2q)2) J • ¡rlR l[r(2q) 1 +2q)2)-ífs(2q) 1 +2(1)2))
= -lr2R2s(n/6·-2<pl-2cp2)
4
Appendix 21 86
Appendix 2.2
loe\ { D11x11+D12Y11+x·xs¡ }
Eqn. (2.17) gives l 1 = \/ l¡y/ = D21x11+D22YJi+Y·YBi
l¡z D31x1,+D32y11+z
where the direction vectors Di. D2, and D3 are given by Eqn. (2.15)
f O ll \ f cosf3cosy \
D1 = \ g21 J = \ cos~siny /
31 -s1np
0 \ J síncsinñcosj-cosesíny \
D2 = { g: ( \
32
sinasin~siny+cosacosy
sínacosf
/
O f cosasinf3cosy+sinasiny \
D3 = { g~ } = \ coscsinpsinj-sinccosy /
cosacos~
Appendix 2 .2 87
and the Jacobian matrix will be
~~
ax ay
[J]=[~]=(J1~={~]- ?¡
a16 a16
--
ax ay
where
21· aI¡y
ol¡ _ 'iJ('V lfx+¡fy+ 1&) _ iY 'iJy _!¡y _D21XJ¡+D22YJ¡+y-Y9¡
OY - OY - 2'V l5c+l~y+ 1~ - l¡ - )¡
2I¡za1¡z
di¡ = 'iJ('V 1fx+l?y+ I~ ) _ 'iJz =!iz. 03¡XJ¡+D32y1¡+Z
'iJz 'iJz 2'V lfx + lfy+ I?z l¡ I¡
smce
0011 \
f
ªa!1 = \ a:1 f = 0
0031
ªª
0012 \
'iJD f aa ,. cosasinj3cosy+sinasiny \
2 ao22 . A. • • o
aa = \ aa f=\ coscsmpsiny-smccosy ,= 3
iJD32 cosacos~
Appendix 2 .2
ºª
88
a ªºa1a3 \ ¡-sinasin'3cosy+cosasiny)
03 I ao23 . . .
aa aa f • -sinasm~s1ny-cosacosy •-D2
11
\
ao33 -s1nacosP
ªª
aou \
ao1 _ I 1f
ao21 _
J-sinPcosy )
• • .
0D2 1f
I ilD22 / sinacosPcosy'
ap = \ ap'
ao32
=' sin~os~siny/=sinaD
-smasmP
1
ap
ªº1i3f \ / cosacosPcosy'
a
0D3 ao23
/
ap =\ ap I = ' cosacos~siny/=cosaD1
0D33 -coscsínf
a13
0011 \
oD1 f aaoy J-cosPsiny '
-sm. y ,
Appendix 2 .2 89
-a¡o:¡u- \ -cosasinPsiny+sinac
osy
ao3 ao2, . . . . .
3 Q
ªº3
so, ay
dl¡x di ·y dl¡z
4 2 2 2
2l¡x-+2l·y-1-+2l¡zr-
l
di¡_ d( I¡x+I¡y+ I¡z) _ dP dP dP
I¡
ao1
x1¡(lr-)+y¡¡{lr
ao2
-) ,
=
a~ a~ _ -XJiÍ sincx{I¡· Dú +coscx(I¡· 03) J +yJ¡Sincx(I¡· D 1)
l¡ l¡
Appendix 2 .2 90
XJiCosP[ cosa(l1·D2)-sina(l1· D3)-y1¡[ cosacos~(l1· D 1 )+siní3(l1· 03) J
l¡
= x11cosf3(cosa~-sina~)-y1;(cosacosf3~+sin~)
Appendix 2 .2 91
Appendix 2.3
Eqn. (2.29) gives (S] = (J]T (KJ (J], so, for platform is at its rest
configuration, where x = { O, O, zo, O, O, O} and due to symmetry of the
conñguration, each leg length will be same at this time, 11 = lo, ( i = 1, 2,
···, 6), if we assume that the individual stiffness of each leg is same, i.e.,
k¡ = k, ( i = 1, 2, .... 6), the stiffness matrix [S] is
D1={ ~}
l¡z=l¡z= D31XJ¡+D32y1¡+zo=zo
SO,
al¡ l·x x~
-=-ª =-ª
ax l¡ lo
al· l·y y~
-ayª =-1l¡ =-lo
ª
al¡ _ hz _ z.o
az -~-~
Appendix 2 .3 92
~ • YJi!Jz. • YJl!O.
aa I¡ lo
-apa11 = -x¡¡:.1111.
11'7
= -xn:v. 7.1\
l¡ ~
and
where
r*2 = r2+R2-2rRsin(1t/6+qH+q>2)= r2+R2-2rRcos(1t/3-q>l-q>2)
JI
z y
Appendix 2 .3 93
so,
S 11 .31q• 2 • 3kcos28
1i
6 a 6
cJi->2=kl', <y1¡Xei~x1¡Yei>2
566=kl',
i=l d'f i=l 11
6 6 6
=.k.(l', YJ¡Xi¡+ l', xj¡Yi¡-2 l', x1¡y1¡Xa¡Ye1¡)
I~ i=l ~=1 ie l
=~ { 2f r2R 2(3+ 2c2(<p l +<p2 )-v'!s(2q> l + 2q>2 )]-2!-f r2R 2s(Ít/6-2q> 1- 2<p2) J)
Appendix 2 .3 94
f a1, a1, 1t , f . .
S 12• S 21 • k ¿,,¡
l•l
<rr>
X y
• i"\¿,,¡
J& i•l
x1,Y1,> • 0
-kzo ~ • -k1-0
~
Sis= Ssi =k¿., <a1,ra1>· ~.L, Xj¡XJ¡) =-2-[3r2-3rRs(1t/6+q,l+<p2)]
=
i=l xa~ lo i=l lo
~ c)J¡ iJI¡ •
kzo ~ YJ¡YJJ 3kzo 2
S24= S42 =k°"' (~) -("" = -3rRs(1t/6+<pl+<p2)]
.
l= 1
ayua = 120 .
1= 1
~r
120 ,
~ é3l·i JI· •
S26= S62 ~J = k ~
YBJ]}
1
=k°"' (e) -{"" [Y1¡(y1¡XB¡-(XJ¡
Appendix 2 .3 95
6 6 6
a1,a1· k
S36= s63 =kI <~~> =TrI <y1¡Xe¡>-I <x1¡Ye¡)J = o
i•l u r 11) i=l i•l
~ )l· ~ ~
S4s= Ss4 =k~ <é)lr· é> = 2 [k (XJiYJ¡)] =0
i=t ªap lo ie l
6 ol· é)I· k 6 6
S46= 564 =kI <~ "é)y 1
= Z0 rI (yJ¡Xe¡)- I (XJiYJi Ye¡)] = 0
•' = 1 ªª 1)
120 1. =1 ' 1
1=
Appendix 2 .3 97
REFERENCES
[1] Asada, H. and Slotine, J.E., 1986, Robot Analysis and Control John
Wiley and Sons
[2] Do, W.Q., 1985, Dynamic Analysis of Stewart Platform, M.S. Thesis,
University of California, Los Angeles, CA
[6] West, H., Hootsmans, N., Dubowsky, S., Stelman, N., 1989,
"Experimental Simulation of Manipulator Base Compliance" Proceedings
of the First International Symposium on Experimental Robotics, Montreal,
June 19-21
(7) Dubowsky, S., Tanner, A.B., 1987, "A Study of Dynamics and Control
References 98
of Mobile Manipulators Subjected to Vehicle Disturbances," Proceedings,
Fourth lnternational Symposium of Robotics Research, Santa Cruz, CA
[8] Dubowsky, S., Vafa, Z., 1987, "A Virtual Manipulator Model for Space
Robotic Systems," Proceedings of NASA Workshop on Space Telerobotics,
Jet Propulsion Laboratory, California Institute of Technology, Pasadena,
CA
[9] Dubowsky, S., Paul, l., West, H., 1988, "An Analytical and
Experimental Program to Develop Control Algorithms for Mobile
Manipulators ," Proc., RoManSy, Udine, Italy, July
[ 12] Fichter, E.F., McDowell, E.D., 1980, "A Novel Design for a Robot
Arm," Advances in Computer Technology, an ASME Publication
References 99
[14] Tanner, A.B., 1987, Study of Robotic Manipulators Subjected to Base
Disturbances, M.S. Thesis, MIT, Cambridge, MA
[15] Vafa, Z., 1987, The Kinematics, Dynamics and Control of Space
Manipu/ators: The virtual Manipu/ator concept, Ph.D. Thesis, MIT,
Cambridge, MA
[16] Weng, T.C., Sandor, G.N., Xu, Y., Kohli, D., 1987, "On the
Workspace of Closed-Loop Manipulators with Ground-Mounted Rotary-
Linear Actuators and Finite Size Platfonn," Proceedings of the 1987
ASME Design Tech., Vol. 11, Robotics, Mechanisms and Machine Systems,
Boston, MA, Sept. 27-30
[17] Yang, D.C.H., Lee, W.L., 1989, "Feasibility Study of a Platform Type
of Robotic Manipulators from a Kinematic Viewpoint," Transactions of
ASME Journa/ of Mechanisms, Transmission and Automation in Design,
Vol. 106
References 100
[20] Sugimoto, K., 1986, "Kinematic and Dynamic Analysis of Parallel
Manipulators By Means of Motor Algebra" ASME Paper, .No. 86-DET-
139
References 101
[26] Gosselin, C., 1990,, "Stiffness Mapping for Parallel Manipulators ",
IEEE Transactions on Robotics and Automation,. Vol. 6, No. 3, June, pp.
377-388
[28] Stewart, D., 1965-66, "A Platfonn with Six Degrees of Freedom",
Proceedings of the lnstitution of Mechanical Engineers,.Vol. 180, Part 1,
No. 15
[29] Ahmad, S., 1988, "Analysis of robot drive train errors, their static
effects, and their compensation," IEEE lnt. Conf. Rcbotics and
Automation,
References 102
[32] Payannet, D., Alton, M. J., and Liegeois, A., 1985, "Identification and
compensation of mechanical errors for industrial robots," Proc. l 5th lnt.
Symp. on Industrial Robots, Tokyo, pp. 857-864.
[33] Wu, e.-H., and Lee, e.e., 1984, "On an accuracy problem of robot
manipulators," Proc. 23rd IEEE Conf. decision and Control, Las Vegas,
Dec. 12-14, pp. 1636-1637.
[34] Wu, e.-H., and Lee, C.C., 1985, "Estimation of accuracy of a robot
manipulator," IEEE trans. Automatic Control, Ae-30, pp. 304-306.
[35] Ziegert, J., and Datseris, P., 1988, "Basic considerations for robot
calibration," Proc. IEEE lnt. Conf. Robotics and Automation, Philadelphia,
April 24-29, pp. 932-938.
References 103