JP2021171905A - ロボット制御装置、方法、及びプログラム - Google Patents

Abstract

【課題】移動経路上に障害物がある場合でも作業効率を低下させないロボット制御装置等を提供すること。【解決手段】現在地から目的地までの移動経路を生成する移動経路生成部と、生成された前記移動経路に沿って前記移動ロボットを移動させる移動制御部と、所定距離内における前記移動経路上の障害物を検出する障害物検出部と、前記障害物を前記移動経路から除くための所定の対応を実行する障害物対応部と、を備え、前記障害物検出部は、前記障害物が人か否かを検出し、前記障害物対応部は、前記障害物が人か否かに応じて選択した一又は複数の前記所定の対応を実行する、ロボット制御装置が提供される。【選択図】図２

Description

本発明は、例えば、ロボットの制御装置等に関する。

近年、工場や倉庫のみならず、商業ビルや空港、介護施設等、様々な場所にロボットが適用されている。例えば特許文献１では、工場で人と共有する作業領域を自律走行する人協働型の移動ロボットが開示されている。

特許第６４１２１７９号公報

ところで、移動ロボットが計画した目的地までの移動経路を移動する際、障害物が移動経路に立ち塞がることがある。特許文献１の移動ロボットは、移動経路を立ち塞ぐ障害物と接触した場合には、接触時に加わる力を検知して、移動ロボットの移動を停止するように構成される。

このような移動ロボットの移動経路に障害物がある場合は、移動経路上の障害物に周囲の人間が気づき、これを取り除くまでは移動経路を確保することができないので、作業効率が低下するという課題がある。

本発明は、上述の技術的課題を解決するためになされたものであり、その目的とするところは、移動経路上に障害物がある場合でも作業効率を低下させないロボット制御装置等を提供することにある。

上述の技術的課題は、以下の構成を有するロボット制御装置等により解決することができる。

すなわち、本発明に係るロボット制御装置は、移動ロボットを制御するロボット制御装置であって、現在地から目的地までの移動経路を生成する移動経路生成部と、生成された前記移動経路に沿って前記移動ロボットを移動させる移動制御部と、所定距離内における前記移動経路上の障害物を検出する障害物検出部と、前記障害物を前記移動経路から除くための所定の対応を実行する障害物対応部と、を備え、前記障害物検出部は、前記障害物が人か否かを検出し、前記障害物対応部は、前記障害物が人か否かに応じて選択した一又は複数の前記所定の対応を実行する。

このような構成によれば、移動経路上に障害物が検出された場合に、当該障害物を移動経路から除くために実行する所定の対応を障害物が人か否かに応じて選択することができるので、障害物に応じてより適切な働きかけを選択し、移動経路から障害物を効率よく取り除くことができる。これにより、移動経路上に障害物が検出された場合でも、移動ロボットの作業効率の低下を抑制することができる。また、後述する所定の対応を複数組み合わせて実行することもできるので、よりきめ細かい、多様な対応を実現することが可能となり、障害物をより効率的に取り除くことができる。

前記移動ロボットは、正面を顔部とする頭部と、前記頭部を駆動する駆動手段と、をさらに備え、検出した前記障害物が人である場合は、前記障害物検出部は、前記人の頭の位置を検出し、前記障害物対応部は、前記所定の対応として、前記駆動手段を制御して前記顔部を前記人の頭に向ける、ものであってよい。

このような構成によれば、障害物が人である場合に当該人の頭に顔部を向けるので、当該人に対して移動経路から立ち退くことを積極的に促すことができる。

検出した前記障害物が人であって、かつ当該人が複数いる場合に前記移動ロボットに最も近い人を特定する特定部をさらに備え、前記障害物対応部は、前記所定の対応として前記顔部を前記人の頭に向ける場合は、前記顔部を前記特定部が特定した前記人の頭に向ける、ものであってよい。

このような構成によれば、障害物としての人が複数人検出された場合であっても、人の行動原理と同様の順番で特定された人に対して、順次、違和感なく退避を促すことができる。

前記移動ロボットは、正面を顔部とする頭部と、前記頭部を駆動する駆動手段と、をさらに備え、検出した前記障害物が人ではない場合は、前記障害物検出部は、前記移動ロボットの周辺にいる人の頭の位置を検出し、前記障害物対応部は、前記所定の対応として、前記駆動手段を制御して前記顔部を周辺にいる前記人の頭に向ける、ものであってよい。

このような構成によれば、障害物が物である場合に、周囲にいる人の頭に顔部を向けるので、障害物を移動経路から取り除くことを周囲にいる人に積極的に訴えることができる。

前記所定の対応として、所定の報知を行うための報知手段をさらに備える、ものであってよい。

このような構成によれば、報知手段を用いて、障害物を移動経路から取り除くことを周囲にいる人により明確に訴えることができる。

前記移動ロボットは前記報知手段としてのスピーカをさらに備え、前記障害物対応部は、前記所定の対応として、前記障害物が人か否かに応じて選択される所定の音を前記スピーカを用いて出力する、ものであってよい。

このような構成によれば、スピーカを用いて人の聴覚に訴えることができるので、障害物を移動経路から除くことをより強く、より明確に訴えることができる。また、出力する音は、障害物が人か否かに応じて選択されるので、より適切な音を選択して、障害物を移動経路から効率よく取り除くことができる。

前記所定の音は、働きかけの強さが異なる複数種類の音声を含み、前記障害物対応部は、前記所定の音の種類を所定の時間毎に働きかけの度合いが強くなるように変更する、ものであってよい。

このような構成によれば、働きかけの強さを徐々に強くすることができるので、いきなり強い言葉を発するなどして人を不快にさせることなく、人の行動に応じて段階的に強くなる適切な強度での働きかけを実現することができる。

前記障害物対応部は、前記所定の音の音量を所定の時間毎に大きくする、ものであってよい。

このような構成によれば、いきなり大音量を発するなどして人を驚かせることなく、人の行動に応じて段階的に大きくなる適切な音量での働きかけを実現することができる。

前記障害物対応部が出力する前記所定の音の種類、音量、出力回数、および出力継続時間の少なくとも一つ以上は、予め設定可能に構成される、ものであってよい。

このような構成によれば、移動ロボットが適用される場所等に応じた適切な音を設定することが可能になる。

前記スピーカは、前記所定の音が前記頭部から出力されるように配置される、ものであってよい。

このような構成によれば、所定の音を、人と略同様の位置から出力することができるので、音を聞く側の人に違和感を生じさせず、より効果的に音を伝えることができる。

前記障害物対応部は、前記報知手段による働きかけの強さを所定の時間毎に変更する、ものであってよい。

