mobot: mobile robot - gunadarma

50
Pengantar Robotika – Universitas Gunadarma 1 Mohammad Iqbal Based-on slide Prof. John (Jizhong) Xiao Mobot: Mobile Robot Introduction to ROBOTICS

Upload: others

Post on 06-Apr-2022

12 views

Category:

Documents


0 download

TRANSCRIPT

Page 1: Mobot: Mobile Robot - Gunadarma

The City College of New YorkPengantar Robotika – Universitas Gunadarma 1

Mohammad IqbalBased-on slide Prof. John (Jizhong) Xiao

Mobot: Mobile Robot

Introduction to ROBOTICS

Page 2: Mobot: Mobile Robot - Gunadarma

The City College of New YorkPengantar Robotika – Universitas Gunadarma 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: Mobot: Mobile Robot - Gunadarma

The City College of New YorkPengantar Robotika – Universitas Gunadarma 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: Mobot: Mobile Robot - Gunadarma

The City College of New YorkPengantar Robotika – Universitas Gunadarma 4

Wheeled Mobile Robots (WMR)

Page 5: Mobot: Mobile Robot - Gunadarma

The City College of New YorkPengantar Robotika – Universitas Gunadarma 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: Mobot: Mobile Robot - Gunadarma

The City College of New YorkPengantar Robotika – Universitas Gunadarma 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: Mobot: Mobile Robot - Gunadarma

The City College of New YorkPengantar Robotika – Universitas Gunadarma 7

Notation

Posture: position(x, y) and orientation θ

Page 8: Mobot: Mobile Robot - Gunadarma

The City College of New YorkPengantar Robotika – Universitas Gunadarma 8

Wheels

Lateral slip

Rolling motion

Page 9: Mobot: Mobile Robot - Gunadarma

The City College of New YorkPengantar Robotika – Universitas Gunadarma 9

Steered Wheel• Steered wheel

– The orientation of the rotation axis can be controlled

Page 10: Mobot: Mobile Robot - Gunadarma

The City College of New YorkPengantar Robotika – Universitas Gunadarma 10

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 11: Mobot: Mobile Robot - Gunadarma

The City College of New YorkPengantar Robotika – Universitas Gunadarma 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: Mobot: Mobile Robot - Gunadarma

The City College of New YorkPengantar Robotika – Universitas Gunadarma 12

Wheel TypesFixed wheel Centered orientable wheel

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

property

Page 13: Mobot: Mobile Robot - Gunadarma

The City College of New YorkPengantar Robotika – Universitas Gunadarma 13

Fixed wheel– Velocity of point P

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

x

y

where, ax : A unit vector to X axis

Page 14: Mobot: Mobile Robot - Gunadarma

The City College of New YorkPengantar Robotika – Universitas Gunadarma 14

Centered orientable wheels– Velocity of point P

– Restriction to the robot mobility

ax : A unit vector of x axisay : A unit vector of y axis

x

y

where,

Page 15: Mobot: Mobile Robot - Gunadarma

The City College of New YorkPengantar Robotika – Universitas Gunadarma 15

– Velocity of point P

– Restriction to the robot mobility

x

y

ax : A unit vector of x axisay : A unit vector of y axis

where,

Off-Centered Orientable Wheels

Page 16: Mobot: Mobile Robot - Gunadarma

The City College of New YorkPengantar Robotika – Universitas Gunadarma 16

Swedish wheel– Velocity of point P

– Omnidirectional property

x

y

ax : A unit vector of x axisas : A unit vector to the motion of roller

where,

Page 17: Mobot: Mobile Robot - Gunadarma

The City College of New YorkPengantar Robotika – Universitas Gunadarma 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: Mobot: Mobile Robot - Gunadarma

The City College of New YorkPengantar Robotika – Universitas Gunadarma 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: Mobot: Mobile Robot - Gunadarma

The City College of New YorkPengantar Robotika – Universitas Gunadarma 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: Mobot: Mobile Robot - Gunadarma

The City College of New YorkPengantar Robotika – Universitas Gunadarma 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: Mobot: Mobile Robot - Gunadarma

The City College of New YorkPengantar Robotika – Universitas Gunadarma 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: Mobot: Mobile Robot - Gunadarma

The City College of New YorkPengantar Robotika – Universitas Gunadarma 22

Degree of Maneuverability

smM δδδ +=

Page 23: Mobot: Mobile Robot - Gunadarma

The City College of New YorkPengantar Robotika – Universitas Gunadarma 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: Mobot: Mobile Robot - Gunadarma

The City College of New YorkPengantar Robotika – Universitas Gunadarma 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: Mobot: Mobile Robot - Gunadarma

The City College of New YorkPengantar Robotika – Universitas Gunadarma 25

• Posture of the robot

v : Linear velocity of the robotw : 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: Mobot: Mobile Robot - Gunadarma

The City College of New YorkPengantar Robotika – Universitas Gunadarma 26

Differential Drive– linear velocity of right wheel– linear velocity of left wheel

r – 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.,

RVLR =+ )2

