the city college of new york 1 prof. john (jizhong) xiao department of electrical engineering city...

50
The City College of New York 1 Prof. John (Jizhong) Xiao Department of Electrical Engineering City College of New York [email protected] Mobot: Mobile Robot Introduction to ROBOTICS

Post on 20-Dec-2015

220 views

Category:

Documents


2 download

TRANSCRIPT

Page 1: The City College of New York 1 Prof. John (Jizhong) Xiao Department of Electrical Engineering City College of New York jxiao@ccny.cuny.edu Mobot: Mobile

The City College of New York

1

Prof. John (Jizhong) Xiao

Department of Electrical Engineering

City College of New York

[email protected]

Mobot: Mobile Robot

Introduction to ROBOTICS

Page 2: The City College of New York 1 Prof. John (Jizhong) Xiao Department of Electrical Engineering City College of New York jxiao@ccny.cuny.edu Mobot: Mobile

The City College of New York

2

Contents• Introduction• Classification of wheels

– Fixed wheel– Centered orientable wheel– Off-centered orientable wheel– Swedish wheel

• Mobile Robot Locomotion– Differential Drive– Tricycle– Synchronous Drive– Omni-directional– Ackerman Steering

• Kinematics models of WMR• Summary

Page 3: The City College of New York 1 Prof. John (Jizhong) Xiao Department of Electrical Engineering City College of New York jxiao@ccny.cuny.edu Mobot: Mobile

The City College of New York

3

Locomotion

Locomotion is the process of causing an autonomous robot to move

In order to produce motion, forces must be applied to the vehicle

Page 4: The City College of New York 1 Prof. John (Jizhong) Xiao Department of Electrical Engineering City College of New York jxiao@ccny.cuny.edu Mobot: Mobile

The City College of New York

4

Wheeled Mobile Robots (WMR)

Page 5: The City College of New York 1 Prof. John (Jizhong) Xiao Department of Electrical Engineering City College of New York jxiao@ccny.cuny.edu Mobot: Mobile

The City College of New York

5

Wheeled Mobile Robots• 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

Page 6: The City College of New York 1 Prof. John (Jizhong) Xiao Department of Electrical Engineering City College of New York jxiao@ccny.cuny.edu Mobot: Mobile

The City College of New York

6

Wheeled Mobile Robots

• Locomotion — the process of causing an robot to move.– In order to produce motion, forces must be applied to the robot– Motor output, payload

• Kinematics – study of the mathematics of motion without considering the forces that affect the motion.– 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.

Page 7: The City College of New York 1 Prof. John (Jizhong) Xiao Department of Electrical Engineering City College of New York jxiao@ccny.cuny.edu Mobot: Mobile

The City College of New York

7

Notation

Posture: position(x, y) and orientation

Page 8: The City College of New York 1 Prof. John (Jizhong) Xiao Department of Electrical Engineering City College of New York jxiao@ccny.cuny.edu Mobot: Mobile

The City College of New York

8

Wheels

Lateral slip

Rolling motion

Page 9: The City College of New York 1 Prof. John (Jizhong) Xiao Department of Electrical Engineering City College of New York jxiao@ccny.cuny.edu Mobot: Mobile

The City College of New York

9

1. The robot is built from rigid mechanisms.

2. No slip occurs in the orthogonal direction of rolling (non-slipping).

3. No translational slip occurs between the wheel and the floor (pure rolling).

4. The robot contains at most one steering link per wheel.

5. All steering axes are perpendicular to the floor.

Non-slipping and pure rolling

• Assumptions

Idealized Rolling Wheel

Page 10: The City College of New York 1 Prof. John (Jizhong) Xiao Department of Electrical Engineering City College of New York jxiao@ccny.cuny.edu Mobot: Mobile

The City College of New York

10

Steered Wheel• Steered wheel

– The orientation of the rotation axis can be controlled

