03_wheeledlocomotion

Upload: mbede

Post on 03-Apr-2018

214 views

Category:

Documents


0 download

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