Terramechanics Based Analysis and Motion Control of Rovers...

33
Terramechanics Based Analysis and Motion Control of Rovers on Simulated Lunar Soil Kazuya Yoshida and Keiji Nagatani Dept. Aerospace Engineering Graduate School of Engineering Tohoku University, Sendai, Japan ICRA '07 Space Robotics Workshop 14 April, 2007

Transcript of Terramechanics Based Analysis and Motion Control of Rovers...

Page 1: Terramechanics Based Analysis and Motion Control of Rovers ...ewh.ieee.org/conf/icra/2007/workshops/SpaceRobotics/07Yoshida/IC… · G. Ishigami, A. Miwa, K. Nagatani and K. Yoshida

Terramechanics Based Analysis and Motion Control of Rovers on Simulated Lunar Soil

Kazuya Yoshida and Keiji Nagatani

Dept. Aerospace EngineeringGraduate School of Engineering

Tohoku University, Sendai, Japan

ICRA '07 Space Robotics Workshop14 April, 2007

Page 2: Terramechanics Based Analysis and Motion Control of Rovers ...ewh.ieee.org/conf/icra/2007/workshops/SpaceRobotics/07Yoshida/IC… · G. Ishigami, A. Miwa, K. Nagatani and K. Yoshida

Apollo mission © NASA

Page 3: Terramechanics Based Analysis and Motion Control of Rovers ...ewh.ieee.org/conf/icra/2007/workshops/SpaceRobotics/07Yoshida/IC… · G. Ishigami, A. Miwa, K. Nagatani and K. Yoshida

Increasing Interest in Lunar Missions

Robotic precursor missions Autonomous landingSurface locomotionCore sampling and excavationConstruction

International cooperation

Exploration of the areas where Apollo or Luna did not goIn-situ resource utilizationOutpost for human habitation on MoonTechnology demonstration and crew training for future Mars expeditions

Page 4: Terramechanics Based Analysis and Motion Control of Rovers ...ewh.ieee.org/conf/icra/2007/workshops/SpaceRobotics/07Yoshida/IC… · G. Ishigami, A. Miwa, K. Nagatani and K. Yoshida

Design and Control Issuesfor Lunar/Mars Rovers

Mobility on Natural TerrainTraversability (Rocky obstacles, Slope climbing/traversing))Navigation (Teleoperation v.s. Autonomy)Positioning, Localization, Map Generation…In-Situ AnalysisSample Acquisition and Handling, PreprocessingPower, CommunicationVersatility to Hostile Environment(Thermal, Dust.. eg. –170~+130℃ on Moon)

Page 5: Terramechanics Based Analysis and Motion Control of Rovers ...ewh.ieee.org/conf/icra/2007/workshops/SpaceRobotics/07Yoshida/IC… · G. Ishigami, A. Miwa, K. Nagatani and K. Yoshida

Rover Test Beds since 1997

Page 6: Terramechanics Based Analysis and Motion Control of Rovers ...ewh.ieee.org/conf/icra/2007/workshops/SpaceRobotics/07Yoshida/IC… · G. Ishigami, A. Miwa, K. Nagatani and K. Yoshida

Research Focus on Lunar/Planetary Rovers

Mechanical DesignChoice of locomotion mode: wheels, tracks, or legsChassis design

Traction ControlMakes difference in performanceSlip on loose soil

NavigationPath planning with stability & slip criteriaPath following with slip compensation

Page 7: Terramechanics Based Analysis and Motion Control of Rovers ...ewh.ieee.org/conf/icra/2007/workshops/SpaceRobotics/07Yoshida/IC… · G. Ishigami, A. Miwa, K. Nagatani and K. Yoshida

Experiment of Slip-Based Traction Control

• Without Slip control With Slip control

Page 8: Terramechanics Based Analysis and Motion Control of Rovers ...ewh.ieee.org/conf/icra/2007/workshops/SpaceRobotics/07Yoshida/IC… · G. Ishigami, A. Miwa, K. Nagatani and K. Yoshida

Even though the rover travels slowly, the phenomena around the wheels are dynamic…