Page 11: The City College of New York 1 Prof. John (Jizhong) Xiao Department of Electrical Engineering City College of New York jxiao@ccny.cuny.edu Mobot: Mobile

The City College of New York

11

Robot wheel parameters

• For low velocities, rolling is a reasonable wheel model.– This is the model that will be considered in the

kinematics models of WMR

• Wheel parameters:– r = wheel radius– v = wheel linear velocity– w = wheel angular velocity– t = steering velocity

Page 12: The City College of New York 1 Prof. John (Jizhong) Xiao Department of Electrical Engineering City College of New York jxiao@ccny.cuny.edu Mobot: Mobile

The City College of New York

12

Wheel TypesFixed wheel Centered orientable wheel

Off-centered orientable wheel (Castor wheel) Swedish wheel:omnidirectional

property

Page 13: The City College of New York 1 Prof. John (Jizhong) Xiao Department of Electrical Engineering City College of New York jxiao@ccny.cuny.edu Mobot: Mobile

The City College of New York

13

Fixed wheel– Velocity of point P

– Restriction to the robot mobility Point P cannot move to the direction perpendicular to plane of the wheel.

x

y

where, ax : A unit vector to X axis

Page 14: The City College of New York 1 Prof. John (Jizhong) Xiao Department of Electrical Engineering City College of New York jxiao@ccny.cuny.edu Mobot: Mobile

The City College of New York

14

Centered orientable wheels

– Velocity of point P

– Restriction to the robot mobility

ax : A unit vector of x axis

ay : A unit vector of y axis

x

y

where,

Page 15: The City College of New York 1 Prof. John (Jizhong) Xiao Department of Electrical Engineering City College of New York jxiao@ccny.cuny.edu Mobot: Mobile

The City College of New York

15

– Velocity of point P

– Restriction to the robot mobility

x

y

ax : A unit vector of x axis

ay : A unit vector of y axis

where,

Off-Centered Orientable Wheels

Page 16: The City College of New York 1 Prof. John (Jizhong) Xiao Department of Electrical Engineering City College of New York jxiao@ccny.cuny.edu Mobot: Mobile

The City College of New York

16

Swedish wheel

– Velocity of point P

– Omnidirectional property

x

y

ax : A unit vector of x axis as : A unit vector to the motion of

roller

where,

Page 17: The City College of New York 1 Prof. John (Jizhong) Xiao Department of Electrical Engineering City College of New York jxiao@ccny.cuny.edu Mobot: Mobile

The City College of New York

17

• Smooth motion • Risk of slipping• Some times use roller-ball

to make balance Bi-wheel type robot

Omnidirectional robot

Caterpillar type robot

• Exact straight motion• Robust to slipping• Inexact modeling of

turning

• Free motion• Complex structure• Weakness of the frame

Example

Examples of WMR

Page 18: The City College of New York 1 Prof. John (Jizhong) Xiao Department of Electrical Engineering City College of New York jxiao@ccny.cuny.edu Mobot: Mobile

The City College of New York

18

Mobile Robot Locomotion• Instantaneous center of rotation (ICR) or Instantaneous center

of curvature (ICC)– A cross point of all axes of the wheels

Page 19: The City College of New York 1 Prof. John (Jizhong) Xiao Department of Electrical Engineering City College of New York jxiao@ccny.cuny.edu Mobot: Mobile

The City College of New York

19

Degree of Mobility

• Degree of mobility The degree of freedom of the robot motion

• Degree of mobility : 0

• Degree of mobility : 2

• Degree of mobility : 3

• Degree of mobility : 1

Cannot move anywhere (No ICR)

Fixed arc motion (Only one ICR)

Variable arc motion (line of ICRs)

Fully free motion

( ICR can be located at any position)

Page 20: The City College of New York 1 Prof. John (Jizhong) Xiao Department of Electrical Engineering City College of New York jxiao@ccny.cuny.edu Mobot: Mobile

The City College of New York

20

Degree of Steerability• Degree of steerability