このような構成によれば、前記報知手段によって、人の行動に応じて段階的に強くなる適切な強度での働きかけを実現することができる。

前記移動経路生成部は、前記障害物が検出された場合に、現在地から当該障害物を回避して前記目的地に到達する移動経路を生成し、前記障害物対応部は、現在地から前記障害物を回避して前記目的地に到達する移動経路が生成できなかった場合に、前記所定の対応を実行する、ものであってよい。

このような構成によれば、移動経路上に障害物が検出された場合には、当該障害物を回避して目的地まで到達可能な移動経路が再生成され、又、そのような経路が再生成されなかった場合には、障害物を移動経路から除くための所定の対応が実行されるので、移動ロボットが目的地までの移動経路を積極的に確保して、作業効率を高めることができる。

前記移動経路生成部は、前記障害物が検出された場合であって、かつ前記障害物対応部が前記所定の対応を実行してから所定時間経過しても前記障害物が前記移動経路から除かれない場合に、現在地から当該障害物を回避して前記目的地に到達する移動経路を生成する、ものであってよい。

このような構成によれば、移動経路上に障害物が検出された場合には、障害物を移動経路から除くための所定の対応が実行され、その後所定時間経過しても障害物が移動経路から取り除かれない場合には、当該障害物を回避して目的地まで到達可能な移動経路が再生成されるので、移動ロボットが目的地までの移動経路を積極的に確保して、作業効率を高めることができる。

前記移動制御部は、移動中に前記障害物が検出された場合は、前記移動ロボットを減速又は停止させる、ものであってよい。

このような構成によれば、移動経路の再設定、又は障害物への所定の対応を、障害物に接触または衝突する前に、安全に実行することができる。

障害物対応部は、前記障害物が検出された場合に前記移動ロボットが停止した場合には、前記所定の対応として、前記移動ロボットの停止状態を維持する、ものであってよい。

このような構成によれば、例えば、移動ロボットの作業を停止させてでも静かに運用したい状況にも対応できる移動ロボットを提供することができる。

前記移動ロボットは、マニピュレータ機構を有する一又は複数の腕部をさらに備える、ものであってよい。

このような構成によれば、上述の各機能を備える移動マニピュレータを実現することができる。

前記障害物対応部は、検出した前記障害物が人ではない場合に、前記所定の対応として前記腕部を用いて前記障害物を指し示す、ものであってよい。

このような構成によれば、移動経路から取り除いてほしい障害物を周囲の人により的確に伝えることができる。

本発明は、方法として観念することもできる。すなわち、本発明にかかるロボット制御方法は、移動ロボットを制御するロボット制御方法であって、現在地から目的地までの移動経路を生成する移動経路生成ステップと、生成された前記移動経路に沿って前記移動ロボットを移動させる移動制御ステップと、前記移動経路上の障害物を検出する障害物検出ステップと、前記障害物を前記移動経路から除くための所定の対応を実行する障害物対応ステップと、を含み、前記障害物検出ステップでは、前記障害物が人か否かを検出し、前記障害物対応ステップでは、前記障害物が人か否かに応じて選択した一又は複数の前記所定の対応を実行する。

本発明は、コンピュータプログラムとして観念することもできる。すなわち、本発明に係るロボット制御プログラムは、移動ロボットを制御するロボット制御プログラムであって、現在地から目的地までの移動経路を生成する移動経路生成ステップと、生成された前記移動経路に沿って前記移動ロボットを移動させる移動制御ステップと、前記移動経路上の障害物を検出する障害物検出ステップと、前記障害物を前記移動経路から除くための所定の対応を実行する障害物対応ステップと、を含み、前記障害物検出ステップでは、前記障害物が人か否かを検出し、前記障害物対応ステップでは、前記障害物が人か否かに応じて選択した一又は複数の前記所定の対応を実行する。

本発明によれば、移動経路上に障害物がある場合でも作業効率を低下させないロボット制御装置等を提供することができる。

図１は、ロボット制御装置が適用される移動ロボットの概略構成図である。 図２は、移動ロボットの外観を示すが概略構成図である。 図３は、移動ロボットの頭部を説明する図である。 図４は、移動制御を説明するフローチャートである。 図５は、移動処理を説明するフローチャートである。 図６は、移動経路上の障害物を検出する方法を説明する図である。 図７は、障害物対応処理を説明するフローチャートである。 図８は、人特定処理を説明する図である。 図９は、人対応処理の動作を説明する図である。 図１０は、物対応処理の動作を説明する図である。

[実施形態]
図１から図３は、本発明の一実施形態に係るロボット制御装置（コントローラ１）が適用される移動ロボット１００の構成を説明する図である。移動ロボット１００は、人と共有の作業領域内を移動することが想定されるロボットであって、例えば、工場等で部品をピックして所定場所に運搬する機能等を有する移動マニピュレータや、空港等の施設で旅行者等を案内するサービスロボット等に適用されてよい。本実施形態では、移動ロボット１００が、図２に示すような頭部３０とマニピュレータ機構を有する腕部４０とを備える略人型の移動マニピュレータに適用された例について説明する。

図１に示すとおり、本実施形態の移動ロボット１００は、移動ロボット１００の動作を制御するロボット制御装置として機能するコントローラ１と、移動機構駆動手段２と、頭部駆動手段３と、検出手段４と、報知手段５と、を含んで構成される。

コントローラ１は、移動経路生成部１１、移動制御部１２、障害物検出部１３、および障害物対応部１４等の機能部を有する。コントローラ１は、例えば、プロセッサとしての中央演算装置（ＣＰＵ）、記憶媒体としての読み出し専用メモリ（ＲＯＭ）およびランダムアクセスメモリ（ＲＡＭ）、入出力インタフェース（Ｉ／Ｏインタフェース）等がバスを介して接続されて構成される情報処理装置である。また、コントローラ１が備えるＲＯＭには、前述の各機能部がそれぞれに有する各機能を実行するためのプログラム（制御プログラム）が格納されている。すなわち、コントローラ１は、記憶媒体に格納された各種プログラムを実行することによって、移動経路生成部１１、移動制御部１２、障害物検出部１３、および障害物対応部１４の各機能部の機能を実現するように構成される。なお、コントローラ１を構成するプロセッサおよび記憶媒体として上述した構成は例示であって、これらに加えて、或いは代えて、GPU、フラッシュメモリ、ハードディスク、ストレージ等を含んでもよい。また、上述の各機能部の機能は、必ずしもコントローラ１のみによって実現される必要はなく、機能部毎に適宜選択された複数のコントローラがそれぞれ、或いは協調することによって実現されるように構成されてもよい。コントローラ１の各機能部の機能について以下説明する。

