Motion Planning for the On-orbit Grasping of a Tumbling Target with - - PowerPoint PPT Presentation

motion planning for the on orbit grasping of a tumbling
SMART_READER_LITE
LIVE PREVIEW

Motion Planning for the On-orbit Grasping of a Tumbling Target with - - PowerPoint PPT Presentation

Motion Planning for the On-orbit Grasping of a Tumbling Target with Large Momentum Roberto Lampariello Institute of Robotics and Mechatronics German Aerospace Center (DLR) Contents Some Past and Current Space Programs Free-flying


slide-1
SLIDE 1

Motion Planning for the On-orbit Grasping of a Tumbling Target with Large Momentum

Roberto Lampariello

Institute of Robotics and Mechatronics German Aerospace Center (DLR)

slide-2
SLIDE 2

Date: 08/01/2005

Institute of Robotics and Mechatronics, DLR

2

MOVIE

Contents

  • Some Past and Current Space Programs
  • Free-flying robots and related problems
  • Motion Planning for Grasping a Tumbling

Target

  • Other applications
  • Conclusion
slide-3
SLIDE 3

Date: 08/01/2005

Institute of Robotics and Mechatronics, DLR

3

MOVIE

Past and Current Space Programs

  • ETS-VII – NASDA
  • Workshop on On-orbit Servicing of

Space Infrastructure Elements Via Automation & Robotics Technology: “Developing a Roadmap”

  • Orbital Recovery – ConeXpress
  • TECSAS
slide-4
SLIDE 4

Date: 08/01/2005

Institute of Robotics and Mechatronics, DLR

4

MOVIE

TECSAS -Technology Satellite for demonstration and Verification of Space Systems

Manipulator (7 D.O.F.) Target satellite Handle Sarah hand (CSA) Target spinning axis (ω = 4 deg/sec) Chaser satellite (thruster controlled)

CHASER TARGET

m m ≈

slide-5
SLIDE 5

Date: 08/01/2005

Institute of Robotics and Mechatronics, DLR

5

MOVIE

Free-flying robot dynamics and related problems

  • free-floating dynamics
  • free-floating vs. free-flying
  • optimal minimum may be

the free-floating solution but this is a priori unknown

slide-6
SLIDE 6

Date: 08/01/2005

Institute of Robotics and Mechatronics, DLR

6

MOVIE

Free-flying robot dynamics and related problems (2)

  • dynamic coupling - potential collision
  • external actions vs. uncertainty – require identification
  • path planning solutions are inertial parameter dependent

Non-expert Semi-expert Planned

slide-7
SLIDE 7

Date: 08/01/2005

Institute of Robotics and Mechatronics, DLR

7

MOVIE

Algorithm (Lampariello, Agrawal – ICRA ‘03) Motivation:

A free-flying robot is generally subject to:

  • spacecraft control actions
  • orbital disturbances (gravity gradient, orbital

dynamics)

  • as well as robot torques

Free-floating approximation is only valid for:

  • local motions or short operations

Require an efficient planner

slide-8
SLIDE 8

Date: 08/01/2005

Institute of Robotics and Mechatronics, DLR

8

MOVIE

Problem Definition

  • Path planning for actuated as well as for non-

actuated spacecraft degrees of freedom

  • Optimal solution for minimal energy
  • Fast solutions for realistic applications
  • Dynamically feasible solutions
  • Point-to-point maneuvers of the robot end-effector

and grasping maneuvers for a moving target

slide-9
SLIDE 9

Date: 08/01/2005

Institute of Robotics and Mechatronics, DLR

9

MOVIE

Algorithm Methodology

  • Spatial model of free-flying robot
  • Initial and final end-effector state defined in inertial

space or a given target motion

  • Final robot configuration unknown & optimized

(no BVP!)

  • Single shooting optimization problem
  • Motion planning in joint space for avoidance of

dynamic singularity problem

slide-10
SLIDE 10

Date: 08/01/2005

Institute of Robotics and Mechatronics, DLR

10

MOVIE

Equations of motion - fully actuated system

State space variables: Kinematics: Dynamics:

slide-11
SLIDE 11

Date: 08/01/2005

Institute of Robotics and Mechatronics, DLR

11

MOVIE

Modeling - rheonomic joints

