Fixed point stablization device for legged mobile body

Abstract

The present invention provides a fixed point stabilization device for a legged mobile body having a generating mechanism for generating a fixed point. The present invention also provides a fixed point stabilization device for a legged mobile body comprising stabilizing means for stabilizing the fixed point in accordance with a leg grounding position of the legged mobile body. The fixed point is generated by inputting a predetermined constant torque to a joint of a leg of the legged mobile body on the basis of the energy balance in the legged mobile body, leg switching, and a leg swinging motion. The fixed point is stabilized globally by keeping the leg grounding position of the legged mobile body constant using a stopper. Further, the fixed point is stabilized locally by varying the leg grounding position of the legged mobile body in accordance with a deviation between the fixed point and a current quantity of state.

Description

TECHNICAL FIELD

The present application claims priority on the basis of Japanese Patent Application No. 2005-168905, filed on Jun. 8, 2005, the entire contents of which are hereby incorporated in this specification by reference.

The present invention relates to a fixed point stabilization device for a legged mobile body.

BACKGROUND ART

Patent Document 1 and so on are known as examples of attitude stabilization control for a legged mobile robot, in particular a bipedal walking legged mobile robot employing Zero Moment Point (ZMP). Further, Non-Patent Document 1 provides detail with respect to stabilization of the fixed point of a legged mobile body, in particular a passive walker.

Conventional legged mobile robots stand at the forefront of technologies including high-precision sensors, high-performance actuators, and advanced control. The keystone of the technologies is ZMP. A walking control method employing ZMP focuses on trajectory planning and control (including measurement) of ZMP.

Meanwhile, the gait known as passive walking, cannot be ignored, and always generates a great deal of interest in terms of the possibility of engineering applications. A feature of passive dynamic walking is that a natural gait can be produced by the interaction between the dynamics of the legged mobile body and the environment (a downward slope) with no control whatsoever.

Patent Document 1: Japanese Patent No. 3269852

Non-Patent Document 1: T. McGeer, “Passive Dynamic Walking”, The Int. J. of Robotics Research, vol. 9, no. 2, pp. 62-82, 1990

DISCLOSURE OF THE INVENTION

ZMP is an important mechanical index relating to attitude stabilization not only during walking, and is the most powerful tool for enabling walking without falling. However, with attitude stabilization control employing ZMP, it is difficult in principle to realize a highly energy-efficient gait. Moreover, the resulting gait feels unnatural compared to passive walking.

In passive walking, the solution of a nonlinear leg swinging motion jumps discontinuously due to the leg switching phenomenon. A cyclic trajectory is generated from this type of hybrid system. When the trajectory forms a limit cycle, the state immediately after grounding is fixed as the fixed point. With conventional passive walking, however, a stable fixed point does not exist when walking uphill and along level ground, and therefore a steady gait cannot be achieved. Moreover, the robustness of passive walking is low, and stable continuous walking is difficult. Furthermore, convergence on the fixed point is poor.

It is therefore an object of the present invention to provide a fixed point stabilization device for a legged mobile body having a generating mechanism for generating a fixed point. Another object of the present invention is to provide a fixed point stabilization device for a legged mobile body comprising stabilizing means for stabilizing the fixed point generated by the generating mechanism in accordance with a leg grounding position of the legged mobile body.

A fixed point stabilization device for a legged mobile body according to the present invention has a generating mechanism for generating a fixed point, and is characterized in comprising stabilizing means for stabilizing the fixed point generated by the generating mechanism in accordance with a leg grounding position of the legged mobile body.

In the fixed point stabilization device for a legged mobile body according to the present invention, the generating mechanism preferably generates the fixed point from an energy balance in the legged mobile body, leg switching, and a leg swinging motion.

The generating mechanism preferably generates the fixed point by inputting a constant torque to a joint of a leg of the legged mobile body.

Further, in the fixed point stabilization device for a legged mobile body according to the present invention, the stabilizing means preferably stabilize the fixed point globally by keeping the leg grounding position of the legged mobile body constant or substantially constant. At this time, the stabilizing means are preferably a stopper.

Furthermore, the stabilizing means preferably stabilize the fixed point locally by varying the leg grounding position of the legged mobile body in accordance with a deviation between the fixed point and a current quantity of state.

According to the present invention, a fixed point can be generated, on level ground or uphill, simply by inputting a constant torque at each step period based on a mechanical structure of a fixed point formed from an energy balance, leg switching, and a leg swinging motion. As a result, a natural and highly energy-efficient gait can be realized.

By keeping the grounding position of the leg constant or substantially constant, the fixed point can be stabilized globally, enabling extremely stable continuous walking. Moreover, robustness increases dramatically.

Finite settling is performed through local stabilization of the fixed point, and as a result, the fixed point converges to a substantially steady state in a few steps.