移動経路生成部１１は、移動ロボット１００が移動しようとする経路（移動経路）を生成する。具体的には、移動経路生成部１１は、作業領域の地図情報（マップデータ）に基づいて所定位置から目的地までの経路を生成するパスプランニングを実行する。生成された経路は移動ロボット１００の移動経路として設定される。ここでの所定位置は、予め定められた所定の位置であってもよいし、移動ロボット１００の現在位置であってもよい。移動経路生成部１１が実行するパスプランニングの具体的な手法は特に限定されず、既存の移動マニピュレータ等の移動ロボットに用いられている公知の手法が適宜採用されてよい。

移動制御部１２は、移動経路生成部１１が生成した移動経路に沿って移動ロボット１００を移動させるために、移動機構駆動手段２を制御する。このように、本実施形態の移動ロボット１００は、生成した移動経路に沿って自律的に移動するいわゆる自律走行型の移動ロボットとして構成される。移動機構駆動手段２については図２を参照して後述する。

検出手段４は、移動ロボット２００の周囲環境に存在する障害物を検出する。ここでの障害物は、物だけでなく人も含む。また、検出手段４は、障害物を検出する手段として用いられるだけでなく、移動ロボット１００が自律走行するために移動ロボット１００の周辺環境を認識するための手段としても構成されてよい。検出手段４は、例えば、センサ（イメージセンサ、ライダ、レーザスキャナ等）、ステレオカメラ等の少なくとも一つを含む。本実施形態の検出手段４は、イメージセンサから構成されるものとし、検出手段４を以下ではセンサ４とも称する。なお、イメージセンサは、光学系を通して検出した光を電気信号に変換する撮像素子を有するセンサであってその種類については特に制限されない。センサ４は、少なくとも前方を含む周囲環境に存在する障害物を検出可能に構成され、例えば、図３（ａ）で示す顔部３１に構成された人の目に相当する部分等に設けられてよい。また、いわゆる３６０度カメラと言われるような全方位を検出できるセンサ４が例えば頭部３０の頭頂部に設けられてもよい。本実施形態のセンサ４は、移動ロボット１００の少なくとも前方を含む周辺に存在する障害物の位置、及び障害物が人である場合には当該人の位置と姿勢を認識可能な画像データを検出して、検出データ（画像データ）をコントローラ１（障害物検出部１３）に送信する。

障害物検出部１３は、センサ４が取得した検出データ（画像データ）に基づいて、移動経路上の障害物を検出する。また、障害物検出部１３は、障害物が人であるか否かを識別し、障害物が人である場合には当該人の位置と姿勢を検出する。さらに、障害物検出部１３は、移動経路上の障害物だけでなく、移動ロボット１００の周辺に存在する人の位置と姿勢を検出するように構成されてよい。ただし、障害物検出部２１が検出する人の姿勢は、必ずしも体全体の構えではなく、少なくとも人の頭の位置が検出可能であればよい。なお、画像データに基づいて人の位置と姿勢とを検出する手法として、公知の種々の手法を採用し得るが、本実施形態では、画像データから人の骨格（ボーン）を検出して人の位置と姿勢とを検出する手法（ボーンモデル）が採用されてよい。これにより、障害物検出部１３は、移動経路上、および移動ロボット１００の周辺にいる人の頭の位置を容易に検出することができる。

また、障害物検出部１３が検出する「移動経路上にある障害物」とは、移動ロボット１００が移動経路上を移動した際に、障害物に接触あるいは衝突するおそれのある障害物を含んでもよい。換言すれば、ここでの「移動経路」は、移動ロボット１００が移動する予定の経路に対応して引かれる単なる線として観念されるだけでなく、移動ロボット１００の水平方向幅に対応する幅を持つ帯として観念されてよい。「移動経路上にある障害物」の検出方法の具体例については図８を参照して後述する。

障害物対応部１４は、障害物検出部１３が障害物を検出した場合に、当該障害物に対する所定の対応を実行する。ここでの所定の対応は、例えば、頭部３０を駆動する、報知手段５から所定の報知を行う、等の対応を含む。所定の対応は、障害物の種類（例えば人か否か）や状況に応じて適宜選択されてよい。所定の対応の詳細については図９および図１０を参照して後述する。

頭部方向制御部１４ａは、移動ロボット１００に備わる頭部３０（図２参照）を駆動するために、頭部駆動手段３を制御する。具体的には、頭部方向制御部１４ａは、頭部駆動手段３を介して頭部３０の正面の向く方向を制御する。頭部駆動手段３の詳細については図２を参照して後述する。なお、本実施形態の頭部方向制御部１４ａは、障害物対応部１４の一機能部として説明される。

報知制御部１４ｂは、報知手段５を用いて所定の報知を行う。本実施形態の報知手段５はスピーカとし、報知手段５を以下ではスピーカ５とも称する。すなわち、報知制御部１４ｂは、スピーカ５を用いて所定の音を出力する。所定の音の詳細については後述する。なお、本実施形態の報知制御部１４ｂは、障害物対応部１４の一機能部として説明される。

図２は、移動ロボット１００の構成を説明する図であって、主に移動ロボット１００の外観例を示す。

図示するように、本実施形態の移動ロボット１００は、略人型の形状を有しており、ロボット本体部１０と、ロボット本体部１０を支持する移動台車２０と、ロボット本体部１０の上端に設けられた頭部３０と、ロボット本体部１０の前面から延びる腕部４０とから構成されている。

ロボット本体部１０を支持する移動台車２０は、主に、移動ロボット１００が置かれた面（床面）の上を移動する機能を有する。移動台車２０の種類は特に制限されないが、本実施形態では全方位移動台車が採用される。全方位移動台車とは、例えば駆動輪として複数のオムニホイールを備える等して、全方向に移動することができるように構成された台車である。本実施形態の移動台車２０は、図２で示されるように、外観に表されるスカート２１の内側に、三つの駆動輪２２と、駆動輪２２をベルト等を介して駆動するための移動機構駆動手段２とから構成されてよい。本実施形態の移動機構駆動手段２は一または複数のモータから構成されるものとし、以下では、移動機構駆動手段２をモータ２とも称する。

頭部３０は、略人型の移動ロボット１００において、人の頭（首より上の部分）に相当する構成としてロボット本体部１０の上端に設けられてよい。また、頭部３０は、人がその正面を顔として認識できるように構成されるのが望ましい。頭部３０は、正面が向く方向を制御可能に構成される。具体的には、本実施形態の移動ロボット１００は、一又は複数の頭部駆動手段３（アクチュエータ３）を備え、頭部駆動手段３を介して頭部を動かすことによりその正面の向きを制御できるように構成される。なお、以下では、頭部３０の正面を顔部３１と称する。

