JP4660870B2 - Legged mobile robot and control method thereof - Google Patents

Description

[0001]
BACKGROUND OF THE INVENTION
The present invention relates to a realistic robot mechanism configured by modeling biological mechanisms and operations, and more particularly to a legged mobile robot that models the body mechanisms of legged mobile animals such as humans and monkeys. Regarding the mechanism.
[0002]
More specifically, the present invention relates to a legged mobile robot of a type in which each of two or more movable legs realizes an operation pattern such as walking, running, jumping, etc. by cooperatively repeating landing and leaving actions. Leg movement type that can reduce the impact received from the floor as much as possible when landing after the robot leaves the floor, especially when executing jumps and other movement patterns The present invention relates to a robot mechanism and its control method.
[0003]
[Prior art]
It is said that the word “robot” comes from the Slavic word ROBOTA (slave machine). In Japan, robots started to spread from the end of the 1960s, but many of them are industrial robots such as manipulators and transfer robots for the purpose of automating and unmanned production operations in factories. Met.
[0004]
Recently, research and development on legged mobile robots simulating the body mechanisms and movements of biped upright walking such as humans and monkeys has progressed, and expectations for practical use are also increasing. Leg-type movement with two legs standing upright is unstable and difficult to control posture and walking, compared to crawler type, four-legged or six-legged type, etc. It is excellent in that it can realize traveling motion.
[0005]
For example, Japanese Patent Application Laid-Open No. 3-184782 discloses a joint structure applied to a structure corresponding to a lower part of a torso of a legged walking robot.
[0006]
A legged mobile robot that emulates a human biological mechanism or movement is particularly called a “humanoid” or “humanoid robot”. The humanoid robot can provide, for example, life support, that is, support for human activities in various situations in daily life such as a living environment.
[0007]
The significance of researching and developing robots called humanoids or humanoids can be understood from, for example, the following two viewpoints.
[0008]
One is a human scientific viewpoint. In other words, through the process of creating a robot with a structure resembling human lower limbs and / or upper limbs, devising its control method and simulating human walking motion, the mechanism of human natural motion including walking Can be elucidated in engineering. Such research results can be greatly reduced to the progress of various other research fields dealing with human movement mechanisms, such as ergonomics, rehabilitation engineering, or sports science.
[0009]
The other is the development of a robot that supports life as a human partner, that is, supports human activities in various situations in the living environment and other daily lives. This kind of robot needs to learn how to adapt to a person or an environment with different personalities while learning from humans in various aspects of the human living environment, and needs to grow further in terms of functionality. At this time, it is considered that the robot having the “human shape”, that is, the same shape or the same structure as the human, functions effectively for smooth communication between the human and the robot.
[0010]
For example, if you step on No When teaching robots on the ground how to get through the room while avoiding unobstructed obstacles, it ’s more like a crawler-type or quadruped-type robot than the opponent you ’re teaching has a completely different structure. A biped robot that looks like it will be much easier to teach and to be taught by robots (for example, “Control of a biped robot” by Takanishi (Automobile Engineering Association of Kanto Branch <High Plastics) > No. 25, 1996 APRIL)). In the first place, since most of the human living environment is formed according to the form and behavior of human beings, having a humanoid form increases the affinity with the human living environment. It can be said that it is essential above.
[0011]
One of the uses of the humanoid robot is to perform various difficult operations in industrial activities and production activities. For example, maintenance work at nuclear power plants, thermal power plants, petrochemical plants, transportation and assembly work of parts at manufacturing plants, cleaning of high-rise buildings, substitution of dangerous work and difficult work such as rescue at fire sites etc. . However, robots specializing in this type of industrial use have the ultimate design and production theme of realizing specific uses or functions, and are supposed to be biped, but humans and monkeys stand upright. It is not always necessary to faithfully reproduce the body mechanisms and movements inherent to walking animals as mechanical devices. For example, while strengthening the degree of freedom and movement functions of the hand to realize a specific application, it limits the degree of freedom of the head, trunk (such as the spine), and the waist, which are relatively unrelated to the application. It should be allowed to some extent to omit it. As a result, biped walking and so-called edo may remain unnatural for humans in terms of the appearance of robot work and operations, but this point must be compromised.
[0012]
Further, as another use of the humanoid robot, there is a use that is close to life, that is, “symbiosis” with a human, rather than life support such as substitution of difficult work. This type of robot is designed to faithfully reproduce the whole body cooperative movement mechanism inherent in animals that walk on two legs upright, such as humans and monkeys, and to achieve its natural and smooth movement. To do. In addition, as long as it emulates highly intelligent upright animals such as humans and monkeys, it is desirable that the expression of movement using the extremities is rich. Furthermore, not only to faithfully execute the pre-input motion pattern, but also to realize a lively motion expression that responds to the opponent's language and attitude (such as “praise”, “speak”, “beat”). Is also required. In this sense, an entertainment robot that imitates humans is just right to call it a “humanoid robot”.
[0013]
As already known, the human body has hundreds of joints, or hundreds of degrees of freedom. It is preferable to give almost the same degree of freedom in order to give the movement to the legged mobile robot as close as possible to a human, but this is extremely difficult technically. This is because it is necessary to arrange at least one actuator for each degree of freedom. However, mounting several hundred actuators on a mechanical device called a robot is difficult in terms of manufacturing cost. This is impossible from the design point of view. In addition, if the degree of freedom is large, the amount of calculation for the position / motion pattern control, posture stability control, and the like of the robot increases exponentially.
[0014]
For this reason, it is common to construct a humanoid robot with joint degrees of freedom of about several tens, which is much smaller than the human body. Therefore, it can be said that one of the important issues in the design and control of a humanoid robot is how to realize a more natural motion using a small degree of freedom.
[0015]
For example, it is already clear from the viewpoint of ergonomics that a flexible mechanism such as the spine is important for performing various and complex operations in the human life. The degree of freedom of trunk joints, which means the spine, has low value for industrial applications, but is important for entertainment and other life-oriented humanoid robots. Moreover, it is required that the flexibility can be actively adjusted according to the situation.
[0016]
In addition, legged mobile robots that perform biped upright walking are superior in that they can realize flexible walking and running operations (for example, raising and lowering stairs and getting over obstacles), but the center of gravity is higher, so Posture control and stable walking control become difficult by the amount. In particular, in the case of robots that are closely linked to daily life, postures and stable walking must be controlled while richly expressing natural movements and emotions in intelligent animals such as humans and monkeys.
[0017]
Numerous techniques related to posture control and stable walking have been proposed for robots of the type that perform legged movement by biped walking. Stable “walking” in this context can be defined as moving with legs without falling down.
[0018]
At the time of walking, gravity, inertial force, and these moments act on the road surface from the walking system due to gravity and acceleration caused by walking motion. According to the so-called “Dalambert principle”, they balance with the floor reaction force and the floor reaction force moment as a reaction from the road surface to the walking system. As a result of the dynamic reasoning, there is a point where the pitch and roll axis moment become zero on the side of the support polygon formed by the sole contact point and the road surface, or “ZMP (Zero Moment Point)”.
[0019]
Many of the proposals regarding the stable walking of the robot use this ZMP as a standard for determining the stability of walking. The biped walking pattern generation based on the ZMP norm has advantages such that a foot landing point can be set in advance and it is easy to consider the kinematic constraint conditions of the foot according to the road surface shape.
[0020]
For example, JP-A-5-305579 discloses a walking control device for a legged mobile robot. The walking control device described in this publication controls ZMP (Zero Moment Point), that is, a point on the floor where the moment caused by the floor reaction force when walking is zero to coincide with the target value.
[0021]
Further, in the legged mobile robot described in Japanese Patent Laid-Open No. 5-305581, the ZMP is at least a predetermined margin from the inside of the support polyhedron (polygon) or from the end of the support polyhedron (polygon) when landing or getting off the floor. It was comprised so that it might be in the position which has. As a result, even if a disturbance or the like is received, there is a ZMP margin for a predetermined distance, and the stability of walking can be improved.
[0022]
Japanese Patent Laid-Open No. 5-305583 discloses that the walking speed of a legged mobile robot is controlled by the ZMP target position. That is, the legged mobile robot described in the publication uses the walking pattern data set in advance, drives the leg joint so that the ZMP matches the target position, detects the inclination of the upper body, The discharge speed of the walking pattern data set according to the detected value is changed. As a result, when the robot leans forward, for example, by stepping on unexpected irregularities, the posture can be recovered by increasing the discharge speed. In addition, since the ZMP can be controlled to the target position, there is no problem even if the discharge speed is changed during the both-leg support period.
[0023]
Japanese Patent Laid-Open No. 5-305585 discloses that the landing position of a legged mobile robot is controlled by the ZMP target position. That is, the legged mobile robot described in the publication detects a deviation between the ZMP target position and the actually measured position and drives one or both of the legs so as to eliminate it, or around the ZMP target position. A stable walking is performed by detecting the moment and driving the leg so that it becomes zero.
[0024]
Japanese Patent Application Laid-Open No. 5-305586 discloses that the tilting posture of a legged mobile robot is controlled by the ZMP target position. In other words, the legged mobile robot described in the publication detects a moment around the ZMP target position, and when a moment is generated, drives the leg so that the moment becomes zero, so that a stable walking is performed. It has become.
[0025]
[Problems to be solved by the invention]
Unlike stationary robots such as manipulators and crawl-type mobile robots, legged mobile robots each have a plurality of movable legs that perform landing and leaving operations. Cooperation By repeating automatically, the walking motion is realized as a whole robot. At the time of landing, a reaction force from the floor surface is applied as an impact to the movable legs and the entire robot. Naturally, repeated impacts and corner impacts cause fatigue and breakage of joints (actuators) and other parts.
[0026]
In addition, human legged movement is not limited to walking movement, and further includes movement with a relatively long bed leaving period such as running and jumping. Although all of the above-described conventional technologies related to humanoid robots are only proposals for walking motions, the realization of motion patterns including the robot's bed leaving period, such as running and jumping, is typical of human beings in nature or naturally. This is one of the operation patterns. Needless to say, the movement pattern of jumping or dropping from a high place is included in the design goals of legged or humanoid robots.
[0027]
For example, in the case of the above-described humanoid robot for entertainment, a highly entertaining work such as dancing or playing games such as sports is performed. Therefore, in addition to the movement patterns that occur during human work, such as walking and stair climbing, the frequency of executing movement patterns with a long bed leaving period, such as running, jumping, jumping off high places, etc., is extremely high. is expected. In addition, a long bed leaving period means falling from a higher position. Since the robot itself is a heavy object, a much larger impact is applied when it falls than when the movable leg during normal walking is subjected to landing.
[0028]
Entertainment Oriented It can be said that the humanoid robot of this type receives more impacts by landing. For this reason, the joint actuator is easily damaged or broken, and other parts are easily damaged.
[0029]
For example, in Japanese Patent Laid-Open No. 11-48170, in a situation where a legged mobile robot is likely to fall, damage to the robot due to the fall, and damage to an object on the other side with which the robot collides at the time of the fall are reduced as much as possible. A control device for a legged mobile robot that can be used is disclosed.
[0030]
However, the control device described in the publication can reduce damage to the robot body or the housing, but does not attempt to reduce the impact applied to the joint actuator.
[0031]
In addition, the publication only proposes to control to lower the center of gravity of the robot at the time of landing due to falling, and mitigates the impact received from the floor surface by the operation throughout the period from leaving the floor to landing. It does not mention such points. In the first place, this publication considers only when the legged mobile robot falls, and is irrelevant to an operation pattern with a relatively long bed leaving period, such as a jump operation or a fall from a high place.
[0032]
The publication proposes to control the center of gravity of the robot to be lowered when landing due to falling, but the posture of the robot after landing is only assumed to be in a falling state. In other words, this publication is unrelated to the technical problem of stably controlling the posture of the robot so that it does not fall over when it leaves the floor by a jump action and then falls down again.
[0033]
The present invention has been made in view of the technical problems as described above, and the object thereof is to walk, run, jump by each of two or more movable legs executing a landing and a leaving operation in a coordinated manner repeatedly. It is an object of the present invention to provide an excellent control mechanism for a legged mobile robot that realizes an operation pattern such as the above.
[0034]
It is a further object of the present invention to provide an excellent control mechanism for a legged mobile robot capable of mitigating as much as possible the impact received from the floor surface when landing after the robot has left the floor. It is to provide.
[0035]
It is a further object of the present invention to provide a legged mobile robot capable of mitigating as much as possible the impact that the joint actuator receives from the floor surface when landing after the robot has jumped or performed other actions. It is to provide an excellent control mechanism.
[0036]
A further object of the present invention is to reduce the impact received from the floor surface as much as possible by performing a series of operations throughout the period from the robot jumping or performing other leaving operations to the landing. It is to provide an excellent control mechanism for a legged mobile robot.
[0037]
A further object of the present invention is to provide a legged mobile robot that can stably control the posture so that the robot does not fall over when landing after the robot has jumped or performed other floor movements. It is to provide an excellent control mechanism.
[0038]
[Means and Actions for Solving the Problems]
The present invention has been made in consideration of the above-mentioned problems, and the first side surface thereof is composed of at least a lower limb and an upper body disposed above the lower limb, and performs various operations according to the movement of the lower limb. A legged mobile robot that realizes a pattern,
A joint actuator with variable impedance provided at least on the lower limbs;
Detecting means for detecting whether the robot is leaving or landing; and
The impedance of the joint actuator is reduced in response to detecting that it is during the bed leaving period, and the impedance of the joint actuator is returned to the original value before the landing operation in response to detecting the landing. Control means for performing predetermined control, etc.
It is a legged mobile robot characterized by comprising.
[0039]
According to the legged mobile robot according to the first aspect of the present invention, the robot lowers the impedance of its joint actuator during the bed leaving period so that the joint actuator itself functions as a cushioning material. Can wait.
[0040]
Further, at the time of landing, the buffering effect can be ensured by restoring the impedance of the joint actuator to the original state over a predetermined time.
[0041]
In addition, after the impedance of the joint actuator is restored and the normal control state is restored, the posture control is performed so that the ZMP of the robot 100 enters the stable region based on the stability determination standard by the ZMP, so that the robot after landing Can avoid a secondary dangerous situation in which a person falls.
[0042]
Further, the second aspect of the present invention is a legged mobile robot composed of at least a lower limb and an upper body disposed above the lower limb, and realizing various operation patterns by movement of the lower limb,
Detecting means for detecting whether the robot is leaving or landing; and
First driving means for extending and bending the lower limbs;
Second driving means for extending and bending the upper body;
Control means for controlling the driving of the first and second driving means,
The control means includes
In response to detecting that it is during a bed leaving period, the first and second are such that the upper body extends in a direction opposite to the direction of gravity and / or the lower limb extends in the direction of gravity. And controlling each of the driving means of
In response to detecting the landing, each of the first and second driving means is controlled so that the position of the center of gravity of the entire robot is lowered.
This is a legged mobile robot.
[0043]
According to the legged mobile robot according to the second aspect of the present invention, during the bed leaving period, the robot takes a posture that extends in the vertical direction (described later: see FIG. 8), and the center of gravity position is landed. Wait for landing in a position that is as high as possible from the sole of the foot. Furthermore, the maximum impact force received from the floor surface at the time of landing can be reduced by taking an operation pattern in which the position of the center of gravity gradually decreases within a predetermined acceleration range when landing.
[0044]
In addition, when landing, by performing posture control so that the ZMP of the legged mobile robot enters the stable region, it is possible to avoid a secondary dangerous situation in which the robot falls over after landing. it can.
[0045]
Here, in response to detecting the landing, the control means controls each of the first and second driving means so that the position of the center of gravity of the entire robot falls within an allowable acceleration. Also good.
[0046]
In addition, the control means determines whether the ZMP of the robot is in the stable region at the time of landing, and if the determination result is negative, the control unit is configured so that the ZMP enters the stable region. You may make it perform the process which changes the attitude | position of a robot.
[0047]
The third aspect of the present invention is a legged mobile robot that is composed of at least a lower limb and an upper body disposed above the lower limb, and realizes various operation patterns by movement of the lower limb,
Detecting means for detecting whether the robot is leaving or landing; and
First driving means for driving each joint of the lower limbs;
Second driving means for driving each joint of the upper body;
Control means for controlling the driving of the first and second driving means,
The control means includes
In response to detecting that it is during the bed leaving period, it is determined whether or not the virtual ZMP on the virtual floor plane is within the virtual stable region,
In response to the negative determination result, each of the first and second driving means is controlled so that the virtual ZMP falls within the virtual stable region.
This is a legged mobile robot.
[0048]
According to the legged mobile robot according to the third aspect of the present invention, the robot can stand by until it leaves the floor while maintaining a stable posture with respect to the virtual floor plane during the bed leaving period. As a result, it is possible to eliminate as much as possible the possibility that the robot loses balance at the time of landing and the robot falls, and that part or all of the robot is damaged by the fall.
[0049]
The control means reduces the impedance of the joint actuator in response to detecting that it is during the bed leaving period, and returns the impedance of the joint actuator to the original value in response to detecting the landing. Thus, an impact absorbing operation at the time of landing may be performed. Alternatively, the control means may perform an impact absorbing operation at the time of landing so that the position of the center of gravity of the entire robot is lowered within an allowable acceleration in response to the detection of the landing by the robot.
[0050]
The fourth aspect of the present invention is a legged mobile robot control method comprising at least a lower limb and an upper body disposed above the lower limb, and realizing various motion patterns by movement of the lower limb. And at least the joint actuator provided in the lower limb is variable in impedance,
(A) reducing the impedance of the joint actuator during a bed leaving period;
(B) performing predetermined control such as returning the impedance of the joint actuator to the original value at the time of landing;
A control method for a legged mobile robot.
[0051]
In the control method according to the fourth aspect of the present invention, in step (b), the impedance may be continuously returned toward the original value continuously for a predetermined time.
[0052]
Also,
(C) upon landing, determining whether the ZMP of the robot is within a stable region;
(D) If the determination result in step (c) is negative, changing the posture of the robot so that ZMP falls within the stable region;
May be further provided.
[0053]
The fifth aspect of the present invention is a legged mobile robot control method comprising at least a lower limb and an upper body disposed above the lower limb, and realizing various operation patterns by movement of the lower limb. The legged mobile robot includes first driving means for extending and bending the lower limbs, and second driving means for extending and bending the upper body,
(A) During the bed leaving period, each of the first and second driving means is controlled so that the upper body extends in a direction opposite to the direction of gravity and / or the lower limbs extend in the direction of gravity. And steps to
(B) controlling each of the first and second driving means so that the position of the center of gravity of the entire robot is lowered in response to detecting the landing;
This is a control method for a legged mobile robot.
[0054]
In the control method according to the fifth aspect of the present invention, in the step (b), each of the first and second drive means is controlled so that the position of the center of gravity of the entire robot falls within an allowable acceleration. May be.
[0055]
Also,
(C) upon landing, determining whether the ZMP of the robot is within a stable region;
(D) If the determination result in step (c) is negative, changing the posture of the robot so that ZMP falls within the stable region;
May be further provided.
[0056]
The sixth aspect of the present invention is a legged mobile robot control method comprising at least a lower limb and an upper body disposed above the lower limb, and realizing various motion patterns by movement of the lower limb. There,
(A) determining whether the legged mobile robot is in a bed leaving period;
(B) detecting the direction of gravity of the legged mobile robot;
(C) setting a virtual floor plane of the legged mobile robot;
(D) setting a virtual stable region of the legged mobile robot;
(E) calculating a virtual ZMP of the legged mobile robot;
(F) determining whether the virtual ZMP is within a virtual stable region;
(G) in response to the determination result in the step (f) being negative, changing the posture of the legged mobile robot so that the virtual ZMP falls within the virtual stable region;
A control method for a legged mobile robot.
[0057]
The control method according to the sixth aspect of the present invention includes a step of reducing the impedance of the joint actuator in response to detecting that it is during a bed leaving period, and a step of reducing the impedance of the joint actuator in response to detecting landing. The step of returning the impedance to the original value may be further included.
[0058]
In addition, in response to detecting the landing, the robot may further include a step of controlling the posture so that the position of the center of gravity of the entire robot falls within an allowable acceleration.
[0059]
Other objects, features, and advantages of the present invention will become apparent from a more detailed description based on embodiments of the present invention described later and the accompanying drawings.
[0060]
DETAILED DESCRIPTION OF THE INVENTION
Hereinafter, embodiments of the present invention will be described in detail with reference to the drawings.
[0061]
FIG. 1 and FIG. 2 show a state in which the humanoid or humanoid robot 100 used for carrying out the present invention is viewed from the front and the rear. Further, FIG. 3 schematically shows the joint degree-of-freedom configuration of the humanoid robot 100.
[0062]
As shown in FIG. 3, the humanoid robot 100 connects an upper body including two arms and a head 1, a lower limb including two legs that realize a moving operation, and an upper limb and a lower limb. Consists of the trunk.
[0063]
The neck joint that supports the head 1 has three degrees of freedom: a neck joint yaw axis 2, a neck joint pitch axis 3, and a neck joint roll axis 4.
[0064]
Each arm portion includes a shoulder joint pitch axis 8, a shoulder joint roll axis 9, an upper arm yaw axis 10, an elbow joint pitch axis 11, a forearm yaw axis 12, a wrist joint pitch axis 13, and a wrist joint roll. It comprises a shaft 14 and a hand portion 15. The hand portion 15 is actually a multi-joint / multi-degree-of-freedom structure including a plurality of fingers. However, since the movement of the hand portion 15 has little contribution or influence to the posture stability control or the walking movement control of the robot 100, it is assumed in this specification that there is zero degree of freedom. Therefore, it is assumed that each arm portion has seven degrees of freedom.
[0065]
The trunk has three degrees of freedom: a trunk pitch axis 5, a trunk roll axis 6, and a trunk yaw axis 7.
[0066]
Further, each leg constituting the lower limb includes a hip joint yaw axis 16, a hip joint pitch axis 17, a hip joint roll axis 18, a knee joint pitch axis 19, an ankle joint pitch axis 20, and a joint roll axis 21. It is comprised with the foot | leg part (plant sole) 22. Assume that the intersection point of the hip joint pitch axis 17 and the hip joint roll axis 18 defines the hip joint position of the robot 100 according to the present embodiment. The human foot (sole) 22 is actually a structure including a multi-joint / multi-degree-of-freedom sole, but the sole of the humanoid robot 100 according to the present embodiment has zero degrees of freedom. . Accordingly, each leg is configured with 6 degrees of freedom.
[0067]
In summary, the entire humanoid robot 100 according to the present embodiment has a total of 3 + 7 × 2 + 3 + 6 × 2 = 32 degrees of freedom. However, the humanoid robot 100 for entertainment is not necessarily limited to 32 degrees of freedom. It goes without saying that the degree of freedom, that is, the number of joints, can be increased or decreased as appropriate in accordance with design and manufacturing constraints and required specifications.
[0068]
Each degree of freedom of the humanoid robot 100 as described above is actually implemented using an actuator. It is preferable that the actuator be small and light in light of demands such as eliminating the appearance of extra bulges on the appearance and approximating the shape of a human body, and performing posture control on an unstable structure such as biped walking. . In this embodiment, a small AC servo actuator of a gear direct connection type and a servo control system of a single chip built in a motor unit is mounted. This type of AC servo actuator is disclosed in, for example, Japanese Patent Application No. 11-33386, which has already been assigned to the present applicant.
[0069]
FIG. 4 schematically shows a control system configuration of the humanoid robot 100. As shown in the figure, the humanoid robot 100 performs adaptive control for realizing cooperative operation between the mechanism units 30, 40, 50R / L, and 60R / L representing the human limbs and the mechanism units. It is comprised with the control unit 80 to perform (however, each of R and L is a suffix which shows each of right and left, and so on).
[0070]
The overall operation of the humanoid robot 100 is controlled by the control unit 80 in an integrated manner. The control unit 80 exchanges data and commands between a main control unit 81 composed of main circuit components (not shown) such as a CPU (Central Processing Unit) chip and a memory chip, and each component of the power supply device and the robot 100. And a peripheral circuit 82 including an interface (not shown) for performing the above.
[0071]
In this embodiment, the power supply apparatus has a configuration (not shown in FIG. 4) including a battery for driving the robot 100 autonomously. If it is a self-supporting drive type, the physical action radius of the humanoid robot 100 can be freely walked without being restricted by the power cable. Further, during various exercises including walking and other upper limbs, it is not necessary to consider interference with the power cable, and operation control is facilitated.
[0072]
Each degree of freedom of joint in the robot 100 shown in FIG. 3 is realized by a corresponding actuator. That is, the head unit 30 includes a neck joint yaw axis actuator A that represents the neck joint yaw axis 2, the neck joint pitch axis 3, and the neck joint roll axis 4. ₂ , Neck joint pitch axis actuator A _Three , Neck joint roll axis actuator A _Four Are arranged respectively.
[0073]
The trunk unit 40 includes a trunk pitch axis actuator A that represents the trunk pitch axis 5, the trunk roll axis 6, and the trunk yaw axis 7. _Five , Trunk roll axis actuator A ₆ , Trunk yaw axis actuator A ₇ Are deployed.
[0074]
Further, the arm unit 50R / L is subdivided into an upper arm unit 51R / L, an elbow joint unit 52R / L, and a forearm unit 53R / L, but a shoulder joint pitch axis 8, a shoulder joint roll axis 9, and an upper arm Shoulder joint pitch axis actuator A representing the yaw axis 10, the elbow joint pitch axis 11, the elbow joint roll axis 12, the wrist joint pitch axis 13, and the wrist joint roll axis 14. ₈ , Shoulder joint roll axis actuator A ₉ , Upper arm yaw axis actuator A _Ten , Elbow joint pitch axis actuator A ₁₁ , Elbow joint roll axis actuator A ₁₂ , Wrist joint pitch axis actuator A ₁₃ Wrist joint roll axis actuator A ₁₄ Are deployed.
[0075]
The leg unit 60R / L is subdivided into a thigh unit 61R / L, a knee unit 62R / L, and a shin unit 63R / L, but the hip joint yaw axis 16, the hip joint pitch axis 17, the hip joint Hip joint yaw axis actuator A representing each of roll axis 18, knee joint pitch axis 19, ankle joint pitch axis 20, and ankle joint roll axis 21 ₁₆ Hip joint pitch axis actuator A ₁₇ , Hip joint roll axis actuator A ₁₈ , Knee joint pitch axis actuator A ₁₉ , Ankle joint pitch axis actuator A ₂₀ , Ankle joint roll axis actuator A _{twenty one} Are deployed.
[0076]
Each actuator A ₂ , A _Three Is more preferably a small AC servo actuator (described above) of a gear direct connection type and a servo control system that is mounted on a motor unit in a single chip.
[0077]
For each mechanism unit such as the head unit 30, the trunk unit 40, the arm unit 50, and each leg unit 60, sub-control units 35, 45, 55, and 65 for actuator drive control are respectively provided. Furthermore, grounding confirmation sensors 91 and 92 for detecting whether or not the soles of the leg portions 60R and 60L have landed are mounted, and a posture sensor 93 for measuring posture is provided in the trunk unit 40. ing. In this embodiment, an acceleration sensor is used as the attitude sensor 93. The control targets can be dynamically corrected by detecting the landing and leaving periods of the sole 22, the inclination of the trunk portion, and the like based on the outputs of the sensors 91 to 93.
[0078]
The main control unit 80 performs adaptive control on each of the sub-control units 35, 45, 55, and 65 in response to the outputs of the sensors 91 to 93, and the upper limbs, the trunk, and the humanoid robot 100. The coordinated movement of the lower limbs can be realized. The main control unit 81 sets a foot movement, a ZMP (Zero Moment Point) trajectory, a trunk movement, an upper limb movement, a waist height, and the like according to a user command and the like, and instructs an operation in accordance with these setting contents. The command to be transferred is transferred to each sub-control unit 35, 45, 55, 65.
[0079]
And each sub-control part 35, 45 ... interprets the received command from the main control part 81, and each actuator A ₂ , A _Three A drive control signal is output to. Here, “ZMP” refers to a point on the floor where the moment due to floor reaction force during walking is zero, and “ZMP trajectory” refers to, for example, during the walking operation period of the robot 100. It means the trajectory that ZMP moves.
[0080]
Next, a processing procedure when the humanoid robot 100 is dropped and landed after a bed leaving period such as a jump will be described.
[0081]
FIG. 5 illustrates an example of a processing procedure during landing in the form of a flowchart.
Hereinafter, each step of this flowchart will be described.
[0082]
When the robot 100 performs a bed leaving operation (step S11), the ground contact confirmation sensors 91 and 92 provided on the soles of both feet are turned off (step S12), and the main control unit 81 detects the bed leaving state. . The movement pattern of the leaving action here is not particularly specified, such as a jumping action or an action of jumping off from a high place, and therefore the description thereof is omitted in this specification.
[0083]
In response to detecting the bed leaving motion, the control parameter value of each joint actuator is changed (step S13). More specifically, the control parameter is changed so that the impedance of the actuator is lowered. Since the actuator with low impedance is in a flexible state, it functions as a buffer when landing and can absorb the impact received from the floor surface. In particular, it is preferable to change the impedance of an actuator that receives a large impact near the floor, such as an ankle joint or a knee joint.
[0084]
FIG. 6 shows a block diagram of a servo circuit related to one actuator used in the robot 100 and its control system 200. As shown in the figure, the control system is a type of control system that receives position command and speed command and feeds back position detection. The position command is input to the position controller 201, the output of the position controller 201 and the speed command are input to the speed controllers 202 and 203, the output of the speed controller 203 is supplied to the actuator 204, and the actuator 204 is driven. . In addition, a position detection signal from an encoder (not shown) attached to the actuator 204 is fed back to the position controller 201, and a time differentiated signal is fed back to the speed controller 202.
[0085]
K shown in FIG. _pp , K _vi , K _vp Are control parameters for the servo control system. By changing at least one of these parameters to a small value, the impedance of the actuator 200 decreases.
[0086]
The actuator 200 is a small AC servo actuator of the type directly connected to the gear and having a servo control system integrated into a motor unit. For example, Japanese Patent Application No. 11-29 already assigned to the present applicant. No. 33386.
[0087]
Returning to FIG. 5 again, the processing procedure will be described. In step S14, both the ground sensors 91 and 92 of both feet are turned on (or one of the sensors is turned on), and the robot 100 is on standby until it reaches the floor surface.
[0088]
When landing of the robot 100 is detected, the control parameter value of the joint actuator changed in step S13 is returned to the original value (step S15). As a result, the impedance of the actuator is recovered, and a state before leaving the bed where the operation of the robot 100 can be controlled is obtained. However, if the impedance is sharply recovered, the effect as a buffer material is lost, and therefore, it returns to the original value over a predetermined time T (for example, about several hundred milliseconds).
[0089]
Next, it is determined whether or not the ZMP of the robot 100 is in a stable region, for example, at the planted sole (step S16). If ZMP is not in the stable region, the posture of the entire robot 100 is changed so as to enter the stable region (step S17).
[0090]
On the other hand, if the ZMP is in the stable region, the entire processing procedure is terminated.
[0091]
According to the landing processing procedure as shown in FIG. 5, the robot 100 may reduce the impedance of its joint actuator during the bed leaving period, and wait for the robot 100 to land while the actuator functions as a cushioning material. it can.
[0092]
Further, when the robot 100 is landed, the buffering effect can be ensured by restoring the impedance to the original state after a predetermined time.
[0093]
In addition, after the robot 100 has landed and the impedance of the joint actuator has recovered and returned to the normal control state, the posture control is performed so that the ZMP of the robot 100 enters the stable region based on the stability determination criterion by the ZMP. By doing so, it is possible to avoid a secondary dangerous situation in which the robot 100 falls over after landing.
[0094]
FIG. 7 illustrates another example in the form of a flowchart regarding a processing procedure at the time of landing. Hereinafter, each step of this flowchart will be described.
[0095]
When the robot 100 performs a bed leaving operation (step S21), the ground contact confirmation sensors 91 and 92 provided on the soles of both feet are turned off (step S22), and the main controller 81 determines whether the robot 100 has left the floor. Detected. As for the leaving action here, an action pattern such as a jumping action or an action of jumping down from a high place is not particularly specified, and thus description thereof is omitted in this specification.
[0096]
In response to detecting the bed leaving motion, the pitch axis at each joint of the upper limb and trunk of the robot 100 is rotationally driven in the direction opposite to the direction of gravity, and the lower limbs and legs are extended in the direction of gravity (step S23). ).
[0097]
FIG. 8 schematically illustrates an example of a posture in which the pitch axis at each joint of the upper limb and trunk of the robot 100 is rotationally driven in the direction opposite to the direction of gravity and the lower limbs and legs are extended in the direction of gravity. ing. As shown in the figure, the posture of the robot 100 is controlled so that both hands and both feet of the robot 100 extend. As a result, the distance (height) h from the tip of the foot to the center of gravity G of the entire robot 100 is longer than the center of gravity G ′ before extending the limb.
[0098]
In step S24, both the ground sensors 91 and 92 of both feet are turned on (or one of the sensors is turned on) and waits until the robot 100 reaches the floor surface.
[0099]
When the landing of the robot 100 is detected, the pitch axes of the upper limb, the lower limb, and the trunk joint of the robot are driven so that the center of gravity of the robot 100 is lowered (step S25).
[0100]
An example of a posture in which the center of gravity of the robot 100 is lowered is a state in which both legs, hip joints, and trunk joints are bent and bent as shown in FIG. 9, for example. It will be understood that the distance from the foot that has landed to the center of gravity is sufficiently short.
[0101]
By the bending operation in step S25, the position of the center of gravity of the robot 100 becomes G when landing. ₀ From the end of landing operation (when stable) G _f (However, G ₀ > G _F ). By spending a predetermined time T for this series of landing operations, the impact force that the robot 100 receives from the floor surface is gently dispersed during the time T as shown in the chart of FIG. 10, and the maximum impact force is also reduced. The
[0102]
However, in the bending operation in step S25, the driving speed of each joint axis is set so that the value of the acceleration sensor 93 does not exceed the allowable acceleration value. Cooperation Therefore, it is necessary to control (that is, to bend the posture). This is because if the bending motion is performed at a value exceeding the allowable acceleration, the impact applied to the robot 100 is rather amplified.
[0103]
FIG. 11 shows the position of the center of gravity of the robot 100 at the point G when landing. ₀ To point G _F The chart shows the relationship between the speed of movement to the floor and the impact force received from the floor. More specifically, the center of gravity position is point G. ₀ To point G _F The time required to move to (that is, the time required to reach stability after landing) T is T ₁ , T ₂ , And T _Three (However, T ₁ <T ₂ <T _Three ) Is plotted. As can be seen from the figure, the shorter the required time, the faster the acceleration of movement of the center of gravity position, and the maximum value of the impact force F received from the floor surface increases in proportion to this. Conversely, the longer the time required for the movement of the center of gravity, the lower the acceleration, the impact upon landing is absorbed by the movement of the center of gravity, and the maximum value of the impact force F is reduced.
[0104]
Next, it is determined whether or not the ZMP of the robot 100 is in a stable region, for example, at the planted sole (step S26). If ZMP is not in the stable region, the posture of the entire robot 100 is changed so as to enter the stable region (step S27).
[0105]
On the other hand, if the ZMP is in the stable region, the entire processing procedure is terminated.
[0106]
According to the landing processing procedure as shown in FIG. 7, the robot 100 takes a posture in which the robot 100 extends in the vertical direction during the bed leaving period (see FIG. 8), and the center of gravity position is as much as possible from the sole where the floor is landing. It is possible to wait for landing in a high position. Furthermore, the maximum impact force received from the floor surface can be reduced by taking an operation pattern in which the position of the center of gravity gradually decreases within a predetermined acceleration range during landing.
[0107]
Further, when landing, by performing posture control so that the ZMP of the robot 100 enters the stable region, it is possible to avoid a secondary dangerous situation in which the robot 100 falls over after landing. .
[0108]
FIG. 12 illustrates another example of the processing procedure at the time of landing in the form of a flowchart. Hereinafter, each step of this flowchart will be described.
[0109]
When the robot 100 performs a bed leaving operation (step S31), the ground contact confirmation sensors 91 and 92 provided on the soles of both feet are turned off (step S32), and the main control unit 81 detects the bed leaving state. . As for the leaving action here, an action pattern such as a jumping action or an action of jumping down from a high place is not particularly specified, and thus description thereof is omitted in this specification.
[0110]
In response to detecting the bed leaving motion, the main control unit 81 calculates the direction of gravity based on the output of the attitude sensor 93 (step S33), and sets the virtual floor plane (step S34). In this specification, “virtual floor plane” means the current robot 100. Gravity vector at the lowest point (either left or right foot or both feet in normal leaving movement such as jump) is the normal vector Refers to the plane (see FIG. 13).
[0111]
Next, a virtual stable area on the virtual floor plane is set (step S35). In this specification, the “virtual stable region” refers to a region on the floor where the robot 100 can maintain stability when it is landed on the virtual floor plane in the current posture of the robot 100. . For example, you landed on a virtual floor plane Support polygon formed by the foot contact point and virtual floor plane (Refer to FIG. 14).
[0112]
Next, a virtual ZMP is calculated (step S36). The “virtual ZMP” is a point on the virtual floor plane where the moment due to the floor reaction force on the virtual floor plane is zero.
[0113]
In decision block S37, it is determined whether or not the virtual ZMP is within the virtual stable region.
[0114]
If the determination result is negative, the posture of the robot 100 is changed by driving at least some joint actuators of the upper limb, lower limb, and trunk of the robot 100 so that the virtual ZMP falls within the virtual stable region ( Step S38).
[0115]
As a result of the posture control as described above, the robot 100 can wait for the landing while always maintaining a stable posture with respect to the virtual floor plane during the bed leaving period. At the time of landing, the virtual floor plane coincides with the actual floor plane, but in step S39 described above, the robot 100 can land in a stable posture. The landing operation may include an impact absorbing operation as described with reference to FIGS.
[0116]
In short, if the posture control processing procedure as shown in FIG. 12 is followed, the robot 100 can stand by until it leaves the floor while maintaining a stable posture with respect to the virtual floor plane during the bed leaving period. As a result, it is possible to eliminate as much as possible the possibility that the robot 100 will fall out of balance at the time of landing, and that part or all of the robot 100 will be damaged by the fall. Furthermore, a perfect landing operation can be realized by incorporating the above-described shock absorbing operation.
[0117]
[Supplement]
The present invention has been described in detail above with reference to specific embodiments. However, it is obvious that those skilled in the art can make modifications and substitutions of the embodiments without departing from the gist of the present invention.
[0118]
In the present specification, the present invention has been described by taking a humanoid robot that performs legged movement with two legs as an example, but the gist of the present invention is not limited to a biped robot. For example, the present invention can be suitably applied to a quadruped walking robot such as a pet-type robot that models a dog or other legged mobile robots having a lower number of legs. Further, as shown in the present embodiment, the present invention can be applied to a robot of a type in which an upper limb or a head is not mounted on the trunk (trunk unit).
[0119]
In short, the present invention has been disclosed in the form of exemplification, and should not be interpreted in a limited manner. In order to determine the gist of the present invention, the claims section described at the beginning should be considered.
[0120]
In judging the gist of the present invention, it is not appropriate to strictly apply FIG. 3 for the names of joints and the like for the biped robot 100, and biped upright walking such as actual humans and monkeys. It should be interpreted flexibly by contrast with the animal's physical mechanism.
[0121]
For reference, the joint model configuration of a humanoid robot is illustrated in FIG. In the example shown in the figure, a portion including the shoulder joint 5 to the upper arm, the elbow joint 6, the forearm, the wrist 7 and the hand portion 8 is referred to as an “upper limb”. The range from the shoulder joint 5 to the hip joint 11 is called a “trunk” and corresponds to the human torso. In addition, a range from the hip joint 11 to the trunk joint 10 among the trunk is referred to as a “lumbar region”. The trunk joint 10 has an effect of expressing the degree of freedom of the human spine. Further, a portion including the thigh 12, the knee joint 14, the crus 13, the ankle 15, and the foot 16 below the hip joint 11 is referred to as “lower limb”. Generally, the upper part of the hip joint is called the “upper body” and the lower part is called the “lower body”.
[0122]
FIG. 16 illustrates another joint model configuration of a humanoid robot. The example shown in the figure is different from the example shown in FIG. 14 in that the trunk joint 10 is not provided. Refer to the figure for the names of each part. As a result of the omission of the trunk joint corresponding to the spine, the upper body movement of the humanoid robot loses its expressive power. However, in the case of a humanoid robot for industrial purposes such as dangerous work or substitution of work, there is a case where movement of the upper body is not required. It should be understood that the reference numerals used in FIGS. 15 and 16 do not match those in other drawings such as FIG.
[0123]
【The invention's effect】
As described above in detail, according to the present invention, an excellent legged mobile robot capable of mitigating as much as possible the impact received from the floor surface when landing after jumping or other robots leaving the floor, and The control method can be provided.
[0124]
Further, according to the present invention, an excellent legged mobile robot capable of reducing as much as possible the impact that the joint actuator receives from the floor surface when landing after the robot has jumped or performed other flooring operations, and The control method can be provided.
[0125]
In addition, according to the present invention, the impact received from the floor surface can be reduced as much as possible through a series of operations through the entire period until the robot reaches the floor after jumping or performing other bed leaving operations. An excellent legged mobile robot and its control method can be provided.
[0126]
In addition, according to the present invention, when the robot is landing after jumping or performing other bed leaving operations, it is possible to stably control the posture of the robot so that the robot does not fall down. The control method can be provided.
[Brief description of the drawings]
FIG. 1 shows a state in which a humanoid robot 100 used for carrying out the present invention is viewed from the front. Shi It is a figure.
FIG. 2 shows a state in which a humanoid robot 100 used for carrying out the present invention is viewed from behind. Shi It is a figure.
FIG. 3 is a diagram schematically illustrating a degree-of-freedom configuration model included in the humanoid robot 100 according to the present embodiment.
FIG. 4 is a diagram schematically illustrating a control system configuration of the humanoid robot 100 according to the present embodiment.
FIG. 5 is a flowchart showing an example of a processing procedure when the robot 100 is landed.
6 is a block diagram illustrating a servo circuit and a control system related to one actuator used in the robot 100. FIG.
FIG. 7 is a flowchart showing another example of a processing procedure when the robot 100 is landed.
FIG. 8 shows a state in which the robot 100 in the bed leaving period has both hands and both legs extended, and the posture (the height) from the tip of the foot that reaches the floor to the center of gravity of the entire robot 100 is as long as possible. FIG.
FIG. 9 is a diagram showing a specific example of the posture that the robot 100 takes when landing.
FIG. 10 is a chart showing an impact force that the robot 100 receives from the floor surface when landing.
FIG. 11 shows the position of the center of gravity of the robot 100 at the point G when landing ₀ To point G _F It is the chart which showed the relationship between the speed to move to and the impact force received from a floor surface.
FIG. 12 is a flowchart showing another example of a processing procedure when the robot 100 is landed.
FIG. 13 illustrates a virtual floor plane for the robot 100 at the time of getting out of bed.
FIG. 14 illustrates a virtual stable region of the robot 100 when getting out of bed.
FIG. 15 is a diagram schematically showing an example of a joint model configuration for a humanoid robot.
FIG. 16 is a diagram schematically illustrating another example of a joint model configuration for a humanoid robot.