BRIEF DESCRIPTION OF THE DRAWINGS

FIG. 1 is a schematic view showing a legged mobile body having a knee joint;

FIG. 2 is a view showing the results of a walking simulation; and

FIG. 3 is a schematic view showing the entirety of a legged mobile body employing the present invention.

BEST MODE FOR CARRYING OUT THE INVENTION

A preferred embodiment of a fixed point stabilization device for a legged mobile body according to the present invention will be described below.

A generating mechanism for generating a fixed point, which is provided in the fixed point stabilization device for a legged mobile body according to the present invention, is capable of calculating a fixed point directly, without searching for a fixed point numerically, from the energy balance in the legged mobile body, leg switching, and a leg swinging motion. Hence, by varying the energy balance and the leg switching and leg swinging motions, a fixed point can be created as desired. For example, a fixed point is preferably calculated from an energy balance formula, a leg switching formula, and a leg swinging formula, whereupon a fixed torque required to generate the fixed point is generated in the joints of the legged mobile body.

In the fixed point stabilization device for a legged mobile body according to the present invention, the most important feature of the stabilizing means is to keep the leg grounding position of the legged mobile body constant or substantially constant in order to stabilize the fixed point globally. Keeping the leg grounding position constant or substantially constant is preferably realized actively by a servo mechanism employing an actuator, or more preferably realized passively employing a passive element. Attaching a stopper to the legged mobile body, for example, is simple and reliable.

Further, by varying the leg grounding position of the legged mobile body in accordance with a deviation between the fixed point and the current quantity of state, the fixed point is stabilized locally. The quantity of state is preferably taken as the state immediately before or immediately after grounding, and the leg is grounded in a grounding position that has been varied according to the deviation from the fixed point, preferably such that local (in the vicinity of the fixed point) stability in a discrete time system reaches a maximum.

EMBODIMENT

First Embodiment

FIG. 1 schematically shows a legged mobile body having a knee joint. First, fixed point generation and local stabilization on level ground (γ=0 [rad]) will be described. In FIG. 1, l=0.7 [m], l₁=l₂=0.35 [m], a₁=b₁=a₂=b₂=0.35 [m], and p=m₂/m₁=0.4. The fixed point of the passive dynamic walking class corresponding to a slope angle of γ=0.073 [rad] is derived from a legged mobile body energy balance formula, a leg switching formula, and a leg swinging motion formula. The quantity of state at this time corresponds to an inter-leg angle α_f=0.73750 [rad] immediately after grounding and the angular velocity of a stance leg (d←/dt)|_f⁺=1.35140 [rad/s]. Note that in this embodiment, the knee joint of a swing leg is fixed at the point where the swing leg becomes straight and the knee joint of the stance leg extends straight, and therefore the inter-leg angle immediately after grounding is considered equivalent to the grounding position of the leg.

Joint torque vectors τ_K, τ_C required to generate the fixed point are calculated from Formula 1 and Formula 2 and obtained as follows,

τ_K=[0.50078, −0.275429, −0.125195][Nm/kgm²]

τ_C=[0.50078, −0.275429][Nm/kgm²]

Until the knee joint of the swing leg is fixed, τ_K is input, and after the knee joint is fixed, τ_C is input.

A coefficient is calculated from the inter-leg angle α_f at the fixed point, the angular velocity of the stance leg (dθ/dt)|_f⁺, and Formulae 3, 4 and 5, and obtained as follows,

a_f=0.002 [l/s], b_f=−0.8156 [l/s], c_f=0.5478

Then, a rate of change in the inter-leg angle at the time of grounding as finite setting is calculated from Formulae 6 and 7, and obtained as follows,

(δα_k+1/δα_k)|_f=0.54861, (δα_k+1/δ((dθ/dt)|⁺))|_f=0.36845 [s]

Finally, when setting is performed to obtain the numerical value of (δα_k+1/δα_k)|_f, (δα_k+1/δ((dθ/dt)|⁺))|_f at which the coefficient of Formula 8 is obtained,

K_α=1.7582, K_(dθ/dt)=−1.4508

By controlling the leg grounding position (the inter-leg angle at the time of grounding) using Formula 8 in the vicinity of the fixed point, the fixed point can be locally stabilized.

FIG. 2 shows the results of a walking simulation. The abscissa and ordinate respectively show the number of steps and the inter-leg angle at the time of grounding. As is evident from the drawing, a fixed point (gait) is generated even on level ground and converges to a substantially steady state after three steps.