本実施形態の移動ロボット１００は、頭部３０を床面に対して水平方向（左右方向）に回転させる鉛直方向の回転軸を有し頭部３０の左右方向への回転駆動を可能とする頭部駆動手段３（サーボモータ３ａ）を有する。これにより、移動ロボット１００は、頭部３０のみを鉛直方向に対して左右へ回転駆動させることができる。ただし、サーボモータ３ａの配置は、図示する配置に制限されず、顔部３１の向きを左右方向に動かすことができる限り適宜変更されてよい。例えば、サーボモータ３ａは、ロボット本体部１０を移動台車２０に対して左右へ回転駆動させるようにロボット本体部１０の下端に設けられてもよい。この場合、サーボモータ３ａは、頭部３０をロボット本体部１０とともに垂直方向に対して左右へ回転駆動させることにより顔部３１の向きを変えることができる。

また、移動ロボット１００は、頭部３０を床面に対して上下方向に駆動させる水平方向の回転軸を有し頭部３０の上下を仰ぎ見る動作を可能とする頭部駆動手段３（サーボモータ３ｂ）を有してもよい。これにより、移動ロボット１００は、顔部３１の向きを上下方向にも動かすことができる。

図３は、本実施形態の頭部３０の構成例をより具体的に説明する図である。頭部３０の形状は、正面を顔部３１として認識できる限り特に制限されない。例えば、顔部３１は、正面を顔部３１として容易に認識されるように、頭部３０の正面部分にのみ視認される構造的な特徴を有していることが望ましい。例えば、図３（ａ）のように、人の顔を模した二つの目に相当する構成を頭部３０の正面にのみ設けることにより、正面が顔部３１として容易に認識され得る。また、図３（ｂ）に示すように、例えば透過部材からなる特徴的な部分（太矢印で示す部分）が頭部３０の正面にのみ設けられてもよい。或いは、図示しないが、例えば略長球形等の頭部３０において、正面のみを平面にする等してもよい。

また、頭部３０は、図示するように、人間の首に相当する構成（頸部）を介してロボット本体部１０に設けられてもよいし、ロボット本体部１０の上端に直接設けられてもよい。すなわち、サーボモータ３ａ、３ｂは、頸部に設けられてもよいし、頭部３０に設けられてもよい。また、検出手段４は、頭部３０において、例えば、図３（ａ）に示す目に相当する部分や、図３（ｂ）に示す透過部材からなる部分から外部環境を検出するように設けられてもよい。また、スピーカ５は、頭部３０、例えば顔部３１から音を出力するように設けられてよい。以上が頭部３０の構成例である。図２に戻って説明を続ける。

図２に示すとおり、本実施形態の移動ロボット１００はロボット本体部１０の前面に腕部４０を備える。腕部４０は、マニピュレータ機構を備え、運搬する部材等を把持するための把持機構４１が自由端に相当する先端に設けられている。ただし、腕部４０の形状、数、および配置は図示する態様に制限されず目的に応じて適宜変更されてよい。例えば、移動ロボット１００は、ロボット本体部１０の両側面に腕部４０を備える双腕ロボットとして構成されてもよい。

以上が、本実施形態の移動ロボット１００の構成例である。なお、移動ロボット１００は、図２では省略されているが、移動ロボット１００の動作を制御するのに必要となる他の構成、例えば、腕部４０等を駆動する他のアクチュエータや、電力源となるバッテリ等を備えてもよい。

次に、図４から図１０を参照して、移動ロボット１００の動作について説明する。

図４は、本実施形態の移動ロボット１００が行う移動制御を説明するフローチャートである。コントローラ１が備える記憶媒体には、図示のフローチャートを参照して以下に説明する処理を実行する制御プログラムが格納されている。

ステップＳ１１では、コントローラ１はタスク取得処理を実行する。タスク取得処理は、移動ロボット１００が後述の移動経路生成処理（Ｓ１２）によって移動経路を生成するために必要な情報を取得するための処理である。タスク取得処理では、例えば、ピックする部品の識別情報（部品ＩＤ）や目的地の位置情報（例えば位置座標）等が取得される。取得方法に制限はなく、例えば公知の無線通信技術を利用して取得してもよいし、不図示の情報入力手段（例えばタッチパネル等）を介して取得するように構成されてもよい。

ステップＳ１２では、コントローラ１（移動経路生成部１１）は、現在地から目的地までの移動経路を生成する。目的地は、タスク取得処理によって取得した情報に応じて設定されてよい。例えば、タスク取得処理によって部品ＩＤを取得した場合には、移動経路生成部１１は、当該部品ＩＤにより特定される部品が置かれている場所を目的地とし、現在地から当該目的地までの経路を生成する。生成された経路は、移動ロボット１００の移動経路として設定される。その際、候補となる経路が複数生成された場合には目的地まで最も早く到達できる経路または目的地までの距離が最も短い経路を優先する等の設定条件が予め定められていてもよい。目的地までの移動経路が設定されると、移動ロボット１００を目的地まで移動させるための移動処理が実行される（Ｓ１３）。

ステップＳ１３では、コントローラ１（移動制御部１２）は、移動ロボット１００を目的地まで移動させる移動処理を実行する。移動処理では、移動制御部１２がモータ２を制御して、移動ロボット１００を設定された移動経路に沿って目的地まで移動させる。本ステップで実行される移動処理の具体的な手法は特に制限されず、公知の種々の手法が適宜採用されてよい。例えば、移動ロボット１００は、パスプランニングにより計画された経路と、予め記憶された作業領域のマップデータとに基づいて、オドメトリ、スキャンマッチング等の公知の自己位置推定を行いながらモータ２を制御して、目的地までの自律的な移動（自律走行）を実現するように構成されてよい。

ステップＳ１３の移動処理の詳細について、図５を参照して説明する。

図５は、本実施形態の移動ロボット１００が行う移動処理を説明するフローチャートである。本フローチャートで説明する移動処理は、移動ロボット１００が設定された移動経路に沿って目的地まで移動している間、常時実行される。なお、コントローラ１が備える記憶媒体には、図示のフローチャートを参照して以下に説明する処理を実行する制御プログラムが格納されている。

ステップＳ１３１では、コントローラ１（障害物検出部１３）は、所定距離内における移動経路上の障害物を検出する。障害物検出部１３が移動経路上の障害物を検出する方法の具体例について、図６を用いて説明する。

図６は、本実施形態の障害物検出部１３が移動経路上の障害物を検出する方法を説明する図である。図６では、移動ロボット１００と検出手段４により検出された障害物３００とが示されている。移動ロボット１００から延びる点線矢印は、生成された移動経路を示す。また、移動ロボット１００から延びる実線矢印は、移動ロボット１００の直近の移動方向（現在地からの移動方向）、すなわち、現在地から、移動経路上において最初に方向転換する地点（経由点）に向かう方向である。

