Contrôle de la locomotion artificielle: Une approche par commande prédictive sans trajectoire de...

Contrôle de la locomotion artificielle:Une approche par commande prédictive

sans trajectoire de référence

Philippe Poignet (LIRMM, Montpellier) Christine Azevedo (INRIA, Grenoble)

Context | Human locomotion features | Control approach | Conclusions & perspectives

Context

1. Biped robots

2. Locomotion control

3. Guidelines of the research

ASIMO & P3Honda Motor Co

WabianWaseda University

JohnnieTUM

1. Some realisations

1. Biped robots

Mobility environment perception & understandingadaptationautonomy

Biped stability skills (contacts, impacts)robustness to disturbancesfalls

2. General issues

1. Biped robots

Mobile robots: wheeled, caterpillar, legged

Legged robots: n-legs, biped

cluttered environments

human facilities (stairs, corridors…)

- trunk + pelvis + 2 legs

- 15 active joints:

7 sagittal: ankles, knees, hips, trunk 5 frontal: ankles, hips, trunk 3 horizontal: hips, trunk

- 105 kg - 180 cm

- human proportions

BIP was designed and built in collaboration between INRIA and LMS Poitiers

1. Biped robots

3. BIP: the anthropomorphic robot

Context

1. Biped robots

Pre-computed reference trajectory tracking

- anthropomorphic joint trajectories [vukobratovic et al 01]

- torque trajectories [goswami et al 96], [pratt & pratt et al 01]

- optimal trajectories [chevallereau et al 97], [chessé & bessonnet 01]

Pre-computed movements non-adaptable to environment and events changes

1. State of the art

ControlReference trajectories

Desired behaviour Real behaviour

Sensors information

1. State of the art (2)

On-line walking adaptation

- ZMP compensation [park99]

- discrete set of trajectories [denk01]

large set of trajectories needed + switches

