JP5069538B2 - Control method for legged mobile body and legged mobile body - Google Patents
Control method for legged mobile body and legged mobile body Download PDFInfo
- Publication number
- JP5069538B2 JP5069538B2 JP2007278937A JP2007278937A JP5069538B2 JP 5069538 B2 JP5069538 B2 JP 5069538B2 JP 2007278937 A JP2007278937 A JP 2007278937A JP 2007278937 A JP2007278937 A JP 2007278937A JP 5069538 B2 JP5069538 B2 JP 5069538B2
- Authority
- JP
- Japan
- Prior art keywords
- main body
- connection angle
- external force
- posture
- change
- 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
- Manipulator (AREA)
Description
本発明は、本体と本体に連結されて移動面に接地される複数の可動脚ユニットとを有する脚式移動体に係り、特に、各可動脚ユニットの本体に対する連結角度をアクチュエータにより変化させて本体の姿勢を三次元方向に変化させるように操縦するための技術に関するものである。 The present invention relates to a legged mobile body having a main body and a plurality of movable leg units connected to the main body and grounded to a moving surface, and in particular, the main body by changing the connecting angle of each movable leg unit to the main body by an actuator. It is related with the technique for maneuvering so that the attitude | position of a can be changed to a three-dimensional direction.
従来より、無人の監視区域等において監視作業を行う自立走行型の産業用ロボット(移動体)が知られている。この種のロボットは、例えば、GPS(全地球測位システム)により得た自らの位置を地図情報と照らし合わせながら、目的に応じたパターンで監視区域の移動面上における自立走行を行う。その際、地図情報に存在しない不測の障害物が移動面に存在した場合には、ロボットに搭載されたレーザスキャナ等の外界センサにより障害物を検出し、これとの干渉を避けるようにロボットを走行させる必要がある。 2. Description of the Related Art Conventionally, a self-traveling industrial robot (moving body) that performs monitoring work in an unattended monitoring area or the like is known. This type of robot, for example, performs autonomous running on the moving surface of the monitoring area in a pattern according to the purpose while comparing its position obtained by GPS (Global Positioning System) with map information. At that time, if an unexpected obstacle that does not exist in the map information exists on the moving surface, the obstacle is detected by an external sensor such as a laser scanner mounted on the robot, and the robot is moved to avoid interference with this. Need to run.
そこで、この種のロボットの中には、移動面に接地される可動脚ユニットを本体に複数連結してその連結角度をアクチュエータにより変化させることのできる脚式ロボットがある。この脚式ロボットでは、各可動脚ユニットの本体に対する連結角度を適宜個別に変化させることで、本体の姿勢を三次元方向に変化させることができる。よって、障害物が移動面に存在する場合は、外界センサにより検出したその位置に応じて本体の姿勢を三次元方向に変化させることで、障害物との干渉を避けて移動面上を移動することができる。 Therefore, among this type of robot, there is a legged robot in which a plurality of movable leg units that are grounded to a moving surface are connected to a main body and the connection angle can be changed by an actuator. In this legged robot, the posture of the main body can be changed in a three-dimensional direction by appropriately changing the connecting angle of each movable leg unit to the main body. Therefore, when an obstacle is present on the moving surface, the posture of the main body is changed in a three-dimensional direction according to the position detected by the external sensor, thereby moving on the moving surface while avoiding interference with the obstacle. be able to.
このような脚式ロボットには、アクチュエータにより連結角度を変化させることのできる所謂関節部が多数存在する。そのため、移動面上の障害物を回避できる姿勢を本体に取らせるためには、複数の関節部のアクチュエータを連携して動作させなければならない。よって、関節部のアクチュエータの制御内容は極めて複雑になる。 Such a legged robot has many so-called joints that can change the connection angle by an actuator. Therefore, in order to make the main body take a posture that can avoid an obstacle on the moving surface, it is necessary to operate the actuators of a plurality of joint portions in cooperation. Therefore, the control content of the joint actuator is extremely complicated.
そこで、一般的には、本体が取るべき姿勢を何パターンが予め定めておき、外界センサにより検出した障害物の位置や大きさ等によって、どのパターンの姿勢を本体に取らせるべきかを判定するようにしている。このようにすることで、各関節部のアクチュエータの制御内容を定型化して、制御上の負担を軽減することができる。 Therefore, in general, how many patterns are determined in advance for the posture that the main body should take, and which pattern posture should be taken by the main body based on the position and size of the obstacle detected by the external sensor I am doing so. By doing in this way, the control content of the actuator of each joint part can be standardized, and the burden on control can be reduced.
そして、本体が取るべき姿勢のパターンは、ロボットティーチングによってロボットに教示、入力されるのが一般的である。このロボットティーチングは、例えば、ティーチングマンの各部の動作をモーションキャプチャ方式で取得して脚式ロボットのコントローラに入力することで実施することができる(例えば特許文献1,2)。
しかしながら、ティーチングマンによるロボットティーチングは、人間の動作をベースにするものであることから、人間の動作とは異なる動作を行う上述のような脚式ロボットのティーチングには不向きである。しかも、仮にそのような問題がないとしても、人間の動作とは異なる動作を人間が想定し再現してティーチングするのは、動作をイメージしづらく直感的に作業を行えないことから現実的ではない。よって、脚式ロボットに対するティーチングマンによるロボットティーチングは、作業に時間を要したり、作業のミスを生む原因ともなりかねない。 However, since robot teaching by a teaching man is based on human motion, it is not suitable for teaching the above-described legged robot that performs motions different from human motion. Moreover, even if there is no such problem, it is not realistic for humans to assume and reproduce motions that are different from human motions because it is difficult to imagine the motion and intuitive work cannot be done. . Therefore, robot teaching by a teaching man for a legged robot may take time for work and may cause work mistakes.
そこで、各関節部のアクチュエータのサーボロックを解除して人間が脚式ロボットを所望の姿勢に動かし、その姿勢における各関節部のアクチュエータの動作状態(位置)を取得して、ロボットティーチングを行うことも考えられる。しかし、人間が自ら脚式ロボットを所望の姿勢に動かすには、自ずと脚式ロボットの大きさや重量に対する制約があり、よほど限られた条件の下でしか行うことができない。 Therefore, the servo lock of the actuator of each joint part is released, and a human moves the legged robot to a desired posture, and the operation state (position) of the actuator of each joint part in that posture is acquired and robot teaching is performed. Is also possible. However, in order for a human to move the legged robot to a desired posture, there are restrictions on the size and weight of the legged robot, which can be performed only under very limited conditions.
このような問題は、上述した脚式ロボットのような、運用時に自律動作する脚式移動体に所望の姿勢をティーチングする場合に限って起こるものではない。即ち、運用時に操縦されるタイプの移動体を操縦する際にも、人間の動作と異なる動作を移動体に行わせるのに、操縦者が上述したロボットティーチングにおけるティーチングマンと同様の問題に直面する可能性がある。 Such a problem does not occur only when a desired posture is taught to a legged mobile body that operates autonomously during operation, such as the legged robot described above. That is, when manipulating a moving body that is maneuvered during operation, the operator faces the same problem as the teaching man in the robot teaching described above in order to cause the moving body to perform an operation different from the human motion. there is a possibility.
本発明は前記事情に鑑みなされたもので、本発明の目的は、上述した脚式移動体に動作をティーチングしたり実際に運用するのに当たって、脚式移動体を操縦する必要がある場合に、感覚的かつ容易に脚式移動体を操縦することができる脚式移動体の操縦方法と脚式移動体を提供することにある。 The present invention has been made in view of the above circumstances, and the object of the present invention is to teach operation of the above-described legged mobile body or to actually operate the legged mobile body when it is necessary to maneuver the legged mobile body. It is an object of the present invention to provide a method for maneuvering a legged mobile body and a legged mobile body that can be maneuvered easily and sensuously.
上記目的を達成するため、請求項1に記載した本発明の脚式移動体の操縦方法は、本体に連結されて移動面に接地される複数の可動脚ユニットの前記本体に対する連結角度をアクチュエータにより変化させることで、前記本体の三次元方向における姿勢が変化する脚式移動体を操縦する方法であって、前記本体に加わった三次元方向の外力の向きを電気的に検出し、前記電気的に検出した外力の向きに基づいて、その電気的に検出した外力の向きに前記本体を押圧した場合に該本体が取るべき仮想上の姿勢変化と同じように、前記本体の三次元方向の姿勢を変化させるための、前記各可動脚ユニットの前記本体に対する連結角度の変化量をそれぞれ割り出し、前記割り出したそれぞれの変化量で、前記各可動脚ユニットの前記本体に対する連結角度をそれぞれ前記アクチュエータにより変化させるようにしたことを特徴とする。 In order to achieve the above object, according to a first aspect of the present invention, there is provided a method for operating a legged mobile body according to the present invention. A method of maneuvering a legged mobile body in which the posture of the main body in the three-dimensional direction changes by changing the direction, and electrically detecting the direction of a three-dimensional external force applied to the main body, Based on the direction of the external force detected at the same time, when the main body is pressed in the direction of the externally detected external force, the posture of the main body in the three-dimensional direction is taken, similar to the virtual posture change that the main body should take The amount of change in the connection angle of each movable leg unit with respect to the main body for changing each of the movable leg units is determined. Characterized in that the angle was set to be changed by each of the actuators.
また、上記目的を達成するため、請求項4に記載した本発明の脚式移動体は、本体に連結されて移動面に接地される複数の可動脚ユニットの前記本体に対する連結角度をアクチュエータにより変化させることで、前記本体の三次元方向における姿勢が変化する脚式移動体であって、前記各可動脚ユニットの前記本体に対する連結角度をそれぞれ検出する複数の連結角度検出手段と、前記本体の表面に配設され、該表面に加わった三次元方向の外力の向きに応じた電気信号を出力する力センサと、前記力センサからの前記電気信号によって示される、前記本体の表面に加わった三次元方向の外力の向きと、前記各連結角度検出手段がそれぞれ検出する前記各可動脚ユニットの前記本体に対する連結角度とに基づいて、前記本体の表面に加わった外力の向きに前記本体を押圧した場合に該本体が取るべき仮想上の姿勢変化と同じように、前記本体の三次元方向の姿勢を変化させるための、前記各可動脚ユニットの前記本体に対する連結角度の変化量をそれぞれ割り出す連結角度変化量割出手段とを備え、前記連結角度変化量割出手段が割り出したそれぞれの変化量で、前記各可動脚ユニットの前記本体に対する連結角度をそれぞれ変化させることを特徴とする。
In order to achieve the above object, according to the legged mobile body of the present invention described in
請求項1に記載した本発明の脚式移動体の操縦方法と、請求項4に記載した本発明の脚式移動体とによれば、本体に三次元方向の外力が加わると、その外力の向きが電気的に検出され、その検出結果に基づいて割り出された変化量だけ、複数の可動脚ユニットの本体に対する連結角度がアクチュエータにより変化し、これにより、本体に加わった外力の向きに応じた向きで本体の三次元方向の姿勢が変化することになる。
According to the control method for the legged mobile body of the present invention described in
このため、操縦者が、本体の現在の姿勢をどのような姿勢に変化させるかを想定し、その変化後の本体の姿勢に向けて本体に外力を加えると共に、本体に加える外力の大きさを、本体の変化前後の姿勢の違いの度合い(距離)に応じた大きさとすることで、本体を所望の姿勢にすることができる。 For this reason, it is assumed that the pilot will change the current posture of the main body, and the external force is applied to the main body toward the posture of the main body after the change, and the magnitude of the external force applied to the main body is set. The main body can be in a desired posture by setting the size according to the degree (distance) of the difference in posture before and after the change of the main body.
よって、脚式移動体をティーチングや運用のために操縦する際に、各可動脚ユニットの本体に対する連結角度の変化量を直接計算したり想定しなくても、本体に対して外力を加えてその向きに応じた向きで本体の姿勢を変化させ、あるいは、その操作を複合的に行うことで、脚式移動体を感覚的かつ容易に操縦することができる。 Therefore, when manipulating a legged mobile unit for teaching or operation, it is possible to apply an external force to the main unit without directly calculating or assuming the amount of change in the connection angle of each movable leg unit to the main unit. By changing the posture of the main body in a direction corresponding to the direction or performing the operation in a composite manner, the legged mobile body can be maneuvered sensuously and easily.
以下、本発明の実施形態について図面を参照しながら説明する。 Hereinafter, embodiments of the present invention will be described with reference to the drawings.
図1は本発明による操縦方法を適用した脚式移動体の第1実施形態に係る脚式ロボットを示す概略構成図である。 FIG. 1 is a schematic configuration diagram showing a legged robot according to a first embodiment of a legged mobile body to which a control method according to the present invention is applied.
そして、図1中引用符号Aで示す移動面上を移動する第1実施形態の脚式ロボット1(請求項中の脚式移動体に相当)は、直方体状の本体3と、この本体3の下部に前後左右の走行輪アーム7(請求項中の可動脚ユニットに相当)を介してそれぞれ接続された、4つの移動用走行輪5と、本体3上に設置された雲台9,11と、雲台9上に設置された外界センサ13及び内界センサ15と、雲台11上に設置された監視用カメラ17と、本体3に搭載された各種制御用のコントローラユニット19とを有している。
A legged robot 1 (corresponding to the legged moving body in the claims) of the first embodiment that moves on the moving surface indicated by the reference symbol A in FIG. 1 includes a rectangular parallelepiped
前記各移動用走行輪5は、例えばアウタロータ式のインホイールモータ51(図6参照)を内蔵している。各移動用走行輪5のインホイールモータ51は、後述するコントローラユニット19により個別に駆動制御される。
Each of the
前記各走行輪アーム7は、第1実施形態では2つのアーム部71,73をロータリアクチュエータ75により相互に連結して構成されており、一方のアーム部71は移動用走行輪5に枢着され、他方のアーム部73はロータリアクチュエータ77を介して本体3に連結されている。
In the first embodiment, each
そして、各ロータリアクチュエータ75,77(請求項中のアクチュエータに相当)は、例えばDCサーボモータ等の高トルク型モータによって構成されており、回転角度量を示すエンコーダ信号を出力するロータリエンコーダ75a,77a(請求項中の連結角度検出手段に相当、図6参照)を内蔵している。各ロータリアクチュエータ75,77は、図1に示すホームポジションにおける屈伸形状を含む、目標とする脚式ロボット1(乃至本体3)の姿勢に合わせた形状に走行輪アーム7が屈伸するように、後述するコントローラユニット19により個別に駆動制御される。
The
前記雲台9は、脚式ロボット1の進行方向Fにおける本体3の前方上部に固定して配置されており、この雲台9上に設置された外界センサ13は、内部のポリゴンミラーによりレーザ光源からの測定光を脚式ロボット1の左右方向に走査させて脚式ロボット1の前方に出力する。
The
外界センサ13が測定信号を出力している間、図1に示す脚式ロボット1の本体3は、ロータリアクチュエータ75,77の駆動による各走行輪アーム7の屈伸によって、脚式ロボット1の本体3の上面が移動面Aに対して平行に位置する図1のホームポジションを中心として、チルト方向の上下に揺動される。
While the
したがって、脚式ロボット1の本体3がチルト方向下方に揺動することで、脚式ロボット1の左右方向に走査されて外界センサ13から出力される測定光は、脚式ロボット1の上下方向に走査されることになる。このため、外界センサ13が出力する測定信号は結局、測定光の照射対象の三次元形状に応じたものとなる。
Therefore, when the
外界センサ13から出力された測定光が照射された照射対象からの反射光は、外界センサ13のポリゴンミラーによってフォトダイオードに向けて反射され、フォトダイオードにより受光される。
The reflected light from the irradiation target irradiated with the measurement light output from the
そして、フォトダイオードの出力信号から得られる測距値とポリゴンミラーの角度値に、そのタイミングにおける脚式ロボット1の左右方向における測定光の走査角度データを関連づけた内容の信号が、外界センサ13から測定信号として出力される。
Then, a signal having a content in which the distance value obtained from the output signal of the photodiode and the angle value of the polygon mirror are associated with the scanning angle data of the measurement light in the left-right direction of the
この測定信号は、コントローラ19に入力されて解析され、この解析結果により、移動面A上の障害物が検出される。コントローラ19は、脚式ロボット1が検出した障害物の付近を移動する際、その障害物と衝突しない姿勢を本体3に取らせるために、各走行輪アーム7のロータリアクチュエータ75,77を適宜駆動制御する。
This measurement signal is input to the
そのときの本体3の姿勢や外界センサ13の傾き具合を検出するのが雲台9上の前記内界センサ15である。この内界センサ15は具体的には、例えばジャイロスコープや加速度センサで構成され、内界センサ15による検出結果は、コントローラ19において各種の制御に利用される。
It is the
図1に示す前記雲台11は、不図示の伸縮用モータにより伸縮可能に構成されており、かつ、前記監視用カメラ17をパン、チルト可能に支持するものである。前記監視用カメラ17は、昼夜間を通して対応できるように、通常のカメラと赤外線カメラとをユニット化して構成されている。監視用カメラ17で撮影された画像は、コントローラ19から遠隔地の集中監視センタに送信され、そこでの遠隔監視作業に供される。
The
このように構成された脚式ロボット1の姿勢を人間がロボットティーチングする等のために、第1実施形態では、本体3の表面にシート状の多数の力センサが取り付けられている。詳しくは、本体3の上面3aには、図2に平面図で示すように、3×3のマトリクス状に9個の力センサU1〜U9が取り付けられている。また、本体3の側面3b,3cにも、図3に側面図で示すように、3×3のマトリクス状に9個の力センサS1〜S9,S10〜S18が取り付けられている。
In the first embodiment, a large number of sheet-like force sensors are attached to the surface of the
さらに、本体3の前後面3d,3eには、図4に正面図(背面図)で示すように、中央付近に1個の力センサF1,B1が取り付けられている。本体3の底面3fには、図5に底面図で示すように、前後方向のほぼ中央に、左右2個の力センサD1,D2が取り付けられている。
Further, on the front and
また、第1実施形態の脚式ロボット1では、各走行輪アーム7にも、図3に示すように、各アーム部71,73の前後方向の両側面にそれぞれ1つずつ、計4個の力センサL1〜L4が取り付けられている。
Further, in the
尚、これらの力センサU1〜U9,S1〜S18,F1,B1,D1,D2,L1〜L4は、加わった外力に対する感度を有するものであれば、歪ゲージであっても、静電容量型のセンサであってもよく、あるいは、圧電効果素子を利用したものであってもよい。 Note that these force sensors U1 to U9, S1 to S18, F1, B1, D1, D2, and L1 to L4 may be strain gauges as long as they have sensitivity to the applied external force, even if they are strain gauges. These sensors may be used, or a sensor using a piezoelectric effect element may be used.
前記コントローラユニット19は、図6に脚式ロボット1の電気的な概略構成のブロック図で示すように、CPU19a、RAM19b、ROM19c、及び、不揮発性メモリNVMを内蔵する本体19Aと、キーボード19B及びモニタ19Cとを有している。
As shown in the block diagram of the schematic electrical configuration of the
前記キーボード19Bは、コントローラユニット19で実行させる処理のメニューを選択する場合等に操作されるもので、前記モニタ19Cは、キーボード19Bの操作による処理メニューの選択時等に、それに必要な画面やキーボード19Bによる入力、選択内容を表示するためのものである。
The
また、前記本体19AのCPU19aには、RAM19b及びROM19cや、キーボード19B及びモニタ19C、不揮発性メモリNVMの他、各移動用走行輪5のインホイールモータ51のドライバ51aやロータリエンコーダ51b、各走行輪アーム7のロータリアクチュエータ75,77のドライバ75a,77aやロータリエンコーダ75b,77b、及び、力センサU1〜U9,S1〜S18,F1,B1,D1,D2,L1〜L4が接続されている。
The
尚、スペースの都合により、図6中では、インホイールモータ51のドライバ51aやロータリエンコーダ51bを、1つの移動用走行輪5の分だけ代表して記載しており、CPU19aに接続されている他の移動用走行輪5のインホイールモータ51のドライバ51aやロータリエンコーダ51bは、図6中での記載を省略している。
For convenience of space, in FIG. 6, the
同様の理由で、図6中では、ロータリアクチュエータ75,77のドライバ75a,77aやロータリエンコーダ75b,77bを、1つの走行輪アーム7の分だけ代表して記載しており、CPU19aに接続されている他の走行輪アーム7のロータリアクチュエータ75,77のドライバ75a,77aやロータリエンコーダ75b,77bは、図6中での記載を省略している。
For the same reason, in FIG. 6, the drivers 75 a and 77 a of the
また、第1実施形態の脚式ロボット1では、各走行輪アーム7の各アーム部71,73の力センサL1〜L4を除く他の力センサU1〜U9,S1〜S18,F1,B1,D1,D2が、請求項中の力センサに相当している。
In the
前記RAM19bは、各種データ記憶用のデータエリア及び各種処理作業に用いるワークエリアを有しており、前記ROM19cには、CPU19aに各種処理動作を行わせるための制御プログラムが格納されている。
The
前記不揮発性メモリNVMには、本体3に取り付けられる各力センサU1〜U9,S1〜S18,F1,B1,D1,D2において外力を検出した場合に、本体3の姿勢を変化させる方向を規定したテーブルが格納されている。このテーブルで方向を規定するのに用いる本体3の姿勢の変化方向としては、図2に示すヨー方向α、図3に示すピッチ方向β、図4に示すロール方向γと、脚式ロボット1の前後方向X、左右方向Y、及び、上下方向Zがある。
The non-volatile memory NVM defines a direction in which the posture of the
また、不揮発性メモリNVMには、各走行輪アーム7に取り付けられる各力センサL1〜L4において外力を検出した場合に、各アーム部71,73の姿勢を変化させる方向を規定したテーブルが格納されている。このテーブルでは、アーム部71の姿勢の変化方向として、アーム部71,73の連結部分に設けたロータリアクチュエータ75の回転方向が用いられる。また、アーム部73の姿勢の変化方向として、アーム部73と本体3との連結部分に設けたロータリアクチュエータ77の回転方向が用いられる。これらの回転方向はいずれも、正転方向CW(図3中時計回り方向)と反転方向CCW(図3中反時計回り方向)とで定義される。
The non-volatile memory NVM stores a table that defines the direction in which the postures of the
そして、本体3の上面3aに取り付けられた力センサU1〜U9に関するテーブルには、図7の説明図に示すように、各力センサU1〜U9が単独で外力を検出した場合の本体3の姿勢の変化方向と、2つの力センサU1〜U9が同時に外力を検出した場合の本体3の姿勢の変化方向(この場合は、各力センサU1〜U9にそれぞれ対応付けられた本体3の姿勢の変化方向をプラスした内容)とが、規定されている。
And in the table regarding the force sensors U1 to U9 attached to the
また、本体3の側面3b,3cに取り付けられた力センサS1〜S9,S10〜S18に関するテーブルには、図8の説明図に示すように、各力センサS1〜S9,S10〜S18が単独で外力を検出した場合の本体3の姿勢の変化方向が、規定されている。尚、力センサS5による外力の検出に対しては、脚式ロボット1の左右方向Yへの姿勢変化が規定されているが、第1実施形態の脚式ロボット1は左右方向Yに直進する移動手段を持たないため、実際には非動作扱いとなる。
Further, in the table relating to the force sensors S1 to S9 and S10 to S18 attached to the side surfaces 3b and 3c of the
さらに、本体3の前後面3d,3eに取り付けられた力センサF1,B1に関するテーブルには、図9の説明図に示すように、各力センサF1,B1が外力を検出した場合の本体3の姿勢の変化方向が、規定されている。
Further, in the table relating to the force sensors F1 and B1 attached to the front and
また、本体3の底面3fに取り付けられた力センサD1,D2に関するテーブルには、図10の説明図に示すように、各力センサD1,D2が外力を検出した場合の本体3の姿勢の変化方向が、規定されている。
Further, in the table relating to the force sensors D1 and D2 attached to the
さらに、各走行輪アーム7の各アーム部71,73に取り付けられた力センサL1〜L4に関するテーブルには、図11の説明図に示すように、各力センサL1〜L4が外力を検出した場合のロータリアクチュエータ75,77の回転方向が、規定されている。
Further, in the table relating to the force sensors L1 to L4 attached to the
そして、第1実施形態のコントローラ19のCPU19aは、ROM19cに格納された制御プログラムに従い処理を実行することで、各走行輪アーム7のロータリアクチュエータ75,77のロータリエンコーダ75b,77bから入力されるエンコーダ信号に基づいて、ロータリアクチュエータ75,77の現在の回転位置、ひいては、本体3に対するアーム部71の連結角度やアーム部71に対するアーム部73の連結角度を把握するように構成されている。
The
次に、ROM19cに格納された制御プログラムに従いCPU19aが、脚式ロボット1の操縦に関する処理において行う、本体3や各走行輪アーム7のアーム部71,73に取り付けられる各力センサU1〜U9,S1〜S18,F1,B1,D1,D2,L1〜L4による外力の検出に応じた、本体3や各走行輪アーム7のアーム部71,73の姿勢制御動作に関する処理を、図12のフローチャートを参照して説明する。
Next, in accordance with the control program stored in the
コントローラユニット19が起動しプログラムがスタートすると、CPU19aは、各力センサU1〜U9,S1〜S18,F1,B1,D1,D2,L1〜L4からの出力信号の有無、つまり、外力の検出に伴う信号レベルの変化の有無をスキャンし(ステップS1)、全ての力センサU1〜U9,S1〜S18,F1,B1,D1,D2,L1〜L4からの出力信号がない場合は(ステップS1でN)、ステップS1をリピートする。
When the
これに対して、いずれかの力センサU1〜U9,S1〜S18,F1,B1,D1,D2,L1〜L4からの出力信号がある場合は(ステップS1でY)、その出力信号が、本体3に取り付けられた力センサU1〜U9,S1〜S18,F1,B1,D1,D2からのものであるか否かを確認する(ステップS3)。 On the other hand, when there is an output signal from any of the force sensors U1 to U9, S1 to S18, F1, B1, D1, D2, and L1 to L4 (Y in step S1), the output signal is 3 is checked whether it is from force sensors U1 to U9, S1 to S18, F1, B1, D1 and D2 attached to 3 (step S3).
本体3に取り付けられた力センサU1〜U9,S1〜S18,F1,B1,D1,D2からの出力信号である場合は(ステップS3でY)、出力信号の出力元の力センサU1〜U9,S1〜S18,F1,B1,D1,D2に対応して不揮発性メモリNVMの図7乃至図10のいずれかのテーブルに規定されている方向に、本体3の姿勢を所定ピッチ変化させるための、各走行輪アーム7のロータリアクチュエータ75,77の回転方向及び回転量を、個別に決定する(ステップS5)。
In the case of output signals from the force sensors U1 to U9, S1 to S18, F1, B1, D1, and D2 attached to the main body 3 (Y in step S3), the force sensors U1 to U9 that are output sources of the output signals In order to change the posture of the
この回転方向及び回転量の決定は、先に説明したように、各走行輪アーム7のロータリアクチュエータ75,77のロータリエンコーダ75b,77bから入力されるエンコーダ信号に基づいてCPU19aが把握している、ロータリアクチュエータ75,77の現在の回転位置、つまり、本体3に対するアーム部71の連結角度やアーム部71に対するアーム部73の連結角度を参照した上で、例えば逆運動学の理論に基づく既知のアルゴリズムを用いて行われる。
The determination of the rotation direction and the rotation amount is ascertained by the
そして、決定した回転方向及び回転量で、各走行輪アーム7のロータリアクチュエータ75,77を個別に回転させ(ステップS7)、その後、ステップS1にリターンする。
Then, the
また、出力信号が、本体3に取り付けられた力センサU1〜U9,S1〜S18,F1,B1,D1,D2からの出力信号でない場合は(ステップS3でN)、出力信号の出力元の力センサL1〜L4に対応して不揮発性メモリNVMの図11のテーブルに規定されている方向に、予め定められた回転量だけ、力センサL1〜L4の取り付け先の走行輪アーム7のロータリアクチュエータ75,77を回転させ(ステップS9)、その後、ステップS1にリターンする。
If the output signal is not an output signal from the force sensors U1 to U9, S1 to S18, F1, B1, D1, and D2 attached to the main body 3 (N in step S3), the output source force of the output signal The
尚、本体3の力センサU1〜U9,S1〜S18,F1,B1,D1,D2からの出力信号の検出は、各面(上面3a、側面3b、側面3c、前面3d、後面3e、底面3f)の力センサU1〜U9,S1〜S18,F1,B1,D1,D2単位で行われる。そして、出力信号の検出は、(1)上面3aの力センサU1〜U9、(2)側面3b,3cの力センサS1〜S18、(3)前後面3d,3eの力センサF1,B1、(4)底面3fの力センサD1,D2の優先順位で行われる。
The output signals from the force sensors U1 to U9, S1 to S18, F1, B1, D1, and D2 of the
したがって、本体3の複数の面3a〜3fの力センサU1〜U9,S1〜S18,F1,B1,D1,D2からの出力信号が同時に発生した場合は、出力信号の検出の優先順位が高い面3a〜3fの力センサU1〜U9,S1〜S18,F1,B1,D1,D2からの出力信号の検出内容に応じた動作が、優先して実行される。
Therefore, when output signals from the force sensors U1 to U9, S1 to S18, F1, B1, D1, and D2 of the plurality of
以上の説明からも明らかなように、第1実施形態においては、図12のフローチャートにおけるステップS5が、請求項中の連結角度変化量割出手段に対応する処理となっている。 As is clear from the above description, in the first embodiment, step S5 in the flowchart of FIG. 12 is processing corresponding to the connection angle change amount indexing means in the claims.
尚、コントローラユニット19は、ROMに格納された制御プログラムをCPUが実行することで上記の処理の全てを行うものであってもよく、一部の処理をDSP(Digital Signal Processor)により実行するものであってもよい。
The
上述のように構成された第1実施形態の脚式ロボット1では、本体3に取らせる姿勢のパターンをロボットティーチングによりコントローラユニット19に教示、入力するのに当たって、ティーチングマン(図示せず)が本体3の力センサU1〜U9,S1〜S18,F1,B1,D1,D2を適宜接触操作すると、接触操作された力センサU1〜U9,S1〜S18,F1,B1,D1,D2からの出力信号が、先に説明した優先順位でコントローラ19により検出される。
In the
そして、コントローラ19により出力信号が検出された力センサU1〜U9,S1〜SS18,F1,B1,D1,D2に対応して、不揮発性メモリNVMのテーブルで規定されている、本体3の姿勢を変化させる方向と、ロータリアクチュエータ75,77の現在の回転位置、つまり、本体3に対するアーム部71の連結角度やアーム部71に対するアーム部73の連結角度とに基づき、逆運動学の理論に基づく既知のアルゴリズムを用いて、各走行輪アーム7のロータリアクチュエータ75,77の回転方向が決定され、その回転方向に、予め定められたピッチで各走行輪アーム7のロータリアクチュエータ75,77が回転される。
Then, the posture of the
これにより、本体3の姿勢が、ティーチングマンが接触操作した本体3の力センサU1〜U9,S1〜S18,F1,B1,D1,D2の位置に応じた方向に変化する。
Thereby, the attitude | position of the
ここで、図7乃至図10の各テーブルにおいて規定されている本体3の姿勢の変化方向は、テーブルの内容から明らかなように、ティーチングマンの接触操作により外力を検出した力センサU1〜U9,S1〜S18,F1,B1,D1,D2の位置との間に、関連性を持っている。
Here, the change direction of the posture of the
つまり、本体3の上面3aと側面3b,3cについては、図7及び図8の各テーブルに示すように、それぞれの面3a〜3cの中央に位置する力センサU5,S5,S14に対応付けて、対向する面(底面3f、側面3c,3b)に向かう方向が規定されている。また、それぞれの面3a〜3cの中央から外れた位置の力センサU1〜U4、U6〜U9,S1〜S4、S6〜S9,S10〜S13、S15〜S18には、それぞれの面3a〜3cの中央を支点とし、外力を検出した力センサの位置を作用点とする回転モーメント方向が、それぞれ対応して規定されている。
That is, the
本体3の前後面3d,3eについては、図9のテーブルに示すように、各面前後面3d,3eの中央付近に位置する力センサF1,B1に対応付けて、対向する面(後面3e、前面3d)に向かう方向が規定されている。本体3の底面3fについては、図10のテーブルに示すように、前後方向のほぼ中央に位置する左右の各力センサD1,D2には、底面3fの中央を支点とし、外力を検出した力センサの位置を作用点とする回転モーメント方向が、それぞれ対応して規定されている。
As shown in the table of FIG. 9, the front and
尚、2つの力センサU1〜U9による外力の同時検出を受け付ける本体3の上面3aについては、図7のテーブルに示すように、各力センサU1〜U9にそれぞれ対応付けられた本体3の姿勢の変化方向をプラスした内容が、規定されている。
In addition, about the
また、図8のテーブルのヨー方向αの移動に際しては、第1実施形態の脚式ロボット1が移動手段を有していない左右方向Yへの直進成分を含んでいることから、例外的に、左右の移動用走行輪5の差動による旋回動作が実行される。
In addition, when the table of FIG. 8 moves in the yaw direction α, the
このような構成による第1実施形態の脚式ロボット1によれば、ティーチングマンが、目標とする変化後の本体3の姿勢に向けて現在の本体3の姿勢をどのような向きに変更すればよいかを想定し、その想定した方向に自ら本体3を動かす場合に本体3のどの場所に力を加えるかを想定して、その想定した場所にある力センサU1〜U9,S1〜S18,F1,B1,D1,D2に接触操作するだけで、感覚的かつ容易に本体3の姿勢を所望の方向に変化させることができる。
According to the
ちなみに、第1実施形態の脚式ロボット1では、各走行輪アーム7の各アーム部71,73の前後方向の両側面に取り付けた力センサL1〜L4を適宜接触操作すると、接触操作された力センサL1〜L4からの出力信号が、コントローラ19により検出される。
By the way, in the
そして、コントローラ19により出力信号が検出された力センサL1〜L4に対応して、不揮発性メモリNVMのテーブルで規定されている、ロータリアクチュエータ75,77の回転方向と、ロータリアクチュエータ75,77の現在の回転位置、つまり、本体3に対するアーム部71の連結角度やアーム部71に対するアーム部73の連結角度とに基づいて、各走行輪アーム7のロータリアクチュエータ75,77の回転方向及び回転量が決定され、その回転方向及び回転量で各走行輪アーム7のロータリアクチュエータ75,77が回転される。
Then, corresponding to the force sensors L1 to L4 from which the output signals are detected by the
上述した各走行輪アーム7の力センサL1〜L4の接触操作によるロータリアクチュエータ75,77の回転動作は、本体3の力センサU1〜U9,S1〜S18,F1,B1,D1,D2への接触操作による本体3の姿勢の変化動作を微調整する際に行うと、特に有効である。
The rotary operation of the
以上に説明した第1実施形態の脚式ロボット1では、本体3の各面3a〜3fに力センサU1〜U9,S1〜S18,F1,B1,D1,D2それぞれ分散して取り付ける構成とした。しかし、本体3の特定箇所に取り付けた単一の力センサに加わる外力よって、本体3の姿勢の変化方向を決定してその方向に本体3の姿勢を変化させる構成とすることもできる。
In the
そのように構成したのが、図13に正面図で示す、本発明の第2実施形態に係る脚式ロボット1Aである。 Such a configuration is a legged robot 1A according to the second embodiment of the present invention shown in a front view in FIG.
第2実施形態の脚式ロボット1Aは、本体3の前面3dの中央付近に、第1実施形態の脚式ロボット1における力センサF1に代えて、突起型の力センサF11を取り付けた点と、前面3d以外の本体3の各面3a〜3c,3e,3fの力センサU1〜U9,S1〜S18,B1,D1,D2を全てなくした点において、第1実施形態の脚式ロボット1と内容が異なっている。
The legged robot 1A of the second embodiment has a protruding force sensor F11 attached in the vicinity of the center of the
また、第2実施形態の脚式ロボット1Aは、コントローラユニット19の本体19AのROM19bに格納された制御プログラムの内容が、第1実施形態の脚式ロボット1と異なっており、かつ、不揮発性メモリNVMに格納されているテーブルの内容が、第1実施形態の脚式ロボット1と異なっている。
Further, the legged robot 1A of the second embodiment differs from the
そして、第1実施形態の脚式ロボット1では、本体3の力センサU1〜U9,S1〜S18,F1,B1,D1,D2が、接触操作されるものであったが、第2実施形態の脚式ロボット1Aでは、本体3の力センサF11が、直接接触(押圧)操作されるだけでなく、力センサF11に結合した引き綱Lにより引っ張り操作されることもあるものとなっている。
In the
そのため、前記力センサF11は、脚式ロボット1Aの前後方向X、左右方向Y、上下方向Zの三方向のそれぞれについて、押圧、引っ張りの両外力に対する感度を有している。この力センサF11が外力を検出した場合は、前後方向X、左右方向Y、上下方向Zの三方向の成分別に信号が出力される。この出力信号は、前後方向Xの成分については、力センサF11が検出した外力が押圧力ならば−(マイナス)の値、引張力ならば+(プラス)の値となる。左右方向Yの成分については、押圧力であるか引張力であるかを問わず、力センサF11が検出した外力が図13中左方向であれば−(マイナス)の値、右方向であれば+(プラス)の値となる。上下方向Zの成分については、押圧力であるか引張力であるかを問わず、力センサF11が検出した外力が図13中下方向であれば−(マイナス)の値、上方向であれば+(プラス)の値となる。 Therefore, the force sensor F11 has sensitivity to both external forces of pressing and pulling in each of the three directions of the front and rear direction X, the left and right direction Y, and the up and down direction Z of the legged robot 1A. When the force sensor F11 detects an external force, a signal is output for each component in the three directions of the front-rear direction X, the left-right direction Y, and the up-down direction Z. For the component in the front-rear direction X, this output signal has a value of-(minus) if the external force detected by the force sensor F11 is a pressing force, and a value of + (plus) if it is a tensile force. Regarding the component in the left-right direction Y, regardless of whether it is a pressing force or a tensile force, if the external force detected by the force sensor F11 is in the left direction in FIG. + (Plus) value. Regarding the component in the vertical direction Z, regardless of whether it is a pressing force or a tensile force, if the external force detected by the force sensor F11 is a downward direction in FIG. + (Plus) value.
この力センサF11には、第1実施形態の脚式ロボット1における力センサU1〜U9,S1〜S18,F1,B1,D1,D2,L1〜L4と同様に、歪ゲージや静電容量型のセンサ、圧電効果素子を利用したセンサ等を利用することができる。
The force sensor F11 includes strain gauges and electrostatic capacitance type sensors similar to the force sensors U1 to U9, S1 to S18, F1, B1, D1, D2, and L1 to L4 in the
また、第2実施形態の脚式ロボット1Aでは、力センサF11が外力を検出した場合に、本体3の姿勢を変化させる方向を規定したテーブルが、コントロールユニット19の不揮発性メモリNVMに格納されている。このテーブルには、図14の説明図に示すように、それぞれの方向成分ついて、本体3の姿勢の変化方向が規定されている。これは、力センサF11が先に説明したとおり、外力の検出時に前後方向X、左右方向Y、及び、上下方向Zの3方向成分別に信号を出力することに起因している。力センサF11が検出した外力に2つ以上の方向成分が含まれている場合は、力センサ11の出力信号もそれに応じた内容となる。
In the legged robot 1A of the second embodiment, a table that defines the direction in which the posture of the
そして、第2実施形態の脚式ロボット1Aにおいて、コントロールユニット19のCPU19aが、ROM19bに格納された制御プログラムに従って行う、脚式ロボット1Aの操縦時の本体3や各走行輪アーム7のアーム部71,73の姿勢制御動作に関する処理の内容は、図12のフローチャートに示す第1実施形態の脚式ロボット1のコントロールユニット19のCPU19aが行う処理と、基本的には同じである。
In the legged robot 1A of the second embodiment, the
即ち、図12のステップS1やステップS3の各処理において出力信号の有無を確認する力センサの対象を、力センサU1〜U9,S1〜S18,F1,B1,D1,D2から力センサF11に変えると共に、図12のステップS5において、各走行輪アーム7のロータリアクチュエータ75,77の回転方向及び回転量を、不揮発性メモリNVMの図7乃至図10のいずれかのテーブルではなく、図14のテーブルに規定されている方向に基づいて決定するように変更する。
That is, the target of the force sensor for checking the presence or absence of the output signal in each processing of step S1 and step S3 in FIG. 12 is changed from the force sensor U1 to U9, S1 to S18, F1, B1, D1, D2 to the force sensor F11. At the same time, in step S5 of FIG. 12, the rotational direction and amount of rotation of the
それ以外は、第2実施形態の脚式ロボット1Aのコントロールユニット19のCPU19aにおいても、図12のフローチャートに示す第1実施形態の脚式ロボット1のコントロールユニット19のCPU19aが行う処理と同様の処理が行われる。
Other than that, also in the
尚、第2実施形態の脚式ロボット1Aでは、本体3の前面3dの力センサF11が、請求項中の力センサに相当している。
In the legged robot 1A of the second embodiment, the force sensor F11 on the
このような構成による第2実施形態の脚式ロボット1Aでは、力センサF11を直接接触(押圧)操作することで、力センサF11に、最大で前後方向X、左右方向Y、及び、上下方向Zの3方向成分を含む押圧力が外力として加わり、また、引き綱を引くことで本体3の前面3dの力センサF11に、最大で前後方向X、左右方向Y、及び、上下方向Zの3方向成分を含む引張力が外力として加わることになる。
In the legged robot 1A according to the second embodiment having such a configuration, the force sensor F11 is directly contacted (pressed), so that the force sensor F11 can be operated in the front-rear direction X, the left-right direction Y, and the up-down direction Z. Is applied to the force sensor F11 on the
そして、ティーチングマンが、目標とする変化後の本体3の姿勢に向けて現在の本体3の姿勢をどのような向きに変更すればよいかを想定し、その想定した方向に自ら本体3を動かす場合に本体3の前面3dに対してどの方向に力を加えるかを想定して、その想定した方向への外力を、押圧力又は引張力として力センサF11に加えるだけで、感覚的かつ容易に本体3の姿勢を所望の方向に変化させることができる。
Then, assuming that the teaching man should change the current posture of the
ちなみに、第2実施形態の脚式ロボット1Aにおいても、各走行輪アーム7の各アーム部71,73の前後方向の両側面に取り付けた力センサL1〜L4の接触操作と、それに伴い接触操作された力センサL1〜L4からの出力信号に基づいて、コントローラ19の制御により各走行輪アーム7のロータリアクチュエータ75,77が回転される点は、第1実施形態の脚式ロボット1と同様である。
Incidentally, also in the legged robot 1A of the second embodiment, the contact operation of the force sensors L1 to L4 attached to both side surfaces in the front-rear direction of the
尚、上述した第1及び第2実施形態では、各力センサU1〜U9,S1〜S18,F1,B1,D1,D2,L1〜L4,F11によって検出するのが、外力の有無のみであり、検出した外力に応じて本体3の姿勢を変化させる際、つまり、本体3に対するアーム部71の連結角度やアーム部71に対するアーム部73の連結角度を変化させる際の、各走行輪アーム7のロータリアクチュエータ75,77の回転量は、予め定められたピッチである場合について説明した。
In the first and second embodiments described above, only the presence or absence of external force is detected by each of the force sensors U1 to U9, S1 to S18, F1, B1, D1, D2, L1 to L4, and F11. When the posture of the
しかし、各力センサU1〜U9,S1〜S18,F1,B1,D1,D2,L1〜L4,F11が、外力の大きさに応じた出力信号を生成するものとし、その出力信号の大きさに応じて、本体3の姿勢の変化量、つまり、本体3に対するアーム部71の連結角度やアーム部71に対するアーム部73の連結角度の変化量が決定され、その決定された変化量の分だけ、各走行輪アーム7のロータリアクチュエータ75,77が回転されるように構成してもよい。
However, each of the force sensors U1 to U9, S1 to S18, F1, B1, D1, D2, L1 to L4, and F11 generates an output signal corresponding to the magnitude of the external force. Accordingly, the amount of change in the posture of the
また、第1及び第2実施形態の脚式ロボット1,1Aでは、各走行輪アーム7の各アーム部71,73の前後方向の両側面に力センサL1〜L4を取り付けて、それらの力センサL1〜L4に加わる外力に応じてロータリアクチュエータ75,77を回転させる構成としたが、この構成は省略してもよい。
In the
そして、本発明は、第1及び第2実施形態で説明した走行輪により移動する移動体に限らず、例えば、可動脚ユニットの本体に対する連結角度の変更により可動脚ユニットが所謂歩行運動を行って移動する脚式移動体にも適用可能である。また、可動脚ユニットは第1及び第2実施形態の脚式ロボット1,1Aのように前後左右の四脚に限らず、それ以上又はそれ以下の脚数であってもよいことは言うまでもない。
The present invention is not limited to the moving body that moves by the traveling wheels described in the first and second embodiments. For example, the movable leg unit performs a so-called walking motion by changing the connection angle with the main body of the movable leg unit. The present invention can also be applied to a legged moving body that moves. Further, it goes without saying that the movable leg unit is not limited to the four legs on the front, rear, left and right as in the
1 脚式ロボット(脚式移動体)
3 本体
3a 本体上面(表面)
3b,3c 本体側面(表面)
3d 本体前面(表面、特定箇所)
3e 本体後面(表面)
3f 本体底面(表面)
7 走行輪アーム(可動脚ユニット)
75,77 ロータリアクチュエータ(アクチュエータ)
75a,77a ロータリエンコーダ(連結角度検出手段)
19 コントロールユニット(連結角度変化量割出手段)
A 移動面
B1,D1,D2,F1,F11,U1〜U9,S1〜S18 力センサ
X 前後方向
Y 左右方向
Z 上下方向
1 Legged robot (legged moving body)
3
3b, 3c Side surface (surface)
3d Front of the main body (surface, specific location)
3e Rear surface (surface)
3f Body bottom (surface)
7 Traveling wheel arm (movable leg unit)
75, 77 Rotary actuator (actuator)
75a, 77a Rotary encoder (connection angle detection means)
19 Control unit (connection angle change amount indexing means)
A Moving surface B1, D1, D2, F1, F11, U1 to U9, S1 to S18 Force sensor X Back and forth direction Y Left and right direction Z Up and down direction
Claims (6)
前記本体に加わった三次元方向の外力の向きを電気的に検出し、
前記電気的に検出した外力の向きに基づいて、その電気的に検出した外力の向きに前記本体を押圧した場合に該本体が取るべき仮想上の姿勢変化と同じように、前記本体の三次元方向の姿勢を変化させるための、前記各可動脚ユニットの前記本体に対する連結角度の変化量をそれぞれ割り出し、
前記割り出したそれぞれの変化量で、前記各可動脚ユニットの前記本体に対する連結角度をそれぞれ前記アクチュエータにより変化させるようにした、
ことを特徴とする脚式移動体の操縦方法。 A method of manipulating a legged mobile body in which the posture of the main body in a three-dimensional direction changes by changing the connection angle of the plurality of movable leg units connected to the main body and grounded to the moving surface with respect to the main body by an actuator. There,
Electrically detecting the direction of the external force in the three-dimensional direction applied to the main body,
Based on the direction of the externally detected external force, in the same way as the virtual posture change that the main body should take when the main body is pressed in the direction of the externally detected external force, To determine the amount of change in the connection angle of each movable leg unit with respect to the main body to change the orientation of the direction,
With each of the calculated change amounts, the connection angle of each movable leg unit to the main body is changed by the actuator, respectively.
A method for maneuvering a legged mobile unit.
前記各可動脚ユニットの前記本体に対する連結角度をそれぞれ検出する複数の連結角度検出手段と、
前記本体の表面に配設され、該表面に加わった三次元方向の外力の向きに応じた電気信号を出力する力センサと、
前記力センサからの前記電気信号によって示される、前記本体の表面に加わった三次元方向の外力の向きと、前記各連結角度検出手段がそれぞれ検出する前記各可動脚ユニットの前記本体に対する連結角度とに基づいて、前記本体の表面に加わった外力の向きに前記本体を押圧した場合に該本体が取るべき仮想上の姿勢変化と同じように、前記本体の三次元方向の姿勢を変化させるための、前記各可動脚ユニットの前記本体に対する連結角度の変化量をそれぞれ割り出す連結角度変化量割出手段とを備え、
前記連結角度変化量割出手段が割り出したそれぞれの変化量で、前記各可動脚ユニットの前記本体に対する連結角度をそれぞれ変化させる、
ことを特徴とする脚式移動体。 A legged moving body in which a posture in a three-dimensional direction of the main body is changed by changing a connection angle of the plurality of movable leg units connected to the main body and grounded to a moving surface with respect to the main body by an actuator,
A plurality of connection angle detection means for detecting connection angles of the movable leg units to the body;
A force sensor disposed on the surface of the main body and outputting an electrical signal corresponding to the direction of the external force applied in the three-dimensional direction applied to the surface;
The direction of a three-dimensional external force applied to the surface of the main body, indicated by the electrical signal from the force sensor, and the connection angle of the movable leg unit to the main body that is detected by the connection angle detecting means, respectively. In order to change the posture of the main body in the three-dimensional direction , similar to a virtual posture change that the main body should take when the main body is pressed in the direction of an external force applied to the surface of the main body. A connection angle change amount indexing means for determining a change amount of the connection angle of each movable leg unit with respect to the main body,
With each change amount calculated by the connection angle change amount indexing means, the connection angle of each movable leg unit to the main body is changed, respectively.
This is a leg-type moving body.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2007278937A JP5069538B2 (en) | 2007-10-26 | 2007-10-26 | Control method for legged mobile body and legged mobile body |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2007278937A JP5069538B2 (en) | 2007-10-26 | 2007-10-26 | Control method for legged mobile body and legged mobile body |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2009107035A JP2009107035A (en) | 2009-05-21 |
JP5069538B2 true JP5069538B2 (en) | 2012-11-07 |
Family
ID=40776119
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2007278937A Expired - Fee Related JP5069538B2 (en) | 2007-10-26 | 2007-10-26 | Control method for legged mobile body and legged mobile body |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP5069538B2 (en) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR101107222B1 (en) * | 2009-09-30 | 2012-01-25 | 한국과학기술연구원 | Mobile robot and controlling method of the same |
CN102841605B (en) * | 2012-09-14 | 2014-12-31 | 中国人民解放军国防科学技术大学 | Motion control method for wheel-leg combined type mobile platform |
JP6522930B2 (en) * | 2014-11-28 | 2019-05-29 | ファナック株式会社 | A numerically controlled machine tool that can manually operate the movable part directly |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3035051B2 (en) * | 1991-12-20 | 2000-04-17 | 本田技研工業株式会社 | Walking control device for legged mobile robot |
JP2002120183A (en) * | 2000-10-11 | 2002-04-23 | Sony Corp | Robot device and input information detecting method for robot device |
JP2002239960A (en) * | 2001-02-21 | 2002-08-28 | Sony Corp | Action control method of robot device, program, recording medium, and robot device |
JP2007175831A (en) * | 2005-12-28 | 2007-07-12 | Kawada Kogyo Kk | Walking robot |
-
2007
- 2007-10-26 JP JP2007278937A patent/JP5069538B2/en not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
JP2009107035A (en) | 2009-05-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US10980605B2 (en) | Remote control robot system | |
JP5510081B2 (en) | Obstacle avoidance support device, obstacle avoidance support method, and moving object | |
JP5895628B2 (en) | ROBOT CONTROL METHOD, ROBOT CONTROL DEVICE, AND ROBOT CONTROL SYSTEM | |
JP4506685B2 (en) | Mobile robot | |
JP5141507B2 (en) | Autonomous mobile device | |
US7970492B2 (en) | Mobile robot control system | |
US9073211B2 (en) | Control system and teaching method for seven-axis articulated robot | |
JP2012011498A (en) | System and method for operating robot arm | |
JP5458769B2 (en) | Robot control device | |
WO2005001375A1 (en) | Three-dimensional shape measuring method and measuring apparatus thereof | |
WO2015137169A1 (en) | Terrain determination device, legged mobile robot, robot system, control method for legged mobile robot, and control method for robot system | |
JP5069538B2 (en) | Control method for legged mobile body and legged mobile body | |
JP2013094935A (en) | Robot arm device | |
JP2020193503A (en) | Operation support system of work machine, operation support method of work machine, maintenance support method of operation support system, and construction machine | |
JP4277825B2 (en) | Robot teaching system | |
JP2009109219A (en) | Obstacle position recognition method for mobile unit and mobile unit | |
US11926064B2 (en) | Remote control manipulator system and remote control assistance system | |
JP4512405B2 (en) | 3D shape measurement method | |
JP5895682B2 (en) | Obstacle detection device and moving body equipped with the same | |
JP6433664B2 (en) | Overhead image display device for construction machinery | |
JP2013215839A (en) | Method for controlling robot having redundant degree of freedom, device for controlling robot, and system for controlling robot | |
JPH06179187A (en) | Direction detection type teaching mechanism | |
JP7405960B2 (en) | Robot control device and control method, robot system, device and method for generating robot operation program | |
JP7081926B2 (en) | Mobiles, motion control systems, and mobile systems | |
JP2018114590A (en) | Robot teaching device and robot teaching method |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A711 | Notification of change in applicant |
Free format text: JAPANESE INTERMEDIATE CODE: A711 Effective date: 20090630 |
|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20100729 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20120314 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20120321 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20120517 |
|
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: 20120731 |
|
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: 20120817 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20150824 Year of fee payment: 3 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 5069538 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
LAPS | Cancellation because of no payment of annual fees |