JP2006007376A - Control device for humanoid robot - Google Patents

Abstract

<P>PROBLEM TO BE SOLVED: To provide a control device for a humanoid robot capable of stably walking while pushing an object. <P>SOLUTION: The control device for the humanoid robot capable of continuously pushing the object placed on a floor is equipped with a control means for controlling so as to push the object during a double-leg supporting period in which both legs of the robot are on the ground and so as not to push the object during a single-leg supporting period in which only one leg is on the ground. The control device for the humanoid robot capable of continuously pushing the object placed on the floor carries out control for pushing the object by controlling reactive force of the hands during the double-leg supporting period in which both legs of the robot are on the ground and for stepping by an amount of previously pushing the object without pushing the object during the single-leg supporting period in which only one leg is on the ground. <P>COPYRIGHT: (C)2006,JPO&NCIPI

Description

  The present invention relates to a control device for a humanoid robot capable of performing a stable gait while pushing an object with a hand.

  In recent years, the development of humanoid robots that can walk on two legs and perform various tasks with an arm equipped with a hand has been widely promoted. Manipulation functions are indispensable for humanoid robots to actually work in a real environment. However, research on manipulation by humanoid robots has not been sufficiently studied.

  As one form of manipulating an object by a humanoid robot, for example, as shown in FIG. 1, attention is paid to an operation of pushing a large object placed on the floor. At this time, position control is performed according to the difference in arm control method. There are two types of operations: a push operation based on the force and a push operation based on force control.

  In the case of a push operation based on position control that does not use hand reaction force information, the control device can be easily mounted and is stable when the object is light and the reaction force applied to the hand is small. Can be pushed. On the other hand, when the object becomes heavy, the robot finally falls because the walking speed of the robot exceeds the moving speed of the object.

  In contrast, force control-based push operations using hand reaction force information can be used to stabilize objects of various weights by adaptively changing the gait based on hand reaction force information. It is expected that it can be pushed.

  On the other hand, in order to perform stable work by the humanoid robot as described above, when the target hand force and the actual hand force are different as shown in, for example, Japanese Patent Laid-Open No. 10-230485, A method has been proposed in which the moment deviation around the floor reaction force center point (target ZMP) is calculated and the position of the trunk is changed to compensate for the moment deviation (FIG. 7).

