Professional Documents
Culture Documents
S 3a - Kinematics Wheel
S 3a - Kinematics Wheel
"Position"
Global Map
Environment Model
Local Map
Perception
Cognition
Path
Real World
Environment
Motion Control
R. Siegwart, I. Nourbakhsh
Introduction:
Aim
Description of mechanical behavior of the robot for
design and control
Similar to robot manipulator kinematics
However, mobile robots can move unbound with respect to its
environment
o there is no direct way to measure the robots position
o Position must be integrated over time
o Leads to inaccuracies of the position (motion) estimate
-> the number 1 challenge in mobile robotics
R. Siegwart, I. Nourbakhsh
Introduction:
3.2.1
Kinematics Model
Goal:
T
& as a function of the wheel speeds & i ,
& and the geometric parameters of the
i
yI
v(t)
x&
& = y& = f ( &1 ,K& n , 1 ,K m , &1 ,K & m )
&
s(t)
Inverse kinematics
[ &
why not
& n
xI
& 1 K & m
1 K m
x
y = f ( ,K , ,K )
-> not straight forward
1
n
1
m
R. Siegwart, I. Nourbakhsh
3.2.1
{X I , YI }
{X R ,YR }
Robot position:
I = [x
YI
YR
y ]T
XR
cos
R( ) = sin
0
sin
cos
0
XI
0
0
1
YI
XR
YR
XI
R. Siegwart, I. Nourbakhsh
3.2.1
Example
Presented on blackboard
YI
YR
XR
XI
R. Siegwart, I. Nourbakhsh
3.2.1
Example
R. Siegwart, I. Nourbakhsh
3.2.3
XR
& r
XI
R. Siegwart, I. Nourbakhsh
3.2.3
R. Siegwart, I. Nourbakhsh
.
(l)
.
(l) cos()
3.2.3
.
l sin()
Robot chassis
.
x cos(+)
.
y sin(+)
)
+
)
(+
v=r
.
x
.
y (-cos(+))
.
x sin(+)
.
y
R. Siegwart, I. Nourbakhsh
3.2.3
Example
R. Siegwart, I. Nourbakhsh
3.2.3
R. Siegwart, I. Nourbakhsh
3.2.3
Castor Wheel
R. Siegwart, I. Nourbakhsh
3.2.3
Swedish Wheel
R. Siegwart, I. Nourbakhsh
3.2.3
Spherical Wheel
3.2.4
)
J1 ( s ) R ( )&I + J 2& = 0 (t ) =
1
s
J ( ) J 2 = diag (r1 L rN )
s (t )
1s s
Lateral movement
(N f + N s )1
(N f + N s )3
C1 ( s ) = 1 f
C1s ( s )
C1 ( s ) R ( )&I = 0
(N f + N s )3
R. Siegwart, I. Nourbakhsh
3.3
m
s
M = m +s
R. Siegwart, I. Nourbakhsh
3.3.1
C1s ( s ) R ( )&I = 0
C1 ( s ) = 1 f
C1s ( s )
Mathematically:
R( )&I must belong to the null space of the projection matrix C1 ( s )
Null space of C1 ( s ) is the space N such that for any vector n in N
C1 ( s ) n = 0
3.3.1
Bicycle
R. Siegwart, I. Nourbakhsh
3.3.1
Mathematically
o no standard wheels
o all direction constrained
rank [C1 ( s )] = 0
rank [C1 ( s )] = 3
0 rank [C1 ( s )] 3
Examples:
Unicycle: One single fixed standard wheel
Differential drive: Two fixed standard wheels
o wheels on same axle
o wheels on different axle
R. Siegwart, I. Nourbakhsh
3.3.2
Range of s :
0 s 2
Examples:
one steered wheel: Tricycle
two steered wheels: No fixed standard wheel
-> common axle
car (Ackermann steering): Nf = 2, Ns=2
R. Siegwart, I. Nourbakhsh
3.3.3
M = m + s =1+1 = 2
R. Siegwart, I. Nourbakhsh
3.3.3
Tricycle
R. Siegwart, I. Nourbakhsh
3.3.3
R. Siegwart, I. Nourbakhsh
3.3.3
Synchro Drive
M = m + s =1+1 = 2
Video: J. Borenstein
R. Siegwart, I. Nourbakhsh
3.4.1
Workspace
how the vehicle is able to move between different configuration in its
workspace?
R. Siegwart, I. Nourbakhsh
3.4.2
DDOF m DOF
Holonomic Robots
A holonomic kinematic constraint can be expressed a an explicit function
of position variables only
A non-holonomic constraint requires a different relationship, such as the
derivative of a position variable
Fixed and steered standard wheels impose non-holonomic constraints
R. Siegwart, I. Nourbakhsh
3.4.2
R. Siegwart, I. Nourbakhsh
3.4.3
R. Siegwart, I. Nourbakhsh
3.4.3
R. Siegwart, I. Nourbakhsh