FIG. 3 is a schematic view showing the legged mobile body employing this embodiment. A simple stopper such as that shown in FIG. 3 is attached in order to fix the leg grounding position (the inter-leg angle at the time of grounding) of the legged mobile body. Note that the stopper is not limited to this example. When the leg grounding position is not fixed (the stopper is not provided), continuous downhill walking for five paces or more is impossible. When the grounding position is fixed, on the other hand, continuous downhill walking for nine paces (the maximum number of possible steps) is achieved with a success rate of approximately 70 [%]. Note that the experiment was conducted 350 times.

$\begin{array}{cc}{\tau }_{\kappa }=\left[\begin{array}{c}{\tau }_{1f}\\ {\tau }_{2f}\\ {\tau }_{3f}\end{array}\right]=\left[\begin{array}{c}{u}_1\text{/}M\\ u_2\text{/}m_1\\ u_3\text{/}m_2\end{array}\right]=\left[\begin{array}{c}l\left({\gamma }^{\prime }-\gamma \right)\\ -\left(b_1+{\mathrm{pl}}_1+{\mathrm{pb}}_2\right)\left({\gamma }^{\prime }-\gamma \right)\\ -b_2\left({\gamma }^{\prime }-\gamma \right)\end{array}\right]g& \mathrm{Formula}1\\ {\tau }_C=\left[\begin{array}{c}{\tau }_{1f}\\ {\tau }_{2f}\end{array}\right]=\left[\begin{array}{c}{u}_1\text{/}M\\ u_2\text{/}m_1\end{array}\right]=\left[\begin{array}{c}l\left({\gamma }^{\prime }-\gamma \right)\\ -\left(1+p\right)b\left({\gamma }^{\prime }-\gamma \right)\end{array}\right]g& \mathrm{Formula}2\\ {\alpha }_f=\frac{1}{d_f}\frac{\partial e_f}{\partial {\alpha }_f}\left({\stackrel{.}{\theta }}_f^{+2}+\frac{4g}{l}\sin \frac{{\alpha }_f}{2}\sin \gamma +\frac{2{\tau }_{1k}{\alpha }_l}{l^2}\right)+e_f\frac{g}{2{\mathrm{ld}}_f}\left(\sin \frac{{\alpha }_f}{2}\cos \gamma +\cos \frac{{\alpha }_f}{2}\sin \gamma \right)+e_f\frac{{\tau }_{1f}}{2l^2d_f}\mathrm{Where}d_f=\sqrt{{\stackrel{.}{\theta }}_f^{+2}+\frac{4g}{l}\sin \frac{{\alpha }_f}{2}\sin \gamma +\frac{2{\tau }_{1k}{\alpha }_f}{l^2}}e_f=\cos {\alpha }_f& \mathrm{Formula}3\\ b_f=e_f\frac{g}{2{\mathrm{ld}}_f}\left(-\sin \frac{{\alpha }_f}{2}\cos \gamma +\cos \frac{{\alpha }_f}{2}\sin \gamma \right)+e_f\frac{{\tau }_{1f}}{2l^2d_f}& \mathrm{Formula}4\\ c_f=e_f\frac{{\stackrel{.}{\theta }}_f^{+}}{d_f}& \mathrm{Formula}5\\ \frac{\partial {\alpha }_{k+1}}{\partial {\alpha }_k}{}_f=-\frac{b_fc_f}{b_f+a_fc_f}& \mathrm{Formula}6\\ \frac{\partial {\alpha }_{k+1}}{\partial {\stackrel{.}{\theta }}_k^{+}}{}_f=-\frac{c_f^2}{b_f+a_fc_f}& \mathrm{Formula}7\end{array}$ τ_2k=K_α(α_k−α_f)+K_θ({dot over (θ)}_k⁺−{dot over (θ)}_f+)+τ_2f  Formula 8

The meanings of the symbols in the above formulae and the drawings are as follows.

g: acceleration of gravityγ: slope angleu₁: ankle torque, u₂: hip torque, u₃: knee torqueτ_K: joint torque vector of fixed pointτ_C: joint torque vector of fixed point when locked at knee of swing leg extends straight τ_K and τ_C can be expressed as follows.

τ_K=[τ_1f, τ_2f, τ_3f]=[u₁/M, u₂/m₁, u₃/m₂]

τ_C=[τ_1f, τ_2f]=[u₁/M, u₂/m₁]

α_f: the inter-leg angle at the time of grounding at fixed pointe_f=cos α_f: loss factor at the time of grounding

where e_f² denotes the energy survival rate when the legged mobile body collides with a floor surface.

γ′: control coefficient during fixed point generationK_α: control coefficient for stabilizing fixed pointK_(dθ/dt): control coefficient for stabilizing fixed pointd/dt: time differential (a symbol formed by attaching a dot to “θ” also denotes the same time differential)δ: partial differentialSuperscript suffix “+”: the value of a variable to which the suffix “+” is added immediately after groundingSuperscript suffix “−”: the value of a variable to which the suffix “−” is added immediately before groundingSubscript suffix “f”: the value of a variable to which the suffix “f” is added at the fixed pointSubscript suffix “k”: the value of a variable to which the suffix “k” is added at step “k” of walkingSubscript suffix “k+1”: the value at step “k+1”

