rabbit: a testbed for advanced control theory chevallereau, et. al

21
RABBIT: A Testbed for Advanced Control Theory Chevallereau, et. al. Michael Mistry 2/24/04 CLMC Lab

Upload: duante

Post on 15-Jan-2016

28 views

Category:

Documents


0 download

DESCRIPTION

RABBIT: A Testbed for Advanced Control Theory Chevallereau, et. al. Michael Mistry 2/24/04 CLMC Lab. Grizzle vs. ZMP. No trajectory tracking A disturbance will force ASIMO to “catch up” to the planned trajectory Controller creates an asymptotically stable orbit. - PowerPoint PPT Presentation

TRANSCRIPT

Page 1: RABBIT: A Testbed for Advanced Control Theory Chevallereau, et. al

RABBIT: A Testbed for Advanced Control Theory

Chevallereau, et. al.

Michael Mistry

2/24/04

CLMC Lab

Page 2: RABBIT: A Testbed for Advanced Control Theory Chevallereau, et. al
Page 3: RABBIT: A Testbed for Advanced Control Theory Chevallereau, et. al

Grizzle vs. ZMP

• No trajectory tracking– A disturbance will force ASIMO to “catch up”

to the planned trajectory

• Controller creates an asymptotically stable orbit.– Similar to a van der Pol oscillator– Robot converges into a trajectory instead of

being forced into a trajectory

Page 4: RABBIT: A Testbed for Advanced Control Theory Chevallereau, et. al

Grizzle vs. ZMP

• RABBIT is purposefully underactuated– No ankles, no feet– ZMP does not apply

- Feedback controller can be computed to be optimal with respect to any cost function- Such as minimal energy

Page 5: RABBIT: A Testbed for Advanced Control Theory Chevallereau, et. al

Mathematical Model

Page 6: RABBIT: A Testbed for Advanced Control Theory Chevallereau, et. al

Mathematical Model

• Flight: 7 DOF

• Single Stance: 5 DOF

• Double Stance: 3 DOF

• Single Stance Dynamics (by Lagrange):

Page 7: RABBIT: A Testbed for Advanced Control Theory Chevallereau, et. al

Impact Model

• Impact is instantaneous (and therefore double stance is instantaneous)

• Impulsive forces may result in an instantaneous change in velocities

Page 8: RABBIT: A Testbed for Advanced Control Theory Chevallereau, et. al

Dynamic Model with Impact

• Where S is the set of points where the swing leg touches the ground

Page 9: RABBIT: A Testbed for Advanced Control Theory Chevallereau, et. al

Virtual Constraints

Page 10: RABBIT: A Testbed for Advanced Control Theory Chevallereau, et. al

Virtual Constraints

• Cylinder walls apply constraints:

• Alternatively, we can apply “virtual constraints” via control laws. Calling the output :

• Then control the output to zero (using PD, etc.)

Page 11: RABBIT: A Testbed for Advanced Control Theory Chevallereau, et. al

Constraining the RABBIT

• 4 constraints + 5 DOF = 1 DOF– Keep torso erect at a nearly vertical angle– Hip height rises and falls during step– Swing foot traces a parabolic trajectory (x,y)

• Describe these constraints as functions of the angle of the virtual leg– Virtual leg is a good choice because it is

monotonically increasing during a forward step

Page 12: RABBIT: A Testbed for Advanced Control Theory Chevallereau, et. al

Virtual Leg

Page 13: RABBIT: A Testbed for Advanced Control Theory Chevallereau, et. al

Constraining the RABBIT

• Now express four outputs as:

• Where θ(q) is a monotonically increasing scalar function of the configuration variables– i.e. virtual leg– Analogous to time

• h0 represents the four quantities to be controlled

• hd specifies the virtual constraints

Page 14: RABBIT: A Testbed for Advanced Control Theory Chevallereau, et. al

Hybrid Zero Dynamics (HZD)

• Zero dynamics: the dynamics of the system compatible with the outputs being identically zero

• Hybrid because swing phase is continuous but impact phase is discrete.

Page 15: RABBIT: A Testbed for Advanced Control Theory Chevallereau, et. al

Hybrid Zero Dynamics

• Swing phase zero dynamics has one DOF:

• Z is the surface of all points in the state space where outputs are zero

• σZ is the angular momentum of the robot about the pivot point of the stance leg

• xc is the horizontal distance between pivot point and COG

Page 16: RABBIT: A Testbed for Advanced Control Theory Chevallereau, et. al

HZD Model

• Hybrid zero dynamics of our system are:

• State is a 2 dimensional:

Page 17: RABBIT: A Testbed for Advanced Control Theory Chevallereau, et. al

Graphical Interpretation

Page 18: RABBIT: A Testbed for Advanced Control Theory Chevallereau, et. al

Graphical Interpretation

Page 19: RABBIT: A Testbed for Advanced Control Theory Chevallereau, et. al

Condition for Periodic Solution

Page 20: RABBIT: A Testbed for Advanced Control Theory Chevallereau, et. al

Energy Analysis

Page 21: RABBIT: A Testbed for Advanced Control Theory Chevallereau, et. al

State Space Orbit