Page 9: Terramechanics Based Analysis and Motion Control of Rovers ...ewh.ieee.org/conf/icra/2007/workshops/SpaceRobotics/07Yoshida/IC… · G. Ishigami, A. Miwa, K. Nagatani and K. Yoshida

Side slip phenomena is very interesting,which should studied well.

Page 10: Terramechanics Based Analysis and Motion Control of Rovers ...ewh.ieee.org/conf/icra/2007/workshops/SpaceRobotics/07Yoshida/IC… · G. Ishigami, A. Miwa, K. Nagatani and K. Yoshida

Slip is a key state variable

Slip Ratio

( )

( )⎪⎪

⎪⎪

<−

>−

=

xx

x

xx

vrv

vr

vrr

vr

s

ωω

ωω

ω S > 0 while accelerating

S < 0 while braking

Page 11: Terramechanics Based Analysis and Motion Control of Rovers ...ewh.ieee.org/conf/icra/2007/workshops/SpaceRobotics/07Yoshida/IC… · G. Ishigami, A. Miwa, K. Nagatani and K. Yoshida

Slip Angle

Page 12: Terramechanics Based Analysis and Motion Control of Rovers ...ewh.ieee.org/conf/icra/2007/workshops/SpaceRobotics/07Yoshida/IC… · G. Ishigami, A. Miwa, K. Nagatani and K. Yoshida

Two Modeling Approaches for the Studyof Soil Behavior under a Wheel

Discrete Element Method (DEM)

Continuum ModelingBekker 1956Wong 1978

Page 13: Terramechanics Based Analysis and Motion Control of Rovers ...ewh.ieee.org/conf/icra/2007/workshops/SpaceRobotics/07Yoshida/IC… · G. Ishigami, A. Miwa, K. Nagatani and K. Yoshida

Traction Model for a Rigid Tire on Soft Soil

( ) ( ){ }

( ) ( ){ } θθθσθθτ

θθθτθθσ

θ

θ

θ

θ

drbDP

drbW

f

r

f

r

∫−=

+=

sincos

sincos

( ) ( )( )( ) ( )( )[ ]θθθθ

ϕσθτ

sinsin1

