JP5040693B2 - Legged robot and control method thereof - Google Patents
Legged robot and control method thereof Download PDFInfo
- Publication number
- JP5040693B2 JP5040693B2 JP2008024125A JP2008024125A JP5040693B2 JP 5040693 B2 JP5040693 B2 JP 5040693B2 JP 2008024125 A JP2008024125 A JP 2008024125A JP 2008024125 A JP2008024125 A JP 2008024125A JP 5040693 B2 JP5040693 B2 JP 5040693B2
- Authority
- JP
- Japan
- Prior art keywords
- sole
- foot
- distance
- detection unit
- target
- 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 - Fee Related
Links
Images
Landscapes
- Toys (AREA)
- Manipulator (AREA)
Description
本発明は脚式ロボット、及びその制御方法に関する。 The present invention relates to a legged robot and a control method thereof.
近年、脚部の下端に足平部を設けたロボットにおいて、足平部の足裏を路面に倣わせる足裏倣い制御と、足平部から胴体への位置姿勢を目標の位置姿勢に維持する倒立制御とを組合せて、ロボットを安定して歩行させる技術が開発されている。 In recent years, in a robot with a foot part at the lower end of the leg part, foot imitation control that makes the foot part of the foot part follow the road surface, and the position and orientation from the foot part to the body are maintained at the target position and orientation. A technique for stably walking a robot in combination with an inverted control is developed.
このような脚式ロボットでは、まず、足平部の足裏部分を床面に接触させて支持脚とし、その後に足平の裏面で床面を押して脚部全体（ロボット全体）を持ち上げるように脚部を駆動することで、次の歩行動作を行う。駆動された脚部は遊脚となる一方、他の脚部が支持脚となり、このように、遊脚と支持脚を交互に繰り返して切替えることで、歩行動作を行うことができる。 In such a legged robot, firstly, the sole part of the foot part is brought into contact with the floor surface to be a supporting leg, and then the entire leg part (the entire robot) is lifted by pressing the floor surface on the back surface of the foot. The following walking motion is performed by driving the leg. The driven leg portion is a free leg, while the other leg portion is a support leg. Thus, a walking motion can be performed by alternately switching the free leg and the support leg.
脚式ロボットを転倒させずに安定して移動させるためには、支持脚期ではロボットの足裏を路面に密着させると共に、遊脚を着地させる際には、予期しない路面凹凸からの外乱力を抑制することが効果的である。このため、ロボットの足裏と路面との関係を目標どおりに制御することが重要となる。 In order to move the legged robot without falling down, the robot's soles are in close contact with the road surface during the supporting leg stage, and when landing the free leg, the disturbance force from unexpected road surface irregularities is applied. It is effective to suppress. For this reason, it is important to control the relationship between the soles of the robot and the road surface as intended.
従来、ロボットの足裏に距離センサを配置して、距離センサの出力値を目標値に追従させるように足裏を制御する技術が知られている。本出願人による出願（特願２００７−２７８１０７号）には、足裏に路面との距離を検出する距離センサを設け、距離センサの検出結果に基づく足裏倣い制御により歩行安定化を行う２足ロボットが開示されている。当該２足ロボットでは、足裏倣い制御と倒立制御を組合せて制御する際に、ロボットの転倒方向を検出して足裏倣い制御で使用する距離センサを適切に選択することにより、不整地においても足裏が路面に密着しつつ、転倒しているロボットを戻すのに効果的な床反力モーメントを得るものである。
しかしながら、本出願人による出願（特願２００７−２７８１０７号）に開示されるロボットでは、距離センサの故障を検知する手段を備えておらず、距離センサの故障に起因してロボットが転倒する虞があった。即ち、距離センサが故障した際に、故障した距離センサをそのまま用いて制御を行った場合には足裏を路面に密着させることができず、逆に、路面から離れた場所へと足裏を制御しようとするため、歩行が不安定となる。このため、足裏に設けられた距離センサが故障した際には、足裏倣い制御において、路面と足裏との関係を目標通りに制御することができず、結果として、床から意図しない反力を受けてロボットが転倒してしまうという問題がある。 However, the robot disclosed in the application by the present applicant (Japanese Patent Application No. 2007-278107) does not include means for detecting a failure of the distance sensor, and the robot may fall down due to the failure of the distance sensor. there were. That is, when the distance sensor fails, if the control is performed using the failed distance sensor as it is, the sole cannot be brought into close contact with the road surface, and conversely, the sole should be moved away from the road surface. Because it tries to control, walking becomes unstable. For this reason, when the distance sensor provided on the sole fails, the relationship between the road surface and the sole cannot be controlled as intended in the sole imitation control. There is a problem that the robot falls down due to the force.
他方、特許文献１には、距離センサの出力信号に変動が生じなかった場合に、距離センサに故障が生じているものと判定する自己診断機能付きロボットが開示されている。かかる特許文献１記載のロボットは、人を検知するための超音波距離センサを胸部に設けると共に、障害物や段差を検出する赤外線センサを脚部の前面に設け、これらセンサの故障をセンサの検出値に基づいて検知するものである。即ち、特許文献１記載のロボットは、足裏と路面との距離を検出する距離検出部の故障を検知して、正常な距離検出部の検出結果に基づいて歩容データを修正することで、路面と足裏との関係を目標通りに制御することを目的とするものではないため、足裏距離センサが故障した場合に、歩行の安定化を図るものではない。
On the other hand,
このように、従来の脚式ロボットによれば、距離センサの故障を検知することができないため歩行が不安定となり、ロボットが転倒する虞があるという問題があった。 As described above, according to the conventional legged robot, there is a problem in that walking is unstable because the failure of the distance sensor cannot be detected, and the robot may fall down.
本発明は、かかる課題を解決するためになされたものであり、距離センサの故障を検知して、安定して歩行が可能な脚式ロボット、及びその制御方法を提供することを目的とする。 The present invention has been made to solve such a problem, and an object thereof is to provide a legged robot capable of stably walking by detecting a failure of a distance sensor and a control method thereof.
本発明にかかる脚式ロボットは、胴体と、該胴体に連結された脚部と、該脚部の下端に設けられた足平部と、前記足平部の足裏と路面との距離を検出する距離検出部と、歩容データに基づいて前記脚部の関節を駆動制御する制御部と、を備えた脚式ロボットであって、前記制御部は、前記距離検出部の検出結果が基準範囲内に含まれない場合に、当該距離検出部の故障を検知する故障検知部と、故障していない正常な距離検出部の検出結果に基づいて、前記歩容データを修正する歩容データ修正部と、を備えるものである。 A legged robot according to the present invention detects a distance between a torso, a leg connected to the torso, a foot provided at a lower end of the leg, and a sole and a road surface of the foot. And a control unit that drives and controls the joints of the legs based on gait data, wherein the control unit detects that the detection result of the distance detection unit is a reference range. A gait data correcting unit that corrects the gait data based on a detection result of a normal distance detecting unit that is not out of order, and a failure detecting unit that detects a failure of the distance detecting unit when not included in Are provided.
このように距離検出部の検出結果が基準範囲内に含まれるか否かに応じてその故障を検知し、故障していない正常な距離検出部の検出結果に基づいて歩容データを修正することで、距離センサが故障した場合であっても、路面と足裏との関係を目標通りに制御することができ、安定して歩行することができる。 In this way, detecting the failure depending on whether or not the detection result of the distance detection unit is included in the reference range, and correcting the gait data based on the detection result of the normal distance detection unit that is not in failure Thus, even when the distance sensor is out of order, the relationship between the road surface and the sole can be controlled as desired, and the user can walk stably.
また、前記故障検知部は、前記脚部が遊脚期であって、前記距離検出部の検出値が前記基準範囲内に含まれない場合に、当該距離検出部の故障を検知するようにしてもよい。これにより、脚部が遊脚期である場合には、支持脚期の場合と比べて、距離検出部の検出値はその目標値近辺により安定して収束するため、距離検出部の検出値が基準範囲内に含まれるか否かに応じて距離検出部の故障を容易かつ正確に検知することができる。 In addition, the failure detection unit detects a failure of the distance detection unit when the leg portion is in the swing phase and the detection value of the distance detection unit is not included in the reference range. Also good. As a result, when the leg is in the free leg period, the detection value of the distance detection unit converges more stably near the target value than in the case of the support leg period. It is possible to easily and accurately detect a failure of the distance detection unit depending on whether or not it is included in the reference range.
さらにまた、前記基準範囲が、前記脚部が遊脚期であって、前記距離検出部の検出可能な最大値を含む所定の範囲であるようにしてもよい。これにより、脚部が遊脚期である場合には、距離検出部の検出値は、その検出可能な最大値近傍の値になるものと考えられるため、脚部が遊脚期である場合に、距離検出部が検出可能な最大値を含む所定の範囲を基準範囲とすることで、距離検出部の故障をより容易かつ正確に検知することができる。 Furthermore, the reference range may be a predetermined range including the maximum value that can be detected by the distance detection unit when the leg portion is in the swinging leg period. As a result, when the leg is in the swing phase, the detection value of the distance detection unit is considered to be a value near the maximum detectable value. By setting the predetermined range including the maximum value that can be detected by the distance detection unit as the reference range, a failure of the distance detection unit can be detected more easily and accurately.
また、前記制御部は、前記距離検出部の検出結果に基づいて、接地面から見た相対的な前記足平部の目標とする位置姿勢と実際の位置姿勢との偏差を計算し、前記歩容データ修正部は、当該偏差を小さくするように前記歩容データを修正するようにしてもよい。 Further, the control unit calculates a deviation between a target position / posture of the foot portion relative to the ground plane and an actual position / posture as viewed from the ground plane based on a detection result of the distance detection unit, and The content data correction unit may correct the gait data so as to reduce the deviation.
さらにまた、前記制御部は、前記故障検知部の検知結果に応じて、前記制御部による制御が継続可能であるか否かを判定する切替判定部を更に備え、前記歩容データ修正部は、前記切替判定部による判定の結果、前記制御部による制御が継続可能であると判定した場合に、故障していない正常な距離検出部を利用して、前記歩容データを修正するようにしてもよい。このように、距離検出部の故障検知結果に応じて制御の切替を行うことで、距離検出部が故障した際に、ロボットの制御をより迅速に安定化させることができる。 Furthermore, the control unit further includes a switching determination unit that determines whether the control by the control unit can be continued according to the detection result of the failure detection unit, and the gait data correction unit includes: As a result of the determination by the switching determination unit, when it is determined that the control by the control unit can be continued, the gait data may be corrected using a normal distance detection unit that is not malfunctioning. Good. Thus, by switching the control according to the failure detection result of the distance detection unit, the control of the robot can be stabilized more quickly when the distance detection unit fails.
また、前記胴体の姿勢を検出する胴体姿勢検出部を更に備え、前記制御部は、前記胴体姿勢検出部の検出結果に基づいて、前記胴体の目標とする姿勢と実際の姿勢との偏差を計算し、前記歩容データ修正部は、当該偏差を小さくするように前記歩容データを修正するようにしてもよい。 In addition, a fuselage posture detection unit that detects the posture of the fuselage is further provided, and the control unit calculates a deviation between a target posture of the fuselage and an actual posture based on a detection result of the fuselage posture detection unit. Then, the gait data correction unit may correct the gait data so as to reduce the deviation.
さらにまた、前記脚式ロボットの重心位置を検出する重心位置検出部を更に備え、前記制御部は、前記重心位置検出部の検出結果に基づいて、前記足平部を基準とした目標とする重心位置と実際の重心位置との偏差を計算し、前記歩容データ修正部は、当該偏差を小さくするように前記歩容データを修正するようにしてもよい。 Still further, a gravity center position detection unit that detects a gravity center position of the legged robot is further provided, and the control unit is configured to target a center of gravity based on the detection result of the gravity center position detection unit. The deviation between the position and the actual center-of-gravity position may be calculated, and the gait data correcting unit may correct the gait data so as to reduce the deviation.
また、前記距離検出部は、前記足平部の足裏に設けられた距離センサの出力信号から前記足平部の足裏と路面との距離を検出するようにしてもよい。 The distance detection unit may detect a distance between the sole of the foot and the road surface from an output signal of a distance sensor provided on the sole of the foot.
本発明にかかる脚式ロボットの制御方法は、胴体と、該胴体に連結された脚部と、該脚部の下端に設けられた足平部と、を備えた脚式ロボットの制御方法であって、歩容データに基づいて前記脚部の関節を駆動制御する制御ステップでは、前記足平部の足裏と路面との距離を検出する距離検出ステップと、前記検出された前記足平部の足裏と路面との距離が基準範囲内に含まれない場合に、当該距離検出部の故障を検知する故障検知ステップと、故障していない正常な距離検出部の検出結果に基づいて、前記歩容データを修正する歩容データ修正ステップと、を備えるものである。 A control method for a legged robot according to the present invention is a control method for a legged robot including a torso, a leg connected to the torso, and a foot provided at a lower end of the leg. Then, in the control step of driving and controlling the joint of the leg based on the gait data, a distance detection step of detecting a distance between the sole of the foot and the road surface, and a step of detecting the foot of the detected foot When the distance between the sole and the road surface is not included in the reference range, the step of detecting the failure of the distance detection unit and the detection result of the normal distance detection unit that is not faulty A gait data correction step for correcting the content data.
このように、検出された足平部の足裏と路面との距離が基準範囲内に含まれるか否かに応じてその故障を検知し、故障していない正常な距離検出部の検出結果に基づいて歩容データを修正することで、距離センサが故障した場合であっても、路面と足裏との関係を目標通りに制御することができ、安定して歩行することができる。 In this way, the failure is detected according to whether or not the distance between the sole of the detected foot and the road surface is included in the reference range, and the detection result of the normal distance detection unit that has not failed is detected. By correcting the gait data on the basis, the relationship between the road surface and the sole can be controlled according to the target even when the distance sensor is out of order, and stable walking is possible.
また、前記故障検知部は、前記脚部が遊脚期であって、前記距離検出部の検出値が、前記距離検出部が検出可能な最大値を含む所定の範囲内に含まれない場合に、当該距離検出部の故障を検知するようにしてもよい。これにより、脚部が遊脚期である場合には、支持脚期の場合と比べて、距離検出部の検出値はその目標値近辺により安定して収束し、距離検出部の検出値は、その検出可能な最大値近傍の値になるものと考えられるため、脚部が遊脚期である場合に、距離検出部が検出可能な最大値を含む所定の範囲を基準範囲とすることで、距離検出部の故障をより容易かつ正確に検知することができる。 The failure detection unit may be configured such that the leg portion is in a swing leg period and the detection value of the distance detection unit is not included in a predetermined range including the maximum value that can be detected by the distance detection unit. A failure of the distance detection unit may be detected. Thereby, when the leg is in the swing leg period, compared with the support leg period, the detection value of the distance detection unit converges more stably near its target value, and the detection value of the distance detection unit is Since it is considered to be a value in the vicinity of the maximum value that can be detected, when the leg is in the swing phase, by setting a predetermined range including the maximum value that can be detected by the distance detection unit as a reference range, A failure in the distance detection unit can be detected more easily and accurately.
本発明によれば、距離センサの故障を検知して、安定して歩行が可能な脚式ロボット、及びその制御方法を提供することを目的とする。 An object of the present invention is to provide a legged robot capable of detecting a failure of a distance sensor and stably walking, and a control method thereof.
発明の実施の形態１．
本実施の形態１にかかる脚式ロボットは、胴体と、胴体に連結された脚部と、脚部の下端に設けられた足平部と、足平部の足裏と路面との距離を検出する距離検出部と、歩容データに基づいて脚部の関節を駆動制御する制御部と、を備える。ここで、制御部は、距離検出部の検出結果が基準範囲内に含まれない場合に、その距離検出部の故障を検知する故障検知部と、故障していない正常な距離検出部の検出結果に基づいて、歩容データを修正する歩容データ修正部と、を備える
The legged robot according to the first embodiment detects the distance between the trunk, the leg connected to the trunk, the foot provided at the lower end of the leg, and the sole of the foot and the road surface. And a control unit that drives and controls the joints of the legs based on the gait data. Here, when the detection result of the distance detection unit is not included in the reference range, the control unit detects the failure of the distance detection unit and the detection result of the normal distance detection unit that is not faulty And a gait data correction unit for correcting gait data based on
脚式ロボットが歩行する際には、足平部の足裏に設けられた足裏距離センサを用いて足裏を路面に倣わせる足裏倣い制御と、姿勢センサを用いてロボットの姿勢を倒立させる倒立振子制御を組合せることによって安定化制御を実現している。本実施の形態１にかかる脚式ロボットによれば、足裏距離センサの検出値が基準範囲内に含まれるか否かに応じてその故障を検知し、故障していない正常な足裏距離センサの検出値に基づいて歩容データを修正することで、足裏距離センサが故障した場合であっても、路面と足裏との関係を目標通りに制御することができ、安定して歩行することができる。 When a legged robot walks, it uses a sole distance sensor provided on the sole of the foot of the foot to simulate the sole to follow the road surface, and the posture sensor is used to control the posture of the robot. Stabilization control is realized by combining inverted pendulum control to invert. According to the legged robot according to the first embodiment, the failure is detected according to whether or not the detection value of the sole distance sensor is included in the reference range, and a normal sole distance sensor that is not malfunctioning is detected. By correcting the gait data based on the detected value, even if the sole distance sensor fails, the relationship between the road surface and the sole can be controlled as desired, and the gait is stable be able to.
以下、図面を参照しながら本実施の形態１に係るロボットの制御方法について説明する。図１は、本実施の形態１に係る脚式ロボットの概要を示す図である。ロボット１００は、胴体１０と、胴体１０に連結された２本の脚を有する。尚、図１には、一方の脚部２０のみを示しており、他方の脚部は図示を省略している。胴体１０は、ロボット１００の動作（脚部の各関節の動作）を制御する制御部３０と、胴体の加速度を検出する加速度センサ１２と、胴体の１０の鉛直方向に対する傾斜角（姿勢角）を検出する姿勢角センサ１４を備える。
Hereinafter, the robot control method according to the first embodiment will be described with reference to the drawings. FIG. 1 is a diagram showing an outline of the legged robot according to the first embodiment. The
脚部２０は、股関節２１、膝関節２３、足首関節２５、大腿リンク２２、脛リンク２４、及び足平部としての足平リンク２６を備える。大腿リンク２２と脛リンク２４は、直線で模式化して示してある。股関節２１は、胴体１０と大腿リンク２２を揺動可能に連結している。膝関節２３は、大腿リンク２２と脛リンク２４を揺動可能に連結している。足首関節２５は、脛リンク２４と足平リンク２６を揺動可能に連結している。脚部２０の下端には足平部としての足平リンク２６が設けられる。足平リンク２６は板状の部材であり、足平リンクの裏面（足裏面）は平面となっている。
The
足平リンク２６には、距離検出部としての少なくとも３個以上の足裏距離センサ１６が設けられている。足裏距離センサ１６は、足平リンク２６の裏面（足裏面）と接地面Ｓとの距離を検出する。図２は、足平リンク２６の構成を説明するための図である。図２に示すように、足平リンク２６は、上面視において、略矩形状に形成されている。足平リンク２６の四隅近傍には、４つの足裏距離センサ１６ａ、１６ｂ、１６ｃ、１６ｄがそれぞれ設けられている。ここでは、足平リンク２６の爪先側に２つの足裏距離センサ１６ａ及び１６ｄが、踵側に２つ足裏距離センサ１６ｂ及び１６ｃがそれぞれ設けられている。足裏距離センサ１６ａ及び１６ｄは、足平リンク２６の前方の所定位置における足裏面と接地面Ｓとの距離を検出し、足裏距離センサ１６ｂ及び１６ｃは、足平リンク２６の後方の所定位置における足裏面と接地面Ｓとの距離を検出する。従って、足裏距離センサ１６ａ及び１６ｄが検出する距離と１６ｂ及び１６ｃが検出する距離の差から、足平リンク２６の足裏面の接地面Ｓに対する傾きを求めることができる。
The
各関節には図示しないモータが内蔵されており、制御部３０からの指令に基づいて駆動される。モータを駆動することによって、関節に連結されたリンク同士を揺動させることができる。図示を省略している他方の脚部も、脚部２０と同様の構造を有する。制御部３０が２本の脚部の関節（詳細には関節角）を適宜制御することにより、ロボット１００を歩行させることができる。
Each joint incorporates a motor (not shown) and is driven based on a command from the
図１においては、説明の便宜上、ロボット１００が進行する向き（前後方向）をｘ軸、ロボット１００が進行する方向に対して水平方向に直交する向き（左右方向）をｙ軸、ロボット１００の進行する平面から鉛直方向に延びる向き（上下方向）をｚ軸とし、これら３軸からなる絶対座標系を用いて説明する。即ち、図１において、ｘ軸は紙面に向かって左右方向、ｙ軸は紙面の奥行き方向、ｚ軸は紙面中の上下方向を示す。尚、ロボット１００の胴体１０に対して点Ｏｂを特定し固定する。足平リンク２６に対して点Ｏｆを特定し固定する。
In FIG. 1, for convenience of explanation, the direction in which the
ロボット１００は、制御部３０に記憶されている歩容データに基づいて制御される。歩容データには、胴体１０の目標位置（目標胴***置）、胴体１０の目標姿勢角（目標胴体姿勢角）、足平リンク２６の目標位置（目標足平位置）、及び足平リンク２６の目標姿勢角（目標足平姿勢角）のそれぞれの時系列データが含まれる。歩容データには、ロボット１００が有する脚部のそれぞれの目標足平位置・姿勢角の時系列データが含まれる。
The
歩容データは、シミュレーション等によってロボット１００を安定して歩行させることができるように作成されている。即ち、目標胴***置、目標胴体姿勢角、目標足平位置、及び目標足平姿勢角は、ロボット１００のＺＭＰ位置が接地面に接地した足裏で囲まれた凸包内となる関係を満足するように設定されている。作成された歩容データは、ロボット１００の制御部３０に記憶される。後述するように、制御部３０は、歩容データに含まれる目標胴***置等に実胴***置等を一致させるように各関節を制御する。
The gait data is created so that the
目標胴***置は、絶対座標系に対する特定点Ｏｂの位置で表される。特定点Ｏｂを原点とする胴体座標系を用いる場合には、目標胴体姿勢角は、絶対座標系に対する胴体座標系の傾きで表される。実胴体姿勢角は、胴体１０に備えられた姿勢角センサ１４によって検出することができる。目標足平位置は、絶対座標系に対する特定点Ｏｆの位置で表される。目標足平姿勢角は、接地面に対する足裏面の角度で表される。特定点Ｏｆを原点とする足平座標系を用いる場合には、目標足平姿勢角は、絶対座標系に対する足平座標系の傾きで表してもよい。実足平姿勢角は、後述するように、足平リンク２６に備えられた足裏距離センサ１６によって検出することができる。
The target body position is represented by the position of the specific point Ob with respect to the absolute coordinate system. In the case of using a body coordinate system having the specific point Ob as the origin, the target body posture angle is represented by the inclination of the body coordinate system with respect to the absolute coordinate system. The actual body posture angle can be detected by a
続いて、本実施の形態１に係るロボット１００の制御システム１の詳細について説明する。制御システム１は、倒立制御を実行すると共に、足裏倣い制御を実行する。倒立制御は、実胴***置及び姿勢角を目標胴***置及び姿勢角に一致する制御である。尚、胴体姿勢角の代わりに重心位置を用いてもよい。足裏倣い制御は、接地面から見た相対的な実足平位置及び実足平姿勢角をそれぞれ目標足平位置及び目標足平姿勢角に一致する制御である。
Next, details of the
図３は、制御システム１の機能構成を示す機能ブロック図である。制御システム１は、制御部３０と、記憶部５０と、姿勢角センサ１４と、モータ１５と、足裏距離センサ１６等を有している。
FIG. 3 is a functional block diagram showing a functional configuration of the
記憶部５０には、歩容データ５１及び路面ノミナル位置・傾斜情報５２が記憶されている。歩容データ５１は、目標胴***置、目標胴体姿勢角、目標足平位置、及び目標足平姿勢角の時系列データを含む。歩容データ上で足裏が接地面と接触するときは、足裏面と接地面を面接触状態とするため、目標足平姿勢角（仮想的な接地面に対する仮想的な足裏面の傾き）はゼロに設定されている。また、歩容データ上の各目標値は、ロボット１００のＺＭＰ位置が接地している脚の足裏で囲まれた凸包内となる関係を満たすように決定されている。路面ノミナル位置・傾斜情報５２は、ロボット１００が移動する路面の存在情報であり、路面の位置・傾斜に関する基準値を示す。
The
制御部３０は、記憶部５０に記憶された歩容データ５１等を読み出すと共に、読み出した歩容データ５１等によって特定されるロボット１００の姿勢を実現するために必要な脚部２０の関節角を算出する。そして、このように算出した関節角に基づく信号をモータ１５に送信する。また、制御部３０は、センサからの信号を受けて、モータの駆動量を調整する。
The
より詳細には、制御部３０は、足裏倣い制御部６１と、倒立制御部６２と、関節角変換部６３と、各軸制御器６４と、足裏倣い制御切替判定部６５と、故障検知部６６と、を備える。制御部３０内では、実胴体姿勢角と目標胴体姿勢角の偏差に基づくフィードバック制御系（倒立制御部６２による倒立制御系）と、接地面から見た相対的な実足平姿勢角と目標足平姿勢角の偏差に基づくフィードバック制御系（足裏倣い制御部６１による倣い制御系）が含まれる。以後、足裏倣い制御の偏差については、接地面から見た相対的な足平姿勢角に関するものを示すものとする。
More specifically, the
足裏倣い制御部６１は、実足平姿勢角を目標足平姿勢角に一致させるように、例えば足裏が接地面に密着している状態を目標として、踵側が接地面から浮いている場合には、足平リンク２６の爪先側を脛リンク２４に近づける方向に足平リンク２６を回転させる。即ち、足裏面と接地面との面接触を維持するように足平リンク２６を回転させる。実足平姿勢角は、足平リンク２６が備える足裏距離センサ１６ａ、１６ｂ、１６ｃ、１６ｄの出力値から求められる。尚、足裏倣い制御部６１の詳細については後述する。
When the sole
倒立制御部６２は、ロボット１００の胴***置姿勢を目標位置姿勢に維持する機能を果たす。胴***置姿勢は、実際の胴***置と胴体姿勢角であり、目標位置姿勢は、目標の胴***置と胴体姿勢角である。実胴体姿勢角は、胴体１０に備えられた姿勢角センサ１４で検出される。姿勢角センサ１４は、例えば胴体１０の角速度を検出するジャイロと、ジャイロの出力（角速度）を積分する積分器と、重力加速度ベクトルを検出する３軸加速度センサで構成される。尚、倒立制御部６２の詳細については後述する。
The
故障検知部６６は、足裏距離センサ１６の検出結果が基準範囲内に含まれない場合に、足裏距離センサ１６の故障を検知する。切替判定部としての足裏倣い制御切替判定部６５は、故障検知部６６の検知結果に応じて、制御部３０による制御が継続可能であるか否かを判定する。図示しない歩容データ修正部は、足裏倣い制御切替判定部６５による判定の結果、制御部３０による制御が継続可能であると判定した場合に、故障していない正常な足裏距離センサ１６に基づいて、歩容データを修正する。尚、故障検知部６６及び足裏倣い制御切替判定部６５の詳細については後述する。
The
より詳細には、以下のようにして記憶部５０に記憶された歩容データ（目標胴***置、目標胴体姿勢角、目標足平位置、及び目標足平姿勢角の時系列データ）が修正され、関節角変換部６３に入力される。図３においては、胴***置姿勢目標値が、目標胴***置及び目標胴体姿勢角の時系列データを含み、足先位置姿勢目標値が、目標足平位置及び目標足平姿勢角の時系列データを含む。
More specifically, the gait data (target body position, target body posture angle, target foot position, and target foot posture angle time series data) stored in the
記憶部５０に記憶された目標胴***置は、目標胴体加速度と実胴体加速度の偏差に基づいて補正された後に関節角変換部６３に入力される。目標胴体加速度は、目標胴***置を２回微分することによって求められる。実胴体加速度は、加速度センサ１２により検出される。
The target body position stored in the
記憶部５０に記憶された目標足平位置は、目標足平位置と実足平位置の偏差に基づいて補正された後に関節角変換部６３に入力される。
The target foot position stored in the
記憶部５０に記憶された目標胴体姿勢角は、そのまま関節角変換部６３に入力される。同時に、目標胴体姿勢角と実胴体姿勢角の偏差（胴体姿勢角偏差）が求められる。胴体姿勢角偏差は倒立制御部６２に入力されて、胴体姿勢角偏差を小さくする方向に胴体を回転させる胴体補正角が算出される。実胴体姿勢角は、姿勢角センサ１４により検出される。尚、図３においては、胴体補正角は足裏倣い制御部６１における補正量となるため、胴体補正角を倣い制御目標値補正量という。
The target body posture angle stored in the
記憶部５０に記憶された目標足平姿勢角と実足平姿勢角の偏差（足平姿勢角偏差）が求められる。実足平姿勢角は、足裏距離センサ１６により検出される。足平姿勢角偏差と上述した胴体補正角（倣い制御目標値補正量）とが加算され、加算された結果が、足裏倣い制御部６１に入力される。足裏倣い制御部６１によって、入力された角度（胴体補正角と足平姿勢角偏差を加算した角度）を小さくする方向へ足平を回転させる足平補正角が求められる。記憶部５０に記憶された目標足平姿勢角は、上述した足平補正角が加算された後に（足平補正角で補正された後に）関節角変換部６３に入力される。尚、図３においては、足平補正角を足先目標値補正量という。
A deviation between the desired foot posture angle and the actual foot posture angle stored in the storage unit 50 (foot posture angle deviation) is obtained. The actual foot posture angle is detected by the
関節角変換部６３には、以上のようにして修正された歩容データが入力される。これらの値から、関節角変換部６３では、逆キネマティクスの演算によって脚部２０の各関節の目標関節角が算出される。ここで、それぞれの目標値は、絶対座標系に対する値で表されている。関節角変換部６３では、目標足平位置と目標胴***置の差から足平と胴体の相対位置を計算し、目標足平姿勢角（足平補正角によって補正されている）と目標胴体姿勢角の差から足平と胴体の相対回転角を計算する。計算された相対位置と相対回転角を実現する目標関節角が算出される。
The gait data corrected as described above is input to the joint
各軸制御器６４は、関節角変換部６３により送信された目標関節角の信号に基づいて、脚部２０を駆動するための各モータ１５の駆動量を特定し、これらの駆動量でモータ１５を駆動させるためのモータ駆動信号を各モータに送信する。これによって、脚部２０の各関節における駆動量が変更され、ロボット１００の動きが制御される。
Each
続いて、図４を参照しながら、本実施の形態１に係る倒立制御部６２について詳細に説明する。図４は、倒立制御部６２の機能構成を示す機能ブロック図である。図４に示すように、倒立制御部６２は、姿勢偏差計算部６２１と、コントローラ６２２と、リミッタ６２３と、を有する。
Next, the
倒立制御部６２は、まず、姿勢偏差計算部６２１において、胴体姿勢目標値（胴体の目標姿勢）と、胴体姿勢計測値（姿勢角センサ１４により検出した実姿勢）との偏差を計算する。そして、計算した胴体の姿勢偏差に基づき、所定のコントローラ６２２によって、足裏倣い制御で使用する足裏と路面との目標相対位置・目標相対姿勢の補正量を計算する。
The
次いで、倒立制御部６２は、足裏距離センサ１６の出力値に基づき、足裏が路面から剥がれたか否かを判定する。判定の結果、足裏が路面から剥がれていない場合には、計算された目標相対位置・目標相対姿勢に対して補正を行わずに、倣い制御目標値補正量として出力する。一方で、足裏が路面から剥がれた場合には、リミッタ６２３を介して、計算した補正量を制限する。即ち、リミッタ６２３は、目標相対位置・目標相対姿勢の補正量の大きさに制限を加えるものである。リミッタ６２３は、入力された補正量の大きさが許容範囲内を超えているときに、許容限界の値を出力する。このリミッタ６２３を設けることで、足裏倣い制御部６１に入力される倣い制御目標値補正量を制限する。これによって、倣い制御系（足裏倣い制御部６１）が倒立制御系（倒立制御部６２）よりも優勢に作用することを保証する。従って、倣い制御系が優勢に作用して、足裏面が接地面と面接触することを保証することができる。
Next, the
次いで、倒立制御部６２は、計算された補正量に基づいて、胴体の姿勢偏差を小さくする方向へ、足裏と路面との目標相対位置・目標相対姿勢を補正する。補正された目標相対位置・目標相対姿勢を倣い制御目標値補正量として足裏倣い制御部６１へと出力する。
Next, the
続いて、図５及び６を参照しながら、本実施の形態１に係る故障検知部６６について詳細に説明する。図５は、故障検知部６６による故障検知処理を説明するためのフローチャートである。図６は、足裏距離センサ１６の検出値と目標値の関係を示す概念図である。
Next, the
故障検知部６６は、まず、各足裏距離センサ１６の故障を検出するための故障フラグの値を初期化する（ｆａｉｌ＿ｆｌａｇ＝０）（ステップＳ１０１）。次いで、故障検知部６６は、ロボット１００の脚部２０が遊脚であるか又は支持脚であるかを判定する（ステップＳ１０２）。判定の結果、脚部２０が支持脚である場合には、故障検知処理を終了する。
First, the
一方で、判定の結果、脚部２０が遊脚である場合には、歩容データに含まれる足平リンク２６の目標位置（ここでは高さ）が、予め定めた所定値よりも大きいか否かを判定する（ステップＳ１０３）。即ち、遊脚期における足平リンク２６の目標高さが十分大きいか否かを判定する。判定の結果、足平リンク２６の目標高さが所定値よりも大きくない場合には、故障検知処理を終了する。
On the other hand, if the result of determination is that the
一方で、判定の結果、足平リンク２６の目標高さが所定値よりも大きな場合には、計測された足裏距離センサ１６の出力値が、予め定めた基準範囲内に含まれるか否かを判定する（ステップＳ１０４）。判定の結果、計測された足裏距離センサ１６の出力値が、予め定めた基準範囲内に含まれる場合には、故障検知処理を終了する。
On the other hand, as a result of the determination, if the target height of the
一方で、判定の結果、計測された足裏距離センサ１６の出力値が、予め定めた基準範囲内に含まれない場合には、その足裏距離センサ１６は故障しているものとし、故障状態を示す値を故障フラグの値に設定する（ｆａｉｌ＿ｆｌａｇ＝１）（ステップＳ１０５）。
On the other hand, if the output value of the measured
図６は、足裏距離センサ１６の検出値と目標値の関係を示す概念図である。本実施の形態１に係るロボット１００では、足裏距離センサ１６として接触型のセンサを採用する。これにより、足裏と路面との間の距離を精度良く測定することができる。このような接触型の距離センサでは、遊脚が路面から完全に離床している状態においては、足裏距離センサ１６の出力値として、その計測可能な範囲の最大値を出力する。図６（ａ）に示すように、脚部２０が遊脚時であって、目標高さが所定値よりも十分大きな場合（例えば時間ｔ１〜ｔ２に示す区間の場合）、足裏距離センサ１６の目標とする出力（路面と足裏との目標距離（即ち足平リンク２６の目標高さ））は、足裏距離センサ１６が計測可能な最大値ｈ＿ｍａｘとなる。そこで、図６（ｂ）に示すように、遊脚時における足裏距離センサ１６が検出可能な最大値を中心として、当該最大値を含む範囲を基準範囲として設定する。このように、遊脚時であって、足平リンク２６の目標高さが所定値よりも十分大きな場合に、故障していない正常な足裏距離センサ１６によって計測される出力値は、当該基準範囲内に含まれるものと想定される。従って、計測時における誤差を考慮して、最大値を含む所定の範囲を基準範囲とし、遊脚時であって、足平リンク２６の目標高さが所定値よりも十分大きな場合に、計測された足裏距離センサ１６の出力値が、基準範囲内に含まれるか否かを判定することで、足裏距離センサ１６の故障を容易かつ正確に検知することができる。また、最大値に対して所定の範囲を持たせることで、センサノイズに対しても耐性を有することができる。
FIG. 6 is a conceptual diagram showing the relationship between the detection value of the
続いて、図７乃至９を参照しながら、本実施の形態１に係る足裏倣い制御部６１について詳細に説明する。図７は、足裏倣い制御部６１の機能構成を示す機能ブロック図である。図８は、足裏倣い制御部６１による制御処理の概要を説明するためのフローチャートである。図９は、足裏倣い制御が継続可能であるか否かの判定処理を説明するための図である。図５に示すように、足裏倣い制御部６１は、距離センサ目標値計算部６１１と、差分器６１２と、距離センサ選択部６１３と、位置姿勢偏差計算部６１４と、加算器６１５と、補償器６１６を有する。
Next, the sole
まず、足裏倣い制御部６１に対して切替判定情報が入力され、足裏倣い制御部６１は、切替判定情報から、足裏距離センサ１６のうちで故障したセンサが存在するか否かを判定する（ステップＳ２０１）。ここで、切替判定情報は足裏倣い制御切替判定部６５により出力される。足裏倣い制御切替判定部６５は、故障検知部６６の検知結果に基づいて、足裏倣い制御が継続可能であるか否かを判定し、当該判定結果を含む切替判定情報を出力する。また、切替判定情報は、各足裏距離センサ１６が故障しているか又は正常であるかを示す足裏距離センサ状態情報（足裏距離センサ１６の故障フラグの値）を含む。
First, switching determination information is input to the sole
次いで、判定の結果、故障した足裏距離センサ１６が存在する場合には、足裏倣い制御部６１は、切替判定情報から、正常な足裏距離センサ１６のみで足裏倣い制御が継続可能か否かを判定する（ステップＳ２０２）。判定の結果、正常な足裏距離センサ１６のみでは足裏倣い制御が継続不可能な場合には、足裏倣い制御を実行せずに、その出力値（足先目標値補正量）を０に設定する（ステップＳ２０３）。尚、足裏倣い制御と倒立制御は同時に実行することが好ましいため、足裏倣い制御部６１の出力である足先目標値補正量を０とすることで、足裏倣い制御を実行しない場合には、倒立制御も同時に実行させないようにすることができる。
Next, if there is a broken
次いでロボット１００の制御部３０は、足先目標値補正量を計算し（ステップＳ２０４）、計算された足先目標値補正量を実現するように歩容データを修正する（ステップＳ２０５）。より詳細には、足裏倣い制御部６１において、相対位置偏差・相対姿勢偏差と倣い制御目標値補正量とが加算器６１５により加算され、加算された結果が、補償器６１６に入力される。補償器６１６において、所定の伝達関数を用いて足先目標値補正量を計算し、計算された足先目標値補正量により、偏差が小さくなるように足平リンク２６の目標位置姿勢を補正する。足先目標値補正量の計算は、例えば、足偏差を入力とし、足先目標値補正量を出力とする伝達関数を通すことで実現することができる。
Next, the
一方で、ステップＳ２０１における判定の結果、故障した足裏距離センサ１６が存在しない場合には、足裏倣い制御部６１は、全ての足裏距離センサ１６を用いて、通常の足裏倣い制御を実行する（ステップＳ２０７）。より詳細には、まず、足裏倣い制御部６１の距離センサ目標値計算部６１１において、歩容データ５１に含まれる足先位置姿勢目標値（目標足平位置・姿勢角の軌道）と、路面の存在情報である路面のノミナル位置・傾斜情報５２とから、足裏距離センサ１６の高さ目標値を計算する。言い換えると、足平リンク２６の目標位置・姿勢角を示す軌道データと、足平２６が実際に着地する地点（ノミナル位置・傾斜）とから、足裏距離センサ１６の目標とする時系列値を計算する。即ち、目標とする足裏距離センサ１６の出力値を計算する。尚、ノミナル位置・傾斜に代えて、ロボット１００の一歩分の着地位置から足平リンク２６の着地位置・姿勢を計算することで、目標とする足裏距離センサ１６の出力値を計算するようにしてもよい。
On the other hand, if there is no faulty
次いで、計算した足裏距離センサ１６の目標値と、足裏距離センサ１６によって実際に計測された計測値とから、足裏距離センサ１６の偏差を差分器６１２により計算する。このとき、距離センサ選択部６１３によって、足裏距離センサ１６のうち、床反力モーメントを効果的に得ることができるように足裏距離センサ１６を選択し、選択された足裏距離センサ１６を用いて足裏倣い制御を実行することで、倒立制御において転倒をより効果的に防止することができる。
Next, a difference of the
次いで、位置姿勢偏差計算部６１４において、計算した足裏距離センサ１６の偏差から、足平リンク２６の足裏と路面との相対位置偏差・相対姿勢偏差を計算する。より詳細には、足平リンク２６の目標位置姿勢に対する実際の位置姿勢の足偏差（ロール、ピッチ、ｚ）を計算する。尚、ｚは鉛直方向の測定高さを示す。足裏と距離センサ１６が配置される位置の幾何学的関係から近似を用いて、各足裏距離センサ１６ａ乃至１６ｄの出力値の偏差と、各足裏距離センサ１６の偏差に対応する変換行列とから、足偏差を一意に決定することができる。制御部３０は、このようにして計算した足偏差から、上述したように足先目標値補正量を計算し（ステップＳ２０４）、計算された足先目標補正量を実現するように歩容データを修正する（ステップＳ２０５）。
Next, the position / posture
一方で、ステップＳ２０２における判定の結果、正常な足裏距離センサ１６のみで足裏倣い制御が継続可能である場合には、正常な足裏距離センサ１６のみを用いて、足裏倣い制御を実行する（ステップＳ２０６）。次いで、制御部３０は、上述したようにして、計算した足偏差から、足先目標値補正量を計算し（ステップＳ２０４）、計算された足先目標補正量を実現するように歩容データを修正する（ステップＳ２０５）。
On the other hand, if the result of determination in step S202 is that the sole imprint control can be continued with only the normal
図９は、足裏倣い制御が継続可能であるか否かの判定処理を説明するための図である。図において、故障した足裏距離センサ１６を斜線領域により示す。図９（ａ）に示すように、足裏倣い制御では、足偏差（ロール、ピッチ、ｚ）を補正する。これに対して、本実施の形態１に係るロボット１００では、足裏距離センサ１６を４個備えているため、センサの個数が冗長となる。このため、図９（ｂ）乃至（ｄ）に示すように、足裏距離センサ１６の故障状況に応じて、距離センサ選択部６１３は、足裏距離センサ１６のうち、床反力モーメントを効果的に得ることができるように足裏距離センサ１６を選択する。そして、足裏倣い制御処理においては、選択された足裏距離センサ１６を用いて足裏倣い制御を実行する。
FIG. 9 is a diagram for explaining a process of determining whether or not the sole scanning control can be continued. In the figure, the broken
まず、図９（ｂ）に示すように、足裏距離センサ１６が全て正常な場合には（図８におけるステップＳ２０７の場合）、床反力モーメントを効果的に得ることができるように３個の足裏距離センサ１６を選択することで、倒立制御の転倒を防止することができる。
First, as shown in FIG. 9B, when the
他方、図９（ｃ）に示すように、足裏距離センサ１６のうち１つが故障している場合には（例えば図８におけるステップＳ２０６の場合）、正常な残り３個の足裏距離センサ１６を選択し、選択された足裏距離センサ１６を用いて足裏倣い制御を実行する。
On the other hand, as shown in FIG. 9C, when one of the
また、図９（ｄ）に示すように、足裏距離センサ１６のうち２つが故障している場合には（例えば図８におけるステップＳ２０３の場合）、正常な残り２個の足裏距離センサ１６では足先目標値補正量を適切に計算することができないため、足裏距離センサ１６を用いて足裏倣い制御を実行しないものとする。
Further, as shown in FIG. 9D, when two of the
発明の実施の形態２．
上述した実施の形態１においては、足平リンク２６に設けられた足裏距離センサ１６が４個である場合について、それら足裏距離センサ１６のうち、３個の足裏距離センサ１６を選択する処理について説明した。本発明はこれに限定されず、足平リンク２６に設けられた少なくとも３個以上の足裏距離センサ１６から、３個の足裏距離センサ１６を選択するようにしてもよい。尚、本実施の形態２に係るロボット１００の構成は、足平リンク２６の構成、及び足平リンク２６に設けられる足裏距離センサ１６の配置を除いて、上述した発明の実施の形態１と同様である。
In the first embodiment described above, when there are four
図１０は、本実施の形態２に係るロボット１００の足平リンク２６の構成を説明するための図である。足平リンク２６は、爪先部２６ａと、爪先関節２７を介して爪先部２６ａに連結された踵部２６ｂとから構成される。ロボット１００の歩行動作中には、爪先関節２７を駆動することで、爪先部２６ａを路面に対して接地させたまま、踵部２６ｂを浮かせることができる。即ち、踵部２６ｂを浮かせたまま爪先部２６ａのみを接地させることにより、ロボット１００を直立させることができる。
FIG. 10 is a diagram for explaining the configuration of the
図１０に示すように、爪先部２６ａ及び踵部２６ｂは、上面視において、略矩形状に形成されている。爪先部２６ａの四隅近傍には、４つの足裏距離センサ１６ａ、１６ｂ、１６ｃ、１６ｄがそれぞれ設けられている。ここでは、爪先部２６ａの爪先側に２つの足裏距離センサ１６ａ及び１６ｄが、踵部方向側に２つ足裏距離センサ１６ｂ及び１６ｃが設けられている。足裏距離センサ１６ａ及び１６ｄは、爪先部２６ａの前方の所定位置における足裏面と接地面Ｓとの距離を検出し、足裏距離センサ１６ｂ及び１６ｃは、爪先部２６ａの後方の所定位置における足裏面と接地面Ｓとの距離を検出する。踵部２６ｂには、爪先部側とは反対側の二隅に２つの足裏距離センサ１６ｅ及び１６ｆがそれぞれ設けられている。足裏距離センサ１６ｅ及び１６ｆは、踵部２６ｂの後方の所定位置における足裏面と接地面Ｓとの距離を検出する。従って、足裏距離センサ１６ａ及び１６ｄが検出する距離と、足裏距離センサ１６ｂ及び１６ｃが検出する距離と、足裏距離センサ１６ｅ及び１６ｆが検出する距離との差から、足平リンク２６の足裏面の接地面Ｓに対する傾きを求めることができる。
As shown in FIG. 10, the
本実施の形態２に係るロボット１００は、爪先関節２７を駆動させて爪先部２６ａ及び踵部２６ｂを路面に倣わせる際に、ロボット１００の足裏から倒立制御に対して効果的な床反力モーメントを得ることができるように、爪先部２６ａに配置された足裏距離センサ１６から３個の距離センサ１６を選択すると共に、踵部２６ｂと路面との距離に基づいて、踵部２６ｂに配置された足裏距離センサ１６から路面との距離を追従させるべき１個の距離センサ１６を選択する。
In the
図１１は、本実施の形態２に係るロボット１００について、足裏倣い制御が継続可能であるか否かの判定処理を説明するための図である。図に示すように、足裏倣い制御では、爪先部２６ａの爪先偏差（ロール、ピッチ、ｚ）に加えて、爪先角度も補正する。これに対して、本実施の形態２に係るロボット１００では、足裏距離センサ１６を足裏に６個備えているため、センサの個数が冗長となる。このため、足裏距離センサ１６の故障状況に応じて、距離センサ選択部６１３は、足裏距離センサ１６のうち、床反力モーメントを効果的に得ることができるように足裏距離センサ１６を選択する。そして、足裏倣い制御処理においては、選択された足裏距離センサ１６を用いて足裏倣い制御を実行する。
FIG. 11 is a diagram for explaining a determination process as to whether or not the sole copying control can be continued for the
ここで、爪先部２６ａの爪先偏差（ロール、ピッチ、ｚ）については、爪先部２６ａに設けられた４個の足裏距離センサ１６ａ、１６ｂ、１６ｃ、１６ｄを用いることで計算することができるため、実施の形態１と同様にして、４個の足裏距離センサ１６から３個の足裏距離センサ１６を選択する。爪先角度については、爪先部２６ａに設けられた少なくとも１個の足裏距離センサ１６と、踵部２６ｂに設けられた少なくとも１個の足裏距離センサ１６とを選択することで計算することができる。従って、爪先角度について、爪先部２６ａに設けられた足裏距離センサ１６と、踵部２６ｂに設けられた足裏距離センサ１６とから、少なくともそれぞれ１個ずつの足裏距離センサ１６を使用することができない場合には、足先目標値補正量を適切に計算することができないため、足裏距離センサ１６を用いて足裏倣い制御を実行しないものとする。
Here, the toe deviation (roll, pitch, z) of the
以上説明したように足裏距離センサ１６の検出結果が基準範囲内に含まれない場合に、その足裏距離センサ１６の故障を検知する故障検知部を備え、故障していない正常な距離検出部の検出結果に基づいて、歩容データを修正することで、足裏距離センサ１６が故障した場合であっても、路面と足裏との関係を目標通りに制御することができ、安定して歩行することができる。
As described above, when the detection result of the
その他の実施の形態．
上述した実施の形態においては、ロボット１００は２本の脚を備えるものとしたが本発明はこれに限定されない。少なくとも２本以上の脚を有し、それぞれの脚の下端には足平部が設けられ、足平部の足裏には少なくとも３個以上の足裏距離センサを備える脚式ロボットに対しても、本発明を適用することができる。
Other embodiments.
In the embodiment described above, the
尚、本発明は上述した実施の形態のみに限定されるものではなく、既に述べた本発明の要旨を逸脱しない範囲において種々の変更が可能であることは勿論である。 It should be noted that the present invention is not limited to the above-described embodiment, and various modifications can be made without departing from the gist of the present invention already described.
１ 制御システム、
１０ 胴体、
１２ 加速度センサ、１４ 姿勢角センサ、１５ モータ、１６ 距離センサ
２０ 脚部、２１ 股関節、２２ 大腿リンク、２３ 膝関節、２４ 脛リンク、
２５ 足首関節、２６ 足平リンク、２６ａ 爪先部、２６ｂ 踵部、２７ 爪先関節、
３０ 制御部、５０ 記憶部、
５１ 歩容データ、５２ 路面ノミナル位置・傾斜、
６０ 演算処理部、６１ 足裏倣い制御部、６２ 倒立制御部、６３ 関節角変換部、
６４ 各軸制御器、６５ 足裏倣い制御切替判定部、６６ 故障検知部、
６１１ 距離センサ目標値計算部、６１３ 距離センサ選択部、
６１４ 位置姿勢偏差計算部、６１５ 補償器、
６２１ 姿勢偏差計算部、６２２ コントローラ、６２３ リミッタ、
１００ ロボット
1 control system,
10 torso,
12 acceleration sensors, 14 posture angle sensors, 15 motors, 16
25 ankle joint, 26 foot link, 26a toe part, 26b buttocks, 27 toe joint,
30 control unit, 50 storage unit,
51 gait data, 52 road surface nominal position / tilt,
60 arithmetic processing units, 61 sole copying control unit, 62 inversion control unit, 63 joint angle conversion unit,
64 Axis controllers, 65 Foot imitation control switching determination unit, 66 Fault detection unit,
611 Distance sensor target value calculation unit, 613 Distance sensor selection unit,
614 position and orientation deviation calculator, 615 compensator,
621 Attitude deviation calculator, 622 controller, 623 limiter,
100 robot
Claims (6)
前記制御部は、
前記距離検出部の検出結果が基準範囲内に含まれない場合に、当該距離検出部の故障を検知する故障検知部と、
故障していない正常な距離検出部の検出結果に基づいて、足先目標値補正量を計算し、当該計算された足先目標値補正量を用いて前記足先位置姿勢目標値を補正して前記歩容データを修正する歩容データ修正部と、を備える
ことを特徴とする脚式ロボット。 A torso, a leg connected to the torso, a foot provided at a lower end of the leg, a distance detecting unit for detecting a distance between the sole of the foot and the road surface, and a target foot A legged robot comprising: a control unit that drives and controls the joints of the legs based on gait data including the toe position / posture target value including time-series data of position and target foot posture angle ;
The controller is
When the detection result of the distance detection unit is not included in the reference range, a failure detection unit for detecting a failure of the distance detection unit,
Based on the detection result of the normal distance detection unit that is not malfunctioning , the toe target value correction amount is calculated, and the toe position / posture target value is corrected using the calculated toe target value correction amount. And a gait data correcting unit for correcting the gait data.
前記脚部が遊脚期であって、前記距離検出部の検出値が前記基準範囲内に含まれない場合に、当該距離検出部の故障を検知する
ことを特徴とする請求項１記載の脚式ロボット。 The failure detection unit is
2. The leg according to claim 1, wherein when the leg portion is in a free leg period and a detection value of the distance detection unit is not included in the reference range, a failure of the distance detection unit is detected. Type robot.
前記脚部が遊脚期であって、前記距離検出部の検出可能な最大値を含む所定の範囲である
ことを特徴とする請求項２記載の脚式ロボット。 The reference range is
The legged robot according to claim 2, wherein the leg portion is in a free leg period and is in a predetermined range including a maximum value detectable by the distance detection unit.
前記故障検知部の検知結果に応じて、前記制御部による制御が継続可能であるか否かを判定する切替判定部を更に備え、
前記歩容データ修正部は、
前記切替判定部による判定の結果、前記制御部による制御が継続可能であると判定した場合に、故障していない正常な距離検出部を利用して、前記歩容データを修正する
ことを特徴とする請求項１記載乃至３いずれか１項記載の脚式ロボット。 The controller is
According to the detection result of the failure detection unit, further comprising a switching determination unit for determining whether the control by the control unit can be continued,
The gait data correction unit
As a result of the determination by the switching determination unit, when it is determined that the control by the control unit can be continued, the gait data is corrected using a normal distance detection unit that is not faulty. claim 1, wherein乃optimum 3 have Zureka 1 wherein the legged robot according to.
目標足平位置及び目標足平姿勢角の時系列データを含む足先位置姿勢目標値を含む歩容データに基づいて前記脚部の関節を駆動制御する制御ステップでは、
前記足平部の足裏と路面との距離を検出する距離検出ステップと、
前記検出された前記足平部の足裏と路面との距離が基準範囲内に含まれない場合に、当該距離検出部の故障を検知する故障検知ステップと、
故障していない正常な距離検出部の検出結果に基づいて、足先目標値補正量を計算し、当該計算された足先目標値補正量を用いて前記足先位置姿勢目標値を補正して前記歩容データを修正する歩容データ修正ステップと、を備える
ことを特徴とする脚式ロボットの制御方法。 A control method for a legged robot comprising a torso, a leg connected to the torso, and a foot provided at the lower end of the leg,
In the control step of driving and controlling the joint of the leg based on the gait data including the foot position / posture target value including the time-series data of the target foot position and the target foot posture angle ,
A distance detecting step for detecting a distance between the sole of the foot and the road surface;
When the detected distance between the sole of the foot and the road surface is not included in the reference range, a failure detection step of detecting a failure of the distance detection unit,
Based on the detection result of the normal distance detection unit that is not malfunctioning , the toe target value correction amount is calculated, and the toe position / posture target value is corrected using the calculated toe target value correction amount. And a gait data correcting step for correcting the gait data.
前記脚部が遊脚期であって、前記距離検出部の検出値が、前記距離検出部が検出可能な最大値を含む所定の範囲内に含まれない場合に、当該距離検出部の故障を検知する
ことを特徴とする請求項５記載の脚式ロボットの制御方法。 The failure detection unit is
When the leg is in the swing phase and the detection value of the distance detection unit is not included in a predetermined range including the maximum value that can be detected by the distance detection unit, the distance detection unit fails. the method of the legged robot of claim 5 Symbol mounting and detecting.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2008024125A JP5040693B2 (en) | 2008-02-04 | 2008-02-04 | Legged robot and control method thereof |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2008024125A JP5040693B2 (en) | 2008-02-04 | 2008-02-04 | Legged robot and control method thereof |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2009184035A JP2009184035A (en) | 2009-08-20 |
| JP5040693B2 true JP5040693B2 (en) | 2012-10-03 |
Family
ID=41067832
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2008024125A Expired - Fee Related JP5040693B2 (en) | 2008-02-04 | 2008-02-04 | Legged robot and control method thereof |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP5040693B2 (en) |
Families Citing this family (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP5306959B2 (en) * | 2009-10-07 | 2013-10-02 | 本田技研工業株式会社 | Control device for legged mobile robot |
| JP5685842B2 (en) | 2010-07-12 | 2015-03-18 | セイコーエプソン株式会社 | Robot device and control method of robot device |
| JP2012171088A (en) | 2011-02-24 | 2012-09-10 | Olympus Corp | Master operation input device, and master-slave manipulator |
| JP5732993B2 (en) * | 2011-04-19 | 2015-06-10 | トヨタ自動車株式会社 | Robot control apparatus, control method thereof, and control program |
Family Cites Families (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH02212906A (en) * | 1989-02-14 | 1990-08-24 | Toshiba Corp | Multi-leg type moving device |
| JP2911984B2 (en) * | 1990-09-12 | 1999-06-28 | 本田技研工業株式会社 | Walking control device for legged mobile robot |
| JP3811073B2 (en) * | 2002-01-18 | 2006-08-16 | 本田技研工業株式会社 | Abnormality detection device for mobile robot |
| JP4483254B2 (en) * | 2002-10-01 | 2010-06-16 | ソニー株式会社 | Robot apparatus and control method of robot apparatus |
| JP4506716B2 (en) * | 2006-04-24 | 2010-07-21 | トヨタ自動車株式会社 | Legged robot |
-
2008
- 2008-02-04 JP JP2008024125A patent/JP5040693B2/en not_active Expired - Fee Related
Also Published As
| Publication number | Publication date |
|---|---|
| JP2009184035A (en) | 2009-08-20 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP4466715B2 (en) | Legged robot and control method thereof | |
| US6505096B2 (en) | Posture control system of legged mobile robot | |
| US8855821B2 (en) | Robot and control method thereof | |
| KR101687630B1 (en) | Walking robot and method for controlling balancing the same | |
| KR101985790B1 (en) | Walking robot and control method thereof | |
| US20120316682A1 (en) | Balance control apparatus of robot and control method thereof | |
| US20130079929A1 (en) | Robot and control method thereof | |
| US20130116820A1 (en) | Walking robot and control method thereof | |
| CN107351936B (en) | Walking control method, recording medium, and biped walking robot | |
| JP5181957B2 (en) | Robot control apparatus, robot control method, and robot control program | |
| KR20110082711A (en) | Walking control apparatus of robot and method for controlling the same | |
| JP2001328083A (en) | Floor shape estimating device for leg type moving robot | |
| US8509948B2 (en) | Walking robot and method of controlling the same | |
| JP2009184022A (en) | Apparatus, method and program for robot control | |
| JP5040693B2 (en) | Legged robot and control method thereof | |
| US8761926B2 (en) | Apparatus and method for robot control | |
| JP5198035B2 (en) | Legged robot and control method thereof | |
| JP4905041B2 (en) | Robot controller | |
| JP2009107033A (en) | Legged mobile robot and its control method | |
| JP2008093762A (en) | Walking robot | |
| JP2009101497A (en) | Legged robot and control method therefor | |
| JP2009255231A (en) | Walking control device and walking control method | |
| JP2009184034A (en) | Legged robot and control method of the same | |
| JP5228589B2 (en) | Legged robot and control method thereof | |
| JP4696728B2 (en) | Legged robot and its control method |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20100702 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20120120 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20120221 |
|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20120308 |
|
| TRDD | Decision of grant or rejection written | ||
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20120612 |
|
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20120625 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20150720 Year of fee payment: 3 |
|
| LAPS | Cancellation because of no payment of annual fees |