JP4127043B2 - 脚式移動ロボット並びに脚式移動ロボットの関節軸として適用されるアクチュエータ装置 - Google Patents
脚式移動ロボット並びに脚式移動ロボットの関節軸として適用されるアクチュエータ装置 Download PDFInfo
- Publication number
- JP4127043B2 JP4127043B2 JP2002358859A JP2002358859A JP4127043B2 JP 4127043 B2 JP4127043 B2 JP 4127043B2 JP 2002358859 A JP2002358859 A JP 2002358859A JP 2002358859 A JP2002358859 A JP 2002358859A JP 4127043 B2 JP4127043 B2 JP 4127043B2
- Authority
- JP
- Japan
- Prior art keywords
- sensor
- actuator
- contact
- mobile robot
- legged mobile
- 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
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J13/00—Controls for manipulators
- B25J13/08—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
- B25J13/088—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices with position, velocity or acceleration sensors
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J13/00—Controls for manipulators
- B25J13/08—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
- B25J13/085—Force or torque sensors
Landscapes
- Engineering & Computer Science (AREA)
- Human Computer Interaction (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
Description
【発明の属する技術分野】
本発明は、少なくとも複数本の可動脚を備えた脚式移動ロボット並びに脚式移動ロボットの関節軸として適用されるアクチュエータ装置に係り、特に、位置センサ、加速度センサ、角速度センサ、トルク・センサなどのアクチュエータ駆動状況を検知するセンサや接触センサや感圧センサなど外界との接触や衝突を検知するセンサを配置する脚式移動ロボット並びに脚式移動ロボットの関節軸として適用されるアクチュエータ装置に関する。
【0002】
さらに詳しくは、本発明は、位置センサ、加速度センサ、角速度センサ、トルク・センサなどのアクチュエータ駆動状況を検知するセンサを各関節アクチュエータ毎に内蔵するとともに、外界との接触や衝突を検知するセンサをアクチュエータ外部に配設した脚式移動ロボット並びに脚式移動ロボットの関節軸として適用されるアクチュエータ装置に係り、特に、各関節アクチュエータの駆動制御用の信号、アクチュエータ内蔵センサの出力信号、並びにアクチュエータ外に配設されたセンサの出力信号を好適に上位制御系と交信する脚式移動ロボット並びに脚式移動ロボットの関節軸として適用されるアクチュエータ装置に関する。
【0003】
【従来の技術】
電気的若しくは磁気的な作用を用いて人間の動作に似せた運動を行う機械装置のことを「ロボット」という。ロボットの語源は、スラブ語の"ROBOTA(奴隷機械)"に由来すると言われている。わが国では、ロボットが普及し始めたのは1960年代末からであるが、その多くは、工場における生産作業の自動化・無人化などを目的としたマニピュレータや搬送ロボットなどの産業用ロボット(industrial robot)であった。
【0004】
アーム式ロボットのように、ある特定の場所に植設して用いるような据置きタイプのロボットは、部品の組立・選別作業など固定的・局所的な作業空間でのみ活動する。これに対し、移動式のロボットは、作業空間は非限定的であり、所定の経路上または無経路上を自在に移動して、所定の若しくは任意の人的作業を代行したり、ヒトやイヌあるいはその他の生命体に置き換わる種々の幅広いサービスを提供したりすることができる。なかでも脚式の移動ロボットは、クローラ式やタイヤ式のロボットに比し不安定で姿勢制御や歩行制御が難しくなるが、階段や梯子の昇降や障害物の乗り越えや、整地・不整地の区別を問わない柔軟な歩行・走行動作を実現できるという点で優れている。
【0005】
最近では、イヌやネコのように4足歩行の動物の身体メカニズムやその動作を模したペット型ロボット、あるいは、ヒトのような2足直立歩行を行う動物の身体メカニズムや動作をモデルにしてデザインされた「人間形」若しくは「人間型」と呼ばれるロボット(humanoid robot)など、脚式移動ロボットに関する研究開発が進展し、実用化への期待も高まってきている。
【0006】
また、ヒトの生体メカニズムや動作を再現した脚式移動ロボットのことを、特に、「人間形」、若しくは「人間型」のロボット(humanoid robot)と呼ぶ。人間型ロボットは、例えば、生活支援、すなわち住環境その他の日常生活上のさまざまな場面における人的活動の支援などを行なうことができる。
【0007】
人間の作業空間や居住空間のほとんどは、2足直立歩行という人間が持つ身体メカニズムや行動様式に合わせて形成されおり、車輪その他の駆動装置を移動手段とした現状の機械システムが移動するには多くの障壁が存在する。したがって、機械システムすなわちロボットがさまざまな人的作業を代行し、さらに人間の住空間に深く浸透していくためには、ロボットの移動可能範囲が人間のそれとほぼ同じであることが好ましい。これが、脚式移動ロボットの実用化が大いに期待されている所以でもある。
【0008】
この種の脚式移動ロボットは、一般に、多数の関節自由度を備え、関節の動きをアクチュエータ・モータで実現するようになっている。また、各モータの回転位置、回転量などを取り出して、サーボ制御を行なうことにより、所望の動作パターンを再現するとともに、姿勢制御を行なうようになっている。
【0009】
関節自由度を構成するサーボ・モータを小型且つ高性能に設計・製作しなければならない。このため、脚式移動ロボットの関節アクチュエータとして適用することができる、ギア直結型で且つサーボ制御系をワンチップ化してモータ・ユニットに内蔵したタイプの小型ACサーボ・モータなどが既に存在する(例えば、特許文献1を参照のこと)。
【0010】
ところが、従来のユニット化されたアクチュエータは、アクチュエータ本体から電源及び制御信号用のハーネスが出現している。また、アクチュエータ・モータの回転子に連結された出力軸部には、構造材と接続するための機構しか付加されていない。
【0011】
このため、ユーザ(又は設計者)がこうしたアクチュエータ・ユニットを用いて多軸ロボットを構築する場合、幾つもの可動部を経由するハーネスの引き回し設計を行なう必要がある。
【0012】
また、脚式移動ロボットの姿勢安定制御や歩行時の転倒防止に関する提案の多くは、ZMP(Zero Moment Point)を歩行の安定度判別の規範(例えば、非特許文献1を参照のこと)として用いている。ZMP規範に基づく2足歩行パターン生成によれば、足底着地点をあらかじめ設定することができ、路面形状に応じた足先の運動学的拘束条件を考慮し易いなどの利点がある。また、ZMPを安定度判別規範とすることは、力ではなく軌道を運動制御上の目標値として扱うことを意味するので、技術的に実現可能性が高まる。
【0013】
ここで、脚式ロボットをZMP方程式に従って厳密に運動制御することを考えると、制御に用いるローカル座標限定の世界座標における加速度と、ローカル座標系における機体各部の位置(姿勢)、加速度、そしてZMP位置と外力及び外力モーメントを計測し、その計測値をZMP方程式に導入することで、未知外力モーメント及び未知外力を同定しつつ、各部の位置、加速度を制御することが最も厳密に運動制御を行なうことになる。
【0014】
例えば、傾斜計(又は加速度計)、及びジャイロを各軸(ピッチ、ロール、ヨー(X,Y,Z))に1つずつ、6軸力センサの配置位置を、外力及び外力が加わることが想定される部位毎に、実際の作用位置より離れた位置に、最小限の個数のセンサ構成で運動制御を行なう。ところが、このようなセンサ配置に基づく運動制御方式では、制御に用いるローカル座標限定加速度に加え、すべての部位の位置及び加速度を直接的に計測し、制御することは困難である。力やトルクが作用すると路面が動いてしまう砂利上や毛足の長い絨毯上、そして、並進の摩擦係数が十分に確保できず滑りが生じ易い住居内のタイルなどでの安定歩行(運動)や、ロボット自身の構造に柔軟性を持たせることで跳躍を伴う全身運動の実現を目指したロボットの運動制御を保証することはできない。
【0015】
これに対し、制御に用いるローカル座標とその座標を直接的に計測するための加速度センサや角速度センサ、速度センサを各制御点毎に配置し、さらに計算モデルで用いる各ベクトル位置に加速度センサと姿勢センサを配置するという提案がなされている(例えば、非特許文献2を参照のこと)。これによって、ZMP方程式(又は運動方程式)の導入に必要な制御パラメータ値を直接的に計測することができる。この結果、機体が剛体で外力などの印加で変形しないという条件を前提としないで厳密な運動制御を応答性よく実現することができる。
【0016】
しかしながら、このように機体の姿勢安定制御に万全を期そうとした場合、機体のさまざまな部位に隙間なく加速度センサや角速度センサ、速度センサを配置する必要がある。このような場合、局部からのセンサ出力を中央の制御ユニットに伝達するためには、幾つもの可動部を経由するハーネスの引き回し設計を行なう必要がある。
【0017】
また、この種の自由度の高い脚式移動ロボットは、あらゆる環境下での使用が想定され、機械的な可動部を持ち、その可動部の動作によって人間との情報のやりとりやエンタティンメントを目的としており、機体の制御系が保証する運用条件を逸脱するような場面が多々存在する。例えば、人間が接触して触覚による情報授受を行なう場合、玩具などのロボットと異なり、人間はそのロボットの動作を予期することが困難であり、可動部によって指などを挟み込まれる危険があるという課題がある。また、その危険による恐怖感のために情報の授受を楽しむことが困難となるという問題も発生している。
【0018】
このため、例えば肘や膝など可動範囲が広くユーザの挟み込みや巻き込みを引き起こす危険のある関節部位にトルク・センサを配設し、これらセンサ出力を基に挟み込みや巻き込みを自動検出するシステムなどが提案されている(例えば、特許文献2を参照のこと)。この場合、脚式移動ロボットは、所定の部位においてユーザの手指などの挟み込みを検出すると、これを回避するための動作を実行する。これによって、機械的な可動部の動作によって人間との情報のやりとりやエンタティンメントを目的としたロボットが人の手指などを動作によって挟み込む危害を防止することができる。この場合、安全なロボットを提供でき、加えて恐怖感などを人に与えることがなくなり、ロボットとの情報授受を安心して楽しめるという効果がある。
【0019】
ところが、ロボットの可動時における危険回避に関し、さらに万全を期そうとした場合、機体のさまざまな関節部位に隙間なくトルク・センサやや温度センサなどを配置する必要がある。挟み込みや他物体との干渉に関し、さらに詳細に言及するならば、トルク検出などアクチュエータ内部のセンサ情報だけでは不十分であり、感圧センサを外筐に配置するなどアクチュエータ外部のセンサ情報が必要である。
【0020】
このような場合、局部からのセンサ出力を中央の制御ユニットに伝達するためには、幾つもの可動部を経由するハーネスの引き回し設計を行なう必要がある。
【0021】
アクチュエータの駆動制御用の信号線に加え、上記のセンサ信号伝送用の信号線を勘案した場合、機体のハーネスの引き回し設計は不可能に等しい状況となってくる。
【0022】
【特許文献1】
特開2000−299970号公報
【特許文献2】
特開2002−342963号公報
【非特許文献1】
Miomir Vukobratovic著"LEGGED LOCOMOTION ROBOTS"(加藤一郎外著『歩行ロボットと人工の足』(日刊工業新聞社))
【非特許文献2】
特願2002−297207
【0023】
【発明が解決しようとする課題】
本発明の目的は、位置センサ、加速度センサ、角速度センサ、トルク・センサなどのアクチュエータ駆動状況を検知するセンサや接触センサや感圧センサなど外界との接触や衝突を検知するセンサを配置する優れた脚式移動ロボット並びに脚式移動ロボットの関節軸として適用されるアクチュエータ装置を提供することにある。
【0024】
本発明のさらなる目的は、位置センサ、加速度センサ、角速度センサ、トルク・センサなどのアクチュエータ駆動状況を検知するセンサを各関節アクチュエータ毎に内蔵するとともに、外界との接触や衝突を検知するセンサをアクチュエータ外部に配設した優れた脚式移動ロボット並びに脚式移動ロボットの関節軸として適用されるアクチュエータ装置を提供することにある。
【0025】
本発明のさらなる目的は、各関節アクチュエータの駆動制御用の信号、アクチュエータ内蔵センサの出力信号、並びにアクチュエータ外に配設されたセンサの出力信号を好適に上位制御系と交信することができる、優れた脚式移動ロボット並びに脚式移動ロボットの関節軸として適用されるアクチュエータ装置を提供することにある。
【0026】
【課題を解決するための手段及び作用】
本発明は、上記課題を参酌してなされたものであり、その第1の側面は、少なくとも複数本の可動脚を備え、各関節自由度がアクチュエータ装置によって実現される脚式移動ロボットであって、
位置センサ、加速度センサ、角速度センサ、トルク・センサなどのアクチュエータ駆動状況を検知するセンサを各関節アクチュエータ装置毎に内蔵するとともに、外界との接触や衝突を検知するセンサをアクチュエータ装置の外部に配設し、
前記アクチュエータ装置は、当該装置外部に配設された1以上のセンサからのセンサ信号を取り込むための入力インターフェースと、内蔵センサ及び外部センサから取り込んだセンサ信号のノイズ除去などの信号処理部と、上位制御系からのコマンドに従ったアクチュエータ・モータの駆動制御やセンサ情報の処理などの演算処理を行なう演算処理部を備える、
ことを特徴とする脚式移動ロボットである。
【0027】
本発明の第1の側面に係る脚式移動ロボットにおいて、機体の関節自由度を構成する各アクチュエータは、位置センサ、角速度センサ、加速度センサ、温度センサ、トルク・センサといったアクチュエータの駆動に関する情報を検知するセンサ類を内蔵している。
【0028】
また、機体上にはアクチュエータ間を接続するバス(共通信号線路)が構成されており、上位制御系とのアクチュエータの駆動制御信号の授受や、アクチュエータ内蔵センサからのセンサ情報の伝達は、このバスを利用して行なわれる。この種のバスは、例えばUSB(Universal Serial Bus)などのバス・インターフェース規格に基づいて設計し、高速のシリアル通信を実現することができる。
【0029】
また、各アクチュエータ装置は、装置外部に配設された接触センサやその他のセンサからの1以上のセンサ信号を得るための入力インターフェースを備えている。さらにアクチュエータ装置内では、これら1以上のセンサ入力を受け付ける信号処理回路とその演算能力を備え、さらにアクチュエータ装置のバス・インターフェースは、外部センサから取り込んだセンサ信号の処理結果をバス転送するように構成されている。
【0030】
また、機体上の任意の場所の接触センサからの出力を、配線経路が最短となる(又は、関節駆動の干渉とならない)最寄りのアクチュエータ装置に入力する。そして、アクチュエータ装置内では、この外部センサの出力を信号ノイズの除去などの処理や、センサ情報の演算などの処理を施す。そして、これらの処理結果を、アクチュエータの駆動制御信号とアクチュエータ内蔵センサからのセンサ情報とともに、バス転送して、上位制御系へ送信する。
【0031】
すなわち、アクチュエータの駆動制御信号とアクチュエータ内蔵センサからのセンサ情報、並びにアクチュエータ装置外のセンサからのセンサ情報はすべてバスを利用して上位制御系へ伝達される。
【0032】
したがって、アクチュエータ装置の外部に配設されたセンサからのセンサ情報を上位制御系へ伝達する際の、浮遊容量の影響や、配線のインピーダンス増による高周波ノイズが信号に重畳されるという問題を解決することができる。また、機体の配線構造を簡素化することができるので、設計が容易になるとともに、配線過多に伴う動作負荷の増大や、動作繰り返しによる配線の損傷などの問題も解決することができる。
【0033】
また、左右の脚部や腕部など、各可動ユニット毎に伝送信号線を集結するハブ装置を配設することにより、さらに配線構造の簡素化を実現することができる。
【0034】
また、本発明の第2の側面は、脚式移動ロボットの関節軸として適用されるアクチュエータ装置であって、
アクチュエータ・モータと、
位置センサ、加速度センサ、角速度センサ、トルク・センサなどのアクチュエータ駆動状況を検知するための装置内蔵センサと、
外界との接触や衝突を検知するために当該装置外部に配設された1以上のセンサからのセンサ信号を取り込むための入力インターフェースと、
前記装置内蔵センサ及び外部センサから取り込んだセンサ信号のノイズ除去などの信号処理部と、
上位制御系からのコマンドに従った前記アクチュエータ・モータの駆動制御やセンサ情報の処理などの演算処理を行なう演算処理部と、
を具備することを特徴とする脚式移動ロボットの関節軸として適用されるアクチュエータ装置である。
【0035】
ここで、前記装置内蔵センサは、位置センサ、加速度センサ、角速度センサ、トルク・センサ、温度センサのうち少なくとも1つを含むものとする。
【0036】
また、前記外部センサは、外界との接触や衝突を検知するための接触センサ又は感圧センサである。
【0037】
そして、脚式移動ロボットの関節軸として適用されたとき、アクチュエータ装置は、配線経路が最短となるような最寄りの外部センサから前記入力インターフェースを介してセンサ信号を取り込むようにする。
【0038】
本発明の第2の側面に係るアクチュエータ装置によれば、アクチュエータの駆動制御信号とアクチュエータ内蔵センサからのセンサ情報、並びにアクチュエータ装置外のセンサからのセンサ情報はすべてバスを利用して上位制御系へ伝達される。
【0039】
したがって、アクチュエータ装置の外部に配設されたセンサからのセンサ情報を上位制御系へ伝達する際の、浮遊容量の影響や、配線のインピーダンス増による高周波ノイズが信号に重畳されるという問題を解決することができる。また、機体の配線構造を簡素化することができるので、設計が容易になるとともに、配線過多に伴う動作負荷の増大や、動作繰り返しによる配線の損傷などの問題も解決することができる。
【0040】
本発明のさらに他の目的、特徴や利点は、後述する本発明の実施形態や添付する図面に基づくより詳細な説明によって明らかになるであろう。
【0041】
【発明の実施の形態】
以下、図面を参照しながら本発明の実施形態について詳解する。
【0042】
図1及び図2には、本発明の実施形態に係る脚式移動ロボット100の外観構成を示している。この脚式移動ロボット100は、2脚2腕を有する「人間形」又は「人間型」と呼ばれるものであり、胴体部と、頭部と、左右の上肢部と、脚式移動を行う左右2足の下肢部とで構成され、例えば胴体に内蔵されている制御部(図示しない)により機体の動作を統括的にコントロールするようになっている。
【0043】
左右各々の下肢は、大腿部と、膝関節と、脛部と、足首と、足平とで構成され、股関節によって体幹部の略最下端にて連結されている。また、左右各々の上肢は、上腕と、肘関節と、前腕とで構成され、肩関節によって体幹部の上方の左右各側縁にて連結されている。また、頭部は、首関節によって体幹部の略最上端中央に連結されている。
【0044】
制御部は、この脚式移動ロボット100を構成する各関節アクチュエータの駆動制御や各センサ(後述)などからの外部入力を処理するコントローラ(主制御部)や、電源回路その他の周辺機器類を搭載した筐体である。制御部は、その他、遠隔操作用の通信インターフェースや通信装置を含んでいてもよい。
【0045】
また、図3には、この脚式移動ロボット100が具備する関節自由度構成を模式的に示している。各関節軸の駆動にはアクチュエータ・モータが適用される。
【0046】
頭部を支持する首関節(Neck)は、首関節ヨー軸と、第1及び第2の首関節ピッチ軸と、首関節ロール軸という4自由度を有している。
【0047】
また、左右の各腕部はそれぞれ、その関節自由度として、肩(Shoulder)における肩関節ピッチ軸と、肩関節ロール軸と、肩関節ヨー軸、肘(Elbow)における肘関節ピッチ軸という4自由度を備えている。さらに腕部の先端に配設される手部は、実際には、複数本の指を含む多関節・多自由度構造体(図示しない)である。
【0048】
また、体幹部(Body又はTrunk)は、体幹ピッチ軸と、体幹ロール軸という2自由度を有する。
【0049】
また、下肢を構成する左右各々の脚部は、股関節(Hip又はThigh)における股関節ヨー軸と、股関節ピッチ軸と、股関節ロール軸と、膝(Knee)における膝関節ピッチ軸と、足首(Ankle)における足首関節ピッチ軸と、足首関節ロール軸という6自由度を備えている。また、脚部の下端には、通常歩行時の着床部位としての足部が配設されている。
【0050】
図1〜図3に示すように構成された脚式移動ロボット100は、制御部による全身協調的な動作制御により、2足歩行を実現することができる。かかる2足歩行は、一般に、以下に示す各動作期間に分割される歩行周期を繰り返すことによって行われる。すなわち、
【0051】
(1)右脚を持ち上げた、左脚による単脚支持期
(2)右足が接地した両脚支持期
(3)左脚を持ち上げた、右脚による単脚支持期
(4)左足が接地した両脚支持期
【0052】
本実施形態に係る脚式移動ロボット100は、ZMP(Zero Moment Point)を機体の姿勢安定度判別の規範として用いている。ZMPによる安定度判別規範は、系が適切なZMP空間を形成し、支持多角形の内側にZMPがある場合は、系に回転運動や並進運動が発生せず、回転や並進に関する運動方程式を解く必要がない。但し、支持多角形の内側にZMPがない場合や、外界に対する支持作用点が存在しない場合は、ZMP方程式に代えて、運動方程式を解く必要がある。
【0053】
機体のZMP方程式は、制御目標点において印加される各モーメントの釣合い関係を記述したものである。世界座標系(O−XYZ)で記述された機体のZMP釣合い方程式、並びに機体のローカル座標系(O−X’Y’Z’)で記述された機体のZMP釣合い方程式はそれぞれ以下の通りとなる。
【0054】
【数1】
【0055】
【数2】
【0056】
上記の各式は、各質点(又は制御点)miにおいて印加された加速度成分により生成されるZMP回り(半径ri−rzmp)のモーメントの総和と、各質点miに印加された外力モーメントMiの総和と、外力Fkにより生成されるZMP回り(k番目の外力Fkの作用点をskとする)のモーメントの総和が釣り合うということを記述している。
【0057】
このZMP釣合い方程式は、総モーメント補償量すなわちモーメント・エラー成分Tを含んでいる。このモーメント・エラーをゼロ又は所定の許容範囲内に抑えることによって、機体の姿勢安定性が維持される。すなわち、モーメント・エラーをゼロ又は許容値以下となるように機体運動を修正することが、ZMPを安定度判別規範とした姿勢安定制御の本質である。
【0058】
本実施形態に係る脚式移動ロボット100は、外界と接触する各部位にZMPと力を直接計測する反力センサ・システムを配置する。また、運動制御に用いるローカル座標とその座標を直接的に計測するための速度センサや加速度センサ、角度センサを機体の各部位配置し、さらに計算モデルで用いている各ベクトル位置に加速度センサと姿勢センサを機体の各部位に配置する。
【0059】
本実施形態に係る運動制御用のセンサ・システムは、各アクチュエータの重心付近に、加速度、角加速度、加速度センサを搭載することによって構成されている。すなわち、機体上の主な質量集中部位としての各アクチュエータの重心付近を制御点として、各制御点において印加される加速度成分を制御点毎に直接計測し、これにより生成される制御点におけるZMP回りのモーメント項、制御点に印加される外力モーメント項、制御点に印加される外力により生成されるZMP回りのモーメント項を、各部位毎に直接算出することができる。
【0060】
そして、中央の制御ユニットにおいては、各制御点から集められたこれらモーメント項を順次加算してその総和をとることで、より厳密なZMP釣合い方程式を直接的に導入することができる。また、各制御点毎にモーメント項を直接計測していることから、機体が剛体で外力などの印加で変形しないという条件を前提としないで厳密な運動制御を応答性よく実現することができる。
【0061】
図4には、脚式移動ロボット100の機体上の各アクチュエータの重心付近に加速度、角加速度、角速度センサを搭載している様子を示している。同図に示すように、主要な外界との接触部位として、手のひらと足底に外力センサ及び外力モーメント・センサを搭載している。
【0062】
上述したように機体の姿勢安定制御に万全を期すために、機体のさまざまな部位に隙間なく加速度センサや角速度センサ、速度センサを配置した場合、局部からのセンサ出力を中央の制御ユニットに伝達するためには、幾つもの可動部を経由するハーネスの引き回し設計を行なう必要がある(後述)。
【0063】
また、本実施形態に係る脚式移動ロボット100の場合、可動部の動作によって人間との情報のやりとりやエンタティンメントを目的とし、機械的な可動範囲が広いため、ユーザの指やその他の異物をこれら可動部に挟み込んだり巻き込んだりするなど、機体の制御系が保証する運用条件を逸脱するような場面が多々存在する。
【0064】
このため、例えば肘や膝など可動範囲が広くユーザの挟み込みや巻き込みを引き起こす危険のある関節部位のアクチュエータ内にトルク・センサや温度センサを配設している。この場合、脚式移動ロボット100は、所定の部位においてトルク・リミッタを検出すると、ユーザの手指や異物などの挟み込み又は巻き込みを回避するための動作を実行する。
【0065】
このような場合、アクチュエータ駆動制御用の信号線とは別に各センサの出力信号線を機体に配線するという設計方法以外に、機体上のアクチュエータ間を接続するバス(共通信号線路)を構成して、アクチュエータの駆動制御信号とアクチュエータ内蔵センサからのセンサ情報をともにこのバスを利用して伝達するという設計方法も考えられる。
【0066】
また、他物体との干渉問題や異物の挟み込み検知、ユーザの指などの保護のための挟み込み検知に関し万全を期すためには、トルク・センサや温度センサなどアクチュエータ内部のセンサ情報だけでは十分な検知結果を得ることができない。
【0067】
そこで、本実施形態では、さらに、機体が外界との接触したこと(すなわち接触情報)を検知するための接触センサを各部位に配置して、アクチュエータ外部のセンサ情報を得るようにしている。接触センサとして、例えば感圧式や静電容量式のセンサが適用される。
【0068】
図5には、脚式移動ロボット100の全身の各部位に、ユーザの体の一部や異物の挟み込み又は巻き込み(pinch)を検出する接触センサを配置した様子を模式的に示している。
【0069】
頭部には、首関節ロール軸の駆動により左右の頬と肩における挟み込み又は巻き込み(pinch)を検出するための接触センサ(R/L_neck_pinch_sensor)が配設されている。
【0070】
左右の腕部には、外界との接触や衝突を検知するために、上腕及び前腕にそれぞれ接触センサ(R/L_upper_arm_out−pinch_sensor,R/L_arm_out−pinch_sensor)が配設されている。
【0071】
また、左右の腕部先端には、手先による外界との接触や衝突を検知するための接触センサ(R/L_hand_pinch_sensor)が配設されている。
【0072】
また、左右の腕部と胴体側面との間でユーザの体の一部や異物の挟み込み又は巻き込みを検出するために、上腕側の接触センサ(R/L_upper_arm_in−pinch_sensor)及びこれに対応する胴体側面側の接触センサ(R/L_armpit_pinch_sensor)、並びに、前腕側の接触センサ(R/L_arm_in−pinch_sensor)及びこれに対応する胴体側面側の接触センサ(R/L_waist_pinch_sensor)がそれぞれ配設されている。
【0073】
左右の脚部には、外界との接触や衝突を検知するために、大腿及び下腿にそれぞれ接触センサ(R/L_thigh_out−pinch_sensor,R/L_leg_out−pinch_sensor)が配設されている。
【0074】
また、左右の脚部の間でユーザの体の一部や異物の挟み込み又は巻き込みを検出するために、大腿側の接触センサ(R/L_thigh_in−pinch_sensor)並びに、下腿側の接触センサ(R/L_leg_in−pinch_sensor)がそれぞれ配設されている。
【0075】
また、左右の足部足底には、着床又は離床を検知するための接触センサ(R/L_Foot_pinch_sensor)が配設されている。
【0076】
このようにアクチュエータ外部のセンサを機体の各部位に配置した場合、局部からのセンサ出力を中央の制御ユニットに伝達するためには、幾つもの可動部を経由するハーネスの引き回し設計を行なう必要がある。
【0077】
図6には、脚式移動ロボット100の全身の各部位に配置された接触センサからのセンサ情報を上位コントローラへ伝達するためのセンサ信号を含んだ機体の配線構造の一例を示している。
【0078】
既に述べたように、機体の関節自由度を構成する各アクチュエータは、一センサ、角速度センサ、加速度センサ、温度センサ、トルク・センサといったアクチュエータの駆動に関する情報を検知するセンサ類を内蔵している。同図に示す例では、機体上のアクチュエータ間を接続するバス(共通信号線路)が構成されており、アクチュエータの駆動制御信号とアクチュエータ内蔵センサからのセンサ情報に関しては、このバスを利用して上位制御系へ伝達される。この種のバスは、例えばUSB(Universal Serial Bus)などのバス・インターフェース規格に基づいて設計し、高速のシリアル通信を実現することができる。
【0079】
一方、図5に示した接触センサなどのアクチュエータ外部に配設されたセンサ出力信号は、バス以外のセンサ信号線によって上位制御系へ伝達される。このような場合、センサ信号線は比較的長い配線となってしまう。
【0080】
局部に配設された各接触センサからのセンサ信号がアナログ信号で出力されている場合、配線経路が長いことで浮遊容量の影響や、配線のインピーダンス増による高周波ノイズが信号に重畳されてしまう。このため、上位制御系では正しい接触情報が得られない可能性がある。
【0081】
また、局部に配設された各接触センサからのセンサ信号をデジタル信号により通信する場合(例えば、局部毎に信号処理回路を備え、USBなどの高速シリアル通信を利用するなど)であっても、配線経路が長いことで浮遊容量の影響や、配線のインピーダンス増による高周波ノイズが信号に重畳されてしまう。この場合も、上位制御系では正しい接触情報が得られない可能性がある。
【0082】
また、図1〜図3に示すような脚式移動ロボット100においては、可動部分が多く且つ可動範囲が大きい構成となっているため、配線が多いと駆動時の動作の抵抗となり、制御系の想定外の負荷が発生し、機体の姿勢安定などの動作に悪影響を与えるであろう。また、動作の繰り返しに伴う疲労により配線が断線し易い構成となる。
【0083】
図7には、脚式移動ロボット100の全身の各部位に配置された接触センサからのセンサ情報を上位コントローラへ伝達するためのセンサ信号を含んだ機体の配線構造についての他の例を示している。
【0084】
既に述べたように、機体の関節自由度を構成する各アクチュエータは、位置センサ、角速度センサ、加速度センサ、温度センサ、トルク・センサといったアクチュエータの駆動に関する情報を検知するセンサ類を内蔵している。
【0085】
同図に示す例では、機体上にはアクチュエータ間を接続するバス(共通信号線路)が構成されており、アクチュエータの駆動制御信号とアクチュエータ内蔵センサからのセンサ情報はこのバスを利用して上位制御系へ伝達される。この種のバスは、例えばUSB(Universal Serial Bus)などのバス・インターフェース規格に基づいて設計し、高速のシリアル通信を実現することができる。
【0086】
また、各アクチュエータ装置は、装置外部に配設された接触センサやその他のセンサからの1以上のセンサ信号を得るための入力インターフェースを備えている。さらにアクチュエータ装置内では、これら1以上のセンサ入力を受け付ける信号処理回路とその演算能力を備え、さらにアクチュエータ装置のバス・インターフェースは、外部センサから取り込んだセンサ信号の処理結果をバス転送するように構成されている。
【0087】
機体上の任意の場所の接触センサからの出力を、配線経路が最短となる(又は、関節駆動の干渉とならない)最寄りのアクチュエータ装置に入力する。そして、アクチュエータ装置内では、この外部センサの出力を信号ノイズの除去などの処理や、センサ情報の演算などの処理を施す。そして、これらの処理結果を、アクチュエータの駆動制御信号とアクチュエータ内蔵センサからのセンサ情報とともに、バス転送して、上位制御系へ送信する。
【0088】
すなわち、図7に示す実施形態では、アクチュエータの駆動制御信号とアクチュエータ内蔵センサからのセンサ情報、並びにアクチュエータ装置外のセンサからのセンサ情報はすべてバスを利用して上位制御系へ伝達される。
【0089】
したがって、アクチュエータ装置外のセンサからのセンサ情報を上位制御系へ伝達する際の、浮遊容量の影響や、配線のインピーダンス増による高周波ノイズが信号に重畳されるという問題を解決することができる。また、機体の配線構造を簡素化することができるので、設計が容易になるとともに、配線過多に伴う動作負荷の増大や、動作繰り返しによる配線の損傷などの問題も解決することができる。
【0090】
また、図8には、脚式移動ロボット100の全身の各部位に配置された接触センサからのセンサ情報を上位コントローラへ伝達するためのセンサ信号を含んだ機体の配線構造についてのさらに他の例を示している。
【0091】
図7を参照しながら既に説明したように、アクチュエータ駆動制御用の信号、並びにセンサ出力信号の転送をすべてバス上で行なうように構成することにより、機体の配線構造を簡素化することができる。図8に示す例では、左右の脚部や腕部など、各可動ユニット毎に伝送信号線を集結するハブ装置を配設することにより、さらに配線構造の簡素化を図っている。この場合、膝や肘などの可動部を通過する配線本数を図7に示す場合よりもさらに減少することができる。
【0092】
図9には、脚式移動ロボット100の全身に配置されたセンサを、最寄りのアクチュエータ装置、ハブ、及びバスを経由して上位制御系へ伝達する配線構造を模式的に示している。但し、各部のセンサ信号は、アナログ信号、デジタルPWM信号、シリアル通信バスなどで構成することができる。
【0093】
左右の頬と肩における挟み込み又は巻き込み(pinch)を検出するための頭部の接触センサ(R/L_neck_pinch_sensor)からのセンサ信号は、第1の首関節ピッチ軸駆動用のアクチュエータに入力され、このアクチュエータ装置内で信号ノイズの除去などの処理や、センサ情報の演算などの処理が施される。
【0094】
そして、第1の首関節ピッチ軸駆動用のアクチュエータ装置の入出力信号線は、この部位を集線するハブに集結された後、上位制御系と相互接続される。
【0095】
また、前腕における外界との接触や衝突を検知するために接触センサ(R/L_arm_out−pinch_sensor)、前腕部と胴体側面との間でユーザの体の一部や異物の挟み込み又は巻き込みを検出するための前腕側の接触センサ(R/L_arm_in−pinch_sensor)、並びに手先による外界との接触や衝突を検知するための接触センサ(R/L_hand_pinch_sensor)からのセンサ信号は、それぞれ左右の肘ピッチ軸駆動用のアクチュエータに入力され、このアクチュエータ装置内で信号ノイズの除去などの処理や、センサ情報の演算などの処理が施される。
【0096】
また、上腕における外界との接触や衝突を検知するために接触センサ(R/L_upper_arm_out−pinch_sensor)、並びに上腕部と胴体側面との間でユーザの体の一部や異物の挟み込み又は巻き込みを検出するための上腕側の接触センサ(R/L_upper_arm_in−pinch_sensor)からのセンサ信号は、それぞれ左右の肩ヨー軸駆動用のアクチュエータに入力され、このアクチュエータ装置内で信号ノイズの除去などの処理や、センサ情報の演算などの処理が施される。
【0097】
また、上腕部と胴体側面との間でユーザの体の一部や異物の挟み込み又は巻き込みを検出するための上腕側の接触センサ(R/L_armpit_pinch_sensor)からのセンサ信号は、それぞれ左右の肩ロール軸駆動用のアクチュエータに入力され、このアクチュエータ装置内で信号ノイズの除去などの処理や、センサ情報の演算などの処理が施される。
【0098】
そして、肘ピッチ軸駆動用のアクチュエータ装置、肩ヨー軸駆動用のアクチュエータ、肩ロール軸駆動用のアクチュエータの各入出力信号線は、この部位を集線する左右のハブにそれぞれ集結された後、上位制御系と相互接続される。
【0099】
また、着床又は離床を検知するための接触センサ(R/L_Foot_pinch_sensor)からのセンサ信号は、それぞれ左右の足首ピッチ軸駆動用のアクチュエータに入力され、このアクチュエータ装置内で信号ノイズの除去などの処理や、センサ情報の演算などの処理が施される。
【0100】
また、下腿部と外界との接触や衝突を検知するための接触センサR/L_leg_out−pinch_sensor)、並びに左右の下腿部の間でユーザの体の一部や異物の挟み込み又は巻き込みを検出するための接触センサ(R/L_leg_in−pinch_sensor)からのセンサ信号は、それぞれ左右の膝ピッチ軸駆動用のアクチュエータに入力され、このアクチュエータ装置内で信号ノイズの除去などの処理や、センサ情報の演算などの処理が施される。
【0101】
また、大腿部と外界との接触や衝突を検知するための接触センサR/L_thigh_out−pinch_sensor)、並びに左右の大腿部の間でユーザの体の一部や異物の挟み込み又は巻き込みを検出するための接触センサ(R/L_thigh_in−pinch_sensor)からのセンサ信号は、それぞれ左右の大腿(股関節)ピッチ軸駆動用のアクチュエータに入力され、このアクチュエータ装置内で信号ノイズの除去などの処理や、センサ情報の演算などの処理が施される。
【0102】
また、上腕部と胴体側面との間でユーザの体の一部や異物の挟み込み又は巻き込みを検出するための胴体側の接触センサ(R/L_waist_pinch_sensor)からのセンサ信号は、それぞれ左右の大腿(股関節)ロール軸駆動用のアクチュエータに入力され、このアクチュエータ装置内で信号ノイズの除去などの処理や、センサ情報の演算などの処理が施される。
【0103】
そして、足首ピッチ軸駆動用のアクチュエータ装置、膝ピッチ軸駆動用のアクチュエータ、大腿(股関節)ピッチ軸駆動用のアクチュエータ、大腿(股関節)ロール軸駆動用のアクチュエータの各入出力信号線は、この部位を集線する左右のハブにそれぞれ集結された後、上位制御系と相互接続される。
【0104】
図10には、本実施形態に係るアクチュエータ・ユニットの構成例を示している。
【0105】
同図に示す関節アクチュエータは、回転子マグネットと、複数相の磁気コイルからなる固定子で構成されるモータ部と、モータ部の出力する回転を加減速するギア・ユニットと、モータ部への供給電力を制御する制御部で構成される。
【0106】
制御部は例えば印刷配線板で構成され、その略中央には、センサ・ユニットが搭載されている。
【0107】
センサ・ユニットは、姿勢安定制御の入力パラメータを得るための1軸〜3軸の加速度センサと、1〜2軸の角速度センサと、3軸の角速度センサの組み合わせで構成され、アクチュエータ・ユニットの重心付近に配設されている。この他、トルク・センサや温度センサなどのアクチュエータ駆動状況を検知するセンサを内蔵している。
【0108】
図11には、図10に示した関節アクチュエータの機能構成を模式的に示している。同図に示すように、アクチュエータ10は、バス・インターフェース部11と、演算処理部12と、モータ制御部13と、センサ信号処理部14と、センサ入力インターフェース17を備えている。
【0109】
バス・インターフェース部11は、ハブ及びバスを介した上位制御系との間でのインターフェース・プロトコルを実現する。
【0110】
演算処理部12は、インターフェース部12を介して受け取ったホスト・コマンドを処理してモータ制御部13に伝達したり、モータ制御部13やセンサ信号処理部14からのセンサ情報をインターフェース部12経由でホスト・コントローラに返したりする。
【0111】
モータ制御部13は、ホスト・コマンドに従ったモータの回転を実現するための電流信号をモータ・コイル15にPWM(Pulse Width Modulation)出力し、また、回転子(図示しない)の回転位置を検出する位置センサ16からの角度情報を取得する。
【0112】
センサ信号処理部14は、アクチュエータ内蔵センサからのセンサ信号の信号ノイズの除去などの処理を行なう内蔵センサ用信号処理部14Aと、アクチュエータ装置の外部に配設された外部センサ用の信号処理部14Bで構成される。
【0113】
アクチュエータ内蔵センサは、加速度センサ(X〜Y)、ジャイロ・センサ(ピッチ、ロール、ヨー)、位置センサ、トルク・センサ、温度センサなど、センサ・ユニットに含まれている。
【0114】
また、アクチュエータ装置の外部に配設された外部センサとして、機体各部の外筐に配設された接触センサなどが挙げられる。これら外部センサからのセンサ信号は、センサ入力インターフェース17を介して外部センサ用の信号処理部14Bに取り込まれる。
【0115】
図7〜図9を参照しながら既に説明したように、機体上の任意の場所の接触センサからの出力は、配線経路が最短となる(又は、関節駆動の干渉とならない)最寄りのアクチュエータ装置に入力する。そして、アクチュエータ装置内では、外部センサ用の信号処理部14Bにおいて外部センサの出力を信号ノイズの除去などの処理や、センサ情報の演算などの処理を施す。そして、これらの処理結果を、アクチュエータの駆動制御信号とアクチュエータ内蔵センサからのセンサ情報とともに、バス転送して、上位制御系へ送信する。
【0116】
本実施形態に係るアクチュエータ装置によれば、アクチュエータの駆動制御信号とアクチュエータ内蔵センサからのセンサ情報、並びにアクチュエータ装置外のセンサからのセンサ情報はすべてバスを利用して上位制御系へ伝達される。
【0117】
したがって、アクチュエータ装置の外部に配設されたセンサからのセンサ情報を上位制御系へ伝達する際の、浮遊容量の影響や、配線のインピーダンス増による高周波ノイズが信号に重畳されるという問題を解決することができる。また、機体の配線構造を簡素化することができるので、設計が容易になるとともに、配線過多に伴う動作負荷の増大や、動作繰り返しによる配線の損傷などの問題も解決することができる。
【0118】
図12には、接触センサからの接触情報を用いた脚式移動ロボット100の機体動作の処理手順をフローチャートの形式で示している。
【0119】
機体上の任意の部位における接触センサが接触情報を検知すると、接触情報を検知した部位周辺のアクチュエータの発生トルクを検査する(ステップS1)。また、他の個所のセンサの接触情報も同時に検査する(ステップS2)。
【0120】
そして、接触情報を検知した部位周辺のアクチュエータの発生トルクが通常時よりも明らかに大きいとき(ステップS2)、あるいは、異物を挟む関係にある接触センサが500ミリ秒以内にオンとなったとき(ステップS3)には各状況に応じた処理を実行する(ステップS10)。
【0121】
すなわち、接触情報を検知した部位周辺のアクチュエータの発生トルクが通常時よりも明らかに大きくなったが、異物を挟む関係にある接触センサが500ミリ秒以内にオンとならなかったとき(ケース1)、あるいは、接触情報を検知した部位周辺のアクチュエータの発生トルクが通常時よりも大きくなることはないが、異物を挟む関係にある接触センサが500ミリ秒以内にオンとなったとき(ケース2)には、異物を関節とリンクで挟んだと判断して(ステップS6)、異物を挟んだリンクを駆動するアクチュエータのサーボ制御器の比例ゲインを2分の1に減じ(ステップS7)、該当部位における機械受動性(コンプライアンス)を上げる。また、上位制御系に対して異物挟み込み発生を通知する(ステップS8)。
【0122】
また、接触情報を検知した部位周辺のアクチュエータの発生トルクが通常時よりも明らかに大きくなるとともに、異物を挟む関係にある接触センサが500ミリ秒以内にオンとなったときには(ケース3)、干渉が発生したとして(ステップS9)、上位制御系に干渉発生を通知する(ステップS10)。
【0123】
一方、ステップS2において接触情報を検知した部位周辺のアクチュエータの発生トルクが通常時よりも大きくなることなく、且つ、ステップS3において異物を挟む関係にある接触センサが500ミリ秒以内にオンとならなかったときには、干渉が発生したとして(ステップS7)、上位制御系に干渉発生を通知する(ステップS8)。
【0124】
そして、上位制御系に対して干渉発生又は異物挟み込み発生を通知した後、ステップS13では、機体の状況に応じて以下の処理を実行する。すなわち、
【0125】
(1)干渉発生時、ZMP規範の姿勢安定化制御が可能な範囲での動作軌道修正が可能であれば、機体動作の軌道を修正する。
(2)干渉発生時、ZMP規範の姿勢安定化制御が可能な範囲での動作軌道修正が不可能であれば、機体動作を停止する。
(3)異物挟み込み又は巻き込み発生時には、機体動作を停止して、挟み込みや巻き込みがこれ以上進行しないようにする。
【0126】
そして、実行された処理がケース1であった場合には、動作軌道の修正をして、各関節アクチュエータに指令を発行する(ステップS14)。そして、干渉を回避できるようになるまで、動作軌道の修正を繰り返し実行する(ステップS15)。
【0127】
また、実行された処理がケース2又はケース3であった場合には、すべての関節アクチュエータの動作を停止する(ステップS16)。そして、異物挟み込みという状況が解除されるまで、アクチュエータの動作停止を継続する(ステップS17)。
【0128】
本実施形態によれば、例えば肘や膝など可動範囲が広くユーザの挟み込みや巻き込みを引き起こす危険のある関節アクチュエータにトルク・センサを配設するとともに、機体の各部位の外筐に外界との接触や衝突を検出する接触センサを配設し、これらセンサ出力を基に挟み込みや巻き込みを自動検出することができる。
【0129】
そして、上述したような処理手順に従って動作することにより、脚式移動ロボットは、所定の部位においてユーザの手指などの挟み込みを検出すると、これを回避するための動作を実行する。これによって、機械的な可動部の動作によって人間との情報のやりとりやエンタティンメントを目的としたロボットが人の手指などを動作によって挟み込む危害を防止することができる。この場合、安全なロボットを提供でき、加えて恐怖感などを人に与えることがなくなり、ロボットとの情報授受を安心して楽しめるという効果がある。
【0130】
[追補]
以上、特定の実施例を参照しながら、本発明について詳解してきた。しかしながら、本発明の要旨を逸脱しない範囲で当業者が該実施例の修正や代用を成し得ることは自明である。
【0131】
本発明の要旨は、必ずしも「ロボット」と称される製品には限定されない。すなわち、電気的若しくは磁気的な作用を用いて人間の動作に似せた運動を行う機械装置であるならば、例えば玩具等のような他の産業分野に属する製品であっても、同様に本発明を適用することができる。
【0132】
要するに、例示という形態で本発明を開示してきたのであり、本明細書の記載内容を限定的に解釈するべきではない。本発明の要旨を判断するためには、冒頭に記載した特許請求の範囲の欄を参酌すべきである。
【0133】
【発明の効果】
以上詳記したように、本発明によれば、位置センサ、加速度センサ、角速度センサ、トルク・センサなどのアクチュエータ駆動状況を検知するセンサを各関節アクチュエータ毎に内蔵するとともに、外界との接触や衝突を検知するセンサをアクチュエータ外部に配設した優れた脚式移動ロボット並びに脚式移動ロボットの関節軸として適用されるアクチュエータ装置を提供することができる。
【0134】
また、本発明によれば、各関節アクチュエータの駆動制御用の信号、アクチュエータ内蔵センサの出力信号、並びにアクチュエータ外に配設されたセンサの出力信号を好適に上位制御系と交信することができる、優れた脚式移動ロボット並びに脚式移動ロボットの関節軸として適用されるアクチュエータ装置を提供することができる。
【図面の簡単な説明】
【図1】本発明の実施に供される脚式移動ロボットが直立している様子を前方から眺望した様子を示した図である。
【図2】本発明の実施に供される脚式移動ロボットが直立している様子を後方から眺望した様子を示した図である。
【図3】脚式移動ロボット100が具備する関節自由度構成を模式的に示した図である。
【図4】脚式移動ロボット100の機体上の各アクチュエータの重心付近に加速度、角加速度、角速度センサを搭載している様子を示した図である。
【図5】脚式移動ロボット100の全身の各部位に、ユーザの体の一部や異物の挟み込み又は巻き込み(pinch)を検出する接触センサを配置した様子を模式的に示した図である。
【図6】脚式移動ロボット100の全身の各部位に配置された接触センサからのセンサ情報を上位コントローラへ伝達するためのセンサ信号を含んだ機体の配線構造の一例を示した図である。
【図7】脚式移動ロボット100の全身の各部位に配置された接触センサからのセンサ情報を上位コントローラへ伝達するためのセンサ信号を含んだ機体の配線構造の他の例を示した図である。
【図8】脚式移動ロボット100の全身の各部位に配置された接触センサからのセンサ情報を上位コントローラへ伝達するためのセンサ信号を含んだ機体の配線構造についてのさらに他の例を示した図である。
【図9】脚式移動ロボット100の全身に配置されたセンサを、最寄りのアクチュエータ装置、ハブ、及びバスを経由して上位制御系へ伝達する配線構造を模式的に示した図である。
【図10】本発明の実施形態に係るアクチュエータ・ユニットの構成例を示した図である。
【図11】図10に示した関節アクチュエータの機能構成を模式的に示した図である。
【図12】接触センサからの接触情報を用いた脚式移動ロボット100の機体動作の処理手順を示したフローチャートである。
【符号の説明】
10…アクチュエータ装置
11…バス・インターフェース部
12…演算処理部
13…モータ制御部
14…センサ信号処理部
15…モータ・コイル
16…位置センサ
17…センサ入力インターフェース
Claims (10)
- 少なくとも複数本の可動脚を備え、各関節自由度がアクチュエータ装置によって実現される脚式移動ロボットであって、
機体動作を統括的に制御する上位制御系と、
アクチュエータ駆動状況を検知するための位置センサ、加速度センサ、角速度センサ、トルク・センサのうち少なくとも1つのセンサを関節アクチュエータ装置毎に内蔵するとともに、外界との接触や衝突を検知する接触センサをアクチュエータ装置の外部の1以上の部位に配設し、
前記アクチュエータ装置は、当該装置外部に配設された1以上のセンサからのセンサ信号を取り込むための入力インターフェースと、前記の内蔵センサ及び外部の接触センサから取り込んだセンサ信号のノイズ除去又はその他の信号処理を行なう信号処理部と、上位制御系からのコマンドに従ったアクチュエータ・モータの駆動制御やセンサ情報の処理又はその他の演算処理を行なう演算処理部を備え、
前記接触センサの少なくとも一部は、他の部位とともに異物を挟む関係にある部位に配設されており、
前記演算制御部は、いずれかの部位における接触センサが接触情報を検知したときに、接触情報を検知した接触センサが配設された部位に隣接するアクチュエータの発生トルクを検査するとともに、他の個所に配設された接触センサの接触情報も同時に検査し、該検査結果に基づいて異物を関節とリンクで挟んだと判断したときには前記上位制御系に対して異物挟み込み発生を通知する、
ことを特徴とする脚式移動ロボット。 - 機体上のいずれかの場所の接触センサからの出力を配線経路が最短となる最寄りのアクチュエータ装置に入力し、
前記の各アクチュエータ装置内では、外部センサの出力を信号ノイズの除去の処理や、センサ情報の演算又はその他の処理を施す、
ことを特徴とする請求項1に記載の脚式移動ロボット。 - 機体上には、前記上位制御系及び各アクチュエータ装置間を接続するバスが構成され、
前記の各アクチュエータ装置は、前記上位制御系とのアクチュエータ駆動制御信号の授受や、前記のアクチュエータ内蔵センサ及び前記アクチュエータ装置外に配置されたセンサからのセンサ情報の伝達を前記バスを介して行なう、
ことを特徴とする請求項1に記載の脚式移動ロボット。 - 可動ユニット毎に伝送信号線を集結するハブ装置を配設する、
ことを特徴とする請求項1に記載の脚式移動ロボット。 - 前記演算処理部は、接触情報を検知した接触センサが配設された部位に隣接するアクチュエータの発生トルクが通常時よりも大きくなるとともに、当該接触センサが配設された部位とは異物を挟む関係にある部位に配設された接触センサが所定時間以内にオンとなったときには、干渉が発生したと判断する、
ことを特徴とする請求項1に記載の脚式移動ロボット。 - 前記演算制御部は、接触情報を検知した接触センサが配設された部位に隣接するアクチュエータの発生トルクが通常時よりも大きくなったが、当該接触センサが配設された部位とは異物を挟む関係にある部位に配設された接触センサが所定時間以内にオンとならなかったとき、あるいは接触情報を検知した接触センサが配設された部位に隣接するアクチュエータの発生トルクが通常時よりも大きくなることはないが、当該接触センサが配設された部位とは異物を挟む関係にある部位に配設された接触センサが所定時間以内にオンとなったときには、当該アクチュエータのサーボ制御器の比例ゲインを減じて該当部位における機械受動性(コンプライアンス)を上げる、
ことを特徴とする請求項1に記載の脚式移動ロボット。 - 脚式移動ロボットの関節軸として適用されるアクチュエータ装置であって、
アクチュエータ・モータと、
アクチュエータ駆動状況を検知するための装置内蔵センサと、
当該装置外部に配設された1以上の接触センサを含む1以上の外部センサからのセンサ信号を取り込むための入力インターフェースと、
前記装置内蔵センサ及び外部センサから取り込んだセンサ信号のノイズ除去又はその他の信号処理部と、
上位制御系とのアクチュエータ駆動制御信号の授受や、前記装置内蔵センサ及び前記外部センサからのセンサ情報の伝達を前記バスを介して行なうバス・インターフェースと、
上位制御系からのコマンドに従った前記アクチュエータ・モータの駆動制御やセンサ情報の処理又はその他の演算処理を行なう演算処理部を備え、
前記接触センサの少なくとも一部は、他の部位とともに異物を挟む関係にある部位に配設されており、
前記演算制御部は、いずれかの部位における接触センサが接触情報を検知したときに、接触情報を検知した接触センサが配設された部位に隣接するアクチュエータの発生トルクを検査するとともに、他の個所に配設された接触センサの接触情報も同時に検査し、該検査結果に基づいて異物を関節とリンクで挟んだと判断したときには前記上位制御系に対して異物挟み込み発生を通知する、
ことを特徴とする脚式移動ロボットの関節軸として適用されるアクチュエータ装置。 - 前記装置内蔵センサは、位置センサ、加速度センサ、角速度センサ、トルク・センサ、温度センサのうち少なくとも1つを含む、
ことを特徴とする請求項7に記載の脚式移動ロボットの関節軸として適用されるアクチュエータ装置。 - 前記外部センサは、外界との接触や衝突を検知するための接触センサ又は感圧センサである、
ことを特徴とする請求項7に記載の脚式移動ロボットの関節軸として適用されるアクチュエータ装置。 - 配線経路が最短となるような最寄りの外部センサから前記入力インターフェースを介してセンサ信号を取り込む、
ことを特徴とする請求項7に記載の脚式移動ロボットの関節軸として適用されるアクチュエータ装置。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2002358859A JP4127043B2 (ja) | 2002-12-11 | 2002-12-11 | 脚式移動ロボット並びに脚式移動ロボットの関節軸として適用されるアクチュエータ装置 |
US10/731,155 US7061200B2 (en) | 2002-12-11 | 2003-12-10 | Legged mobile robot and actuator device applicable to join shaft of the robot |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2002358859A JP4127043B2 (ja) | 2002-12-11 | 2002-12-11 | 脚式移動ロボット並びに脚式移動ロボットの関節軸として適用されるアクチュエータ装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2004188535A JP2004188535A (ja) | 2004-07-08 |
JP4127043B2 true JP4127043B2 (ja) | 2008-07-30 |
Family
ID=32758419
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2002358859A Expired - Fee Related JP4127043B2 (ja) | 2002-12-11 | 2002-12-11 | 脚式移動ロボット並びに脚式移動ロボットの関節軸として適用されるアクチュエータ装置 |
Country Status (2)
Country | Link |
---|---|
US (1) | US7061200B2 (ja) |
JP (1) | JP4127043B2 (ja) |
Families Citing this family (40)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2004085121A1 (ja) * | 2003-03-27 | 2004-10-07 | Sony Corporation | ロボット装置及びロボット装置の制御方法 |
DE102004045805A1 (de) * | 2004-09-22 | 2006-04-13 | Ferenc Farkas | Vorrichtung und Verfahren zur Stabilisierung zweibeiniger Roboter |
JP2008009588A (ja) * | 2006-06-28 | 2008-01-17 | Ihi Corp | シミュレーション装置、方法およびプログラム |
CN101219284A (zh) * | 2007-01-08 | 2008-07-16 | 鸿富锦精密工业(深圳)有限公司 | 仿生类装置 |
JP4550849B2 (ja) * | 2007-03-22 | 2010-09-22 | 株式会社東芝 | アーム搭載移動ロボット |
JP4490997B2 (ja) * | 2007-07-18 | 2010-06-30 | 株式会社東芝 | 移動ロボット |
JP4392037B2 (ja) * | 2007-09-12 | 2009-12-24 | トヨタ自動車株式会社 | 脚式ロボット、及びその制御方法 |
JP4440956B2 (ja) * | 2007-09-12 | 2010-03-24 | トヨタ自動車株式会社 | 脚式ロボット、及びその制御方法 |
US8545335B2 (en) * | 2007-09-14 | 2013-10-01 | Tool, Inc. | Toy with memory and USB ports |
JP5103589B2 (ja) * | 2007-09-14 | 2012-12-19 | 株式会社国際電気通信基礎技術研究所 | コミュニケーションロボット |
CN101411946B (zh) * | 2007-10-19 | 2012-03-28 | 鸿富锦精密工业(深圳)有限公司 | 玩具恐龙 |
KR100958114B1 (ko) * | 2007-12-17 | 2010-05-18 | 한국과학기술연구원 | 인간형 로봇의 보행 안정화 및 자세 제어 방법 |
KR101457147B1 (ko) * | 2008-05-14 | 2014-11-03 | 삼성전자 주식회사 | 인간형 로봇과 그 어깨관절 어셈블리 |
KR101484943B1 (ko) * | 2008-05-30 | 2015-01-21 | 삼성전자 주식회사 | 보행로봇 |
US20100181943A1 (en) * | 2009-01-22 | 2010-07-22 | Phan Charlie D | Sensor-model synchronized action system |
KR20110026935A (ko) * | 2009-09-09 | 2011-03-16 | 삼성전자주식회사 | 로봇 관절 구동장치 및 이를 포함하는 로봇 |
US8369992B2 (en) * | 2009-09-22 | 2013-02-05 | GM Global Technology Operations LLC | Embedded diagnostic, prognostic, and health management system and method for a humanoid robot |
US8260460B2 (en) * | 2009-09-22 | 2012-09-04 | GM Global Technology Operations LLC | Interactive robot control system and method of use |
US8442684B2 (en) * | 2009-09-22 | 2013-05-14 | GM Global Technology Operations LLC | Integrated high-speed torque control system for a robotic joint |
KR101200191B1 (ko) * | 2010-07-14 | 2012-11-13 | 서울대학교산학협력단 | 데이터 기반 바이페드 제어 장치 및 방법 |
KR20120024098A (ko) * | 2010-09-06 | 2012-03-14 | 삼성전자주식회사 | 보행 로봇 및 그 제어방법 |
US9183346B2 (en) | 2012-03-12 | 2015-11-10 | Empire Technology Development Llc | Robotic appendages |
US20130280985A1 (en) * | 2012-04-24 | 2013-10-24 | Peter Klein | Bedtime toy |
CN103029130B (zh) * | 2012-12-05 | 2015-06-10 | 长春工业大学 | 仿人机器人 |
JP6314428B2 (ja) * | 2013-11-01 | 2018-04-25 | セイコーエプソン株式会社 | ロボット、制御装置及びロボットシステム |
CN104608125B (zh) | 2013-11-01 | 2019-12-17 | 精工爱普生株式会社 | 机器人、控制装置以及机器人*** |
US9308648B2 (en) * | 2014-07-24 | 2016-04-12 | Google Inc. | Systems and methods for robotic self-right |
US10201901B2 (en) * | 2015-01-29 | 2019-02-12 | Canon Kabushiki Kaisha | Robot apparatus, method for controlling robot, program, and recording medium |
US9975238B2 (en) * | 2015-06-09 | 2018-05-22 | Shanghai Xpartner Robotics Co., Ltd. | Screw-free assembled modular robot |
GB201512964D0 (en) * | 2015-07-22 | 2015-09-02 | Cambridge Medical Robotics Ltd | Communication paths for robot arms |
WO2017033353A1 (ja) * | 2015-08-25 | 2017-03-02 | 川崎重工業株式会社 | 遠隔操作ロボットシステム |
USD844485S1 (en) * | 2016-03-21 | 2019-04-02 | Kamal Siegel | Figurine leg and foot |
US10179619B1 (en) | 2016-03-30 | 2019-01-15 | Schaft Inc. | Robotic foot sensor |
CN105818136B (zh) * | 2016-05-20 | 2018-06-26 | 深圳市君航智远科技有限公司 | 一种基于四连杆机构的外骨骼机器人肩关节设计方法 |
US10286556B2 (en) * | 2016-10-16 | 2019-05-14 | The Boeing Company | Method and apparatus for compliant robotic end-effector |
CN106313101A (zh) * | 2016-10-16 | 2017-01-11 | 福州幻科机电科技有限公司 | 一种仿真智能机器人的肩关节总成 |
JP7329902B2 (ja) * | 2017-08-25 | 2023-08-21 | オムロン株式会社 | ロボット制御装置、ロボットシステム、ロボット制御方法、および、ロボット制御プログラム |
JP7141232B2 (ja) * | 2018-04-06 | 2022-09-22 | 川崎重工業株式会社 | ロボットの制御装置 |
JP7081294B2 (ja) | 2018-05-11 | 2022-06-07 | トヨタ自動車株式会社 | 電子ユニット |
JP7388828B2 (ja) * | 2019-05-27 | 2023-11-29 | ファナック株式会社 | ロボット |
Family Cites Families (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS61270095A (ja) * | 1985-05-27 | 1986-11-29 | 三菱電機株式会社 | マニピユレ−タの衝突検知装置 |
JP3118775B2 (ja) * | 1992-02-26 | 2000-12-18 | 本田技研工業株式会社 | リンク機構を備えたロボット |
US5445235A (en) * | 1992-05-26 | 1995-08-29 | Honda Giken Kogyo Kabushiki Kaisha | Legged mobile robot equipped with impact absorber |
JP3626303B2 (ja) * | 1996-12-18 | 2005-03-09 | 本田技研工業株式会社 | 脚式移動ロボットの足底接地位置検出装置 |
JP3667914B2 (ja) * | 1997-01-31 | 2005-07-06 | 本田技研工業株式会社 | 脚式移動ロボットの遠隔制御システム |
JP3578375B2 (ja) * | 1997-03-17 | 2004-10-20 | 技術研究組合医療福祉機器研究所 | ロボットアーム駆動装置およびロボットハンド |
JP3621808B2 (ja) * | 1997-06-20 | 2005-02-16 | 本田技研工業株式会社 | 脚式移動ロボットの足平接地状態把握装置 |
JP2000158378A (ja) * | 1998-11-26 | 2000-06-13 | Seiko Epson Corp | ロボットおよびロボットの制御装置 |
JP2000158367A (ja) * | 1998-11-30 | 2000-06-13 | Sony Corp | ロボット装置及びその制御方法 |
JP3332226B2 (ja) * | 1999-02-10 | 2002-10-07 | ソニー株式会社 | アクチュエータ装置 |
US6616464B1 (en) * | 1999-05-10 | 2003-09-09 | Sony Corporation | Robot device |
JP2001038663A (ja) * | 1999-07-28 | 2001-02-13 | Yamaha Motor Co Ltd | マシンの制御システム |
JP2001239479A (ja) * | 1999-12-24 | 2001-09-04 | Sony Corp | 脚式移動ロボット及びロボットのための外装モジュール |
JP4480843B2 (ja) * | 2000-04-03 | 2010-06-16 | ソニー株式会社 | 脚式移動ロボット及びその制御方法、並びに、脚式移動ロボット用相対移動測定センサ |
JP4281210B2 (ja) * | 2000-04-10 | 2009-06-17 | ソニー株式会社 | アクチュエータ駆動制御方式、並びにアクチュエータのための駆動制御装置 |
JP2001341092A (ja) * | 2000-06-02 | 2001-12-11 | Sharp Corp | 多関節ロボットおよび多関節ロボットの位置教示方法 |
JP2002307350A (ja) * | 2001-04-18 | 2002-10-23 | Sony Corp | ロボット装置、ロボット装置の動作制御方法、ロボット装置の制御システム、プログラム及び記録媒体 |
-
2002
- 2002-12-11 JP JP2002358859A patent/JP4127043B2/ja not_active Expired - Fee Related
-
2003
- 2003-12-10 US US10/731,155 patent/US7061200B2/en not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
US7061200B2 (en) | 2006-06-13 |
US20040164697A1 (en) | 2004-08-26 |
JP2004188535A (ja) | 2004-07-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP4127043B2 (ja) | 脚式移動ロボット並びに脚式移動ロボットの関節軸として適用されるアクチュエータ装置 | |
JP4305323B2 (ja) | ロボット装置の動作制御装置及び動作制御方法 | |
US6583595B1 (en) | Robot and joint device for the same | |
JP4595727B2 (ja) | 外力推定システム及び外力推定方法、並びにコンピュータ・プログラム | |
JP3824608B2 (ja) | 脚式移動ロボット及びその動作制御方法 | |
US6438454B1 (en) | Robot failure diagnosing system | |
US6463356B1 (en) | Legged mobile robot and method of controlling operation of the same | |
JP5586163B2 (ja) | ロボット及びその制御方法 | |
JP2001277163A (ja) | ロボットの制御装置及び制御方法 | |
JP2010005782A (ja) | 歩行ロボット及びその制御方法 | |
WO2007139135A1 (ja) | ロボット及び制御装置 | |
JP2001138271A (ja) | 脚式移動ロボット及び脚式移動ロボットの転倒時動作制御方法 | |
JP2002307340A (ja) | 脚式移動ロボット及びその制御方法 | |
JP4232376B2 (ja) | 脚式移動ロボット | |
JP4289446B2 (ja) | 脚式移動ロボット | |
JP4660870B2 (ja) | 脚式移動ロボット及びその制御方法 | |
JP4600551B2 (ja) | 移動ロボット | |
JP2002210681A (ja) | 脚式移動ロボットのための動作制御装置及び動作制御方法、並びにロボット装置 | |
JP4110525B2 (ja) | ロボット装置及びその動作制御方法 | |
JP4352774B2 (ja) | 脚式歩行ロボットの運動制御装置及び運動制御方法 | |
JP2004181613A (ja) | ロボット装置、脚式移動ロボットの動作制御装置及び動作制御方法、脚式移動ロボットのためのセンサ・システム、並びに移動体装置 | |
JP3813102B2 (ja) | 脚式ロボットの姿勢制御装置及び姿勢制御方法 | |
JP4981074B2 (ja) | 脚式移動ロボット | |
JP2001150375A (ja) | 脚式移動ロボットの制御システム | |
JP2002301684A (ja) | 脚式移動ロボット並びに脚式移動ロボットのための情報伝達装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20040416 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20070130 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20070329 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20070814 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20071011 |
|
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: 20080422 |
|
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: 20080505 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110523 Year of fee payment: 3 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110523 Year of fee payment: 3 |
|
LAPS | Cancellation because of no payment of annual fees |