(ω LVLR =− )2

)(tVR)(tVL

Page 27: Mobot: Mobile Robot - Gunadarma

The City College of New YorkPengantar Robotika – Universitas Gunadarma 27

Differential Drive

[ ] 0cossincossin =−=⎥⎦

⎤⎢⎣

⎡− θθθθ yx

yx

!!!

!

• Nonholonomic Constraint

• Kinematic equation

Physical Meaning?

• Relation between the control input and speed of wheelsPosture Kinematics Model: Kinematics model in world frame

θ−!90

θ

Page 28: Mobot: Mobile Robot - Gunadarma

The City College of New YorkPengantar Robotika – Universitas Gunadarma 28

Differential DriveKinematics model in robot frame---configuration kinematics model

Page 29: Mobot: Mobile Robot - Gunadarma

The City College of New YorkPengantar Robotika – Universitas Gunadarma 29

Basic Motion Control• Instantaneous center of rotation

• Straight motionR = Infinity VR = VL

• Rotational motionR = 0 VR = -VL

R : Radius of rotation

Page 30: Mobot: Mobile Robot - Gunadarma

The City College of New YorkPengantar Robotika – Universitas Gunadarma 30

• Velocity Profile

: Radius of rotation: Length of path: Angle of rotation

3 10 2

3 10 2

Basic Motion Control

Page 31: Mobot: Mobile Robot - Gunadarma

The City College of New YorkPengantar Robotika – Universitas Gunadarma 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: Mobot: Mobile Robot - Gunadarma

The City College of New YorkPengantar Robotika – Universitas Gunadarma 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: Mobot: Mobile Robot - Gunadarma

The City College of New YorkPengantar Robotika – Universitas Gunadarma 33

Tricycle

d: distance from the front wheel to the rear axle

Page 34: Mobot: Mobile Robot - Gunadarma

The City College of New YorkPengantar Robotika – Universitas Gunadarma 34

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

Page 35: Mobot: Mobile Robot - Gunadarma

The City College of New YorkPengantar Robotika – Universitas Gunadarma 35

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

Page 36: Mobot: Mobile Robot - Gunadarma

The City College of New YorkPengantar Robotika – Universitas Gunadarma 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: Mobot: Mobile Robot - Gunadarma

The City College of New YorkPengantar Robotika – Universitas Gunadarma 37

Synchronous Drive

Page 38: Mobot: Mobile Robot - Gunadarma

The City College of New YorkPengantar Robotika – Universitas Gunadarma 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: Mobot: Mobile Robot - Gunadarma

The City College of New YorkPengantar Robotika – Universitas Gunadarma 39

Synchronous Drive• Control variables (independent)

– v(t), ω(t)

Page 40: Mobot: Mobile Robot - Gunadarma

The City College of New YorkPengantar Robotika – Universitas Gunadarma 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: Mobot: Mobile Robot - Gunadarma

The City College of New YorkPengantar Robotika – Universitas Gunadarma 41

Omidirectional

Swedish Wheel

Page 42: Mobot: Mobile Robot - Gunadarma

The City College of New YorkPengantar Robotika – Universitas Gunadarma 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: Mobot: Mobile Robot - Gunadarma

The City College of New YorkPengantar Robotika – Universitas Gunadarma 43

Ackerman Steering

whered = lateral wheel separationl = longitudinal wheel separationθi = relative steering angle of inside wheelθo = relative steering angle of outside wheelR=distance between ICC to centerline of the vehicle

R

Page 44: Mobot: Mobile Robot - Gunadarma

The City College of New YorkPengantar Robotika – Universitas Gunadarma 44

Ackerman Steering• The Ackerman Steering equation:

– :

θθ

θsincoscot =

ld

ldR

ldR

oi

=

+−

−=

2/2/cotcot θθ

ld

oi =− θθ cotcot

R

Page 45: Mobot: Mobile Robot - Gunadarma

The City College of New YorkPengantar Robotika – Universitas Gunadarma 45

Ackerman SteeringEquivalent:

Page 46: Mobot: Mobile Robot - Gunadarma

The City College of New YorkPengantar Robotika – Universitas Gunadarma 46

Kinematic model for car-like robot• Control Input• Driving type: Forward wheel drive

1u

X

Y

θ

ϕ

},{},{},,,{

21

21

ττ

ϕθ

uuyx

yx,

: forward vel

: steering vel2u

Page 47: Mobot: Mobile Robot - Gunadarma

The City College of New YorkPengantar Robotika – Universitas Gunadarma 47

Kinematic model for car-like robot

2

1

1

1

tan

sincos

uluuyux

=

=

=

=

ϕ

ϕθ

θ

θ

!

!

!

!

X

Y

θ

ϕ

yx,

0cossin =− θθ yx !!

non-holonomic constraint:

: forward velocity

: steering velocity1u2u

Page 48: Mobot: Mobile Robot - Gunadarma

The City College of New YorkPengantar Robotika – Universitas Gunadarma 48

Dynamic Model

⎟⎟⎠

⎞⎜⎜⎝

⎟⎟⎟

⎜⎜⎜

+⎟⎟⎟

⎜⎜⎜

=⎟⎟⎟

⎜⎜⎜

⎟⎟⎟

⎜⎜⎜

2

1

100

0sincos

0cossin

00

0

0

00

ff

yx

Im

mθθ

λθθ

θ!!!!

!!

X

Y

θ

ϕ

yx,• Dynamic model

Page 49: Mobot: Mobile Robot - Gunadarma

The City College of New YorkPengantar Robotika – Universitas Gunadarma 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: Mobot: Mobile Robot - Gunadarma

The City College of New YorkPengantar Robotika – Universitas Gunadarma 50

TerimakasihMateri Selanjutnya : Robot Sensing