1 / 32

Whole-body optimization based control

Whole-body optimization based control. Abderrahmane K HEDDAR CNRS-AIST Joint Robotics Laboratory (JRL), UMI3218/CRT , Tsukuba , Japan CNRS-UM2 LIRMM, Interactive Digital Humans group, Montpellier, France. Summary. Motivation Multi-contact planning

anoki
Download Presentation

Whole-body optimization based control

An Image/Link below is provided (as is) to download presentation Download Policy: Content on the Website is provided to you AS IS for your information and personal use and may not be sold / licensed / shared on other websites without getting consent from its author. Content is provided to you AS IS for your information and personal use only. Download presentation by click this link. While downloading, if for some reason you are not able to download a presentation, the publisher may have deleted the file from their server. During download, if you can't get a presentation, the file might be deleted by the publisher.

E N D

Presentation Transcript


  1. Whole-body optimization based control Abderrahmane KHEDDAR CNRS-AIST Joint Robotics Laboratory (JRL), UMI3218/CRT, Tsukuba, Japan CNRS-UM2 LIRMM, Interactive Digital Humans group, Montpellier, France

  2. Summary • Motivation • Multi-contact planning • Dynamic motion generation between contact stances • Whole-body dynamic optimization • Experiments on HRP-2 • Problems and open issues

  3. Cumbersome environments

  4. Escande, Kheddar, Miossec IEEE/RSJ IROS 2009 (video session)

  5. PG: implementation

  6. Tasks in posture generation can be used in a more general way • to expresstasks not related to planning: • Orientation of a body • looking at a target (including a new contact) • keeping visual features in the field of view • … • It amounts to restraint to smaller sub-manifolds 9

  7. Example of tasks • Carrying a glass Idea: having n collinear to k with the same direction Escande, Kheddar, Miossec, Garsault, ISER, 2008 Escande, Kheddar, IEEE/RSJ IROS 2009 Escande, Kheddar, Chapter 6 in Humanoid Motion Planning, K. Harada, E. Yoshida and K. Yokoi (Eds), Springer, STAR series, pp. 161–180, 2010 7

  8. Generalized PG • Unifies manipulation and locomotion • No distinctions • Unifies objects, robots, agents • Only goals are specified • Functional extensions • Bilateral contacts (e.g. grasps) • Deformable bodies Bouyarmane, Kheddar, IEEE/RSJ Humanoids, 2010 Bouyarmane, Kheddar, Multi-contact stances planning for multiple agents, IEEE ICRA, 2011

  9. Generalized PG in planning Bouyarmane, Kheddar, Multi-contact stances planning for multiple agents, IEEE ICRA, 2011

  10. Motion generation • Main ideas • MPC on simplified models • All variants of Kajita et al.’s PG • Operational task-based prioritized control • E.g. Sentis, Park, Khatib, IEEE TRO 2010 • E.g. Mansard, Saab et al. or L. Righetti et al. ICRA 2011 • Closed-loop QP-based control • Computer Graphics communities (all variants) • Bouyarmane et al. IROS 2011; Salini et al. ICRA 2011 • Whole-body dynamic optimization • This talk • Possibly others • E.g. learning techniques

  11. Why motion optimization • Benefits • Minimization of a criteria • Same method whatever the motion • Easy inclusion of all constraints (actuator limitations, joint limits, stability, collision) • Necessary for high performance motions, highly constrained motions • Drawbacks • Off-line (solution: motions database) • Does not solve control problem (possibility : stochastic optimization)

  12. Motion optimization problem • System model • General problem • Look for a motion q(t) or control u(t) t in [0…tf] • Criteria to minimize f(q(t),u(t)) • Constraints to satisfy c(q(t),u(t))</=0  t in [0…tf] • Problem to solve

  13. How to solve optimization pb? • Solving method (first implementations) • Discretization • Of parameters q(t) = q(p,t) (ex.: B-Splines) • Of constraints at times ti: c(q(ti)) </=0 i  [0…N] • System control u(t) computed with inverse dynamic model • Problem to solve • Resolution with a nonlinear optimization algorithm

  14. Convergence ? Convergence ? Implementation on HRP-2 • General architecture of the program Definition of motion and constraints Motion class Optimization algorithm (IPOPT) B-Splines, dynamic model k=0 k=0 criteria Criteria Iteration k Criteria gradient Iteration k k=k+1 k=k+1 Criteria gradient Constraints Constraints No No Constraints gradient Constraints gradient Yes Yes End

  15. Optimal Motion Generation • Optimal motion problematic • Minimization of any criteria • Energy consumption • Time, jerk, etc. • Constraints • Actuators’ torque, max speeds, Joint limits… • Collision and Auto-collision • Unilateral contact, stability • Output • High performance desired motion with constraint satisfaction • Tool • Development of a software framework • A unified constraint definition Miossec, Yokoi, Kheddar, IEEEROBIO, 2006 Escande, Miossec, Kheddar, IEEE/RSJ Humanoids, 2007

  16. Dynamic transition from one feasible posture to another under joint torque limitation Combining two different motions accelerating an object upward sliding the body into under the object Extreme tasks Arisumi, Chardonnet, Kheddar, Yokoi, IEEEICRA 07 Arisumi, Miossec, Chardonnet, Yokoi,IEEE/RSJ IROS 08

  17. Problem • Theoretical • Difficult to find a compromise between the number of trajectory control points (optimization variables) and sampling time • Difficult to keep a uniformed sampling when the final time is an optimization variable • No guarantee of constraints satisfaction between time samples • Optimization using interval analysis (Lengagne et al.) • Guarantee of constraint satisfaction • Computationally heavy

  18. Multi-contact motion optimization • Whole-body model (incl. dynamics) • Motion local planning • Play trajectories in pseudo-closed-loop • … if the solutions fits within critical time • Use in a closed-loop scheme Optimization Contact sets Dynamic motion

  19. Problem (case 1)

  20. Problem (case 2)

  21. Solution (adopted) dk+1 (Ci , Cj) 0 t Tf t0 t5 t1 t2 t3 t4

  22. More about subdivisions Lengagne, Mathieu, Kheddar, Yoshida, HUMANOIDS, 2010 Lengagne, Mathieu, Kheddar, Yoshida, IROS, 2010

  23. Video: HRP-2 Reported by the NEW SCIENTIST and REUTERS Press Agency

  24. Other videos: HRP-2

  25. HRP-2 emulating impaired leg Lengagne, Kheddar, Druon, Yoshida, IEEE ROBIO, 2011

  26. Comparing motions

  27. Floating contact

  28. Avoiding collisions P Optimization Solver Motion Parametrization Polynomial Approximation (Taylor) Global Minima Distance Computation

  29. CD (no)

  30. CD (yes)

  31. Conclusion • Optimization is a powerful tool • Yet, we need adding: • Impact • Multi-contact stabilizer • Collision avoidance • Faster solvers • Flexibility of the ankle • Current software status • Draft

  32. Collaborators (on this topic) • Past members • New members (RoboHow.Cog)

More Related