Claims (6)

A legged mobile robot having an upper body and a lower limb connected to the upper body,
Detecting means for detecting whether the robot is leaving or landing; and
First driving means for driving each joint of the upper body;
Second driving means for driving each joint of the lower limbs;
Control means for controlling driving of the first and second driving means;
Comprising
The control means includes
In response to detecting that it is during a bed leaving period, a virtual floor generated when landing on a virtual floor plane passing through the lowest point of the legged mobile robot and having a gravity vector as a normal vector Whether the virtual ZMP on the virtual floor plane where the moment due to the reaction force is zero is within the virtual stable region consisting of the foot ground contact point of the foot landing on the virtual floor plane and the support polygon formed by the virtual floor plane And determine whether or not
In response to the negative determination result, each of the first and second driving means is controlled so that the virtual ZMP falls within the virtual stable region.
Legged mobile robot. The control means reduces the impedance of the joint actuator in response to detecting that it is during the bed leaving period, and returns the impedance of the joint actuator to the original value in response to detecting the landing.
The legged mobile robot according to claim 1. In response to detecting the landing, the control means controls each of the first and second driving means so that the position of the center of gravity of the entire robot falls within an allowable acceleration.
The legged mobile robot according to claim 1. A control method for a legged mobile robot having at least a lower limb,
(A) determining whether the legged mobile robot is in a bed leaving period;
(B) detecting the direction of gravity of the legged mobile robot;
(C) In response to detecting that it is during a bed leaving period, a step of setting a virtual floor plane that passes through the lowest point of the legged mobile robot of the legged mobile robot and has a gravity vector as a normal vector When,
(D) setting a virtual stable region consisting of a foot ground contact point of the foot that the legged mobile robot has landed on the virtual floor plane and a support polygon formed by the virtual floor plane ;
(E) calculating a virtual ZMP on a virtual floor plane in which a moment due to a virtual floor reaction force generated when the legged mobile robot is landed on the virtual floor plane is zero ;
(F) determining whether the virtual ZMP is within a virtual stable region;
(G) in response to the determination result in the step (f) being negative, changing the posture of the legged mobile robot so that the virtual ZMP falls within the virtual stable region;
Method for controlling a legged mobile robot having   A step of reducing the impedance of the joint actuator in response to detecting that it is during a bed leaving period, and a step of returning the impedance of the joint actuator to an original value in response to detection of landing. Item 5. A control method for a legged mobile robot according to Item 4.   5. The control method for a legged mobile robot according to claim 4, further comprising a step of controlling the posture so that the position of the center of gravity of the entire robot falls within an allowable acceleration in response to detection of landing.

Images