1tan)(

−−−−−=

−+=

ff

sa

skrsa

ec

(Bekker 1956, Wong 1978)

∫= f

r

dbrTθ

θθθτ )(2

Page 14: Terramechanics Based Analysis and Motion Control of Rovers ...ewh.ieee.org/conf/icra/2007/workshops/SpaceRobotics/07Yoshida/IC… · G. Ishigami, A. Miwa, K. Nagatani and K. Yoshida

Traction Model for a Rigid Tire on Soft Soil

( ) ( ){ }

( ) ( ){ } θθθσθθτ

θθθτθθσ

θ

θ

θ

θ

drbDP

drbW

f

r

f

r

∫−=

+=

sincos

sincos

( ) ( )( )( ) ( )( )[ ]θθθθ

ϕσθτ

sinsin1

1tan)(

−−−−−=

−+=

ff

sa

skrsa

ec

(Bekker 1956, Wong 1978)

∫= f

r

dbrTθ

θθθτ )(2 Key parameters:

c : soil cohesionϕ : friction anglek : shear deformation

modulus

Page 15: Terramechanics Based Analysis and Motion Control of Rovers ...ewh.ieee.org/conf/icra/2007/workshops/SpaceRobotics/07Yoshida/IC… · G. Ishigami, A. Miwa, K. Nagatani and K. Yoshida

Angle of Internal Friction

Shear force

Normal force

φ

C

Page 16: Terramechanics Based Analysis and Motion Control of Rovers ...ewh.ieee.org/conf/icra/2007/workshops/SpaceRobotics/07Yoshida/IC… · G. Ishigami, A. Miwa, K. Nagatani and K. Yoshida

Modeling of Side Forces : Fy

suy FFF +=θθτ

θ

θdrbF f

ryu ∫= )(

θθθ

θdhrRF f

rbs )cos( −= ∫

(Yoshida & Ishigami,IROS2004)

Page 17: Terramechanics Based Analysis and Motion Control of Rovers ...ewh.ieee.org/conf/icra/2007/workshops/SpaceRobotics/07Yoshida/IC… · G. Ishigami, A. Miwa, K. Nagatani and K. Yoshida

Single Wheel Test Bed

0 – 0.8Slip RatioDiameter:184[mm], Width:107[mm]Wheel

Lunar Regolith SimulantSoil0 – 45 degreesSlip Angle

Page 18: Terramechanics Based Analysis and Motion Control of Rovers ...ewh.ieee.org/conf/icra/2007/workshops/SpaceRobotics/07Yoshida/IC… · G. Ishigami, A. Miwa, K. Nagatani and K. Yoshida
Page 19: Terramechanics Based Analysis and Motion Control of Rovers ...ewh.ieee.org/conf/icra/2007/workshops/SpaceRobotics/07Yoshida/IC… · G. Ishigami, A. Miwa, K. Nagatani and K. Yoshida

Experimental Results (longitudinal force)

Slip angle : Small

Slip angle : Large

(Ishigami, Nagatani, Yoshida, J. of Field Robotics, 2007)

Page 20: Terramechanics Based Analysis and Motion Control of Rovers ...ewh.ieee.org/conf/icra/2007/workshops/SpaceRobotics/07Yoshida/IC… · G. Ishigami, A. Miwa, K. Nagatani and K. Yoshida

Experimental Results (side force)

Slip angle : Small

Slip angle : Large

(Ishigami, Nagatani, Yoshida, J. of Field Robotics, 2007)

Page 21: Terramechanics Based Analysis and Motion Control of Rovers ...ewh.ieee.org/conf/icra/2007/workshops/SpaceRobotics/07Yoshida/IC… · G. Ishigami, A. Miwa, K. Nagatani and K. Yoshida

Multibody Dynamics with a Moving Base

+ Multi Contact,Gravity

Equation of Motion

⎥⎥⎥⎥

⎢⎢⎢⎢

+

⎥⎥⎥⎥

⎢⎢⎢⎢

=+

⎥⎥⎥⎥⎥

⎢⎢⎢⎢⎢

6

2

1

0

0

0

0

f

ff

J

nnNF

C

v

H T

s

w M

&&

&&

&

&

φ

θ

ω

0ω0v

mi, Ii

VehicleDynamics

Page 22: Terramechanics Based Analysis and Motion Control of Rovers ...ewh.ieee.org/conf/icra/2007/workshops/SpaceRobotics/07Yoshida/IC… · G. Ishigami, A. Miwa, K. Nagatani and K. Yoshida

Slope Climbing Experiment Slope Climbing Experiment at JAXA, Aerospace Research Centerat JAXA, Aerospace Research Center

Lunar Regolith Simulantarbitrary inclination 0-30 deg or over

Page 23: Terramechanics Based Analysis and Motion Control of Rovers ...ewh.ieee.org/conf/icra/2007/workshops/SpaceRobotics/07Yoshida/IC… · G. Ishigami, A. Miwa, K. Nagatani and K. Yoshida

Slope Traversing Experiment Slope Traversing Experiment at JAXA, Aerospace Research Centerat JAXA, Aerospace Research Center

Lunar Regolith Simulantarbitrary inclination 0-30 deg or over

Red is simulation, blue is experimentExperimental trace

Page 24: Terramechanics Based Analysis and Motion Control of Rovers ...ewh.ieee.org/conf/icra/2007/workshops/SpaceRobotics/07Yoshida/IC… · G. Ishigami, A. Miwa, K. Nagatani and K. Yoshida

Research Focus on Lunar/Planetary Rovers

Mechanical DesignChoice of locomotion mode: wheels, tracks, or legsChassis design

Traction ControlMakes difference in performanceSlip on loose soil

NavigationPath planning with stability & slip criteriaPath following with slip compensation

Page 25: Terramechanics Based Analysis and Motion Control of Rovers ...ewh.ieee.org/conf/icra/2007/workshops/SpaceRobotics/07Yoshida/IC… · G. Ishigami, A. Miwa, K. Nagatani and K. Yoshida

Path Planning IssuePath Planning IssueEvaluate candidate paths by dynamic simulation Evaluate candidate paths by dynamic simulation

which takes both longitudinal and lateral slip which takes both longitudinal and lateral slip effects into account .effects into account .

Page 26: Terramechanics Based Analysis and Motion Control of Rovers ...ewh.ieee.org/conf/icra/2007/workshops/SpaceRobotics/07Yoshida/IC… · G. Ishigami, A. Miwa, K. Nagatani and K. Yoshida

Model for Path Following Control

Control objectivesDistance errorOrientation errorVehicle orientation angleDesired orientation angle

Page 27: Terramechanics Based Analysis and Motion Control of Rovers ...ewh.ieee.org/conf/icra/2007/workshops/SpaceRobotics/07Yoshida/IC… · G. Ishigami, A. Miwa, K. Nagatani and K. Yoshida

Sideslip Compensation

Control objectiveSideslip is measured by slip angle, .

Page 28: Terramechanics Based Analysis and Motion Control of Rovers ...ewh.ieee.org/conf/icra/2007/workshops/SpaceRobotics/07Yoshida/IC… · G. Ishigami, A. Miwa, K. Nagatani and K. Yoshida

Slope Traversal (10 deg)

Video presentation is 4-time faster than the real motionWith path-following control and slip compensation

Page 29: Terramechanics Based Analysis and Motion Control of Rovers ...ewh.ieee.org/conf/icra/2007/workshops/SpaceRobotics/07Yoshida/IC… · G. Ishigami, A. Miwa, K. Nagatani and K. Yoshida

Conditions of Experiments

15.0Approx. total weight of the rover [kg]

0.16-0.17Control loop cycle time [s]

0.30Wheel angular velocity [rad/sec]

113.0Wheel radius (including paddles) [mm]

[email protected] [m]Sensor accuracy of SLC [mm]

5.0 / 7.5 / 10.0Slope angle [deg]

Page 30: Terramechanics Based Analysis and Motion Control of Rovers ...ewh.ieee.org/conf/icra/2007/workshops/SpaceRobotics/07Yoshida/IC… · G. Ishigami, A. Miwa, K. Nagatani and K. Yoshida

Experimental result (10 deg slope)

Page 31: Terramechanics Based Analysis and Motion Control of Rovers ...ewh.ieee.org/conf/icra/2007/workshops/SpaceRobotics/07Yoshida/IC… · G. Ishigami, A. Miwa, K. Nagatani and K. Yoshida

Summary

In this presentation, the state-of-art study on terramechanics based analysis and motion control of rovers are overviewed.Models for wheel traction mechanics on loose soil is focused, where slip is a key state variable to describe the traction performance.Experimental data of the traction measurement on simulated lunar soil is presented for various slip ratios and slip angles.An example is illustrated for the path following control of a rover with compensating the side slips.

Page 32: Terramechanics Based Analysis and Motion Control of Rovers ...ewh.ieee.org/conf/icra/2007/workshops/SpaceRobotics/07Yoshida/IC… · G. Ishigami, A. Miwa, K. Nagatani and K. Yoshida

References

Bekker, M. G. (1960), Off-The-Road Locomotion,The University of Michigan Press.Wong, J. Y. (1978), Theory of Ground Vehicles,John Wiley & Sons.Iagnemma, K. and Dubowsky, S. (2004), Mobile Robots in Rough Terrain : Estimation, Motion Planning, and Control with Application to Planetary Rovers (Springer Tracts in Advanced Robotics 12), Springer.G. Ishigami, A. Miwa, K. Nagatani and K. Yoshida (2007) “Terramechanics-based Model for Steering Maneuver of Planetary Exploration Rovers on Loose Soil”Journal of Field Robotics, vol.24, no.3, pp.233-250.

Page 33: Terramechanics Based Analysis and Motion Control of Rovers ...ewh.ieee.org/conf/icra/2007/workshops/SpaceRobotics/07Yoshida/IC… · G. Ishigami, A. Miwa, K. Nagatani and K. Yoshida

The Space Robotics Lab.Dept. of Aerospace Engineering

Tohoku University, JAPANDirected by Prof. Kazuya Yoshida

[email protected]://www.astro.mech.tohoku.ac.jp/home-e.html

Free-Flying Space Robot

Planetary Exploration Rovers Asteroid Sampling

Robotic Systems on ISS

The SPACE ROBOTICS

Lab.