WO2006013779A1 - 脚式移動ロボットの歩容生成装置および制御装置 - Google Patents
脚式移動ロボットの歩容生成装置および制御装置 Download PDFInfo
- Publication number
- WO2006013779A1 WO2006013779A1 PCT/JP2005/013840 JP2005013840W WO2006013779A1 WO 2006013779 A1 WO2006013779 A1 WO 2006013779A1 JP 2005013840 W JP2005013840 W JP 2005013840W WO 2006013779 A1 WO2006013779 A1 WO 2006013779A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- gait
- trajectory
- robot
- target
- parameter
- Prior art date
Links
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J5/00—Manipulators mounted on wheels or on carriages
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D57/00—Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track
- B62D57/02—Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track with ground-engaging propulsion means, e.g. walking members
- B62D57/032—Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track with ground-engaging propulsion means, e.g. walking members with alternately or sequentially lifted supporting base and legs; with alternately or sequentially lifted feet or skid
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J13/00—Controls for manipulators
Definitions
- the present invention relates to a gait generator that generates a gait of a robot in a state where an external force other than a floor reaction force appropriately acts on a legged mobile robot, and a control device that controls the operation of the robot.
- the robot When a legged mobile robot such as a biped mobile robot is used to push a certain object, the robot simply receives the floor reaction force that the tip of the leg contacts.
- the target force also receives reaction force.
- the force other than the floor reaction force that the external environmental force acts on the robot in this way is called an external force.
- Object force The external force (reaction force) that the robot receives is called the object reaction force.
- the external force does not include gravity.
- Patent Document 1 Japanese Patent Laid-Open No. 10-230485 (hereinafter referred to as Patent Document 1) by the inventor of the present application is known as a technique for generating a gait of a robot in a state in which an external force is applied to a legged mobile robot and performing motion control. ) Is known.
- This technology removes the vertical component of the moment (horizontal component) of the moment generated around the target ZMP (target floor reaction force center point) by the resultant force of the inertial force generated by the robot's motion and the gravity and external force acting on the robot.
- the desired gait is generated so as to satisfy the dynamic equilibrium condition that becomes 0 (the floor reaction force acting on the center point of the target floor reaction force balances the resultant force).
- Patent Document 2 As a technique for generating a target gait of a robot in real time, a technique found in PCT International Publication No. WOZ02Z40224A1 (hereinafter referred to as Patent Document 2) previously proposed by the present applicant is also known.
- This technology ensures the continuous stability of the robot by generating the body position and posture of the target gait so that it converges to the body position and posture of the normal turning gait, which is a virtual periodic gait.
- the target gait of the robot is generated in real time while preventing the robot's motion state from diverging.
- the technique disclosed in Patent Document 1 the basic target gait is simply generated so that the dynamic equilibrium condition described above is satisfied.
- the basic desired gait may deviate significantly from the gait that satisfies the original dynamic equilibrium condition for unexpected external force changes.
- the robot's body position / posture is adjusted so that the center of gravity is balanced, the robot's continuous movement cannot be ensured immediately because the robot's dynamic balance cannot be secured. There was a risk that it could not be performed stably.
- external force changes suddenly such as when the robot starts to move the object by bringing its arm or the like into contact with the object from a state where the robot is not in contact with the object.
- the present invention has been made in view of a strong background, and in an environment in which an external force appropriately acts on the robot, such as a reaction force that acts on the robot from the object when the object is moved by the robot.
- An object of the present invention is to provide a gait generator and a control device capable of generating a target gait that can ensure the continuous stability of a robot even when the external force changes rapidly. It is another object of the present invention to provide a gait generator and a controller that can generate a target gait that can ensure the continuous stability of the robot even when the external force does not always become as expected.
- the first invention of the gait generator for legged mobile robot provides:
- An external force trajectory temporary determining means for temporarily determining a target trajectory of an external force other than a floor reaction force acting on the robot
- Periodic gait parameter determining means for determining a periodic gait parameter including at least a parameter defining
- the motion trajectory of the upper body of the robot determined based on the robot dynamics model representing the relationship between the floor reaction force and external force acting on the robot and the robot motion and the current time gait parameter is the dynamic model.
- At least one parameter of the tentatively determined current time gait parameter is corrected so as to satisfy the condition of convergence to the upper body motion trajectory of the robot obtained based on the periodic gait parameter Parameter correction means for determining the gait parameters this time,
- the present time gait instantaneous value determining means for sequentially determining the instantaneous value of the current time gait based on at least the corrected current time gait parameter.
- the current time's gait parameter is calculated based on the motion trajectory of the upper body of the robot obtained based on this and the robot dynamics model. It is determined so as to satisfy the condition of convergence on the motion trajectory of the upper body of the robot obtained based on this.
- the periodic gait is a gait that can guarantee the continuous stability of the robot motion because it is a gait that repeats the motion of the robot in the same form for one cycle.
- the periodic gait parameter includes a parameter that defines the trajectory of the external force in the periodic gait. Therefore, the current time's gait parameter can be determined in consideration of future changes in external force following this time's gait.
- the time series of the instantaneous value of the current time's gait taking into account future external force changes (more specifically, the future external force It is possible to generate a time series of instantaneous values of the current time's gait that can be obtained by continuous movement of the robot even by changes. [0010] Therefore, according to the first invention, in an environment in which an external force acts on the robot as appropriate, even if the external force suddenly changes, the target gait that can ensure the continuous stability of the robot. Can be generated.
- the external force may be a force caused by an electromagnetic force or an air flow that is not limited to a reaction force that acts on the robot from any object that directly contacts the robot. .
- the second invention of the gait generator of the present invention is a robot for causing a legged mobile robot having a plurality of legs extending from the upper body to perform an operation of moving an object.
- a gait parameter tentative determination means for tentatively determining a current gait parameter including at least a parameter defining a floor reaction force and an external force trajectory to be applied to
- a periodic gait parameter determining means for determining a periodic gait parameter including at least a parameter defining a trajectory of the external force
- the robot's upper body motion trajectory determined based on the robot dynamics model representing the relationship between the floor reaction force and external force acting on the robot and the robot's motion and the current time's gait parameter is the robot dynamics model. And at least one parameter of the tentatively determined current time gait parameter is corrected so as to satisfy the condition that the robot converges to the upper body motion trajectory obtained based on the periodic gait parameter.
- Parameter correction means for determining the gait parameters this time is
- the current time's gait parameter is calculated based on this and the mouth bot dynamics model, as in the first invention. It is determined so as to satisfy the condition of convergence on the upper body motion trajectory of the robot obtained based on the model and the periodic gait parameters.
- the periodic gait meter includes a parameter that defines the trajectory of the external force (reaction force that the robot receives as a target force) in the periodic gait.
- the current time's gait parameter can be determined in consideration of the change in the future external force (reaction force received by the object force robot) following the current time's gait.
- the time series of the instantaneous value of the current time's gait taking into account future external force changes (more specifically, Can also generate a time series of instantaneous values of the current time's gait that can perform continuous robot movement.
- the parameter to be corrected by the parameter correcting means includes, for example, at least a parameter that specifies the trajectory of the floor reaction force among the current time gait parameters.
- the parameter correcting means corrects the parameter when the parameter that defines the trajectory of the floor reaction force is corrected so as to satisfy the condition among the temporarily determined gait parameters.
- the parameters that specify the trajectory of the floor reaction force are subject to correction.
- the gait parameters can be determined this time to satisfy.
- ZMP is the inertia generated by the movement of the robot.
- the resultant force of the sexual force and the force other than the floor reaction force acting on the robot ie, gravity and the external force
- the third invention when the correction amount of the butter meter that defines the trajectory of the floor reaction force in the current time's gait exceeds a predetermined amount, the above condition is satisfied so as to satisfy the above condition while reducing the correction amount. At least the parameter that defines the trajectory of the external force is corrected among the gait parameters that have been provisionally determined. By doing so, the current time gait parameter can be corrected so as to satisfy the above condition even when it is difficult to appropriately correct the parameter that defines the trajectory of the floor reaction force.
- the robot's leg movement cannot be adjusted immediately, even if the situation (for example, just before landing on the leg), the robot's continuous stability can be ensured.
- a time series of instantaneous values can be generated, and the robot can be accelerated and decelerated rapidly using external force.
- the parameter correction means when the parameter to be corrected by the parameter correction means includes at least a parameter that defines the trajectory of the floor reaction force among the current time gait parameters, the parameter correction means When the calibrated amount of the metric when the parameter defining the trajectory of the floor reaction force is corrected so as to satisfy the above condition among the temporarily determined gait parameters, Means may be provided for correcting at least a parameter that defines the movement trajectory of the leg among the temporarily determined gait parameters so as to satisfy the condition while reducing the correction amount. (Fourth invention).
- the parameter that defines the trajectory of the floor reaction force is preferably a parameter that defines the trajectory of the target ZMP of the robot (fifth invention, fourth invention). 6 inventions).
- the parameter correction means is a correction target. Since the parameters include the target ZMP, the current time's gait parameters that can ensure the robot's stability margin can be determined regardless of the number of robot legs that are in contact with the ground.
- the object trajectory provisional deciding means is an object representing a relationship between a motion of the object and a force acting on the object.
- Means for determining the current parameter by correcting at least one of the target motion trajectory of the figurine and the parameter defining the motion trajectory of the leg of the corrected current time gait parameter; (7th invention).
- the future motion of the robot is predicted based on the corrected current time gait parameter, the periodic gait parameter, and the robot dynamics model, and the predicted future motion of the robot is determined.
- a predetermined geometric constraint for example, the robot and the object Geometry such as whether interference occurs, whether the robot and target are too close, and the joint rotation angle of the part (arm body, etc.) to be engaged with the robot target is excessive. It is determined whether or not the geometrical constraints are met. If the geometric constraint condition is not satisfied, at least one of the target motion trajectory of the object and the parameter that defines the motion trajectory of the leg in the corrected current time gait parameter.
- the gait parameters can be determined this time so that the appropriate positional relationship between the robot and the object (the positional relationship that satisfies the geometric constraint conditions) is maintained in the future, and the appropriate position is determined. If there is a risk that the relationship may not be maintained, an appropriate current time gait parameter that can be resolved can be determined in advance, so that the continuous movement of the mouth bot can be carried out smoothly without interruption. .
- the seventh invention may be combined with the third to sixth inventions.
- a disturbance force other than the force acting on the object is estimated from the robot operating according to the instantaneous gait instantaneous value.
- An object disturbance force estimating means for determining, and the object trajectory provisional deciding means comprises an object dynamics model representing a relationship between a motion of the object and a force acting on the object, the movement plan, and the It is preferable that the means temporarily determines the target motion trajectory of the object and the target trajectory of the external force based on the estimated disturbance force (the eighth invention).
- the disturbance force for example, a frictional force or a braking force that acts on the object, which is not assumed in the movement plan, or a gravity gradient that acts on the object on the inclined surface of the floor.
- the target motion trajectory of the target and the target trajectory of the external force are tentatively determined using the target dynamic model. For this reason, even if the external force (reaction force) that acts on the robot from the target does not always become as expected, the target motion trajectory of the target and the target trajectory of the external force are temporarily set according to the actual environment. Can be determined. Based on these target motion trajectory and the target trajectory of external force, as a result, the external force (reaction force) acting on the robot will not always be as expected! A goal gait that can ensure stability can be generated.
- the eighth invention may be combined with the third to seventh inventions.
- the object trajectory provisional determination means includes the difference between the motion trajectory of the object corresponding to the movement plan and the target motion trajectory of the provisionally determined object, and the estimation It is preferable that a means for correcting the movement plan is provided based on at least one of the generated disturbance forces (the ninth invention).
- the ninth aspect of the invention at least one of the difference between the motion trajectory of the object corresponding to the movement plan and the target motion trajectory of the provisionally determined object and the estimated disturbance force Based on one, the movement plan is modified.
- the robot's stability is improved while avoiding excessive changes in the robot's behavior.
- the travel plan can be modified to an appropriate plan that is in line with the actual environment.
- a control device for a legged mobile robot according to the present invention is a current time gait generated by the gait generator for a legged mobile robot according to any one of the first to ninth inventions.
- the control device that controls the operation of the robot according to the instantaneous value is a current time gait generated by the gait generator for a legged mobile robot according to any one of the first to ninth inventions.
- the current step of the robot is adjusted so as to approach zero.
- the instantaneous value of the gait at least one of the target motion and the desired floor reaction force of the robot!
- the gait instantaneous value correcting means for correcting one of the deviations, and the corrected moment of the current time gait And a control means for controlling the operation of the robot so as to follow the value.
- the instantaneous gait of the current gait is made close to 0 so that the deviation between the actual external force (actual external force) and the instantaneous value of the external force in the current gait (that is, the instantaneous value of the target external force) approaches zero. Since at least one of the target motion and the desired floor reaction force of the robot is corrected, the external force (target external force) and actual external force assumed in generating the instantaneous value of the current time's gait Even when the deviation of the robot becomes large, it is possible to control the robot movement so as to maintain the stability of the robot. Therefore, continuous stability during the actual operation of the robot can be improved.
- the actual external force may be detected using a force sensor.
- a gait generation device and a control device for a legged mobile robot according to an embodiment of the present invention will be described with reference to the accompanying drawings.
- a legged mobile robot a bipedal mobile robot is taken as an example.
- Fig. 1 is a schematic diagram showing the entire biped mobile robot as a legged mobile robot according to this embodiment.
- a bipedal mobile robot (hereinafter referred to as a robot) 1 includes a pair of left and right legs (leg links) 2 and 2 extending downward from an upper body (base of the robot 1) 3. . Both legs 2, 2 have the same structure, each with six joints.
- the six joints are crotch (waist ) Joints 10R, 10L for rotation (rotation) (for rotation in the direction of the upper body 3) (reference symbols R and L are symbols corresponding to the right leg and the left leg, respectively) And the following joints 12R and 12L for rotation in the crotch (waist) roll direction (around the X axis) and joints 14R and 14L for rotation in the crotch (waist) pitch direction (around the Y axis)
- the joints 16R, 16L for rotation in the pitch direction of the knee, the rotation joints 18R, 18L for rotation in the pitch direction of the ankle, and the joints 20R, 20L for rotation in the roll direction of the ankle are also configured.
- a foot (foot) 22R (L) constituting the tip of each leg 2 is attached.
- the upper body 3 is attached to the uppermost positions of both legs 2 and 2 through three joints 10R (L), 12R (L) and 14R (L) of the crotch of each leg 2. ing.
- a control unit 60 and the like, which will be described in detail later, are stored.
- the control unit 60 is shown outside the upper body 3 for the convenience of illustration.
- the hip joint (or the hip joint) has joints 10R (L) and 12R.
- the knee joint is composed of joint 16R (L)
- the ankle joint is composed of joints 18R (L) and 20R (L).
- the hip joint and knee joint are connected by a thigh link 24R (L)
- the knee joint and ankle joint are connected by a crus link 26R (L).
- a pair of left and right arm bodies (arm links) 5 and 5 are attached to both side portions of the upper portion of the upper body 3, and a head 4 is disposed at the upper end portion of the upper body 3.
- Both arms 5 and 5 have the same structure, each with 7 joints. That is, each arm body 5 has a shoulder joint composed of three joints 30R (L), 32R (L), 34R (L), an elbow joint composed of one joint 36R (L), and three A wrist joint composed of joints 38R (L), 40R (L), and 42R (L) and a hand portion (hand) 40R (L) connected to the wrist joint are provided.
- the head 4 does not have a direct relationship with the gist of the present invention, and therefore a detailed description is omitted.
- the foot 22R (L) of each leg 2 is given six degrees of freedom with respect to the upper body 3.
- “*" is multiplication for scalar operations and cross product for vectors.
- the desired joints 22R and 22L can be exercised by driving the joint shown in FIG.
- the robot 1 can arbitrarily move in the three-dimensional space.
- a known 6-axis force sensor 50 is interposed below the ankle joints 18R (L) and 20R (L) of each leg 2 between the foot 22R (L). ing.
- the six-axis force sensor 50 is for detecting the presence / absence of the foot 22R (L) of each leg 2 and the floor reaction force (ground load) acting on each leg 2, etc.
- the detection signals of the three-direction components Fx, Fy, Fz of the translational force of the floor reaction force and the three-way components Mx, My, Mz of the moment are output to the control unit 60.
- the 6-axis force sensor 52 which is similar to the 6-axis force sensor 50, has a wrist portion (node) 40R (L) and wrist joints 38R (L), 40R (L), 42R (L) of each arm body 5. Detection signals for the three-direction component of the translational force of the external force acting on the hand 40R (L) and the three-way component of the moment are output from the six-axis force sensor 52 to the control unit 60. .
- the body 3 detects the inclination angle of the body 3 with respect to the Z axis (vertical direction (gravity direction)) and its angular velocity, and the rotation angle (one angle) of the body 3 around the Z axis and its angular velocity.
- a posture sensor 54 is provided, and a detection signal thereof is output from the posture sensor 54 to the control unit 60.
- This posture sensor 54 includes a triaxial acceleration sensor and a triaxial gyro sensor (not shown).
- the detection signals of these sensors indicate the posture angle (tilt angle and horizontal angle) of the upper body 3 and its angular velocity. It is used to detect the robot's self-position and posture.
- each joint of the robot 1 has an electric motor 64 (see FIG. 3) for driving the joint and a rotation amount of the electric motor 64 (a rotation angle of each joint).
- An encoder (rotary encoder) 65 (see FIG. 3) for detection is provided, and a detection signal of the encoder 65 is output from the encoder 65 to the control unit 60.
- an elastic body such as a spring is interposed between each foot 22R (L) and the 6-axis force sensor 50, and the bottom surface of the foot 22R (L)
- An elastic body such as rubber is attached to the surface.
- FIG. 2 is a block diagram showing the configuration of the control unit 60.
- the control unit 60 is constituted by a microcomputer, and the first arithmetic unit 90 and the second arithmetic unit 92, which also have CPU power, an AZD variable ⁇ 80, a counter 86, a DZA variable ⁇ 96, a RAM 84, a ROM 94, a parallel And a bus line 82 for exchanging data between them.
- the output signals from the 6-axis force sensor 50 of each leg 2, the 6-axis force sensor 52 of each arm 5, and the attitude sensor 54 (acceleration sensor and rate gyro sensor) are output from the AZD converter 80. After being converted to a digital value, it is sent to the RAM 84 via the bus line 82.
- the output of the encoder 65 (rotary encoder) of each joint of the robot 1 is input to the RAM 84 via the counter 86.
- the first arithmetic unit 90 generates a target gait as described later, calculates a joint angle displacement command (a command value of a displacement angle of each joint or a rotation angle of each electric motor 64), and RAM8 Send to 4. Further, the second arithmetic unit 92 reads out the joint angle displacement command from the RAM 84 and the actually measured value of the joint angle detected based on the output signal of the encoder 65, and calculates the operation amount necessary for driving each joint. It is calculated and output to the electric motor 64 that drives each joint via the DZA converter 96 and the servo amplifier 64a.
- FIG. 3 is a block diagram generally showing a functional configuration of the control device for the legged mobile robot according to the embodiment of the present specification.
- the portion surrounded by a broken line in FIG. 3 is constituted by processing functions (mainly functions of the first arithmetic device 90 and the second arithmetic device 92) executed by the control unit 60.
- processing functions mainly functions of the first arithmetic device 90 and the second arithmetic device 92
- the symbols R and L are omitted when it is not necessary to distinguish between the left and right of the leg body 2 and the arm body 5.
- the functional configuration of the control unit 60 includes a gait generator 100, an object reaction force balance controller 102, a leg main controller 104, and an arm main controller 106.
- the applicant of the present invention has previously described the processing of the object reaction force balance control device 102, the leg main control device 104, and the arm main control device 106. This is the same as that proposed in Japanese Patent Laid-Open No. 10-230485 (Patent Document 1). Therefore, in the following description of the present embodiment, the gait generator 100 will be mainly described, and the object reaction force balance controller 102, the leg main controller 104, and the arm main controller 106 will be schematically described. Keep on.
- the gait generator 100 generates and outputs the target gait of the robot 1 in real time and corresponds to the gait generator of the present invention.
- the target gait output by the gait generator 100 is the target body position / posture trajectory (the target position trajectory of the upper body 3). And target posture trajectory), target foot position / posture trajectory (target position trajectory and target posture trajectory of each foot 22), target hand position / posture trajectory (target position trajectory and target posture trajectory of the hand portion 44 of each arm body 5) , Target total floor reaction force center point trajectory (target floor trajectory of the total floor reaction force center point), target total floor reaction force trajectory, and target object reaction force trajectory.
- a “trajectory” in a gait means a temporal change pattern (time-series pattern).
- the "position" of each part of the robot 1, such as the foot position and the body position means the position of a representative point fixedly set in that part.
- the representative point of each foot 22 is a point where a perpendicular extending from the center of the ankle joint of the leg 2 including the foot 22 to the bottom surface of the foot 22 intersects the bottom surface.
- the position of the representative point is the foot position.
- “Position” means spatial orientation.
- the body posture is the tilt angle of the upper body 3 in the roll direction (around the X axis) and the tilt direction of the upper body 3 in the pitch direction (around the Y axis)
- the foot posture is represented by a two-axis spatial azimuth that is fixedly set on each foot 22 (in the Z axis).
- the gait related to the motion of the robot 1 such as the foot position / posture, the body position / posture, etc. other than the components related to the floor reaction force and the object reaction force in the gait are generic. It is called “exercise”.
- the motion trajectory may be constant (does not change with time) or substantially constant. For example, when the robot 1 keeps its feet 22 and 22 landed and does not move, the foot position / posture trajectory is constant.
- the object reaction force in the gait means an external force other than the floor reaction force that the robot 1 receives environmental force. Therefore, the target object reaction force trajectory corresponds to the target trajectory of the external force in the present invention.
- the robot 1 is engaged with the hand portions 44R and 44L of the arms 5 and 5 at a predetermined portion of the object 120 (the carriage in the illustrated example).
- an external force other than the floor reaction force that the robot 1 also receives environmental force means a reaction force that the robot 1 receives from the object 120.
- the external force is referred to as an object reaction force.
- the object reaction force is generally composed of a translational force component and a moment component.
- the object reaction force means the translational force acting on the robot 1 from the object 120, and the moment around the point acting on the robot 1 by the translational force is the object reaction force moment.
- the position of the object 120 means the position of a representative point fixedly set on the object 120, like the foot position of the robot 1.
- the posture of the object 120 means the spatial orientation of the object 120, like the posture of the foot 22 of the robot 1.
- the position and orientation of the object 120 are sometimes collectively referred to as object movement.
- each foot floor reaction force the floor reaction force acting on each foot 22 (the floor reaction force consisting of translational force and moment) is called “each foot floor reaction force", and all (two) foot 22R,
- All floor reaction force The resultant force of “each foot floor reaction force” for 22L is called “all floor reaction force”.
- each foot floor reaction force is hardly mentioned, and unless otherwise noted, “floor reaction force” is treated as the same as “whole floor reaction force”.
- the target floor reaction force is generally expressed by an action point, a translational force and a moment acting on the point.
- the action point can be used anywhere, and there are countless expressions for the same target floor reaction force, but the target floor reaction force center point (target position of the center point of all floor reaction forces) is the target point.
- the moment component of the desired floor reaction force is zero except for the vertical component (moment about the lead straight axis (Z axis)).
- the horizontal component of the moment of the desired floor reaction force around the desired floor reaction force center point is zero.
- the gait generator 100 generates the target floor reaction force center point as the action point of the target total floor reaction force. Since the target floor reaction force central point has a meaning as an action point of the target total floor reaction force, it can be said that it is essentially one component of the target total floor reaction force. However, in the present embodiment, the target floor reaction force center point of the target floor reaction force is closely related to the present invention. Therefore, in Figure 4, the target floor reaction force center point, which is the point of action of the target total floor reaction force, is described separately from the target total floor reaction force.
- ZMP zero moment point
- ZMP is the resultant force of the inertial force generated by the motion of the robot, the gravity acting on the robot, and the reaction force of the object (or the floor reaction force that balances the resultant force).
- ZMP Is used to mean the point where the moment acting around the point becomes 0 except for the vertical component.
- the ZMP calculated from the target motion trajectory of the robot, gravity, and the target object reaction force coincides with the target floor reaction force center point.
- the target ZMP is often referred to as the target ZMP instead of the target floor reaction force center point.
- the target gait means a set of a target motion, a target floor reaction force (including a target Z MP) for a predetermined period, and a target object reaction force.
- the target gait (including the case where it is simply referred to as a gait) is the target motion and the target floor reaction force (including the target ZMP) for one step of the robot 1 unless otherwise stated.
- the target object reaction force “1 step” of the target gait is used in the meaning from the time when one leg 2 of the robot 1 is landed until the other leg 2 is landed. It is assumed that a series of gaits are connected with several gaits (gait for a predetermined period).
- the target gait for the period of one step may be called a unit gait.
- the period of one step when the robot 1 does not move corresponds to a predetermined period (the period of one step when the robot 1 moves). Period).
- the both-leg support period in the gait is the period in which the robot 1 supports its own weight with both legs 2 and 2 (the period in which both legs 2 and 2 become support legs), and the one-leg support period. This is the period during which either one of the legs 2 supports the weight of the robot 1 (the period during which only one leg 2 is the supporting leg).
- the target gait (unit gait) in the present embodiment is the target gait for the period until the end of the next one-leg support period.
- the leg 2 that supports the weight of the robot 1 is called the support leg.
- both legs 2 and 2 are support legs
- one leg 2 is a support leg.
- the leg 2 on the side that does not support the weight of the robot 1 during the one-leg support period (the leg 2 that is not the support leg) is called a free leg.
- the supporting leg in the target gait is the leg 2 that lands at the start of the both-leg supporting period 2 (the leg that becomes the supporting leg in the one-leg supporting period following the both-leg supporting period) It shall mean 2).
- the foot 22 of the leg 2 on the support leg side and the foot 22 of the leg 2 on the free leg side are referred to as the support leg foot 22 and the free leg foot 22, respectively.
- robot 1 is not moving (both feet Even in the state of maintaining the ground contact between the flat surfaces 22 and 22, it is assumed that one leg 2 is a supporting leg and the other leg 2 is a free leg.
- a target gait (unit gait) to be newly generated by the gait generator 100 or a target gait being generated (unit gait) is called a current time gait, and this time gait.
- the target gait one step before is called the previous time gait
- the target gait one step after the current gait is called the next gait
- the next one step is called the next gait.
- the target gait is described in a support leg coordinate system as a global coordinate system.
- the support leg coordinate system is such that the support leg foot 22 is in a horizontal posture (more generally, a posture parallel to the floor surface) and substantially the entire bottom surface of the support leg foot 22 is on the floor surface.
- the central force of the ankle joints 18 and 20 of the supporting leg intersects with the floor surface (this point is the foot of the supporting leg in the example of this embodiment).
- the global coordinate system (fixed to the floor) is set with the origin as the origin point and the horizontal plane passing through the origin as the XY plane. Coordinate system).
- the X-axis direction and the Y-axis direction are the front-rear direction and the left-right direction of the support leg foot 22, respectively.
- the X axis, Y axis, and Z axis mean the three axes of this support leg coordinate system unless otherwise specified. Note that the origin of the support leg coordinate system is not necessarily the same as the representative point of the foot 22 in a state where almost the entire bottom surface of the support leg foot 22 is in contact with the floor surface. It may be set to a point on the floor.
- the gait generator 100 is an embodiment of the first to third inventions, the fifth invention, and the seventh to tenth inventions of the present invention.
- the gait generator 100 sequentially executes the processes shown in the flowcharts of FIGS. 5 to 7 at a predetermined calculation processing cycle.
- the movement plan of the object 120 is determined.
- Move determined here The plan includes a movement plan of the object 120 for at least a predetermined period in the future (for a plurality of steps of the robot 1) from the current time.
- This movement plan is basically determined according to the movement request of the object 120 (design requirement of how and when the object 120 is moved), and the position of the object 120 is determined. It consists of a posture trajectory (time series of position and posture), or a parameter or a function expression that defines the trajectory. For example, when the movement request of the object 120 is a request to move the object 120 at a constant speed in the X-axis direction from a certain time tO, the movement plan is determined as shown by the graph gl in FIG.
- the Graph gl shows the time course of the object position (X-axis direction position) in the movement plan.
- the time series of the position of the object 120 at each time after the current time (at every step) may be determined as the movement plan! /
- the time tO and the slope of the graph gl target
- the moving speed of the object 120 may be determined as an element (parameter) that defines the movement plan, or a function expression of the graph gl may be determined as an element (parameter) that defines the movement plan.
- the movement request is appropriately given to the gait generator 100 from the outside, or is stored and held in a storage unit (not shown) of the control unit 60 in advance.
- the movement plan determined in S01 is not necessarily determined according to the movement request, but is appropriately corrected as necessary. This will be described later.
- Next step S03 Go forward, based on the movement plan determined in S01 as described above, the target object motion trajectory (target target position / posture trajectory) and target The object reaction trajectory is provisionally determined.
- FIG. 9 is a block diagram showing a calculation process for obtaining the target object position trajectory and the target object reaction force trajectory in the target object motion trajectory in S03.
- a portion surrounded by a broken line in this block diagram is an object dynamic model representing the relationship between the force acting on the object 120 and the movement of the object 120.
- the case where the object 120 is moved on a substantially horizontal floor will be described as an example for convenience of understanding.
- the target object dynamic model shown in FIG. 9 is a dynamic model that outputs the position of the target object 120 with the force (more specifically, the translational force in the horizontal direction) acting on the target object 120 as an input. More specifically, this object dynamics model is a horizontal translation acting on object 120. Multiplying the force input value (the value obtained by the adding unit 204 described later) by the reciprocal 1 ZM of the mass 120 of the object 120 by the multiplication unit 206, the motion acceleration of the object 120 is obtained, and this is the integrator. The position of the object 120 (position on the object dynamic model) is output by sequentially integrating (double integration) at 208 and 210. That is, in the present embodiment, the object dynamic model shown in FIG.
- the output of the integrator 208 means the moving speed of the object 120 on the object dynamics model, and this is hereinafter referred to as the object model speed.
- the target object speed which is the instantaneous target speed (at each time) of the object 120 based on the movement plan determined in S01 is subtracted from the object model speed previously obtained by the integrator 208.
- the target object speed is a value obtained as a first-order differential value of the position trajectory of the object 120 in the movement plan, or a component of the movement plan.
- a time series of target object speeds for a predetermined period in the future (for a plurality of steps of the robot 1) from the current time is sequentially input to the subtraction unit 200.
- the object model speed input to the subtraction unit 200 is the value output from the integrator 208 when the target object speed immediately before the newly input target object speed is input to the subtraction unit 200. It is.
- the required value of the translational force to be applied to the object 120 from the robot 1 is determined by multiplying the deviation by a predetermined gain Kv by the multiplication unit 202.
- the required value of the translational force is set so that the deviation between the target object speed and the target model speed converges to 0 (so that the target model speed follows the target target speed).
- the feed knock control law In this example, a proportional control law is used as the feedback control law.
- a time series obtained by reversing the sign of the calculated required value of the translational force is output as the target object reaction force trajectory.
- the estimated disturbance force which is an estimated value of the force (the floor force is also a friction force acting on the object 120, etc.) is input to the adding unit 204, and the sum of the required value of the translational force and the estimated disturbance force is the object power. It is obtained by the adder 204 as an input value of the translational force for the academic model.
- the estimated disturbance force is obtained by the processing of S35 described later for each arithmetic processing cycle of the gait generator 100, and the estimated disturbance force input to the adder 120 is the gait generator device 100.
- the value (previous value) obtained in the previous computation cycle is used.
- the position of the object 120 is obtained as described above, and the time series of the obtained position is obtained from the integrator 210 as a target. It is output as the object position trajectory.
- the initial value of the output of the integrator 208 of the object dynamic model is the time series of the object model speed obtained by executing the process of S03 in the previous arithmetic processing cycle of the gait generator 100. Is set to a value at the time corresponding to the previous calculation processing cycle (current time in the previous calculation processing cycle).
- the initial value of the output of the integrator 210 is the previous calculation processing cycle in the time sequence of the target object position obtained by executing the processing of S03 in the previous calculation processing cycle of the gait generator 100. Is set to the value at the time corresponding to (current time in the previous processing cycle).
- the target object posture trajectory of the target object motion trajectory is determined so as to substantially coincide with the direction of the target object speed, for example.
- the processing of S03 is not necessarily performed by the gait generator 100. It is not necessary to carry out every calculation processing cycle. Therefore, for example, the process of S03 is performed for each step of the robot 1 or for each of a plurality of calculation processing cycles of the gait generator 100, or when the movement plan is changed in S01, or the estimated disturbance force is relatively low. You can do it when there is a big change!
- the target object movement trajectory and the target object reaction force trajectory for a predetermined period in the future from the current time are provisionally determined.
- the process of S03 corresponds to the external force trajectory temporary determining means in the first invention or the object trajectory temporary determining means in the second invention.
- the object shown in Figure 9 The physical dynamic model corresponds to the object dynamic model in the eighth aspect of the present invention.
- the planned landing position / posture and scheduled landing time of the free leg foot 22 of the mouth bot 1 are provisionally determined based on the target object motion trajectory provisionally determined as described above.
- the planned landing position / posture and scheduled landing time to be provisionally determined here are the planned landing position / posture and landing scheduled time of the free leg foot 22 in the current time's gait, which is the target gait that is currently being created. This includes the planned landing position and scheduled landing time of the free leg foot 22 for multiple steps (at least two steps) of the robot 1.
- the estimated landing position / posture and scheduled landing time to be provisionally determined are at least the planned landing position / posture and landing time of the free leg foot 22 of the current time's gait and the planned landing position of the free leg foot 22 of the next time's gait. Includes position and orientation and estimated landing time.
- the planned landing position / posture and the scheduled landing time of the free leg foot 22 are the same as the landing position / posture of the free leg foot 22 at the planned landing time with respect to the target object motion trajectory determined in S 03. It is determined so as to have a predetermined relative position and orientation relationship with the object position and orientation at the time.
- the planned landing position / posture and the scheduled landing time of the free leg foot 22 do not necessarily have to be determined in such a manner as to follow the target object position / posture. For example, when the robot 1 is not moved (while maintaining the contact between both feet 22 and 22), the object 120 is pushed and moved. When the user's hand 44 is removed from the object 120, the planned landing position / posture of the free leg foot 22 in each gait is maintained constant over time. In other words, in general, the planned landing position / posture and scheduled landing time of the free leg foot 22 are designed according to the motion of the robot 1 that moves only by the target object motion trajectory. Determined on demand
- the planned landing position / posture of the free leg foot 22 is not slippery after the heel of the free leg foot 22 is landed and the free leg foot 22 is in contact with the floor.
- the landing schedule of the free leg foot 22 By determining the fixed position / posture, the position / posture of the support leg coordinate system in each unit gait is determined in accordance with the support leg coordinate system setting method described above. Specifically, the supporting leg coordinate system in each unit gait is such that the foot 22 of the unit gait immediately preceding the unit gait matches the planned landing position / posture.
- the center force of the ankle joint of the leg 2 having the flat 22 is a coordinate system with the origin at the point where the perpendicular extending to the floor intersects the floor.
- a ZMP trajectory parameter that defines the target ZMP trajectory of the current time's gait is provisionally determined.
- the ZMP trajectory parameters provisionally determined here are determined by the planned landing position / posture and the scheduled landing time of the gait target ZMP (hereinafter referred to as temporary target ZMP), which is stipulated in this step.
- temporary target ZMP the scheduled landing time of the gait target ZMP
- the ground contact surface of the supporting leg foot 22 in this time's gait is present in the vicinity of the center of the ground contact surface (so-called support polygon including the ground contact surface of both foot feet 22 in the both-leg support period) and does not change rapidly. To be determined.
- the tentative target ZMP force of the current time's gait is located in the position where the stability margin of the robot 1 is as high as possible within the contact surface (or support polygon) of the robot 1 and does not change suddenly.
- the ZMP trajectory parameters are determined.
- the temporary target ZMP determined by such a guide has a pattern as shown in FIG. 10 (a), for example.
- Fig. 10 (a) shows the pattern of the position of the temporary target ZMP in the X-axis direction.
- the position and time of the breakpoint of the temporary target ZMP pattern (trajectory) are provisionally determined as the ZMP trajectory parameters.
- the process proceeds to S09, and based on the currently provisionally determined target object motion trajectory and the target object reaction force trajectory, around the temporary target Z MP determined by the currently provisionally determined ZMP trajectory parameters.
- the object reaction force moment trajectory (time series of instantaneous values of the object reaction force moment) is calculated. More specifically, first, based on the target object motion trajectory, the motion trajectory (position and orientation trajectory) of the part of the object 120 to which the hand portions 44R and 44L of the arms 120 and 5 of the robot 120 should be engaged Is determined.
- the position / posture of the part has a predetermined position / posture relationship with respect to the position / posture of the object 120.
- the hand position / posture trajectory of the robot 1 (which defines the trajectory of the point of action of the object reaction force on the robot 1) is obtained so as to match the motion trajectory (position / posture trajectory) of the part.
- each time (at every step) The target reaction force moment around the temporary target ZMP at (time) is calculated.
- the time series of the calculated object reaction force moment is obtained as the object reaction force moment trajectory.
- the robot 1 is moved close to the object 120 from a location away from the object 120, and then the operation of pushing the object 120 by engaging the hand portions 44R and 44L with the object 120 is started.
- the gait parameters are the foot trajectory parameters that define the foot position / posture trajectory in the normal turning gait, the ZMP trajectory parameters that define the target ZMP trajectory, and the object reaction force that defines the target object reaction force moment trajectory. Includes trajectory parameters.
- the normal turning gait is the motion state (foot position / posture, body position) of the robot 1 at the gait boundary (in this embodiment, the gait boundary for each step) when the gait is repeated. It means a cyclic gait that does not cause discontinuities in the posture and other conditions.
- the normal turning gait that is a periodic gait is a gait for two steps of the robot 1, that is, the first turning gait following the current time gait and the first turning gait.
- the gait consisting of the second turning gait is the gait for one cycle of the normal turning gait and the gait is repeated for one cycle.
- turning is used here as a force that can be included in a turn in a broad sense because straight turn means straight turn when the turn rate is zero.
- the normal turning gait may be abbreviated as a normal gait.
- one cycle of the normal gait is composed of at least two steps of gait (two consecutive unit gaits). It is also possible to set a complex normal gait with a gait of three steps or more for one cycle. However, the normal gait is used only to determine the divergent component (details will be described later) at the end of the current gait as described below. Therefore, a gait of 3 steps or more is defined as one cycle. Using a normal gait is less effective despite the complexity of gait generation processing
- the gait for one cycle of the normal gait in this embodiment is configured by gaits for two steps (first and second turning gaits).
- the normal gait composed of two steps of gait is regarded as one step gait.
- the normal gait is a virtual gait that is assumed temporarily (on the arithmetic processing of the gait generator 100) in order for the gait generator 100 to determine the divergent component at the end of the current time gait. It is not output from the content generation device 100 as it is.
- divergence means that the horizontal position of the upper body 3 of the bipedal mobile robot 1 is shifted to a position far from the positions of both feet 22 and 22.
- the value of the divergent component means that the horizontal position of the upper body 3 of the biped robot 1 is the position of both feet 22 and 22 (more specifically, the support leg coordinates set on the ground contact surface of the support foot 22) This is a numerical value indicating how far away from the origin of the system.
- the gait is generated using the divergent component as an index so that the target gait is continuously generated without causing the divergence. That is, after determining the initial divergent component of the normal gait following the current time's gait, the terminal divergent component of the current time's gait matches the initial divergent component of the normal gait (more generally, the current time's gait) The current time's gait is generated (the gait parameter that defines the current time's gait is determined) so that the body position / posture of the body converge to the body position / posture of the normal gait).
- the initial divergent component of the normal gait is based on the gait parameters determined in S11, at the initial stage of the normal gait (initial stage of the first turning gait) and at the end (end of the second turning gait). ) And the normal gait condition that the motion state of the robot 1 is the same (hereinafter referred to as the boundary condition of the normal gait) on the robot 1 dynamic model.
- the basic guideline for generating such a gait is the same as that of PCT International Publication No. WO / 02 / 40224A1 (Patent Document 2) previously proposed by the present applicant. Therefore, in the following description of the normal gait, technical matters different from those described in PCT International Publication No. WO / 02 / 40224A1 will be mainly described, and detailed descriptions of similar technical matters may be omitted. .
- the foot trajectory parameter of the gait parameters of the normal gait is the foot leg 22 and the supporting leg foot 22 at the initial stage and the end of the second turning gait, respectively. It consists of each position and orientation of the free leg foot 22 and the gait cycle of each turning gait. Therefore, the foot position / posture trajectory is determined in the order of the current time gait, the first turning gait, and the second turning gait. A specific setting method will be described below with reference to FIG.
- the initial swing leg position / posture of the first turning gait is the foot position / posture at the end of the current time gait viewed from the support leg coordinate system of the next time's gait.
- the foot / posture position / posture at the end of the gait this time is such that the support foot 22 in the initial stage of the gait is in contact with the floor and that the foot 22 does not slip on the floor.
- This is the position / posture of the supporting leg foot 22 when it is rotated in the pitch direction until it comes into contact (this matches the planned landing position / posture of the free leg foot 22 of the previous gait).
- the position / posture of the next time's gait support leg coordinate system is determined in correspondence with the planned landing position / posture of the free leg foot 22 of the current time's gait as shown in FIG.
- the initial supporting leg foot position / posture of the first turning gait is the free leg foot position / posture of the current time gait as seen from the next time's gait supporting leg coordinate system.
- the free leg foot position / posture at the end of this time's gait is determined to be the position / posture corresponding to the planned landing position / posture of the free leg foot 22 of the current time's gait (or the next time's gait support leg coordinate system determined accordingly). Is done.
- the free leg foot position / posture at the end of the current time gait is determined so that is the planned landing position / posture of the free leg foot 22 of the current time's gait.
- the free leg foot position / posture at the end of the first turning gait is the free leg foot position / posture at the end of the next gait as seen from the next time's gait supporting leg coordinate system.
- This next gait end free leg foot position / posture is the same as the method for determining the current time gait end free leg foot position / posture.
- the position and orientation corresponding to the next gait supporting leg coordinate system) determined in this way are determined.
- the supporting leg foot position / posture at the end of the first turning gait is such that the supporting leg foot 22 whose position / posture coincides with the next time's gait supporting leg coordinate system is kept in contact with the floor and does not slip. Position and posture of the supporting foot foot 22 when the foot foot 22 is rotated in the pitch direction until almost the entire bottom surface of the foot foot touches the floor (this position and posture is the landing position of the free leg foot 22 of this time's gait) Agree with the planned position).
- the initial free leg foot position / posture of the second turning gait is the supporting leg foot position / posture at the end of the first turning gait as seen from the next time's gait supporting leg coordinate system.
- 2nd turning gait initial support leg foot position / posture Is the free leg foot position / posture at the end of the first turning gait as seen from the next time's gait supporting leg coordinate system.
- the free leg foot position / posture at the end of the second turning gait is the position / posture when viewed from the next time's gait supporting leg coordinate system. It is determined to match the foot position / posture.
- the foot position / posture of the supporting leg at the end of the second turning gait is the position / posture viewed from the next time's gait supporting leg coordinate system. It is determined to match the posture.
- the gait cycle of the first turning gait and the second turning gait is the next gait cycle (this is the scheduled landing time of the free leg foot 22 of the current time gait and the free leg foot of the next time gait 22). It is set to be the same as the estimated landing time.
- the gait cycles of the first turning gait and the second turning gait do not necessarily need to be the same, but it is preferable to determine both cycles according to at least the next gait cycle.
- the movement parameters (including time parameters such as both leg support periods) of the current time's gait, the first turning gait and the second turning gait are determined according to the parameters determined above. Determine appropriately so as to satisfy the conditions (for example, whether the speed of the actuator is within the allowable range, whether it does not exceed the movable angle, or does not interfere with the floor, etc.).
- the ZMP trajectory parameter is the same as when the target ZMP trajectory parameter is provisionally determined in S07. It is decided not to make a drastic change with a high margin.
- the object reaction force moment trajectory parameter of the normal gait is determined so as to satisfy the condition of periodicity. For example, assume that the object reaction force moment trajectory corresponding to the current time's gait, the next time's gait and the next time's gait is as shown in Fig. 12 (a). Here, the object reaction force moment trajectory of the gait this time is the trajectory obtained in S09. The object reaction moment trajectory of the next gait is based on the object reaction force trajectory and target object trajectory of the next gait obtained in S03, and the ZMP trajectory defined by the ZMP trajectory parameters of the normal turning gait. It is a trajectory calculated in the same way as S09.
- the object reaction force moment trajectory of the next gait is the steady state of the object reaction force trajectory and target object motion trajectory of the next gait obtained in S03.
- the trajectory is calculated in the same way as S09 based on the ZMP trajectory defined by the ZMP trajectory parameters of the turning gait.
- the object reaction force moment trajectory parameter of the normal turning gait is determined so that the object reaction force moment trajectory of the normal turning gait becomes the trajectory shown in Fig. 12 (b), for example. .
- the object reaction force moment trajectory from the beginning to the end of the first turning gait of the normal turning gait continues to the object reaction force moment trajectory of the current time gait, and the object of the next gait. It is determined to coincide with the reaction force moment trajectory.
- the object reaction force moment trajectory of the second turning gait in the normal turning gait is continuous with the object reaction force moment trajectory of the first turning gait and immediately before the end of the initial force of the second turning gait.
- the object reaction force moment trajectory of the next gait coincides with the object trajectory moment trajectory, and from the time tx to the end, the initial value of the first turning gait (the steady turning gait) It is determined to continuously change to the same value as the initial value.
- the time tx corresponds to the time of the break point of the ZMP trajectory of the normal turning gait, for example.
- the processes of S05, S09, and SI1 correspond to the periodic gait parameter determining means in the first and second inventions of the present invention.
- the foot trajectory parameters, ZMP trajectory parameters, and object reaction force moment trajectory parameters determined in S11 are parameters that define the motion trajectory of leg 2 in the normal gait, which is a periodic gait.
- the target object motion trajectory is the “leg” in the first invention.
- the initial divergent component of the normal turning gait is determined.
- the initial state of motion of the first turning gait is determined on the dynamic model determined by the robot 1. Movement of the second turning gait
- the initial divergent component of the normal turning gait is determined so that the terminal state (including the terminal divergent component) matches.
- FIG. 13 shows the structure of the robot simplification model.
- the simplified robot model shown in the figure is a three-mass model.
- the dynamics of the leg 2 and the upper body 3 are configured to be non-interfering with each other, and the overall dynamics of the robot 1 is , Represented by their linear combination.
- This robot simple model consists of an inverted pendulum A and two leg mass points 2m and 2m (support leg mass point and free leg mass point).
- Each leg mass point 2m is a mass point corresponding to each leg 2.
- Each foot mass point 2m is a fixed point in the local coordinate system that is arbitrarily fixedly set on the foot 22 of the corresponding leg 2 and its position corresponds to each foot position / posture. It is supposed to be determined uniquely. For example, each foot mass point 2m is set to a point shifted from the representative point of the bottom surface of the foot 22 toward the ankle joint by a predetermined distance by force toward the center of the ankle joint.
- Inverted pendulum A is composed of a free fulcrum a that moves horizontally, one mass point b, and a variable-length link c that connects fulcrum a and mass point b without mass. In this case, even if the link c is inclined, the link c expands and contracts, and the height h of the mass point b viewed from the fulcrum a is kept constant.
- the mass point b of the inverted pendulum A corresponds to the mass point of the upper body 3 of the robot 3, and hereinafter, the inverted pendulum mass point b is changed to the upper mass point b. Sometimes it is.
- the position of the inverted pendulum mass point b is hereinafter referred to as the inverted pendulum position for short.
- the mass of the upper mass point b includes the mass of the upper body 3 and the masses of the arm bodies 5 and 5 and the head 4.
- the horizontal position of upper body 3 of robot 1 is geometrically determined from the horizontal position of inverted pendulum mass point b Is done. Specifically, for example, the horizontal position of the representative point of the upper body 3 (the XY coordinates seen in the support leg coordinate system), that is, the horizontal component of the upper body position matches the horizontal position of the inverted pendulum mass point b. Is done. In other words, as shown in FIG. 13, the representative point of the upper body 3 and the inverted pendulum mass point b are on the same vertical line.
- inverted pendulum ZMP Since ZMP of inverted pendulum A is at the position of free fulcrum a (no moment is generated around fulcrum a), the position of fulcrum a of inverted pendulum A will be referred to as inverted pendulum ZMP. Call it ZMPpend.
- msup Mass of support leg mass 2m
- mswg Mass of free leg mass 2m
- mb Mass of inverted pendulum mass b
- xsup Position of supporting leg mass point 2m
- xswg Position of free leg mass point 2m
- xb Inverted pendulum position (position of upper mass point b)
- H Inverted pendulum height (height from inverted pendulum A fulcrum a to inverted pendulum mass point b)
- xb, xsup, and xswg are represented by three-dimensional vectors (XYZ coordinate vectors).
- dX / dt represents the first derivative of X
- d2X / dt2 represents the second derivative of X
- g represents a gravitational acceleration constant
- G is a gravitational acceleration vector whose X, Y, and Z components are 0, 0, and 1 g, respectively.
- Equation 01 is a dynamic definition of the total moment of inertia around the point P.
- Leg ZMP is described as ZMPfeet and defined by Equation 02. However, the height of the leg ZMP (Z component of ZMPfeet) is the same as the height of the point P. This leg ZMP is a value that artificially corresponds to the resultant force of the inertial force and gravity generated by the motion of both legs 2 and 2.
- the action point P is set so that the approximation accuracy of the robot simple model increases.
- the action point P related to the current time's gait moves from the origin of the support leg coordinate system of the previous time's gait to the origin of the support leg coordinate system of the current time's gait in a straight line at a constant speed during both leg support periods.
- the current gait support leg coordinate system is set to be maintained at the origin. The same applies to the action point P related to the first turning gait and the second turning gait of the normal turning gait.
- the object reaction force moment around the target ZMP divided by the total mass mtotal of the robot 1 is defined as the object reaction force ZMP, which is described as ZMPobj. That is, ZMPobj is defined by the following equation 03.
- ZMPobj Object reaction force moment around target ZMP Zmtotal — Formula 03
- the target ZMP, leg ZMP (ZMPfeet), inverted pendulum ZMP (ZMPpend), and object reaction force ZMP are approximately The linear relationship of Equation 04 holds.
- Formula 04 is a relational expression on the sagittal plane (XZ plane). On the lateral plane (YZ plane), the sign of the third term on the right side of Formula 03 is " Invert from "1" to "+”.
- the target foot position / posture, the target reaction force moment around the target ZMP, the target ZMP, and the target body posture are calculated by the following dynamic calculations.
- the target body position can be determined from the above.
- the leg ZMP calculator 220 calculates the above equations 01 and 02. Is used to calculate the leg ZMP (ZMPfeet).
- the object reaction force ZMP (ZMPobj) is calculated by multiplying the object reaction force moment around the target ZMP by lZmtotal by the multiplication unit 222. Then, the calculated ZMPfeet multiplied by mfeetZmtotal at the multiplication unit 224 and ZMPobj are subtracted from the target ZMP at the subtraction unit 226, and the subtraction result is multiplied by mtotalZmb at the multiplication unit 228. The right-hand side of is computed. Thus, the inverted pendulum ZMP (ZMPpend) is calculated. The ZMPpend obtained by the above arithmetic processing is on the sagittal plane. When calculating the ZMPpend on the lateral plane, the subtraction unit 226 uses the result of inverting the sign of the operation result of the multiplication unit 222. Enter it.
- the inverted pendulum horizontal position xb is calculated based on the above-described equation 05. Furthermore, based on the horizontal position xb of the inverted pendulum and the target body posture, the body position determiner 230 determines the target body position. In this case, the body position determiner 230 sets the inverted pendulum horizontal position xb as the target body horizontal position. Further, the target body vertical position is determined based on the target body posture, for example, by the body height determination method previously proposed by the present applicant in Japanese Patent Laid-Open No. 10-86080.
- the initial divergence of the normal gait is generated based on the robot simple model described above. Determine the minutes. If the divergence component in the gait is set as q and the horizontal velocity (or body horizontal velocity) vb of the mass point b of the inverted pendulum A is set as vb, q is defined by the following equation 06 in this embodiment.
- ⁇ is the natural frequency of the inverted pendulum ⁇ , that is, the square root of gZh.
- Equation 07 is an equation describing the divergent component q on the sagittal plane, and the equation describing the divergent component q on the lateral plane is the sign of the entire fourth term on the right side of Equation 07. The expression is reversed from “one” to “+”.
- the divergence component hereinafter referred to as the initial divergence component
- the divergence component in the initial stage of the normal turning gait (the initial stage of the first turning gait) and the divergence component (hereinafter referred to as the end of the second turning gait) Focusing on the terminal divergence component and! /, U)
- q [0] the divergence component at time 0
- q [k] the divergence component at time kAt
- the first term on the right side of Expression 07 represents the terminal divergence component generated by the initial divergence component.
- the second term on the right side represents the terminal divergence component generated by the target ZMP pattern.
- the third term on the right-hand side represents the terminal divergent component generated by the movement of both legs 2 and 2 (movement of both leg mass points 2m and 2m).
- the fourth term on the right side represents the terminal divergence component generated by the object reaction force moment pattern.
- the second term on the right side is written as Wzmptotal
- the third term on the right side is written as Wfeet
- the fourth term on the right side is written as Wobj. That is, Wzmptotal, Wfeet, Wobj are defined by the following equations 08a, 08b, 08c.
- Formula 08c defines Wobj on the sagittal plane, and Wobj on the lateral plane is obtained by inverting the sign of the right side of Formula 08c.
- the support leg coordinate system of the gait next to the normal turning gait (the next gait support leg coordinate system in Fig. 11 (X "' Y" ' The coordinate system)) is converted to a value described in the support leg coordinate system of the normal turning gait (next gait support leg coordinate system ( ⁇ ' ⁇ 'coordinate system) in Fig. 11). If the rotation matrix for ⁇ is ⁇ and the translation vector of the coordinate origin is ⁇ , the following equation 11 is obtained.
- inv () is the inverse of the matrix in parentheses. Yes, I is the identity matrix.
- the initial divergent component q [0] that satisfies the boundary condition of the normal turning gait is determined based on this equation 13.
- Wzmptotal may be calculated by an algorithm using the fact that the target ZMP trajectory is a polygonal trajectory as described in PCT International Publication WO / 02 / 40224A1!
- each foot at each time i At (i 0, 1,..., K 1) of the normal turning gait.
- ZMPfeetD is obtained by obtaining the instantaneous value of the flat position and posture and applying it to the expression expressing the above-mentioned expressions 01 and 02 in a discrete system.
- the foot position / posture is calculated for each foot 22 by using, for example, a time limit settling filter proposed by the present applicant in Japanese Patent No. 3233450.
- the calculated foot position / posture trajectory is such that the free leg foot 22 in each of the first turning gait and the second turning gait of the normal turning gait rises from the start time of the one-leg support period.
- the free leg foot 22 moves toward the planned landing position, and at the scheduled landing time of the free leg foot 22, the free leg foot 22 lands at a position corresponding to the planned landing position. Orbit.
- Wfeet is calculated by calculating the right side of the above-mentioned expression 08b.
- the foot position / posture trajectory is fixed. The trajectory is maintained at the landing position / posture. However, raise the free leg foot 22 once, Thereafter, a foot position / posture trajectory may be generated so as to return to the original landing position / posture.
- the step time ⁇ t used in the calculation of Wzmptotal, Wfeet, Wobj is the gait generator 10
- the initial divergence component q [0] is obtained analytically.
- the initial divergence of the normal turning gait that almost matches the terminal divergence component of the normal turning gait as seen by the supporting leg coordinate system force of the gait following the normal turning gait following the current gait Try to determine the ingredients.
- the gait parameters are the foot trajectory parameter that defines the foot position / posture trajectory in the current gait, the ZMP trajectory parameter that defines the target ZMP trajectory, and the object reaction force trajectory parameter that defines the target object reaction force moment trajectory. including.
- the foot trajectory parameter of the gait parameters of the current time's gait is the position and orientation of the supporting leg foot 22 and the free leg foot 22 at the beginning and end of the current time's gait, It consists of a gait cycle.
- the initial position of the foot in the initial gait of the current time's gait is that of the current time's gait at the end of the previous time's gait as seen from the current time's gait supporting leg coordinate system.
- Flat position / posture supporting leg foot position / posture of previous gait).
- This time's initial gait support leg foot position / posture is the support leg foot position / posture of the current time's gait at the end of the previous time's gait, as seen from the current time's gait support leg coordinate system.
- the free leg foot position / posture at the end of the current time's gait is determined according to the planned landing position / posture of the free leg foot 22 of the current time's gait. Specifically, the position when the free leg foot 22 of the current time's gait is rotated by a predetermined angle in the pitch direction so that it does not slide from the foot position / posture at the end of the current time's gait.
- the free leg foot position posture of the current time gait is determined so that the posture becomes the planned landing position / posture of the current time gait.
- the foot position / posture at the end of the current time's gait is determined so that the foot 22 does not slip while the foot 22 is in contact with the floor and the position / posture is matched to the coordinate system of the current time's gait.
- the position and posture of the supporting leg foot 22 when the foot is rotated in the pitch direction until almost the entire bottom surface touches the floor (this position and posture is the planned landing position and posture of the free leg foot 22 of the previous gait). Match).
- the supporting leg foot 22 at the end of the current time's gait is in a posture substantially parallel to the floor surface, but this is not necessarily required. For example, at the end of the gait, make sure that the heel side of the foot 22 is away from the floor.
- the ZMP trajectory parameters are set to be the same as the ZMP trajectory parameters provisionally determined in S07. Therefore, the target ZMP trajectory defined by this ZMP trajectory parameter has a pattern as shown in FIG. 10 (a), for example.
- the object reaction force moment trajectory parameter of the gait parameters of the current time's gait is the object reaction force moment trajectory defined by the object reaction force moment trajectory calculated in S09. It is determined to match the trajectory corresponding to this time's gait.
- the processes in S05, S07, S09, and S15 correspond to the current time gait parameter provisional determination means in the first and second inventions of the present invention.
- the foot trajectory parameters, ZMP trajectory parameters, and object reaction force moment trajectory parameters determined in S15 are the parameters that define the leg motion trajectory in the current gait and the floor reaction in the current gait, respectively. It corresponds to a parameter that defines the force and a parameter that defines the trajectory of the external force.
- the ZMP trajectory parameters of the gait parameters provisionally determined in S15 are corrected so that the current time's gait converges to the normal turning gait. More specifically, steady rotation The ZMP trajectory parameters are modified so that the final divergence component of the current time's gait approximately matches the initial divergence component of the gait.
- the temporary target ZMP in order to make the final divergent component of the current time's gait almost coincide with the initial divergent component of the normal turning gait, the temporary target ZMP has a ZMP as shown in FIG. 10 (b). By adjusting the correction amount, the temporary target ZMP is corrected, thereby obtaining the target ZMP as shown in FIG. 10 (c).
- the basic guideline for the process of correcting the temporary target ZMP is the same as that of PCT International Publication No. WO / 02 / 40224A1. is doing.
- the process of S17 will be specifically described below with a focus on the differences.
- variables having the same meaning as described for the process for determining the initial divergent component of the normal gait (S13) are defined above for the normal gait.
- the correction of the XMP direction component of ZMP is explained for convenience of understanding.
- the ZMP correction amount is trapezoidal as shown in FIG. 10 (b), and its height is a.
- the trapezoid break point time is set according to the break point time of the temporary target ZMP trajectory as shown.
- the ZMP correction amount is generated during the one leg support period of the current time's gait.
- Equation 15 k A t is the end time of the current gait, q [0] Is the initial divergent component of the current time's gait, Wfeet is the final divergent component generated by the movement of both legs 2 and 2 of the current time's gait, and Wobj is the final divergent component generated by the object reaction force moment trajectory of the current time's gait.
- Equation 16 the trapezoidal height of the ZMP correction amount
- the initial divergence component q [0] is calculated from the inverted pendulum position (or body position) at the beginning of the current time's gait and its rate of change, using Equation 06. It is obtained in the same way as when Wzmptotal related to the normal turning gait is obtained from the temporary target ZMP trajectory defined by the ZMP trajectory parameters provisionally determined in S 15.
- Wtrim is determined by setting trapezoidal height a to 1.
- the ZMP trajectory parameter is corrected by adding the ZMP correction amount determined by the trapezoidal height a thus obtained to the temporary target ZMP trajectory.
- the ZMP correction amount is analytically obtained, but may be obtained exploratively.
- the current time's gait is temporarily created using the target ZMP trajectory obtained by correcting the temporary target ZMP with the ZMP correction amount in which the trapezoid height a is set to an appropriate value, and the temporary gait is created.
- the process of correcting the trapezoidal height a value so as to reduce the differential force is repeated.
- the terminal divergence component of the current gait created temporarily is used as the initial gait of the normal gait.
- the ZMP correction amount should be determined based on the value of trapezoidal height a when the diffuse component almost matches.
- the processing of S17 corresponds to the parameter correcting means in the first and second inventions of the present invention.
- the ZMP trajectory parameter is the parameter to be corrected.
- the routine proceeds to S19, where it is determined whether or not the target ZMP determined by the corrected ZMP trajectory parameter is appropriate. Specifically, the target ZMP force after correction If the ground contact surface force of the support leg foot 22 of this time's gait does not deviate or is not biased near the boundary of the contact surface, that is, the stability margin of robot 1 If it can be secured, it is judged that the target ZMP is appropriate. Otherwise, it is judged that the target ZMP is inappropriate.
- the process proceeds to S21, and the target object related to the elements related to parameters other than the ZMP trajectory parameters of the current time's gait parameters, for example, the object reaction force trajectory parameters. Correct the reaction force trajectory.
- the target object reaction force trajectory is determined so that the ZMP correction amount becomes as small as possible when the processing of S09 to S17 is performed again after the correction (at least before the target object reaction force trajectory is corrected). It will be corrected (to be smaller than the ZMP correction amount).
- the target object motion trajectory (position trajectory) based on the movement plan decelerates the object 120 in the X-axis direction from time tl and stops it at time t3.
- the graph g3 in FIG. 15 (a) is an example of the target body position trajectory determined in accordance with the target object motion trajectory.
- the ground contact surface of the supporting leg foot 22 may be deviated (in this case, the judgment result in S19 is NO). If the target gait continues to be generated as it is, a target gait that collides with the object 120 at a certain time t4 is generated as shown in the figure.
- the target object reaction force is set to the current time as shown in Fig. 15 (b) with respect to the target object reaction force trajectory temporarily determined in S03 as described above.
- a period after t2 Within ⁇ 1 the target object reaction force trajectory is corrected so as to increase in the negative direction of the X axis.
- the target object reaction force is corrected so that the acting force applied to the object 120 from the robot 1 (the force obtained by inverting the sign of the target object reaction force) is increased in the positive direction of the X axis.
- the period ⁇ 1 during which the target object reaction force is increased or the magnitude of the increase A F1 is determined by the ZMP correction amount determined by the processing of S09 to S17 based on the target object reaction force after the correction.
- the determination result of S19 is YES.
- Such ⁇ T1 or ⁇ F1 can be obtained analytically or exploratoryly.
- the object in the current time's gait parameter is set so that the motion of the upper body 3 is performed so that the robot 1 positively pushes the object 120.
- the reaction force moment trajectory parameter is determined by S15.
- the target gait generated based on the gait parameters this time is such that the upper body 3 of the robot 1 does not collide with the object 120 while ensuring a stability margin. .
- the processing of S23 corresponds to the robot future behavior predicting means in the seventh invention of the present invention.
- this geometrical constraint condition is that the presence or absence of interference between the object 120 and the robot 1 (such as the upper body 3 hitting the object 120) and the rotational angle of the joint of each arm body 3 are mechanically limited. It is a condition such as the power to stay within.
- the presence / absence of interference between the upper body 3 of the robot 1 and the object 120 can be determined from the target body position / posture and the target object motion trajectory. Further, since the rotation angle of the joint of each arm body 3 can be determined from the target body position / posture and the target hand position / posture, it is possible to determine whether the rotation angle is within the mechanical limits or not.
- the determination processing in S25 is sequentially performed on instantaneous values such as the desired body posture at predetermined time intervals until the current time force is also at the end of the second turning gait. That is, if the determination result in S25 is OK for each instantaneous value, it is determined in S27 whether or not the check for all times from the current time to the end of the second turning gait has been completed. . If the determination result in S27 is NO, the determination process in S25 is repeated.
- the target object movement trajectory (position trajectory) in the X-axis direction based on the movement plan at the current time tl is the trajectory indicated by graph g4 in the figure (hereinafter referred to as the original trajectory and ⁇ ⁇ )
- the original trajectory and ⁇ ⁇ the trajectory indicated by graph g4 in the figure.
- the target object motion trajectory (position trajectory) in the interval ⁇ T2 is changed to the corrected trajectory shown in graph g5.
- This modified trajectory g5 is determined so as to be smoothly connected to the original trajectory g4 at both ends of the period ⁇ 2 in order to avoid a sudden change in the behavior of the robot 1.
- the shift amount ⁇ ⁇ at time t2 is adjusted so that there is no interference between the upper body 3 of the robot 1 and the object 120 (in S25). It is decided so that the judgment result is OK.
- the corresponding time to be the judgment result force SNG of S25 is used instead of correcting the target object motion trajectory as explained in the case of correcting the target object motion trajectory. It may be possible to correct the planned landing position / posture of the free leg foot 22 in the gait including it. For example, if interference occurs at time t2 as shown in FIG. 16, the planned landing position / posture for the gait including that time t2 is adjusted to a position / posture away from the object 120 in the X-axis direction. Correct it. Alternatively, correct both the target object motion trajectory and the planned landing position / posture.
- This calculation process is performed as follows. That is, the instantaneous value of the desired foot position / posture is calculated based on the foot trajectory parameter of the current time gait parameters. This calculation process is performed by using the finite-time settling filter proposed by the present applicant in Japanese Patent No. 3233450 in the same manner as described for the process of calculating ZMPfeetD] in the process of S13. Calculated every 22nd.
- the instantaneous value of the target ZMP is calculated based on the ZMP trajectory parameter of the current time's gait parameters, and the instantaneous target reaction force moment is calculated based on the target reaction moment moment trajectory parameter. A value is calculated.
- the target body posture is, for example, a vertical posture.
- the target body posture may be changed without having to maintain the vertical posture.
- the simplified robot model be a dynamic model that takes into account the change in the angular momentum of the robot 3 due to the change in the posture of the upper body 3.
- each leg 2 has six degrees of freedom, so if the target body position / posture and the desired foot position / posture are determined, the rotation angle of each joint of each leg 2 is uniquely determined. Determined.
- the target body position / posture obtained in S31 is further corrected by the process of S39 described later.
- the process proceeds to S33, and based on the previous value of the final corrected target hand position (the value in the previous calculation processing cycle), in the previous calculation processing cycle (the calculation processing cycle of the gait generator 100).
- the actual position of the target object 120 is estimated.
- the final corrected target hand position is obtained by the arm main control device 106 described later, and corresponds to a command value for the actual hand position of the robot 1. Therefore, for example, the previous value of the final corrected target hand position is set as the previous value of the actual hand position of the robot 1, and a position having a predetermined relative positional relationship with this is estimated as the actual object position. It is also possible to mount a gyro sensor or an acceleration sensor on the object 120 and estimate the actual object position from the detected values.
- FIG. 17 is a block diagram showing a calculation process for obtaining the target object position, the target object reaction force, and the estimated disturbance force in the target object motion in S03, and a part denoted by reference numeral 238 in the figure.
- the object dynamic model represents the relationship between the force acting on the object 120 and the movement of the object 120. Since this object dynamic model is partially different from that shown in Fig. 9, in the following explanation, the object dynamic model in Fig. 17 is different from the object dynamic model in Fig. 9. To distinguish, object dynamics model 2 and!
- the basic structure of this object dynamic model 2 is the same as that of the object dynamic model shown in Fig. 9, and the force acting on the object 120 (more specifically, the translational force in the horizontal direction) is input.
- the input value the value obtained by the multiplier 242 described later
- the inverse 1ZM of the mass M of the object 120 by the multiplier 244
- the motion acceleration of the object 120 is obtained.
- 250 for sequential integration (double integration).
- the integrator 250 adds the model speed manipulated variable in addition to the output of the integrator 246 (integral value of motion acceleration). It is designed to be input automatically.
- This model speed manipulated variable is a speed manipulated variable determined by the feedback control law so that the deviation between the actual object position and the target object position approaches 0 by the model speed manipulated variable determining unit 252.
- the form is determined by the following equation 17.
- the model speed manipulated variable is determined by the PI position law (proportional integral control law) as well as the object position deviation force.
- Kel and Ke2 are predetermined gains.
- the model speed manipulated variable determining unit 252 in FIG. 17 is an arithmetic processing unit that performs the calculation of the right side of Equation 17. That is, the model speed manipulated variable determination unit 252 determines the actual object position (current value obtained in S33 in the current computation processing cycle) and the target object position (previous value obtained in S35 in the previous computation processing cycle).
- the object position deviation which is the difference between them, is obtained by the subtraction unit 254.
- the obtained object position deviation is multiplied by the gain Kel by the multiplier 256 (proportional term), and the object position deviation multiplied by the gain Ke2 by the multiplier 258 is further integrated by the integrator 260.
- the model speed manipulated variable is calculated by adding the product (integral term) by the adder 262.
- the calculated model speed manipulated variable is added to the output of the integrator 246 by the adder 248 provided on the input side of the integrator 250 of the object dynamic model 2 and then input to the integrator 250. .
- the model speed manipulated variable determining unit 252 may be input to the object dynamic model 2 in an additional manner.
- the integrator 260 is omitted, and the output of the multiplier 258 is additionally input to the integrator 246. At this time, the sum of the output of the integrator 246 and the output of the multiplier 256 is input to the integrator 250. You may make it input. Even in this case, the output of the object dynamic model 2 (the output of the integrator 250) is the same as that of FIG.
- the output of the adder 248 integrated by the integrator 250 is obtained as the instantaneous value of the target object position. Further, the output of the adding unit 248 becomes the object model speed that is the moving speed of the object 120 on the object dynamic model 2.
- the required value of the acting force (translation force) on the object 120 is the target object motion trajectory (the target when the judgment result in S27 is YES)
- Multiplier 242 adds a predetermined gain Kv to the deviation (target object speed minus object model speed) obtained by subtractor 240 from the target object speed based on the object motion trajectory) and the object model speed. It is obtained by multiplication.
- the required value of the translational force input to the object dynamic model 2 is the same as that in FIG. 9, so that the deviation between the object target speed and the object model speed converges to 0. In this example, it is determined by the proportional control law).
- the object model speed in this case is the output of the adder 248 as described above. Therefore, unlike the one in Fig. 9, the model speed manipulated variable is taken into account.
- the target object speed is obtained as the first derivative of the position trajectory of the current target object motion trajectory.
- a value obtained by inverting the sign of the required value of the translational force obtained as described above is obtained as an instantaneous value of the target object reaction force. Further, the required value of the translational force is input to the multiplication unit 244 of the object dynamics model 2, and the model speed manipulated variable is input to the addition unit 248, whereby the object dynamics model 2 The instantaneous value of the target object position is output from the integrator 250.
- the part denoted by reference numeral 264 in Fig. 17 is an estimated disturbance force determining unit that performs processing for obtaining the estimated disturbance force.
- the estimated disturbance force determination unit 264 receives the object model speed and the required value of the translational force.
- the object model velocity is input to a conversion unit 266 represented by a transfer function of the form M ′ sZ (Tc ′ s + l), and the conversion unit 266 determines the translational force acting on the object 120.
- An estimate is calculated.
- M in the transfer function of the conversion unit 266 is the mass of the object 120
- Tc is a predetermined time constant.
- the estimated value calculated by the conversion unit 266 is obtained by adding the first order of the time constant Tc to the translational force that generates the motion acceleration (differential value of the object model speed) of the object 120 on the object dynamic model 2. It follows with a delay. Further, the estimated value of the translational force is also subtracted by the subtraction unit 268 from the required value of the translational force that is the output of the multiplication unit 242 to calculate the instantaneous value of the estimated disturbance force. The instantaneous value of the estimated disturbance force obtained here is used in the calculation process of S02 (see Fig. 9) as described above.
- the estimated disturbance force determining unit 264 corresponds to the object disturbance force estimating means in the eighth invention of the present invention.
- the instantaneous value of the target object posture in the target object motion is determined so as to substantially match the direction of the target object speed, for example.
- the process proceeds to S37, and the instantaneous value (current value) of the target hand position / posture is determined based on the instantaneous value of the target object motion obtained in S35.
- the instantaneous value of the target hand position / posture is obtained in the same manner as when the target hand position / posture trajectory is obtained in S09. [0201]
- the desired body position / posture is obtained by using the robot simple model to calculate the target Z MP on the robot simple model. It is calculated so that it is satisfied (so that the resultant force of the inertial force, gravity, and object reaction force moment of robot 1 is zero in the horizontal component of the moment generated around the target ZMP). Therefore, the target gait obtained by the processing up to S37 is a gait in which the horizontal component of the floor reaction force moment around the target ZMP is zero on the robot simple model.
- the robot simple model has a great advantage in that it can effectively reduce the computation load of the gait generator 100, the dynamic accuracy is not necessarily high. Absent. Therefore, in this embodiment, a part of the target gait (specifically, using a robot dynamic model with high dynamic accuracy (hereinafter referred to as a full model) (specifically, Correct the target body position / posture instantaneous value and the floor reaction force moment instantaneous value around the target ZMP). This correction process is called full model correction, and this full model correction is executed in S39 after the process of S37.
- a full model specifically, Correct the target body position / posture instantaneous value and the floor reaction force moment instantaneous value around the target ZMP.
- This full model correction is performed, for example, in exactly the same way as described in Japanese Patent Laid-Open No. 2002-326173 previously proposed by the applicant of the present application. Therefore, the description in this specification is omitted.
- the full model correction may be performed, for example, in the same manner as described in PCT International Publication No. W 0 03/057427 A1 by the present applicant.
- the processing of S31 to S39 corresponds to the current time gait instantaneous value determining means in the first and second inventions of the present invention.
- the robot 1 When the robot 1 is moving while pushing the object 120, there is a step (a convex part of the floor) that is not assumed in the current movement plan (such as the movement plan as described above).
- Object 1 When an unexpected external force other than robot 1 is applied to 20, there is a difference between the target object motion trajectory based on the movement plan and the actual object motion trajectory (hereinafter referred to as the actual object motion trajectory). growing.
- the gait generator 100 generates a gait by determining a gait meter or the like based on the target object motion trajectory, and therefore, there is a difference between the target object motion trajectory and the actual object motion trajectory. If it becomes excessive, it will be difficult to generate a gait that can ensure the continuous stability of the robot 1. Therefore, in S01 in the present embodiment, when the deviation becomes large to some extent (or is predicted to increase), the movement plan determined in S01 is corrected in real time.
- the current movement plan (before modification) is a dredging plan when the object 120 is moved in the positive direction of the X axis at a constant speed.
- movement plan before correction based on the movement plan before correction (hereinafter referred to as movement plan before correction), the target object position trajectory of the target object motion trajectory (time series of instantaneous values) calculated in S35 as described above. Is almost orbital as shown by graph g6 in Fig. 18 (a).
- the target object 120 stops at time tl due to the pulling force of the actual target object 120 on the floor step (convex part) that is not expected in the pre-correction movement plan.
- the trajectory of the actual object position (the time series of the actual object position estimated in S33) is a trajectory as shown by the graph g7 in FIG. 18 (a).
- the deviation between the target object position based on the pre-correction movement plan and the actual object position increases with time.
- the object position deviation difference between the actual object position and the target object position obtained in S35 of the previous calculation processing cycle, that is, the difference obtained by the subtraction unit 254 in FIG.
- the magnitude (absolute value) of the figurine position deviation is compared with a predetermined value.
- the object position deviation becomes larger than the predetermined value (time t2 in FIG. 18 (a)
- the object position deviation as shown by the graph g8 in FIG. 18 (a) is obtained.
- the pre-correction movement plan is corrected to suppress the increase.
- the corrected movement plan is hereinafter referred to as a corrected movement plan.
- a corrected movement plan In the example of FIG.
- the corrected movement plan is a movement plan that gradually decelerates the moving speed of the object 120 until it becomes almost zero after time t2.
- the post-correction movement plan is determined so that the target object motion specified thereby is smoothly continuous without causing a sudden change with respect to the pre-correction movement plan.
- the followability of the actual object position to the target object position trajectory corresponding to the corrected movement plan is as follows. If the difference between the target object motion trajectory and the actual object motion trajectory becomes small to some extent, the travel plan is corrected so that the corrected travel plan approaches the pre-correction travel plan. This revised movement plan is hereinafter referred to as the revised revision plan.
- the movement speed of the object 120 based on the movement plan after re-correction is made closer to the movement speed based on the movement plan before correction, but the target object position trajectory based on the movement plan after re-correction. Can be made closer to the object position trajectory based on the pre-correction movement plan.
- the process of correcting the movement plan in S01 as described above corresponds to the process of correcting the movement plan in the ninth aspect of the present invention.
- the target body position / posture trajectory, the target ZMP trajectory, and the target object reaction force trajectory are input to the object reaction force balance controller 102.
- the object reaction force balance controller 102 eliminates the deviation between the target object reaction force and the actual object reaction force that is the reaction force that the actual robot 1 receives from the object 120 (closes to 0).
- Target Compensation for target reaction force balance control to correct the target floor reaction force moment around ZMP Calculates the total floor reaction force and corrects the target body position / posture of the target motion The body position / posture is obtained.
- the processing of the object reaction force balance control device 102 will be described later.
- this object reaction force balance control apparatus 102 corresponds to the gait instantaneous value correcting means in the tenth aspect of the present invention.
- the desired foot position / posture trajectory, the desired ZMP trajectory, and the desired total floor reaction force trajectory in the desired gait are input to the leg main control device 104.
- the leg main controller 104 inputs the corrected target body position / posture and the compensated total floor reaction force for the object reaction force balance control from the object reaction force balance controller 102.
- the leg main control device 104 uses a joint control actuator (electric motor) for the legs 2 and 2 to follow the movement of the target gait (except for the movements of the arms 5 and 5) and the floor reaction force by compliance control processing. ) To control.
- the restored total floor reaction force that should be generated in the target ZMP is calculated and applied to the target ZMP.
- the actual total floor reaction force moment component (which is obtained from the detection values of the 6-axis force sensor 50 of the legs 2 and 2) is the restored total floor reaction force, the desired total floor reaction force, and the object reaction force balance.
- the desired foot position / posture is corrected so that it matches the moment component of the resultant force with the control compensation total floor reaction force.
- the corrected target foot position / posture is referred to as a corrected target foot position / posture.
- the main leg control device 104 then moves the two leg bodies 2 so that the actual joint displacement follows the target joint displacement of both legs 2 and 2 determined from the corrected target foot position / posture and the corrected target body position / posture.
- 2 joint actuators are controlled (motor drive commands for each leg 2 are output to each joint actuator).
- the target hand position / posture trajectory and the target object reaction force trajectory of the target gait In-control device 106 is input to the arm main control device 106 from the object reaction force balance control device 102.
- the arm main controller 106 controls the joint actuator (electric motor) of the arm bodies 5 and 5 so as to follow the target hand position / posture trajectory and the target object reaction trajectory by compliance control processing. More specifically, the target hand position / posture is corrected according to the difference between the detected value (actual object reaction force) of the 6-axis force sensor 52 and the target object reaction force.
- the corrected target hand position / posture is referred to as a final corrected target hand position / posture.
- the arm main controller 106 then moves the arms 5 and 5 so that the actual joint displacement follows the target joint displacement of the arms 5 and 5 determined from the final corrected target hand position and posture and the corrected target body position and posture. , 5
- the joint actuator is controlled (the motor drive command for each arm 5 is output to each joint actuator).
- leg main control device 104 and the arm main control device 106 correspond to the control means in the ninth invention of the present invention.
- FIG. 19 is a block diagram functionally showing the processing of the object reaction force balance control apparatus 102.
- the target object reaction force moment around the target ZMP by the target object reaction force and the actual object reaction force moment around the target ZMP by the actual object reaction force are calculated.
- the object reaction force moment deviation which is a deviation, is calculated by the moment deviation calculation unit 270.
- the target object reaction force moment includes the target object reaction force and target ZMP output from the gait generator 100, and the final corrected target hand position / posture determined by the arm main controller 106 (more details). Is calculated from the previous control processing cycle).
- the actual object reaction force moment is the detected value of the 6-axis force sensor 52 (actual object reaction force), the target ZMP, and the final corrected target hand position / posture (more specifically, the value in the previous control processing cycle) And calculated from
- the center-of-gravity position perturbation amount calculation unit 272 calculates a target center-of-gravity position perturbation amount that is the target perturbation amount of the entire center-of-gravity position of the robot 1.
- the target center-of-gravity position perturbation amount has a meaning as a perturbation amount of the entire center of gravity of the robot 1 in order to resolve the object reaction force moment deviation in the long term by gravity acting on the robot 1, for example, the target object
- the value is proportional to the reaction force moment.
- perturbation dynamics described later A deviation between the total center of gravity position model perturbation amount, which is a perturbation amount of the total center of gravity of the robot 1 on the perturbation dynamics model calculated by the model, and the target center of gravity position perturbation amount is calculated by the subtractor 274.
- This deviation force is also calculated by the feedback control law 276, for example, the PD control law, to compensate the total reaction force moment for the object reaction force balance control, which is the moment manipulated variable around the target ZMP to converge the deviation to zero.
- the sum of the total reaction force moment compensated for the object reaction force balance control and the deviation of the object reaction force moment is calculated by the adder 278.
- the output of the adder 278 shows the relationship between the perturbation of the overall center of gravity of the robot 1 and the moment perturbation around the target ZMP, as well as the relationship between the perturbation of the overall center of gravity and the perturbation of the upper body posture.
- the body position / posture perturbation amount is calculated using this perturbation dynamics model.
- the perturbation dynamics model is a model that describes the relationship (dynamic relationship) between the perturbation of the total center of gravity of the robot 1 and the perturbation of the moment around the target ZMP by the following equation 18.
- Equation 18 Moment horizontal component around the target ZMP.
- the other variables are the same as those defined for the robot simple model.
- Expression 18 is an expression on the sagittal plane, and the relational expression on the lateral plane may be obtained by inverting the sign of the second term on the right side of Expression 18.
- This equation 18 has the mass of the total mass mtotal of robot 1, and the dynamics of the inverted pendulum such that the moment horizontal component generated around the target ZMP, which is the fulcrum of the mass, is ⁇ Mx. It is a formula which shows a behavior.
- Equation 19 holds approximately.
- the perturbation amount AxG of the total center of gravity is calculated by using the output of the adder 278 as ⁇ ⁇ on the right side of Equation 18, and this AxG force is also calculated by Equation 19.
- the body position perturbation amount is obtained.
- the corrected target body posture out of the corrected target body posture is assumed to match the target body posture, and the perturbation amount of the body posture is 0.
- the body position perturbation amount output from the perturbation dynamics model 280 in this way is added to the target body position / posture (output of the gait generator 100).
- the corrected target body position / posture is calculated.
- the current time's gait is generated so that the current time's gait converges to the normal gait while considering the object reaction force.
- the future object reaction force object reaction force of the second step
- the operation of pushing the object 120 by the robot 1 is performed in the next gait following the current gait.
- the robot 1 performs an action of accelerating the upper body 3 against the object 120 in the current time's gait. Then, the next time the gait also starts to push the object 120.
- the object 120 is started to be pushed with an inertial force that causes the center of gravity of the robot 1 to be directed toward the object 120. For this reason, in order to start the operation of pushing the object 120, it is possible to secure a margin of stability without greatly shifting the foot position / posture of the robot 1 this time gait (the ZMP correction amount can be reduced).
- the second embodiment is an embodiment of the first to third inventions, the fifth invention, and the seventh to tenth inventions of the present invention.
- the second embodiment is different from the first embodiment only in the process of correcting the movement plan (the process corresponding to the eighth invention of the present invention) in S01 of FIG.
- the situation where the deviation between the actual object motion trajectory and the target object motion trajectory based on the movement plan becomes large is the force acting on the actual object 120 other than the force acting on the robot 1. Occurs when the disturbance force of the is relatively large.
- the movement plan is corrected according to a change in the estimated disturbance force.
- the rest is the same as the first embodiment.
- the estimated disturbance force (X-axis direction component) calculated in S35 is shown in FIG.
- the object 120 suddenly increases in the negative direction after the time tl when the object 120 is applied to the step. Therefore, in the second embodiment, when this estimated disturbance force changes by a predetermined value or more (time t5 in FIG. 20 (a)), the movement plan before correction as described in the first embodiment with respect to FIG. Correct the movement plan to determine the revised movement plan.
- the estimated disturbance force (X-axis direction component) calculated in S35 is determined by the object 120 as shown in Fig. 20 (b). After time t3 after overcoming the step, it returns to the same value as the original value before time tl. Therefore, when this estimated disturbance force changes more than a predetermined value and then returns to a value close to the original value (time t6 in FIG. 20 (b)), FIG. 18 (b) is explained in the first embodiment. As such, the revised movement plan is revised and the revised movement plan is determined.
- the force designed to correct the movement plan according to the change of the estimated disturbance force The detected value force of the 6-axis force sensor 52 of both arms 5 and 5 The actual object to be grasped If the deviation between the object reaction force and the target object reaction force determined in S35 becomes larger than the predetermined value, the movement plan may be corrected. [0244]
- This third embodiment is an embodiment of the first, second, fourth, and sixth to ninth inventions of the present invention.
- FIG. 21 is a flowchart showing a process corresponding to the process of FIG. 5 according to the first embodiment in the process of the gait generator 100 in the third embodiment. As shown in FIG. 21, the third embodiment is different from the first embodiment only in the processing in the case where the determination result power SNO is S19.
- the force that corrects the target object reaction force trajectory In the third embodiment, instead of this, in S 21 ′ Correct the landing position / posture or scheduled landing time of the free leg foot 22.
- the estimated landing position / posture or scheduled landing time is set so that the ZMP correction amount becomes as small as possible when the processing of S07 to S17 is performed again after the correction (at least the planned landing position / posture or landing). It is corrected (to be smaller than the ZMP correction amount obtained before the scheduled time is corrected). After the correction, the processing from S07 is executed again. The rest is the same as the first embodiment.
- the target object reaction force trajectory as shown in FIG. 23 (a) is a step-like trajectory such as a rising force from the middle of the next time's gait, for example.
- the ZMP correction amount (X-axis direction component) determined by the process of S17 becomes relatively large as shown by the solid line in FIG. 23 (b), for example, and the determination result of S19 is NO. It may be.
- the planned landing position / posture of the free leg foot 22 in the next gait is indicated by the broken line in FIG. Correct it so that it is closer with.
- the planned landing position / posture of the free leg foot 22L is corrected so as to make the stride of the next time gait smaller. If the process from S05 is executed again after correcting the planned landing position / posture of the next time's gait in this way, the ZMP correction amount determined in S17 becomes smaller as shown by the broken line in FIG. 23 (b). As a result, the determination result in S 19 is YES.
- the second turning step of the normal gait is determined by the above-described method for determining the foot trajectory parameters of the normal gait.
- the foot position of the free leg at the end of the foot will also approach the initial free leg foot position of the second turning gait (the planned landing position of the free leg foot 22 R of the current time's gait).
- the planned landing position / posture of the free leg foot 22L of the next time's gait was corrected, but there is room to correct the planned landing position / posture of the free leg foot 22R of the current time's gait. If there is, it may be corrected. Or, try to correct the planned landing positions and postures for both the current time gait and the next time gait.
- the planned landing position / posture is corrected.
- the planned landing time of the free leg foot 22 of at least one of the current time gait and the next time gait is corrected. May be.
- the scheduled landing time of the next gait may be delayed.
- the third embodiment of the present invention is the same operational effects as in the first embodiment can be achieved.
- the planned landing position / posture or scheduled landing time of the free leg foot 22 is corrected when the determination result of S19 is NO. Correct the target object reaction force trajectory.
- the present invention can also be applied to the case where the object 120 is lifted and moved. Furthermore, when the robot 1 is moved in an environment in which the robot 1 is subjected to an external force without being in direct contact with an object due to electromagnetic force or a fluid such as airflow. The present invention can also be applied.
- the present invention ensures the continuous stability of the robot in an environment where an external force is applied to the robot as appropriate, such as when the robot moves an object. This is useful for generating a gait that can be maintained.
- FIG. 1 is a diagram showing a schematic configuration of a biped mobile robot as a legged mobile robot in an embodiment of the present invention.
- FIG. 2 is a block diagram showing the configuration of a control unit provided in the robot of FIG.
- FIG. 3 is a block diagram showing a functional configuration of a main part of the control unit of FIG.
- FIG. 4 is a diagram showing a relationship between a robot and an object in the embodiment.
- FIG. 5 is a flowchart showing a calculation process of the gait generator in the first embodiment.
- FIG. 6 is a flowchart showing a calculation process of the gait generator in the first embodiment.
- FIG. 7 is a flowchart showing a calculation process of the gait generator in the first embodiment.
- FIG. 8 is a diagram showing an example of a movement plan determined in S02 of FIG.
- FIG. 9 is a block diagram showing processing of S02 in FIG.
- FIG. 10 (a) is a diagram showing an example of a temporary target ZMP trajectory related to S07 in FIG. 5
- FIG. 10 (b) is a diagram showing an example of the ZMP correction amount determined in S17 in FIG. 10 (c) shows an example of the target ZMP trajectory modified in S17.
- FIG. 11 is a diagram showing an example of foot trajectory parameters determined in S 11 of FIG.
- Fig. 12 shows an example of the object floor reaction force moment trajectory of the current time's gait
- Fig. 12 (b) shows the object reaction force moment of the normal gait determined by SI 1 in Fig. 5.
- the figure which shows the example of an orbit.
- FIG. 13 is a diagram showing an example of a robot dynamics model used in the embodiment.
- FIG. 14 is a block diagram showing a process for obtaining a body position using the robot dynamic model of FIG.
- FIGS. 15A and 15B are diagrams for explaining the processing of S21 in FIG.
- FIG. 16 is a diagram for explaining the processing of S29 in FIG.
- FIG. 17 is a block diagram showing the process of S35 of FIG.
- FIGS. 18 (a) and 18 (b) are diagrams for explaining the process of correcting the SOI movement plan in FIG.
- FIG. 19 is a block diagram showing processing of the object reaction force balance control device shown in FIG.
- ⁇ 20 A diagram for explaining the movement plan correction processing of S01 (FIG. 5) in the second embodiment of the present invention.
- ⁇ 21 A flow chart showing the main processing of the gait generator in the third embodiment of the present invention.
- FIG. 22 is a diagram for explaining the processing of S21 ′ in FIG.
- FIGS. 23 (a) and 23 (b) are diagrams for explaining the processing of S21 ′ in FIG.
Abstract
Description
Claims
Priority Applications (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
DE602005019183T DE602005019183D1 (de) | 2004-08-02 | 2005-07-28 | Beweglicher roboter mit beinen und einer gangmustererzeugungsvorrichtung |
EP05767078A EP1798004B1 (en) | 2004-08-02 | 2005-07-28 | Legged mobile robot having a gait pattern generating device |
KR1020077000627A KR101209097B1 (ko) | 2004-08-02 | 2005-07-28 | 다리식 이동 로봇의 보용생성장치 및 제어장치 |
US11/572,677 US7991508B2 (en) | 2004-08-02 | 2005-07-28 | Gait generating system and control device of legged mobile robot |
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2004226048A JP4485279B2 (ja) | 2004-08-02 | 2004-08-02 | 脚式移動ロボットの歩容生成装置および制御装置 |
JP2004-226048 | 2004-08-02 |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2006013779A1 true WO2006013779A1 (ja) | 2006-02-09 |
Family
ID=35787067
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2005/013840 WO2006013779A1 (ja) | 2004-08-02 | 2005-07-28 | 脚式移動ロボットの歩容生成装置および制御装置 |
Country Status (6)
Country | Link |
---|---|
US (1) | US7991508B2 (ja) |
EP (3) | EP2177324B1 (ja) |
JP (1) | JP4485279B2 (ja) |
KR (1) | KR101209097B1 (ja) |
DE (1) | DE602005019183D1 (ja) |
WO (1) | WO2006013779A1 (ja) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114625129A (zh) * | 2022-02-22 | 2022-06-14 | 中国科学院自动化研究所 | 位控腿足机器人的运动控制方法及系统 |
Families Citing this family (36)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4531520B2 (ja) | 2004-10-15 | 2010-08-25 | 本田技研工業株式会社 | 脚式移動ロボットの制御装置 |
DE602005021689D1 (de) | 2004-10-15 | 2010-07-15 | Honda Motor Co Ltd | Gangerzeuger für mobilen roboter mit beinen |
JP4641252B2 (ja) * | 2005-12-12 | 2011-03-02 | 本田技研工業株式会社 | 脚式移動ロボットの歩容生成装置 |
JP4560658B2 (ja) * | 2007-12-10 | 2010-10-13 | 本田技研工業株式会社 | 脚式移動ロボットの制御装置 |
JP5483997B2 (ja) * | 2009-10-28 | 2014-05-07 | 本田技研工業株式会社 | 脚式移動ロボットの制御装置 |
JP5232124B2 (ja) * | 2009-10-28 | 2013-07-10 | 本田技研工業株式会社 | 脚式移動ロボットの制御装置 |
KR101667032B1 (ko) * | 2009-10-30 | 2016-10-17 | 삼성전자 주식회사 | 로봇의 경로 계획 장치 및 그 방법 |
JP4952959B2 (ja) * | 2009-11-18 | 2012-06-13 | 独立行政法人科学技術振興機構 | 搬送システム、ロボットの制御方法 |
US9764468B2 (en) | 2013-03-15 | 2017-09-19 | Brain Corporation | Adaptive predictor apparatus and methods |
US9242372B2 (en) | 2013-05-31 | 2016-01-26 | Brain Corporation | Adaptive robotic interface apparatus and methods |
US9314924B1 (en) | 2013-06-14 | 2016-04-19 | Brain Corporation | Predictive robotic controller apparatus and methods |
US9597797B2 (en) * | 2013-11-01 | 2017-03-21 | Brain Corporation | Apparatus and methods for haptic training of robots |
US9358685B2 (en) | 2014-02-03 | 2016-06-07 | Brain Corporation | Apparatus and methods for control of robot actions based on corrective user inputs |
US9395726B1 (en) * | 2014-07-24 | 2016-07-19 | Google Inc. | Methods and devices for bound and gallop gaits |
US10081098B1 (en) | 2014-08-25 | 2018-09-25 | Boston Dynamics, Inc. | Generalized coordinate surrogates for integrated estimation and control |
US9618937B1 (en) | 2014-08-25 | 2017-04-11 | Google Inc. | Slip detection using robotic limbs |
US9499219B1 (en) | 2014-08-25 | 2016-11-22 | Google Inc. | Touch-down sensing for robotic devices |
US9387588B1 (en) * | 2014-08-25 | 2016-07-12 | Google Inc. | Handling gait disturbances with asynchronous timing |
US9623556B1 (en) * | 2014-09-03 | 2017-04-18 | X Development Llc | Robotic sole joint |
US9630318B2 (en) | 2014-10-02 | 2017-04-25 | Brain Corporation | Feature detection apparatus and methods for training of robotic navigation |
US9446518B1 (en) | 2014-11-11 | 2016-09-20 | Google Inc. | Leg collision avoidance in a robotic device |
JP6332018B2 (ja) * | 2014-12-25 | 2018-05-30 | トヨタ自動車株式会社 | 搬送ロボット、及びその制御方法 |
US9440353B1 (en) | 2014-12-29 | 2016-09-13 | Google Inc. | Offline determination of robot behavior |
US9499218B1 (en) | 2014-12-30 | 2016-11-22 | Google Inc. | Mechanically-timed footsteps for a robotic device |
JP6447278B2 (ja) * | 2015-03-18 | 2019-01-09 | トヨタ自動車株式会社 | 多点接触ロボット、多点接触ロボットの制御方法及びプログラム |
US9594377B1 (en) * | 2015-05-12 | 2017-03-14 | Google Inc. | Auto-height swing adjustment |
US9586316B1 (en) | 2015-09-15 | 2017-03-07 | Google Inc. | Determination of robotic step path |
US9778132B1 (en) * | 2015-12-16 | 2017-10-03 | X Development Llc | Methods and systems for force sensor calibration |
JP6483014B2 (ja) * | 2015-12-25 | 2019-03-13 | 本田技研工業株式会社 | 移動ロボットの制御装置 |
US9789919B1 (en) | 2016-03-22 | 2017-10-17 | Google Inc. | Mitigating sensor noise in legged robots |
US11510539B2 (en) * | 2017-06-02 | 2022-11-29 | Pixart Imaging Inc. | Auto clean machine, cliff determining method and surface type determining method |
WO2020133288A1 (zh) * | 2018-12-28 | 2020-07-02 | 深圳市优必选科技有限公司 | 一种双足机器人步态控制方法以及双足机器人 |
CN113031579B (zh) * | 2019-12-25 | 2023-10-10 | 深圳市优必选科技股份有限公司 | 双足机器人的行走控制方法、装置及双足机器人 |
JP7396231B2 (ja) * | 2020-08-28 | 2023-12-12 | トヨタ自動車株式会社 | 配送システム、配送方法、及びプログラム |
CN114115310B (zh) * | 2021-11-19 | 2023-12-15 | 北京理工大学 | 一种四足机器人运动控制方法及系统 |
CN114253260B (zh) * | 2021-12-08 | 2023-08-18 | 深圳市优必选科技股份有限公司 | 机器人步态规划方法及装置、运动规划设备和存储介质 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH10230485A (ja) | 1996-12-19 | 1998-09-02 | Honda Motor Co Ltd | 脚式移動ロボットの姿勢制御装置 |
JP3233450B2 (ja) | 1992-05-22 | 2001-11-26 | 本田技研工業株式会社 | 指定時刻到達関数発生器 |
WO2002040224A1 (fr) * | 2000-11-17 | 2002-05-23 | Honda Giken Kogyo Kabushiki Kaisha | Dispositif generateur d'un modele de demarche pour robot mobile pourvu de jambes |
JP2002326173A (ja) | 2001-04-27 | 2002-11-12 | Honda Motor Co Ltd | 脚式移動ロボットの動作生成装置 |
WO2003057427A1 (fr) | 2001-12-28 | 2003-07-17 | Honda Giken Kogyo Kabushiki Kaisha | Dispositif de commande pour robot mobile sur jambes |
JP2004209614A (ja) * | 2003-01-08 | 2004-07-29 | National Institute Of Advanced Industrial & Technology | 脚式移動ロボット及び制御方法 |
JP2005115654A (ja) * | 2003-10-08 | 2005-04-28 | Sony Corp | 情報処理装置および方法、プログラム格納媒体、並びにプログラム |
Family Cites Families (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS6486080A (en) | 1987-09-29 | 1989-03-30 | Kawasaki Steel Co | Method and apparatus for diagnosing abnormality of current detector |
JP3035051B2 (ja) * | 1991-12-20 | 2000-04-17 | 本田技研工業株式会社 | 脚式移動ロボットの歩行制御装置 |
JP3663034B2 (ja) | 1996-07-25 | 2005-06-22 | 本田技研工業株式会社 | 脚式移動ロボットの歩容生成装置 |
EP0965416B1 (en) * | 1996-12-19 | 2005-12-07 | Honda Giken Kogyo Kabushiki Kaisha | Attitude controller of legged moving robot |
JP3726009B2 (ja) * | 2000-05-19 | 2005-12-14 | 本田技研工業株式会社 | 脚式移動ロボットの床形状推定装置 |
JP3760186B2 (ja) * | 2001-06-07 | 2006-03-29 | 独立行政法人科学技術振興機構 | 二脚歩行式移動装置及びその歩行制御装置並びに歩行制御方法 |
EP1470900B1 (en) | 2001-12-28 | 2010-07-14 | Honda Giken Kogyo Kabushiki Kaisha | Gait production device and control device for leg type movable robot |
KR100960552B1 (ko) * | 2002-04-26 | 2010-06-03 | 혼다 기켄 고교 가부시키가이샤 | 다리식 이동 로봇의 제어장치 및 족적결정 장치 |
JP3833567B2 (ja) * | 2002-05-01 | 2006-10-11 | 本田技研工業株式会社 | 移動ロボットの姿勢制御装置 |
US8005573B2 (en) * | 2003-06-27 | 2011-08-23 | Honda Motor Co., Ltd. | Control device for legged mobile robot |
EP1649983B1 (en) * | 2003-06-27 | 2010-09-22 | Honda Motor Co., Ltd. | Gait generation device for legged mobile robot |
JP4531520B2 (ja) * | 2004-10-15 | 2010-08-25 | 本田技研工業株式会社 | 脚式移動ロボットの制御装置 |
JP4440761B2 (ja) * | 2004-12-24 | 2010-03-24 | 本田技研工業株式会社 | 脚式移動ロボットの制御装置 |
-
2004
- 2004-08-02 JP JP2004226048A patent/JP4485279B2/ja not_active Expired - Fee Related
-
2005
- 2005-07-28 WO PCT/JP2005/013840 patent/WO2006013779A1/ja active Application Filing
- 2005-07-28 EP EP09015354A patent/EP2177324B1/en not_active Expired - Fee Related
- 2005-07-28 DE DE602005019183T patent/DE602005019183D1/de active Active
- 2005-07-28 EP EP09015355A patent/EP2172312B1/en not_active Expired - Fee Related
- 2005-07-28 EP EP05767078A patent/EP1798004B1/en not_active Expired - Fee Related
- 2005-07-28 KR KR1020077000627A patent/KR101209097B1/ko active IP Right Grant
- 2005-07-28 US US11/572,677 patent/US7991508B2/en not_active Expired - Fee Related
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3233450B2 (ja) | 1992-05-22 | 2001-11-26 | 本田技研工業株式会社 | 指定時刻到達関数発生器 |
JPH10230485A (ja) | 1996-12-19 | 1998-09-02 | Honda Motor Co Ltd | 脚式移動ロボットの姿勢制御装置 |
WO2002040224A1 (fr) * | 2000-11-17 | 2002-05-23 | Honda Giken Kogyo Kabushiki Kaisha | Dispositif generateur d'un modele de demarche pour robot mobile pourvu de jambes |
JP2002326173A (ja) | 2001-04-27 | 2002-11-12 | Honda Motor Co Ltd | 脚式移動ロボットの動作生成装置 |
WO2003057427A1 (fr) | 2001-12-28 | 2003-07-17 | Honda Giken Kogyo Kabushiki Kaisha | Dispositif de commande pour robot mobile sur jambes |
JP2004209614A (ja) * | 2003-01-08 | 2004-07-29 | National Institute Of Advanced Industrial & Technology | 脚式移動ロボット及び制御方法 |
JP2005115654A (ja) * | 2003-10-08 | 2005-04-28 | Sony Corp | 情報処理装置および方法、プログラム格納媒体、並びにプログラム |
Non-Patent Citations (3)
Title |
---|
HARADA K. ET AL: "Humanoid ni yoru Oshi Sosa. (Pushing Manipulation by a Humano id Robot)", DAI 45 KAI PROCEEDINGS OF THE JAPAN JOINT AUTOMATIC CONTROL CONFERENCE, 2002, pages 115 - 116, XP002996819 * |
OKADA K. ET AL: "Taishobutsu Kido no Kijutsu ni Motozuita Humanoid no Zenshin Dosa Seiseiho to Buttai Unpan Kodo no Jitsugen. (Motion Generation of Humanoids based on Object Trajectory Description)", THE 22ND ANNUAL CONFERENCE OF THE ROBOTICS SOCIETY OF JAPAN YOKOSHU, September 2004 (2004-09-01), pages 1K12, XP002996820 * |
See also references of EP1798004A4 |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114625129A (zh) * | 2022-02-22 | 2022-06-14 | 中国科学院自动化研究所 | 位控腿足机器人的运动控制方法及系统 |
CN114625129B (zh) * | 2022-02-22 | 2023-09-12 | 中国科学院自动化研究所 | 位控腿足机器人的运动控制方法及系统 |
Also Published As
Publication number | Publication date |
---|---|
EP2177324A1 (en) | 2010-04-21 |
US20080208391A1 (en) | 2008-08-28 |
EP1798004A1 (en) | 2007-06-20 |
JP4485279B2 (ja) | 2010-06-16 |
DE602005019183D1 (de) | 2010-03-18 |
US7991508B2 (en) | 2011-08-02 |
EP1798004A4 (en) | 2008-05-07 |
EP2172312A1 (en) | 2010-04-07 |
JP2006043797A (ja) | 2006-02-16 |
EP2177324B1 (en) | 2012-12-05 |
EP2172312B1 (en) | 2012-12-05 |
KR101209097B1 (ko) | 2012-12-06 |
EP1798004B1 (en) | 2010-01-27 |
KR20070032778A (ko) | 2007-03-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP4485279B2 (ja) | 脚式移動ロボットの歩容生成装置および制御装置 | |
JP4808626B2 (ja) | 脚式移動ロボットの歩容生成装置 | |
JP4641252B2 (ja) | 脚式移動ロボットの歩容生成装置 | |
JP4531520B2 (ja) | 脚式移動ロボットの制御装置 | |
WO2006067904A1 (ja) | 脚式移動ロボットの歩容生成装置 | |
JP3726097B2 (ja) | 脚式移動ロボットの姿勢制御装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
AK | Designated states |
Kind code of ref document: A1 Designated state(s): AE AG AL AM AT AU AZ BA BB BG BR BW BY BZ CA CH CN CO CR CU CZ DE DK DM DZ EC EE EG ES FI GB GD GE GH GM HR HU ID IL IN IS KE KG KM KP KR KZ LC LK LR LS LT LU LV MA MD MG MK MN MW MX MZ NA NG NI NO NZ OM PG PH PL PT RO RU SC SD SE SG SK SL SM SY TJ TM TN TR TT TZ UA UG US UZ VC VN YU ZA ZM ZW |
|
AL | Designated countries for regional patents |
Kind code of ref document: A1 Designated state(s): BW GH GM KE LS MW MZ NA SD SL SZ TZ UG ZM ZW AM AZ BY KG KZ MD RU TJ TM AT BE BG CH CY CZ DE DK EE ES FI FR GB GR HU IE IS IT LT LU LV MC NL PL PT RO SE SI SK TR BF BJ CF CG CI CM GA GN GQ GW ML MR NE SN TD TG |
|
121 | Ep: the epo has been informed by wipo that ep was designated in this application | ||
WWE | Wipo information: entry into national phase |
Ref document number: 1020077000627 Country of ref document: KR |
|
WWE | Wipo information: entry into national phase |
Ref document number: 11572677 Country of ref document: US |
|
NENP | Non-entry into the national phase |
Ref country code: DE |
|
WWE | Wipo information: entry into national phase |
Ref document number: 2005767078 Country of ref document: EP |
|
WWP | Wipo information: published in national office |
Ref document number: 1020077000627 Country of ref document: KR |
|
WWP | Wipo information: published in national office |
Ref document number: 2005767078 Country of ref document: EP |