Beruflich Dokumente
Kultur Dokumente
II.
I.
INTRODUCTION
LITERATURE REVIEW
159
III.
Fr Fr*
IV.
(r
1,2,......n)
w F v Pi
(15)
(r 1,2,3) , ( pi B,W1 ,W2 )
wur
The partial angular velocities of the main body and the
wheels can be obtained using [24]:
w F Z Bi
(16)
(r 1,2,3) , ( Bi B,W1 ,W2 )
Z~rBi
wur
The forces exerted on the robot are assumed to be the
torques between the wheels and body generated by the
driving motors and the gravitational force at the center of
the main body and that at the center of the wheels [7, 29].
The forces are assumed as follows:
(17)
TW1 D1n1 D 2n 2 D 3n 3
W1
ZW
u2n 2 u3n 2
L
1
u1 u2 n 3 u2n 2
R
R
L
1
u1 u2 n 3 u2n 2
R
R
W1
F W2
u1 u2 Ln1
u1 Lu2 n1
L 2
L (11)
1
1
u1u 2 u 2 n1 u 2 n 2 u1 u 2 n 3
R
R
R
R
2
2
2
3
2
3
aW1
mB gn 2
(21)
(22)
26]:
Fr Fr*
(27)
0
(r 1,2,3)
Based on equations (25)-(27) and the kinematic
information obtained the equations of motion of the TWIP
can be found as:
D 3 E 3 3m m x m d cos I I
W
B
B
R
(28)
\ 2 I 2 mB d sin I 0
D1 E1 n1 D 2 E 2 n 2 D 3 E 3 n 3
(26)
(r 1,2,3)
The dynamical equations of motion are given by [24,
(20)
(25)
(r 1,2,3)
The Generalized inertia forces are given by [13]:
*
~ Bi T * ( p B B,W ,W )
Fr v~rPi RPi* Z
i
i
1
2
r
Bi
(9)
DW
mW gn 2
The inertia torques of the main body and the wheels can
be computed using [24]:
*
(24)
TBi D Bi I Z Bi u I Z Bi ( Bi B,W1 ,W2 )
The generalized active forces are given by [24]:
~ Bi T
( pi Bi B,W1 ,W2 )
Fr v~rPi RPi Z
r
Bi
(8)
u u d cos I u u d sin I n
u d sin I u d cos I n
RW2
(6)
aB
(19)
Where TW1 ,
L 2
L (10)
1
1
u1u 2 u 2 n 1 u 2 n 2 u1 u 2 n 3
R
R
R
R
mW gn 2
(5)
DW
RW 1
RB
(18)
(4)
(7)
u2n 2 u3n 3
E1n1 E 2n 2 E3n 3
TB
TW2
(3)
(14)
v~rPi
(2)
u1, 2,3 x \ I
7KHDQJXODUYHORFLWLHVRIWKHURERWVPDLQERG\DQGWKH
wheels with respect to reference frame F are [28]:
F
>
aW2
(12)
(13)
161
L
D 3 E 3 mW 3L2 1 R 2 mB d 2 sin 2 I I 2 \
R
2
2
(29)
m d sin I cos I \I 0
1
s
1
s
t
1
s
1
s
yaw
u^2
0.212
u^2
cos
0.564
sin
u^2
V.
cos
SIMULATION
2.885
u^2
0.564
sin
-9.81
sin
cos
sin
cos
x
cos 2 I 2.885
9.81sin I cos I
cos 2 I 2.885
sin I cos I
\ 2
\I
sin I 0.987
dx3
-1
0.564 sin I 2
I
cos 2 I 2.885
u^2
sin
0.987
(31)
u^2
(32)
0.084
sin
cos
I
u^2
cos
2.885
(33)
u^2
sin
cos
Value
15
0.42
0.20
0.106
0.63
1.12
9.81
0.212
tilt
Unit
kg
kg
M
M
kgm2
kgm2
m/s2
M
-K-
sin
1
s
1
s
Tiltangle(rad)
1
0.8
0.6
0.4
0.2
0
0.5
1.5
2.5
Time(s)
162
1
0.8
Orientation(rad)
0.6
Position(m)
-0.5
-1
0.4
0.2
0
-0.2
-0.4
-0.6
-0.8
-1.5
0.5
1.5
-1
2.5
0.5
Time(s)
1.5
2.5
Time(s)
The result from the Kanes method was also compared with
the result from Lagrange method. Figure 7 and 8 shows the
simulation results. Form the result it can be seen that, the
TWIP modeled based on Kanes Method falls in about 2.1
seconds, while that modeled based on Lagrange Method
falls in about 2.4 seconds as shown in figure 8, and the
TWIP modeled based on Kanes Method moves about 0.4
meters in before fallen, while the TWIP modeled based on
Lagrange Method moves about 0.05 meters before fallen.
1.6
-0.2
1.4
-0.4
1.2
Tiltangle(rad)
-0.6
-0.8
-1
1
0.8
0.6
-1.2
0.4
-1.4
0.2
-1.6
0.5
1.5
Kane
Lagrange
2.5
0.5
1.5
2.5
Time (s)
Time(s)
0.5
1.5
Kane
Lagrange
Position(m)
Position (m)
-0.5
0.5
-1
0.5
1.5
2.5
0.5
1.5
2.5
Time (s)
Time(s)
163
[13] 6 < 6HR 6 + .LP 6 /HH 6 ++DQ + 6 .LP 6LPXODWLRQ RI
$WWLWXGH &RQWURO RI D :KHHOHG ,QYHUWHG 3HQGXOXP International
Conference on Control, Automation and systems, Seoul Korea, Oct.
2007, pp. 2264-2269.
[14] $1.1DVLU0$$KPDGDQG5075,VPDLO7KH&RQWURORI
a Highly Nonlinear Two-wheels Balancing Robot: A Comparative
Assessment between LQR and PID-PID Control SchemHV LQ
Proceedings of World Academy of Science Engineering and
Technology, 2010, vol. 70, pp. 227-232.
[15] .0*RKHU027RNKLDQG1+6LGGLTXH'\QDPLF0RGHOLQJ
and Control of a Two Wheeled Robotic Vehicle with Virtual
3D\ORDGARPN Journal of Engineering and Applied Sciences, 2011,
vol. 6, No. 3, pp. 7-41.
[16] . 3DWKDN - )UDQFK DQG 6 . $JUDZDO 9HORFLW\ DQG SRVLWLRQ
control of a wheeled inverted pendulum by partial feedback
OLQHDUL]DWLRQIEEE transactions on robotics, June 2005, vol. 21, no.
3, pp. 505-513.
[17] = /L DQG - /XR $GDSWLYH 5REXVW '\QDPLF %DODQFH DQG 0RWLRQ
&RQWUROVRI0RELOH:KHHOHG,QYHUWHG3HQGXOXPIEEE Transactions
on Control Systems Technology, Vol. 17, No. 1, January 2009.
[18] 0 %DORK DQG 0 3DUHQW 0RGHOLQJ DQG 0RGHO 9HULILFDWLRQ of an
Intelligent Self-Balancing Two-wheeled Vehicle for an Autonomous
8UEDQ 7UDQVSRUWDWLRQ 6\VWHP Conference on Computational
Intelligence, Robotics, and Autonomous Systems, Dec. 15 2003,
Singapore.
[19] 0.*RKHUDQG027RNKL'HYHORSPHQW0RGHOLQJDQd Control
RI D 1RYHO 'HVLJQ RI 7ZR :KHHOHG 0DFKLQHV Journal of Selected
Areas in Robotics and Control (JSRC), December 2010, pp. 6-16.
[20] 6 -HRQJ DQG 7 7DNDKDVKL :KHHOHG ,QYHUWHG 3HQGXOXP 7\SH
Assistant Robot: Inverted Mobile, Standing and Sitting MotioQV
Proceedings of the 2007 IEEE/JRS International Conference on
Intelligent Robots and Systems, San Diego, CA USA October 29November 2, 2007, pp. 1932-1937.
[21] ; 5XDQ DQG - &KHQ %-2WMR System Model and Underactuated
3URSHUW\ $QDO\VLV Proceedings of the IEEE International
Conference on Automation and Logistics, Jinan, China, August 18-21,
2007, pp. 580-585.
[22] / 6XQ DQG - *DQ 5HVHDUFKLQJ RI 7ZR-Wheeled Self-Balancing
5RERW %DVHG RQ /45 &RPELQHG ZLWK 3,' The 2nd IEEE
International Workshop on Intelligent Systems and Applications,
2010, pp. 1-5.
[23] 3 . : $EH\JXQDZDUGKDQD 0 'HIRRUW DQG 7 0XUDNDPL 6HOISustaining Control of Wheel Mobile Manipulator using Sliding Mode
&RQWURO The 11th IEEE International Workshop on Advanced
Motion Control, March 21-24, 2010, pp. 792-797, Nagaoka, Japan.
[24] %-)UHJO\.DQHV6XPPDU\ /HFWXUHQRWH(/($QDO\WLFDO
Dynamics, University of Florida, 2004.
[25] : 1XNQOZXWKLRSDV 6 /DRZDWWDQD DQG 7 0DQHHZDUQ Dynamic
Modeling of a One-ZKHHO 5RERW E\ 8VLQJ .DQHV PHWKRG, IEEE
International Conference on Industrial Technology (ICIT), Bangkok,
THAILAND, 2002. vol. 1 pp. 524-529.
[26] 5'HOXFD$%ULHI6\QRSVLVRI.DQHV0HWKRG5HWULHYHG$SULO
2011, www.cs.cmu/edu/~delucr/kane.doc.
[27] 6:1DZDZL3DUWLDO)HHGEDFN/LQHDUL]DWLRQ&RQWUROIRUD&ODVVRI
Two-:KHHOHG 0RELOH 5RERW 3KG 7KHVLV 8QLYHUVLWL 7HNQRORJL
Malaysia, 2010.
[28] 3&0LWLJX\DQG75.DQH0RWLRQ9DULDEOHV/HDGLQJWR(IILFLHQW
(TXDWLRQV RI 0RWLRQ The International Journal of Robotics, Vol.
15, No. 5, October 1996, pp. 522-532.
[29] . 7KDQMDYXU DQG 5 5DMDJRSDODQ (DVH RI '\QDPLF 0RGHOOLQJ RI
:KHHOHG 0RELOH 5RERWV :05V XVLQJ .DQHV $SSURDFK IEEE
International Conference on Robotics and Automation, Albuquerque,
New Mexico, April 1997, pp. 2926-2931.
CONCLUSION
164