JP2011161524A - Bipedal walking robot and method of generating gait data for the same - Google Patents
Bipedal walking robot and method of generating gait data for the same Download PDFInfo
- Publication number
- JP2011161524A JP2011161524A JP2010023703A JP2010023703A JP2011161524A JP 2011161524 A JP2011161524 A JP 2011161524A JP 2010023703 A JP2010023703 A JP 2010023703A JP 2010023703 A JP2010023703 A JP 2010023703A JP 2011161524 A JP2011161524 A JP 2011161524A
- Authority
- JP
- Japan
- Prior art keywords
- time
- center
- gravity
- trajectory
- period
- 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.)
- Granted
Links
Images
Landscapes
- Manipulator (AREA)
Abstract
Description
本発明は、２脚歩行ロボット（Ｂｉｐｅｄ Ｒｏｂｏｔ）に関する。特に、ロボット動作中のリアルタイム処理に適した歩容データを効率的に生成する技術に関する。 The present invention relates to a biped robot. In particular, the present invention relates to a technique for efficiently generating gait data suitable for real-time processing during robot operation.
歩行のための脚関節の目標角の時系列データは歩容データと呼ばれる。２脚歩行ロボットは、適切な歩容データを用いないと転倒してしまう。転倒するか否かは、ロボットが現実に歩行して初めて確認できる事項であるので、本明細書では、理論上転倒せずに歩行できることを便宜上、「安定に歩行することができる」と表現する。さらに、理論上、安定な歩行を実現することができる歩容データを便宜上「安定な歩容データ」と称する。また、以下では簡単のため「２脚歩行ロボット」を単に「ロボット」と称する。 The time series data of the target angle of the leg joint for walking is called gait data. A biped robot would fall over without proper gait data. Whether or not the robot falls is a matter that can be confirmed only when the robot actually walks. Therefore, in this specification, for the sake of convenience, the robot can walk without falling down. . Further, the gait data that can realize a stable walking in theory is referred to as “stable gait data” for convenience. In the following, for the sake of simplicity, the “biped walking robot” is simply referred to as “robot”.
安定な歩容データを生成する一つの手法は、ＺＭＰ方程式に基づいてロボットの重心軌道を生成し、重心軌道から脚各関節の目標角を求めることである。転倒するか否かは、ロボットの重心軌道が支配的な要素であるからである。なお、重心軌道は、重心位置の時系列データの別称である。以下、本明細書では、「軌道」という用語を「時系列データ」と等価の意味で用いる。 One method for generating stable gait data is to generate a center of gravity trajectory of the robot based on the ZMP equation, and obtain a target angle of each leg joint from the center of gravity trajectory. Whether or not the robot falls is because the center of gravity trajectory of the robot is the dominant factor. The center-of-gravity trajectory is another name for time-series data of the center-of-gravity position. Hereinafter, in this specification, the term “orbit” is used in the same meaning as “time-series data”.
「重心ヤコビアン」と呼ばれるに変換式を用いることによって、各時刻における重心位置から脚各関節の目標角を求めることができる。このことは良く知られているので説明は省略する。脚各関節の目標角の時系列データは重心軌道、重心周りのロボットの角運動量、および、足先の軌道から算出される。即ち、「重心軌道」は、「歩容データ」の主要な要素である。特に、安定に歩行するためには重心軌道が重要である。そのため、本明細書では、「歩容データ」との用語を、重心軌道と同等のものとして扱う。ＺＭＰ方程式に基づく歩容データ生成方法は、例えば特許文献１〜３に開示されている。なお、本明細書の最後にも、ＺＭＰ方程式に基づく歩容データ生成方法に関する説明を掲載するので参照されたい。 By using a conversion formula called “center of gravity Jacobian”, the target angle of each leg joint can be obtained from the position of the center of gravity at each time. Since this is well known, description is omitted. The time-series data of the target angle of each leg joint is calculated from the center of gravity trajectory, the angular momentum of the robot around the center of gravity, and the foot tip trajectory. That is, the “center of gravity trajectory” is a main element of “gait data”. In particular, the center of gravity trajectory is important for stable walking. Therefore, in this specification, the term “gait data” is treated as equivalent to the center of gravity trajectory. Gait data generation methods based on the ZMP equation are disclosed in, for example, Patent Documents 1 to 3. It should be noted that an explanation regarding a gait data generation method based on the ZMP equation is also provided at the end of this specification.
歩容データは、安定して歩行するための条件を満たすことが求められるため、その算出には高い計算負荷が必要とされる。そのため、歩容データを効率よく求める技術が望まれている。歩容データを効率よく求める一つの手法が特許文献１〜３に開示されている。その方法は、ＺＭＰ方程式に現れる重心加速度を連続する３つの時刻の重心位置の変数によって近似した３項方程式を用いる。ＺＭＰ方程式の３項方程式近似による重心位置の求解法も本明細書の最後に掲載するので参照されたい。 Since the gait data is required to satisfy the conditions for stable walking, a high calculation load is required for the calculation. Therefore, a technique for efficiently obtaining gait data is desired. One method for efficiently obtaining gait data is disclosed in Patent Documents 1 to 3. The method uses a ternary equation that approximates the acceleration of the center of gravity appearing in the ZMP equation by the variable of the center of gravity position at three consecutive times. A method of solving the center of gravity position by approximating the ternary equation of the ZMP equation is also described at the end of this specification, so please refer to it.
本明細書は、特許文献１〜３とは別のアプローチで歩容データを効率よく求める技術を提供する。さらに、本明細書が開示する技術は、特許文献１〜３に開示される３項方程式による歩容データ生成方法に適用することで、さらなる計算効率化を図ることができる。 The present specification provides a technique for efficiently obtaining gait data by an approach different from Patent Documents 1 to 3. Furthermore, the technique disclosed in this specification can be applied to the gait data generation method based on the ternary equation disclosed in Patent Documents 1 to 3, thereby further improving the calculation efficiency.
前述したように、歩容データの計算負荷を増大させる主要な一因は、安定した歩行のための条件を満たす歩容データを求めることである。ここで、「安定した歩行のための条件」について考察する。例えば、現在時刻における遊脚が着地できることを（理論上）保証する歩容データであっても、その時点で体幹が大きく傾いていては、歩行を継続することができない。逆に、１０分後まで歩行を継続できることを（理論上）保証した上で現在時刻から１分後までの歩容データを生成するのは無駄である。そこで、「安定した歩行のための条件」の一つの目安として、２歩進めることを（理論上）保証して歩容データを作成することが妥当であるという考え方がある。ここで、「２歩」とは次の事象を意味する。即ち、現在時刻における遊脚が着地するタイミングが「１歩目」に相当し、現在時刻における立脚が遊脚に移行し次いで着地するタイミングが「２歩目」に相当する。即ち、「安定な歩容データ」とは、現在時刻における立脚が離床し、次いで遊脚から立脚に切り換わる予定の時刻まで歩行が継続できることを（理論上）保証する歩容データに相当する。より詳しくは、前記した予定時刻においてロボット重心が適切な範囲内に存在すること、及び予定時刻における重心速度が適切な大きさ以下であることを（理論上）保証する歩容データが「安定な歩容データ」に相当する。以下では、安定な歩容データであることを保証する予定時刻におけるロボット重心位置と重心速度の範囲を予定時刻における境界条件と称することがある。 As described above, the main factor that increases the calculation load of gait data is to obtain gait data that satisfies the conditions for stable walking. Here, “conditions for stable walking” will be considered. For example, even if the gait data guarantees (theoretically) that the free leg can be landed at the current time, walking cannot be continued if the trunk is tilted at that time. Conversely, it is useless to generate gait data from the current time to 1 minute after guaranteeing that (in theory) it is possible to continue walking until 10 minutes later. Therefore, there is an idea that it is appropriate to create gait data with (in theory) guaranteeing that two steps are taken as one guideline of “conditions for stable walking”. Here, “two steps” means the next event. That is, the timing at which the free leg lands at the current time corresponds to “first step”, and the timing at which the stance at the current time shifts to the free leg and then lands corresponds to “second step”. That is, the “stable gait data” corresponds to gait data that (theoretically) guarantees that walking can be continued until the time when the standing leg at the current time leaves the floor and then the scheduled transition from the free leg to the standing leg is performed. More specifically, gait data that guarantees (theoretical) that the center of gravity of the robot is within an appropriate range at the scheduled time and that the center of gravity speed at the scheduled time is less than or equal to an appropriate magnitude is “stable. It corresponds to “gait data”. In the following, the range of the robot center of gravity position and the center of gravity speed at the scheduled time for guaranteeing stable gait data may be referred to as a boundary condition at the scheduled time.
なお、「安定した歩行のための条件」の一つの目安は、「２歩」でなく、「３歩」であることが明らかに好ましい。従って別言すれば、「安定な歩容データ」とは、少なくとも現在時刻における立脚が遊脚に移行し次に遊脚から立脚に切り換わる予定時刻において重心位置が予め定められた範囲に存在することが保証できる重心軌道に相当する。以下では、「現在時刻における立脚が遊脚に移行し次に遊脚から立脚に切り換わる予定時刻」を「２歩目着地予定時刻」と称する。 Note that it is clearly preferable that one guideline of “conditions for stable walking” is not “2 steps” but “3 steps”. Therefore, in other words, the “stable gait data” means that the position of the center of gravity exists in a predetermined range at least at the scheduled time when the stance at the current time shifts to the free leg and then switches from the free leg to the stance. This corresponds to the center of gravity trajectory that can be guaranteed. Hereinafter, the “scheduled time when the standing leg at the current time shifts to the swinging leg and then switches from the swinging leg to the standing leg” is referred to as “second landing scheduled time”.
一歩行周期ＴＷよりも短い軌道計算周期で、２歩目着地予定時刻までの「安定な歩容データ」を繰り返し算出すれば、常に２歩目まで歩行できることが（理論上）保証され、結果的に、２歩以上歩行を継続できることになる（理論的には無限に歩行を継続できる）。なお、２歩目着地予定時刻は、一歩行周期ＴＷを予め定めておくことによって、現在時刻における歩行周期内のポジションと一歩行周期ＴＷから決定することができる。以下では、現在時刻から２歩目着地予定時刻までの期間を、軌道算出期間と称する。 By repeatedly calculating “stable gait data” up to the scheduled landing time for the second step with a trajectory calculation cycle shorter than one walking cycle TW, it is guaranteed (theoretically) that you can always walk to the second step, and as a result In addition, it is possible to continue walking for two or more steps (theoretically, walking can be continued indefinitely). The scheduled landing time for the second step can be determined from a position in the walking cycle at the current time and the one walking cycle TW by setting one walking cycle TW in advance. Hereinafter, a period from the current time to the scheduled landing time for the second step is referred to as a trajectory calculation period.
ここで、一歩行周期ＴＷは概ね１秒である。従って、軌道算出期間は概ね２秒となる。他方、関節のサーボ制御周期は、概ね５msec以下であり好ましくは２msec以下である。これは以下の理由による。サーボ制御周期をシステム全体のサンプリング周期と仮定すると、シャノンのサンプリング定理より、サーボ制御周期が５msecの場合はシステムのダイナミックレンジが理論上１００Ｈｚであり、サーボ制御周期が２msecの場合はシステムのダイナミックレンジが理論上２５０Ｈｚとなる。人間の応答速度が概ね０．１秒（即ち１００Ｈｚ）であるから、人間と同等のダイナミックレンジを有する２脚歩行ロボットを実現するためには、サーボ制御周期は５msec以下が必要ということになる。 Here, one walking cycle TW is approximately 1 second. Therefore, the trajectory calculation period is approximately 2 seconds. On the other hand, the servo control cycle of the joint is approximately 5 msec or less, preferably 2 msec or less. This is due to the following reason. Assuming that the servo control period is the sampling period of the entire system, according to Shannon's sampling theorem, the dynamic range of the system is theoretically 100 Hz when the servo control period is 5 msec, and the dynamic range of the system when the servo control period is 2 msec. Is theoretically 250 Hz. Since the response speed of a human is approximately 0.1 seconds (that is, 100 Hz), in order to realize a biped walking robot having a dynamic range equivalent to that of a human, the servo control cycle is required to be 5 msec or less.
サーボ制御周期に合わせて関節目標角を順次変更していく必要がある。即ち、サーボ制御周期に相当する第１時間間隔で関節目標角の時系列データが必要となる。そのためには、第１時間間隔で重心位置の時系列データが必要となる。前述したように軌道算出期間は概ね２秒であるから、サーボ制御周期を仮に２msecとすると１回の軌道計算で１０００点の重心位置のデータを算出しなければならず、高い計算能力が要求される。 It is necessary to sequentially change the joint target angle according to the servo control cycle. That is, time series data of the joint target angle is required at the first time interval corresponding to the servo control cycle. For this purpose, time-series data of the center of gravity position is required at the first time interval. As described above, the trajectory calculation period is approximately 2 seconds. Therefore, assuming that the servo control cycle is 2 msec, it is necessary to calculate the data of the center of gravity position of 1000 points in one trajectory calculation, and high calculation ability is required. The
発明者は、サーボ制御周期（５msec以下）、２歩目までの軌道算出期間（約２秒）、及び、軌道計算周期の差に着目した。ここで、軌道計算周期は、一歩行周期ＴＷ（約１秒）よりも小さいことが必要であるが、サーボ制御周期ほどには小さくなくてよい。現在時刻から少なくとも軌道計算周期に相当する期間（この期間を初期期間と称する）の間は、サーボ制御周期に相当する第１時間間隔で重心軌道（重心位置の時系列データ）を求める必要があるが、初期期間以降は、安定であることが保証できればよいので第１時間間隔で重心軌道を求める必要はない。なぜならば、軌道計算周期毎に重心軌道を再計算するのであれば、初期期間以降の重心軌道はサーボ制御には利用されないからである。 The inventor paid attention to the difference between the servo control period (5 msec or less), the trajectory calculation period up to the second step (about 2 seconds), and the trajectory calculation period. Here, the trajectory calculation period needs to be smaller than one walking period TW (about 1 second), but may not be as small as the servo control period. At least during the period corresponding to the trajectory calculation period from the current time (this period is referred to as the initial period), it is necessary to obtain the center of gravity trajectory (time series data of the center of gravity position) at the first time interval corresponding to the servo control period. However, after the initial period, it is only necessary to ensure that it is stable, so there is no need to obtain the center of gravity trajectory at the first time interval. This is because if the center-of-gravity trajectory is recalculated for each trajectory calculation period, the center-of-gravity trajectory after the initial period is not used for servo control.
即ち、初期期間以降の重心軌道は第１時間間隔より長い第２時間間隔で求めればよい。そうすることによって、サーボ制御に影響を与えることなく、２歩目着地予定時刻までの重心軌道を従来よりも少ない点数の時系列データで表すことができる。求める時系列データの点数が少なくなれば計算負荷を低減できる。例えば、サーボ制御周期（第１時間間隔）を２msec、軌道算出期間を２秒とすると、従来は１０００点の時系列データを計算する必要があった。初期期間（軌道計算周期）を５００msec、第２時間間隔を１０msecとすると、２秒の重心算出期間は、５００／２＋１５００／１０＝４００、即ち、４００点の時系列データに短縮することができる。この場合、データ点数が半分以下となるので、計算負荷も概算で半分以下となることが期待できる。即ち、初期期間以降の重心軌道をサーボ制御周期よりも長い時間間隔で求めることによって、安定な歩容データを算出する際の効率を格段に向上することができる。なお、実際には計算オーバーヘッド等を要するために計算時間は単純にデータ点数の比とはならないことに留意されたい。 That is, the center of gravity trajectory after the initial period may be obtained at a second time interval longer than the first time interval. By doing so, the center-of-gravity trajectory up to the scheduled time for landing at the second step can be represented by time-series data with a smaller number of points than before without affecting the servo control. If the number of required time series data is reduced, the calculation load can be reduced. For example, assuming that the servo control period (first time interval) is 2 msec and the trajectory calculation period is 2 seconds, it has been conventionally necessary to calculate 1000 time-series data. If the initial period (orbit calculation cycle) is 500 msec and the second time interval is 10 msec, the center-of-gravity calculation period of 2 seconds can be reduced to 500/2 + 1500/10 = 400, that is, 400 points of time-series data. In this case, since the number of data points is less than half, it can be expected that the calculation load is also roughly less than half. That is, by obtaining the center of gravity trajectory after the initial period at a time interval longer than the servo control cycle, the efficiency in calculating stable gait data can be significantly improved. It should be noted that the calculation time is not simply the ratio of the number of data points because the calculation overhead is actually required.
上記した手法の一実施形態は、２脚歩行ロボットの歩容データ生成方法として具現化できる。その方法は、軌道算出ステップと目標角算出ステップを含む。軌道算出ステップは、予め定められた軌道計算周期毎にＺＭＰ方程式に基づいて重心位置の時系列データを算出する。目標角算出ステップは、時系列データの各時刻における重心位置に基づいて（重心ヤコビアンを使って）脚関節の目標角を算出する。ここで、軌道算出ステップは、現在時刻から少なくとも軌道計算周期に相当する初期期間の間は関節のサーボ制御周期に相当する第１時間間隔で重心位置の時系列データを算出する。さらに軌道算出ステップは、初期期間以降は第１時間間隔よりも長い第２時間間隔で重心位置の時系列データを算出する。なお、軌道計算周期は、一歩行周期ＴＷよりも短い。また、目標角算出ステップは、初期期間における各時刻の重心位置から脚関節の目標角を算出する。 One embodiment of the above-described technique can be embodied as a gait data generation method for a biped walking robot. The method includes a trajectory calculation step and a target angle calculation step. The trajectory calculation step calculates time series data of the center of gravity based on the ZMP equation for each predetermined trajectory calculation period. The target angle calculation step calculates the target angle of the leg joint based on the position of the center of gravity at each time of the time series data (using the center of gravity Jacobian). Here, the trajectory calculation step calculates time-series data of the center of gravity position at a first time interval corresponding to the joint servo control cycle for at least an initial period corresponding to the trajectory calculation cycle from the current time. Furthermore, the trajectory calculation step calculates time series data of the center of gravity position at a second time interval longer than the first time interval after the initial period. The trajectory calculation cycle is shorter than one walking cycle TW. In the target angle calculation step, the target angle of the leg joint is calculated from the barycentric position at each time in the initial period.
通常、重心軌道の上下方向成分は予め与えられることが多い。従って軌道算出ステップにおいて算出する重心軌道は、歩行面に平行な面における重心軌道でよい。ここで「歩行面に平行な面」は、ロボットの進行方向を表すｘ軸と体側方向を表すｙ軸が張る平面を意味する。以下、「歩行面に平行な面」を、本明細書では床平行面と称する。なお、「サジタル面」は、ロボットの進行方向を表すｘ軸を含み、床平行面と直交する面を意味する。安定か否かは、床平行面内における重心軌道が重要である。安定か否かは、重心軌道が歩行面上に描かれる歩行経路から発散しないことが重要だからである。通常、安定した歩行では、床平行面内の重心軌道は、歩行経路を中心に体側方向に振れながら進んでいく。なお、重心軌道の鉛直方向成分は体幹の上下動に相当し、通常は既定の軌道が予め準備される。 Usually, the vertical component of the center of gravity trajectory is often given in advance. Therefore, the center-of-gravity trajectory calculated in the trajectory calculation step may be a center-of-gravity trajectory in a plane parallel to the walking surface. Here, the “plane parallel to the walking surface” means a plane extending by the x axis representing the traveling direction of the robot and the y axis representing the body side direction. Hereinafter, the “surface parallel to the walking surface” is referred to as a floor parallel surface in this specification. The “sagittal plane” means a plane that includes the x-axis that represents the traveling direction of the robot and is orthogonal to the floor parallel plane. The center of gravity trajectory in the plane parallel to the floor is important for the stability. This is because it is important that the center of gravity trajectory does not diverge from the walking route drawn on the walking surface. Normally, in stable walking, the center-of-gravity trajectory in the floor parallel plane advances while swinging in the body side direction around the walking path. The vertical component of the center of gravity trajectory corresponds to the vertical movement of the trunk, and a predetermined trajectory is usually prepared in advance.
前述したように、安定した歩行を実現するためには、軌道算出ステップは、軌道計算周期毎に、少なくとも現在時刻における立脚が遊脚に移り次いで遊脚から立脚に切り換わる予定時刻（２歩目着地予定時刻）までの期間（軌道算出期間）について、重心位置の時系列データを算出する。前述したように、２歩目着地予定時刻は、予め与えられる一歩行周期ＴＷによって定められる。 As described above, in order to realize stable walking, the trajectory calculation step includes at least a scheduled time (second step) at which the stance at the current time moves to the free leg and then switches from the free leg to the stance at every trajectory calculation period. The time series data of the center of gravity position is calculated for the period (orbit calculation period) until the scheduled landing time). As described above, the scheduled landing time for the second step is determined by a predetermined walking cycle TW.
上記した方法は、ＺＭＰ方程式を、床平行面内の重心加速度を連続する３つの時刻の重心位置の変数によって近似した３項方程式で表し、その３項方程式を解いて重心軌道を算出する手法と組み合わせるとさらに計算効率が向上する。３項方程式近似によって、ＺＭＰ方程式から床平行面内の重心加速度項を消去することができ、それによってＺＭＰ方程式を重心位置とＺＭＰとの関係式として表すことができる。詳細は実施例の後に付した「歩容データ算出方法についての説明」を参照されたい。ここでは、要点だけを説明する。３項方程式近似によって、離散時間系で順次に並ぶｎ時刻分のＺＭＰ方程式（時刻毎のＺＭＰ方程式を、微小時刻Δｔごとにｎ時刻分並べた方程式群）は、［Ａ］［Ｘ］＝［Ｑ］のマトリクス形式で表現できる。なお、重心軌道のｘ軸方向（ロボット進行方向）成分とｙ軸方向（ロボット体側方向）成分の夫々についてマトリクス表現ができる。両者は基本的に同じであるので、以下ではｘ軸方向成分に関して説明する。ここで、［Ａ］はｎ次のマトリクスであり、［Ｘ］は重心位置のｘ座標のｎ次列ベクトルであり、［Ｑ］はＺＭＰのｘ座標のｎ次列ベクトルである。従って、重心位置のｘ座標ベクトル［Ｘ］は、［Ａ］−１［Ｑ］で求められる。次数ｎは、重心位置の時系列データの時間間隔が短いほど大きくなる。従って、上記方法により初期期間以降の時間間隔（第２時間間隔）を長くすることによって、次数ｎを顕著に減らすことができ、行列演算に要する計算負荷を格段に低減することができる。上記したマトリクス方程式は、初期時刻と終端時刻の境界条件を与えることによって、重心軌道［Ｘ］について解くことができる（詳しくは「歩容データ算出方法についての説明」を参照されたい）。 The method described above represents the ZMP equation as a ternary equation that approximates the acceleration of the center of gravity in the floor parallel plane by the variable of the center of gravity position at three consecutive times, and calculates the center of gravity trajectory by solving the ternary equation. When combined, calculation efficiency is further improved. By ternary equation approximation, the center-of-gravity acceleration term in the floor parallel plane can be eliminated from the ZMP equation, whereby the ZMP equation can be expressed as a relational expression between the center-of-gravity position and ZMP. For details, refer to “Description of Gait Data Calculation Method” attached to the end of the example. Only the main points will be described here. By ternary equation approximation, ZMP equations for n times sequentially arranged in a discrete time system (a group of equations in which ZMP equations for each time are arranged for n times every minute time Δt) are expressed as [A] [X] = [ Q] matrix form. It should be noted that a matrix representation can be made for each of the x-axis direction (robot traveling direction) component and the y-axis direction (robot body side direction) component of the center of gravity trajectory. Since both are basically the same, the x-axis direction component will be described below. Here, [A] is an n-order matrix, [X] is an n-order column vector of the x-coordinate of the centroid position, and [Q] is an n-order column vector of the x-coordinate of ZMP. Therefore, the x-coordinate vector [X] of the centroid position is obtained by [A] −1 [Q]. The order n increases as the time interval of the time series data of the center of gravity position is shorter. Therefore, by increasing the time interval (second time interval) after the initial period by the above method, the order n can be remarkably reduced, and the calculation load required for the matrix operation can be significantly reduced. The matrix equation described above can be solved for the center-of-gravity trajectory [X] by giving a boundary condition between the initial time and the end time (for details, see “Description of Gait Data Calculation Method”).
３項方程式近似を採用する場合、第２時間間隔は、一歩行周期ＴＷを時分割するための予め定められた次数ｎで一歩行周期ＴＷを除した値で定めるとよい。予め定められた次数ｎは、上記した行列の次数に相当する。即ち、そのように定めると、行列の次数ｎを一定にすることができる。重心軌道を求めるための行列演算に要する計算時間を一定にすることができる。 When the ternary equation approximation is adopted, the second time interval may be determined by a value obtained by dividing the one walking cycle TW by a predetermined order n for time-sharing the one walking cycle TW. The predetermined order n corresponds to the order of the matrix described above. In other words, if so determined, the order n of the matrix can be made constant. The calculation time required for the matrix calculation for obtaining the center of gravity trajectory can be made constant.
重心軌道を求める手法は、上記したマトリクス法に限られない。ＺＭＰ方程式は、重心の運動方程式に相当する。即ち、ＺＭＰ方程式では、各時刻における重心の加速度が重心の位置とＺＭＰで表される。従ってＺＭＰ方程式で表される重心加速度を数値積分していくことによっても重心軌道を求めることができる。数値積分の際の時間ステップが時系列データの時間間隔に相当する。従って、数値積分によってＺＭＰ方程式から重心軌道を求める場合であっても、上記した手法は計算負荷を低減することができる。数値積分法は、ルンゲクッタ法や予測子修正子法など、良く知られた様々な手法を採用してよい。なお、上記した３項方程式近似は、オイラー法による近似に基本的に対応する。 The method for obtaining the center of gravity trajectory is not limited to the matrix method described above. The ZMP equation corresponds to the equation of motion of the center of gravity. That is, in the ZMP equation, the acceleration of the center of gravity at each time is expressed by the position of the center of gravity and ZMP. Therefore, the center of gravity trajectory can also be obtained by numerically integrating the center of gravity acceleration represented by the ZMP equation. A time step in numerical integration corresponds to a time interval of time series data. Therefore, even when the center of gravity trajectory is obtained from the ZMP equation by numerical integration, the above-described method can reduce the calculation load. For the numerical integration method, various well-known methods such as the Runge-Kutta method and the predictor corrector method may be employed. The ternary equation approximation described above basically corresponds to the approximation by the Euler method.
上記した手法の他の一実施形態は、２脚歩行ロボットに具現化することも好適である。その２脚歩行ロボットは、軌道算出部、目標角算出部、サーボ制御部を備える。軌道算出部は、予め定められた軌道計算周期毎にＺＭＰ方程式に基づいて床平行面における重心位置の時系列データを算出する。目標角算出部は、時系列データの各時刻における重心位置から脚関節の目標角を算出する。サーボ制御部は、サーボ制御周期毎に脚の計測関節角を目標角に追従するように制御する。軌道算出部は、現在時刻から少なくとも軌道計算周期に相当する初期期間の間はサーボ制御周期に相当する第１時間間隔で重心位置の時系列データを算出する。さらに軌道算出部は、初期期間以降は第１時間間隔よりも長い第２時間間隔で重心位置の時系列データを算出する。目標角算出部は、初期期間における各時刻の重心位置から脚関節の目標角を算出する。サーボ制御部は、サーボ制御周期毎に脚の実際の関節角（計測関節角）を目標角に追従するように制御する。なお、軌道算出部は、軌道計算周期毎に、少なくとも２歩目着地予定時刻までの重心位置の時系列データを算出する。そのような２脚歩行ロボットは、上記した歩容データ生成方法をリアルタイムに実行しながら安定に歩行することができる。 Another embodiment of the method described above is also preferably embodied in a biped robot. The biped robot includes a trajectory calculation unit, a target angle calculation unit, and a servo control unit. The trajectory calculation unit calculates time series data of the center of gravity position on the floor parallel plane based on the ZMP equation for each predetermined trajectory calculation period. The target angle calculation unit calculates the target angle of the leg joint from the position of the center of gravity at each time of the time series data. The servo control unit performs control so that the measurement joint angle of the leg follows the target angle every servo control period. The trajectory calculation unit calculates time series data of the center of gravity position at a first time interval corresponding to the servo control period for at least an initial period corresponding to the trajectory calculation period from the current time. Further, the trajectory calculation unit calculates time series data of the center of gravity position at a second time interval longer than the first time interval after the initial period. The target angle calculation unit calculates the target angle of the leg joint from the position of the center of gravity at each time in the initial period. The servo control unit performs control so that the actual joint angle (measured joint angle) of the leg follows the target angle every servo control period. Note that the trajectory calculation unit calculates time-series data of the center of gravity position at least up to the second landing scheduled time for each trajectory calculation period. Such a biped robot can stably walk while executing the above-described gait data generation method in real time.
図１に、歩行中の２脚歩行ロボット１００の側面図を示す。以下、２脚歩行ロボット１００を単にロボット１００と称する。夫々の脚（右脚１２Ｒと左脚１２Ｌ）は、股関節がロール軸、ピッチ軸、ヨー軸周り回転の３自由度を有し、膝関節がピッチ軸周り回転の１自由度を有し、足首関節がロール軸周り回転とピッチ軸周り回転の２自由度を有する。ロボット１００はさらに、足平にピッチ軸回りの関節を備えている。この関節は足指付け根の関節に相当する。足指付け根の関節を有すると、人間の歩行動作と同じ様に、足指の底面（及び母趾球）で接地しつつ踵を上げることができ、円滑な歩行動作を達成することができる。各関節はモータ１４とセンサ１６（エンコーダ）を搭載している。センサ１６は関節角を検出する。体幹１０にはコントローラ２０が内蔵されている。コントローラ２０が、センサ１６のセンサデータに基づいてモータ１４を制御する。コントローラ２０が各モータを適切に制御することによって、ロボット１００は歩行する。本明細書が開示する技術は、脚の幾何学的な構造、各関節のサーボ制御ルールに依存しないことに留意されたい。従って、脚の構造、及び、関節サーボ制御ルールの詳しい説明は省略する。上記した７自由度の脚は一例であり、本明細書が開示する技術は、当然、他の自由度を有する脚、或いは他の幾何学的構造を有する脚を備えた２脚歩行ロボットに適用することができる。また、２脚歩行ロボットは腕や頭を備えていてもよい。
FIG. 1 shows a side view of a
座標系について説明する。図１において、ｘ軸はロボット進行方向に相当し、ｙ軸はロボット体側方向に相当する。ｚ軸はｘ軸及びｙ軸に直交する。本明細書では、ｘ軸とｙ軸が張る平面を「床平行面」と称する。ｘ軸とｚ軸が張る平面はサジタル面と呼ばれている。図１の上側の側面図がサジタル面に相当する。図１の下側は、床平行面を示している。床平行面は歩行面に相当する。図１下側の床平行面は、足の着地位置を示している。なお、図１下側の床平行面の図は、後述の「歩容データ算出についての補足事項」の項にて説明する際に用いる。 The coordinate system will be described. In FIG. 1, the x-axis corresponds to the robot traveling direction, and the y-axis corresponds to the robot body side direction. The z axis is orthogonal to the x axis and the y axis. In this specification, a plane formed by the x-axis and the y-axis is referred to as a “floor parallel plane”. A plane extending between the x-axis and the z-axis is called a sagittal plane. The upper side view of FIG. 1 corresponds to the sagittal plane. The lower side of FIG. 1 shows a floor parallel plane. The floor parallel plane corresponds to the walking plane. The floor parallel plane on the lower side of FIG. 1 indicates the landing position of the foot. In addition, the figure of the floor parallel plane on the lower side of FIG. 1 is used in the description of “Additional items for gait data calculation” described later.
ロボット１００は、安定した歩行を実現するための歩容データを高速に求めることができる点に特徴がある。なお、「安定した歩行」とは、前述したように、少なくとも２歩進むことが理論上保証される歩容データを意味する。まず、歩容データについて概説する。歩容データは、実質的には重心軌道（重心位置の時系列データ）で決まる。歩容データは、ロボットが安定に歩行できなれば意味が無く、安定に歩行できるか否かは重心軌道に依存するからである。また、最終的には歩容データは各関節の目標角の時系列データで表現されるが、重心ヤコビアンによって重心軌道から目標角の時系列データが算出できるので、「歩容データ」は実質的には「重心軌道」に相当するとみなしてよい。「重心ヤコビアン」については脚式ロボットの技術分野では良く知られているので詳しい説明は省略する。
The
前述したように安定した歩容データは、実質的には、床平行面における重心軌道で定まる。なぜならば、床平行面における重心軌道が歩行経路から大きく離れないことが即ち「安定した歩行」に相当するからである。本実施例のロボット１００は、現在時刻Ｔ０から２歩目着地予定時刻Ｔ２までの重心軌道が歩行経路から大きくずれないことを理論上保証する歩容データを算出する。そのような安定な歩容データの算出方法は、ＺＭＰ方程式に基づいて算出できることが知られている。２歩目着地予定時刻Ｔ２までの重心軌道の具体的な算出方法は、後の「歩容データ算出方法についての説明」の項にて説明するのでそちらを参照されたい。なお、本明細書が開示する新規な歩容データ算出技術は、物理現象的な観点からは従来の算出技術と同じ技術を用いるが、計算の仕方に工夫があり、従来よりも効率よく歩容データを算出することを可能にする。
As described above, stable gait data is substantially determined by the center-of-gravity trajectory in the floor parallel plane. This is because the center of gravity trajectory on the floor parallel plane does not greatly deviate from the walking path, that is, it corresponds to “stable walking”. The
図１の各符号について説明する。図１の（Ａ）は、現在時刻Ｔ０におけるロボット１００の姿勢を示している。現在時刻Ｔ０では、ロボット１００の左脚１２Ｌが立脚となっており、右脚１２Ｒが遊脚となっている。（Ｂ）は１歩目着地予定時刻Ｔ１における姿勢（予定値）を示し、（Ｃ）は２歩目着地予定時刻Ｔ２における姿勢（予定値）を示している。「１歩目着地予定時刻Ｔ１」とは、現在時刻Ｔ０における遊脚（右脚１２Ｒ）が着地する予定の時刻に相当する。２歩目着地予定時刻Ｔ２は、現在時刻Ｔ０における立脚（左脚１２Ｌ）が離床し、次いで遊脚から立脚に切り換わる予定（着地予定）の時刻に相当する。なお、一歩行周期ＴＷは予め与えられる。現在の歩行周期の開始時刻は既に特定されているので、与えられた一歩行周期ＴＷから時刻Ｔ１とＴ２が定まる。
Each symbol in FIG. 1 will be described. FIG. 1A shows the posture of the
ｘｇ（ｉ）、ｙｇ（ｉ）、及び、ｚｇ（ｉ）は、それぞれ、時刻ｉにおける重心Ｇのｘ座標、ｙ座標、及び、ｚ座標を表している。ここで、「座標」は、「位置」に相当する。ｘｇ（Ｔ０）は、現在時刻Ｔ０における重心Ｇのｘ座標（ｘ軸方向の重心位置）を表している。ｘｇ（Ｔ１）、ｘｇ（Ｔ２）、は夫々、１歩目着地予定時刻Ｔ１、２歩目着地予定時刻Ｔ２における重心Ｇのｘ座標（予定値）を表している。ｖｇ（Ｔ０）は、現在時刻Ｔ０における重心Ｇの速度のｘ軸方向成分を表している。ｖｇ（Ｔ０）は、脚の各関節が備えるセンサ１６のセンサデータから求められる。ｖｇ（Ｔ１）、ｖｇ（Ｔ２）、は夫々、１歩目着地予定時刻Ｔ１、２歩目着地予定時刻Ｔ２における重心Ｇの速度のｘ軸方向成分を表している。ｖｇ（Ｔ１）、ｖｇ（Ｔ２）、は予め与えられる値である。例えば、ロボット１００が一定速度Ｖ０で直線歩行する場合、「ｖｇ（Ｔ１）＝ｖｇ（Ｔ２）＝Ｖ０」となる。
x g (i), y g (i), and z g (i) represent the x, y, and z coordinates of the center of gravity G at time i, respectively. Here, “coordinates” correspond to “positions”. x g (T0) represents the x coordinate (the position of the center of gravity in the x-axis direction) of the center of gravity G at the current time T0. x g (T1) and x g (T2) represent the x coordinate (scheduled value) of the center of gravity G at the first step landing scheduled time T1 and the second step landing scheduled time T2, respectively. v g (T0) represents the x-axis direction component of the velocity of the center of gravity G at the current time T0. v g (T0) is obtained from the sensor data of the
ｘｐ（ｉ）は、現在時刻における遊脚（右脚１２Ｒ）の足の軌道を表している。本実施例では、足の軌道は、足のつま先に固定された点の軌道で現される。ｘｐ（Ｔ０）は、現在時刻Ｔ０における遊脚足のｘ座標（左足位置）を表している。ｘｐ（Ｔ１）は、着地予定時刻Ｔ１における遊脚足のｘ座標、即ち、遊脚の着地予定位置を示している。
x p (i) represents the trajectory of the free leg (
図１の下側の床平行面について簡単に説明する。詳しくは、後の「歩容データ算出方法についての説明」の項で述べる。Ｆ０は、現在時刻における立脚（左脚）足の位置を示している。Ｆ１、Ｆ２は、右脚足の着地予定位置、左脚足の次の着地予定位置を表している。符号ＬＰａｔｈが示す直線は歩行経路を表している。符号ＬＺＭＰが示す破線はＺＭＰ軌道を表しており、符号Ｌｇが示す実線は床平行面における重心軌道を表している。本明細書においてＺＭＰとは、接地している足の裏面に分布している床圧力の中心（圧力中心）を意味する。この定義は、ＺＭＰの概念を始めて提唱したユーゴスラビアのブコブラトビッチの定義に相当する。なお、図１の一点鎖線は、時刻Ｔ１において左足が位置Ｆ０で接地しており右足が位置Ｆ１で接地している両脚支持期間における支持多角形を示している。「支持多角形」もブコブラトビッチの定義に準ずる。支持多角形は、片脚立脚期間では接地している足の足裏面に等しい。両脚接地期間では上記したように接地している両足位置によって支持多角形が画定される。 The floor parallel surface on the lower side of FIG. 1 will be briefly described. Details will be described later in the section “Description of Gait Data Calculation Method”. F0 indicates the position of the standing leg (left leg) at the current time. F1 and F2 represent the planned landing position of the right leg foot and the next planned landing position of the left leg foot. The straight line indicated by the symbol L Path represents the walking route. The broken line indicated by the symbol L ZMP represents the ZMP trajectory, and the solid line indicated by the symbol L g represents the center of gravity trajectory on the floor parallel plane. In this specification, ZMP means the center of the bed pressure (center of pressure) distributed on the back surface of the grounded foot. This definition corresponds to the definition of Yugoslavia's Bukobratovic, which first proposed the concept of ZMP. 1 indicates a support polygon in a both-leg support period in which the left foot is in contact with the position F0 and the right foot is in contact with the position F1 at time T1. "Supporting polygon" also follows the definition of Bukobratovic. The support polygon is equal to the sole of the foot that is in contact with the ground during the one-leg stand. In the both-leg contact period, the support polygon is defined by the positions of both feet that are in contact as described above.
図１下側の床平行面の図は、安定した歩容データ、即ち安定した重心軌道Ｌｇを示している。重心軌道Ｌｇは歩行経路ＬＰａｔｈに対して左右に振れながらも歩行経路ＬＰａｔｈに沿っているからである。安定な重心軌道の算出方法については「歩容データ算出方法についての説明」を参照されたい。 FIG floor parallel surfaces of Figure 1 the lower shows a steady gait data, i.e. stable trajectory of the center of gravity L g. Trajectory of the center of gravity L g is because also along the walking path L Path while swung to the right and left with respect to the walking path L Path. Refer to “Explanation of Gait Data Calculation Method” for the calculation method of stable center of gravity trajectory.
ロボット１００は、現在時刻Ｔ０において、２歩目着地予定時刻Ｔ２までの重心軌道を算出する。なお、以下では、重心位置のｘ成分ｘｇ（ｉ）について説明し、ｙ成分ｙｇ（ｉ）についてはｘ成分と同様であるので説明は省略する。ロボット１００は、現在時刻Ｔ０において、重心位置のｘ成分ｘｇ（ｉ）、（ただしｉ＝０からＴ２）を算出する。
The
図２を用いてロボット１００の歩容データ生成処理をさらに説明する。図２は、図１の一部を拡大した図である。図２は、現在時刻Ｔ０から１歩目着地予定時刻Ｔ１までの期間を拡大した図である。重心軌道Ｌｇは、重心位置の時系列データであり、現在時刻Ｔ０から２歩目着地予定時刻Ｔ２までの重心位置の点列として求められる。ロボット１００は、予め定められた軌道計算周期（例えば２０msec）毎に、２歩目着地予定時刻Ｔ２までの重心軌道を算出する。このとき、ロボット１００は、現在時刻Ｔ０から、軌道計算周期に相当する初期期間ＴＳ１の間は、関節サーボ制御周期に相当する第１時間間隔ΔＴ１で重心位置の時系列データを算出する。初期期間ＴＳ１以降、２歩目着地予定時刻Ｔ２までの期間ＴＳ２は、第１時間間隔ΔＴ１よりも長い第２時間間隔ΔＴ２で重心軌道を算出する。図２では、初期期間ＴＳ１の間の重心軌道Ｌｇ−１が第１時間間隔ΔＴ１で算出され、初期期間ＴＳ１以降の重心軌道Ｌｇ−２が第２時間間隔ΔＴ２で算出される。
The gait data generation process of the
ロボット１００は、初期期間ＴＳ１の各時刻における重心位置（重心位置はΔＴ１間隔で求められている）から、各関節の目標角Ｌｐ−１を算出する。各時刻の関節目標角は、対応する時刻の重心位置を重心ヤコビアンに代入することによって得られる。こうして、ロボット１００は、現在時刻から初期期間ＴＳ１までの間、サーボ制御周期毎の関節目標角を得る。なお、初期期間ＴＳ１以降に相当する足軌道Ｌｐ−２は、現在時刻では求める必要がない。Ｌｐ−２は、現在時刻Ｔ０から軌道計算周期に相当する時間後に改めて、第１時間間隔ΔＴ１ごとの時系列データとして算出される。
The
上記説明したアルゴリズムを実行するコントローラ２０のブロック図を図３に示し、制御フローチャートを図４に示す。コントローラ２０は、軌道算出部２１、目標角算出部２２、メモリ２３、タスク管理部２４、サーボ制御部２５、サーボアンプ２６、及びリアルタイムクロック（ＲＴＣ）２７を備える。軌道算出部２１と目標角算出部２２によって、軌道算出タスクが実行され、サーボ制御部２５によってサーボ制御タスクが実行される（図４参照）。タスク管理部２４は、リアルタイムクロック２７の信号に基づいて、軌道計算周期毎に軌道算出タスクを起動し、サーボ制御周期毎にサーボ制御タスクを起動する。なお、前述したように、軌道計算周期は例えば２０msecでありサーボ制御周期は２msecである。軌道算出タスクとサーボ制御タスクは並列に実行される。
A block diagram of the
歩行経路は上位コントローラ９０からロボットのコントローラ２０に与えられる。上位コントローラ９０は、ロボット１００と接続されたコンピュータでよい。
The walking route is given from the
軌道算出タスクを説明する。軌道算出部２１は、センサ１６のデータを読み込むとともに、２歩目着地予定時刻Ｔ２までの重心軌道を算出する（Ｓ１２）。次に目標角算出部２２が目標角を算出する（Ｓ１４）。ここで、重心軌道は２歩目着地予定時刻Ｔ２まで算出されるが、目標角は現在時刻から初期期間ＴＳ１までの間の各時刻の重心軌道に対応する分だけが算出される。算出された目標角の時系列データはメモリ２３に格納される。ステップＳ１２の処理が軌道算出ステップに相当し、ステップＳ１４の処理が目標角算出ステップに相当する。後に「歩容データ算出方法についての説明」で述べる、軌道算出ステップでは、現在時刻Ｔ０から２歩目着地予定時刻Ｔ２まで（即ち軌道算出期間の間）の重心軌道が、２歩目着地予定時刻Ｔ２（終端時刻）における既定の重心速度と重心位置範囲を境界条件として算出される。
The trajectory calculation task will be described. The
サーボ制御タスクについて説明する、サーボ制御タスクは、軌道算出タスクと並列に、サーボ制御周期毎に起動される。サーボ制御部２５は、まずセンサデータを取得する（Ｓ２２）。次に、メモリ２３から、記憶されている目標角の時系列データの中から、現在のサーボ制御時刻に対応する目標角を読み出す（Ｓ２４）。コントローラ２０は、センサデータと読み出した目標角との偏差に基づいて、各関節のモータ１４への指令値を算出する（Ｓ２６）。ステップＳ２６では、例えば、ＰＩＤ制御ルールに基づいて指令値が算出される。算出された指令値はサーボアンプ２６へ出力される（Ｓ２８）。サーボアンプ２６は、入力された指令値に基づいて各モータ１４を制御する。
The servo control task will be described. The servo control task is started for each servo control period in parallel with the trajectory calculation task. The
ロボット１００の各関節は、サーボ制御周期（即ち第１時間間隔ΔＴ１）毎の目標角に追従する。その結果、ロボット１００はその重心が算出された重心軌道に追従するように動作する。すなわちロボット１００は安定に歩行する。軌道計算周期毎に軌道算出タスクが軌道され、その都度、現在時刻から初期期間分の目標角データが算出される。毎回の目標角データは常に２歩目まで安定に歩行することが（理論上）保証されている。そのため、ロボット１００は、（理論上）無限に安定に歩行し続けることができる。
Each joint of the
後の「歩容データ算出方法についての説明」の項にて述べるように、ロボット１００は、各時刻におけるＺＭＰ方程式を、床平行面内の重心加速度を連続する３つの時刻の重心位置の変数によって近似した３項方程式で表し、現在時刻と終端時刻の境界条件を与えることによって各時刻の３項方程式を解いて重心位置の時系列データを算出する。現在時刻の境界条件は、現在時刻の重心速度ｖｇ（Ｔ０）と位置ｘｇ（Ｔ０）である。終端時刻の境界条件は、２歩目着地予定時刻Ｔ２における重心速度ｖｇ（Ｔ２）と予め決められた２歩目安定保証領域である。２歩目安定保証領域は、後の「歩容データ算出方法についての説明」の項にて説明する。さらにロボット１００は、第２時間間隔ΔＴ２を次のルールによって決定する。コントローラ２０は、一歩行周期ＴＷを、予め定められた次数ｎで除した値でΔＴ２を定める。次数ｎは、後述する行列［Ａ］の次数である。
As will be described later in the section “Explanation of Gait Data Calculation Method”, the
実施例のロボット１００の利点を説明する。ロボット１００は、リアルタイムに２歩目着地予定時刻Ｔ２までの重心軌道を算出する。別言すれば、ロボット１００は、２歩目まで安定して歩行できることが理論上保証される重心軌道を算出する。ロボット１００は、２歩目までの重心軌道のうち、関節目標角を算出するための初期期間ＴＳ１の重心軌道を、サーボ制御周期と同じ第１時間間隔ΔＴ１で求める。初期期間ＴＳ１以降、２歩目着地予定時間Ｔ２までの後期間ＴＳ２は、第１時間間隔ΔＴ１より長い第２時間間隔ΔＴ２で重心軌道を求める。第２時間間隔ΔＴ２を長くすることによって、２歩目着地予定時刻Ｔ２まで重心軌道を求めるための計算負荷を軽減できる。
Advantages of the
後期間ＴＳ２の重心軌道を求める際、第２時間間隔ΔＴ２は、３項方程式で近似したＺＭＰ方程式の係数行列［Ａ］の次数ｎが一定となるように決定される。従って、２歩目着地予定時刻Ｔ２までの重心軌道算出に要する演算時間を一定にすることができる。 When obtaining the center of gravity trajectory of the later period TS2, the second time interval ΔT2 is determined so that the order n of the coefficient matrix [A] of the ZMP equation approximated by the ternary equation is constant. Accordingly, the calculation time required for calculating the center of gravity trajectory up to the second landing scheduled time T2 can be made constant.
（歩容データ算出方法についての説明）ＺＭＰ方程式に基づく重心軌道の算出方法について説明する。ここでは説明のため、ロボット全体を一つの剛体で表す。また、ここでは、重心軌道のｘ軸成分ｘｇ（ｉ）について説明する。以下の議論はｙ軸成分についても成立する。図５に、時刻（ｉ）における、ロボットを模式化した図（サジタル面における側面図）を示す。図５において、ｑｘ（ｉ）は、ＺＭＰのｘ座標を表す。図５のＦｒは、足裏に加わる圧力分布（反力分布）に等価な集中反力を示す。ＺＭＰは、足裏に分布する圧力（反力）に等価な集中反力が床面と交差する点で定義されるので、Ｆｒの起点がＺＭＰの位置を示す。ｇは重力加速度を表す。ｒｙ（ｉ）は重心Ｇに作用するｙ軸周りのモーメントを示す。モーメントｒｙ（ｉ）は、ロボットｙ軸周りの角運動量の時間微分に相当する。時刻（ｉ）における重心Ｇを中心とするｙ軸回りの釣り合い方程式は次の（数１）で与えられる。 (Description of Gait Data Calculation Method) A method of calculating the center of gravity trajectory based on the ZMP equation will be described. Here, for the sake of explanation, the entire robot is represented by one rigid body. Here, the x-axis component x g (i) of the gravity center trajectory will be described. The following discussion also holds for the y-axis component. FIG. 5 shows a schematic diagram (side view on the sagittal plane) of the robot at time (i). In FIG. 5, q x (i) represents the x-coordinate of ZMP. Fr in FIG. 5 indicates a concentrated reaction force equivalent to a pressure distribution (reaction force distribution) applied to the sole. Since ZMP is defined by a point where a concentrated reaction force equivalent to the pressure (reaction force) distributed on the sole intersects the floor surface, the starting point of Fr indicates the position of ZMP. g represents gravitational acceleration. r y (i) represents a moment around the y axis acting on the center of gravity G. The moment r y (i) corresponds to the time derivative of the angular momentum about the robot y axis. The balance equation around the y axis centered on the center of gravity G at time (i) is given by the following (Equation 1).
ここで、ｍはロボット全体の質量を表す。ｚｇ（ｉ）は重心Ｇのｚ座標を表す。上付き文字の（２）は時間２回微分を表す。即ち、ｘｇ （２）（ｉ）は、重心Ｇの加速度のｘ軸成分を表す。 Here, m represents the mass of the entire robot. z g (i) represents the z coordinate of the center of gravity G. The superscript (2) represents twice the time differentiation. That is, x g (2) (i) represents the x-axis component of the acceleration of the center of gravity G.
重心Ｇの加速度のｚ軸成分、即ち、ｚｇ （２）（ｉ）は予め与えられる。ｚｇ （２）（ｉ）は、歩行時の腰の上下動にほぼ相当する。重心Ｇの加速度のｘ軸成分、即ち、ｘｇ （２）（ｉ）、及び、重心Ｇの速度のｘ軸成分ｘｇ （１）（ｉ）は、微小時間間隔Δｔを用いたオイラー近似によると次の（数２）で表される。 The z-axis component of the acceleration of the center of gravity G, that is, z g (2) (i) is given in advance. z g (2) (i) substantially corresponds to the vertical movement of the waist during walking. The x-axis component of the acceleration of the center of gravity G, that is, x g (2) (i), and the x-axis component x g (1) (i) of the velocity of the center of gravity G are based on Euler approximation using a minute time interval Δt. And the following (Equation 2).
（数２）より、重心Ｇの加速度のｘ軸成分ｘｇ （２）（ｉ）は重心Ｇの連続する３つの時刻の位置、ｘｇ（ｉ）、ｘｇ（ｉ＋１）、ｘｇ（ｉ＋２）によって次の（数３）で近似できる。 From (Equation 2), the x-axis component x g (2) (i) of the acceleration of the center of gravity G is the position of three consecutive times of the center of gravity G, x g (i), x g (i + 1), x g (i + 2). ) Can be approximated by the following (Equation 3).
（数３）を（数１）に代入し、ｒｙ（ｉ）＝０とおくと次の（数４）が得られる。 Substituting (Equation 3) into (Equation 1) and setting r y (i) = 0, the following (Equation 4) is obtained.
（数４）は、（数１）のＺＭＰ方程式において、床平行面内の重心加速度ｘｇ （２）（ｉ）を連続する３つの時刻の重心位置の変数、即ち、ｘｇ（ｉ＋１）、ｘｇ（ｉ）及び、ｘｇ（ｉ−１）によって近似した３項方程式である。ｉ＝１からｎまでについて、（数４）をマトリクス表現すると次の（数５）が得られる。 (Equation 4) is a variable of the gravity center position at three consecutive times of the gravity acceleration x g (2) (i) in the floor parallel plane in the ZMP equation of (Equation 1), that is, x g (i + 1), It is a ternary equation approximated by x g (i) and x g (i−1). When (Equation 4) is expressed in matrix for i = 1 to n, the following (Equation 5) is obtained.
なお、（数５）のｑｘ（１）とｑｘ（ｎ）は、他のｑｘ（ｉ）すなわち、ＺＭＰの位置とは別の意味を有している。（数５）の第１行は、初期速度が現在時刻の重心速度に一致することを保証し、第ｎ行は、２歩目着地予定時刻Ｔ２における重心速度が予定された速度に一致することを保証する境界条件に相当する。（数２）の定義から、ｑｘ（１）＝ｖ（Ｔ０）Δｔ、ｑｘ（ｎ）＝ｖ（Ｔ２）Δｔである。ｖ（Ｔ０）とｖ（Ｔ２）は、第１図に示した通り、現在時刻Ｔ０と２歩目着地予定時刻Ｔ２における重心Ｇの速度のｘ軸成分である。（数５）より、重心軌道のｘ軸成分［Ｘｇ］（即ち、ｘｇ（ｉ），ｉ＝１〜ｎ）は、次の（数６）で求めることができる。 Note that q x (1) and q x (n) in (Expression 5) have different meanings from the other q x (i), that is, the position of ZMP. The first line of (Equation 5) ensures that the initial speed matches the center of gravity speed at the current time, and the nth line is that the center of gravity speed at the second landing scheduled time T2 matches the planned speed. This corresponds to a boundary condition that guarantees From the definition of (Equation 2), q x (1) = v (T0) Δt and q x (n) = v (T2) Δt. As shown in FIG. 1, v (T0) and v (T2) are x-axis components of the velocity of the center of gravity G at the current time T0 and the scheduled second step landing time T2. From (Equation 5), the x-axis component [Xg] (that is, x g (i), i = 1 to n) of the gravity center trajectory can be obtained by the following (Equation 6).
（数６）は、ＺＭＰ軌道［Ｑｘ］を与えると重心軌道［Ｘｇ］が求まることを表している。再び図１を参照して、（数６）を用いた重心軌道演算を説明する。図１下側の床平行面を参照されたい。今、歩行速度Ｖ０＝ｖ（Ｔ０）＝ｖ（Ｔ１）＝ｖ（Ｔ２）は与えられている。また、一歩行周期ＴＷのＺＭＰ軌道も与えられている。一歩行周期のＺＭＰ軌道が与えられているということは、１歩目と２歩目の足着地位置（図１の足位置Ｆ１とＦ２）が与えられていることを意味する。即ち、１歩目と２歩目の足位置Ｆ１とＦ２によって支持多角形が定まり、ＺＭＰ軌道はその支持多角形内を移動するように予め定められている。なお、与えられたＺＭＰ軌道は、仮の値であり、後述する演算によって、安定性が保証されるＺＭＰ軌道（即ち１歩目と２歩目の足着地位置）が改めて求まる。（数５）、（数６）における［Ｑｘ］がＺＭＰ軌道に相当し、［Ｘｇ］が重心軌道（但しｘ軸方向成分）に相当する。 (Expression 6) represents that the center-of-gravity trajectory [Xg] is obtained when the ZMP trajectory [Qx] is given. Referring to FIG. 1 again, the gravity center trajectory calculation using (Equation 6) will be described. See the floor parallel plane at the bottom of FIG. Now, the walking speed V0 = v (T0) = v (T1) = v (T2) is given. A ZMP trajectory with one walking cycle TW is also given. The fact that a ZMP trajectory having one walking cycle is given means that the first and second foot landing positions (foot positions F1 and F2 in FIG. 1) are given. That is, the support polygon is determined by the foot positions F1 and F2 of the first step and the second step, and the ZMP trajectory is determined in advance so as to move within the support polygon. The given ZMP trajectory is a tentative value, and the ZMP trajectory (that is, the foot landing position of the first step and the second step) for which stability is guaranteed is obtained again by an operation described later. [Qx] in (Equation 5) and (Equation 6) corresponds to the ZMP trajectory, and [Xg] corresponds to the gravity center trajectory (however, the x-axis direction component).
歩行経路ＬＰａｔｈが与えられると、ロボット１００のコントローラ２０は、与えられた歩行経路に沿って、１歩目と２歩目の足着地位置（図１の足位置Ｆ１とＦ２）及び、ＺＭＰ軌道、即ち（数６）の［Ｑｘ］を仮決定する。また、前述したとおり。重心軌道のｚ軸成分（ｚｇ（ｉ）、ｚｇ （２）（ｉ））も予め与えられており、行列［Ａ］の各要素（ａｉ、ｂｉ、及びｃｉ）が（数４）から算出される。［Ａ］と［Ｑｘ］が与えられるので、［Ａ］の逆行列を演算し、（数６）から重心軌道（ここでは、重心軌道のｘ軸成分ｘｇ（ｉ））が求められる。このときのｘｇ（ｉ）はまだ仮の値である。次に、ｉ＝ｎ−１における重心位置ｘｇ（ｎ−１）が所定の範囲内であるか否かを確認する。なお、前述したとおり、（数５）の第ｎ行はＺＭＰ位置とは異なる別の意味を有しているので、ｎ−１における重心位置ｘｇ（ｎ−１）を使う。また、所定の範囲とは、１歩目着地予定位置Ｆ１と２歩目着地予定位置Ｆ２の中間やや前方の領域（２歩目安定保証領域と称する）に設定されている。そのような２歩目安定保証領域は、２歩目が着地したときに重心位置が両足のラテラル方向略中央に位置することを保証し、安定歩行を（理論上）保証する。
When the walking path L Path is given, the
重心位置ｘｇ（ｎ−１）が２歩目安定保証領域外である場合は、仮決定したＺＭＰ軌道が不適切であることを示している。この場合は、仮決定したＺＭＰ軌道を何らかのルールに基づいて修正して上記演算を繰り返す。そのような繰り返し演算（いわば収束演算）を重心位置ｘｇ（ｎ−１）が２歩目安定保証領域内となるまで行う。上記アルゴリズムは、重心軌道のｙ軸成分についても当てはまる。こうして、安定な重心軌道（即ち歩容データ）が求まる。 If the center-of-gravity position x g (n−1) is outside the second-step stability guarantee region, it indicates that the temporarily determined ZMP trajectory is inappropriate. In this case, the tentatively determined ZMP trajectory is corrected based on some rule and the above calculation is repeated. Such repeated calculation (so-called convergence calculation) is performed until the gravity center position x g (n−1) is within the second-step stability guarantee region. The above algorithm also applies to the y-axis component of the centroid trajectory. In this way, a stable center of gravity trajectory (ie, gait data) is obtained.
ｉ＝０とｎにおける重心速度ｖｇ（Ｔ０）、ｖｇ（Ｔ２）と、ｉ＝ｎ−１における重心位置ｘｇ（ｎ−１）が２歩目安定保証領域内に存在することが、（数６）を解くときの境界条件に相当する。 The center-of-gravity speeds v g (T0) and v g (T2) at i = 0 and n and the center-of-gravity position x g (n−1) at i = n−1 exist in the second-step stability guarantee region. This corresponds to the boundary condition when solving (Equation 6).
上記の歩容データ（重心軌道）求解手法では、重心Ｇに作用するｙ軸周りのモーメントｒｙ（ｉ）をゼロと仮定した。モーメントｒｙ（ｉ）を考慮した歩容データ求解手法は、例えば、本願の発明者による特許出願（特願２００９−２９１２５７）で提唱されている。 In the above gait data (trajectory of the center of gravity) solving approach, assuming moment r y (i) around the y-axis acting on the center of gravity G to zero. The gait data solving method considering the moment r y (i) is proposed in, for example, a patent application (Japanese Patent Application No. 2009-291257) by the inventor of the present application.
上記の求解手法では、現在時刻Ｔ０から２歩目着地予定時刻Ｔ２までの重心軌道を一つの行列［Ａ］でまとめて求めた。その場合、重心軌道を求めるためのＺＭＰ軌道［Ｑｘ］の点列（時系列データ）は、現在時刻から少なくとも初期期間の間は第１時間間隔ΔＴ１で構成され、初期期間以降は第２時間間隔ΔＴ２で構成される。そのような手法に変えて、現在時刻Ｔ０から１歩目着地予定時刻Ｔ１までを１歩目着地予定時刻Ｔ１における境界条件を与えて解き、その後、１歩目着地予定時刻Ｔ１から２歩目着地予定時刻Ｔ２までの重心軌道を別途求めることも好適である。その場合、時刻Ｔ０から時刻Ｔ１までのＺＭＰ軌道を第１時間間隔ΔＴ１で準備し、時刻Ｔ１から時刻Ｔ２までのＺＭＰ軌道を第２時間間隔ΔＴ２で準備するとよい。 In the above solution finding method, the center-of-gravity trajectories from the current time T0 to the second-step scheduled landing time T2 are obtained together with one matrix [A]. In that case, the point sequence (time-series data) of the ZMP trajectory [Qx] for obtaining the center-of-gravity trajectory is composed of the first time interval ΔT1 during at least the initial period from the current time, and the second time interval after the initial period. It is comprised by (DELTA) T2. Instead of such a technique, the boundary condition at the first step landing scheduled time T1 is solved from the current time T0 to the first step landing scheduled time T1, and then the second step landing from the first step landing scheduled time T1. It is also preferable to separately obtain the center of gravity trajectory up to the scheduled time T2. In that case, a ZMP trajectory from time T0 to time T1 may be prepared at a first time interval ΔT1, and a ZMP trajectory from time T1 to time T2 may be prepared at a second time interval ΔT2.
上記の求解手法は、３項方程式で近似したＺＭＰ方程式を用いた。その手法は、加速度をオイラー法で近似することを含む。オイラー法は数値積分としては簡単であるが精度が低い。上記求解手法に変えて、例えばルンゲクッタ法等の数値積分法によって（数１）から、重心軌道を求めてもよい。具体的には、（数１）を変形し、重心加速度のｘ軸方向成分ｘｇ （２）（ｉ）に関する式に変形する（数７）。（数７）を逐次積分することによって重心軌道、即ちｘｇ（ｉ）が求まる。 In the above solution method, a ZMP equation approximated by a ternary equation was used. The technique includes approximating acceleration with Euler's method. Euler's method is simple as numerical integration but has low accuracy. Instead of the above solution method, the center of gravity trajectory may be obtained from (Equation 1) by a numerical integration method such as the Runge-Kutta method. Specifically, (Equation 1) is transformed into an equation relating to the x-axis direction component x g (2) (i) of the center-of-gravity acceleration ( Equation 7). The center-of-gravity trajectory, that is, x g (i) is obtained by sequentially integrating (Equation 7).
前述した境界条件を満たすまで、ＺＭＰ軌道を修正しながら数値積分による重心軌道の求解を繰り返す。境界条件を満たすときの重心軌道が、２歩目着地予定時刻Ｔ２まで（理論上）安定な歩容データに相当する。 Until the boundary condition described above is satisfied, the solution of the center of gravity trajectory by numerical integration is repeated while correcting the ZMP trajectory. The center-of-gravity trajectory when the boundary condition is satisfied corresponds to stable gait data until the second landing scheduled time T2 (theoretically).
本明細書が開示する技術について留意点を述べる。本明細書における「歩行」は、「走行」も含む。「歩行」は、いずれかの足が常に接地している移動形態を意味するが、「走行」は両足ともに浮いている期間を有する移動形態を意味する。「走行」の場合であっても、一方の脚が接地している期間においては、本明細書が開示する歩容データ生成手法が適用できる。 Points to be noted about the technology disclosed in this specification. “Walk” in this specification includes “running”. “Walk” means a moving form in which one of the feet is always in contact with the ground, whereas “running” means a moving form having a period in which both feet are floating. Even in the case of “running”, the gait data generation method disclosed in this specification can be applied during a period in which one leg is in contact with the ground.
上記の実施例では、１回の重心軌道演算において、２歩目着地予定時刻Ｔ２までの軌道を算出した。これに代えて、１回の重心軌道演算において、３歩目着地予定時刻までの重心軌道を算出することも好適である。１回の重心軌道演算において何歩目までの重心軌道を算出するかは、安定歩行の確実性と演算負荷のトレードオフである。発明者らの知見によると、１回の軌道演算において、２歩目まで、或いは３歩目まで安定して歩行することが保証される重心軌道を算出すれば実用上十分である。 In the above-described embodiment, the trajectory up to the second step scheduled landing time T2 is calculated in one gravity center trajectory calculation. Instead of this, it is also preferable to calculate the center-of-gravity trajectory up to the scheduled landing time of the third step in one center-of-gravity trajectory calculation. The number of steps to calculate the center-of-gravity trajectory in one center-of-gravity trajectory calculation is a trade-off between the certainty of stable walking and the calculation load. According to the inventors' knowledge, it is practically sufficient to calculate the center of gravity trajectory that guarantees stable walking up to the second step or the third step in one trajectory calculation.
以上、本発明の具体例を詳細に説明したが、これらは例示に過ぎず、特許請求の範囲を限定するものではない。特許請求の範囲に記載の技術には、以上に例示した具体例を様々に変形、変更したものが含まれる。本明細書または図面に説明した技術要素は、単独であるいは各種の組合せによって技術的有用性を発揮するものであり、出願時請求項記載の組合せに限定されるものではない。また、本明細書または図面に例示した技術は複数目的を同時に達成し得るものであり、そのうちの一つの目的を達成すること自体で技術的有用性を持つものである。 Specific examples of the present invention have been described in detail above, but these are merely examples and do not limit the scope of the claims. The technology described in the claims includes various modifications and changes of the specific examples illustrated above. The technical elements described in this specification or the drawings exhibit technical usefulness alone or in various combinations, and are not limited to the combinations described in the claims at the time of filing. In addition, the technology exemplified in this specification or the drawings can achieve a plurality of objects at the same time, and has technical usefulness by achieving one of the objects.
１０：体幹
１２Ｌ：左脚
１２Ｒ：右脚
１４：モータ
１６：センサ
２０：コントローラ
２１：軌道算出部
２２：目標角算出部
２３：メモリ
２４：タスク管理部
２５：サーボ制御部
２６：サーボアンプ
２７：リアルタイムクロック
１００：脚歩行ロボット
10:
Claims (6)
予め定められた軌道計算周期毎にＺＭＰ方程式に基づいて重心位置の時系列データを算出する軌道算出ステップと、
前記時系列データの各時刻における重心位置から脚関節の目標角を算出する目標角算出ステップと、
を備えており、
前記軌道算出ステップは、現在時刻から少なくとも前記軌道計算周期に相当する初期期間の間は関節のサーボ制御周期に相当する第１時間間隔で重心位置の時系列データを算出するとともに、前記初期期間以降は第１時間間隔よりも長い第２時間間隔で重心位置の時系列データを算出し、
前記目標角算出ステップは、前記初期期間における各時刻の重心位置から脚関節の目標角を算出することを特徴とする歩容データ生成方法。 A gait data generation method for a biped robot,
A trajectory calculation step for calculating time-series data of the center of gravity position based on the ZMP equation for each predetermined trajectory calculation period;
A target angle calculation step of calculating a target angle of the leg joint from the position of the center of gravity at each time of the time series data;
With
The trajectory calculation step calculates time series data of the center of gravity position at a first time interval corresponding to a joint servo control period during at least an initial period corresponding to the trajectory calculation period from the current time, and after the initial period Calculates time series data of the center of gravity position at a second time interval longer than the first time interval,
The gait data generation method characterized in that the target angle calculation step calculates a target angle of a leg joint from a center of gravity position at each time in the initial period.
前記時系列データの各時刻における重心位置から脚関節の目標角を算出する目標角算出部と、
サーボ制御周期毎に脚の計測関節角を目標角に追従するように制御するサーボ制御部と、を備えており、
前記軌道算出部は、現在時刻から少なくとも前記軌道計算周期に相当する初期期間の間は前記サーボ制御周期に相当する第１時間間隔で重心位置の時系列データを算出するとともに、前記初期期間以降は第１時間間隔よりも長い第２時間間隔で重心位置の時系列データを算出し、
前記目標角算出部は、前記初期期間における各時刻の重心位置から脚関節の目標角を算出し、
前記サーボ制御部は、サーボ制御周期毎に、前記初期期間における各時刻の脚関節の目標角に追従するように前記計測関節角を制御することを特徴とする２脚歩行ロボット。 A trajectory calculation unit that calculates time-series data of the center of gravity based on the ZMP equation for each predetermined trajectory calculation period;
A target angle calculation unit that calculates a target angle of the leg joint from the position of the center of gravity at each time of the time series data;
A servo control unit that controls the measurement joint angle of the leg to follow the target angle at each servo control cycle, and
The trajectory calculation unit calculates time series data of the center of gravity position at a first time interval corresponding to the servo control period during at least an initial period corresponding to the trajectory calculation period from a current time, and after the initial period Calculate time-series data of the center of gravity position at a second time interval longer than the first time interval,
The target angle calculation unit calculates a target angle of the leg joint from the center of gravity position at each time in the initial period,
The biped walking robot, wherein the servo control unit controls the measurement joint angle so as to follow a target angle of a leg joint at each time in the initial period for each servo control period.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2010023703A JP5392125B2 (en) | 2010-02-05 | 2010-02-05 | Biped walking robot and gait data generation method therefor |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2010023703A JP5392125B2 (en) | 2010-02-05 | 2010-02-05 | Biped walking robot and gait data generation method therefor |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2011161524A true JP2011161524A (en) | 2011-08-25 |
| JP5392125B2 JP5392125B2 (en) | 2014-01-22 |
Family
ID=44592827
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2010023703A Expired - Fee Related JP5392125B2 (en) | 2010-02-05 | 2010-02-05 | Biped walking robot and gait data generation method therefor |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP5392125B2 (en) |
Cited By (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN104570732A (en) * | 2014-12-15 | 2015-04-29 | 浙江大学 | Online generation method for walking mode of humanoid robot |
| JP2016172309A (en) * | 2015-03-18 | 2016-09-29 | トヨタ自動車株式会社 | Multi-point contact robot, and method and program for controlling multi-point contact robot |
| JP2018527646A (en) * | 2015-12-02 | 2018-09-20 | ゴーアテック インコーポレイテッドＧｏｅｒｔｅｋ Ｉｎｃ | Biped robot walking control method and walking control device |
| CN108639183A (en) * | 2018-06-07 | 2018-10-12 | 重庆邮电大学 | A kind of device and control method improving biped robot's balance and the speed of travel |
| JP2019514713A (en) * | 2016-04-29 | 2019-06-06 | ソフトバンク・ロボティクス・ヨーロッパＳｏｆｔｂａｎｋ Ｒｏｂｏｔｉｃｓ Ｅｕｒｏｐｅ | Mobile robot with well-balanced movement and behavioral skills |
| CN110764413A (en) * | 2019-10-29 | 2020-02-07 | 中国科学院自动化研究所 | Self-stabilization control method, system and device of wheel-leg robot |
| CN112572453A (en) * | 2020-12-21 | 2021-03-30 | 广州大学 | Gait planning method, device, equipment and medium for robot walking on slope |
Families Citing this family (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN108237532B (en) * | 2016-12-23 | 2020-11-27 | 深圳光启合众科技有限公司 | Gait control method and device of multi-legged robot and robot |
| CN110371213A (en) * | 2019-07-12 | 2019-10-25 | 沈阳城市学院 | A kind of biped robot's walking planning and control method |
| EP4043991A4 (en) | 2020-04-14 | 2023-02-08 | Tencent Technology (Shenzhen) Company Limited | Method and device for determining barycenter position, legged robot, and storage medium |
Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2006212736A (en) * | 2005-02-03 | 2006-08-17 | Toyota Motor Corp | Legged robot and its control method |
| JP2006247769A (en) * | 2005-03-09 | 2006-09-21 | Toyota Motor Corp | Legged robot and operation control method thereof |
| JP2009066697A (en) * | 2007-09-12 | 2009-04-02 | Toyota Motor Corp | Legged robot, and control method thereof |
-
2010
- 2010-02-05 JP JP2010023703A patent/JP5392125B2/en not_active Expired - Fee Related
Patent Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2006212736A (en) * | 2005-02-03 | 2006-08-17 | Toyota Motor Corp | Legged robot and its control method |
| JP2006247769A (en) * | 2005-03-09 | 2006-09-21 | Toyota Motor Corp | Legged robot and operation control method thereof |
| JP2009066697A (en) * | 2007-09-12 | 2009-04-02 | Toyota Motor Corp | Legged robot, and control method thereof |
Cited By (10)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN104570732A (en) * | 2014-12-15 | 2015-04-29 | 浙江大学 | Online generation method for walking mode of humanoid robot |
| JP2016172309A (en) * | 2015-03-18 | 2016-09-29 | トヨタ自動車株式会社 | Multi-point contact robot, and method and program for controlling multi-point contact robot |
| JP2018527646A (en) * | 2015-12-02 | 2018-09-20 | ゴーアテック インコーポレイテッドＧｏｅｒｔｅｋ Ｉｎｃ | Biped robot walking control method and walking control device |
| JP2019514713A (en) * | 2016-04-29 | 2019-06-06 | ソフトバンク・ロボティクス・ヨーロッパＳｏｆｔｂａｎｋ Ｒｏｂｏｔｉｃｓ Ｅｕｒｏｐｅ | Mobile robot with well-balanced movement and behavioral skills |
| US11014247B2 (en) | 2016-04-29 | 2021-05-25 | Softbank Robotics Europe | Mobile robot with enhanced balanced motion and behavior capabilities |
| CN108639183A (en) * | 2018-06-07 | 2018-10-12 | 重庆邮电大学 | A kind of device and control method improving biped robot's balance and the speed of travel |
| CN110764413A (en) * | 2019-10-29 | 2020-02-07 | 中国科学院自动化研究所 | Self-stabilization control method, system and device of wheel-leg robot |
| CN110764413B (en) * | 2019-10-29 | 2020-09-29 | 中国科学院自动化研究所 | Self-stabilization control method, system and device of wheel-leg robot |
| CN112572453A (en) * | 2020-12-21 | 2021-03-30 | 广州大学 | Gait planning method, device, equipment and medium for robot walking on slope |
| CN112572453B (en) * | 2020-12-21 | 2022-02-18 | 广州大学 | Gait planning method, device, equipment and medium for robot walking on slope |
Also Published As
| Publication number | Publication date |
|---|---|
| JP5392125B2 (en) | 2014-01-22 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP5392125B2 (en) | Biped walking robot and gait data generation method therefor | |
| US8825213B2 (en) | Gait generating device for legged mobile robot and operational target generating device for robot | |
| KR101029228B1 (en) | Robot, and its control method | |
| US10836040B2 (en) | Desired ZMP trajectory generating device | |
| KR101985790B1 (en) | Walking robot and control method thereof | |
| US7805218B2 (en) | Robot device and control method of robot device | |
| JP3599244B2 (en) | Robot device, motion control device of robot device, and motion control method | |
| US7664572B2 (en) | Control device of legged mobile robot | |
| US20120316682A1 (en) | Balance control apparatus of robot and control method thereof | |
| US9533415B2 (en) | Control device for mobile robot | |
| JP4392037B2 (en) | Legged robot and control method thereof | |
| US20050151497A1 (en) | Robot and motion control method of robot | |
| US9682474B2 (en) | Control device for mobile body | |
| US7765030B2 (en) | Gait generator for mobile robot | |
| JP4492395B2 (en) | Legged robot and its motion control method | |
| US7801643B2 (en) | Legged mobile robot and control program for the robot | |
| JP5463991B2 (en) | Biped walking robot | |
| Sari et al. | Implementation and integration of fuzzy algorithms for descending stair of KMEI humanoid robot | |
| JP2011131301A (en) | Legged robot and method of generating gait data for the same | |
| Scholz et al. | Fast, robust and versatile humanoid robot locomotion with minimal sensor input | |
| JP2007007802A (en) | Legged robot and control method thereof | |
| JP4848686B2 (en) | Legged robot and its motion adjustment method | |
| JP6311153B2 (en) | Biped robot control system | |
| Vukobratović et al. | How to Generate and Realize Bipedal Gait in Unstructured Environments? | |
| Vukobratovic et al. | Generation of bipedal gait suitable for use in unstructured environments |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20121129 |
|
| 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: 20130917 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20130930 |
|
| R151 | Written notification of patent or utility model registration |
Ref document number: 5392125 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |
|
| LAPS | Cancellation because of no payment of annual fees |