The number of centered orientable wheels that can be steered independently in order to steer the robot

• Degree of steerability : 0

• Degree of steerability : 2

• Degree of steerability : 1

No centered orientable wheels

One centered orientable wheel

Two mutually dependent centered orientable wheels

Two mutually independent centered orientable wheels

Page 21: The City College of New York 1 Prof. John (Jizhong) Xiao Department of Electrical Engineering City College of New York jxiao@ccny.cuny.edu Mobot: Mobile

The City College of New York

21

Degree of Maneuverability

Degree of Mobility 3 2 2 1 1Degree of Steerability 0 0 1 1 2

• The overall degrees of freedom that a robot can manipulate:

• Examples of robot types (degree of mobility, degree of steerability)

smM

Page 22: The City College of New York 1 Prof. John (Jizhong) Xiao Department of Electrical Engineering City College of New York jxiao@ccny.cuny.edu Mobot: Mobile

The City College of New York

22

Degree of Maneuverability

smM

Page 23: The City College of New York 1 Prof. John (Jizhong) Xiao Department of Electrical Engineering City College of New York jxiao@ccny.cuny.edu Mobot: Mobile

The City College of New York

23

Non-holonomic constraint

So what does that mean?Your robot can move in some directions (forward

and backward), but not others (sideward).

The robot can instantlymove forward and backward, but can not move sideward

Parallel parking,Series of maneuvers

A non-holonomic constraint is a constraint on the feasible velocities of a body

Page 24: The City College of New York 1 Prof. John (Jizhong) Xiao Department of Electrical Engineering City College of New York jxiao@ccny.cuny.edu Mobot: Mobile

The City College of New York

24

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)

Page 25: The City College of New York 1 Prof. John (Jizhong) Xiao Department of Electrical Engineering City College of New York jxiao@ccny.cuny.edu Mobot: Mobile

The City College of New York

25

• Posture of the robot

v : Linear velocity of the robot

w : Angular velocity of the robot

(notice: not for each wheel)

(x,y) : Position of the robot

: Orientation of the robot

• Control input

Differential Drive

Page 26: The City College of New York 1 Prof. John (Jizhong) Xiao Department of Electrical Engineering City College of New York jxiao@ccny.cuny.edu Mobot: Mobile

The City College of New York

26

Differential Drive – linear velocity of right wheel – linear velocity of left wheelr – nominal radius of each wheelR – instantaneous curvature radius of the robot trajectory (distance from ICC to the midpoint between the two wheels).

Property: At each time instant, the left and right wheels must follow a trajectory that moves around the ICC at the same angular rate , i.e.,

RVL

R )2

( LVL

R )2