本実施形態の障害物検出部１３による障害物の検出は、移動ロボット１００および障害物３００を、上方から床面に投射された単純な二次元図形とみなし、当該二次元図形同士が干渉する否かを判定することにより行われてもよい。図６で例示されるように、移動ロボット１００は、例えば、移動台車２０や腕部４０の各リンクに対応して投射された円の連なりで表現される。また、障害物（人）３００は、腕を水平方向に伸ばした場合に水平方向に広がる領域を考慮した円で表現される。なお、障害物が人でない場合には、障害物の外形に応じて適宜選択された二次元図形で表現されてよい。なお、投射された二次元図形の外縁例えば円の直径は、上方から見た移動ロボット１００の水平方向幅の最大値、および障害物３００の水平方向幅の最大値にそれぞれ一致する必要は必ずしもない。投射された二次元図形は、若干広くして余裕を持たせたり、現実的な可動範囲を考慮して狭めたりするなど適宜調整されてよい。

また、移動ロボット１００に対応する円は、移動ロボット１００が所定距離または所定時間移動する間の移動経路に沿って生成される。図６では、点線円で示す所定距離内を移動する移動ロボット１００に対応する円が時系列に示されている。本図では、現在地の移動ロボット１００に対応する円を（ｔ）とし、移動経路に沿って時系列に生成された円を（ｔ＋１）、（ｔ＋２）として示している。そして、障害物検出部１３は、所定距離内において、移動ロボット１００に対応する円と障害物３００に対応する円とが接触（干渉）するか否かを計算する。接触するか否かは、例えば円と円との中心間距離と、各円のそれぞれの半径とに基づいて容易に計算することができる。これにより、障害物検出部１３は、例えば図示のように、移動ロボット１００が（ｔ＋２）において障害物３００と接触あるいは衝突し得ること、すなわち、（ｔ＋２）の位置において障害物３００に移動経路を妨げられることを容易に検出することができる。

なお、図中の点線円で示す所定距離、すなわち現在地を基準として移動経路上の障害物を検出する距離的範囲は、適宜設定されてよい。ここでの所定距離は、主に、移動ロボット１００から遠すぎる位置にある障害物が検出されることを除く意図で設定される距離であって、例えば５ｍ等、移動ロボット１００の移動速度や作業領域の広さ等に応じて適宜設定されてよい。図では、経由点よりも近い範囲、すなわち、移動ロボット１００が直近の移動方向に動いた場合に衝突し得る障害物を検出する例が示されているが、これに限られない。障害物を検出する所定距離内は適宜設定されてよく、原則として検出手段４が検出可能な範囲内において、経由点を超える範囲で設定されてもよい。

なお、衝突検証用図形として上述のような二次元図形を生成する衝突判定手法は一例であって、これに限られない。障害物検出部１３は、衝突検証用図形として、例えば移動ロボット１００の水平方向幅に対応する幅を持つ帯を移動経路に沿って生成してもよい。また、障害物検出部１３は、三次元図形を生成する公知の他の衝突判定手法を採用してもよい。この場合には、移動ロボット２００および障害物３００は、衝突検証用図形として三次元の球体の連なりまたはポリゴンメッシュで表されてもよい。

図５に戻って説明を続ける。ステップＳ１３１の処理において移動経路上に障害物が検出されない場合には（ＮＯ判定）、目的地に到達するまで、ステップＳ１３１からステップＳ１３２の処理が繰り返し実行される。移動経路上に障害物が検出された場合には（ＹＥＳ判定）、ステップＳ１３３の処理が実行される。

ステップＳ１３３では、コントローラ１は、事前の設定に基づいて、障害物を回避する別の移動経路を生成するか否か判断する。障害物が検出された際は移動経路を再生成すると予め設定されていた場合には（ＹＥＳ判定）、ステップＳ１３４の処理に進む。障害物が検出された際は移動経路を再生成すると予め設定されていない場合には（ＮＯ判定）、ステップＳ１３４の障害物対応処理に進む。なお、移動経路の再生成に関する設定方法に制限はなく、例えば公知の無線通信技術を介して設定されてもよいし、不図示の情報入力手段（例えばタッチパネル等）を介して設定されるように構成されてもよい。また、移動経路の再生成に関する事前の設定は、されなくてもよい。この場合、ステップＳ１３３の処理は削除されてよく、コントローラ１は、移動経路上に障害物が検出された場合には（Ｓ１３１、ＹＥＳ判定）、ステップＳ１３４の処理を実行する。

ステップＳ１３４では、コントローラ１（移動経路生成部１１）は、ステップＳ１３１で検出された障害物を回避して現在地から目的地まで到達可能な移動経路（回避ルート）の生成を試みる。この際、回避ルートの生成条件として、目的地に到達するまでに要する距離又は時間の上限が予め設定されてもよい。例えば、１００ｍの距離的上限が設定されている場合には、目的地までの通路上に障害物が検出され、当該通路の幅を鑑みて障害物を避けて越えられない場合であって、かつ唯一の迂回路では現在地から目的地までの距離が１００ｍを超える場合には、回避ルートは生成されず、新たな移動経路は再設定されない。なお、ステップＳ１２での移動経路生成処理と同様に、候補となる経路が複数生成された場合には目的地まで最も早く到達できる経路または目的地までの距離が最も短い経路を優先する等の条件が予め定められていてもよい。

回避ルートが生成されると（Ｓ１３４、ＹＥＳ判定）、生成された回避ルートを移動経路として再設定する移動経路再設定処理が実行され（Ｓ１３５）、再設定された移動経路に沿って目的地に到達するまでステップＳ１３１からステップＳ１３２の処理が繰り返し実行される。その間、移動ロボット１００は移動経路に沿って移動し、目的地に到達したと判定されると（Ｓ１３２、ＹＥＳ判定）、移動処理は終了する。

他方、ステップＳ１３４において、現在地から障害物を回避して目的地まで到達可能な経路が存在しない、或いは、上述の上限又は設定条件を満たす経路が存在しないことによって回避ルートが生成されない場合は（Ｓ１３４、ＮＯ判定）、障害物を取り除くための所定の対応を実行するためにステップＳ１３６の障害物対応処理に進む。

なお、ステップＳ１３１で障害物が検出されてから、障害物対応処理（Ｓ１３６）又は移動経路再設定処理（Ｓ１３５）が実行されるまでの間、コントローラ１（移動制御部１４）は、移動ロボット１００の移動を減速または停止させる処理（減速処理）を実行してもよい。これにより、移動中に障害物を検出した場合に、障害物に衝突する前に、障害物対応処理（Ｓ１３６）又は移動経路再設定処理（Ｓ１３５）を安全に実行することができる。なお、減速の度合い及び停止する位置（障害物との距離）は、予め設定されていてもよいし、障害物を検出した時点における移動ロボット１００の移動速度等に応じて適宜調整されてもよい。

