Given a robot we can write:
F = m.g - m.a
Where m is the robots mass, g is gravity and a is the acceleration of the center of mass.
The moment on any point is:
Mp = p.COM x m.g - p.COM x m.a - H
Where p is the point in question, COM is the center of mass, and H is the rate of angular momentum at the center of mass.
If we can find a point on the ground that balances the motion of the robot then we have the ZMP.
P.zmp = n x MP / F.n
Where P is the projection of the ankle to the ground, and n is the grounds normal.
For more information refer to Honda's ASIMO history which gives a few diagrams and an overview, and Philippe Sardain and Guy Bessonnet article Forces Acting on a Biped Robot: Center of Pressure, Zero Moment Point.
No comments:
Post a Comment