In addition, as shown in Journal of the Robotics Society of Japan, Vol. 18, No. 1, pages 75-86, there has also been proposed a method for determining the timing when the legged mobile robot takes a step according to the external force applied to the hand.
Japanese Patent Laid-Open No. 10-230485 Journal of the Robotics Society of Japan Volume 18 Issue 1 Pages 75-86

  For example, let us consider an operation of pushing the object in the state where the hand of the humanoid robot as described above is in contact with the object placed on the floor as described above. At this time, it is assumed that the weight of the object and the coefficient of friction between the object and the floor are unknown. In this state, the robot's walking parameters are not set properly in order to maintain a dynamic equilibrium without falling down while the robot applies a large force and continuously moves the object on the floor. Must not.

  However, in various conventionally proposed methods, no guidance has been given on how to determine a walking parameter to realize a stable walking motion. Accordingly, an object of the present invention is to provide a control device for a humanoid robot that can stably walk while pushing an object in a biped humanoid robot.

  When a humanoid robot continuously pushes an object placed on the floor, it pushes the object while both legs are on the ground (both leg support period) and only one leg is on the ground (one leg support period) Then, it is thought that it is easier to keep the robot stable without pushing the object. Further, a continuous pressing operation is realized by pressing the object by controlling the hand reaction force during the both-leg support period and stepping by the amount of the object pressed during the one-leg support period.

  Based on the above-described concept, the humanoid robot control device according to the present invention is a humanoid robot control device that continuously pushes an object placed on the floor. It is characterized by comprising control means for controlling the object not to be pushed during the one-leg support period in which the object is pushed and only one leg is on the ground.

  The humanoid robot control device more specifically includes a both-foot-grounded state detecting means for detecting that both feet are on the ground, and an object pressing operation for pressing an object placed on the floor. And when the two foot contact state detecting means detects that both feet are on the ground, the object pressing means pushes the object, and the both foot contact state detecting means detects one of the feet on the ground. This can be realized by providing a control means for controlling the object not to be pressed by the object pressing means when it is detected that the object has not arrived.

  Further, another humanoid robot control device according to the present invention is a humanoid robot control device that continuously pushes an object placed on the floor, and controls the hand reaction force during the period when both legs are on the ground. And a control means for controlling to step by the amount of pushing the object in a one leg support period in which only one foot is touched to the ground.

  More specifically, the control device for the humanoid robot includes both foot contact state detection means for detecting that both feet are on the ground, and hand reaction force for pressing an object placed on the floor. A hand reaction force control means for controlling, an object movement amount detection means for detecting a distance by which the object is pushed, and a step control means for stepping one foot, and the both feet contact with the ground by the both foot contact state detection means. Only when it is detected that the object has been touched by the hand reaction force control means, and when it is detected by the both foot contact state detection means that either foot is not touching, the object movement amount detection It can be realized by providing a control means for stepping one foot not grounded by the step control means by the amount of the previous object movement detected by the means.

  By configuring the present invention as described above, when a humanoid robot performs work in an actual environment, it is possible to continue walking stably while applying force to the object with the hand. In addition, when a humanoid robot performs work in a real environment, the work can be continued stably even when the physical parameter of the object is unknown.

  In the present invention, when a humanoid robot performs work in a real environment, the robot continues to walk stably with force applied to the object with the hand, and is stable even when the physical parameter of the object is unknown. In a humanoid robot control device that continuously pushes an object placed on the floor, the object is pushed while both legs are on the ground, and only one leg touches the ground. In the one-leg support period, it is equipped with control means that controls the object not to be pushed, and in the control device of the humanoid robot that continuously pushes the object placed on the floor, in the both-leg support period when both feet are on the ground This is realized by providing a control means for controlling the hand reaction force to push the object and to control to step by the amount of pushing the object in the one-leg support period in which only one foot is on the ground.

  Although the floor reaction force center point is generally called ZMP (Zero Moment Point), when attention is paid to ZMP existing at the contact between the sole and the floor surface, this ZMP is also displaced according to the reaction force applied to the hand. If the ZMP is included in the sole support area, the robot can maintain dynamic equilibrium. However, in manipulation, the ZMP is displaced by an unexpected hand reaction force, and the robot moves to the end of the sole support area. There is a danger that the robot will fall over.

  Therefore, using the feature that the convex hull of the sole support area widens during the leg support period during walking movement, the pushing phase that pushes the object during the both leg support period and the step without pressing the object We consider the form of manipulation divided into stepping phase.

  FIG. 3 shows a time chart of an embodiment according to the present invention. In the pushing phase, the object is pushed by controlling the force applied to the hand. Further, in the latter half of the pushing phase, the position of the hand is controlled to return the speed viewed from the absolute coordinate system of the hand to zero. In the stepping phase, the operation of the object is stopped.

  In the stepping phase, the distance that the robot steps is made equal to the distance the object was pushed in the pushing phase. Further, the ZMP trajectory is recalculated using the distance of pressing the object, and the current ZMP trajectory is connected. The trajectory of the trunk center of gravity is derived from the ZMP trajectory.

  Fig. 4 shows an overview of the arm control method in the pushing phase. Here, μ is the coefficient of friction between the object and the floor, and m is the mass of the object. In the pushing phase, the reaction force received from the object is controlled by impedance control. The target impedance with respect to the robot traveling direction is given in the following form.

Here, m target mass, c is represents the target _{viscosity, f xd} represents a target value of _{f x.} When f _xd <μm _o g, the object does not move because f _x balances with f _xd . In contrast, the object moves when f _xd > μm _o g, and the acceleration of the object depends on the difference between f _xd and f _x . When a light object is pushed and operated under the condition that the target impedance is realized, the object moves with a large acceleration, and the acceleration of the object decreases as the object becomes heavier. And if the mass of a target object becomes very large, a target object will stop moving. That is, by using this method, the robot can adaptively perform the pushing operation without considering the mass of the object and the friction coefficient between the object and the floor surface.