Let state space variables be: and rheonomically driven variables: New equations:

  • is dependent on , a prescribed function of

time

  • order of equations = 6 - d.o.f.s of base body
  • Free-floating system:
slide-12
SLIDE 12

Date: 08/01/2005

Institute of Robotics and Mechatronics, DLR

12

MOVIE

Trajectory Planning - optimization problem: point-to-point

  • Equality constraints: initial and final end-effector

position and orientation: (kinematics)

  • Inequality constraints:

(inverse dynamics)

  • Cost function:

(base actuation)

slide-13
SLIDE 13

Date: 08/01/2005

Institute of Robotics and Mechatronics, DLR

13

MOVIE

Use of Free-floating solution

  • Local workspace - workspace with no base

actuation free-floating solution = from integration of equations of motion

  • Global workspace - all reachable free space

free-flying solution = free-floating solution + extra parametric function of base states

→ →

slide-14
SLIDE 14

Date: 08/01/2005

Institute of Robotics and Mechatronics, DLR

14

MOVIE

Trajectory Planning Solver

Optimization problem: for

  • one free parameter for each state variable

Parameterization of state variables: E.g. base position free-floating solution + polynomial order 5 Parameters:

slide-15
SLIDE 15

Date: 08/01/2005

Institute of Robotics and Mechatronics, DLR

15

MOVIE

Results - Path in local workspace

  • Initial state:
  • Desired final state:
  • Cost: 8e-3 kg m/s
  • Computational time ~

5-7 seconds

  • Initial guess:
slide-16
SLIDE 16

Date: 08/01/2005

Institute of Robotics and Mechatronics, DLR

16

MOVIE

Results - Path in global workspace

  • Desired final state:
  • Cost: 4460 kg m/s (1815

kg m/s for translational forces)

  • Computational time

~ 10 seconds

  • Initial guess: as previous
slide-17
SLIDE 17

Date: 08/01/2005

Institute of Robotics and Mechatronics, DLR

17

MOVIE

Motion Planning for Grasping a Tumbling Target

slide-18
SLIDE 18

Date: 08/01/2005

Institute of Robotics and Mechatronics, DLR

18

MOVIE

Motion Planning for Grasping a Tumbling Target (2) Three phases:

  • Approach to target
  • Tracking of grasping point – inverse kinematics
  • Grasping and stabilization

Inequality constraints:

  • As previously for the point-to-point problem
  • Inequality constraints on chaser satellite states

(collision avoidance) and end-effector forces

  • Same cost function (base actuation)
slide-19
SLIDE 19

Date: 08/01/2005

Institute of Robotics and Mechatronics, DLR

19

MOVIE

Motion Planning for Grasping a Tumbling Target (3) Motivation for path planning:

  • due to free-floating state, need to guarantee no collision
  • due to tracking phase for minimum impact, need to guarantee

feasibility of solution (joint limits, singularities, etc.)

  • due to large momentum, need to guarantee stabilization of

residual motion

  • can optimize for safety (initial chaser attitude and robot

configuration, chaser actuation, etc.) need a realistic model

slide-20
SLIDE 20

Date: 08/01/2005

Institute of Robotics and Mechatronics, DLR

20

MOVIE

Motion Planning for Grasping a Tumbling Target (4)

slide-21
SLIDE 21

Date: 08/01/2005

Institute of Robotics and Mechatronics, DLR

21

MOVIE

Other Applications – Parameter Identification

  • Modeling requirements
  • Experimental design

ETS-VII Experimental Data

slide-22
SLIDE 22

Date: 08/01/2005

Institute of Robotics and Mechatronics, DLR

22

MOVIE

Other Applications Compensation Maneuvers for a 2D platform

slide-23
SLIDE 23

Date: 08/01/2005

Institute of Robotics and Mechatronics, DLR

23

MOVIE

Conclusion - Problems and Demands

  • Path planning method provides optimal solutions for

maneuvers in local and global workspaces but is highly nonlinear

  • Collision avoidance and improve algorithm efficiency
  • Integral modeling environment for all mentioned

functionalities

  • Motion planning problems are diverse and model-

based.

slide-24
SLIDE 24

Date: 08/01/2005

Institute of Robotics and Mechatronics, DLR

24

MOVIE

Thank you!