Wheeled Mobile Robots
Kinematics and Control
9/1/2016
Dr. T. Asokan
E-mail: [email protected]
Contents
Locomotion
Wheeled Locomotion
Wheel design
Wheel configuration
Stability
Manuverability
Kinematics
Kinematic models and constraints
Maneuverability
Motion control
9/1/2016
Dr T ASOKAN, IIT MADRAS
9/1/2016
Dr T ASOKAN, IIT MADRAS
9/1/2016
Dr T ASOKAN, IIT MADRAS
Seekur robot
9/1/2016
Dr T ASOKAN, IIT MADRAS
Google Autonomous Car
9/1/2016
Dr T ASOKAN, IIT MADRAS
WHEELED MOBILE ROBOT (WMR)
A robot capable of locomotion on a surface solely through the actuation of
wheel assemblies mounted on the robot and in contact with the surface. (Muir
and Newman, 1986)
A wheel assembly is a device which provides or allows relative motion between
its mount and surface on which it is intended to have a single point of rolling
contact.
Introduction to Robotics
WMR
A WMR consists of a main body which is able to move on a
surface of travel by means of one or more wheels.
Each wheel of a WMR may be considered as an open
chain; however, since each wheel connects a common
surface of travel the WMR is a closedchain.
Introduction to Robotics
Combination of various physical (hardware) and
computational (software) components
A collection of subsystems:
Locomotion: how the robot moves through its
environment
Sensing: how the robot measures properties of itself
and its environment
Control: how the robot generate physical actions
Reasoning: how the robot maps measurements into
actions
Communication: how the robots communicate with
each other or with an outside operator
Introduction to Robotics
Locomotion the process of causing a robot to move.
Kinematics study of the mathematics of motion
without considering the forces that affect the motion.
In order to produce motion, forces must be applied to the robot
Motor output, payload
Deals with the geometric relationships that govern the system
Deals with the relationship between control parameters and the
behavior of a system.
Dynamics study of motion in which these forces are
modeled
Deals with the relationship between force and motions.
Introduction to Robotics
10
Locomotion Concepts: Principles Found in Nature
9/1/2016
Dr T ASOKAN, IIT MADRAS
11
Locomotion concepts
Concepts found in nature difficult to imitate technically
Most technical systems use wheels or caterpillars
Rolling is most efficient, but not found in nature
Nature never invented the wheel !
However, the movement of a walking biped is close to rolling
Biped walking mechanism
not to far from real rolling.
rolling of a polygon with side length equal to the length of the step.
the smaller the step gets, the more the polygon tends to a circle
(wheel).
However, fully rotating joint was not developed in nature.
Locomotion is the process of causing a robot to move.
9/1/2016
Dr T ASOKAN, IIT MADRAS
12
9/1/2016
Dr T ASOKAN, IIT MADRAS
14
Types of locomotion in mobile robots
Wheeled locomotion
Legged locomotion
The fewer legs the more complicated
becomes locomotion
Stability - at least three legs are required for
static stability
During walking some legs are lifted
thus loosing stability?
For statically stable walking at least 6
legs are required
babies have to learn for quite a while until
they are able to stand or even walk on their
two legs.
9/1/2016
Wheels are the most appropriate solution
for most applications
Three wheels are sufficient to guarantee
stability
With more than three wheels an
appropriate suspension is required
Selection of wheels depends on the
application
Dr T ASOKAN, IIT MADRAS
physical interaction between the vehicle and its environment.
15
Types of Legged robots
Hopping machine
Bipedal
Quadruped
Hexapod
9/1/2016
Dr T ASOKAN, IIT MADRAS
16
Mobile Robot Locomotion
Differential Drive
two driving wheels (plus roller-ball for balance)
simplest drive mechanism
sensitive to the relative velocity of the two wheels (small error result in
different trajectories, not just speed)
Steered wheels (tricycle, bicycles, wagon)
Steering wheel + rear wheels
cannot turn 90
limited radius of curvature
Synchronous Drive
Omni-directional
Car Drive (Ackerman Steering)
9/1/2016
Dr T ASOKAN, IIT MADRAS
17
Wheeled Locomotion
Wheel Design
Wheel Geometry/configuration
Stability
Maneuverability
Controllability
9/1/2016
Dr T ASOKAN, IIT MADRAS
18
WHEEL DESIGN
Castor Wheel
Two degrees of freedom
9/1/2016
Dr T ASOKAN, IIT MADRAS
19
9/1/2016
Dr T ASOKAN, IIT MADRAS
20
Wheel configurations
9/1/2016
Dr T ASOKAN, IIT MADRAS
21
9/1/2016
Dr T ASOKAN, IIT MADRAS
22
9/1/2016
Dr T ASOKAN, IIT MADRAS
23
9/1/2016
Dr T ASOKAN, IIT MADRAS
24
9/1/2016
Dr T ASOKAN, IIT MADRAS
25
9/1/2016
Dr T ASOKAN, IIT MADRAS
26
9/1/2016
Dr T ASOKAN, IIT MADRAS
27
9/1/2016
Dr T ASOKAN, IIT MADRAS
28
9/1/2016
Dr T ASOKAN, IIT MADRAS
29
9/1/2016
Dr T ASOKAN, IIT MADRAS
30
9/1/2016
Dr T ASOKAN, IIT MADRAS
31
9/1/2016
Dr T ASOKAN, IIT MADRAS
32
Stability
Minimum two wheels needed for static
stability (provided Centre of mass is below
wheel axle)
Stability can be improved by adding more
wheels
9/1/2016
Dr T ASOKAN, IIT MADRAS
33
Maneuverability
Ability to move in any direction irrespective of
the orientation of the robot
Degree of Maneuverability: The overall
degrees of freedom that a robot can manipulate
Degree of maneuverability= Degree of
mobility+ Degree of steerability
9/1/2016
Dr T ASOKAN, IIT MADRAS
34
Degree of Mobility
The degree of freedom of the robot motion
Cannot move
anywhere (No
ICR)
Fixed arc motion
(Only one ICR)
Degree of mobility : 1
Degree of mobility : 0
Fully free motion
Variable arc
motion (line of
ICRs)
( ICR can be located
at any position)
Degree of mobility : 2
ICR: Instantaneous Centre of Rotation
9/1/2016
Degree of mobility : 3
Dr T ASOKAN, IIT MADRAS
35
Degree of Steerability
The number of centered orientable wheels that can be steered
independently in order to steer the robot
No centered orientable wheels
Degree of steerability : 0
One centered orientable
wheel
Two mutually
independent
centered
orientable wheels
Two mutually
dependent centered
orientable wheels
9/1/2016
Degree of steerability : 1
Dr T ASOKAN, IIT MADRAS
Degree of steerability : 2
36
Degree of Maneuverability
The overall degrees of freedom that a robot can manipulate:
M m s
Degree of Mobility
Degree of Steerability
Examples of robot types (degree of mobility, degree of steerability)
9/1/2016
Dr T ASOKAN, IIT MADRAS
37
9/1/2016
Dr T ASOKAN, IIT MADRAS
38
Synchro drive
9/1/2016
Dr T ASOKAN, IIT MADRAS
39
Mobile Robot Kinematics
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
there is no direct way to measure the robots position
Position must be integrated over time
Leads to inaccuracies of the position (motion) estimate
-> the number 1 challenge in mobile robotics
Understanding mobile robot motion starts with
understanding wheel constraints placed on the robots
mobility
9/1/2016
Dr T ASOKAN, IIT MADRAS
40
Kinematics Model
Goal:
establish the robot speed x y T as a function of the
wheel speeds i, steering angles i , steering speeds i and the
geometric parameters of the robot (configuration coordinates).
forward kinematics
x
y f ( 1 , n , 1 , m , 1 , m )
yI
v(t)
s(t)
Inverse kinematics
1 n 1 m 1 m T f ( x, y,)
x
why not
y f ( 1 , n , 1 , m )
-> not straight forward
9/1/2016
Dr T ASOKAN, IIT MADRAS
41
xI
Representing Robot Position
Representing robot within an arbitrary initial
Y
frame
I
Inertial frame: X I ,YI
Robot frame: X R ,YR
YR
XR
T
Robot position: I x y
Mapping between the two frames
T
I R R R x y
R R I R x y
1
9/1/2016
Dr T ASOKAN, IIT MADRAS
XI
cos sin 0
R 1 R( )T sin cos 0
0
0
1
42
Example
cos sin 0
R 1 R( )T sin cos 0
0
0
1
-1
9/1/2016
Dr T ASOKAN, IIT MADRAS
43
Forward Kinematic Models
(Refer chap.3 (sec. 3.2.2), Roland Siegwart )
9/1/2016
Dr T ASOKAN, IIT MADRAS
44
Example
If a mobile robot parameters are given as
theta=pi/2, r=1, l=1 and the wheel speeds are
4 and 2 , find the velocity of the robot wrt
inertial frame.
9/1/2016
Dr T ASOKAN, IIT MADRAS
45
Wheel Kinematic Constraints: Assumptions
Movement on a horizontal plane
Point contact of the wheels
Wheels not deformable
Pure rolling
v = 0 at contact point
YI
YR
No slipping, skidding or sliding
No friction for rotation around contact point
Steering axes orthogonal to the surface
Wheels connected by rigid frame (chassis)
XR
XI
Rolling constraint: Wheel must roll in the appropriate direction when the
motion takes place
Sliding Constraint: No lateral slippage- wheel must not slide orthogonal to the
9/1/2016
Dr T ASOKAN, IIT MADRAS
wheel
plane
46
Wheel Kinematic Constraints:
Fixed Standard Wheel
9/1/2016
Dr T ASOKAN, IIT MADRAS
47
-1
-1
9/1/2016
Dr T ASOKAN, IIT MADRAS
48
Rolling constraint
-1
-1
Sliding constraint
-1
J1 f R( )I J 2 0
-1
C1 f R( ) I 0
Suppose that the wheel A is in position such that
a = 0 and = 0
This would place the contact point of the wheel on XI with the
plane of the wheel oriented parallel to YI. If = 0, then this
sliding constraint reduces to:
9/1/2016
Dr T ASOKAN, IIT MADRAS
49
Wheel Kinematic Constraints:
Steered Standard Wheel
Rolling constraint
-1
-1
Sliding constraint
-1
9/1/2016
Dr T ASOKAN, IIT MADRAS
J1 ( s ) R( )I J 2 0
-1
C1 ( s ) R( 50
)I 0
Wheel Kinematic Constraints:
Castor Wheel
Any motion orthogonal to
the wheel plane must be
balanced by an equivalent
and opposite amount of
castor steering motion.
Given any
robot chasis
.
motion, I , there exists a
some value for spin speed
and steering speed such
that the constraints are
met.
Rolling constraint
-1
-1
Additional (Rolling) constraint
cos(a )
9/1/2016
sin(a ) d l sin R( ) I d 0
-1
Dr T ASOKAN, IIT MADRAS
J1 ( s ) R( )I J. 2 0
-1
C1( s ) R( )I C2 ( 51s ) 0
Wheel Kinematic Constraints:
Swedish Wheel
What will
happen if =0 or
90?
-1
J1 ( s ) R( )I J 2 0
-1
C ( ) R( ) 0
1
sin(a )
cos(a )
9/1/2016
cos(a ) l cos( )R( ) I r cos 0
-1 .
-1 .
sin(a ) l sin( )R( ) I r sin
Dr T ASOKAN, IIT MADRAS
.
rsw sw 0
52
Wheel Kinematic Constraints:
Spherical Wheel
-1
-1
9/1/2016
Dr T ASOKAN, IIT MADRAS
53
Robot Kinematic Constraints
Given a robot with M wheels
each wheel imposes zero or more constraints on the robot motion
only fixed and steerable standard wheels impose constraints
Suppose we have a total of N=Nfixed + Nsteerable
We can develop the equations for the constraints in matrix forms:
Rolling
-1
J1( s ) R( )I J 2 0
J1 f J diag(r r )
J1 ( s )
2
1
N
J1s ( s )
N f N s 3
Lateral movement
C1 ( s ) R( )I 0
-1
C1 f
C1 ( s )
C
(
)
1s s
(t )
f (t )
(t )
s
size N f N s 1
N f N s 3
9/1/2016
Dr T ASOKAN, IIT MADRAS
54
Example: Differential Drive Robot
yI
v(t)
s(t)
xI
-1
-1
9/1/2016
Dr T ASOKAN, IIT MADRAS
55
Example: Omidirectional robot
Swedish Wheel
sin(a )
9/1/2016
-1 .
cos(a ) l cos( )R( ) I r cos 0
Dr T ASOKAN, IIT MADRAS
56
Summary
Wheeled locomotion
Wheel Design
Wheel Geometry/configuration
Stability
Maneuverability
Wheel Kinematic constraints
Robot Kinematic constraints
Motion Control
9/1/2016
Dr T ASOKAN, IIT MADRAS
60
Assignment II
(x
9/1/2016
y )
Dr T ASOKAN, IIT MADRAS
61
Project/Seminar
Group Projects (max. four members)
Select your team members
Choose a project
Inform the TA
Carry out the work
Submit a report along with a ppt. presentation
Individual Seminar
Choose a topic
Inform the TA
Make a report
Make a presentation
Seminar presentations to start from Oct first week
Project
to be presented
before end sem. Exam.
9/1/2016
Dr T ASOKAN, IIT MADRAS
62