Next, a method for planning a gait in real time based on information on the pushing operation of the object will be examined. As shown in FIG. 5, it is assumed that the target ZMP trajectory is given by the following piecewise polynomial.
here,






Represents the ZMP trajectory of the jth section. By approximating the robot with an inverted pendulum whose height does not change, the trajectory of the center of gravity of the robot can be derived as follows.

here,





Is an unknown constant, and is determined so as to smoothly connect the trajectory of the center of gravity of the robot while satisfying the boundary condition.

  In order to realize real-time gait changes, consider connecting the newly calculated robot center of gravity trajectory to the current center of gravity trajectory. As shown in FIG. 5, the ZMP trajectory is calculated so that the stride becomes equal to the pushing amount in the pushing phase at the end of the one leg support period. Based on this ZMP trajectory, the trajectory of the center of gravity of the robot is calculated and smoothly connected to the current center of gravity trajectory.

Here, the orbit of the center of gravity includes sinh and cosh in the homogeneous solution. That is, to prevent the solution from diverging over time, the factor
Is tested by solving a two-point boundary value problem.

  Note that in the two-point boundary value problem, the initial position and the end position are given, but the number of conditional expressions exceeds the number of unknowns, so the initial speed cannot be included in the boundary condition. is there.

  That is, when a newly calculated center-of-gravity trajectory is connected to the current robot center-of-gravity trajectory, a discontinuity of speed occurs. In order to make all the positions and velocities of the ZMP trajectory and the robot center of gravity continuous, the function shape of the target ZMP in the first section is also unknown, and the function shape is determined so as to satisfy the boundary condition.

  FIG. 6 shows the configuration of control blocks, their relationship, and operation flow in a humanoid robot control apparatus using this method. First, the hand position is calculated by an impedance control method. At the end of the pushing phase, gait planning is performed and the robot's center of gravity and toe position are calculated. And the target position of each joint is derived | led-out from those information. This target joint position command is given to the robot. Here, since there is a possibility that an error may occur in the position of the ZMP due to the influence of parameter error or disturbance, a stabilization control system for controlling the posture of the body at the same time as the ZMP position is introduced.

  According to experiments and simulation results using such a control device, it was confirmed that the robot maintained dynamic equilibrium and pushed the object stably despite the change in the mass of the object. .

It is a figure which shows the example of the operation | work which pushes the target object placed on the floor. It is explanatory drawing of the impedance control of a hand. It is a time chart of the Example of this invention. It is a figure which shows a ZMP orbit. It is a figure which shows the real time gait plan by the connection of a track | orbit. Block diagram when applying the proposed method to a robot It is a figure which shows the method of changing the position of the trunk | drum based on the conventional moment deviation.

Claims (4)

  In a humanoid robot controller that continuously pushes an object placed on the floor, it pushes the object when both legs are on the ground while both legs are touching the ground, and only supports one leg when the legs are on the ground. A control device for a humanoid robot, characterized by comprising control means for performing control without pressing. Two-foot ground contact state detecting means for detecting that both feet are on the ground, and object pressing means for performing an operation of pressing an object placed on the floor,
When it is detected by the two-foot contact state detection means that both feet are on the ground, the object is pressed by the object pressing means, and either foot is not on the ground by the two-foot contact state detection means. A control device for a humanoid robot, comprising control means for controlling so that the object pressing means does not press the object when detected.   In a control device for a humanoid robot that continuously pushes an object placed on the floor, the object is pushed by controlling the hand reaction force during the period of both-leg support when both feet are on the ground, and only one foot is on the ground. A control device for a humanoid robot, comprising control means for performing control to step by an amount of pressing an object in a single leg support period. The both foot contact state detection means for detecting that both feet are on the ground, the hand reaction force control means for controlling the hand reaction force for pushing the object placed on the floor, and the distance at which the object is pushed An object movement amount detecting means for detecting, and a step control means for stepping one leg,
Only when it is detected by the both-foot contact state detecting means that both feet are on the ground, the object is pushed by the hand reaction force control means, and either foot is not in contact with the both-foot contact state detecting means And a control means for stepping one foot not grounded by the step control means by an amount corresponding to the previous object movement amount detected by the object movement amount detection means. Type robot controller.