- continuous set of parameterized trajectories [[wieber00][chevallereau02]

defining the set

- learning techniques [kun96]

- neuro-fuzzy [meyret02]

no explicit model

Context

1. Biped robots

1. no trajectory tracking

2. high adaptability + + no algorithm switches

3. robustness to disturbances

searching inspiration from human walking without mimicking

ControlReference trajectories

Desired behaviour Real behaviour

Sensors information

New approach to biped locomotion control

1. Locomotion structure (biomechanics)

2. Locomotion control (neurosciences)

3. Conclusion: some principles

Human locomotion featuresContext | Human locomotion features | Control approach | Conclusions & perspectives

1. stationary / transient gait (stop, starting,…) 2. stationary walk: symmetric + cyclic3. phases : support and swing

4. supports: single support and double support5. variable patterns (tiredness, learning…)6. objective oriented optimization of displacements

(metabolic energy minimization in stationary walk)

[vaughan et al 92]

1. Locomotion structure

1. Walking activity

2. Equilibrium

Static equilibrium: CoM projection within support base (posture, difficult situations, working at a work station…)

Dynamic equilibrium: normal walking fall forward onto the foot receiving the body‘s weight. Definition remains an open problem for bipedal systems with unilateral constraints.

1. Control process

musclesactuators

skeletonsystem

SensorsSensors

CNScontroller

intentionactivation force movement

environment

disturbances

1. Control process

musclesactuators

skeletonsystem

SensorsSensors

CNScontroller

intentionactivation force movement

environment

disturbances

2. Control properties

- No reference trajectory tracking- Anticipation and prediction: CNS internal models planning- Strategy: library of objective oriented solutions- Learning: taking lessons from past situations

Unsuccessful approaches in exploiting movements invariants.

- Consider both stationary and transient walk - Optimal gaits / criteria adapted to goal (endurance, speed)- Consider both static and dynamic equilibrium

- No reference trajectory tracking- Perception- Anticipation and prediction- Consider internal and external constraints to ensure feasibility

and equilibrium.

idea: use a model predictive control approach

1. Modelling

2. Model predictive control

3. Application of MPC to locomotion control

4. Simulation results

5. Conclusions

Control approachContext | Human locomotion features | Control approach | Conclusions & perspectives

Use of a model predictive control (MPC) approach:

1. Modelling

1. Continuous dynamics

joint positions

robot orientation and position in 3D space

1. Lagrange formulation

cBG(q)q)qN(q,qM(q)

[wieber00] [genot98] [pfeiffer96]

Depending on the contacts the system can be underactuated

1. Modelling

1. Continuous dynamics (1)

cBG(q)q)qN(q,qM(q)

2. Ground contact

=(n,t)T

support force

1. Modelling

cBG(q)q)qN(q,qM(q)

2. Ground contact

closure constraint: 0Φ

ΦBΓGqNqM

=(n,t)T

support force

1. Modelling

Tn λCλCBΓGqNqM

=(n,t)T

1. Modelling

Tn λCλCBΓGqNqM

0qCqCΦ nnn unilateral constraint

=(n,t)T

1. Modelling

Tn λCλCBΓGqNqM

=(n,t)T

1. Modelling

Tn λCλCBΓGqNqM

0Φλ nTn

complementaritycondition

=(n,t)T

0)Φ 0(Φ nn

1. Modelling

Tn λCλCBΓGqNqM

0Φλ nTn

complementaritycondition

0qCqCΦ ttt no-slipping assumption(friction cone )nt 0||||

=(n,t)T

0)Φ 0(Φ nn

1. Modelling

2. Impact dynamics

1. Modelling

2. Impact dynamics

Impact velocity jump: qq

=(n,t)T

1. Modelling

2. Impact dynamics

=(n,t)T

Impulsive force

1. Modelling

2. Impact dynamics

Tn ΛCΛC)qqM(q)(

=(n,t)T

1. Modelling

2. Impact dynamics

Tn ΛCΛC)qqM(q)(

0qCnn no take-off assumption

=(n,t)T

1. Modelling

2. Impact dynamics

Tn ΛCΛC)qqM(q)(

no-slipping assumption(friction cone )n0t Λμ||Λ||

no take-off assumption

0qC tt

=(n,t)T

1. Modelling

2. Impact dynamics

Tn ΛCΛC)qqM(q)(

qC)CM(CΛ

)ΛCΛ(CMqq

no-slipping assumption(friction cone )n0t Λμ||Λ||

no take-off assumption

0qC tt

=(n,t)T

1. Modelling

5. Conclusions

1. Control without predictive horizon

Example: elevation of the swing ankle

k k+1 k+2

k+1 k+2

Obstacledetection

k+2 k+3

ObstacleExample: elevation of the swing ankle

Obstacle

No solution !!!

2. Control with predictive horizon

k k+1 k+Nc

Obstacledetection

k k+1 k+Nc

Obstacledetection

k k+1 k+Nc

Obstacledetection

sliding horizon

k+1 k+Nc+1

Obstacledetection

k+1 k+2 k+Nc+2

3. Description

k|Nk...|1k|0Nkk|Nk...|1k|0

]x,x,x[ x ]u,u,u[uP

Control horizon

k k+1 k+Nc k+Np

Predictive horizon

4. Formal problem

]N , [0l X, x

]N , [0l U,u

xx )u,f(x x:tosubject

)u,J(xmin :solve

kk|0kl|kl|k|1l

}xxx/{xX

}uuu/u{U

maxkmink

[allgöwer99]

4. Formal problem

]N , [0l X, x

]N , [0l U,u

)u,J(xmin :solve

kk|0kl|kl|k|1l

}xxx/{xX

}uuu/u{U

maxkmink

function of inputand state (trajectory trackingor regulation)[allgöwer99]

controlhorizon

predictivehorizon

5. State of the art

Linear systems:

- Widely used in linear slow systems (GPC, PFC) [richalet93]

- Many stability proofs results [garcia89][boucher96][rawlings93]

Nonlinear systems:

- Usually used in slow systems- Stability proofs / strong assumptions: infinite horizon [mayne90][meadow93], dual mode [michalska93][chisci96], terminal equality constraint [chen82][alamir94], quasi infinite horizon [garcia89][denicolao97]

1. Modelling

5. Conclusions

1. Problem

}xxx/{xX

}uuu/u{U

maxkmink

]N , [0lX, x

]N , [0lU,u

)u,J(xmin :solve

kk|0k|1lkl|k|1l

function of inputand state (trajectory trackingor regulation)

2. From human observation to problem specification

Walking = shift the body in a standing posture without falling

1) Criteria: gait optimization / objective of the walk