(

)(tVR

)(tVL

Page 27: The City College of New York 1 Prof. John (Jizhong) Xiao Department of Electrical Engineering City College of New York jxiao@ccny.cuny.edu Mobot: Mobile

The City College of New York

27

Differential Drive

0cossincossin

yx

y

x

• Nonholonomic Constraint

• Kinematic equation

Physical Meaning?

• Relation between the control input and speed of wheels

Posture Kinematics Model: Kinematics model in world frame

90

Page 28: The City College of New York 1 Prof. John (Jizhong) Xiao Department of Electrical Engineering City College of New York jxiao@ccny.cuny.edu Mobot: Mobile

The City College of New York

28

Differential DriveKinematics model in robot frame

---configuration kinematics model

Page 29: The City College of New York 1 Prof. John (Jizhong) Xiao Department of Electrical Engineering City College of New York jxiao@ccny.cuny.edu Mobot: Mobile

The City College of New York

29

Basic Motion Control• Instantaneous center of rotation

• Straight motion R = Infinity VR =

VL

• Rotational motion R = 0 VR = -

VL

R : Radius of rotation

Page 30: The City College of New York 1 Prof. John (Jizhong) Xiao Department of Electrical Engineering City College of New York jxiao@ccny.cuny.edu Mobot: Mobile

The City College of New York

30

• Velocity Profile

: Radius of rotation

: Length of path : Angle of

rotation

3 1 0 2

3 1 0 2

Basic Motion Control

Page 31: The City College of New York 1 Prof. John (Jizhong) Xiao Department of Electrical Engineering City College of New York jxiao@ccny.cuny.edu Mobot: Mobile

The City College of New York

31

Tricycle • Three wheels and odometers on the two rear wheels • Steering and power are provided through the front wheel• control variables:

– steering direction α(t)

– angular velocity of steering wheel ws(t)

The ICC must lie onthe line that passesthrough, and isperpendicular to, thefixed rear wheels

Page 32: The City College of New York 1 Prof. John (Jizhong) Xiao Department of Electrical Engineering City College of New York jxiao@ccny.cuny.edu Mobot: Mobile

The City College of New York

32

Tricycle

• If the steering wheel is set to an angle α(t) from the straight-line direction, the tricycle will rotate with angular velocity ω(t) about ICC lying a distance R along the line perpendicular to and passing through the rear wheels.

Page 33: The City College of New York 1 Prof. John (Jizhong) Xiao Department of Electrical Engineering City College of New York jxiao@ccny.cuny.edu Mobot: Mobile

The City College of New York

33

Tricycle

d: distance from the front wheel to the rear axle

Page 34: The City College of New York 1 Prof. John (Jizhong) Xiao Department of Electrical Engineering City College of New York jxiao@ccny.cuny.edu Mobot: Mobile

The City College of New York

34

Tricycle

Kinematics model in the robot frame---configuration kinematics model

Page 35: The City College of New York 1 Prof. John (Jizhong) Xiao Department of Electrical Engineering City College of New York jxiao@ccny.cuny.edu Mobot: Mobile

The City College of New York

35

Tricycle Kinematics model in the world frame---Posture kinematics model

Page 36: The City College of New York 1 Prof. John (Jizhong) Xiao Department of Electrical Engineering City College of New York jxiao@ccny.cuny.edu Mobot: Mobile

The City College of New York

36

Synchronous Drive

• In a synchronous drive robot (synchronous drive) each wheel is capable of being driven and steered.

• Typical configurations– Three steered wheels arranged as vertices of

an equilateral– triangle often surmounted by a cylindrical

platform– All the wheels turn and drive in unison

• This leads to a holonomic behavior

Page 37: The City College of New York 1 Prof. John (Jizhong) Xiao Department of Electrical Engineering City College of New York jxiao@ccny.cuny.edu Mobot: Mobile

The City College of New York

37

Synchronous Drive

Page 38: The City College of New York 1 Prof. John (Jizhong) Xiao Department of Electrical Engineering City College of New York jxiao@ccny.cuny.edu Mobot: Mobile

The City College of New York

38

Synchronous Drive• All the wheels turn in unison• All of the three wheels point in the same direction

and turn at the same rate– This is typically achieved through the use of a complex collection

of belts that physically link the wheels together– Two independent motors, one rolls all wheels forward, one rotate

them for turning

• The vehicle controls the direction in which the wheels point and the rate at which they roll

• Because all the wheels remain parallel the synchro drive always rotate about the center of the robot

• The synchro drive robot has the ability to control the orientation θ of their pose directly.

Page 39: The City College of New York 1 Prof. John (Jizhong) Xiao Department of Electrical Engineering City College of New York jxiao@ccny.cuny.edu Mobot: Mobile

The City College of New York

39

Synchronous Drive• Control variables (independent)

– v(t), ω(t)

Page 40: The City College of New York 1 Prof. John (Jizhong) Xiao Department of Electrical Engineering City College of New York jxiao@ccny.cuny.edu Mobot: Mobile

The City College of New York

40

Synchronous Drive

• Particular cases:– v(t)=0, w(t)=w during a

time interval ∆t, The robot rotates in place by an amount w ∆t .

– v(t)=v, w(t)=0 during a time interval ∆t , the robot moves in the direction its pointing a distance v ∆t.

Page 41: The City College of New York 1 Prof. John (Jizhong) Xiao Department of Electrical Engineering City College of New York jxiao@ccny.cuny.edu Mobot: Mobile

The City College of New York

41

Omidirectional

Swedish Wheel

Page 42: The City College of New York 1 Prof. John (Jizhong) Xiao Department of Electrical Engineering City College of New York jxiao@ccny.cuny.edu Mobot: Mobile

The City College of New York

42

Car Drive (Ackerman Steering)• Used in motor vehicles,

the inside front wheel is rotated slightly sharper than the outside wheel (reduces tire slippage).

• Ackerman steering provides a fairly accurate dead-reckoning solution while supporting traction and ground clearance.

• Generally the method of choice for outdoor autonomous vehicles.

R

Page 43: The City College of New York 1 Prof. John (Jizhong) Xiao Department of Electrical Engineering City College of New York jxiao@ccny.cuny.edu Mobot: Mobile

The City College of New York

43

Ackerman Steering

whered = lateral wheel separationl = longitudinal wheel separationi = relative steering angle of inside wheelo = relative steering angle of outside wheelR=distance between ICC to centerline of the vehicle

R

Page 44: The City College of New York 1 Prof. John (Jizhong) Xiao Department of Electrical Engineering City College of New York jxiao@ccny.cuny.edu Mobot: Mobile

The City College of New York

44

Ackerman Steering• The Ackerman Steering equation:

– :

sin

coscot

l

dl

dR

l

dRoi

2/2/

cotcot

R

Page 45: The City College of New York 1 Prof. John (Jizhong) Xiao Department of Electrical Engineering City College of New York jxiao@ccny.cuny.edu Mobot: Mobile

The City College of New York

45

Ackerman SteeringEquivalent:

Page 46: The City College of New York 1 Prof. John (Jizhong) Xiao Department of Electrical Engineering City College of New York jxiao@ccny.cuny.edu Mobot: Mobile

The City College of New York

46

Kinematic model for car-like robot

• Control Input• Driving type: Forward wheel drive

1u

X

Y

},{

},{

},,,{

21

21

uu

yx

yx,

: forward vel

: steering vel

2u

Page 47: The City College of New York 1 Prof. John (Jizhong) Xiao Department of Electrical Engineering City College of New York jxiao@ccny.cuny.edu Mobot: Mobile

The City College of New York

47

Kinematic model for car-like robot

2

1

1

1

tan

sin

cos

ul

u

uy

ux

X

Y

yx,

0cossin yx non-holonomic constraint:

: forward velocity

: steering velocity

1u2u

Page 48: The City College of New York 1 Prof. John (Jizhong) Xiao Department of Electrical Engineering City College of New York jxiao@ccny.cuny.edu Mobot: Mobile

The City College of New York

48

Dynamic Model

2

1

1

0

0

0

sin

cos

0

cos

sin

0

0

0

0

0

0f

fy

x

I

m

m

X

Y

yx,• Dynamic model

Page 49: The City College of New York 1 Prof. John (Jizhong) Xiao Department of Electrical Engineering City College of New York jxiao@ccny.cuny.edu Mobot: Mobile

The City College of New York

49

Summary• Mobot: Mobile Robot • Classification of wheels

– Fixed wheel– Centered orientable wheel– Off-centered orientable wheel (Caster

Wheel)– Swedish wheel

• Mobile Robot Locomotion– Degrees of mobility– 5 types of driving (steering) methods

• Kinematics of WMR• Basic Control

Page 50: The City College of New York 1 Prof. John (Jizhong) Xiao Department of Electrical Engineering City College of New York jxiao@ccny.cuny.edu Mobot: Mobile

The City College of New York

50

Thank you!

Homework 6 posted

Next class: Robot Sensing