Professional Documents
Culture Documents
1. INTRODUCTION
Normal force
3. HARDWARE DESIGN
Centripetal
force
Centrifugal
force
Tilting
Gravity
Torque
Weight Diameter
4
Gear rate
Safety factor
Torque
Rated torque
(1)
(2)
Specifications
450460550mm
45kg
406mm
10km/h
24V 10Ah Ni-MH(2ea)
20
4. EQUATIONS OF MOTION
F3* M P l{
x sin cos x sin
l cos sin 2 }
l cos sin cos 2
cos sin { I1 P1 ( I 2 I 3 )P 2P 3 }
sin { I 2 P 2 ( I 3 I1 )P1P 3 }
cos cos { I 3 P 3 ( I1 I 2 )P1P 2 }
d
2( Md 2 K J ( ) 2 )
R
J
)
x M P {
x l cos l sin cos
R2
l cos cos 2l sin }
2l cos2 sin 2
cos cos sin
F4* 2( M
P1
P 2 sin
P 3 sin cos cos
cos cos cos sin
cos
P1
sin
sin sin
cos
sin
P2
F1 F1* 0
F2 F2* 0
F3 F3* 0
(3)
L
F4 F4 0
*
F1 l cos sin M P g TT
F2 l sin cos M P g (TL TR ) cos
F3
d
(TR TL ),
R
F4
1
(TL TR )
R
P2 P3
P1
F1* cos { I1 P1 ( I 2 I 3 )P 2P 3 }
sin { I 3 P 3 ( I1 I 2 )P1P 2 }
x
cos ) sin
M P l 2 cos { cos (2
l
cos 2 cos sin ) cos }
( 2
T2
F3
T
F2
N3
F2* { I 2 P 2 ( I 3 I1 )P1P 3 }
N2
M P l{
x cos x sin sin l l sin
sin 2 2 cos 2 )sin cos
l (2
N1
T3
T1
F1
Point P
Body L, R
Wheels of pendulum
Point I
Roll Angle
Pitch Angle
Yaw Angle
TT
Tilting Torque
TL , TR
MP
Mass of body P
Mass of wheel
I1 , I 2 , I 3
MOI of Pendulum
K, J
MOI of Wheel
0.4
5. CONCLUSION
0.35
0.3
0.25
0.2
2.5
1.5
1
Reference of Yaw Velocity(rad/s) 0.5
1.4
0.8
1.6
1.8
1.2
1 Reference of x Velocity(m/s)
0.26
0.24
0.22
Overshoot of Pitch Position(rad)
Frame {N}
0.2
REFERENCES
0.18
[1]
[2]
0.16
0.14
0.12
0.1
2.5
1.5
1
Reference of Yaw Velocity(rad/s) 0.5
1.6
0.8
[3]
[4]
1.8
1.4
1.2
1 Reference of x Velocity(m/s)
[5]
http://www.segway.com
F. Grasser, A. DArrigo, S. Colombi, and A. Rufer,
Joe: A mobile, inverted pendulum, IEEE Trans.
Ind. Electron, Vol. 49, No. 1, pp. 107-144, 2002.
http://www.gm.com
K. Yamafuji and T. Kawamura, Postural control
of a monoaxial bicycle, Robotics Society of
Japan, Vol. 7, No. 4, pp. 74-79, 1989.
Y. S. Ha and S. Yuta, Trajectory tracking control
for navigation of the inverse pendulum type
self-contained mobile robot, Robotics and