03_wheeledlocomotion
TRANSCRIPT
-
7/29/2019 03_wheeledLocomotion
1/29
Zrich
ETH Master Course: 151-0854-00L
Autonomous Mobile Robots
Wheeled Locomotion
Roland Siegwart
Margarita Chli
Martin RufliDavide Scaramuzza
-
7/29/2019 03_wheeledLocomotion
2/29
Zrich
Lecture OverviewMobile Robot Control Scheme
2
raw data
positionglobal map
Sensing Acting
InformationExtraction
PathExecution
CognitionPath Planning
knowledge,data base
missioncommands
Real World
Environment
LocalizationMap Building
MotionControl
Perce
ption
actuator
commands
environment modellocal map
path
3 - Wheeled Locomotion
-
7/29/2019 03_wheeledLocomotion
3/29
Zrich
Lecture OverviewReview: Efficiency of Locomotion Types
3
3 - Wheeled Locomotion
Wheeled motion is highly efficient on
hard and flat surfaces (usually man-made)
generally restricted to man-made structures
the de-facto standard for mobile robotics
-
7/29/2019 03_wheeledLocomotion
4/29
Zrich
Lecture OverviewReview: Dimensionality
The Degree of Freedom (DOF) of a workspaceis
its overall dimensionality On (flat) ground,
In the air or below water,
For a robotic system
is its ability to achieve various poses
is its ability to achieve various velocities
4
3 - Wheeled Locomotion
DOFDDOF M
3DOF
6DOF
DOFDDOF
-
7/29/2019 03_wheeledLocomotion
5/29
Zrich
Lecture OverviewReview: Kinematics Terminology
Kinematics Origin: kinein(Greek)to move
The subfield of Mechanics dealing with motions of bodies
Forward kinematics
Given is a set of actuator positions
Determine corresponding reference pose
Inverse kinematics
Given is a desired reference pose
Determine corresponding actuator positions
5
3 - Wheeled Locomotion
-
7/29/2019 03_wheeledLocomotion
6/29
Zrich
Lecture OverviewPreview: Wheeled Kinematics
Wheels Are often subject to motion constraints
Often do not allow to compute kinematics directly
Consequently, for most wheeled robots, actuator positions do notmap to unique reference poses
There is no direct(i.e., instantaneous) way to measure a robots position
Position must be integrated over time, depends on the path taken
Understanding mobile robotic motion requires an understanding ofwheel constraints placed on the robots mobility
6
3 - Wheeled Locomotion
-
7/29/2019 03_wheeledLocomotion
7/29
Zrich
Wheeled LocomotionHolonomic System
Holonomic systems Diff. eqn. of are integrableto the final position
the measure of the traveled distance of each wheel issufficient to calculate the final position of the robot
Examples Ballbot
Robots composed out of (multiple) wheels that do notconstrain motion (i.e., Castor, Swedish and Omni-wheels)
7
3 - Wheeled Locomotion
0y
0x
I
-
7/29/2019 03_wheeledLocomotion
8/29
Zrich
Iy
Ix
Wheeled LocomotionNon-Holonomic Systems
Non-holonomic systems Diff. eqn. of are not integrableto the final position
The measure of the traveled distance sof each wheelis not sufficient to calculate the final robot position
Knowledge of the movement as a function of time becomes necessary
8
3 - Wheeled Locomotion
2s
1s
I
-
7/29/2019 03_wheeledLocomotion
9/29
Zrich
Representation of differential forward kinematics Robot pose
Mapping velocities between two frames
Wheeled LocomotionHomogeneous Transformation
9
3 - Wheeled Locomotion
Tyx 0101010
100
0cossin
0sincos10
R
T
yxRR
111101100
0y
0x
1y
1x
1
2
-
7/29/2019 03_wheeledLocomotion
10/29Zrich
For robots containing (several) actuated wheels,find , with the actuator velocities
Assumptions
Movement on a horizontal plane
Point contact of the wheels Wheels not deformable
Pure rolling, no slipping, skidding or sliding
No friction for rotation around contact point
Wheels connected to a rigid frame (chassis)
Wheeled LocomotionAssumptions
10
3 - Wheeled Locomotion
),,(1
0
nf i
0y
0x
1y
1x
1
2
-
7/29/2019 03_wheeledLocomotion
11/29Zrich
Wheeled LocomotionStandard and Castor Wheels
11
3 - Wheeled Locomotion
Standard wheel a)
two degrees of freedom
rotation around the (motorized) wheelaxle and the contact point
Castor wheel b)
three degrees of freedom
rotation around the wheel axle, the
contact point and the castor axle
-
7/29/2019 03_wheeledLocomotion
12/29Zrich
Wheeled LocomotionSwedish and Spherical Wheels
12
3 - Wheeled Locomotion
Swedish wheel c)
three degrees of freedom
rotation around the (motorized) wheelaxle, around the rollers and aroundthe contact point
Ball (spherical wheel) d)
three degrees of freedom
suspension technically not solved
-
7/29/2019 03_wheeledLocomotion
13/29Zrich
Ry
Rx
Differential Forward KinematicsFixed Standard Wheel
13
3 - Wheeled Locomotion
TR yx 111
0)(cos)cos()sin( rRl IT
0)(sin)sin()cos( ITRl
-
7/29/2019 03_wheeledLocomotion
14/29Zrich
Differential Forward KinematicsSteered Standard Wheel
16
3 - Wheeled Locomotion
Ry
Rx
0)(cos)cos()sin( rRl IT
0)(sin)sin()cos( ITRl
Differential Forward KinematicsSteered Standard Wheel
TR yx 111
-
7/29/2019 03_wheeledLocomotion
15/29Zrich
Differential Forward KinematicsCastor Wheel
17
3 - Wheeled Locomotion
Ry
Rx
0)(cos)cos()sin( rRl IT
0)(sin)sin()cos( dRld IT
v
-
7/29/2019 03_wheeledLocomotion
16/29Zrich
Differential Forward KinematicsSwedish Wheel
18
3 - Wheeled Locomotion
Ry
Rx
0cos)()cos()cos()sin( rRl IT
0sin)()sin()sin()cos( swswIT
rrRl
v
-
7/29/2019 03_wheeledLocomotion
17/29Zrich
Differential Forward KinematicsSpherical Wheel
19
3 - Wheeled Locomotion
Ry
Rx
0)(cos)cos()sin( rRl IT
0)(sin)sin()cos( ITRl
-
7/29/2019 03_wheeledLocomotion
18/29Zrich
Differential Forward KinematicsConcatenation of Constraints
Given a wheeled robot Each wheel imposes constraints on its motion
Only fixed and steerable standard wheels impose no-sliding constraints
Suppose the robot has standard wheels of radius , then the
individual wheel constraints can be concatenated in matrix form Rolling constraints
No-sliding constraints
Solving for results in an expression for Differential Forward Kinematics
20
3 - Wheeled Locomotion
1)(
)()(
sf NN
s
f
t
tt
sf NN
31
11
)()(
sf NN
ss
fs
J
JJ
)( 12 NrrdiagJ
0)()(1
Is RC
31
1
1)(
)(
sf NN
ss
f
sC
CC
0
0)()(21
JRJ Is
I
ir
-
7/29/2019 03_wheeledLocomotion
19/29Zrich
Wheel ArrangementsStaticStability of Overall System
21
Stability requires
At least 3 wheels in ground contact
That CoG lies within support triangle
Stability is improved by 4 and more wheels
Such arrangements are hyper static
Necessitates a flexible suspension system
3 - Wheeled Locomotion
-
7/29/2019 03_wheeledLocomotion
20/29Zrich
Wheel ArrangementsTwo and Three Wheeled Robots
22
3 - Wheeled Locomotion
Two wheels:
Three wheels:
23
-
7/29/2019 03_wheeledLocomotion
21/29Zrich
Wheel ArrangementsFour Wheeled Robots
23
3 - Wheeled Locomotion
Four wheels:
24
-
7/29/2019 03_wheeledLocomotion
22/29Zrich
Motion ConstraintsDegree of Maneuverability
Maneuverabiliy degree of mobility
degree of steerability
The maneuverability of a robot is composed of
Mobility (restricted by the no-sliding constraints)
Additional freedom contributed by the steering mechanisms
24
3 - Wheeled Locomotion
m
s
smM
25
-
7/29/2019 03_wheeledLocomotion
23/29Zrich
Motion ConstraintsDegree of Mobility
To avoid any lateral slip the motion vectorneeds to satisfy:
Hence, to avoid lateral slip must belong to the null spaceNof
The null space of is the space where any vector verifies
Geometrically this can be shown by the Instantaneous Center of Rotation(ICR)
The larger the rank of , the more constrained a robots mobility
Consequently, , with
no standard wheels:
all directions constrained:
25
3 - Wheeled Locomotion
IR )( )(1 sC
)(1 sC 0)(1 nC s
IR
)(
0)()(1
Is RC
31
1
1)(
)(
sf NN
ss
f
sC
CC
n
)(1 s
C
)(3)(dim11 ssm
CrankCN 3)(0 1 sCrank
0)(1 sCrank 3)(1 sCrank
26
-
7/29/2019 03_wheeledLocomotion
24/29Zrich
Motion ConstraintsInstantaneous Center of Rotation
Instantaneous Center of Rotation (ICR) For any robot with the ICR is constrained to
lie on a line
For any robot with the ICR can be set to any point on the 2D plane
ExamplesAckermann Steering Bicycle
26
3 - Wheeled Locomotion
3M
2M
27
-
7/29/2019 03_wheeledLocomotion
25/29Zrich
Motion ConstraintsDegree of Steerability
Degree of steerability Represents an indirectdegree of motion
The particular orientation at any instant imposes a kinematic constraint
The ability to change that orientation leads to an additional degree ofmaneuverability
Range of :
Examples:
One steered wheel: Tricycle,
Two steered wheels: Two-steer,
Two steered wheels on a common axis: Car (with Ackermann steering),
27
3 - Wheeled Locomotion
)(1 sss Crank
20 ss
1s
1s
2s
28
-
7/29/2019 03_wheeledLocomotion
26/29Zrich
Motion ConstraintsDegree of Maneuverability
Degree of Maneuverability Two robots with the same may not be equivalent
instantaneously
Examples
28
3 - Wheeled Locomotion
smM M
29
-
7/29/2019 03_wheeledLocomotion
27/29Zrich
Motion ConstraintsOmni-Drive Example
29
3 - Wheeled Locomotion
Omni-Drive
0y
0x
30
-
7/29/2019 03_wheeledLocomotion
28/29Zrich
Motion ConstraintsTwo-Steer Example
Two-Steer
30
3 - Wheeled Locomotion
0y
0x
31
-
7/29/2019 03_wheeledLocomotion
29/29
Differential Inverse KinematicsIterative Scheme Control Theory
In presence of non-holonomic constraints, diff-erential inverse kinematics must be considered
Transformation between velocities instead of positions
Solved via (state ) feedback control
Example: differential drive (kinematic unicycle), AMR book Chapter 3.6
31
(nonintegrable)Robot Model
-
Control law
),,( yx),( 21