A Hierarchical Design Methodology for Multibody Systems with - - PowerPoint PPT Presentation

a hierarchical design methodology for multibody systems
SMART_READER_LITE
LIVE PREVIEW

A Hierarchical Design Methodology for Multibody Systems with - - PowerPoint PPT Presentation

A Hierarchical Design Methodology for Multibody Systems with Frictional Contacts Vijay Kumar GRASP Lab Mechanical Engineering and Applied Mechanics Computer and Information Science University of Pennsylvania Joint work with Bharath


slide-1
SLIDE 1

University of Pennsylvania

1

GRASP

A Hierarchical Design Methodology for Multibody Systems with Frictional Contacts

Vijay Kumar

GRASP Lab Mechanical Engineering and Applied Mechanics Computer and Information Science University of Pennsylvania

Jong-Shi Pang

Mathematical Sciences Rennselaer Polytechnic Institute

Peng Song

Mechanical Engineering Rutgers University

Bharath Mukundakrishnan

GRASP Laboratory University of Pennsylvania

Jeffrey Trinkle

Computer Science Rennselaer Polytechnic Institute

Jonathan Fink

GRASP Lab, Penn ECS, RPI Joint work with

Steve Berard

Computer Science Rennselaer Polytechnic Inst.

slide-2
SLIDE 2

University of Pennsylvania

2

GRASP

  • 1. Decentralized Multirobot Manipulation

Motion plans derived from geometric models

Can we generalize to dynamic models?

Pereira, Campos and Kumar, WAFR 02

slide-3
SLIDE 3

University of Pennsylvania

3

GRASP

  • 2. Part Feeding, Assembly

Design with geometric and kinematic models is possible. Dynamic models are necessary.

[Boothroyd, 1968] [Kraus, 2001]

slide-4
SLIDE 4

University of Pennsylvania

4

GRASP

  • 3. Micro Manipulation

 100 µ dia probe attached to10g load cell  0.4mm x 0.8mm part assembly

Configuration A Configuration B Test Fixture

2 mm 1.5 mm

slide-5
SLIDE 5

University of Pennsylvania

5

GRASP

Design Process or Plan Task

Dynamical System

 Intermittent contacts  Contact state transitions  Multiple contacts

Fundamental difficulties

 Static indeterminacy with traditional models (jamming,

wedging)

 Whitney, Dupont

 No consistent models for frictional impacts

 Goldsmith, Pfeiffer, Keller, Brach, Wang and Mason, Stronge, Chatterjee and Ruina

 No unified treatment for design and planning

slide-6
SLIDE 6

University of Pennsylvania

6

GRASP

Outline

  • 1. Background

 Contact models  Normal and tangential compliance  Frictional contacts  Time-stepping methods

  • 2. Hierarchical Approach

 Models at different levels of fidelity  Abstraction and model reduction  Example

  • 3. Algorithms for design optimization

 Randomized algorithms  Time-stepping algorithms

  • 4. Case Study: Part Feeder

 Modeling  Iterative design process

slide-7
SLIDE 7

University of Pennsylvania

7

GRASP

Systems with Frictional Contacts

Friction

T O c T O cT cO λF λF µλN

slide-8
SLIDE 8

University of Pennsylvania

8

GRASP

Compliant Contact Models

Undeformed Shell Viscoelastic Viscoelastic Layer Layer Rigid Rigid Core Core Rigid Rigid Core Core Deformed Shell N N T

T

δ

N

δ

N

ϕ

T

ϕ slip

S R i T i T i T i T i T i T i N i N i N i N i N i N

