Gait generator for mobile robot
When the placement of the elements (mass points, links having inertia, etc.) of a model expressing a robot 1 is determined according to a first geometric restrictive condition from an instantaneous desired motion of the robot 1 that has been created using a dynamic model, this placement is defined as a first placement, and the placement determined according to a second geometric restrictive condition from a corrected instantaneous desired motion that has been obtained by correcting the instantaneous desired motion is defined as a second placement. The corrected instantaneous desired motion is determined such that the moment component calculated from the difference between the first and the second placements approximates a predetermined value. The instantaneous desired motion is created using a dynamic model of the robot. Thus, the motion of the instantaneous desired gait of the robot that has been created using the dynamic model is properly corrected without using a dynamic model, leading to higher dynamic accuracy of an instantaneous desired gait including the corrected motion.
1. In a gait generating device equipped with instantaneous gait generating means for sequentially generating an instantaneous desired gait composed of an instantaneous desired motion of a mobile robot and an instantaneous desired floor reaction force,
a gait generating device of a mobile robot, comprising instantaneous desired motion correcting means,
wherein if:
all or a part of the mobile robot is expressed in terms of a model constructed of a plurality of elements, the elements being at least either rigid bodies having inertia or mass points;
a placement of elements of the model determined according to a predetermined first geometric restrictive condition, which specifies the relationship between an instantaneous motion of the mobile robot and the placement of the elements of the model, from an instantaneous desired motion generated by the instantaneous gait generating means is defined as a first placement;
a placement of the elements of the model determined according to a predetermined second geometric restrictive condition, which specifies the relationship between an instantaneous motion of the mobile robot and the placement of the elements of the model, from an instantaneous desired motion generated by the instantaneous gait generating means is defined as a second placement; and
a placement of the elements of the model determined according to the second geometric restrictive condition from a corrected instantaneous desired motion obtained by correcting at least either the position or the posture of a predetermined part of the mobile robot in an instantaneous desired motion generated by the instantaneous gait generating means is defined as a third placement; then
the instantaneous desired motion correcting means determines the corrected instantaneous desired motion such that a moment component generated about a predetermined point by a resultant force of inertial forces of the elements calculated by regarding the difference in the placement of the elements of the model between the third placement and the first placement as acceleration is closer to a predetermined value than a moment component acting about the predetermined point due to a resultant force of inertial forces of the elements calculated by regarding the difference in placement of the elements of the model between the second placement and the first placement as acceleration.
2. The gait generating device of a mobile robot according to claim 1 , wherein the instantaneous desired motion correcting means determines the corrected instantaneous desired motion such that a translational component of a resultant force F 3 of the inertial forces of the elements calculated by regarding the difference in placement of the elements of the model between the third placement and the first placement as acceleration is closer to zero than a translational component of a resultant force F 2 of the inertial forces of the elements calculated by regarding the difference in placement of the elements of the model between the second placement and the first placement as acceleration, and a moment component acting about the predetermined point due to the resultant force F 3 is closer to the predetermined value than a moment component acting about the predetermined point due to the resultant force F 2 .
3. The gait generating device of a mobile robot according to claim 1 , wherein
the instantaneous desired motion correcting means determines the corrected instantaneous desired motion such that a moment component acting about the predetermined point due to the resultant force of the inertial forces of the elements calculated by regarding the difference in placement of the elements of the model between the third placement and the first placement as acceleration becomes substantially the predetermined value.
4. The gait generating device of a mobile robot according to claim 3 , wherein the instantaneous desired motion correcting means determines the corrected instantaneous desired motion such that the translational force component of a resultant force of the inertial forces of the elements calculated by regarding the difference in placement of the elements of the model between the second placement and the first placement as acceleration becomes substantially zero, and a moment component acting about the predetermined point due to the resultant force becomes substantially the predetermined value.
5. The gait generating device of a mobile robot according to claim 1 , wherein
in the moment component related to the difference in placement of the elements between the second placement and the first placement, the component originated from the difference between position A in the first placement and position B in the second placement of the elements of the model having masses is calculated from an angle formed by a segment connecting the predetermined point and the position A and a segment connecting the predetermined point and the position B by using a substantially monotonous function related to the angle, and
in the moment component related to the difference in placement of the elements between the third placement and the first placement, the component originated from the difference between position A in the first placement and position C in the third placement of the elements of the model having masses is calculated using the monotonous function from the angle formed by the segment connecting the predetermined point and the position A and the segment connecting the predetermined point and the position C.
6. The gait generating device of a mobile robot according to claim 3 , wherein, in the moment component related to the difference in placement of the elements between the second placement and the first placement, the component originated from the difference between position A in the first placement and position B in the second placement of the elements of the model having masses is calculated from an angle formed by the segment connecting the predetermined point and the position A and the segment connecting the predetermined point and the position B by using a substantially monotonous function related to the angle.
7. The gait generating device of a mobile robot according to claim 1 , wherein the instantaneous desired motion generated by the instantaneous gait generating means is determined using a dynamic model that represents the relationship between a motion of the mobile robot and a floor reaction force and is constructed on the assumption that the inertial force generated by a specific motion component of at least one or more specific parts of the mobile robot is substantially zero, and the model includes an element corresponding to at least one part of the specific parts.
8. The gait generating device of a mobile robot according to claim 1 , wherein
an instantaneous desired motion generated by the instantaneous gait generating means is determined such that it satisfies a desired floor reaction force or a desired ZMP on a predetermined dynamic model representing a relationship between a motion of the mobile robot and a floor reaction force, and
the first and the second geometric restrictive conditions are set such that a value obtained by adding a predetermined steady offset to the difference between a floor reaction force counterbalancing with a resultant force of the inertial forces of the elements that are generated due to temporal changes in the placement of the elements of the model determined according to the first geometric restrictive condition from the instantaneous desired motion and a floor reaction force counterbalancing with a resultant force of the inertial forces of the elements that are generated due to temporal changes in the placement of the elements of the model determined according to the second geometric restrictive condition from the instantaneous desired motion substantially coincides with an error of a floor reaction force produced on the dynamic model by the instantaneous desired motion.
9. The gait generating device of a mobile robot according to claim 1 , wherein
an instantaneous desired motion generated by the instantaneous gait generating means is determined so as to satisfy a desired floor reaction force or a desired ZMP on a predetermined dynamic model representing a relationship between a motion of the mobile robot and a floor reaction force, and
the first and the second geometric restrictive conditions are set such that a value obtained by multiplying the difference between the overall center-of-gravity of the placement of the elements of the model determined according to the first geometric restrictive condition from the instantaneous desired motion and the overall center-of-gravity of the placement of the elements of the model determined according to the second geometric restrictive condition from the instantaneous desired motion by the total mass of the elements substantially coincides with a value obtained by multiplying an error of the overall center-of-gravity of the dynamic model in the instantaneous desired motion by a total mass of the dynamic model.
10. The gait generating device of a mobile robot according to claim 1 , wherein the mobile robot is a robot comprising a plurality of legs or a plurality of arms extended from its body as a plurality of movable members, and the first geometric restrictive condition includes a condition in which any one of the elements of the model exists on a straight line parallel to a segment connecting a predetermined point in the vicinity of a distal end of each movable member and a predetermined point in the vicinity of the connecting portion of the movable member that is connected to the body.
11. The gait generating device of a mobile robot according to claim 1 , wherein the mobile robot is a robot comprising a plurality of legs or a plurality of arms extended from its body as a plurality of movable members, and the first geometric restrictive condition includes a condition in which the body and the movable members on the model are retained in a predetermined constant posture state.
12. The gait generating device of a mobile robot according to claim 11 , wherein the predetermined constant posture is the posture in which the body and the plurality of movable members of the mobile robot are oriented substantially in the vertical direction.
13. The gait generating device of a mobile robot according to claim 1 , wherein the second geometric restrictive condition is set such that the placement of the elements of the model determined according to the condition from an arbitrary instantaneous desired motion of the mobile robot substantially coincides with the placement of parts corresponding to the elements in the robot following the instantaneous desired motion.
14. The gait generating device of a mobile robot according to claim 1 , wherein the mobile robot comprises a plurality of legs or a plurality of arms extended from the body as a plurality of movable members and also has flexible joints at middle portions between the connecting portions of the movable members that connect to the body and the distal ends of the movable members, and an instantaneous desired motion generated by the instantaneous gait generating means is determined using a dynamic model that represents a relationship between a motion of the robot and a floor reaction force and the dynamic model is constructed on the assumption that the inertial forces produced at or near the middle portions of the movable members due to bending motions of the movable members are substantially zero, the model being a model that contains, as an element, a mass point associated with at least the middle portion or a portion near the middle portion of each movable member.
15. The gait generating device of a mobile robot according to claim 14 , wherein the first geometric restrictive condition includes a condition in which a mass point associated with the middle portion or the portion close thereto of each movable member of the elements of the model exists on the segment that connects a predetermined point in the vicinity of the distal end of the movable member and a predetermined point in the vicinity of the connecting portion of the movable member that links with the body, and the second geometric restrictive condition is set such that the placement of the elements of the model determined according to the condition from an arbitrary instantaneous desired motion of the mobile robot substantially coincides with the placement of parts corresponding to the elements in the robot following the instantaneous desired motion.