以上が本実施形態の移動ロボット１００が行う移動処理の詳細である。次に、図７を参照して、障害物対応処理の詳細について説明する。

図７は、本実施形態の移動ロボット１００が行う障害物対応処理（Ｓ１３６）を説明するフローチャートである。コントローラ１が備える記憶媒体には、図示のフローチャートを参照して以下に説明する処理を実行する制御プログラムが格納されている。

ステップＳ１３６１では、コントローラ１（障害物検出部１３）が障害物が人か否かを判定する。障害物が人か否かは、検出手段４が取得した検出データ（画像データ）を解析することで容易に判別することができる。なお、検出手段４は、障害物の温度から人か否かを判別するために、障害物から放射される赤外線を検出可能に構成されてもよい。障害物が人である場合には（ＹＥＳ判定）、検出された障害物（人）が複数であるか否かを判定するためにステップＳ１３６２の処理が実行される。障害物が人でない場合には（ＮＯ判定）、人ではない障害物に対して物対応処理を実行するためにステップＳ１３６５に進む。物対応処理の詳細については図１０を参照して後述する。

ステップＳ１３６２では、コントローラ１は、検出された人が複数か否かを判定する。検出した人が複数ではなく一人であれば（ＮＯ判定）、検出された人に対して人対応処理を実行するためにステップＳ１３６４の処理にすすむ。人対応処理の詳細については図９を参照して後述する。他方、検出された人が複数であれば（ＹＥＳ判定）、人対応処理を実行する対象を特定するために人特定処理（Ｓ１３６３）を実行する。人特定処理の詳細については図８を参照して説明する。

図８は、人特定処理を説明する図である。図８は、移動ロボット１００と人との位置関係を上方から見た図であって、移動ロボット１００と、移動ロボット１００から延びる点線矢印で示す移動経路と、移動ロボット１００から延びる実線矢印で示す直近の移動方向と、点線円で示す移動ロボット１００からの所定距離と、人Ａおよび人Ｂを含む複数の人と、が示されている。

図８に示す人Ａおよび人Ｂは、両者とも所定距離内における移動経路上に検出された障害物としての人である。このように、所定距離内における移動経路上の障害物として人が複数検出された場合には、コントローラ１は、移動ロボット１００が移動した際に最初に接触あるいは衝突すると予測される人を特定する。具体的には、移動ロボット１００に一番近い人（人Ａ）が、最初に衝突が予測される人と特定される。ただし、最初に衝突が予測される人を特定するにおいて人の移動速度や移動方向が考慮されてもよい。この場合、例えば、人Ａが移動ロボット２００からゆっくりと遠ざかる一方で、人Ｂが移動ロボット２００に速やかに近づいている場合には、人Ｂが最初に衝突が予測される人として特定される場合があってもよい。人特定処理により人対応処理を実行する対象が特定されると、ステップＳ１３６４の人対応処理が実行される。

ステップＳ１３６４では、障害物が人であると判定されたので（Ｓ１３６１、ＹＥＳ判定）、検出された障害物に対して、対象が人である場合に選択される一又は複数の所定の対応を実行する。具体的に、図９を参照しながら説明する。

図９は、人対応処理を説明する図である。本実施形態の人対応処理は、少なくとも次の三つの対応のうちのいずれか一つ以上を含む。具体的には、人対応処理は、移動ロボット１００の移動を停止する（人対応１）、人の頭に顔部３１を向ける（人対応２）、および所定の音を出力する（人対応３）のいずれか一つを、または、いずれか二つ以上を組み合わせて実行する。なお、図中の点線矢印は、移動ロボット１００の移動経路を示す。

図９（ａ）は、移動ロボット１００が、人対応１および人対応３のいずれか一方又は両方を実行している様子を説明する図である。図示するように、移動ロボット１００は、障害物である人の前で静止してよい（人対応１）。例えば、上述の減速処理によって障害物の手前で停止した場合には、その停止状態を維持する。このような対応は、人の行動を優先するものであり、原則として、人が移動ロボット１００の存在に気づき移動経路から立ち退いてくれるのを静かに待つことになる。

また、移動ロボット１００は、図９（ａ）の状態でスピーカ５を介して所定の音を出力してもよい（人対応３）。所定の音は、ブザー音等の警告音でもよいし、「すみません、どいてください」「とおります」といった音声でもよい。これら所定の音の種類は、予め記憶された複数パターンの中から事前の設定等に応じて適宜選択されてよい。音の種類だけでなく、音量、音の繰り返し回数（出力回数）、および、音の出力継続時間等も事前に設定可能に構成されてよい。これにより、移動ロボット１００は、移動ロボット１００が利用されるシーンや、移動ロボット１００を管理するユーザの要望に応じた適切な音を出力することができる。

また、静止する人対応１と組み合わせて所定の音を出力する場合には、出力するタイミングも適宜設定されてよい。例えば、静止状態が５秒継続しても人が退避しない場合に音を出力するように設定されてよい。

また、出力する音の種類、音量、繰り返し回数等を人対応処理の継続時間に応じて変化させてもよい。例えば、「すみません」「どいてください」「どけ！」等の、言葉の強さ（意味合い）に応じて働きかけの強さが異なる複数種類の音を用意し、働きかけの度合いが徐々に強くなるように、出力する音の種類を所定時間毎により強い言葉に変更してもよい。なお、ここでの所定時間は適宜設定されてよい。また、段階的に変更する際の時間間隔が等間隔である必要はない。

また、音の種類だけでなく、所定の音の音量を所定時間毎に徐々に大きくしてもよい。このように、人対応３では、音量を徐々に大きくしたり、音の種類（言葉の内容）を段々と強くしたりすることにより、働きかけの強度（働きかけの度合いの強さ）を段階的に高めることができる。これにより、移動ロボット１００は、いきなり大音量で強い言葉を発するなどして人を不快にしたり驚かせたりすることなく、人の行動に応じて段階的に変化する適切な強度で退避を促すことができる。

図９（ｂ）は、移動ロボット１００が人の頭に顔部３１を向ける対応（人対応２）を実行している様子を説明する図である。図示するように、障害物対応部１４（頭部駆動制御部１４ａ）は、人対応処理として顔部３１を人の頭に向けてもよい。これにより、移動経路上の人に対して、静止するだけの人対応１よりは強く、音を出力する人対応３よりかは柔らかく退避を促すことができる。なお、人対応１および人対応３の少なくとも一方と組み合わせて実行されてよく、その組み合わせタイミングは適宜設定されてよい。例えば、静止状態から所定時間経過後に顔部３１を人の頭に向けて、さらに所定時間経過した場合に音を出力するように構成されてよい。これにより、状況に応じて、よりきめ細かい働きかけを行うことが可能になる。以上が本実施形態の人対応処理の詳細である。障害物対応部１４は、障害物が人である場合には、上述の人対応１〜３から選択した一又は複数の所定の対応を人に対して実行するように構成される。

