Modeling Robot with n total limbs n1 limbs

  • Slides: 14
Download presentation
Modeling • • • Robot with n total limbs n-1 limbs on the ground

Modeling • • • Robot with n total limbs n-1 limbs on the ground World , Abdomen Contacts arbitrary, Coulomb Friction Shoulders , End-Effector , Feet Each link’s COM* is at its coordinate origin Quasi-static 1 st limb n th limb Joint Angles: Velocity: is ‘the velocity of w. r. t as seen by ‘ (Support Region) Center Of Mass*

Abdomen Motions • Stance Map: Contact Forces Abdomen Forces • Conventions follow Murray, Li,

Abdomen Motions • Stance Map: Contact Forces Abdomen Forces • Conventions follow Murray, Li, Sastry 1994 Stance Map Transposed: Contact Velocity Abdomen Velocity • Analogous to Grasp Map • Enforce contact constraint • Feet cannot penetrate the ground • Legs must comply with body

Abdomen Velocity • Stance Jacobian: Joint Velocities Abdomen Velocities (contact information) • Analogous to

Abdomen Velocity • Stance Jacobian: Joint Velocities Abdomen Velocities (contact information) • Analogous to Hand Jacobian

Free Limb Motions • Reach Jacobian: Joint velocities end-effector velocities • 2 Pieces: Free

Free Limb Motions • Reach Jacobian: Joint velocities end-effector velocities • 2 Pieces: Free Limb w. rt world = (Abdomen Motion w. r. t world) + (Free Limb Motion w. r. t Abdomen)

Analogies to Manipulation Similarity previously noted by many, e. g. [Waldron 1986], [Kumar and

Analogies to Manipulation Similarity previously noted by many, e. g. [Waldron 1986], [Kumar and Waldron 1987], [Hauser et al 2008], [Bretl and Lall 2008], [Johnson and Koditschek 2012]. Stance Kinematics make analogy explicit. Multi-Legged Robot Kinematics Stance Jacobian Stance Map Multi-Fingered Hand Kinematics* Hand Jacobian Grasp Manipulable Grasp Force Closure *Introduced by [Kerr, 1984] and [Salisbury, 1982]

Center of Mass Velocity • • Differentiate mass weighted average of link positions to

Center of Mass Velocity • • Differentiate mass weighted average of link positions to get Stance Constrained Center of Mass Jacobian: Where (Weighted Jacobians)

Center of Mass Velocity • Center of Mass Jacobian: Joint Velocities Center of Mass

Center of Mass Velocity • Center of Mass Jacobian: Joint Velocities Center of Mass Velocity • Used to encourage ‘Without Falling’ • Relationships expressed in contact frames • Contact properties are explicit • Lots of structure to be exploited

Kinematics of Stance/Reach Stance Jacobian Stance Map. T Reach Jacobian Center-of-Mass Jacobian Weighted Link

Kinematics of Stance/Reach Stance Jacobian Stance Map. T Reach Jacobian Center-of-Mass Jacobian Weighted Link Jacobian Shankar & Burdick ‘ICRA 14 Stance/Reach Kinematics Center-of-Mass Kinematics

“Balanced Priority” Solution “Balanced Priority” Planning 1. Existence & Uniqueness results [ICRA’ 14] 2.

“Balanced Priority” Solution “Balanced Priority” Planning 1. Existence & Uniqueness results [ICRA’ 14] 2. Closed form solution [IJRR’ 15] Extends to these geometries Shankar & Burdick ‘ICRA 14, IJRR’ 15

Efficient QP Formulation Quadratic Programming (QP) Linear feasibility Prog. Subject to Sub. to A

Efficient QP Formulation Quadratic Programming (QP) Linear feasibility Prog. Subject to Sub. to A LOT of constraints can be immediately incorporated (t = 1 if soln. exists, t = 0 otherwise) • Self-Collision Constraints (Bullet) • Hard Boundaries on Link motion • Point link in constant direction (gaze constraint) • Configuration Biasing (preferred walking pose) • Static Equilibrium Constraint • L 1 norm—release min number of joint breaks CVXGEN (Mattingley and Boyd) --(http: //www. cvxgen. com) • Custom solver runs extremely fast • 160 -320 microseconds for SURROGATE (21 DOF) • 220 -480 microseconds for Robo. Simian (28 DOF)

Efficient QP Formulation Quadratic Programming (QP) Linear Constraint Relax. Subject to Sub. to A

Efficient QP Formulation Quadratic Programming (QP) Linear Constraint Relax. Subject to Sub. to A LOT of constraints can be immediately incorporated • Self-Collision Constraints (Bullet) • Hard Boundaries on Link motion • Point link in constant direction (gaze constraint) • Configuration Biasing (preferred walking pose) • Static Equilibrium Constraint • L 1 norm—release min number of joint breaks CVXGEN (Mattingley and Boyd) --(http: //www. cvxgen. com) • Custom solver runs extremely fast • 160 -320 microseconds for SURROGATE (21 DOF) • 220 -480 microseconds for Robo. Simian (28 DOF)

Stance Jacobian

Stance Jacobian

Reach Jacobian

Reach Jacobian

Center of Mass Jacobian

Center of Mass Jacobian