JP2008254134A - 移動装置、ならびにその制御方法および制御プログラム - Google Patents

移動装置、ならびにその制御方法および制御プログラム Download PDF

Info

Publication number
JP2008254134A
JP2008254134A JP2007099999A JP2007099999A JP2008254134A JP 2008254134 A JP2008254134 A JP 2008254134A JP 2007099999 A JP2007099999 A JP 2007099999A JP 2007099999 A JP2007099999 A JP 2007099999A JP 2008254134 A JP2008254134 A JP 2008254134A
Authority
JP
Japan
Prior art keywords
space
processing unit
space element
path
robot
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
Application number
JP2007099999A
Other languages
English (en)
Other versions
JP4975503B2 (ja
Inventor
Makoto Nakamura
眞 中村
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Honda Motor Co Ltd
Original Assignee
Honda Motor Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Honda Motor Co Ltd filed Critical Honda Motor Co Ltd
Priority to JP2007099999A priority Critical patent/JP4975503B2/ja
Priority to US12/062,026 priority patent/US8204679B2/en
Publication of JP2008254134A publication Critical patent/JP2008254134A/ja
Application granted granted Critical
Publication of JP4975503B2 publication Critical patent/JP4975503B2/ja
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62D—MOTOR VEHICLES; TRAILERS
    • B62D57/00—Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track
    • B62D57/02—Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track with ground-engaging propulsion means, e.g. walking members
    • B62D57/032—Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track with ground-engaging propulsion means, e.g. walking members with alternately or sequentially lifted supporting base and legs; with alternately or sequentially lifted feet or skid
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1674—Programme controls characterised by safety, monitoring, diagnostic
    • B25J9/1676—Avoiding collision or forbidden zones
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0214—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0246—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Remote Sensing (AREA)
  • General Physics & Mathematics (AREA)
  • Mechanical Engineering (AREA)
  • Automation & Control Theory (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Combustion & Propulsion (AREA)
  • Transportation (AREA)
  • Chemical & Material Sciences (AREA)
  • Robotics (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Multimedia (AREA)
  • Electromagnetism (AREA)
  • Manipulator (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

【課題】人間等の物体に挙動変化をより明確に認識させることにより、当該物体との接触を回避して移動しうる移動装置等を提供する。
【解決手段】ロボット１およびその挙動状態と物体ｘおよびその挙動状態とのそれぞれが、要素空間ＱＳにおける基準空間要素Ｑ0およびその挙動状態と第１空間要素Ｑ1およびその挙動状態とのそれぞれとして認識される。当該認識結果に基づき、要素空間ＱＳにおいて基準空間要素Ｑ0が第１空間要素Ｑ1に接触する可能性があると認識された場合、基準空間要素Ｑ0と第１空間要素Ｑ1との距離ｄに応じた角度θだけ前回の目標経路Ｒkに対して傾斜しているずらし経路ｒk+1が設定される。また、ずらし経路ｒk+1の終点ｒ0を始点とし、基準空間要素Ｑ0と第１空間要素Ｑ1との接触を回避しうる経路が今回の目標経路Ｒk+1として設定される。
【選択図】 図９

Description

本発明は、行動計画にしたがって自律的に移動する装置、当該移動装置を制御する方法、当該移動装置に搭載されているコンピュータにその制御機能を付与するプログラム、および当該移動装置を監督するシステムに関する。
ロボットがその高機能化にともなって荷物を運搬したり、あるいは人間を目的地まで誘導したりする等の業務または作業を遂行する機会が増えており、ロボットが人間との接触を回避しながら移動する必要性が高まっている。そこで、ロボットから視覚または聴覚を通じて認識することができるような合図を発して当該ロボットの移動方向を周囲の人間に知らせる技術手法が提案されている（たとえば、特許文献１参照）。また、ロボットが障害物との接触を回避するために経路選択フィルタの範囲にある経路を探索し、当該範囲に経路が存在しない場合には当該経路選択フィルタの範囲を段階的に拡大することにより新たな経路を探索する技術が提案されている（たとえば、特許文献２参照）。
特開２００６−０３５３８１号公報 特開２００６−２３６０９８号公報
しかし、ロボットが発する合図の意味するところがその周囲の人間に認識されていなければ、ロボットの人間による予測挙動と実際の挙動とが相違し、当該人間をかえって混乱させるおそれがある。また、ロボットの移動方向の変化がわずかである場合、ロボットが移動方向を変化させることをその周囲の人間に予測させづらい。そして、人間が誤った予測や推測に基づいて自らの位置をずらす等した結果、ロボットに接触する可能性がかえって高くなるような場合がある。このような場合、ロボットおよびその周囲にいる人間が協調しながら移動することが困難となる。
そこで、本発明は、人間等の物体に挙動変化をより明確に認識させることにより、当該物体との接触を回避して移動しうる移動装置等を提供することを解決課題とする。
前記課題を解決するための第１発明の移動装置は、制御システムにより動作が制御されることによって目標経路にしたがって自律的に移動する移動装置であって、前記制御システムが、前記移動装置およびその挙動状態と物体およびその挙動状態とのそれぞれを、要素空間における基準空間要素およびその挙動状態と第１空間要素およびその挙動状態とのそれぞれとして認識する第１処理部と、該第１処理部による認識結果に基づき、該要素空間において該基準空間要素が該第１空間要素に接触する可能性の有無を認識する第２処理部と、該第１処理部による認識結果に基づき、該要素空間において該基準空間要素が該第１空間要素との接触を回避しうる経路を前記目標経路として設定し、該第２処理部により該接触可能性があると認識されたことを要件として、該基準空間要素と該第１空間要素との距離に応じた角度だけ前回の該目標経路に対して傾斜しているずらし経路を設定し、かつ、該ずらし経路の終点を始点として今回の該目標経路を設定する第３処理部とを備えていることを特徴とする。
第１発明の移動装置によれば、要素空間において基準空間要素が第１空間要素との接触を回避しうる経路が実空間において移動装置がしたがう目標経路として設定される。要素空間における「空間要素」とは当該要素空間における位置、速度および加速度等の状態が定義されうる「点」、当該要素空間における位置等に加えてさらに形状および長さ等の状態が定義されうる「線分」、ならびに、当該要素空間における位置等に加えてさらに形状および面積等の状態が定義されうる「領域」等を意味する。空間要素の「挙動状態」は、当該空間要素の位置の時間変化態様を意味し、より具体的には当該空間要素の現在位置、速度、加速度等を意味する。
基準空間要素が第１空間要素に接触する可能性があると認識された場合、すなわち、移動装置が前回の目標経路にしたがって移動することにより物体と接触する可能性がある場合、ずらし経路が設定される。また、ずらし経路の終点を始点として今回の目標経路が設定される。さらに、移動装置が前回の目標経路から外れたずらし経路にしたがって移動した後、今回の目標経路にしたがって移動するようにその動作が制御される。移動装置を前回の目標経路から外れたずらし経路にしたがって移動させることにより、移動装置の挙動を人間等の当該物体に認識させることができ、さらには両者の接触を回避する観点から不適当な物体の挙動を誘発する事態が回避されうる。
また、ずらし経路は基準空間要素と第１空間要素との距離に応じて設定されている角度だけ前回の目標経路に対して傾斜している。したがって、移動装置と物体との距離の長短に鑑みて、人間等の当該物体に移動装置の挙動を明確に認識または予測させる観点から適当に移動装置の移動方向を変化させることができる。そして、物体に当該認識または予測に基づき、違和感等を抱かせることなく移動装置との接触を回避する観点から適当な挙動を促すことができる。
なお、本発明の構成要素が情報を「認識する」とは、当該構成要素が情報をデータベースから検索すること、メモリ等の記憶装置から情報を読み取ること、センサ等の出力信号に基づき情報を測定、算定、推定すること、測定等された情報をメモリに格納すること等、当該情報をさらなる情報処理のために準備または用意するために必要なあらゆる情報処理を実行することを意味する。また、一の物体に他の物体が取り付けられている等、複数の物体が一体的に移動するような場合、当該物体がまとめられて第１空間要素として認識されうる。
また、第２発明の移動装置は、第１発明の移動装置において、前記第２処理部が前記第１処理部による認識結果に基づき、前記第１空間要素がその挙動状態に応じて断続的または連続的に拡張された結果の空間要素としての第２空間要素を認識し、前記第３処理部が、前記基準空間要素が該第２空間要素との接触を回避しうる経路を前記目標経路として設定することを特徴とする。
第２発明の移動装置によれば、要素空間において基準空間要素に対する第１空間要素の挙動状態に基づいて当該第１空間要素が拡張された結果としての空間要素が第２空間要素として認識される。このため、第２空間要素は第１空間要素よりもサイズまたは広がりが大きい空間要素として認識される。また、基準空間要素が第２空間要素との接触を回避しうる目標経路が設定される。したがって、基準空間要素が第１空間要素等の第２空間要素よりも狭い空間要素との接触を回避しうる目標経路が設定される場合よりも、移動装置が物体の挙動状態に鑑みて当該物体と接触することをより確実に回避する観点から適当な目標経路が設定される。
一方、前記のように基準空間要素が第１空間要素に接触する可能性があることが新たな目標経路の設定要件とされているが、第１空間要素は第２空間要素よりも小さい。このため、基準空間要素が第２空間要素等、第１空間要素よりもサイズが大きい空間要素に接触する可能性があることが新たな目標経路の設定要件とされている場合より、目標経路の変更頻度、ひいては移動装置の方向変換等の挙動変化の頻度が低く抑制される。そして、移動装置の挙動変化に応じて物体の挙動変化が誘発され、両者が接触する可能性がかえって高くなる可能性を低下させることができる。
さらに、第３発明の移動装置は、第２発明の移動装置において、前記ずらし経路が前記第２空間要素に重なっていることを要件として、前記第３処理部が該ずらし経路を設定しなおすことを特徴とする。
第３発明の移動装置によれば、第２空間要素に重ならないようにずらし経路が設定される。このため、移動装置および物体のそれぞれの挙動状態に鑑みて、両者の接触をさらに確実に回避する観点から適当な経路にしたがって移動装置を移動させることができる。
また、第４発明の移動装置は、第１〜第３発明のうちいずれか１つの移動装置において、前記第３処理部が前記第１処理部による認識結果に基づき、前記要素空間における前記基準空間要素と前記第１空間要素との距離が短いほど、前記目標経路に対する前記ずらし経路の傾斜角度を大きく設定することを特徴とする。
第４発明の移動装置によれば、移動装置と物体との接触可能性がある場合には両者の間隔が短いほど当該接触を回避する緊急性が高いことに鑑みて、前回の目標経路から適度に外れたずらし経路にしたがって移動装置を移動させることができる。これにより、人間等の物体に移動装置の挙動を明確かつ容易に認識または予測させ、さらには両者の接触を回避する観点から不適当な当該物体の挙動を誘発する事態が回避されうる。
さらに、第５発明の移動装置は、第１〜第４発明のうちいずれか１つの移動装置において、前記第１処理部が、前記移動装置が通行しうる領域の形状およびサイズのそれぞれを前記要素空間の形状およびサイズのそれぞれとして認識し、前記第３処理部が該要素空間からはみ出さないように前記目標経路および前記ずらし経路を設定することを特徴とする。
第５発明の移動装置によれば、移動装置をその通行可能領域からはみ出さないように移動させることができる。
また、第６発明の移動装置は、第１〜第５発明のうちいずれか１つの移動装置において、前記第３処理部が前記要素空間における前記基準空間要素に対する前記第１空間要素の相対速度が大きいほど前記ずらし経路を長くすることを特徴とする。
第６発明の移動装置によれば、移動装置に対する物体の相対速度が大きい場合、両者の接触を回避する緊急性が高いことに鑑みて、移動装置を前回の目標経路から遠くに離すことができる。これにより、人間等の当該物体に移動装置の挙動を明確かつ容易に認識または予測させることができ、ひいては両者の接触がより確実に回避されうる。
さらに、第７発明の移動装置は、第１〜第６発明のうちいずれか１つの移動装置において、前記移動装置が単位動作を繰り返すことにより該床面に推進力を作用させることにより移動可能なロボットであり、前記第３処理部が、該ロボットが所定回数の該単位動作によって移動可能な範囲で前記ずらし経路を設定することを特徴とする。
第７発明の移動装置によれば、ロボットに過度の単位動作の繰り返しを強いることなく、ロボットを前回の目標経路から外れた経路にしたがって移動させることができる。
また、第８発明の移動装置は、第１〜第７発明のうちいずれか１つの移動装置において、前記第２処理部により前記基準空間要素と前記第１空間要素との接触可能性があると判定されたことを要件として、前記第３処理部が前記要素空間において該基準空間要素からみて異なる方向にある複数の点を設定し、当該複数の点のうち１つの点を終点として前記ずらし経路を設定することを特徴とする。
第８発明の移動装置によれば、要素空間において複数の点がずらし経路の終点候補として設定され、当該複数の点の中から１つの点が最終的にずらし経路の終点として選択される。このため、移動装置の挙動を人間等の物体に明確に認識させ、移動装置と当該物体との接触を確実に回避する観点から適当なずらし経路が設定されうる。
前記課題を解決するための第９発明の方法は、目標経路にしたがって自律的に移動する移動装置の動作を制御する方法であって、第１発明の移動装置において制御システムにより実行される第１、第２および第３処理を実行することを特徴とする。
第９発明の方法によれば、移動装置と物体との距離の長短に鑑みて、人間等の当該物体に移動装置の挙動を明確に認識または予測させる観点から適当に移動装置の移動方向を変化させることができる。そして、物体に当該認識または予測に基づき、違和感等を抱かせることなく移動装置との接触を回避する観点から適当な挙動を促すことができる。
前記課題を解決するための第１０発明のプログラムは、目標経路にしたがって自律的に移動する移動装置に搭載されているコンピュータを、該移動装置の動作を制御するシステムとして機能させるためのプログラムであって、前記コンピュータを第１発明の移動装置が備えている制御システムとして機能させることを特徴とする。
第１０発明のプログラムによれば、移動装置と物体との距離の長短に鑑みて、人間等の当該物体に移動装置の挙動を明確に認識または予測させる観点から適当に移動装置の挙動を制御するシステムとして、当該移動装置に搭載されているコンピュータを機能させることができる。
本発明の移動装置等の実施形態について図面を用いて説明する。
移動装置としてのロボット１は基体（胴体部）Ｐ０と、基体Ｐ０の上部に設けられた頭部Ｐ１と、基体Ｐ０の上部左右両側から延設された左右の腕部Ｐ２と、腕部Ｐ２の先端部に設けられた手部Ｐ４と、基体Ｐ０の下部から下方に延設された左右の脚部Ｐ３と、脚部Ｐ３の先端部に取り付けられている足部Ｐ５とを備えている。ロボット１は、再表０３／０９０９７８号公報や、再表０３／０９０９７９号公報に開示されているように、アクチュエータＭ（図２参照）から伝達される力によって、人間の肩関節、肘関節、手根関節、股関節、膝関節、足関節等の複数の関節に相当する複数の関節部分において腕部Ｐ２や脚部Ｐ３を屈伸運動させることができる。ロボット１は、左右の脚部Ｐ３（または足部Ｐ５）のそれぞれの離床および着床の繰り返しを伴う動きによって自律的に移動することができる。基体Ｐ０の鉛直方向に対する傾斜角度が調節されることによって、頭部１１の高さが調節されうる。頭部Ｐ１には、左右に並んでロボット１の前方に向けられた一対の頭カメラ（ＣＣＤカメラ）Ｃ１が搭載されている。基体Ｐ０には前側下部に腰カメラ（赤外線カメラ）Ｃ２が搭載されている。ロボット１には基体Ｐ０の加速度に応じた信号を出力するジャイロセンサ、各関節の関節角度に応じた信号を出力するロータリエンコーダ、脚部Ｐ３に作用する床反力に応じた信号を出力する６軸力センサ等、種々のセンサＳ（図２参照）が搭載されている。
ロボット１はその腕部Ｐ２および脚部Ｐ３等の動作を制御する制御システム１０を備えている。制御システム１０は、ハードウェアとしてのＥＣＵまたはコンピュータ（ＣＰＵ，ＲＯＭ，ＲＡＭ，Ｉ／Ｏ等により構成されている。）と、ソフトウェアとしての本発明の「制御プログラム」とにより構成されている。制御プログラムはコンピュータのメモリに予め格納されていてもよいが、ロボット１からサーバに要求信号が送信されたことに応じて当該サーバによって制御プログラムがネットワークや人工衛星を介して当該コンピュータに配信または放送された上でそのメモリに格納されてもよい。
図２に示されている制御システム１０は第１処理部１１と、第２処理部１２と、第３処理部１３とを備えている。
第１処理部１１は環境データベース１１２に無線方式でアクセスすることによって、ロボット１が通行することができる通行可能領域を要素空間ＱＳとして認識する。環境データベース１１２には、ロボットが通行可能な領域の形状、面積等を示すデータが管理されている。なお、環境データベース１１２が制御システム１０の一部としてロボット１に搭載されていてもよい。また、第１処理部１１はセンサＳ等の出力信号に基づき、ロボット１ならびにその位置および速度等の挙動状態を要素空間ＱＳにおける基準空間要素Ｑ0およびその挙動状態として認識する。さらに、第１処理部１１は頭カメラＣ１および腰カメラＣ２のうち一方または両方により撮像された、ロボット１の周辺画像に基づき、物体ｘおよびその位置および速度等の挙動状態を、要素空間ＱＳにおける第１空間要素Ｑ1およびその挙動状態として認識する。
第２処理部１２は第１処理部１１による認識結果に基づき、第１空間要素Ｑ1をその挙動状態に応じて拡張した結果としての空間要素を第２空間要素Ｑ2として認識する。また、第２処理部１２は第１処理部１１による認識結果に基づき、基準空間要素Ｑ0と第１空間要素Ｑ1との接触可能性の有無を認識する。
第３処理部１３は第１処理部１１および第２処理部１２のそれぞれによる認識結果に基づき、要素空間ＱＳにおいて基準空間要素Ｑ0が第２空間要素Ｑ2との接触を回避しうる経路を、実空間または通行可能領域においてロボット１がしたがう目標経路Ｒkとして設定する。また、第３処理部１３は第２処理部１２により基準空間要素Ｑ0と第１空間要素Ｑ1との接触可能性があると認識されたことを要件としてずらし経路ｒk+1を設定し、かつ、ずらし経路ｒk+1の終点を始点として今回の目標経路Ｒk+1を設定する。ずらし経路ｒk+1は基準空間要素Ｑ0と第１空間要素Ｑ1との距離ｄに応じた角度θだけ前回の目標経路Ｒkに対して傾斜している。
続いて、前記構成のロボットの機能について説明する。図４に示されているように左右を壁で挟まれた廊下（通行可能領域）で、ロボット１および物体（人間）ｘがお互いに向かい合いながら移動している状況を考える。この場合、ロボット１はたとえば図５に一点鎖線で示されている目標経路Ｒkにしたがって歩行または走行している。目標経路Ｒkは初期状態（ｋ＝０）では予め設定されており、その後、後述するように第３処理部１３によって逐次変更される。
まず第１処理部１１が「第１処理」を実行する（図３／Ｓ０１０）。具体的には、第１処理部１１は環境データベース１１２に無線方式でアクセスすることによって、ロボット１が通行することができる領域を要素空間ＱＳとして認識する（図３／Ｓ０１２）。これにより、たとえば図４に示されている廊下および固定構造物の形状に応じた、図５に示されているような形状および面積を有する要素空間ＱＳが認識される。
また、第１処理部１１はセンサＳ等の出力信号に基づき、ロボット１ならびにその位置および速度等の挙動状態を要素空間ＱＳにおける基準空間要素Ｑ0およびその挙動状態として認識する（図３／Ｓ０１４）。これにより、ロボット１ならびにその位置および速度のそれぞれが、たとえば図５に示されている要素空間ＱＳにおける基準空間要素（微小な円形領域）Ｑ0、基準位置（当該円形領域の中心）Ｏおよび基準速度ｖ0のそれぞれとして認識される。後述するように頭カメラＣ１や腰カメラＣ２を通じて得られた画像に基づき測定される物体ｘの位置は、ロボット１を基準とする物体ｘの相対位置に該当するので、ロボット１の位置測定は省略される。なお、物体ｘの測定位置が緯度および経度により表されている等、その測定位置が当該相対位置に該当しない場合、ロボット１の位置は当該相対位置の測定のために測定される。ロボット１の位置はそのＧＰＳ機能により得られる緯度および経度を表す信号や、ジャイロセンサから逐次出力されるロボット１の加速度を表す信号に基づいて測定される。ロボット１の速度はロボット１の時系列的な測定位置、ジャイロセンサからの出力信号、または脚部Ｐ３の各関節角度に応じたロータリエンコーダからの出力信号および逆動力学モデル等に基づいて測定されうる。
さらに、第１処理部１１は頭カメラＣ１および腰カメラＣ２のうち一方または両方により撮像された、ロボット１の周辺画像に基づき、物体ｘおよびその位置および速度等の挙動状態を、要素空間ＱＳにおける第１空間要素Ｑ1およびその挙動状態として認識する（図３／Ｓ０１６）。これにより、物体ｘならびにその位置および速度のそれぞれが、たとえば図５に示されているように要素空間ＱＳにおける第１空間要素（円形領域）Ｑ1、物体位置ｐおよび物体速度ｖとして認識される。物体ｘの位置は頭カメラＰ１等を通じて得られたロボット１の周辺画像の解析に基づいて測定されるが、当該測定位置はロボット１を基準とした物体ｘの相対位置に該当する。
要素空間ＱＳにおける基準空間要素Ｑ0の形状およびサイズはメモリ（ロボット１の形状およびサイズが格納されている。）から読み取られることで認識されうる。また、要素空間ＱＳにおける第１空間要素Ｑ1の形状およびサイズは、頭カメラＣ１等を通じて得られたロボット１の周辺画像に基づいて物体ｘの種類が認識された後、当該認識結果に基づくメモリまたはデータベース（物体の種類、形状およびサイズが関連付けられて格納または管理されている。）の照会によって認識されうる。さらに、物体ｘの位置は、この物体ｘが有する通信装置等から送信された緯度および経度を表す信号が受信された上で、当該信号に基づいて測定または認識されてもよい。また、物体ｘの速度はこの物体ｘの位置の時間変化として測定されうる。要素空間ＱＳは緯度および経度により任意の点が特定される平面または曲面として定義されていてもよいが、ＣＣＤカメラ２１を通じて得られる画像に基づいて認識されるロボット１の周辺における床面の傾斜角度や、段差や凹凸の有無等の形状に基づいて逐次定義されてもよい。
ロボット１がその腕部Ｐ２により箱を持っている場合や、基体Ｐ０にロボット１に機能を付加するためのオプションとなる機器が取り付けられている場合等、当該箱や機器等の物体がロボット１と一体的に移動している状況では、当該一体的に移動しているロボット１および当該物体の形状およびサイズがロボット１の形状およびサイズとして認識されてもよい。
ロボット１の外形特性（形状およびサイズ）に応じて拡張された、要素空間における物体ｘの外形特性に応じた領域が第１空間要素Ｑ1として認識される。ここではロボット１および物体ｘのそれぞれの外形特性に応じた、要素空間における外形特性を有する２つの領域のミンコフスキー和が第１領域Ｑ1として認識される。ロボット１および物体ｘのそれぞれが図６（ａ）に示されているように半径ｒ0の円形状のロボット領域ｑrobotおよび半径ｒ1の円形状の物体領域ｑobjectとして定義されている場合、図６（ｂ）に示されているように円形状領域として表現される当該２つの領域のミンコフスキー和ｑrobot＋ｑobjectが第１空間要素Ｑ1として認識される。ロボット領域ｑrobotの中心が物体領域ｑobjectの輪郭をなぞるようにロボット領域ｑrobotを物体領域ｑobjectの周囲で移動させた場合、ロボット領域ｑrobotのうち物体領域ｑobjectからはみ出した部分が描く環状の領域と、物体領域ｑobjectとの和がミンコフスキー和（＝半径ｒ0＋ｒ1の円形状領域）に該当する。ロボット領域ｑrobotの形状およびサイズはロボット１のサイズ（または形状およびサイズ）に応じてメモリに予め格納されており、当該メモリから読み出されることにより認識される。物体領域ｑobjectはＣＣＤカメラ２１を通じて得られた画像に基づいて認識される物体ｘのサイズ（または形状およびサイズ）に応じた広がりを有する領域として認識される。なお、物体領域ｑobjectがそのまま第１空間要素Ｑ1として認識されてもよく、ミンコフスキー和とは異なる方法によりロボット領域ｑrobotのサイズ等の外形特性に応じて拡張された物体領域ｑobjectが第１空間要素Ｑ1として認識されてもよい。
また、第２処理部１２が「第２処理」を実行する（図３／Ｓ０２０）。具体的には、第２処理部１２は、第１空間要素Ｑ1が、要素空間ＱＳにおける基準空間要素Ｑ0からの移動コストに関する「第１接触条件」を満足しているか否かを判定する（図３／Ｓ０２２）。
移動コストは要素空間ＱＳにおいて基準空間要素Ｑ0が第１空間要素Ｑ1に接触するまでの所要時間および移動距離のうち一方または両方の関数として第２処理部１２により評価される。図５に示されている基準空間要素Ｑ0と、第１空間要素Ｑ1との直線距離もしくは目標経路（一点鎖線）Ｒkに沿った距離ｄ、基準空間要素Ｑ0および第１空間要素Ｑ1のそれぞれが基準速度ｖ0および物体速度ｖを維持したまま移動し、基準空間要素Ｑ0および第１空間要素Ｑ1に接するまでの所要時間ｔ＝（ｄ／｜ｖ0−ｖ｜））、または当該距離ｄおよび所要時間ｔのうち一方もしくは両方の増加関数が移動コストとして評価される。たとえば「移動コストが規定範囲｛０，ε+（＞０）｝にあること」という第１接触条件が採用されている。
さらに、第２処理部１２は第１空間要素Ｑ1が第１接触条件を満足すると判定した場合（図２／Ｓ０２２‥ＹＥＳ）、当該第１空間要素Ｑ1が目標経路ＲKとの位置関係に関する「第２接触条件」を満たしているか否かを判定する（図２／Ｓ０２４）。
たとえば「目標経路ＲKとの交点または接点が存在すること」が第２接触条件として採用されている場合、図５に示されている状況では第１空間要素Ｑ1はロボット１の目標経路ＲKと交わっているので、第２接触条件を満たしていると判定される。なお「第１空間要素Ｑ1までの最短距離またはその目標経路ＲKの一部もしくは全部に沿った累積または積分が所定値以下であること」や「基準位置Ｏにおける目標経路ＲKの接線（基準空間要素Ｑ0の移動方向に延びている。）と第１空間要素Ｑ1との交点または接点が存在すること」等が第２接触条件として採用されてもよい。
第２処理部１２は第１空間要素Ｑ1が第１接触条件に加えて第２接触条件も満足していると判定した場合（図３／Ｓ０２４‥ＹＥＳ）、第１処理部１１による認識結果に基づき、第１空間要素Ｑ1をその挙動状態に応じて拡張した結果としての空間要素を第２空間要素Ｑ2として認識する（図３／Ｓ０２６）。たとえば図７（ａ）左側に示されている第１空間要素Ｑ1が基準速度ｖ0に対する物体速度ｖの相対速度（ベクトル）ｖ−ｖ0に応じた方向に連続的に引き伸ばされた結果として、図７（ａ）右側に示されているほぼまっすぐな帯状の第２空間要素Ｑ2が認識される。第１空間要素Ｑ1の引き伸ばし量は、第１空間要素の速度ｖ、物体位置（相対位置）ｐ（＝ｐ−Ｏ）、および相対速度ｖ−ｖ0に基づき、次式（１）にしたがって設定される。
（引き伸ばし量）＝｜ｐ｜・｜ｖ｜／｜ｖ−ｖ0｜‥（１）
また、図７（ｂ）左側に示されている第１空間要素Ｑ1が相対速度ｖ−ｖ0にしたがって旋回するように連続的に引き伸ばされた結果として、図７（ｂ）右側に示されている屈曲した帯状の第２空間要素Ｑ2が認識される。前述した図５に示されている状況において、図８（ｂ）に示されているような第２空間要素Ｑ2が認識される。なお、図７（ｃ）左側に示されている第１空間要素Ｑ1が相対速度ｖ−ｖ0に応じた方向に断続的に引き伸ばされた結果として、図７（ｃ）右側に示されている分離した空間要素からなる第２空間要素Ｑ2が認識されてもよい。
一方、第１接触条件または第２接触条件が満足されていないと判定された場合（図３／Ｓ０２２‥ＮＯ，Ｓ０２４‥ＮＯ）、後述するようにロボット１が移動を終了するか否かが判定される（図３／Ｓ０４０）。
さらに、第３処理部１３が第１処理部１１および第２処理部１２のそれぞれによる認識結果に基づき「第３処理」を実行する（図３／Ｓ０３０）。具体的には、第３処理部１３は要素空間ＱＳにおいて前回の目標経路Ｒkに対して傾斜している線分をずらし経路ｒk+1として設定する（図３／Ｓ０３２）。
たとえば、要素空間ＱＳにおいて、図８（ａ）に示されているように基準空間要素Ｑ0から６つの方向に伸びる線分（破線）のそれぞれの中間点ｐj1（ｊ＝１〜６）および終点ｐj2が設定される。基準空間要素Ｑ0から各線分の中間点ｐj1および終点ｐj2のそれぞれまでの距離は、たとえばロボット１が２〜５歩程度で到達しうる距離とされている。そして、図８（ｂ）に示されているように前回の目標経路Ｒkに対してθだけ傾斜した線分上にある点ｐ21およびｐ22のうち、基準空間要素Ｑ0から最も遠い点ｐ22がずらし経路ｒk+1の終点ｐ0として選択される。当該傾斜角度θは基準空間要素Ｑ0と第１空間要素Ｑ1との距離ｄの関数であり、図９（ａ）〜（ｃ）に示されているように当該距離ｄが長いほど大きく設定される。
ただし、図８（ｃ）に示されているように１次選択点ｐ22が第２空間要素Ｑ2に包含されている場合、今回の目標経路Ｒkに対する傾斜角度θがより大きい線分上にある点ｐ11およびｐ12のうち、基準空間要素Ｑ0から最も遠い点ｐ12がずらし経路ｒk+1の終点ｐ0として選択される。さらに、図８（ｄ）に示されているように２次選択点ｐ12が要素空間ＱＳからはみ出ている場合、同一線分上にある点ｐ11およびｐ12のうち、基準空間要素Ｑ0から２番目に遠い点ｐ11がずらし経路ｒk+1の終点ｐ0として選択される。そして、図８（ｂ）〜（ｄ）のそれぞれに示されているように基準位置Ｏおよび選択点ｐ0とを結ぶ線分がずらし経路ｒk+1として設定される。
また、第３処理部１３はずらし経路ｒk+1の終点ｐ0を始点とし、基準空間要素Ｑ0が第２空間要素Ｑ2（ひいては第１空間要素Ｑ1）との接触を回避しうる経路を今回の目標経路Ｒk+1として設定する（図３／Ｓ０３４）。これにより、たとえば図９（ａ）〜（ｃ）のそれぞれにおいて二点鎖線で示されているように、第２空間要素Ｑ2に接触しない経路が今回の目標経路Ｒk+1として設定される。
さらに、ロボット１がずらし経路ｒk+1および今回の目標経路Ｒk+1にしたがって移動するようにアクチュエータＭに供給される電流が調節されることにより、ロボット１の動作が制御される。これにより、図９（ａ）〜（ｃ）のそれぞれに示されているようにずらし経路ｒk+1および今回の目標経路Ｒk+1が設定された場合、ロボット１はその正面から見て図１０（ａ）〜（ｃ）のそれぞれに示されているように移動方向を変化させることにより、横方向の位置をずらす。
また、制御システム１０によってロボット１が移動を終了するか否かが判定される（図３／Ｓ０４０）。たとえば、要素空間ＱＳにおいて基準空間要素Ｑ0の基準位置Ｏおよび目的位置ｐdの距離｜Ｏ−ｐd｜が閾値δ以下になったか否かが判定される。そして、当該判定結果が否定的である場合（図３／Ｓ０４０‥ＮＯ）、前述の第１〜第３処理が繰り返して実行される。その一方、当該判定結果が肯定的である場合（図３／Ｓ０４０‥ＹＥＳ）には一連の処理が終了する。
前記機能を発揮するロボット１によれば、要素空間ＱＳにおいて基準空間要素Ｑ0が第２空間要素Ｑ2（ひいては第１空間要素Ｑ1）との接触を回避しうる経路が実空間においてロボット１がしたがう目標経路Ｒkとして設定される。基準空間要素Ｑ0が第１空間要素Ｑ1に接触する可能性があると認識された場合、すなわち、ロボット１が前回の目標経路Ｒkにしたがって移動することにより物体ｘと接触する可能性がある場合、ずらし経路ｒk+1が設定される（図３／Ｓ０３２，図８（ａ）〜（ｄ）参照）。また、ずらし経路ｒk+1の終点ｐ0を始点として今回の目標経路Ｒk+1が設定される（図３／Ｓ０３４，図９（ａ）〜（ｃ）参照）。さらに、ロボット１が前回の目標経路Ｒkから外れたずらし経路ｒk+1にしたがって移動した後、今回の目標経路Ｒk+1にしたがって移動するようにその動作が制御される（図１０（ａ）〜（ｃ）参照）。ロボット１を前回の目標経路Ｒkから外れたずらし経路ｒk+1にしたがって移動させることにより、ロボット１の挙動を人間等の当該物体ｘに認識させることができ、さらには両者の接触を回避する観点から不適当な物体ｘの挙動を誘発する事態が回避されうる。
さらに、ずらし経路ｒk+1は基準空間要素Ｑ0と第１空間要素Ｑ1との距離ｄに応じて設定されている角度θだけ前回の目標経路Ｒkに対して傾斜している（図９（ａ）〜（ｃ）参照）。したがって、ロボット１と物体ｘとの距離ｄの長短に鑑みて、人間等の物体ｘにロボット１の挙動を明確に認識または予測させる観点から適当にロボット１の移動方向を変化させることができる（図１０（ａ）〜（ｃ）参照）。詳細には、ロボット１と物体ｘとの接触可能性がある場合には両者の間隔が短いほど当該接触を回避する緊急性が高いことに鑑みて、前回の目標経路Ｒkから適度に外れたずらし経路ｒk+1にしたがってロボット１を移動させることができる。これにより、人間等の物体ｘにロボット１の挙動を明確かつ容易に認識または予測させ、さらには両者の接触を回避する観点から不適当な当該物体の挙動を誘発する事態が回避されうる。また、物体ｘに当該認識または予測に基づき、違和感等を抱かせることなくロボット１との接触を回避する観点から適当な挙動を促すことができる。
さらに、ずらし経路ｒk+1が第２空間要素Ｑ2に重ならないように設定される（図８（ｃ）参照）。このため、ロボット１および物体ｘのそれぞれの挙動状態に鑑みて、両者の接触をさらに確実に回避する観点から適当な経路にしたがってロボット１を移動させることができる。また、ずらし経路ｒk+1が要素空間ＱＳからはみ出ないように設定される（図８（ｄ）参照）。このため、ロボット１をその通行可能領域からはみ出さないように移動させることができる。
また、ロボット１は１歩だけ移動するという単位動作を繰り返すことにより床面に推進力を作用させることにより移動可能であるが、ロボット１が所定歩数で移動可能な範囲でずらし経路ｒk+1が設定される。これにより、ロボット１に過度の単位動作の繰り返しを強いることなく、ロボット１を前回の目標経路Ｒkから外れた経路ｒk+1にしたがって移動させることができる。
また、要素空間ＱＳにおいて基準空間要素Ｑ0に対する第１空間要素Ｑ1の挙動状態に基づいて当該第１空間要素Ｑ1が拡張された結果としての空間要素が第２空間要素Ｑ2として認識される（図７（ａ）〜（ｃ）参照）。第１空間要素Ｑ1の挙動状態は、時々刻々変化する位置、速度および加速度等のうち一部または全部により特定される。このため、第２空間要素Ｑ2は第１空間要素Ｑ1よりもサイズまたは広がりが大きい空間要素として認識される。
また、基準空間要素Ｑ0が第２空間要素Ｑ2との接触を回避しうる目標経路Ｒk+1が設定される（図９（ａ）〜（ｃ）参照）。したがって、基準空間要素Ｑ0が第１空間要素Ｑ1等の第２空間要素Ｑ2よりも狭い空間要素との接触を回避しうる目標経路が設定される場合よりも、ロボット１が物体ｘの挙動状態に鑑みて当該物体ｘと接触することをより確実に回避する観点から適当な目標経路ＲK+1が設定される。
また、要素空間ＱＳにおいて第１空間要素Ｑ1は第２空間要素Ｑ2よりもサイズまたは広がりが小さい空間要素として認識され、基準空間要素Ｑ0が第１空間要素Ｑ1に接触する可能性があることが新たな目標経路Ｒk+1の設定要件とされている（図３／Ｓ０２２，Ｓ０２４，Ｓ０３０参照）。このため、基準空間要素Ｑ0が第２空間要素Ｑ2等、第１空間要素Ｑ1よりもサイズが大きい空間要素に接触する可能性があることが新たな目標経路Ｒk+1の設定要件とされている場合より、目標経路Ｒkの変更頻度、ひいてはロボット１の方向変換等の挙動変化の頻度が低く抑制される。そして、ロボット１の挙動変化に応じて物体ｘの挙動変化が誘発され、両者が接触する可能性がかえって高くなる可能性を低下させることができる。
さらに、要素空間ＱＳにおける第１空間要素Ｑ1の形状およびサイズがデータベース等への照会により認識されうる。これにより、頭カメラＣ１等による物体ｘのサイズ（または形状およびサイズ）の測定精度の限界のために物体ｘがその実際のサイズに鑑みて要素空間における広がりが過大な第１空間要素Ｑ1として認識される事態が回避されうる。そして、目標経路Ｒkの変更頻度およびこれにともなうロボット１の移動方向等の変更頻度が低く抑制される。すなわち、頭カメラＣ１等を通じた物体ｘの外形特性認識精度の限界のためにロボット１の目標経路Ｒkが頻繁に変更される事態が回避される。なお、移動コストに関する規定範囲の下限値として０ではなく正値が採用された場合、移動コストが当該下限値未満である場合には第１接触条件が満たされず、目標経路Ｒkは変更されない（図３／Ｓ０２２参照）。これにより、物体ｘがロボット１の近くにあるため、ロボット１の挙動を変化させると物体ｘの挙動変化を誘発し、かえって両者の接触可能性が高くなる可能性がある状態で、ロボット１の移動方向が変更される事態が回避されうる。
また、ロボット１および物体ｘのそれぞれの外形特性に応じた２つの領域ｑ0およびｑのミンコフスキー和ｑrobot＋ｑobjectが第１空間要素Ｑ1として認識される（図６（ａ）（ｂ）参照）。これにより、ロボット１および物体ｘのそれぞれのサイズおよび形状が要素空間における第１空間要素Ｑ1のサイズおよび形状にまとめて反映されうる。このため、要素空間ＱＳにおける基準空間要素Ｑ0の点または微小領域としての簡易的な取り扱い、ひいては基準空間要素Ｑ0との接触可能性がある第１空間要素Ｑ1の有無の判定等の容易化が図られながらも、当該判定精度の向上または維持が図られうる。
なお、前記制御方法がロボット１のように左右一対の脚部Ｐ３の動作によって移動するロボットのほか、３つ以上の脚体の動作によって移動するロボットや、車輪式移動ロボット（自動車）等、移動機能を有するあらゆる装置に適用されてもよい。
また、第３処理部１２が要素空間ＱＳにおける基準空間要素Ｑ0に対する第１空間要素Ｑ1の相対速度が大きいほどずらし経路ｒk+1を長く設定してもよい。これにより、ロボット１に対する物体ｘの相対速度が大きい場合、両者の接触を回避する緊急性が高いことに鑑みて、ロボット１を前回の目標経路Ｒkから遠くに離すことができる。これにより、人間等の物体ｘにロボット１の挙動を明確かつ容易に認識または予測させることができ、ひいては両者の接触がより確実に回避されうる。
なお、前記実施形態では基準空間要素Ｑ0と第１空間要素Ｑ1との距離ｄが長いほど前回の目標経路Ｒkに対するずらし経路ｒk+1の傾斜角度θが大きく設定されたが（図９（ａ）〜（ｃ）参照）、他の実施形態として基準空間要素Ｑ0と第１空間要素Ｑ1との距離ｄが長いほど前回の目標経路Ｒkに対するずらし経路ｒk+1の傾斜角度θが小さく設定されてもよい。
本発明の移動装置の構成説明図 本発明の移動装置の制御システムの構成説明図 本発明の移動装置の機能説明図 本発明の移動装置の機能説明図 本発明の移動装置の機能説明図 本発明の移動装置の機能説明図 本発明の移動装置の機能説明図 本発明の移動装置の機能説明図 本発明の移動装置の機能説明図 本発明の移動装置の機能説明図
符号の説明
１‥ロボット（移動装置）、１０‥制御システム、１１‥第１処理部、１２‥第２処理部１３‥第３処理部、ｘ‥人間（物体）、Ｑ0‥基準空間要素、Ｑ1‥第１空間要素、Ｑ2‥第２空間要素、Ｒk‥前回目標経路、Ｒk+1‥今回目標経路、ｒk+1‥ずらし経路

Claims (10)

  1. 制御システムにより動作が制御されることによって目標経路にしたがって自律的に移動する移動装置であって、前記制御システムが、
    前記移動装置およびその挙動状態と物体およびその挙動状態とのそれぞれを、要素空間における基準空間要素およびその挙動状態と第１空間要素およびその挙動状態とのそれぞれとして認識する第１処理部と、
    該第１処理部による認識結果に基づき、該要素空間において該基準空間要素が該第１空間要素に接触する可能性の有無を認識する第２処理部と、
    該第１処理部による認識結果に基づき、該要素空間において該基準空間要素が該第１空間要素との接触を回避しうる経路を前記目標経路として設定し、該第２処理部により該接触可能性があると認識されたことを要件として、該基準空間要素と該第１空間要素との距離に応じた角度だけ前回の該目標経路に対して傾斜しているずらし経路を設定し、かつ、該ずらし経路の終点を始点として今回の該目標経路を設定する第３処理部とを備えていることを特徴とする移動装置。
  2. 請求項１記載の移動装置において、
    前記第２処理部が前記第１処理部による認識結果に基づき、前記第１空間要素がその挙動状態に応じて断続的または連続的に拡張された結果の空間要素としての第２空間要素を認識し、
    前記第３処理部が、前記基準空間要素が該第２空間要素との接触を回避しうる経路を前記目標経路として設定することを特徴とする移動装置。
  3. 請求項２記載の移動装置において、
    前記ずらし経路が前記第２空間要素に重なっていることを要件として、前記第３処理部が該ずらし経路を設定しなおすことを特徴とする移動装置。
  4. 請求項１〜３のうちいずれか１つに記載の移動装置において、
    前記第３処理部が前記第１処理部による認識結果に基づき、前記要素空間における前記基準空間要素と前記第１空間要素との距離が短いほど、前記目標経路に対する前記ずらし経路の傾斜角度を大きく設定することを特徴とする移動装置。
  5. 請求項１〜４のうちいずれか１つに記載の移動装置において、
    前記第１処理部が、前記移動装置が通行しうる領域の形状およびサイズのそれぞれを前記要素空間の形状およびサイズのそれぞれとして認識し、
    前記第３処理部が該要素空間からはみ出さないように前記目標経路および前記ずらし経路を設定することを特徴とする移動装置。
  6. 請求項１〜５のうちいずれか１つに記載の移動装置において、
    前記第３処理部が前記要素空間における前記基準空間要素に対する前記第１空間要素の相対速度が大きいほど前記ずらし経路を長くすることを特徴とする移動装置。
  7. 請求項１〜６のうちいずれか１つに記載の移動装置において、
    前記移動装置が単位動作を繰り返すことにより該床面に推進力を作用させることにより移動可能なロボットであり、
    前記第３処理部が、該ロボットが所定回数の該単位動作によって移動可能な範囲で前記ずらし経路を設定することを特徴とする移動装置。
  8. 請求項１〜７のうちいずれか１つに記載の移動装置において、
    前記第２処理部により前記基準空間要素と前記第１空間要素との接触可能性があると判定されたことを要件として、前記第３処理部が前記要素空間において該基準空間要素からみて異なる方向にある複数の点を設定し、当該複数の点のうち１つの点を終点として前記ずらし経路を設定することを特徴とする移動装置。
  9. 目標経路にしたがって自律的に移動する移動装置の動作を制御する方法であって、
    前記移動装置およびその挙動状態と物体およびその挙動状態とのそれぞれを、要素空間における基準空間要素およびその挙動状態と第１空間要素およびその挙動状態とのそれぞれとして認識する第１処理と、
    該第１処理における認識結果に基づき、該要素空間において該基準空間要素が該第１空間要素に接触する可能性の有無を認識する第２処理と、
    該第１処理における認識結果に基づき、該要素空間において該基準空間要素が該第１空間要素との接触を回避しうる経路を前記目標経路として設定し、該第２処理において該接触可能性があると認識されたことを要件として、該基準空間要素と該第１空間要素との距離に応じた角度だけ前回の該目標経路に対して傾斜しているずらし経路を設定し、かつ、該ずらし経路の終点を始点として今回の該目標経路を設定する第３処理とを実行することを特徴とする方法。
  10. 目標経路にしたがって自律的に移動する移動装置に搭載されているコンピュータを、該移動装置の動作を制御するシステムとして機能させるためのプログラムであって、前記コンピュータを、
    前記移動装置およびその挙動状態と物体およびその挙動状態とのそれぞれを、要素空間における基準空間要素およびその挙動状態と第１空間要素およびその挙動状態とのそれぞれとして認識する第１処理部と、
    該第１処理部による認識結果に基づき、該要素空間において該基準空間要素が該第１空間要素に接触する可能性の有無を認識する第２処理部と、
    該第１処理部による認識結果に基づき、該要素空間において該基準空間要素が該第１空間要素との接触を回避しうる経路を前記目標経路として設定し、該第２処理部により該接触可能性があると認識されたことを要件として、該基準空間要素と該第１空間要素との距離に応じた角度だけ前回の該目標経路に対して傾斜しているずらし経路を設定し、かつ、該ずらし経路の終点を始点として今回の該目標経路を設定する第３処理部とを備えている制御システムとして機能させることを特徴とするプログラム。
JP2007099999A 2007-04-06 2007-04-06 脚式移動ロボット Expired - Fee Related JP4975503B2 (ja)

Priority Applications (2)

Application Number Priority Date Filing Date Title
JP2007099999A JP4975503B2 (ja) 2007-04-06 2007-04-06 脚式移動ロボット
US12/062,026 US8204679B2 (en) 2007-04-06 2008-04-03 Mobile apparatus, control device and control program

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2007099999A JP4975503B2 (ja) 2007-04-06 2007-04-06 脚式移動ロボット

Publications (2)

Publication Number Publication Date
JP2008254134A true JP2008254134A (ja) 2008-10-23
JP4975503B2 JP4975503B2 (ja) 2012-07-11

Family

ID=39827673

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2007099999A Expired - Fee Related JP4975503B2 (ja) 2007-04-06 2007-04-06 脚式移動ロボット

Country Status (2)

Country Link
US (1) US8204679B2 (ja)
JP (1) JP4975503B2 (ja)

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2009134642A (ja) * 2007-11-30 2009-06-18 Honda Motor Co Ltd 移動装置および移動装置システム
JP2012130986A (ja) * 2010-12-21 2012-07-12 Toyota Motor Corp 移動体
WO2013011543A1 (ja) * 2011-07-15 2013-01-24 株式会社日立製作所 自律移動装置およびその制御方法
WO2013046563A1 (ja) * 2011-09-29 2013-04-04 パナソニック株式会社 自律移動装置、自律移動方法、及び、自律移動装置用のプログラム
JP2018116359A (ja) * 2017-01-16 2018-07-26 本田技研工業株式会社 自律移動型ロボット運行管理システム
JP2019219735A (ja) * 2018-06-15 2019-12-26 トヨタ自動車株式会社 自律移動体、および自律移動体の制御プログラム
JP2019219734A (ja) * 2018-06-15 2019-12-26 トヨタ自動車株式会社 自律移動体、および自律移動体の制御プログラム
WO2021029151A1 (ja) * 2019-08-14 2021-02-18 ソニー株式会社 ロボット制御装置、方法およびプログラム
JP2021064372A (ja) * 2019-10-16 2021-04-22 ネイバー コーポレーションＮＡＶＥＲ Ｃｏｒｐｏｒａｔｉｏｎ 認識された人間と連関する個人領域に基づいてロボットを制御する方法およびシステム

Families Citing this family (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP5080333B2 (ja) * 2007-04-06 2012-11-21 本田技研工業株式会社 自律移動体のための物体認識装置
US8934686B2 (en) * 2009-11-26 2015-01-13 Algotec Systems Ltd. User interface for selecting paths in an image
US8508590B2 (en) * 2010-03-02 2013-08-13 Crown Equipment Limited Method and apparatus for simulating a physical environment to facilitate vehicle operation and task completion
US8538577B2 (en) * 2010-03-05 2013-09-17 Crown Equipment Limited Method and apparatus for sensing object load engagement, transportation and disengagement by automated vehicles
US8657042B2 (en) 2010-10-04 2014-02-25 China Industries Limited Walking machine
KR102041093B1 (ko) 2011-04-11 2019-11-06 크라운 이큅먼트 코포레이션 조정된 경로 계획기를 사용하는 다수의 자동화 비-홀로노믹 차량들을 효율적으로 스케줄링하는 방법 및 장치
US8655588B2 (en) 2011-05-26 2014-02-18 Crown Equipment Limited Method and apparatus for providing accurate localization for an industrial vehicle
US8548671B2 (en) 2011-06-06 2013-10-01 Crown Equipment Limited Method and apparatus for automatically calibrating vehicle parameters
US8594923B2 (en) 2011-06-14 2013-11-26 Crown Equipment Limited Method and apparatus for sharing map data associated with automated industrial vehicles
US8589012B2 (en) 2011-06-14 2013-11-19 Crown Equipment Limited Method and apparatus for facilitating map data processing for industrial vehicle navigation
US20140058634A1 (en) 2012-08-24 2014-02-27 Crown Equipment Limited Method and apparatus for using unique landmarks to locate industrial vehicles at start-up
US9056754B2 (en) 2011-09-07 2015-06-16 Crown Equipment Limited Method and apparatus for using pre-positioned objects to localize an industrial vehicle
US9354070B2 (en) 2013-10-31 2016-05-31 Crown Equipment Corporation Systems, methods, and industrial vehicles for determining the visibility of features
KR20150053860A (ko) * 2013-11-08 2015-05-19 삼성전자주식회사 의료기기의 이동을 제어하는 방법 및 이를 위한 제어장치
JP6364836B2 (ja) * 2014-03-14 2018-08-01 セイコーエプソン株式会社 ロボット、ロボットシステム、及び制御装置

Citations (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS6234784A (ja) * 1985-08-01 1987-02-14 工業技術院長 移動体の移動制御方法
JPS6267610A (ja) * 1985-09-20 1987-03-27 Hitachi Ltd 移動機械制御装置
JPS62118282A (ja) * 1985-11-18 1987-05-29 Nippon Kokan Kk <Nkk> 船舶衝突危険度評価方法
JPS62274313A (ja) * 1986-05-22 1987-11-28 Toyota Central Res & Dev Lab Inc 無人者の障害物回避動作指令装置
JPS63276610A (ja) * 1987-05-08 1988-11-14 Toyota Autom Loom Works Ltd 走行コ−ス作成装置
JPH02188809A (ja) * 1989-01-17 1990-07-24 Mitsubishi Electric Corp 移動体の障害物回避制御装置
JPH05165523A (ja) * 1991-12-13 1993-07-02 Meidensha Corp 無人搬送車の制御装置
JPH0764634A (ja) * 1993-08-27 1995-03-10 Nissan Motor Co Ltd 無人移動探査機の経路決定方法
JPH07325620A (ja) * 1994-06-02 1995-12-12 Hitachi Ltd 知能ロボット装置及び知能ロボットシステム
JP2003241836A (ja) * 2002-02-19 2003-08-29 Keio Gijuku 自走移動体の制御方法および装置
JP2005339175A (ja) * 2004-05-26 2005-12-08 Alpine Electronics Inc 対象物認識装置、ナビゲーション装置及び対象物認識方法

Family Cites Families (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2761454B2 (ja) * 1993-12-09 1998-06-04 インターナショナル・ビジネス・マシーンズ・コーポレイション 自律移動機械の誘導方法
US6173215B1 (en) * 1997-12-19 2001-01-09 Caterpillar Inc. Method for determining a desired response to detection of an obstacle
US6721659B2 (en) * 2002-02-01 2004-04-13 Ford Global Technologies, Llc Collision warning and safety countermeasure system
JP4080932B2 (ja) * 2003-03-31 2008-04-23 本田技研工業株式会社 ２足歩行ロボットの制御装置
JP4647201B2 (ja) * 2003-12-05 2011-03-09 富士重工業株式会社 車両の走行制御装置
JP4315872B2 (ja) 2004-07-28 2009-08-19 本田技研工業株式会社 移動ロボットの制御装置
JP4316477B2 (ja) * 2004-11-18 2009-08-19 パナソニック株式会社 移動ロボットの追従方法
JP2006236098A (ja) 2005-02-25 2006-09-07 Mitsubishi Heavy Ind Ltd 移動体の障害物回避方法及び該移動体
JP4699426B2 (ja) * 2006-08-08 2011-06-08 パナソニック株式会社 障害物回避方法と障害物回避移動装置
JP4481291B2 (ja) * 2006-12-01 2010-06-16 本田技研工業株式会社 ロボット、ならびにその制御方法および制御プログラム
JP4171510B2 (ja) * 2006-12-20 2008-10-22 本田技研工業株式会社 移動装置、ならびにその制御システム、制御プログラムおよび監督システム
EP1978432B1 (en) * 2007-04-06 2012-03-21 Honda Motor Co., Ltd. Routing apparatus for autonomous mobile unit

Patent Citations (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS6234784A (ja) * 1985-08-01 1987-02-14 工業技術院長 移動体の移動制御方法
JPS6267610A (ja) * 1985-09-20 1987-03-27 Hitachi Ltd 移動機械制御装置
JPS62118282A (ja) * 1985-11-18 1987-05-29 Nippon Kokan Kk <Nkk> 船舶衝突危険度評価方法
JPS62274313A (ja) * 1986-05-22 1987-11-28 Toyota Central Res & Dev Lab Inc 無人者の障害物回避動作指令装置
JPS63276610A (ja) * 1987-05-08 1988-11-14 Toyota Autom Loom Works Ltd 走行コ−ス作成装置
JPH02188809A (ja) * 1989-01-17 1990-07-24 Mitsubishi Electric Corp 移動体の障害物回避制御装置
JPH05165523A (ja) * 1991-12-13 1993-07-02 Meidensha Corp 無人搬送車の制御装置
JPH0764634A (ja) * 1993-08-27 1995-03-10 Nissan Motor Co Ltd 無人移動探査機の経路決定方法
JPH07325620A (ja) * 1994-06-02 1995-12-12 Hitachi Ltd 知能ロボット装置及び知能ロボットシステム
JP2003241836A (ja) * 2002-02-19 2003-08-29 Keio Gijuku 自走移動体の制御方法および装置
JP2005339175A (ja) * 2004-05-26 2005-12-08 Alpine Electronics Inc 対象物認識装置、ナビゲーション装置及び対象物認識方法

Cited By (19)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP4577697B2 (ja) * 2007-11-30 2010-11-10 本田技研工業株式会社 移動装置および移動装置システム
JP2009134642A (ja) * 2007-11-30 2009-06-18 Honda Motor Co Ltd 移動装置および移動装置システム
JP2012130986A (ja) * 2010-12-21 2012-07-12 Toyota Motor Corp 移動体
JPWO2013011543A1 (ja) * 2011-07-15 2015-02-23 株式会社日立製作所 自律移動装置およびその制御方法
WO2013011543A1 (ja) * 2011-07-15 2013-01-24 株式会社日立製作所 自律移動装置およびその制御方法
US9116521B2 (en) 2011-07-15 2015-08-25 Hitachi, Ltd. Autonomous moving device and control method thereof
US9079307B2 (en) 2011-09-29 2015-07-14 Panasonic Intellectual Property Management Co., Ltd. Autonomous locomotion apparatus, autonomous locomotion method, and program for autonomous locomotion apparatus
JPWO2013046563A1 (ja) * 2011-09-29 2015-03-26 パナソニック株式会社 自律移動装置、自律移動方法、及び、自律移動装置用のプログラム
JP5539596B2 (ja) * 2011-09-29 2014-07-02 パナソニック株式会社 自律移動装置、自律移動方法、及び、自律移動装置用のプログラム
WO2013046563A1 (ja) * 2011-09-29 2013-04-04 パナソニック株式会社 自律移動装置、自律移動方法、及び、自律移動装置用のプログラム
JP2018116359A (ja) * 2017-01-16 2018-07-26 本田技研工業株式会社 自律移動型ロボット運行管理システム
JP2019219735A (ja) * 2018-06-15 2019-12-26 トヨタ自動車株式会社 自律移動体、および自律移動体の制御プログラム
JP2019219734A (ja) * 2018-06-15 2019-12-26 トヨタ自動車株式会社 自律移動体、および自律移動体の制御プログラム
US11345032B2 (en) 2018-06-15 2022-05-31 Toyota Jidosha Kabushiki Kaisha Autonomous moving body and control program for autonomous moving body
JP7095427B2 (ja) 2018-06-15 2022-07-05 トヨタ自動車株式会社 自律移動体、および自律移動体の制御プログラム
JP7176241B2 (ja) 2018-06-15 2022-11-22 トヨタ自動車株式会社 自律移動体、および自律移動体の制御プログラム
WO2021029151A1 (ja) * 2019-08-14 2021-02-18 ソニー株式会社 ロボット制御装置、方法およびプログラム
JP2021064372A (ja) * 2019-10-16 2021-04-22 ネイバー コーポレーションＮＡＶＥＲ Ｃｏｒｐｏｒａｔｉｏｎ 認識された人間と連関する個人領域に基づいてロボットを制御する方法およびシステム
JP7153049B2 (ja) 2019-10-16 2022-10-13 ネイバー コーポレーション 認識された人間と連関する個人領域に基づいてロボットを制御する方法およびシステム

Also Published As

Publication number Publication date
US8204679B2 (en) 2012-06-19
US20080249660A1 (en) 2008-10-09
JP4975503B2 (ja) 2012-07-11

Similar Documents

Publication Publication Date Title
JP4975503B2 (ja) 脚式移動ロボット
JP4328813B2 (ja) 移動装置、ならびにその制御方法および制御プログラム
JP4143103B2 (ja) 移動装置、ならびにその制御システム、制御プログラムおよび監督システム
CN110119140B (zh) 用于加速曲线投影的系统和方法
JP4328819B2 (ja) 移動装置およびその制御プログラム
JP4171510B2 (ja) 移動装置、ならびにその制御システム、制御プログラムおよび監督システム
KR101200209B1 (ko) 이동 장치
JP5142137B2 (ja) リモコン
US8688307B2 (en) Moving device and method for controlling same
JP7469850B2 (ja) 経路決定装置、ロボット及び経路決定方法
KR101598385B1 (ko) 직선 정보 기반 장소 인식을 이용한 로봇의 자율주행 방법 및 자율 주행 로봇
JP7130062B2 (ja) 経路決定方法
EP2186610A1 (en) Robot and task execution system
US20120078416A1 (en) Robot and behavior control system for the same
US8296005B2 (en) Mobile apparatus
JP7036399B2 (ja) 自律移動ロボット、並びに、その制御装置及び動作制御プログラム
JP4577697B2 (ja) 移動装置および移動装置システム
JP6026393B2 (ja) 移動装置
US20210118289A1 (en) Device, method, and storage medium
JP7221839B2 (ja) 自律移動ロボットおよび自律移動ロボットの制御プログラム
JP2008257532A (ja) 移動装置、ならびにその制御方法、制御プログラムおよび監督システム
US11693416B2 (en) Route determination method
CN113467459B (zh) 机器人路线规划方法、装置、设备与计算机可读存储介质
EP3964913A1 (en) Model parameter learning method and movement mode parameter determination method
JP2010134855A (ja) 移動台車

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20091126

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20110414

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20110419

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20110614

A02 Decision of refusal

Free format text: JAPANESE INTERMEDIATE CODE: A02

Effective date: 20110726

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20111026

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20111213

A911 Transfer to examiner for re-examination before appeal (zenchi)

Free format text: JAPANESE INTERMEDIATE CODE: A911

Effective date: 20111216

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20120214

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20120224

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: 20120321

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: 20120411

R150 Certificate of patent or registration of utility model

Ref document number: 4975503

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

Free format text: JAPANESE INTERMEDIATE CODE: R150

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20150420

Year of fee payment: 3

LAPS Cancellation because of no payment of annual fees