次に、ステップＳ１３６５に係る物対応処理の詳細について図１０を参照して説明する。

図１０は、物対応処理を説明する図である。物対応処理は、障害物が人ではないと判定された場合（Ｓ１３６１、ＮＯ判定）に行われる処理であって、少なくとも次の二つの対応のうちのいずれか一つ又は両方を含む。具体的には、物対応処理は、移動ロボット１００の移動を停止した後に、周辺にいる人の頭に顔部３１を向ける（物対応１）、および周辺にいる人に音を出力する（物対応２）のいずれか一方を、または組み合わせて実行される。なお、上述の人対応１と同様に、障害物の手前で静止する物対応３を実行してもよい。図中の点線矢印は、移動ロボット１００の移動経路を示す。

図１０（ａ）は、移動ロボット１００が、障害物（物）の手前で停止している状態を示す。この時、障害物検出部１３が移動ロボット１００の周囲にいる人の位置、特に周囲にいる人の頭の位置を検出する。

そして、図１０（ｂ）に示すように、障害物対応部１４（頭部駆動制御部１４ａ）は、物対応処理として、周辺にいる人の頭に顔部３１を向けてよい（物対応１）。これにより、移動ロボット１００は、障害物に移動経路を妨げられていることを周囲にいる人に積極的に訴えかけることができる。また、この時、顔部３１を向けた人に所定の音を出力することで（物対応２）、移動経路から障害物を除いてほしいことを周囲の人に直接訴えかけることができる。この時に出力する音の種類は、人対応処理時とは変えて、例えば次のような音声であってもよい。

すなわち、障害物対応部１４（報知制御部１４ｂ）は、物対応処理（物対応２）によって、「物をどかしてください」等の、移動経路から障害物を取り除くことを要求する音声を周囲の人に出力してもよい。これにより、移動ロボット１００は、移動経路の確保のために、移動経路から障害物を取り除くことを周囲の人により的確に訴えることができる。また、音を出力するスピーカ５として、いわゆる指向性スピーカが採用されてもよい。これにより、例えばむやみに音を発せられない現場等であっても、周辺にいる特定の人にのみ助けを求めることが可能となる。また、物対応２は図１０（ａ）に示す静止状態（物対応３）において実行されてもよい。その場合には、移動ロボット１００は、音を出力する対象を限定せずに、周辺に向けて「誰かどかしてください」等の音を出力してもよい。なお、物対応処理において音を出力する際においても、人対応処理において上述したのと同様に、音の種類、音量、音の繰り返し回数、音の出力継続時間は適宜変更可能に構成されてよい。

また、図示しないが、障害物対応部１４は、物対応処理として、腕部４０を用いて取り除いてほしい障害物を指し示してもよい（物対応４）。これにより、移動ロボット１００は、移動経路から取り除いてほしい障害物を周囲の人により的確に伝えることができる。なお、障害物を指し示す動作としては種々の動作が採用され得る。例えば、移動ロボット１００は、人が対象物を指差すように腕部４０の先端を障害物に向ける動作を行ってもよいし、さらに、腕部４０の先端を障害物に対して前後させる等して取り除いてほしい障害物をより強調して指し示すような動作を行ってもよい。なお、物対応４についても、上述の物対応１から３のいずれか一つ以上と組み合わせて実行されてよい。

以上が、本実施形態の物対応処理の詳細である。障害物対応部１４は、障害物が物である場合には、上述の物対応１〜４から選択した一又は複数の所定の対応を周囲の人に対して実行するように構成される。

以上が、一実施形態の移動ロボット１００が行う移動制御の詳細である。なお、図４、図５および図７で示すフローチャートは本実施形態の移動制御を説明するための例示であって、必ずしも図示するとおりに実行されることを制限するものではなく、上述の技術的効果を奏する限り適宜変更されてもよい。

例えば、上述したとおり図５で示すステップＳ１３３は削除されてもよい。この場合には、移動ロボット１００は、障害物が検出された場合には回避ルートの生成を試み、適切な回避ルートが生成されなかった場合に、障害物対応処理を実行するように構成されてもよい。

また、移動ロボット１００は、障害物が検出され（Ｓ１３１、ＹＥＳ判定）、障害物対応処理として上述の所定の対応を実行してから所定時間経過しても障害物が移動経路から除かれない場合に、現在地から当該障害物を回避して目的地に到達する移動経路（回避ルート）の生成を試みてもよい（Ｓ１３４）。このように、移動ロボット１００は、障害物を検出した場合に、まずは障害物対応処理を実行し、その後所定時間経過しても障害物が移動経路から取り除かれない場合に、回避ルートを生成するように構成されてよい。なお、ここでの所定時間は適宜設定されてよく特に制限されない。

以上が本実施形態の移動ロボット１００の詳細である。以上説明したように、移動ロボット１００は、移動経路上に障害物が検出された場合には、当該障害物を回避して目的地まで到達可能な移動経路を再生成し、又、そのような経路が再生成できなかった場合には、障害物を移動経路から除くための所定の対応を実行する。あるいは、移動ロボット１００は、移動経路上に障害物が検出された場合には、障害物を移動経路から除くための所定の対応を実行し、又、所定の対応を実行しても当該障害物が取り除かれない場合には、障害物を回避して目的地まで到達可能な移動経路を再生成する。これにより、移動ロボット１００は、移動経路を障害物に塞がれた場合でも、移動経路を積極的に確保して目的地まで移動することができるので、作業効率の低下を抑制することができる。

以上、本発明の実施形態について説明したが、上記実施形態は本発明の適用例の一部を示したに過ぎず、本発明の技術的範囲を上記実施形態の具体的構成に限定する趣旨ではない。

例えば、報知手段５は、必ずしもスピーカである必要はなく、ランプ、レーザ、ディスプレイ等、光を用いて人の視覚に訴えるものであってもよい。また、障害物対応部１４は、障害物対応処理において、このように構成された報知手段５を用いて所定の報知を行う場合でも、働きかけの強さを所定の時間毎に変更してもよい。例えば、報知手段５としてディスプレイを用いて所定の報知が行われる場合でも、障害物対応部１４は、上述のスピーカを用いた所定の報知と同様に、当該ディスプレイに表示される内容に係る働きかけの強さが所定時間毎により強くなるように変更してもよい。