2) Constraints

i) Standing posture maintain the CoM height

ii) Locomotion rhythm forward moving of CoM

iii) static/dynamic equilibrium contact forces control

iv) adaptation to environment ground and obstacle avoidance

iinequality constraints expressions ?

[hurmuzlu93]

3. Example of criteria and constraints specification

Criteria:

Constraints:

1) Dynamics: continuous + impacts

2) Actuator limits :

3) Joint limits:

4) Standing posture:

5) Forward progression:

6) Ground avoidance:

7) Dynamic balance:

maximin qqq maximin uuu

coeff) frict. (μ .λμ||λ|| 0n0t

h yCoM

)f(xy ankleankle vvxv maxCoMmin Expressed in

output space

Tkl|k ΓΓJ

1. Modelling

4. Some simulation results

5. Conclusions

Different simulation results have been tested, 3 of them are presented here:

1. One dynamic step with BIP2. Static walk on flat ground and stairs3. Dynamic steps with RABBIT

Simulation conditions:

sagittal plane sampling period: 10 ms algorithm: SQP software: matlab

1. One dynamic step

2D Dynamic walkingBIP - 6 actuators – 9 dofNc=3.Te= 30 ms

1. One dynamic step

2D Dynamic walkingBIP - 6 actuators – 9 dofNc=3.Te= 30 ms

1. One dynamic step

2D Dynamic walkingBIP - 6 actuators – 9 dof

Nc=3.Te= 30 ms

2. Auto-adaptation to environment

2D Static walkingBIP - 6 actuators – 6 dof

Nc=5.Te= 50 ms

3. Application to an under actuated robot structure

2D Dynamic walkingRABBIT – 4 actuators – 7dof

Nc=3.Te= 30 ms

5. Conclusions

Exploration of a new approach to robot dynamic walking:

MPC + constraints

+ no reference trajectory generation and tracking

+ auto-adaptation to environment changes (no switches)

+ integration of internal and external constraints

+ adaptable to different robots structures

- computation times

- stability definition and proof

- walking activity translation into inequality constraints

Contrôle de la locomotion artificielle: Une approche par commande prédictive sans trajectoire de...

Documents

Transcript of Contrôle de la locomotion artificielle: Une approche par commande prédictive sans trajectoire de...

Reference Governor Applications - LIRMM

Visual Analytics - HAL - LIRMM - CNRS

Décompositions et unicité - LIRMM

Analyse Prédictive et Modélisation

Commande Prédictive

Surgical Robots in Space - LIRMM

12 poignet - fractures

5. Applications web - LIRMM

Recueild'exercices(aveccorrigés) - LIRMM

Poignet - Fractures

ANATOMIE DU POIGNET - orthopedie-lyon.frorthopedie-lyon.fr/wp-content/uploads/2012/02/Anatomie-du-poignet... · Face antérieure du poignet Face inférieure formée par le retinaculum

Séminaire - Justice Prédictive · Intelligence arti!cielle : Justice prédictive et réforme de la justice 5 Section 1. Les potentiels béné!ces de la justice prédictive A. Permettre

Diagnostic d’un poignet douloureux.

Introduction JEE 5 - Lirmm

Module Image - LIRMM

7 - Poignet rhumatoïde

Commande Prédictive Généralisée d’une Machine

Commande prédictive : de la théorie à l’application · Approche GPC (Commande Prédictive Généralisée) Cas d’étude Commande prédictive avec contraintes Approche MPC (Model

Microelectronics Department - Lirmm

1/21 Partie 3 - LIRMM