JP3168066B2 - Control device for link type mobile robot - Google Patents
Control device for link type mobile robotInfo
- Publication number
- JP3168066B2 JP3168066B2 JP13626092A JP13626092A JP3168066B2 JP 3168066 B2 JP3168066 B2 JP 3168066B2 JP 13626092 A JP13626092 A JP 13626092A JP 13626092 A JP13626092 A JP 13626092A JP 3168066 B2 JP3168066 B2 JP 3168066B2
- Authority
- JP
- Japan
- Prior art keywords
- robot
- posture
- trajectory
- gravity
- actuator
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Lifetime
Links
- 238000012546 transfer Methods 0.000 claims description 4
- 230000005484 gravity Effects 0.000 description 82
- 230000001133 acceleration Effects 0.000 description 73
- 210000002414 leg Anatomy 0.000 description 73
- 210000000629 knee joint Anatomy 0.000 description 40
- 230000036544 posture Effects 0.000 description 33
- 238000000034 method Methods 0.000 description 31
- 230000005021 gait Effects 0.000 description 24
- 210000003423 ankle Anatomy 0.000 description 23
- 210000000544 articulatio talocruralis Anatomy 0.000 description 22
- 210000002683 foot Anatomy 0.000 description 21
- 238000010586 diagram Methods 0.000 description 18
- 210000001503 joint Anatomy 0.000 description 18
- 238000012937 correction Methods 0.000 description 10
- 238000012545 processing Methods 0.000 description 10
- 238000005457 optimization Methods 0.000 description 9
- 241000282412 Homo Species 0.000 description 8
- 241000282414 Homo sapiens Species 0.000 description 8
- 238000005516 engineering process Methods 0.000 description 7
- 210000001624 hip Anatomy 0.000 description 6
- 238000006557 surface reaction Methods 0.000 description 6
- 238000005452 bending Methods 0.000 description 5
- 210000004394 hip joint Anatomy 0.000 description 5
- 238000006243 chemical reaction Methods 0.000 description 4
- 230000007423 decrease Effects 0.000 description 4
- 238000005265 energy consumption Methods 0.000 description 4
- 238000006073 displacement reaction Methods 0.000 description 3
- 230000000694 effects Effects 0.000 description 3
- 238000002474 experimental method Methods 0.000 description 2
- 210000003127 knee Anatomy 0.000 description 2
- 238000011084 recovery Methods 0.000 description 2
- RRLHMJHRFMHVNM-BQVXCWBNSA-N [(2s,3r,6r)-6-[5-[5-hydroxy-3-(4-hydroxyphenyl)-4-oxochromen-7-yl]oxypentoxy]-2-methyl-3,6-dihydro-2h-pyran-3-yl] acetate Chemical compound C1=C[C@@H](OC(C)=O)[C@H](C)O[C@H]1OCCCCCOC1=CC(O)=C2C(=O)C(C=3C=CC(O)=CC=3)=COC2=C1 RRLHMJHRFMHVNM-BQVXCWBNSA-N 0.000 description 1
- 230000003044 adaptive effect Effects 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 239000003638 chemical reducing agent Substances 0.000 description 1
- 230000001419 dependent effect Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 238000012805 post-processing Methods 0.000 description 1
- 230000002265 prevention Effects 0.000 description 1
- 230000009291 secondary effect Effects 0.000 description 1
- 230000035945 sensitivity Effects 0.000 description 1
- 238000000926 separation method Methods 0.000 description 1
- 238000001228 spectrum Methods 0.000 description 1
- 230000006641 stabilisation Effects 0.000 description 1
- 238000011105 stabilization Methods 0.000 description 1
- 239000000725 suspension Substances 0.000 description 1
- 230000036962 time dependent Effects 0.000 description 1
- 210000000689 upper leg Anatomy 0.000 description 1
Landscapes
- Numerical Control (AREA)
- Manipulator (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Description
【０００１】[0001]
【産業上の利用分野】この発明はリンク式移動ロボット
の制御装置に関する。BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a control system for a link type mobile robot.
【０００２】[0002]
【従来の技術】従来、移動ロボットに関する技術として
は車輪式、クローラ式、脚式などのロボットが提案され
ている。その中で、脚式移動ロボットの制御技術に関す
るものとして、１脚のロボットに関する技術（Raibert,
M.H., Brown, Jr.H.B.,"Experiments in Balance With
a 2D One-Legged Hopping Machine", ASME, J of DSM
C,vol.106, pp.75-81 (1984)), ２脚のロボットに関す
る技術（日本ロボット学会誌vol.l, no.3, pp.167-203,
1983）、４脚のロボットに関する技術（日本ロボット学
会誌vol.9, no.5, pp.638-643, 1991)、６脚のロボット
に関する技術（Fischeti, M.A.,"Robot Do the Dirty W
ork,"IEEE, spectrum, vol.22. no.4, pp.65-72 (198
5). Shin-Min Song, Kenneth J. Waldron, "Machines T
hat Walk; TheAdaptive Suspension Vehicle", The MIT
Press Cambridge, Massachusetts, London. England)
が多数提案されている。更には、比較的低自由度のロボ
ットでリアルタイムに力学的に安定な移動（歩行）パタ
ーンを生成する技術（下山、”竹馬型２足歩行ロボット
の動的歩行”、日本機械学会論文集 C篇、第48巻、第 4
33号、pp.1445-1454, 1982. および"Legged Robots on
Rough Terrain; Experiments in Adjusting Step Lengt
h", by Jessica Hodgins. IEEE, 1988) や、比較的多自
由度のロボットでオフラインで安定な移動（歩行）パタ
ーンを生成する技術（特開昭62-97006号、特開昭63-150
176 号）も提案されている。2. Description of the Related Art Conventionally, wheel-type, crawler-type and leg-type robots have been proposed as technologies relating to mobile robots. Among them, as for the control technology of a legged mobile robot, the technology related to a one-legged robot (Raibert,
MH, Brown, Jr. HB, "Experiments in Balance With
a 2D One-Legged Hopping Machine ", ASME, J of DSM
C, vol. 106, pp. 75-81 (1984)), Technology on biped robots (Journal of the Robotics Society of Japan vol.l, no.3, pp.167-203,
1983) Technology related to four-legged robots (Journal of the Robotics Society of Japan vol.9, no.5, pp.638-643, 1991), technology related to six-legged robots (Fischeti, MA, "Robot Do the Dirty W"
ork, "IEEE, spectrum, vol.22.no.4, pp.65-72 (198
5). Shin-Min Song, Kenneth J. Waldron, "Machines T
hat Walk; The Adaptive Suspension Vehicle ", The MIT
Press Cambridge, Massachusetts, London. England)
Many have been proposed. Furthermore, a technology to generate a dynamic and stable movement (walking) pattern in real time with a relatively low degree of freedom robot (Shimoyama, "Dynamic walking of a stilt-type biped walking robot", Transactions of the Japan Society of Mechanical Engineers C) , Vol. 48, No. 4
Issue 33, pp. 1445-1454, 1982. and "Legged Robots on
Rough Terrain; Experiments in Adjusting Step Lengt
h ", by Jessica Hodgins. IEEE, 1988) and a technique for generating a stable movement (walking) pattern offline with a robot having relatively many degrees of freedom (JP-A-62-97006, JP-A-63-150)
No. 176) has also been proposed.
【０００３】[0003]
【発明が解決しようとする課題】従来、荷物を積載して
運搬するロボットとしては、工場のラインなどで既に実
用化されている搬送用ロボットなどがあるが、これらの
ロボットは車輪式であるために平坦な路面上しか移動で
きない。そのため、段差をなくしたり、スロープを設置
したり、ときにはエレベータの設置など、作業環境をロ
ボットのために整備する必要があるという欠点があっ
た。Conventionally, as robots for loading and transporting luggage, there are transfer robots that have already been put to practical use in factory lines and the like, but these robots are wheel-type robots. Can only move on flat roads. Therefore, there is a disadvantage that it is necessary to maintain a working environment for the robot, such as eliminating a step, installing a slope, and sometimes installing an elevator.
【０００４】従って、この発明の目的は、上記した従来
技術の欠点を解消し、段差や階段を含む環境や、さらに
は不整地などの環境でも荷物を運搬することができるリ
ンク式移動ロボットの制御装置を提供することにある。Accordingly, an object of the present invention is to solve the above-mentioned drawbacks of the prior art, and to control a link-type mobile robot capable of transporting luggage even in an environment including steps or stairs or in an environment such as uneven terrain. It is to provide a device.
【０００５】[0005]
【課題を解決するための手段】上記した課題を解決する
ために、この発明は以下のように構成した。後述する符
合を付して説明すると、請求項１項にあっては、脚部お
よび／または腕部リンク２を有し、アクチュエータ（電
動モータ）で駆動されて移動するリンク式移動ロボット
（脚式移動ロボット１）の制御装置において、前記ロボ
ットの姿勢又は姿勢の時系列に関する姿勢目標値（重心
軌道など）を設定する目標値設定手段（制御ユニット２
６，Ｓ１０〜Ｓ３０，Ｓ１００〜Ｓ１０６，Ｓ２００〜
Ｓ２２０）、前記姿勢又は姿勢の時系列に関する姿勢目
標値にしたがって、前記アクチュエータの目標操作量を
決定する目標操作量決定手段（制御ユニット２６，Ｓ３
１０，Ｓ３１２）、及び前記目標操作量となるように前
記アクチュエータを動作させるアクチュエータ制御手段
（制御ユニット２６，Ｓ３１２）、を備えると共に、前
記ロボットに貨物３０を積載して運搬するとき、前記姿
勢目標値を前記貨物の任意の回転軸まわり（鉛直方向）
の回転角速度（重心加速度）が実質的に零または所定の
値（Ｇｚツー・ドット.max）より小さくなるように設定
する（Ｓ２２）ように構成した。また、請求項２項にあ
っては、脚部および／または腕部リンク２を有し、アク
チュエータ（電動モータ）で駆動されて移動するリンク
式移動ロボット（脚式移動ロボット１）の制御装置にお
いて、前記ロボットの姿勢又は姿勢の時系列に関する姿
勢目標値（重心軌道など）を設定する目標値設定手段
（制御ユニット２６，Ｓ１０〜Ｓ３０，Ｓ１００〜Ｓ１
０６，Ｓ２００〜Ｓ２２０）、前記姿勢又は姿勢の時系
列に関する姿勢目標値にしたがって、前記アクチュエー
タの目標操作量を決定する目標操作量決定手段（制御ユ
ニット２６，Ｓ３１０，Ｓ３１２）、及び前記目標操作
量となるように前記アクチュエータを動作させるアクチ
ュエータ制御手段（制御ユニット２６，Ｓ３１２）、を
備えると共に、前記ロボットに貨物３０を積載して運搬
するとき、前記貨物を積載する部位の任意の回転軸まわ
りの回転運動に関係する前記姿勢目標値を、前記部位の
任意の回転軸まわり（鉛直方向）の回転角速度（重心加
速度）が実質的に零または所定の値（Ｇｚツー・ドッ
ト.max）より小さくなるように設定する（Ｓ２２）よう
に構成した。 Means for Solving the Problems In order to solve the above-mentioned problems, the present invention is configured as follows. The mark described below
By way given the case, with the one of claims legs Contact
It has a spare / or arm portion link 2, an actuator (electric
Linked mobile robot driven by a moving motor
In the control device of the (legged mobile robot 1) , a posture target value (centroid of gravity) relating to the posture of the robot or a time series of the posture is provided.
Target value setting means (control unit 2 ) for setting the trajectory, etc.
6, S10-S30, S100-S106, S200-
S220), the following orientation desired values for the time series of the attitude or orientation, the target manipulated variable determining means for determining a target operation amount before Kia actuator (control unit 26, S3
10, S312), and before so that the target operation amount
Actuator control means for Ru operate the serial actuator
(Control unit 26, S312), provided with a front
When loading and transporting cargo 30 to the robot,
Target value around any axis of rotation of the cargo (vertical direction)
Rotation angular velocity (center of gravity acceleration) is substantially zero or
The value was set to be smaller than the value (Gz2.dot.max) (S22) . Claim 2
Having leg and / or arm links 2
Link that moves by being driven by a tutor (electric motor)
Control device for the mobile robot (legged mobile robot 1)
And the posture of the robot or a time series of postures
Target value setting means for setting the target value (such as the center of gravity trajectory)
(Control unit 26, S10 to S30, S100 to S1
06, S200 to S220), the posture or the time series of the posture
According to the attitude target value for the row, the actuator
Target operation amount determining means (control unit) for determining the target operation amount of the
Knit 26, S310, S312) and the target operation
Actuate the actuator to actuate the actuator
The heater control means (control unit 26, S312)
Prepare and transport cargo 30 on the robot
When turning the arbitrary rotating shaft of the part where the cargo is loaded
The posture target value related to the rotational movement of
Rotational angular velocity around any rotation axis (vertical direction)
Speed) is substantially zero or a predetermined value (Gz2
G) is set to be smaller than (max.) (S22).
Configured.
【０００６】[0006]
【作用】段差や階段などがあっても移動できるリンク式
のロボットによって、荷物の搬送を行うことにより、作
業環境をロボットのために整備する必要から解放するこ
とが達成できる。従って、環境の整備が困難な既存の設
備においても容易にロボットの導入が行える様になる。According to the present invention, it is possible to eliminate the necessity of maintaining the working environment for the robot by carrying the load by the link type robot which can move even if there are steps or stairs. Therefore, it becomes possible to easily introduce a robot even in an existing facility where maintenance of the environment is difficult.
【０００７】さらに、該リンク式ロボットは室内のみな
らず、屋外や、さらには不整地などを移動することも可
能なので、例えば山小屋へ荷物を運搬する場合など、車
両では運搬できない山道などの部分は人間が荷物を背負
って運搬していたが、この部分を人間に替わって機械で
運搬することができる様になるので、人間を重労働から
解放することができる。Further, since the link type robot can move not only indoors but also outdoors or even on uneven terrain, for example, when transporting luggage to mountain huts, parts such as mountain roads that cannot be transported by vehicles are used. Although humans carried their luggage on their backs, this part can now be transported by machine instead of humans, and humans can be released from heavy labor.
【０００８】[0008]
【実施例】以下、脚式移動ロボットとして２足歩行のロ
ボットを例にとってこの発明の実施例を説明する。図１
はそのロボット１を全体的に示す説明スケルトン図であ
り、左右それぞれの脚部リンク２に６個の関節を備える
（理解の便宜のために各関節をそれを駆動する電動モー
タで示す）。該６個の関節は上から順に、腰の脚部回旋
用の関節１０Ｒ，１０Ｌ（右側をＲ、左側をＬとする。
以下同じ）、腰のロール方向（ｘ軸まわりに回転）の関
節１２Ｒ，１２Ｌ、同ピッチ方向（ｙ軸まわりに回転）
の関節１４Ｒ，１４Ｌ、膝部のピッチ方向の関節１６
Ｒ，１６Ｌ、足首部のピッチ方向の関節１８Ｒ，１８
Ｌ、同ロール方向の関節２０Ｒ，２０Ｌとなっており、
その下部には足平（足部）２２Ｒ，２２Ｌが取着される
と共に、最上位には筐体（基体）２４が設けられ、その
内部には制御ユニット２６が格納される。筐体２４の上
面にはルーフキャリア２８が設けられ、そこに必要に応
じて貨物３０を積載することができる。ルーフキャリア
２８は、図示の如く、筐体２４の上面の四隅に対抗的に
配設された４個のスライダからなり、各スライダはそれ
ぞれｘ方向またはｙ方向に滑動して貨物を挟持した後、
その位置にロックすることができ、ロボット１が歩行す
るとき貨物３０が移動、回転しない様な構成となってい
る。DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS An embodiment of the present invention will be described below by taking a bipedal walking robot as an example of a legged mobile robot. FIG.
Is an explanatory skeleton diagram showing the robot 1 as a whole, and has six joints on each of the left and right leg links 2 (for the sake of convenience of understanding, each joint is shown by an electric motor that drives it). The six joints are, in order from the top, joints 10R and 10L for turning the hip leg (R is the right side and L is the left side).
Joints 12R, 12L in the roll direction of the waist (rotated around the x axis), the same pitch direction (rotated around the y axis)
Joints 14R and 14L, and a joint 16 in the knee pitch direction
R, 16L, joints 18R, 18 in the ankle pitch direction
L, joints 20R and 20L in the same roll direction,
At its lower part, feet (foot parts) 22R and 22L are attached, and at the top, a housing (base) 24 is provided, inside which a control unit 26 is stored. A roof carrier 28 is provided on the upper surface of the housing 24, and a cargo 30 can be loaded thereon as needed. As shown, the roof carrier 28 is composed of four sliders disposed opposite to the four corners of the upper surface of the housing 24. Each slider slides in the x direction or the y direction to grip the cargo.
The position can be locked so that the cargo 30 does not move or rotate when the robot 1 walks.
【０００９】上記において腰関節は関節１０Ｒ（Ｌ），
１２Ｒ（Ｌ），１４Ｒ（Ｌ）から構成され、また足関節
は、関節１８Ｒ（Ｌ），２０Ｒ（Ｌ）から構成される。
また、腰関節と膝関節との間は大腿リンク３２Ｒ，３２
Ｌで、膝関節と足関節との間は下腿リンク３４Ｒ，３４
Ｌで連結される。ここで、脚部リンク２は左右の足につ
いてそれぞれ６つの自由度を与えられ、歩行中にこれら
の６×２＝１２個の関節（軸）をそれぞれ適宜な角度に
駆動することで、足全体に所望の動きを与えることがで
き、任意に３次元空間を歩行することができる様に構成
される。先に述べた様に、上記した関節は電動モータか
らなり、さらにはその出力を倍力する減速機などを備え
るが、その詳細は先に本出願人が提案した出願（特願平
１−３２４２１８号、特開平３−１８４７８２号）など
に述べられており、それ自体はこの発明の要旨とすると
ころではないので、これ以上の説明は省略する。In the above, the hip joint is joint 10R (L),
12R (L) and 14R (L), and the ankle joint is composed of joints 18R (L) and 20R (L).
In addition, the thigh links 32R, 32 between the waist joint and the knee joint.
L, the lower leg links 34R, 34 between the knee joint and the ankle joint.
L connected. Here, the leg link 2 is given six degrees of freedom for each of the left and right feet, and by driving these 6 × 2 = 12 joints (axes) to appropriate angles during walking, the entire foot To a desired motion, and can be arbitrarily walked in a three-dimensional space. As described above, the above-mentioned joint is formed of an electric motor and further provided with a speed reducer for boosting its output. The details thereof are described in the application proposed by the present applicant (Japanese Patent Application No. 1-324218). And Japanese Patent Application Laid-Open No. 3-184772, which are not the subject of the present invention.
【００１０】図１に示すロボット１において、足首部に
は公知の６軸力センサ３６が設けられ、足平を介してロ
ボットに伝達されるｘ，ｙ，ｚ方向の力成分Ｆｘ，Ｆ
ｙ，Ｆｚとその方向まわりのモーメント成分Ｍｘ，Ｍ
ｙ，Ｍｚとを測定し、足部の着地の有無と支持脚に加わ
る力の大きさと方向とを検出する。また足平２２Ｒ
（Ｌ）の四隅には静電容量型の接地スイッチ３８（図１
で図示省略）が設けられて、足平の接地の有無を検出す
る。さらに、筐体２４には傾斜センサ４０が設置され、
ｘ−ｚ平面内のｚ軸に対する傾きとその角速度、同様に
ｙ−ｚ平面内のｚ軸に対する傾きとその角速度を検出す
る。また各関節の電動モータには、その回転量を検出す
るロータリエンコーダが設けられる。さらに、図１では
省略するが、ロボット１の適宜な位置には傾斜センサ４
０の出力を補正するための原点スイッチ４２と、フェー
ル対策用のリミットスイッチ４４が設けられる。これら
の出力は前記した筐体２４内の制御ユニット２６に送ら
れる。In the robot 1 shown in FIG. 1, a known six-axis force sensor 36 is provided at the ankle, and force components Fx, F in the x, y, and z directions transmitted to the robot through the foot.
y, Fz and moment components Mx, M around the direction
By measuring y and Mz, the presence or absence of landing on the foot and the magnitude and direction of the force applied to the supporting leg are detected. In addition, foot 22R
At the four corners of (L), a capacitance type ground switch 38 (FIG. 1)
(Not shown) is provided to detect the presence / absence of the touchdown of the foot. Further, an inclination sensor 40 is installed in the housing 24,
The inclination with respect to the z-axis in the xz plane and its angular velocity, and similarly, the inclination with respect to the z-axis in the yz plane and its angular velocity are detected. The electric motor of each joint is provided with a rotary encoder for detecting the amount of rotation. Although not shown in FIG. 1, an inclination sensor 4 is provided at an appropriate position of the robot 1.
An origin switch 42 for correcting the output of 0 and a limit switch 44 for fail countermeasures are provided. These outputs are sent to the control unit 26 in the housing 24 described above.
【００１１】図２は制御ユニット２６の詳細を示すブロ
ック図であり、マイクロ・コンピュータから構成され
る。そこにおいて傾斜センサ４０などの出力はＡ／Ｄ変
換器５０でデジタル値に変換され、その出力はバス５２
を介してＲＡＭ５４に送られる。また各電動モータに隣
接して配置されるエンコーダの出力はカウンタ５６を介
してＲＡＭ５４内に入力されると共に、接地スイッチ３
８などの出力は波形整形回路５８を経て同様にＲＡＭ５
４内に格納される。制御ユニット内にはＣＰＵからなる
第１、第２の演算装置６０，６２が設けられており、第
１の演算装置６０は後述の如くＲＯＭ６４に格納されて
いる歩行パターンを読み出して目標関節角度（関節駆動
パターン）を算出してＲＡＭ５４に送出する。また第２
の演算装置６２は後述の如くＲＡＭ５４からその目標値
と検出された実測値とを読み出し、各関節の駆動に必要
な制御値を算出してＤ／Ａ変換器６６とサーボアンプを
介して各関節を駆動する電動モータに出力する。FIG. 2 is a block diagram showing the details of the control unit 26, which comprises a microcomputer. The output of the tilt sensor 40 and the like is converted into a digital value by the A / D converter 50, and the output is
Via the RAM 54. The output of an encoder disposed adjacent to each electric motor is input to the RAM 54 via a counter 56, and the ground switch 3
Outputs of the RAM 8 and the like are similarly sent to the RAM 5
4 is stored. In the control unit, first and second arithmetic units 60 and 62 each including a CPU are provided. The first arithmetic unit 60 reads a walking pattern stored in a ROM 64 as described later and reads a target joint angle ( The joint drive pattern is calculated and sent to the RAM 54. Also the second
The arithmetic unit 62 reads the target value and the detected actual value from the RAM 54 as described later, calculates a control value necessary for driving each joint, and outputs the control value to each joint via a D / A converter 66 and a servo amplifier. To the electric motor that drives the motor.
【００１２】続いて、この制御装置の動作を説明する。Next, the operation of the control device will be described.
【００１３】図３はこの制御装置の動作の中の目標軌道
設定手順を示すフロー・チャートである。設定されたデ
ータが図２に示す制御ユニット２６のＲＯＭ６４に格納
され、それに基づいて今述べた様に、制御ユニット２６
で関節駆動制御が行われる。FIG. 3 is a flow chart showing a target trajectory setting procedure in the operation of the control device. The set data is stored in the ROM 64 of the control unit 26 shown in FIG.
Performs joint drive control.
【００１４】先ず目標軌道設定手順を説明すると、重心
軌道などの位置情報を用いて関節角度を決定してロボッ
トの姿勢を一意に決めるには、その自由度と同数の姿勢
決定パラメータを用いる必要がある。即ち、実施例にか
かるロボット１の場合、１２個の関節を備えて１２個の
自由度を有することから、１２個のパラメータを用いて
各関節を変数とする１２元１次連立方程式を解いて各関
節の関節駆動パターン（目標角度）を決定する。この制
御においては、そのため、１２個のパラメータとして図
４に示す様に、 筐体２４の回転角度φｘ，φｙ，φｚ 遊脚足平２２Ｒ（Ｌ）の回転角度θｘ，θｙ，θｚ 重心の座標Ｇｘ，Ｇｙ，Ｇｚ 遊脚足関節１８，２０Ｒ（Ｌ）の交点座標Ａｘ，Ａｙ，
Ａｚ を用いる。ここで回転角度は図示の如く、その添字が示
す方向まわりの角度を示す。また重心などの３次元座標
は、支持脚の足平先端位置を原点とする。First, the procedure for setting the target trajectory will be described. In order to determine the joint angle using position information such as the center of gravity trajectory and uniquely determine the posture of the robot, it is necessary to use the same number of posture determination parameters as its degrees of freedom. is there. That is, in the case of the robot 1 according to the embodiment, since the robot 1 includes 12 joints and has 12 degrees of freedom, a 12-dimensional linear simultaneous equation in which each joint is a variable using 12 parameters is solved. The joint drive pattern (target angle) of each joint is determined. In this control, therefore, as shown in FIG. 4, the rotation angles φx, φy, φz of the housing 24 and the rotation angles θx, θy, θz of the free leg foot 22R (L) as the twelve parameters, , Gy, Gz Intersection coordinates Ax, Ay, of the swing leg joints 18, 20R (L)
Az is used. Here, the rotation angle indicates an angle around the direction indicated by the subscript as shown in the figure. The origin of the three-dimensional coordinates such as the center of gravity is the position of the foot tip of the support leg.
【００１５】ここで、この制御を概括すると、これら１
２個のパラメータを一定値または初期値に仮に固定した
上で重心軌道、遊脚軌道などをチェックし、その（加）
速度成分のピーク値を修正して関節トルクが低減する様
に、パラメータとそれから決定される関節駆動パターン
とを補正する様にした。また、いわゆるｚｍｐの概念を
導入して重心軌道を設定することも特徴とする。ここ
で、ｚｍｐ（zero mome-nt point) とは周知の如く、足
裏をある１点で地面に固定したと考えたとき、歩行動作
によってその点にモーメントが発生しない様な点を意味
する。即ち、図５に示す如く、ロボットに働く外力は重
力ｍｇと路面反力Ｆである。即ち、重心Ｇには重力によ
る鉛直方向の力が加わると共に、重心が加速度を受ける
ことによって生ずる慣性力−ｍＧツー・ドットも働き、
その２つの力の合力と地面から受ける路面反力Ｆ、さら
には、各リンクの慣性モーメントと角加速度によって発
生するモーメントの総和Ｍ＝Σ（Ｉｉ・θｉツー・ドッ
ト）とが釣り合ってロボットは歩行する。この路面反力
Ｆを集中荷重としたときの作用点がｚｍｐである。この
ｚｍｐがロボット全体の接地点の外周を結んだ安定領域
（支持多角形）の外に出ると、ロボットは転倒する。従
って、この制御においてはｚｍｐが所定の領域に位置す
る様に、歩容パラメータを設定する。別言すれば、ロボ
ットが路面その他の環境と接触している部分を頂点とし
て構成される多面体又は多角形と、環境からロボットに
作用する全ての外力の合力ベクトルとの交点の集合がｚ
ｍｐである。Here, this control is summarized as follows.
After temporarily fixing the two parameters to fixed values or initial values, the center of gravity trajectory, the free leg trajectory, etc. are checked, and the (addition)
The parameters and the joint drive pattern determined from the parameters are corrected so that the joint torque is reduced by correcting the peak value of the velocity component. It is also characterized in that the center of gravity trajectory is set by introducing the concept of so-called zmp. Here, zmp (zero mome-nt point) means, as is well known, a point at which no moment is generated at that point when the sole of the foot is fixed to the ground at a certain point by walking motion. That is, as shown in FIG. 5, the external forces acting on the robot are the gravity mg and the road surface reaction force F. That is, a force in the vertical direction due to gravity is applied to the center of gravity G, and an inertia force-mG2 dot generated by the acceleration of the center of gravity also acts.
The robot walks when the resultant force of the two forces and the road surface reaction force F received from the ground balance the moment of inertia of each link and the sum M of moments generated by the angular acceleration M = Σ (Ii · θi two dots). I do. The point of action when this road surface reaction force F is a concentrated load is zmp. When the zmp goes out of the stable area (supporting polygon) connecting the outer circumference of the ground point of the entire robot, the robot falls. Therefore, in this control, the gait parameters are set so that zmp is located in a predetermined area. In other words, a set of intersections between a polyhedron or a polygon having a vertex at a portion where the robot is in contact with the road surface or another environment and a resultant vector of all external forces acting on the robot from the environment is z.
mp.
【００１６】以下、図３フロー・チャートを参照して説
明すると、先ずＳ１０において筐体２４の回転角度φ
ｘ，φｙ，φｚを設定する。この場合には常に零と設定
した。以下、その理由を述べる。Referring to the flow chart of FIG. 3, first, in S10, the rotation angle φ of the housing 24 will be described.
x, φy, φz are set. In this case, it was always set to zero. Hereinafter, the reason will be described.
【００１７】質点系については角運動量の法則、即ち、
質点系のある固定点に関する角運動量の時間的変化の割
合は、外力のその点に関するモーメントの和に等しく、
従って外力の作用しない質点系の角運動量は不変であ
る、なる法則が妥当するが、図６に示す様にロボット１
のｘ−ｚ平面についてこれを示すと、数１に示す様にな
る。For the mass system, the law of angular momentum, ie,
The rate of change of angular momentum over time for a fixed point of the mass system is equal to the sum of the moments of the external force at that point,
Therefore, the following law is valid: the angular momentum of the mass system in which no external force acts is invariable, but as shown in FIG.
When this is shown for the xz plane of Equation (1), Equation 1 is obtained.
【００１８】[0018]
【数１】 (Equation 1)
【００１９】ここで、ロボット１のある瞬間におけるｚ
ｍｐに関して角運動量の法則を適用すると、ロボット１
に作用する外力は重力と路面反力であるが、路面反力は
ｚｍｐを通るので、外力のモーメントは重力によるもの
だけとなる。従って、数１にｚｍｐの座標を加えて変形
した数２を解くことによってｚｍｐの位置を求めること
ができる。Here, z at a certain moment of the robot 1
When the law of angular momentum is applied to mp, the robot 1
Are the gravity and the road surface reaction force, but since the road surface reaction force passes through zmp, the moment of the external force is only due to gravity. Therefore, the position of zmp can be obtained by solving Equation 2, which is obtained by adding the coordinates of zmp to Equation 1, and solving it.
【００２０】[0020]
【数２】 (Equation 2)
【００２１】ロボット１が安定に歩行するためには、こ
のｚｍｐが安定領域内にあることが必要条件であり、ロ
ボット１の歩容は、この条件式を満足する様に決定され
なければならない。しかし、数２にはロボット１を構成
する各部材の質量、重心位置、イナーシャなどが含まれ
ているために、これらのパラメータをロボット１が歩行
する以前に求めておかなければならない。さらに、ロボ
ット１に貨物３０を積載して歩行させる場合、安定条件
式には、貨物の質量、その重心位置、貨物の重心まわり
のイナーシャも含まれる。このうち質量、重心位置につ
いては前記した６軸力センサ３６を通じて容易に検出す
ることができるが、貨物の重心まわりのイナーシャに関
しては動的な測定が必要となることから、測定困難であ
る。そこで、この制御においては、貨物を実質的に回転
させない歩容でロボット１を歩行させることとした。そ
の結果、貨物相当リンクについてのＩωの項を無視する
ことができ、貨物の重心まわりのイナーシャを予め知る
（測定する）必要がなく、単にその質量と重心位置のみ
を測定すれば良いことになって演算が簡略となる。さら
には、貨物を回転させないこととした結果、荷くずれや
貨物の落下、それに伴う貨物の破損などを未然に防止す
ることができるなどの副次的な効果も生じる。尚、回転
角度φｘ，φｙ，φｚを零とするとしたが、φｘ，φ
ｙ，φｚは、特に零である必要はなく、その微分値であ
る角速度ωｘ，ωｙ，ωｚが実質的に無視できる程度の
大きさであれば、φｘ，φｙ，φｚはどのような値でも
よい。In order for the robot 1 to walk stably, it is a necessary condition that the zmp is within a stable region, and the gait of the robot 1 must be determined so as to satisfy this conditional expression. However, since Equation 2 includes the mass, the position of the center of gravity, the inertia, and the like of each member constituting the robot 1, these parameters must be obtained before the robot 1 walks. Furthermore, when the robot 1 is loaded with the cargo 30 and walked, the stability conditional expression also includes the mass of the cargo, the position of the center of gravity, and the inertia around the center of gravity of the cargo. Of these, the mass and the position of the center of gravity can be easily detected through the above-described six-axis force sensor 36, but the inertia around the center of gravity of the cargo needs to be dynamically measured, which is difficult to measure. Therefore, in this control, the robot 1 is caused to walk in a gait that does not substantially rotate the cargo. As a result, the term Iω for the cargo-equivalent link can be ignored, and there is no need to know (measure) the inertia around the center of gravity of the cargo in advance, and only the mass and the position of the center of gravity need be measured. This simplifies the calculation. In addition, as a result of not rotating the cargo, there is a secondary effect such as prevention of collapse of the cargo, falling of the cargo, and damage of the cargo associated therewith. Although the rotation angles φx, φy, and φz are set to zero, φx, φ
y and φz do not need to be particularly zero, and φx, φy, and φz may be any values as long as the angular velocities ωx, ωy, and ωz, which are differential values thereof, are substantially negligible. .
【００２２】図３フロー・チャートにおいては続いてＳ
１２に進み、遊脚足平の回転角度θｘ，θｚを設定す
る。ここではθｘ，θｚを共に零に設定した。続いてＳ
１４に進み、遊脚足関節の座標のうちのＡｙを設定す
る。図１に示したロボットにおいて、両脚部リンク２の
足関節の歩隔（即ち、足関節のｙ方向の離間距離）を２
００ｍｍに設定したことから、ここではＡｙを２００ｍ
ｍに設定する。In the flow chart of FIG.
Proceeding to 12, the rotation angles θx and θz of the free leg foot are set. Here, both θx and θz are set to zero. Then S
Proceed to 14 to set Ay among the coordinates of the free leg ankle. In the robot shown in FIG. 1, the step distance of the ankle joint of the two leg links 2 (that is, the separation distance of the ankle joint in the y direction) is 2
Ay is set to 200m here.
Set to m.
【００２３】続いてＳ１６に進んでｚｍｐ軌道の目標値
を設定する。先にも述べた様に、ロボットが安定に歩行
するためには、片脚支持期にｚｍｐはロボット全体の接
地点の外周を結んだ安定領域内部に、即ち、支持脚の足
裏内に位置しなければならない。人間の歩行も同様にこ
の条件を満足している。そのときのｚｍｐの位置に注目
してみると、ｚｍｐは離床の瞬間に次の片脚支持期の安
定領域の後端にあり、片脚支持期間に安定領域内を移動
して着地の瞬間には前記の安定領域の前端にある。人間
の歩行は着地位置や着地のタイミングを絶妙に調整する
などの方法で歩行の安定化を図っており、非常に高い安
定性を有している。それ故この様なｚｍｐ軌道が合理的
であると推測され、実際に重心の加減速が小さく、また
関節にかかる負荷も小さいことが確かめられた。一方、
運動性能が人間よりも劣る、特に安定性が人間に比較し
て低いと言わざるを得ない現状のロボットでは、ｚｍｐ
を人間と同じ様にすると、離床の直後と着地の直前とで
ｚｍｐが安定領域の端にあったのでは、十分に安定な歩
行を実現することができない。しかし、ロボットには図
１に示した様に足平の面積を比較的大きくすることがで
きる、また関節トルクを大きくすることができる、など
人間にはない特徴があり、これらを活用してｚｍｐ軌道
の目標値を設定することにより、歩行の安定性を向上さ
せることができる。Then, the program proceeds to S16, in which a target value of the zmp trajectory is set. As described above, in order for the robot to walk stably, during the one-leg supporting period, zmp is located inside the stable region connecting the outer circumference of the grounding point of the entire robot, that is, within the sole of the supporting leg. Must. Human walking also satisfies this condition. Focusing on the position of zmp at that time, zmp is at the rear end of the stable area of the next one leg support period at the moment of leaving the bed, moves within the stable area during the one leg support period, and at the moment of landing. Is at the front end of the stability region. In human walking, stabilization of walking is achieved by exquisitely adjusting the landing position and landing timing, and has extremely high stability. Therefore, it was presumed that such a zmp trajectory was reasonable, and it was confirmed that the acceleration and deceleration of the center of gravity were actually small and the load on the joint was also small. on the other hand,
In the current robot, the motion performance of which is inferior to humans, especially the stability of which must be said to be lower than humans, zmp
If zmp is the same as that of a human, a sufficiently stable walking cannot be realized if the zmp is at the end of the stable area immediately after leaving the bed and immediately before landing. However, as shown in FIG. 1, the robot has relatively unique features such as a relatively large foot area and a large joint torque. By setting the target value of the trajectory, walking stability can be improved.
【００２４】以上から、この制御においては、ｚｍｐが
図７、図８に示す位置にある様にｚｍｐ軌道の目標値を
設定した。即ち、 １．離床の瞬間のｚｍｐが、直後の片脚支持期の安定領
域内にあること。 ２．離床の瞬間のｚｍｐが、直後の片脚支持期の安定領
域内にあり、かつその後端と左右端に対して少なくとも
所定の余裕を持つこと。 ３．着地の瞬間のｚｍｐが、直前の片脚支持期の安定領
域内にあること。 ４．着地の瞬間のｚｍｐが、直前の片脚支持期の安定領
域内にあり、かつその前端と左右端に対して少なくとも
所定の余裕を持つこと。 ５．片脚支持期のｚｍｐが、安定領域に対して少なくと
も所定の余裕を持つこと。 尚、言うまでもなく、上記で前（後）端はｘ軸方向の、
左右端はｙ軸方向の位置を示す。As described above, in this control, the target value of the zmp trajectory is set such that zmp is at the position shown in FIGS. That is, 1. The zmp at the moment of leaving the bed should be within the stable region immediately after the one-leg support period. 2. The zmp at the moment of leaving the bed is within the stable region immediately after the one-leg support period, and has at least a predetermined margin with respect to the rear end and the left and right ends. 3. The zmp at the moment of landing is within the stable range of the immediately preceding leg support period. 4. The zmp at the moment of landing is within the stability region of the immediately preceding one-leg support period, and has at least a predetermined margin with respect to its front end and left and right ends. 5. The zmp in the one-leg supporting period has at least a predetermined margin with respect to the stable region. Needless to say, in the above, the front (rear) end is in the x-axis direction,
Left and right ends indicate positions in the y-axis direction.
【００２５】即ち、歩行中、種々の外乱などによってロ
ボットが倒れそうになると、ｚｍｐは目標位置から外れ
て移動し、安定領域の境界まで達するとロボットは倒れ
始める。しかしながら、上記の如く構成したことによ
り、離床と着地の瞬間を含む片脚支持期の全ての瞬間に
おいて、ｚｍｐの位置は安定領域の端に対して少なくと
も所定の余裕を持つので、ｚｍｐを安定領域の端まで移
動させるほどの大きい外乱が加わらなければ、ロボット
は傾かない。従って、この余裕が大きいほど安定である
と言える。このとき、各関節は、外力によって生じる負
荷に抗して姿勢を保持するために、能動的にトルクを発
生している。また、姿勢の安定を回復する方向にｚｍｐ
を移動させる様に、積極的に関節トルクを発生すれば、
ロボットに作用する安定性回復力の力積を大きくするこ
とができるので、さらに安定な歩行を実現することがで
きる。このときのｚｍｐの移動量が大きいほど安定性の
回復能力が大きいと言う関係が成立するが、ｚｍｐは安
定領域の外側に出られないので、外乱などがない状態に
おけるｚｍｐを安定領域の十分内側に位置させること
が、安定性を高める要因となる。上記の如く、この制御
においては、足平面積が大きい、関節トルクが大きいと
言う特徴を生かして歩行の安定性を高める様にした。Ｓ
１６で設定するｚｍｐの軌跡の目標値を歩行中に上方か
ら見ると、平面的に示すと、図９に示す様になる。尚、
この明細書では「軌道」は時間に依存した表現を、「軌
跡」は時間に依存しない表現を、意味するものとして使
用する。That is, if the robot is likely to fall down during walking due to various disturbances, the zmp moves away from the target position, and when it reaches the boundary of the stable area, the robot starts to fall down. However, with the above configuration, the zmp position has at least a predetermined margin with respect to the end of the stable region at all moments of the one-leg support period including the moments of leaving the floor and landing, so that zmp is set to the stable region. The robot does not tilt unless a large disturbance is applied to move it to the end of the robot. Therefore, it can be said that the greater the margin, the more stable. At this time, each joint is actively generating torque in order to maintain a posture against a load generated by an external force. In addition, zmp in the direction to restore the posture stability
If you generate joint torque positively like moving
Since the impulse of the stability recovery force acting on the robot can be increased, more stable walking can be realized. At this time, a relation is established that the greater the movement amount of zmp, the greater the recovery ability of stability is. However, since zmp cannot go outside the stable region, zmp in a state where there is no disturbance or the like is sufficiently inside the stable region. Is a factor that enhances stability. As described above, in this control, the stability of walking is enhanced by taking advantage of the features that the foot area is large and the joint torque is large. S
When the target value of the locus of zmp set at 16 is viewed from above during walking, it is as shown in FIG. 9 in a plan view. still,
In this specification, “trajectory” is used to mean a time-dependent expression, and “trajectory” is used to mean a time-independent expression.
【００２６】続いてＳ１８に進んで重心の位置Ｇｘ，Ｇ
ｙ，Ｇｚの初期値を設定する。これについては後で重心
軌道の最適化を図ることから、ここでは単に歩行する姿
勢がとれれば良いと言う程度の値に設定する。続いてＳ
２０に進んで遊脚軌道の初期値を設定する。即ち、遊脚
について未だ設定されていない足関節の座標Ａｘ，Ａｚ
と足平の回転角度θｙについて、とりあえずは遊脚が地
面に接触しない程度の値に設定する。続いてＳ２２に進
み、重心軌道のうちの上下（重力）方向成分Ｇｚについ
て最適化を図る。Then, the process proceeds to S18, where the positions Gx and G of the center of gravity are set.
Initial values of y and Gz are set. In this regard, since the center of gravity trajectory will be optimized later, the value is set to such a value that it is sufficient to simply take a walking posture. Then S
Proceeding to 20, the initial value of the free leg trajectory is set. That is, the coordinates Ax and Az of the ankle joint that have not yet been set for the free leg
And the rotation angle θy of the foot are set to such a value that the free leg does not contact the ground for the time being. Then, the process proceeds to S22, in which the vertical (gravity) direction component Gz of the center of gravity trajectory is optimized.
【００２７】これについて説明すると、歩行の１周期
（右（左）脚支持期から両足支持期を経て左（右）脚支
持期に至る期間）について重心の位置Ｇｚの上下方向の
変化を見ると、図１０に示す様になる（尚、重心位置の
変化は微小であり、また実際に得られる波形はもっと複
雑であるが、ここでは理解の便宜のため、変化を誇張す
ると共に、波形も滑らかに示す）。また、重心位置が変
位する速度（Ｇｚドットで示す）、重心位置が変位する
加速度（Ｇｚツー・ドットで示す）も併せて同図に示
す。To explain this, the change in the vertical position of the center of gravity Gz for one cycle of walking (the period from the right (left) leg support period to the left (right) leg support period via the two-leg support period) is seen. 10 (note that the change in the position of the center of gravity is minute and the actually obtained waveform is more complicated. However, for the sake of convenience in understanding, the change is exaggerated and the waveform is smooth. Shown). In addition, the speed at which the position of the center of gravity is displaced (shown by Gz dots) and the acceleration at which the position of the center of gravity is displaced (shown by Gz2 dots) are also shown in FIG.
【００２８】ここでロボットにかかる負荷を図１１に示
す様に例えば膝関節１６Ｒ（Ｌ）について見ると、 外力の負荷＝路面反力Ｆ×距離Ｌ 路面反力Ｆ＝ｍｇ＋ｍＧｚツー・ドット 負荷の合計＝外力の負荷（保持トルク）＋内力の負荷
（加減速トルク） と示すことができる（上下方向についてのみ示す）。即
ち、ロボットの重心の加速度が大きいとロボットに働く
外力もそれに応じて大きくなる。それによって、ロボッ
トはそれに耐えるだけの強度と剛性、アクチュエータの
出力を必要として部材重量の増加、駆動系の重量増加と
なって総重量の増加を強いられ、結果としてロボットに
作用する外力がさらに増大すると言った悪循環が生まれ
る。また、消費エネルギも必要以上に大きくなるため
に、ロボットの作業時間が短縮されると共に、エネルギ
源も大型になり、悪循環に拍車をかける。この悪循環を
断ち切ってロボットの軽量化を図るためには、外力をで
きるだけ小さく抑えた重心軌道の運動パターンで歩行さ
せることが重要である。さらに、関節の保持トルクはそ
の角度を一定として考えれば外力に比例しているので、
外力が大きいときは保持トルクも大きくなる。特に、支
持脚の膝関節の保持トルクは曲げ角度にも強く影響を受
け、曲げ角度が大きくなると、前記した距離Ｌが大きく
なって保持トルクも増加する。また、加減速トルクは関
節の角加速度に比例する。さらに、加速度の変化が大き
いと言うことは、運動パターンとして無駄が多くて滑ら
かさに欠けており、歩行安定性の上からも望ましくな
い。Referring to the load applied to the robot with respect to, for example, the knee joint 16R (L) as shown in FIG. 11, the load of external force = road reaction force F × distance L road reaction force F = mg + mGz2-dot total load = Load of external force (holding torque) + load of internal force (acceleration / deceleration torque) (shown only in the vertical direction). That is, if the acceleration of the center of gravity of the robot is large, the external force acting on the robot also becomes large accordingly. As a result, the robot needs the strength and rigidity to withstand it, the output of the actuator needs to increase the weight of members, and the weight of the drive system increases, forcing the total weight to increase, and as a result, the external force acting on the robot further increases Then a vicious circle is born. In addition, since the energy consumption becomes unnecessarily large, the working time of the robot is shortened, and the energy source is increased in size, which spurs a vicious circle. In order to break this vicious cycle and reduce the weight of the robot, it is important to walk the robot in a motion pattern of the center of gravity trajectory in which external force is kept as small as possible. Furthermore, the holding torque of the joint is proportional to the external force if the angle is considered constant,
When the external force is large, the holding torque is also large. In particular, the holding torque of the knee joint of the supporting leg is strongly affected by the bending angle, and when the bending angle increases, the distance L increases to increase the holding torque. The acceleration / deceleration torque is proportional to the angular acceleration of the joint. Further, a large change in acceleration means that the motion pattern is wasteful and lacks in smoothness, which is not desirable from the viewpoint of walking stability.
【００２９】従って、膝関節にかかる負荷を低減するた
めには、重心の加速度を小さく抑え、ロボットに作用す
る外力（路面反力）を低減すること、ならびに重心の高
さを可能な限り高くして支持脚膝関節の曲げ角度（前記
した距離Ｌに比例）を大きくしないことが重要となる。
そこで、この制御においては重心の上下方向の運動パタ
ーンを最適に設定し、歩行中にロボットに作用する外力
の低減化、関節負荷の低減化、消費エネルギの低減化を
図ると共に、歩行安定性を向上させ歩容を人間のそれに
一層近づけて人間の作業動作環境への適応を容易にする
様にした。Therefore, in order to reduce the load applied to the knee joint, the acceleration of the center of gravity should be reduced, the external force (road reaction force) acting on the robot should be reduced, and the height of the center of gravity should be increased as much as possible. It is important not to increase the bending angle of the knee joint of the supporting leg (proportional to the distance L).
Therefore, in this control, the vertical motion pattern of the center of gravity is optimally set to reduce the external force acting on the robot during walking, reduce the joint load, reduce the energy consumption, and improve walking stability. The gait has been improved so as to be closer to that of human beings, so that it is easier to adapt to human working environment.
【００３０】以下、図１２のサブルーチン・フロー・チ
ャートを参照して重心の鉛直方向軌道の最適化を説明す
る。まず図１２のＳ１００では図３のフロー・チャート
のＳ１８で初期設定された、又はＳ２２でこれから述べ
る様に修正されることになる重心の鉛直方向軌道を初期
値として、図３のフロー・チャートのＳ１０，Ｓ１２，
Ｓ１４，Ｓ１６，Ｓ１８，Ｓ２０で設定された他の歩容
パラメータ、又は後で述べる様にＳ２４，Ｓ２６で修正
されることになる遊脚軌道、重心の前後、左右方向の軌
道を前提とした時に取れる姿勢のなかで最も高い重心の
鉛直方向軌道を探索して、重心の鉛直方向限界軌道（Ｇ
ｚ.lim軌道）とする。ここで得られた重心の鉛直方向限
界軌道（Ｇｚ.lim軌道）を図１０の上段のグラフに一点
鎖線で示した。この重心の鉛直方向限界軌道（Ｇｚ.lim
軌道）では少なくとも左右どちらかの膝関節１６Ｒ
（Ｌ）が伸び切った姿勢となっている。重心の鉛直方向
限界軌道（Ｇｚ.lim軌道）を重心の鉛直方向軌道（Ｇｚ
軌道）としてＳ１０２に進む。Ｓ１０２では重心の鉛直
方向軌道（Ｇｚ軌道）の最小値Ｇｚ.minを探索する。Hereinafter, the optimization of the vertical trajectory of the center of gravity will be described with reference to the subroutine flowchart of FIG. First, in S100 of FIG. 12, the vertical trajectory of the center of gravity, which is initialized in S18 of the flow chart of FIG. 3 or will be corrected in S22 as described below, is set as an initial value, and the flow chart of FIG. S10, S12,
When the other gait parameters set in S14, S16, S18, S20, or the free leg trajectory to be corrected in S24, S26 as described later, and the trajectory in the front-back, left-right direction of the center of gravity, The vertical trajectory of the highest center of gravity among the postures that can be taken is searched for, and the vertical trajectory of the center of gravity (G
z.lim orbit). The vertical limit trajectory (Gz.lim trajectory) of the center of gravity obtained here is shown by a chain line in the upper graph of FIG. The vertical limit orbit of this center of gravity (Gz.lim
Orbit) at least the left or right knee joint 16R
(L) is in a fully extended posture. The vertical limit trajectory (Gz.lim trajectory) of the center of gravity is changed to the vertical trajectory (Gz.lim
The process proceeds to S102 as (trajectory). In S102, the minimum value Gz.min of the vertical trajectory (Gz trajectory) of the center of gravity is searched.
【００３１】続いてＳ１０４では鉛直方向の重心加速度
のリミット処理を行う。Ｓ１０２で探索したＧｚ.minと
なる時刻から時間の進む方向と戻る方向の両方向に向け
て鉛直方向の重心加速度（図１０の下段のグラフに一点
鎖線で表す）のチェックを行い、もしある時刻における
鉛直方向の重心加速度の絶対値が所定の鉛直方向の重心
加速度の最大値（Ｇｚツー・ドット.max）を超えていた
場合には、その時刻における鉛直方向の重心加速度が所
定の鉛直方向の重心加速度の最大値（Ｇｚツー・ドッ
ト.max）になるように、かつ重心の鉛直方向限界軌道
（Ｇｚ.lim軌道）を超えないように鉛直方向の重心軌道
（Ｇｚ軌道）に修正を加える。かように修正されたＧ
ｚ.lim軌道のＧｚツー・ドット軌道を図１０の下段のグ
ラフに実線で示す。また、同様に鉛直方向の重心速度
（Ｇｚドット）のリミット処理を行ってもよい。これで
全ての時刻における鉛直方向の重心加速度（速度）が所
定の範囲内（−Ｇｚツー・ドット.max〜Ｇｚツー・ドッ
ト.max、−Ｇｚドット.max〜Ｇｚドット.max）にあると
いう条件を満足する軌道のなかでその平均高さが最も高
い鉛直方向の重心軌道が実現される。実施例では所定の
鉛直方向の重心加速度の最大値（Ｇｚツー・ドット.ma
x）を０．２ｇ〜０．７ｇ（ｇ：重力加速度）と設定し
た場合に良好な結果が得られた。Subsequently, in S104, a vertical center of gravity acceleration limit process is performed. From the time when Gz.min searched in S102, the center of gravity acceleration in the vertical direction (indicated by a dashed line in the lower graph of FIG. 10) is checked in both the forward and backward directions of time. If the absolute value of the vertical center of gravity acceleration exceeds the maximum value of the vertical center of gravity acceleration (Gz2.dot.max), the vertical center of gravity acceleration at that time becomes the predetermined vertical center of gravity. The vertical center-of-gravity trajectory (Gz trajectory) is modified so that the acceleration becomes the maximum value (Gz-to-dot.max) and does not exceed the vertical limit trajectory (Gz.lim trajectory) of the center of gravity. G modified as above
The Gz-to-dot trajectory of the z.lim trajectory is shown by a solid line in the lower graph of FIG. Further, similarly, a limit process of the vertical center of gravity speed (Gz dot) may be performed. Thus, the condition that the acceleration (velocity) of the center of gravity in the vertical direction at all times is within a predetermined range (-Gz2 dot.max to Gz2 dot.max, -Gzdot.max to Gzdot.max). Among the trajectories satisfying the above, a vertical center of gravity trajectory having the highest average height is realized. In the embodiment, the maximum value of the predetermined vertical center of gravity acceleration (Gz2.dot.ma
Good results were obtained when x) was set to 0.2 g to 0.7 g (g: gravitational acceleration).
【００３２】図１２サブルーチン・フロー・チャートに
おいては続いてＳ１０６に進んで、図１０の上段のグラ
フに示す様に、Ｇｚ軌道の最小値Ｇｚ．ｍｉｎに対して
所定の余裕Ｇｚ.margin を持たせる様に、下方に平行移
動させる（よって求められる値を図１０の上段のグラフ
に「Ｇｚ軌道（最終値）」で示す）。即ち、例えば図１
３と図１４に示す様に、膝関節が比較的大きく曲がった
状態（図１３）と膝関節が大きく伸びた状態（図１４）
とでは図１５に示す様に、膝関節角度の変化分Δθ1,2
と重心位置の上下方向変化分Δｚとの割合が大きく相違
する。即ち、図１４の様に重心の高さが限界高さに近づ
くと、支持脚膝関節が伸び切った状態に近づくために重
心高さに対する支持脚膝関節の感度（Δθ2 ／Δｚ）が
図１３の場合のそれ（Δθ1 ／Δｚ）に比較して大きく
なり、任意の時間内で重心高さＧｚをΔｚだけ変化させ
るために必要な支持脚膝関節の加減速トルクが増大して
膝関節にかかる負荷が全体として増加するからである。
この理由から所定の余裕を持たせると共に、実施例では
その余裕Ｇｚ.margin を１０ｍｍとした。尚、この結
果、前記した曲げ角度（距離Ｌに比例）は大きくなり、
保持トルクは増加するが、それ以上に加減速トルクが減
少するので膝関節にかかる負荷の合計は減少することに
なる。In the subroutine flow chart of FIG. 12, the process proceeds to S106, and as shown in the upper graph of FIG. 10, the minimum value Gz. It is translated downward so as to have a predetermined margin Gz.margin with respect to min (the value obtained in this way is indicated by “Gz trajectory (final value)” in the upper graph of FIG. 10). That is, for example, FIG.
As shown in FIGS. 3 and 14, the knee joint is relatively bent (FIG. 13) and the knee joint is greatly extended (FIG. 14).
As shown in FIG. 15, the change amount of the knee joint angle Δθ1,2
There is a large difference between the ratio of the center-of-gravity position and the vertical change Δz. That is, when the height of the center of gravity approaches the limit height as shown in FIG. 14, the sensitivity (Δθ2 / Δz) of the knee joint with respect to the height of the center of gravity is changed as shown in FIG. (Δθ1 / Δz), the acceleration / deceleration torque of the supporting leg knee joint required to change the center of gravity height Gz by Δz within an arbitrary time increases, and the torque is applied to the knee joint. This is because the load increases as a whole.
For this reason, a predetermined margin is provided, and in the embodiment, the margin Gz.margin is set to 10 mm. As a result, the bending angle (proportional to the distance L) increases,
Although the holding torque increases, the acceleration / deceleration torque further decreases, so that the total load applied to the knee joint decreases.
【００３３】図３フロー・チャートに戻ると、続いてＳ
２４に進んで遊脚軌道の最適化を行う。これは膝関節と
足関節とについて今述べたＧｚ軌道の最適化と同様な処
理を行って関節駆動アクチュエータの負荷を軽減し、小
型軽量化を図るものである。即ち、先に述べた様に、ロ
ボットの歩容を一意に決定するためには、その自由度と
同数のパラメータを必要とすることになるから、遊脚の
位置と方向などを指定するためには、少なくとも６個の
パラメータを使用することになる。このとき、脚先端の
位置と方向とを単に指定しておき、それから各関節の駆
動パターンを決定するのみとすると、駆動パターンは歩
容決定パラメータに従属に決定されてしまい、場合によ
っては関節駆動パターンの角加速度、角速度、動作角度
が必要以上に大きくなることがあり得る。その結果、関
節を駆動するアクチュエータは必要以上の出力を要求さ
れて大型になり、高速で運動する脚部リンクやロボット
全体の重量も増加してＧｚ軌道の最適化で述べたと同様
の不都合が生じ得る。また、歩行中はｚｍｐが安定領域
内になければならないと言う条件を満足する必要がある
が、そのために遊脚の運動に不必要な加速度のピークを
持たせてしまった場合、この運動が重心の運動にも反映
されて重心の運動まで不要なピークを持ったものとなっ
たり、ｚ軸まわりの回転モーメントを発生したりして歩
行を不安定にする。そこで、この制御において関節の駆
動パターンの角加速度、角速度のピーク値を抑制するこ
ととした。Returning to the flow chart of FIG.
Proceeding to 24, the free leg trajectory is optimized. This is to reduce the load on the joint drive actuator by performing the same processing as the optimization of the Gz trajectory just described for the knee joint and the ankle joint, and to reduce the size and weight. That is, as described above, in order to uniquely determine the gait of the robot, the same number of parameters as its degrees of freedom are required. Will use at least six parameters. At this time, if the position and direction of the tip of the leg are simply designated, and then the drive pattern of each joint is determined, the drive pattern is determined depending on the gait determination parameters. The angular acceleration, angular velocity, and operation angle of the pattern may be larger than necessary. As a result, the actuators that drive the joints are required to have more power than necessary and become large, and the weight of the leg link and the robot that move at high speed also increase, causing the same disadvantages as described in Optimizing the Gz trajectory. obtain. In addition, it is necessary to satisfy the condition that the zmp must be within the stable region during walking, but if the peak of the acceleration unnecessary for the movement of the swing leg is given for this reason, this movement becomes the center of gravity. It also has an unnecessary peak up to the movement of the center of gravity, which is reflected in the movement of the center of gravity, and generates a rotational moment about the z-axis, thereby making the walking unstable. Therefore, in this control, the peak values of the angular acceleration and the angular velocity of the drive pattern of the joint are suppressed.
【００３４】図１６サブルーチン・フロー・チャートを
参照してこの遊脚軌道の最適化について説明すると、ま
ずＳ２００において足関節１８Ｒ（Ｌ）の角加速度、角
速度の許容最大値θａツー・ドット.lim，θａドット.l
imと膝関節１６Ｒ（Ｌ）の角加速度、角速度の許容最大
値θｋツー・ドット.lim，θｋドット.limを設定する。
次に、Ｓ２０２において設定されている歩容パラメータ
から図１に示した１２個の関節について各関節の駆動パ
ターンを計算する。続いて、Ｓ２０４に進んで計算され
た関節駆動パターンのうち、足関節１８Ｒ（Ｌ）の角加
速度θａツー・ドット、角速度θａドットを計算し、そ
れぞれの最大値θａツー・ドット.max，θａドット.max
を探索する。続いて、Ｓ２０６に進んで膝関節について
も足関節と同様に角加速度、角速度の最大値θｋツー・
ドット.max，θｋドット.maxを探索する。次にＳ２０８
に進んで足関節１８Ｒ（Ｌ）の角加速度、角速度の最大
値θａツー・ドット.max，θａドット.maxがＳ２００で
あらかじめ適切に設定されているそれぞれの許容最大値
θａツー・ドット.lim，θａドット.limを超えているか
どうか判定する。The optimization of the free leg trajectory will be described with reference to the subroutine flow chart of FIG. 16. First, in S200, the allowable maximum values of the angular acceleration and the angular velocity of the ankle joint 18R (L) θa two-dot.lim, θa dot.l
The permissible maximum values of angular acceleration and angular velocity θk to dot.lim and θkdot.lim of the im and the knee joint 16R (L) are set.
Next, a drive pattern for each of the twelve joints shown in FIG. 1 is calculated from the gait parameters set in S202. Subsequently, the process proceeds to S204, in which the angular acceleration θa2 dot and the angular velocity θadot of the ankle 18R (L) are calculated from the calculated joint drive patterns, and the maximum values θa2dot.max and θadot, respectively, are calculated. .max
To explore. Then, proceeding to S206, the maximum value of angular acceleration and angular velocity θk2
Search for dot.max, θkdot.max. Next, S208
The maximum values of the angular acceleration and angular velocity of the ankle joint 18R (L) θa two-dot.max and θa dot.max are appropriately set in advance in S200, and the allowable maximum values θa two-dot.lim, It is determined whether or not θa dot.lim is exceeded.
【００３５】もし、足関節１８Ｒ（Ｌ）の角加速度、角
速度の最大値θａツー・ドット.max，θａドット.maxが
許容最大値θａツー・ドット.lim，θａドット.maxを超
えている場合は、Ｓ２１０に進みθｙを修正する。これ
は、θｙと足関節の駆動パターンに直接的な関係があ
り、θｙを修正することにより足関節の駆動パターンの
角加速度、角速度を許容範囲内に収めることができるか
らである。以下、図１７に沿ってその手順を説明する。
図１７の左半分は歩容パラメータの内のθｙの軌道を、
右半分は歩容パラメータから計算された足関節の駆動パ
ターンを表しており、上段は角度を、中段は角速度を、
下段は角加速度を表している。それぞれのグラフで実線
はＳ２１０で修正される前の軌道を、一点鎖線は修正さ
れた後の軌道を表している（但し、θｙ，θｙドット、
及びθａのグラフにおいては実線と一点鎖線はほぼ重な
り合っている）。If the maximum values of the angular acceleration and angular velocity θa-dot.max, θa-dot.max of the ankle 18R (L) exceed the allowable maximum values θa-dot.lim, θa-dot.max Goes to S210 to correct θy. This is because there is a direct relationship between θy and the driving pattern of the ankle joint, and by correcting θy, the angular acceleration and angular velocity of the driving pattern of the ankle joint can be kept within an allowable range. Hereinafter, the procedure will be described with reference to FIG.
The left half of FIG. 17 shows the trajectory of θy in the gait parameters,
The right half shows the driving pattern of the ankle joint calculated from the gait parameters, the upper row shows the angle, the middle row shows the angular velocity,
The lower part shows the angular acceleration. In each graph, the solid line represents the trajectory before correction in S210, and the dashed line represents the trajectory after correction (provided that θy, θy dots,
And the solid line and the dash-dot line almost overlap in the graphs of θa and θa).
【００３６】実施例では初めに左側θｙのグラフに実線
で示した軌道を初期値として図３のＳ２０で与えた。θ
ｙの角速度θｙドット、角加速度θｙツー・ドットもそ
れぞれのグラフに実線で示した。他の歩容パラメータも
図３のＳ１０，Ｓ１２，Ｓ１４，Ｓ１６，１８で与えら
れている。これらの歩容パラメータに対して、計算され
た足関節の駆動パターンを右側θａのグラフに実線で示
した。とくに中段の角速度（θａドット）、下段の角加
速度（θａツー・ドット）のグラフに示したようにそれ
ぞれ角速度、角加速度の最大ピーク値が大きく、また角
加速度ではその変化も激しい。そこで、足関節駆動パタ
ーンの角加速度θａツー・ドットのグラフに破線で示し
た許容最大値θａツー・ドット.limを設け、任意の時刻
における角加速度θａツー・ドットと比較を行ない、後
者が前者よりも大きいときは、それを超えた割合に応じ
て同じ時刻におけるθｙの角加速度を修正する。例え
ば、ある時刻における足関節駆動パターンの角加速度θ
ａツー・ドットと足関節駆動パターンの角加速度の許容
最大値θａツー・ドット.limの比がθａツー・ドット／
θａツー・ドット.lim＝１．２であったとすれば、同時
刻におけるθｙの角加速度θｙツー・ドットを（１／
１．２）倍に修正する。この修正を足関節駆動パターン
の角加速度θａツー・ドットが足関節駆動パターンの角
加速度の許容最大値θａツー・ドット.limよりも大きい
全ての時刻に対して行なうと、θｙの角加速度はθｙツ
ー・ドットのグラフ中の一点鎖線で示すように修正され
る。これを２回、積分して歩容パラメータθｙの新しい
軌道とする。θｙとθｙドットはθｙツー・ドットが積
分したものとなるので、θｙツー・ドットが修正された
ことによる変化はグラフ中では明確になっていない。こ
の新しく修正された歩容パラメータθｙから計算された
足関節駆動パターンをグラフ中に一点鎖線で示した。θ
ｙと同様の理由で足関節の駆動パターンθａでみるとほ
とんど変化がないように見えるが、足関節駆動パターン
の角速度で見ればその最大ピーク値が小さくなっている
こと、角加速度で見れば最大ピーク値が小さくなると共
にその変化が少なくなっていることが認められ、Ｓ２０
８でのθｙ修正の効果が出ていることがわかる。In the embodiment, the trajectory indicated by the solid line in the graph on the left side θy is initially given in S20 of FIG. θ
The angular velocity θy dot of y and the angular acceleration θy two dots are also indicated by solid lines in the respective graphs. Other gait parameters are also given in S10, S12, S14, S16, and 18 in FIG. The drive pattern of the ankle joint calculated for these gait parameters is indicated by a solid line in the graph on the right side θa. In particular, as shown in the graphs of the angular velocity (θa dot) in the middle stage and the angular acceleration (θa two dots) in the lower stage, the maximum peak values of the angular velocity and the angular acceleration are large, respectively, and the angular acceleration changes greatly. Therefore, an allowable maximum value θa two-dot.lim shown by a broken line is provided in the graph of the angular acceleration θ a two-dot of the ankle drive pattern, and the angular acceleration θ a two-dot at an arbitrary time is compared with the former. If it is larger than the value, the angular acceleration of θy at the same time is corrected according to the ratio exceeding the value. For example, the angular acceleration θ of the ankle drive pattern at a certain time
The ratio between the a-dot and the allowable maximum value of the angular acceleration of the ankle drive pattern θa-dot.lim is θa-dot /
Assuming that θa2dot.lim = 1.2, the angular acceleration θy2dot of θy at the same time is (1/2)
1.2) Correct twice. If this correction is performed for all times at which the angular acceleration θa two dots of the ankle drive pattern is larger than the allowable maximum value θa two dots.lim of the angular acceleration of the ankle drive pattern, the angular acceleration of θy becomes θy The correction is made as shown by the dashed line in the two-dot graph. This is integrated twice to obtain a new trajectory of the gait parameter θy. Since the θy and the θy dots are obtained by integrating the θy two dots, the change due to the correction of the θy two dots is not clear in the graph. The ankle drive pattern calculated from the newly corrected gait parameter θy is indicated by a dashed line in the graph. θ
For the same reason as for y, it appears that there is almost no change when viewed with the ankle drive pattern θa, but the maximum peak value is small when viewed with the angular velocity of the ankle drive pattern, and the maximum when viewed with angular acceleration. It was recognized that the peak value became smaller and the change became smaller.
8, it can be seen that the effect of the correction of θy is obtained.
【００３７】以上は角加速度に対する修正について説明
したが、角速度についても同様な処理を行なってもよ
い。これでＳ２１０のθｙの修正処理は終了し、Ｓ２０
２へ戻る。Ｓ２０２に戻る理由についてはＳ２２０から
Ｓ２０２へと戻る理由と併せて後記する。Although the correction for the angular acceleration has been described above, the same processing may be performed for the angular velocity. Thus, the correction processing of θy in S210 is completed, and in S20
Return to 2. The reason for returning to S202 will be described later together with the reason for returning from S220 to S202.
【００３８】また、足関節１８Ｒ（Ｌ）の角加速度、角
速度の最大値θａツー・ドット.max，θａドット.maxが
許容最大値θａツー・ドット.lim，θａドット.limを超
えていない場合にはＳ２１２に進む。Ｓ２１２では、Ｓ
２０４で計算した膝関節の角加速度、角速度の最大値θ
ｋツー・ドット.max，θｋドット.maxとあらかじめ適切
に設定されているそれぞれの許容最大値θｋツー・ドッ
ト.lim，θｋドット.limの比較を行ない、前者が後者よ
りも大きくないときは遊脚軌道は最適であると判断さ
れ、遊脚軌道の最適化処理は終了し図３のＳ２６へと続
く。もし、前者が後者よりも大きいときはＳ２１４へ進
み、以降の処理を受ける。When the maximum values of the angular acceleration and angular velocity of the ankle joint 18R (L) θa-dot.max and θa-dot.max do not exceed the allowable maximum values θa-dot.lim and θa-dot.lim. To S212. In S212, S
Maximum value of angular acceleration and angular velocity θ of the knee joint calculated in 204
The k-to-dot.max and θk-dot.max are compared with the allowable maximum values θk-to-dot.lim and θk-dot.lim that are appropriately set in advance. If the former is not larger than the latter, the It is determined that the leg trajectory is optimal, and the optimization process of the free leg trajectory ends, and the process continues to S26 in FIG. If the former is larger than the latter, the process proceeds to S214 and receives the subsequent processing.
【００３９】Ｓ２１４では膝関節の駆動パターンを改善
する過程で必要になる遊脚腰関節の位置を算出する。Ｓ
２１６では、Ｓ２０２算出された膝関節の駆動パターン
に角加速度、角速度のリミットをかける処理を行なう。
以下、図１８に沿ってその手順を説明する。図１８の上
段は遊脚期の膝関節駆動パターンを、中段はその微分値
である角速度パターンを、下段は二階微分値である角加
速度パターンを示している。これらの図中ではＳ２０２
で算出された膝関節の駆動パターンに関するものを実線
で表示している。下段のグラフの破線はＳ２００で設定
されたθｋツー・ドット.limを示している。角加速度の
グラフでみると、Ｓ２０２で算出された膝関節の角加速
度パターンでは一部、許容最大値のθｋツー・ドット.l
imを超えている。Ｓ２１６ではこの部分の角加速度にリ
ミットをかけて最大角加速度θｋツー・ドット.maxが最
大許容角加速度θｋツー・ドット.limを超えないように
膝関節駆動パターンの角加速度パターンを修正する。Ｓ
２１８ではＳ２１６で修正された角加速度パターンを積
分して角速度パターンを、さらにもう一度積分して膝関
節の駆動角度パターンを算出する。修正された膝関節駆
動角度パターン、角速度パターン、角加速度パターンを
図中に一点鎖線で示した。次に、Ｓ２２０に進みＳ２１
４とＳ２１８で算出された遊脚腰関節１２Ｒ（Ｌ）位置
と膝関節駆動角度パターンから図１９に示したように、
遊脚腰関節と遊脚足関節を結ぶ直線の角度が変化しない
ように歩容パラメータである遊脚足関節１８，２０Ｒ
（Ｌ）の交点の座標（Ａｘ，Ａｙ，Ａｚ）の軌道を修正
し、Ｓ２０２へ戻る。In S214, the position of the free leg hip joint required in the process of improving the driving pattern of the knee joint is calculated. S
At 216, processing is performed to limit the angular acceleration and angular velocity to the knee joint drive pattern calculated at S202.
Hereinafter, the procedure will be described with reference to FIG. The upper part of FIG. 18 shows the knee joint driving pattern in the swing phase, the middle part shows the angular velocity pattern which is a differential value thereof, and the lower part shows the angular acceleration pattern which is the second order differential value. In these figures, S202
The driving pattern of the knee joint calculated in step (1) is displayed by a solid line. The dashed line in the lower graph indicates θk2.dot.lim set in S200. Looking at the graph of the angular acceleration, in the angular acceleration pattern of the knee joint calculated in S202, a part of the allowable maximum value θk to dot.l
im beyond. In S216, the angular acceleration of the knee joint driving pattern is corrected so that the angular acceleration of this portion is limited so that the maximum angular acceleration θk-to-dot.max does not exceed the maximum allowable angular acceleration θk-to-dot.lim. S
At 218, the angular acceleration pattern corrected at S216 is integrated to calculate the angular velocity pattern, and the integration is performed once again to calculate the knee joint drive angle pattern. The corrected knee joint drive angle pattern, angular velocity pattern, and angular acceleration pattern are indicated by dashed lines in the figure. Next, the process proceeds to S220 and S21.
4 and the knee joint drive angle pattern from the free leg hip joint 12R (L) position and the knee joint drive angle pattern calculated in S218, as shown in FIG.
The free leg ankle joints 18, 20R, which are gait parameters, do not change the angle of the straight line connecting the free leg hip joint and the free leg ankle joint.
The trajectory of the coordinates (Ax, Ay, Az) of the intersection of (L) is corrected, and the process returns to S202.
【００４０】ここで、Ｓ２１０とＳ２２０からＳ２０２
へと戻る理由について記す。Ｓ２１０では足関節の駆動
パターンの改善をθｙ軌道を修正することにより、また
Ｓ２２０では膝関節の駆動パターンの改善を遊脚足関節
１８，２０Ｒ（Ｌ）の交点座標軌道（Ａｘ，Ａｙ，Ａ
ｚ）を修正することにより試みたが、足関節の駆動パタ
ーンはθｙに単独に依存しているわけではなく、また膝
関節の駆動パターンは遊脚足関節軌道のみに依存してい
るわけでもないので、θｙ軌道や遊脚足関節軌道を一度
修正するだけでは足関節駆動パターンや膝関節駆動パタ
ーンが充分に改善されない場合がある。さらに、θｙを
修正した影響は膝関節の駆動パターンにも、また遊脚足
関節軌道を修正した影響は足関節軌道パターンにも及ぶ
ので一旦、Ｓ２０８又はＳ２１２のどちらかの判定条件
を満足したとしても、他方の条件を満足させるために行
なった修正によって一旦は満足したほうの条件に再び適
合しなくなる場合がないとはいえないからである。その
ためにＳ２０２に戻り、Ｓ２０８，Ｓ２１２の判定条件
を満足するまでループをまわり歩容パラメータの修正を
行なう必要があるのである。Here, S210 and S220 to S202
The reason for returning to is described. In S210, the drive pattern of the ankle joint is improved by correcting the θy trajectory. In S220, the drive pattern of the knee joint is improved by the intersection coordinate trajectory (Ax, Ay, A) of the free leg ankles 18, 20R (L).
Tried by correcting z), the drive pattern of the ankle joint does not depend solely on θy, and the drive pattern of the knee joint does not depend solely on the swing leg ankle trajectory. Therefore, once the θy trajectory and the swing leg ankle trajectory are corrected only once, the ankle joint drive pattern and the knee joint drive pattern may not be sufficiently improved. Further, since the effect of correcting θy affects the drive pattern of the knee joint and the effect of correcting the swing leg ankle trajectory also affects the ankle trajectory pattern, it is assumed that the determination condition of either S208 or S212 is once satisfied. This is because it cannot be said that there is no case where the condition once satisfied is not again satisfied by the correction made to satisfy the other condition. For that reason, it is necessary to return to S202 and go around the loop to correct the gait parameters until the determination conditions of S208 and S212 are satisfied.
【００４１】以上述べた遊脚軌道の最適化処理について
まとめると、即ち、初期設定された遊脚軌道から得られ
る足（膝）関節の角加速度は実際には図１７、図１８に
示す様に無駄が多いものであるが、かかる処理を繰り返
すことにより遊脚期間中の足関節及び膝関節の負荷を必
要最小限度になる様に適正に修正することができる。ま
た、先に述べた様に、関節駆動パターンを歩容を決定す
るための遊脚足関節の位置、遊脚足平の回転角度や他の
変数に従属させて決定すると、その角加速度、角速度の
ピーク値が大きくなる場合が生じ得ることから、この制
御においては関節の駆動パターンを主変数として取り上
げ、遊脚足関節の位置、遊脚足平の回転角度を従属変数
とし、関節の駆動パターンを陽に設定する如くした。以
上から、関節を駆動するアクチュエータの負荷を軽減す
ることができ、小型軽量化を実現することができる。ま
た、無駄な動作はなくなるので、不必要なエネルギ消費
も避けることができる。さらに、ロボット全体の運動が
滑らかになるので、脚部リンクを振ることによって発生
する反力も最小限となり、安定性に優れ、人間の作業動
作環境への適応性が高い歩行を実現することができる。To summarize the above-described optimization processing of the free leg trajectory, that is, the angular acceleration of the foot (knee) joint obtained from the initially set free leg trajectory is actually as shown in FIGS. Although it is wasteful, by repeating such processing, it is possible to properly correct the load on the ankle joint and the knee joint during the idle leg period so that it becomes the minimum necessary. Also, as described above, when the joint drive pattern is determined depending on the position of the swing leg ankle for determining the gait, the rotation angle of the swing leg foot, and other variables, the angular acceleration and angular velocity are determined. In this control, the drive value of the joint is taken as the main variable, and the position of the swing leg ankle and the rotation angle of the swing foot are taken as the dependent variables in this control. Was set positively. As described above, the load on the actuator that drives the joint can be reduced, and the size and weight can be reduced. In addition, since unnecessary operation is eliminated, unnecessary energy consumption can be avoided. Furthermore, since the motion of the entire robot becomes smooth, the reaction force generated by swinging the leg link is minimized, and it is possible to realize walking that is excellent in stability and highly adaptable to the human working environment. .
【００４２】図１６のＳ２１０とＳ２２０の両方の判定
条件を満足したときには遊脚軌道の最適化処理ルーチン
から抜け出して図３のＳ２６へと続く。図３のＳ２６で
は姿勢決定パラメータのである重心の前後、左右方向の
軌道（Ｇｘ，Ｇｙ）を算出する。即ち、Ｇｘ，Ｇｙ軌道
はこれまでの手順において設定された他の姿勢決定パラ
メータの軌道とＳ１６で設定されたｚｍｐ軌道を満足す
るよう算出される。When both the determination conditions in S210 and S220 in FIG. 16 are satisfied, the process exits from the idle leg trajectory optimization processing routine and continues to S26 in FIG. In S26 of FIG. 3, the trajectories (Gx, Gy) in the front, rear, left and right directions of the center of gravity, which are the posture determination parameters, are calculated. That is, the Gx and Gy trajectories are calculated so as to satisfy the trajectories of the other posture determination parameters set in the previous procedure and the zmp trajectory set in S16.
【００４３】図３フロー・チャートにおいては続いてＳ
２８で遊脚軌道が最適条件（図１６のＳ２０８，Ｓ２１
２と同じ）を満足しているかどうかチェックする。この
チェックが必要な理由について述べると、Ｓ２４で最適
化された遊脚軌道（Ａｘ，Ａｙ，Ａｚ，θｘ，θｙ，θ
ｚ）はその時点において設定されていたほかの姿勢決定
パラメータの軌道を前提条件としていたが、その内のＧ
ｘ，Ｇｙ軌道がＳ２６において修正されたために遊脚軌
道の最適条件を満足しなくなることがあるからである。
もし、この最適条件を満足していない場合はＳ２４に戻
り再び遊脚軌道の最適化を行なう。しかしここで、Ｇ
ｘ，Ｇｙ軌道を修正しても、それが遊脚軌道の最適性、
即ちここでは足関節および膝関節の駆動パターン、に与
える影響は小さいので、Ｓ２４→Ｓ２６→Ｓ２８→Ｓ２
４を巡るループは数回のうちに収束する。Ｓ２８の判定
条件を満足したならばＳ３０に進む。In the flow chart of FIG.
At 28, the free leg trajectory is optimized (S208, S21 in FIG. 16).
2)). The reason why this check is necessary is as follows. The free leg trajectory (Ax, Ay, Az, θx, θy, θy) optimized in S24
z) presupposes the trajectory of the other posture determination parameters set at that time, but G in that
This is because the x, Gy trajectory is modified in S26, so that the optimum condition of the free leg trajectory may not be satisfied.
If this optimum condition is not satisfied, the flow returns to S24 to optimize the free leg trajectory again. But here, G
Even if the x, Gy trajectory is modified, it is
That is, here, the influence on the driving patterns of the ankle and knee joints is small, so that S24 → S26 → S28 → S2
The loop around 4 converges within a few times. If the determination condition of S28 is satisfied, the process proceeds to S30.
【００４４】Ｓ３０ではＳ２８で遊脚軌道の最適性をチ
ェックしたことと同様の理由からＳ２２で最適化した際
の条件、より具体的には、Ｓ１０６で与えたはずの所定
の余裕Ｇｚ.margin が確保されているかどうかのチェッ
クを行なう。Ｓ２２では最適化の条件として、他にも最
大加速度、最大速度の制約も与えたが、Ｇｚ軌道は姿勢
決定パラメータとなっているためこれらの条件に変化は
ないからである。所定の余裕Ｇｚ.margin が確保されて
いるかどうかのチェックを行なう必要がある理由は、Ｓ
２２で最適化されたＧｚ軌道はその時点において設定さ
れていた姿勢決定パラメータの軌道を前提条件として探
索されたＧｚ.lim軌道に対してＧｚ.margin が与えられ
ていたが、Ｓ２２からＳ３０にいたる過程で遊脚軌道、
並びにＧｘ，Ｇｙ軌道に修正が加えられ前提条件が変わ
り、それに伴ってＧｚ.lim軌道も変化している場合が考
えられるためである。この条件が満足されていない場合
にはＳ２２へと戻って、再びＧｚ軌道の最適化を行な
う。この、Ｓ２４→Ｓ２６→Ｓ２８→Ｓ２４のループを
含むＳ２２・・・Ｓ３０→Ｓ２２を巡るループもＳ２４
→Ｓ２６→Ｓ２８→Ｓ２４のループでの修正がＧｚ.lim
軌道に与える影響は小さいので数回のうちに収束する。
これで歩容、即ち、姿勢決定パラメータの軌道全ての設
定が終了する。In S30, the condition at the time of optimization in S22, more specifically, the predetermined margin Gz.margin which should have been given in S106 is the same as the reason for checking the optimality of the swing leg trajectory in S28. Check if it is secured. In S22, other constraints on the maximum acceleration and the maximum speed are also given as optimization conditions, but these conditions do not change because the Gz trajectory is a posture determination parameter. The reason why it is necessary to check whether a predetermined margin Gz.margin is secured is as follows:
In the Gz trajectory optimized in 22, the Gz.margin is given to the Gz.lim trajectory searched on the premise of the trajectory of the posture determination parameter set at that time, but from S22 to S30. Swing path in the process,
In addition, the Gx.Gy trajectory may be modified and the precondition may be changed, and accordingly, the Gz.lim trajectory may also be changed. If this condition is not satisfied, the process returns to S22, where the Gz trajectory is optimized again. This loop including S24 → S26 → S28 → S24 includes S22... S30 → S22.
Correction in the loop of → S26 → S28 → S24 is Gz.lim
Since the influence on the orbit is small, it converges within several times.
This completes the setting of the gait, that is, all the trajectories of the posture determination parameters.
【００４５】上記の如くして重心軌道、遊脚軌道を含む
ロボットの全ての目標姿勢が時系列に決定される。As described above, all the target postures of the robot, including the center of gravity trajectory and the free leg trajectory, are determined in time series.
【００４６】続いて、図２０フロー・チャートを参照し
て歩行時の制御について説明する。先ずＳ３００でイニ
シャライズした後、Ｓ３０２で歩行終了ではないことを
確認してＳ３０４に進み、そこでタイマ割り込みを待っ
て時刻ｔ＝ｎとする。続いてＳ３０６に進んで図３フロ
ー・チャートに示した手順で設定された目標軌道を読み
出し、Ｓ３０８に進んで時刻ｔにおける関節駆動パター
ンに変換し、Ｓ３１０に進んで各関節がその駆動パター
ンになる様にモータの指令値を決定し、Ｓ３１２で時刻
をタイマ割り込み間隔に等しいΔｎだけ更新し、Ｓ３０
２を経てＳ３０４に戻って更新時刻のタイマ割り込みを
待機する。そして、割り込みがあったときは更新時刻に
ついて同様の処理を行い、以下、Ｓ３０２で歩行終了と
判断されない限り継続し、Ｓ３０２で歩行終了と判断さ
れるときはＳ３１４に進んで必要な後処理をして終わ
る。Next, control during walking will be described with reference to the flowchart of FIG. First, after initialization is performed in S300, it is confirmed that the walking has not been completed in S302, and the process proceeds to S304, where a timer interrupt is waited, and time t = n. Subsequently, the process proceeds to S306, in which the target trajectory set in the procedure shown in the flowchart of FIG. 3 is read out, the process proceeds to S308, and converted into the joint drive pattern at time t, and the process proceeds to S310, where each joint becomes the drive pattern. determining a command value of the motor so as, time, and updates only the equivalent delta n in the timer interrupt interval in S312, S30
After step 2, the process returns to step S304 to wait for a timer interrupt at the update time. Then, when there is an interrupt, the same processing is performed for the update time. Thereafter, the processing is continued unless it is determined that the walking is completed in S302, and if it is determined that the walking is completed in S302, the process proceeds to S314 to perform necessary post-processing. Ends.
【００４７】この実施例は上記の如く、予め設定する歩
行パターンを関節角度ではなく、重心軌道、遊脚軌道な
どのロボットの姿勢で設定したので、脚式移動ロボット
の目標歩容を正確に表現することができる。さらに、重
心軌道については重心位置を大きく変えることなく、そ
の重力方向の加速度の最大値を０．２ｇ〜０．７ｇ以下
に抑制し、あるいはその重力方向の加速度の最大値をそ
の実効値の１１０％以下に抑制し、遊脚軌道についても
足関節と膝関節の角加速度をそれぞれ適宜設定する許容
値以下となる様に抑制したので、関節にかかる負荷を効
果的に低減して関節駆動系の小型軽量化、消費エネルギ
の低減化を図ることができる。さらに、これらの軌道が
滑らかで無駄のないものとなって関節の加減速トルクも
低減できて関節にかかる負荷をその意味からも低減する
ことができると共に、歩行安定性も増して人間の作業動
作環境への適応性を向上させることができる。In this embodiment, as described above, since the preset walking pattern is set not by the joint angle but by the posture of the robot such as the center of gravity trajectory or the swing leg trajectory, the target gait of the legged mobile robot is accurately expressed. can do. Further, with respect to the center of gravity trajectory, the maximum value of the acceleration in the direction of gravity is suppressed to 0.2 g to 0.7 g or less without significantly changing the position of the center of gravity, or the maximum value of the acceleration in the direction of gravity is reduced to 110% of its effective value. %, And the swing leg trajectory is also suppressed so that the angular accelerations of the ankle joint and the knee joint are respectively set to be equal to or less than the allowable values that are appropriately set. The size and weight can be reduced, and energy consumption can be reduced. Furthermore, these trajectories are smooth and lean, and the acceleration and deceleration torque of the joints can be reduced, so that the load on the joints can be reduced in that sense. The adaptability to the environment can be improved.
【００４８】またｚｍｐの概念を導入してｚｍｐが所定
の軌跡を辿る様に重心軌道を設定する様にしたことか
ら、常に安定した歩行を確保することができる。また貨
物を積載して歩行するときも、貨物を回転させない歩容
に設定してｚｍｐが所定の軌跡を辿る様に重心軌道を設
定する様にしたことから、貨物を積載するときも常に安
定した歩行を実現することができ、さらには貨物を落下
させるなどの不都合を生じることがない。Also, since the concept of zmp is introduced to set the center of gravity trajectory so that zmp follows a predetermined trajectory, stable walking can always be ensured. Also, when walking while loading cargo, the gait is set so that the cargo does not rotate, and the center of gravity trajectory is set so that zmp follows a predetermined trajectory, so it is always stable when loading cargo. Walking can be realized, and there is no inconvenience such as dropping cargo.
【００４９】尚、上記において基体の上面に貨物を積載
する様にしたが、それに限られるものではなく、脚部リ
ンクなどに積載個所を設けても良い。要は、貨物積載部
位リンク系のイナーシャを無視できる様にすれば良い。
またｘ，ｙ，ｚ軸まわりの回転角速度ωｘ，ωｙ，ωｚ
を全て零または実質的に無視できる程度の大きさとした
が、それに限られるものではなく、任意の１軸または２
軸まわりの回転角速度のみを零または実質的に無視でき
る程度の大きさとして、歩容設計の自由度を考慮しつ
つ、貨物のイナーシャの測定作業、及び演算量を低減さ
せても良い。また回転角度を用いたが、回転角速度、角
加速度を用いても良い。In the above description, the cargo is loaded on the upper surface of the base. However, the present invention is not limited to this, and a loading point may be provided on a leg link or the like. The point is that the inertia of the link system of the cargo loading part can be ignored.
Further, the rotational angular velocities ωx, ωy, ωz around the x, y, z axes
Are all zero or substantially negligible, but are not limited to this.
The rotational angular velocity around the axis alone may be set to zero or substantially negligible, and the work of measuring the inertia of the cargo and the amount of calculation may be reduced while considering the degree of freedom in gait design. Although the rotation angle is used, a rotation angular velocity and an angular acceleration may be used.
【００５０】尚、上記においてはｚｍｐを用いたが、ロ
ボットの移動速度が低速度のときは動的な成分であるロ
ボットの重心に働く慣性力、及び各リンクのイナーシャ
と角加速度により発生する慣性力を無視しても実質的に
安定性が低下することは無いので、ｚｍｐに代えて、こ
れと実質的に等価であるところのロボットの接地面への
重心の投影点を用いても良い。また、ロボットの全質量
に対する脚部リンクの質量の割合が非常に小さいとき、
あるいは脚部リンクのイナーシャが非常に小さいとき
は、同様の理由により、ｚｍｐに代えて、ロボットの重
心に作用する重力と慣性力のみの合力と接地面との交点
を用いても良い。Although zmp is used in the above description, when the moving speed of the robot is low, the inertia force acting on the center of gravity of the robot, which is a dynamic component, and the inertia generated by the inertia and angular acceleration of each link. Since the stability does not substantially decrease even if the force is ignored, the point of projection of the center of gravity on the ground surface of the robot, which is substantially equivalent to zmp, may be used instead of zmp. Also, when the ratio of the mass of the leg link to the total mass of the robot is very small,
Alternatively, when the inertia of the leg link is very small, for the same reason, instead of zmp, the intersection of the resultant force of only gravity and inertia force acting on the center of gravity of the robot and the ground contact surface may be used.
【００５１】尚、上記の遊脚軌道の最適化においては、
膝関節及び足関節の関節角速度、角加速度の絶対値の最
大値が所定値を超えない様に構成したが、それに限られ
るものではなく、各関節角度の動作範囲の最大値が所定
値を超えない様に構成しても良く、また各関節に作用す
る負荷を直接検出し、その絶対値の最大値が所定値を超
えない様にしても良い。さらにこれらにおいて、実効値
を参照する様に構成しても良く、あるいは絶対値の最大
値または実効値が減少する様に構成しても良い。また、
この遊脚軌道の最適化の手法は、遊脚だけでなく支持脚
にも妥当するものである。In the above-mentioned optimization of the swing leg trajectory,
The maximum values of the absolute values of the joint angular velocity and the angular acceleration of the knee joint and the ankle joint are configured not to exceed the predetermined values.However, the present invention is not limited thereto, and the maximum value of the operation range of each joint angle may exceed the predetermined value. Alternatively, the load acting on each joint may be directly detected and the maximum absolute value may not exceed a predetermined value. Further, in these, the configuration may be such that the effective value is referred to, or the maximum absolute value or the effective value may be reduced. Also,
This method of optimizing the free leg trajectory is appropriate not only for the free leg but also for the support leg.
【００５２】尚、上記において重心の位置を用いてきた
が、重心位置に代えてこれと実質的に置換可能な部位の
位置、例えば腰の位置（左右の腰関節の中点）を用いて
も良い。即ち、図４で示したロボット１の場合には、歩
行中に取られる全ての姿勢において重心位置が大きく変
化することはなく、およそ腰の位置にあるので、腰の位
置を用いることによっても本制御の目的を達成し得るか
らである。この様に、力学的な計算が必要となる重心位
置に代え単に幾何学的な計算のみにより求めることので
きる腰の位置を用いることにより、演算量を低減するこ
とが可能となる。Although the position of the center of gravity has been used in the above description, a position of a part which can be substantially replaced with the position of the center of gravity, for example, a waist position (the middle point of the right and left hip joints) may be used instead of the position of the center of gravity. good. That is, in the case of the robot 1 shown in FIG. 4, the position of the center of gravity does not greatly change in all the postures taken during walking, and is approximately at the waist position. This is because the purpose of control can be achieved. As described above, the amount of calculation can be reduced by using the waist position, which can be obtained only by a geometric calculation, instead of the center of gravity, which requires a mechanical calculation.
【００５３】尚、上記において脚式移動ロボットの脚部
リンクについて説明してきたが、この発明は腕部リンク
についても妥当するものであり、例えばリンク式ロボッ
トが脚部リンクで路面を歩行しつつ腕部リンクで壁に寄
り掛かりながら移動する場合や、脚部リンクと共に腕部
リンクをも路面に接地させつつ移動する場合、さらには
腕部リンクのみにより、天井からの突起物にぶら下がり
ながら空間を移動する様な場合などにも妥当するもので
ある。Although the leg link of the legged mobile robot has been described above, the present invention is also applicable to the arm link. For example, the link type robot can use the leg link to walk on the road surface and arm. When moving while leaning against the wall with the arm link, or moving the arm link together with the leg link while touching the road surface, furthermore, using only the arm link, move in the space while hanging on the protrusion from the ceiling This is also appropriate in the case where it is necessary to do so.
【００５４】尚、この発明を２足歩行の脚式移動ロボッ
トを例にとって説明してきたが、それに限られるもので
はなく、３足以上の脚式移動ロボットにも妥当するもの
である。Although the present invention has been described with reference to a bipedal legged mobile robot as an example, the present invention is not limited to this and is applicable to a legged mobile robot having three or more legs.
【００５５】[0055]
【発明の効果】請求項１項にあっては、脚部および／ま
たは腕部リンクを有し、アクチュエータで駆動されて移
動するリンク式移動ロボットの制御装置において、前記
ロボットの姿勢又は姿勢の時系列に関する姿勢目標値を
設定する目標値設定手段、前記姿勢又は姿勢の時系列に
関する姿勢目標値にしたがって、前記アクチュエータの
目標操作量を決定する目標操作量決定手段、及び前記目
標操作量となるように前記アクチュエータを動作させる
アクチュエータ制御手段、を備えると共に、前記ロボッ
トに貨物を積載して運搬するとき、前記姿勢目標値を前
記貨物の任意の回転軸まわりの回転角速度が実質的に零
または所定の値より小さくなるように設定するように構
成したので、前記リンク式移動ロボットは段差や階段を
含む環境や、さらには不整地などの環境でも荷物を運搬
することができるようになる。この段差や階段などがあ
っても移動できるリンク式のロボットによって荷物の搬
送を行うことにより、作業環境をロボットのために整備
する必要から解放することが達成できる。従って、環境
の整備が困難な既存の設備においても容易にロボットの
導入が行えるようになる。さらに、前記リンク式移動ロ
ボットは室内のみならず、屋外や、さらには不整地など
を移動することも可能なので、例えば山小屋へ荷物を運
搬する場合など、車両では運搬できない山道などの部分
は人間が荷物を背負って運搬していたが、この部分を人
間に替わって機械で運搬することができるようになるの
で、人間を重労働から解放することができる。また、移
動（歩行）の安定性を考慮するうえで、荷物のイナーシ
ャが関与する項を無視できる。その結果、演算量の縮小
が達成されると共に荷物のイナーシャを測定する必要が
なくなる。 According to the first aspect, the leg portion and / or the leg portion are provided.
Other has arms link, transfer is driven by an actuator
The control device of the link type mobile robot for moving, the target value setting means for setting the orientation target values for the time series of the attitude or posture of the robot, according to the posture target value relating to the time series of the posture or attitude, before Kia actuator target manipulated variable determining means for determining a target operation variables, and Ru is operated said actuator such that said target manipulated variable
Both the actuator control means, Ru wherein the robot
When loading and transporting cargo on the
The angular velocity of the cargo about any axis of rotation is substantially zero
Or and then, it is set a predetermined value so than decreases, the link-type mobile robot and the environment, including a step or stairs, more will be able to carry loads even in an environment such as rough terrain. By carrying the luggage by a link-type robot that can move even if there are steps or stairs, the work environment can be relieved from having to be maintained for the robot. Therefore, it allows the easy introduction of the robot in difficult existing facilities development environment. Furthermore, the link type mobile robot is not room only, outdoors or, more so also be possible to move like rough terrain, for example, when carrying luggage to hut, parts such as mountain roads that can not be transported in a vehicle humans It used to carry luggage, but this part can now be transported by machine instead of humans, freeing people from heavy labor. Also,
In consideration of the stability of movement (walking),
Ignore terms involving keyers. As a result, the amount of computation is reduced
Must be measured and the inertia of the luggage needs to be measured
Disappears.
【００５６】請求項２項にあっては、脚部および／また
は腕部リンクを有し、アクチュエータで駆動されて移動
するリンク式移動ロボットの制御装置において、前記ロ
ボットの姿勢又は姿勢の時系列に関する姿勢目標値を設
定する目標値設定手段、前記姿勢又は姿勢の時系列に関
する姿勢目標値にしたがって、前記アクチュエータの目
標操作量を決定する目標操作量決定手段、及び前記目標
操作量となるように前記アクチュエータを動作させるア
クチュエータ制御手段、を備えると共に、前記ロボット
に貨物を積載して運搬するとき、前記貨物を積載する部
位の任意の回転軸まわりの回転運動に関係する前記姿勢
目標値を、前記部位の任意の回転軸まわりの回転角速度
が実質的に零または所定の値より小さくなるように設定
するように構成したので、請求項１項と同様に、前記リ
ンク式移動ロボットは段差や階段を含む環境や、さらに
は不整地などの環境でも荷物を運搬することができるよ
うになる。この段差や階段などがあっても移動できるリ
ンク式のロボットによって荷物の搬送を行うことによ
り、作業環境をロボットのために整備する必要から解放
することが達成できる。従って、環境の整備が困難な既
存の設備においても容易にロボットの導入が行えるよう
になる。さらに、前記リンク式移動ロボットは室内のみ
ならず、屋外や、さらには不整地などを移動することも
可能なので、例えば山小屋へ荷物を運搬する場合など、
車両では運搬できない山道などの部分は人間が荷物を背
負って運搬していたが、この部分を人間に替わって機械
で運搬することができるようになるので、人間を重労働
から解放することができる。また、直接に荷物の回転を
考慮することなく、より簡単に演算量の縮小を達成でき
る。 According to the second aspect, the legs and / or
Has an arm link and is driven by an actuator to move
In the control device of the link type mobile robot,
Set the posture target value for the bot posture or time series of posture.
Target value setting means to determine the posture or the time series of the posture.
Of the actuator according to the posture target value
Target manipulated variable determining means for determining a target manipulated variable, and the target
An actuator for operating the actuator so as to obtain the operation amount.
A robot comprising: a actuator;
When loading and transporting cargo on the
Said position relating to the rotational movement of the position about an arbitrary axis of rotation
Set the target value to the angular velocity of rotation of the part around an arbitrary rotation axis.
Set to be substantially zero or less than a given value
And then, is, as with claim 1 wherein, said Li
Linked mobile robots can be used in environments that include steps and stairs,
Can carry luggage even on rough terrain
Swell. This can be moved even if there are steps or stairs.
Transporting luggage using a robot
Eliminates the need to maintain work environments for robots
Can be achieved. Therefore, it is difficult to improve the environment.
Easy installation of robots in existing facilities
become. Furthermore, the link type mobile robot is only for indoor use.
It is also possible to move outdoors or even on uneven terrain
It is possible, for example, when transporting luggage to a mountain hut,
In areas such as mountain roads that cannot be transported by vehicle, humans can
It was carried by carrying, but this part was replaced by a human
Can be transported by a human
Can be released from In addition, the rotation of luggage directly
You can more easily reduce the amount of computation without considering
You.
【００５７】[0057]
【図１】この発明に係る脚式移動ロボットの歩行制御装
置を全体的に示す概略図である。FIG. 1 is a schematic view showing the entire walking control device of a legged mobile robot according to the present invention.
【図２】図１に示す 制御ユニットの説明ブロック図で
ある。FIG. 2 is an explanatory block diagram of a control unit shown in FIG.
【図３】本制御装置の関節駆動制御で使用する歩行パタ
ーン（目標軌道）の設定作業を示すフロー・チャートで
ある。FIG. 3 is a flowchart showing a setting operation of a walking pattern (target trajectory) used in joint drive control of the control device.
【図４】図３フロー・チャートで使用する１２個のパラ
メータを示す説明図である。FIG. 4 is an explanatory diagram showing 12 parameters used in the flowchart of FIG. 3;
【図５】図１のロボットに作用する路面反力を示す説明
図である。FIG. 5 is an explanatory diagram showing a road surface reaction force acting on the robot of FIG. 1;
【図６】図１のロボットについて角運動量の法則を適用
する場合の説明図である。FIG. 6 is an explanatory diagram in a case where the law of angular momentum is applied to the robot of FIG. 1;
【図７】この制御における離床の瞬間のｚｍｐの位置を
示す説明図である。FIG. 7 is an explanatory diagram showing the position of zmp at the moment of leaving the bed in this control.
【図８】この制御における着地の瞬間のｚｍｐの位置を
示す説明図である。FIG. 8 is an explanatory diagram showing the position of zmp at the moment of landing in this control.
【図９】この制御におけるｚｍｐ軌跡を歩行中に上方か
ら見た説明図である。FIG. 9 is an explanatory diagram of the zmp locus in this control as viewed from above during walking.
【図１０】１歩行周期における重心の重力方向の位置、
その変位速度、その変位加速度の変化を示す波形図であ
る。FIG. 10 shows the position of the center of gravity in the direction of gravity in one walking cycle,
It is a waveform diagram which shows the change of the displacement speed and the displacement acceleration.
【図１１】図１に示すロボット１に作用する外力による
負荷（関節保持トルク）を示す説明図である。11 is an explanatory diagram showing a load (joint holding torque) due to an external force acting on the robot 1 shown in FIG.
【図１２】図３フロー・チャートのＧｚ軌道の最適化作
業を示すサブルーチン・フロー・チャートである。FIG. 12 is a subroutine flowchart showing an operation of optimizing a Gz trajectory in the flowchart of FIG. 3;
【図１３】図１に示すロボット１の膝関節が比較的大き
く曲がった状態を示す説明図である。FIG. 13 is an explanatory diagram showing a state where the knee joint of the robot 1 shown in FIG. 1 is bent relatively large.
【図１４】図１に示すロボット１の膝関節が比較的大き
く伸びた状態を示す説明図である。FIG. 14 is an explanatory diagram showing a state where the knee joint of the robot 1 shown in FIG. 1 has been relatively extended.
【図１５】図１３と図１４における重心の重力方向の変
位と膝関節曲げ角度との関係を示す説明図である。FIG. 15 is an explanatory diagram showing the relationship between the displacement of the center of gravity in the direction of gravity and the knee joint bending angle in FIGS. 13 and 14;
【図１６】図３フロー・チャートの遊脚軌道の最適化作
業を示す説明図である。FIG. 16 is an explanatory diagram showing a work of optimizing a free leg trajectory in the flow chart of FIG. 3;
【図１７】左半分に歩容パラメータである遊脚足平のｙ
軸まわりの回転角度（θｙ）の、右半分に歩容パラメー
タから計算された足関節角度の歩行の１周期における角
度、角速度、角加速度の変化を示す波形図である。FIG. 17 shows the gait parameter y of the free leg foot in the left half.
It is a waveform diagram which shows the change of the angle, angular velocity, and angular acceleration in one cycle of the walking of the ankle angle calculated from the gait parameter in the right half of the rotation angle (θy) about the axis.
【図１８】歩容パラメータから計算された歩行の１周期
における膝関節の角度、角速度、角加速度の変化を示す
波形図である。FIG. 18 is a waveform diagram showing changes in the angle, angular velocity, and angular acceleration of a knee joint in one cycle of walking calculated from gait parameters.
【図１９】遊脚軌道の最適化の様子を表す、図１に示す
ロボットを側面から見た説明図である。FIG. 19 is an explanatory diagram showing a state of optimizing a free leg trajectory when the robot shown in FIG. 1 is viewed from a side.
【図２０】図２の制御ユニットが行う関節駆動制御を示
すフロー・チャートである。FIG. 20 is a flowchart showing joint drive control performed by the control unit of FIG. 2;
１ 脚式移動ロボット（２足歩行ロボ
ット） ２ 脚部リンク １０Ｒ，１０Ｌ 脚部回旋用の関節 １２Ｒ，１２Ｌ 股部のロール方向の関節 １４Ｒ，１４Ｌ 股部のピッチ方向の関節 １６Ｒ，１６Ｌ 膝部のピッチ方向の関節 １８Ｒ，１８Ｌ 足首部のピッチ方向の関節 ２０Ｒ，２０Ｌ 足首部のロール方向の関節 ２２Ｒ，２２Ｌ 足平（足部） ２４ 筐体 ２６ 制御ユニット ２８ ルーフキャリア ３０ 貨物 ３６ ６軸力センサReference Signs List 1 legged mobile robot (bipedal walking robot) 2 leg link 10R, 10L leg rotation joint 12R, 12L crotch roll direction joint 14R, 14L crotch pitch direction joint 16R, 16L knee joint Joints in the pitch direction 18R, 18L Joints in the pitch direction of the ankle 20R, 20L Joints in the roll direction of the ankle 22R, 22L Foot (foot) 24 Housing 26 Control unit 28 Roof carrier 30 Cargo 36 Six-axis force sensor
Claims (2)
アクチュエータで駆動されて移動するリンク式移動ロボ
ットの制御装置において、 ａ．前記ロボットの姿勢又は姿勢の時系列に関する姿勢
目標値を設定する目標値設定手段、 ｂ．前記姿勢又は姿勢の時系列に関する姿勢目標値にし
たがって、前記アクチュエータの目標操作量を決定する
目標操作量決定手段、 及び ｃ．前記目標操作量となるように前記アクチュエータを
動作させるアクチュエー タ制御手段、を 備えると共に、前記ロボットに貨物を積載して運搬す
るとき、前記姿勢目標値を前記貨物の任意の回転軸まわ
りの回転角速度が実質的に零または所定の値より小さく
なるように設定することを特徴とするリンク式移動ロボ
ットの制御装置。1. A has a leg and / or arm portion link,
A control device for a link type mobile robot driven and moved by an actuator , comprising: a. Target value setting means for setting a target value relating to the posture of the robot or a time series of the posture ; b. The following orientation desired values for the time series of the attitude or orientation, the target manipulated variable determining means for determining a target operation amount before Kia actuator, and c. Said actuator such that said target manipulated variable
Actuator control means for Ru is operated, provided with a, to transfer by cargoes to the robot
When the attitude target value is turned around an arbitrary rotation axis of the cargo,
Is substantially zero or less than a predetermined value.
A control device for a link-type mobile robot, wherein the control device is set to be as follows.
アクチュエータで駆動されて移動するリンク式移動ロボ
ットの制御装置において、 ａ．前記ロボットの姿勢又は姿勢の時系列に関する姿勢
目標値を設定する姿勢目 標値設定手段、 ｂ．前記姿勢又は姿勢の時系列に関する姿勢目標値にし
たがって、前記アクチュ エータの目標操作量を決定する
目標操作量決定手段、 及び ｃ．前記目標操作量となるように前記アクチュエータを
動作させるアクチュエー タ制御手段、 を備えると共に、前記ロボットに 貨物を積載して運搬す
るとき、前記貨物を積載する部位の任意の回転軸まわり
の回転運動に関係する前記姿勢目標値を、前記部位の任
意の回転軸まわりの回転角速度が実質的に零または所定
の値より小さくなるように設定することを特徴とするリ
ンク式移動ロボットの制御装置。2. It has a leg and / or arm link,
Link type moving robot that moves by being driven by an actuator
In the control unit of the unit, a. The posture of the robot or the posture related to the time series of the posture
Attitude targets value setting means for setting a target value, b. The posture or the posture target value related to the time series of posture
Therefore, determining the target operation amount of the actuator
Target manipulated variable determining means; and c. The actuator so that the target operation amount is obtained.
Actuator control means for operating, provided with a, when the transfer by cargoes to the robot, the posture target value related to the rotational motion about an arbitrary axis of rotation of the portion for stacking the freight, of the site any rotational angular velocity around the rotational axis substantially zero or a predetermined value the control device features and to Brighter <br/> link type mobile robot set to as is made smaller.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP13626092A JP3168066B2 (en) | 1992-04-28 | 1992-04-28 | Control device for link type mobile robot |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP13626092A JP3168066B2 (en) | 1992-04-28 | 1992-04-28 | Control device for link type mobile robot |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JPH06170758A JPH06170758A (en) | 1994-06-21 |
| JP3168066B2 true JP3168066B2 (en) | 2001-05-21 |
Family
ID=15171030
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP13626092A Expired - Lifetime JP3168066B2 (en) | 1992-04-28 | 1992-04-28 | Control device for link type mobile robot |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP3168066B2 (en) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US9901111B2 (en) | 2011-07-07 | 2018-02-27 | Takasago International Corporation | Taste-improving peptide |
Families Citing this family (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP3677623B2 (en) * | 2000-09-11 | 2005-08-03 | 独立行政法人産業技術総合研究所 | Real-time optimal control method for legged robot |
| KR100541433B1 (en) | 2002-12-23 | 2006-01-11 | 삼성전자주식회사 | Walking Robot with Two Legs |
| CN104298243B (en) * | 2014-08-19 | 2017-02-15 | 北京理工大学 | Humanoid robot uneven ground walking stability control method |
| CN106585763B (en) * | 2016-12-26 | 2018-09-07 | 哈尔滨工业大学 | A kind of biped robot with flexible ankle-joint |
| JP7200990B2 (en) * | 2018-06-05 | 2023-01-10 | ソニーグループ株式会社 | Information processing device, information processing method and program |
-
1992
- 1992-04-28 JP JP13626092A patent/JP3168066B2/en not_active Expired - Lifetime
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US9901111B2 (en) | 2011-07-07 | 2018-02-27 | Takasago International Corporation | Taste-improving peptide |
Also Published As
| Publication number | Publication date |
|---|---|
| JPH06170758A (en) | 1994-06-21 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| EP1053835B1 (en) | Leg type mobile robot control apparatus | |
| US6289265B1 (en) | Controller for legged mobile robot | |
| EP1510302B1 (en) | Attitude control device of mobile robot | |
| JP3132156B2 (en) | Gait generator for legged mobile robot | |
| JP3167404B2 (en) | Robot joint drive controller | |
| EP0965416B1 (en) | Attitude controller of legged moving robot | |
| JP3629133B2 (en) | Control device for legged mobile robot | |
| JP3672426B2 (en) | Posture control device for legged mobile robot | |
| EP1291136A1 (en) | Floor shape deducing device for legged mobile robot | |
| EP1291137A1 (en) | Floor shape deducing device for legged mobile robot | |
| JP3167420B2 (en) | Walking control device for legged mobile robot | |
| JP3168066B2 (en) | Control device for link type mobile robot | |
| JP3629143B2 (en) | Control device for legged mobile robot | |
| JP3167406B2 (en) | Walking control device for legged mobile robot | |
| JP3055737B2 (en) | Walking control device for legged mobile robot | |
| JPH05305581A (en) | Control device for link type mobile robot | |
| JP3024028B2 (en) | Walking control device for legged mobile robot | |
| JP3024023B2 (en) | Walking control device for legged mobile robot | |
| JP3183558B2 (en) | Control device for link type mobile robot | |
| JP3183557B2 (en) | Walking control device for legged mobile robot | |
| JPH06170757A (en) | Control device for link type mobile robot | |
| JP3167407B2 (en) | Walking control device for legged mobile robot | |
| JPH05253867A (en) | Walk control device for leg type moving robot | |
| JP4237130B2 (en) | Control device for legged mobile robot | |
| JPH06182679A (en) | Control device for link type robot |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20010206 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20080309 Year of fee payment: 7 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20090309 Year of fee payment: 8 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100309 Year of fee payment: 9 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100309 Year of fee payment: 9 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110309 Year of fee payment: 10 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110309 Year of fee payment: 10 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120309 Year of fee payment: 11 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130309 Year of fee payment: 12 |
|
| EXPY | Cancellation because of completion of term | ||
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130309 Year of fee payment: 12 |