Further, “k” on the abscissa in FIG. 2 denotes step “k” of walking, and αk on the ordinate denotes the inter-leg angle at the time of grounding at step “k”.

The term “fixed point” in this specification is defined as follows. A certain space (not only a physical space, but also a mathematical n-dimensional space) is assumed. A case in which an arbitrary plane (strictly mathematically speaking, an (n−1)-dimensional space) defined within the space has an intersection point with a trajectory realized within the space is assumed. When the plane and a closed cyclic trajectory have an intersection point, the intersection point is known as the “fixed point”. When a state away from the fixed point converges on the fixed point, the fixed point corresponds to “stable”, and when the fixed point is stable, the trajectory is mathematically proven to be “stable”. Further, a trajectory having a stable fixed point is known as a stable limit cycle. The expressions “trajectory”, “fixed point”, and “stable” used above are typical mathematical expressions, and the basic concepts behind these expressions as used in this specification are identical to the concepts thereof when used mathematically.

In this specification, the “fixed point” is defined in relation to a trajectory drawn by a arbitrary point fixed on a leg of a legged mobile body during walking. The arbitrary point is referred to hereafter as a reference point. The claimed fixed point stabilization device serves to stabilize the fixed point. The space for defining the reference point may be a space employing a so-called generalized coordinate system. The generalized coordinates may be the relative position of the reference point to the waist of the legged mobile body within a three-dimensional physical space, for example. Alternatively, the joint angle of the knee joint of the leg, the joint angular velocity, and so on may be used. In other words, the coordinate value at a point on the trajectory denotes the quantity of state of the leg reference point. The features of the legged mobile body according to this embodiment may be expressed as follows. A legged mobile robot comprises a fixed point generator for generating a fixed point defined in relation to a closed cyclic trajectory of a reference point fixed on a leg, and a fixed point stabilizer for stabilizing the fixed point, wherein the fixed point stabilizing portion stabilizes the fixed point in accordance with a grounding position of the legged mobile body.

An embodiment of the present invention was described in detail above, but this is merely an example of the present invention, and does not limit the claims. The techniques described in the claims include various alterations and modifications of the embodiment described above as an example.

The technical elements described in the specification and drawings exhibit technical usefulness either independently or in various combinations, and are not limited to the combinations described in the claims at the time of filing. Further, the techniques cited in the specification and drawings achieve a plurality of objects simultaneously, and technical usefulness is attained simply by achieving one of these objects.

INDUSTRIAL APPLICABILITY

Legged mobile robots may be used on construction sites, in medical and nursing facilities, in general households, and so on. However, with a conventional control method that does not employ the present invention, energy efficiency is low, leading to great limits on long-term use. By employing the present invention, usage time is extended dramatically.

The present invention is capable of generating an extremely natural and stable gait and maintaining a high level of robustness. Hence, the present invention is highly likely to be of use in future robots that will serve as the key to the industrialization of coexistence with human beings.

Claims

1. A fixed point stabilization device for a legged mobile body having a generating mechanism that generates a fixed point comprising: stabilizing means for stabilizing the fixed point generated by the generating mechanism in accordance with a leg grounding position of the legged mobile body.

2. The fixed point stabilization device for a legged mobile body according to claim 1, wherein the generating mechanism generates the fixed point from an energy balance in the legged mobile body, leg switching, and a leg swinging motion.

3. The fixed point stabilization device for a legged mobile body according to claim 1 or 2, wherein the generating mechanism generates the fixed point by inputting a constant torque to a joint of a leg of the legged mobile body.

4. The fixed point stabilization device for a legged mobile body according to claim 1, wherein the stabilizing means stabilizes the fixed point globally by keeping the leg grounding position of the legged mobile body constant or substantially constant.

5. The fixed point stabilization device for a legged mobile body according to claim 1 or claim 4, wherein the stabilizing means is a stopper.

6. The fixed point stabilization device for a legged mobile body according to claim 1, wherein the stabilizing means stabilizes the fixed point locally by varying the leg grounding position of the legged mobile body in accordance with a deviation between the fixed point and a current quantity of state.

7. A fixed point stabilization device for a legged mobile body, comprising: detecting means for detecting at least a discrete quantity of state of a leg of the legged mobile body;means for calculating at least a deviation between the fixed point and a current quantity of state;means for generating a torque for varying a leg grounding position of the legged mobile body and a constant torque on a joint of the leg; andmeans for keeping the leg grounding position of the legged mobile body constant or substantially constant.