n n i g f g f + = + = + = , , 1 ) , ( ) ( ) , ( ) (

, , , , , , , , , , , ,

L & & δ δ δ λ δ δ δ λ

Gross motion Fine deformation

slide-9
SLIDE 9

University of Pennsylvania

9

GRASP

More Generally… Elastic Bodies

Linear Elastic, Counterformal Contacts

n

Ø i

n i

δ

A B

deformed undeformed

slide-10
SLIDE 10

University of Pennsylvania

10

GRASP

Advantages of Compliant Contact Model

 Proof of uniqueness and existence  Contact forces can always be determined  More realistic friction model

 Tangential compliance  Gross slip is preceded by small local deformations  Hysteresis

Disadvantages

 Identification of parameters  Computational time

u λΤ

Coulomb actual

u λΤ

rigid linear elastic

slide-11
SLIDE 11

University of Pennsylvania

11

GRASP

Time Stepping Model

Equations of Motion

[Anitescu, Pang, Potra, Stewart, and Trinkle]

slide-12
SLIDE 12

University of Pennsylvania

12

GRASP

Extension 1: Compliant Models

deformations separation/slip relative gross motion

Constitutive law Contact compliance

slide-13
SLIDE 13

University of Pennsylvania

13

GRASP

Extension 2: Frictional Contact

(cf. Peng Song’s talk tomorrow)

slide-14
SLIDE 14

University of Pennsylvania

14

GRASP

Compliant Frictional Contacts: Technical Results

Single frictional contact [Song and Kumar, 2003]

 For a single contact with a lumped compliance model, a unique

trajectory always exists

Multiple frictional contacts [Song, Pang and Kumar, 2003]

 A discrete-time solution trajectory always exists  There exists a µ*>0, such that if µ*> µi>0, a unique trajectory

exists

 Under “certain conditions” the discrete time trajectory

converges to converges to that obtained by using the rigid body model time-stepping algorithm

slide-15
SLIDE 15

University of Pennsylvania

15

GRASP

Example

 Linear, visco-elastic contacts  Initial value problem  Five springs at each contact  m = 0.05 kg.  ε=10-10 N/m2  Δt~10-4 seconds

slide-16
SLIDE 16

University of Pennsylvania

16

GRASP

Example (continued)

slide-17
SLIDE 17

University of Pennsylvania

17

GRASP

Design Optimization

Design Optimization

External inputs

  • r disturbances

Difficulties: (1) high dimensionality; (2) non smoothness

slide-18
SLIDE 18

University of Pennsylvania

18

GRASP

Abstractions and hierarchy

System S1 System S2 Transformation S2 is an abstraction of S1 if for any δ > 0 and all inputs u(t), there exists v(t) such that for all x* is reachable for a given design implies z*=h(x*) is reachable for the same design

S1 S2

slide-19
SLIDE 19

University of Pennsylvania

19

GRASP

Example of Abstraction

Kinematic (first order model) Geometric (zeroth order model) More generally…

 Dynamics with compliance  Rigid body dynamic  Kinematic (quasi-static)  Geometric

slide-20
SLIDE 20

University of Pennsylvania

20

GRASP

Case Study: Design of a Part Feeder

slide-21
SLIDE 21

University of Pennsylvania

21

GRASP

Definitions

 State space

Original state space augmented by all parameters

 Inputs/disturbances

Geometric model - virtual input Dynamic model - gravitational force

 Design space

Initial conditions (original state space) + parameter choices

 Search space

x2

Focus on “search” and “satisfaction” rather than optimization

x1

slide-22
SLIDE 22

University of Pennsylvania

22

GRASP

Explorating the Design Space: The RRT method

Explore motions from the chosen vertex by trying all possible inputs

initial state  random state  random state

Grow the tree until a solution is found or the no. of vertices reaches a certain value

Choose the state “closest" to the random state, Xnew. Find the state, Xnear, “closest” to the random state among all explored state s. Explore motions from the chosen vertex by trying all possible inputs. Choose the state closest to the random state, Xnew

Key: A vertex with a larger Voronoi region has higher probability of being chosen as Xnear

[Lavalle and co-workers, 1999-2003]

slide-23
SLIDE 23

University of Pennsylvania

23

GRASP

xinit , qinit Rapidly Exploring Random Tree

Target set (e.g., successful assembly)

slide-24
SLIDE 24

University of Pennsylvania

24

GRASP

Rapidly Exploring Random Tree xinit , qinit xrand , qrand

slide-25
SLIDE 25

University of Pennsylvania

25

GRASP

Rapidly Exploring Random Tree xinit , qinit xrand , qrand xnear , qnear

slide-26
SLIDE 26

University of Pennsylvania

26

GRASP

Rapidly Exploring Random Tree xinit , qinit xrand , qrand

slide-27
SLIDE 27

University of Pennsylvania

27

GRASP

xinit , qinit xrand , qrand xnew , qnew Rapidly Exploring Random Tree

slide-28
SLIDE 28

University of Pennsylvania

28

GRASP

Coverage and Growth

New trees are started when the growth rate slows below a specified threshold. Plots show 8 designs being explored.

slide-29
SLIDE 29

University of Pennsylvania

29

GRASP

Red (thick) geometrically feasible successful

  • path. Green (thin) geometrically feasible

trajectories.

RRT Generated from the Geometric Model with a Given Design

slide-30
SLIDE 30

University of Pennsylvania

30

GRASP

Example: different chute angles

Sampling the 12-Dimensional Design Space: Geometric Model

slide-31
SLIDE 31

University of Pennsylvania

31

GRASP

Exploring the Design Space: Geometric Model

slide-32
SLIDE 32

University of Pennsylvania

32

GRASP

Pruning the Design Space: Kinematic Model

First order model further restricts the choice of design parameters!

slide-33
SLIDE 33

University of Pennsylvania

33

GRASP

Initial Design for Dynamic Analysis

Geometric Kinematic

slide-34
SLIDE 34

University of Pennsylvania

34

GRASP

Dynamic Analysis: Inelastic Impacts

Heavy end last Heavy end first

  • 1. LCP solver, time-stepping algorithm [Stewart & Trinkle]
  • 2. No external input/disturbance

Song et al, ICRA 2004

slide-35
SLIDE 35

University of Pennsylvania

35

GRASP

Dynamic Analyis: Visco-Elastic Contacts

Visco-elastic contacts

 LCP solver, time-stepping [Song, Pang, & Kumar]  Exact detection of collisions [Esposito & Kumar]

slide-36
SLIDE 36

University of Pennsylvania

36

GRASP

Experimental Prototype

Experimental data digitized at 500 Hz., played back at 1/10 normal speed

slide-37
SLIDE 37

University of Pennsylvania

37

GRASP

Summary

  • Explore design space using a family of models
  • Simpler models are used as abstractions for

more complex models initially

  • Can incorporate uncertainty in parameters
  • Enhancement: Optimization [ICRA 04]
  • Alternative: Use “unified” (implicit, NCP) model

to solve boundary-value problem [RSS 05]

Related

(cf. Peng Song’s talk tomorrow)