また、図２で示す移動ロボット１００の構成は、少なくとも頭部３０を備え、移動経路に沿って移動可能に構成される限り適宜変更されてよい。例えば、移動ロボット１００は、ロボット本体部１０を備えなくてもよい。この場合、頭部３０は、移動台車２０に直接設けられるように構成されてよい。

本発明は、少なくともロボット制御装置等を製造する産業において利用可能である。

１ コントローラ
３ 頭部駆動手段（駆動手段）
５ スピーカ
１１ 移動経路設定部
１２ 移動制御部
１３ 障害物検出部
１４ 障害物対応部
２１ 人検出部（検出部）
２２ 衝突予測部（衝突判定部）
３０ 頭部
４０ 腕部
１００ 移動ロボット
３００ 障害物

Claims (19)

1. 移動ロボットを制御するロボット制御装置であって、
   現在地から目的地までの移動経路を生成する移動経路生成部と、
   生成された前記移動経路に沿って前記移動ロボットを移動させる移動制御部と、
   所定距離内における前記移動経路上の障害物を検出する障害物検出部と、
   前記障害物を前記移動経路から除くための所定の対応を実行する障害物対応部と、を備え、
   前記障害物検出部は、前記障害物が人か否かを検出し、
   前記障害物対応部は、前記障害物が人か否かに応じて選択した一又は複数の前記所定の対応を実行する、ロボット制御装置。
2. 前記移動ロボットは、
   正面を顔部とする頭部と、
   前記頭部を駆動する駆動手段と、をさらに備え、
   検出した前記障害物が人である場合は、
   前記障害物検出部は、前記人の頭の位置を検出し、
   前記障害物対応部は、前記所定の対応として、前記駆動手段を制御して前記顔部を前記人の頭に向ける、請求項１に記載のロボット制御装置。
3. 検出した前記障害物が人であって、かつ当該人が複数いる場合に前記移動ロボットに最も近い人を特定する特定部をさらに備え、
   前記障害物対応部は、前記所定の対応として前記顔部を前記人の頭に向ける場合は、前記顔部を前記特定部が特定した前記人の頭に向ける、請求項２に記載のロボット制御装置。
4. 前記移動ロボットは、
   正面を顔部とする頭部と、
   前記頭部を駆動する駆動手段と、をさらに備え、
   検出した前記障害物が人ではない場合は、
   前記障害物検出部は、前記移動ロボットの周辺にいる人の頭の位置を検出し、
   前記障害物対応部は、前記所定の対応として、前記駆動手段を制御して前記顔部を周辺にいる前記人の頭に向ける、請求項１から３のいずれか一項に記載のロボット制御装置。
5. 前記所定の対応として、所定の報知を行うための報知手段をさらに備える、請求項１から４のいずれか一項に記載のロボット制御装置。
6. 前記移動ロボットは前記報知手段としてスピーカを備え、
   前記障害物対応部は、前記所定の対応として、前記障害物が人か否かに応じて選択される所定の音を前記スピーカを用いて出力する、請求項５に記載のロボット制御装置。
7. 前記所定の音は、働きかけの強さが異なる複数種類の音声を含み、
   前記障害物対応部は、前記所定の音の種類を所定の時間毎に働きかけの度合いが強くなるように変更する、請求項６に記載のロボット制御装置。
8. 前記障害物対応部は、前記所定の音の音量を所定の時間毎に大きくする、請求項６又は７に記載のロボット制御装置。
9. 前記障害物対応部が出力する前記所定の音の種類、音量、出力回数、および出力継続時間の少なくとも一つ以上は、予め設定可能に構成される、請求項６から８のいずれか一項に記載のロボット制御装置。
10. 前記スピーカは、前記所定の音が前記頭部から出力されるように配置される、請求項６から９のいずれか一項に記載のロボット制御装置。
11. 前記障害物対応部は、前記報知手段による働きかけの強さを所定の時間毎に変更する、請求項５から１０に記載のロボット制御装置。
12. 前記移動経路生成部は、前記障害物が検出された場合に、現在地から当該障害物を回避して前記目的地に到達する移動経路を生成し、
    前記障害物対応部は、現在地から前記障害物を回避して前記目的地に到達する移動経路が生成できなかった場合に、前記所定の対応を実行する、請求項１から１１のいずれか一項に記載のロボット制御装置。
13. 前記移動経路生成部は、前記障害物が検出された場合であって、かつ前記障害物対応部が前記所定の対応を実行してから所定時間経過しても前記障害物が前記移動経路から除かれない場合に、現在地から当該障害物を回避して前記目的地に到達する移動経路を生成する、請求項１から１１のいずれか一項に記載のロボット制御装置。
14. 前記移動制御部は、移動中に前記障害物が検出された場合は、前記移動ロボットを減速又は停止させる、請求項１から１３のいずれか一項に記載のロボット制御装置。
15. 前記障害物対応部は、前記障害物が検出された場合に前記移動ロボットが停止した場合には、前記所定の対応として、前記移動ロボットの停止状態を維持する、請求項１４に記載のロボット制御装置。
16. 前記移動ロボットはマニピュレータ機構を有する一又は複数の腕部をさらに備える、請求項１から１５のいずれか一項に記載のロボット制御装置。
17. 前記障害物対応部は、検出した前記障害物が人ではない場合に、前記所定の対応として前記腕部を用いて前記障害物を指し示す、請求項１６に記載のロボット制御装置。
18. 移動ロボットを制御するロボット制御方法であって、
    現在地から目的地までの移動経路を生成する移動経路生成ステップと、
    生成された前記移動経路に沿って前記移動ロボットを移動させる移動制御ステップと、
    前記移動経路上の障害物を検出する障害物検出ステップと、
    前記障害物を前記移動経路から除くための所定の対応を実行する障害物対応ステップと、を含み、
    前記障害物検出ステップでは、前記障害物が人か否かを検出し、
    前記障害物対応ステップでは、前記障害物が人か否かに応じて選択した一又は複数の前記所定の対応を実行する、
    ロボット制御方法。
19. 移動ロボットを制御するロボット制御プログラムであって、
    現在地から目的地までの移動経路を生成する移動経路生成ステップと、
    生成された前記移動経路に沿って前記移動ロボットを移動させる移動制御ステップと、
    前記移動経路上の障害物を検出する障害物検出ステップと、
    前記障害物を前記移動経路から除くための所定の対応を実行する障害物対応ステップと、を含み、
    前記障害物検出ステップでは、前記障害物が人か否かを検出し、
    前記障害物対応ステップでは、前記障害物が人か否かに応じて選択した一又は複数の前記所定の対応を実行する、
    ロボット制御プログラム。

Images