移動体、及びその制御方法
【課題】音源に対して確実に近づくことができる移動体、及びその制御方法を提供すること。
【解決手段】
本発明の一態様にかかる移動体は、目標停止位置まで自律移動する移動体１００であって、移動体１００の外部で発生した音の前記移動体に向かう方向を特定するマイクロフォンアレイ１２１と、移動体１００が移動する領域に応じて記憶されている地図データにおいて、音源の候補となる音源候補対象の位置を記憶する音源候補対象記憶部５２と、音源の方向と、音源候補対象の位置とに基づいて、音源の位置を推定する音源位置推定手段１２と、推定された音源の位置から目標停止位置を決定する停止位置決定手段１３と、移動体の現在位置から目標停止位置まで移動体１００を移動させる駆動制御部１６と、を備えるものである。
【解決手段】
本発明の一態様にかかる移動体は、目標停止位置まで自律移動する移動体１００であって、移動体１００の外部で発生した音の前記移動体に向かう方向を特定するマイクロフォンアレイ１２１と、移動体１００が移動する領域に応じて記憶されている地図データにおいて、音源の候補となる音源候補対象の位置を記憶する音源候補対象記憶部５２と、音源の方向と、音源候補対象の位置とに基づいて、音源の位置を推定する音源位置推定手段１２と、推定された音源の位置から目標停止位置を決定する停止位置決定手段１３と、移動体の現在位置から目標停止位置まで移動体１００を移動させる駆動制御部１６と、を備えるものである。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、移動体、及びその制御方法に関し、特に詳しくは自律移動する移動体、及びその制御方法に関する、
【背景技術】
【０００２】
近年、人間が発する音声に応じて動作するロボットが開発されている。例えば、人間が発した音声を受音して、その人間に向かって移動するロボットが開発されている（特許文献１、特許文献２）。
【０００３】
特許文献１のロボットでは、マイクロフォンアレイによって、音源（発話した人間）の方向を推定している。さらに、超音波センサやＣＣＤカメラによって音源までの距離を推定している。そして、音源方向に移動することによって、Ｓ／Ｎ比を向上している。
【０００４】
特許文献２のロボットでは、マイクロフォンアレイによって、人間が発した音声を受音するとともに、過去の音源の方向の履歴から、音源方向を推定している。そして、推定された音源方向に移動している。
【０００５】
【特許文献１】特開２００６−１８１６５１号公報
【特許文献１】特開２００４−１３０４２７号公報
【発明の開示】
【発明が解決しようとする課題】
【０００６】
しかしながら、上記のロボットでは、音源位置に直線的に移動することしかできなかった。従って、音源とロボットの間に障害物がある場合、回避することができないという問題点がある。また、障害物を回避したとしても、音源に直線的に移動するよう制御されているため、もとの経路に復帰するのが困難である。また、特許文献１では、超音波センサなどを用いて音源までの距離を推定しているが、音源までの位置が遠い場合、音源距離を正確に推定することが困難である。さらに、音源とロボットの間に障害物がある場合、音源位置を特定できないという問題点がある。このように、従来の制御では、音源に対して確実に近づけることができないという問題点があった。
【０００７】
本発明は、このような問題を解決するためになされたものであり、音源に対して確実に近づくことができる移動体、及びその制御方法を提供することを目的とする。
【課題を解決するための手段】
【０００８】
本発明の第１の態様にかかる移動体は、目標停止位置まで自律移動する移動体であって、前記移動体の外部で発生した音を受音するマイクを有し、前記マイクが受音した音の前記移動体に向かう方向を前記受音方向として特定する音源方向特定手段と、前記移動体が移動する領域に応じて記憶されている地図データにおいて、音源の候補となる対象の位置を音源候補対象位置として記憶する音源候補対象記憶手段と、前記音源方向特定手段によって特定された音源の方向と、前記音源候補対象記憶手段に記憶された音源候補対象の位置とに基づいて、音源の位置を推定する音源位置推定手段と、前記音源位置推定手段によって推定された音源の位置から目標停止位置を決定する停止位置決定手段と、前記移動体の現在位置から前記停止位置決定手段で決定された目標停止位置まで前記移動体を移動させる移動手段と、を備えるものである。これによって、音源とロボットの間に障害物がある場合でも、音源に対して近づくことができる。さらに、音源候補対象の位置から目標停止位置が決定されているため、音源の推定を確実に行なうことができる。よって、音源に対して確実に近づくことができる。
【０００９】
本発明の第２の態様にかかる移動体は、上記の移動体であって、前記音源位置推定手段が、前記音源候補対象記憶部に記憶された複数の音源候補対象のうち、前記音源方向に対して所定の角度だけ広がった領域に含まれる音源候補対象の位置に基づいて、音源の位置を推定するものである。これにより、音源の位置を正確に推定することができるので、音源に対して確実に近づくことができる。
【００１０】
本発明の第３の態様にかかる移動体は、上記の移動体であって、前記目標停止位置が前記音源候補対象記憶部に記憶された複数の音源候補対象に対応して予め設定されていることを特徴とするものである。これにより、速やかに移動することが可能となる。
【００１１】
本発明の第４の態様にかかる移動体は、上記の移動体であって、前記音源位置推定手段によって推定された音源の位置と前記移動体の位置とに基づいて、前記停止位置決定手段が目標停止位置を算出することを特徴とするものである。これにより、状況が変わった場合でも、音源に対して確実に近づくことができる。
【００１２】
本発明の第５の態様にかかる移動体は、上記の移動体であって、前記目標停止位置に移動した後、前記推定された音源に対して、真の音源であるか否か確認する音源確認情報を取得する音源確認手段をさらに備え、前記推定された音源が真の音源でないと確認された場合、前記音源位置推定手段が前記音源候補対象記憶部に記憶された他の音源候補対象の位置に基づいて音源の位置を推定するものである。これにより、多数の音源候補対象が存在する場合でも、真の音源に対して確実に近づくことができる。
【００１３】
本発明の第６の態様にかかる移動体は、上記の移動体であって、前記地図データ上において音が発生した位置の履歴に基づいて、一定時間以上、音が発生していない位置の音源候補対象を前記音源候補対象記憶手段から消去することを特徴とするものである。これにより、音源候補対象の数が過剰に増えるのを防ぐことができる。従って、速やかに音源に近づくことができる。
【００１４】
本発明の第７の態様にかかる移動体の制御方法は、目標停止位置まで自律移動する移動体の制御方法であって、前記移動体の外部で発生した音をマイクによって受音して、前記マイクが受音した音の前記移動体に向かう方向を前記受音方向として特定するステップと、前記特定された受音方向と、前記移動体が移動する領域の地図データに対して予め登録されている音源候補対象の位置とに基づいて、音源の位置を推定するステップと、前記推定された音源の位置から目標停止位置を決定するステップと、前記移動体の現在位置から前記目標停止位置まで前記移動体を移動するステップと、を備えるものである。これによって、音源とロボットの間に障害物がある場合でも、音源に対して近づくことができる。さらに、音源候補対象の位置から目標停止位置が決定されているため、音源の推定を確実に行なうことができる。よって、音源に対して確実に近づくことができる。
【００１５】
本発明の第８の態様にかかる移動体の制御方法は、上記の制御方法であって、前記音源の位置を推定するステップでは、登録されている複数の前記音源候補対象のうち、前記音源方向に対して所定の角度だけ広がった領域に含まれる音源候補対象の位置に基づいて、音源の位置を推定するものである。これにより、音源の位置を正確に推定することができるので、音源に対して確実に近づくことができる。
【００１６】
本発明の第９の態様にかかる移動体の制御方法は、上記の制御方法であって、前記目標停止位置が登録されている複数の前記音源候補対象に対応して予め設定されていることを特徴とするものである。これにより、速やかに移動することが可能となる。
【００１７】
本発明の第１０の態様にかかる移動体の制御方法は、上記の制御方法であって、前記推定された音源の位置と前記移動体の位置とに基づいて、前記目標停止位置が算出されることを特徴とするものである。これにより、状況が変わった場合でも、音源に対して確実に近づくことができる。
【００１８】
本発明の第１１の態様にかかる移動体の制御方法は、上記の制御方法であって、前記目標停止位置に移動した後、前記推定された音源に対して、音源であるか否か確認する音源確認情報を取得するステップと、前記音源確認情報により、前記推定された音源が真の音源でないと確認された場合、登録されている他の音源候補対象の位置に基づいて音源の位置を推定するものである。これにより、多数の音源候補対象が存在する場合でも、真の音源に対して確実に近づくことができる。
【００１９】
本発明の第１２の態様にかかる移動体の制御方法は、上記の制御方法であって、前記地図データ上において音が発生した位置の履歴に基づいて、一定時間以上、音が発生していない位置の音源候補対象を消去することを特徴とするものである。これにより、音源候補対象の数が過剰に増えるのを防ぐことができる。従って、速やかに音源に近づくことができる。
【発明の効果】
【００２０】
本発明によれば、音源に対して確実に近づくことができる移動体、及びその制御方法を提供することが可能になる。
【発明を実施するための最良の形態】
【００２１】
本実施の形態にかかる移動体について図１を用いて説明する。図１は移動体１００の構成を模式的に示す外観図である。本実施の形態では、移動体１００が、ユーザが発した音声に基づいて自律移動する移動ロボットとして説明する。移動体１００は、車輪２と、筐体３と、を備えている。そして、筐体３の内部には、車輪２と接続されたモータが設けられている。このモータが移動体１００を移動させるための駆動機構となる。モータを駆動することによって、車輪２が回転して、移動体１００が移動する。さらに、移動体１００は、マイクロフォンアレイ１２１を備えている。マイクロフォンアレイ１２１は、移動体１００の外部で発生した音を受音して、音源の方向を推定する。例えば、人間が発話した場合、音源となる発話した人間の方向を推定する。そして、移動体１００は、車輪２を駆動して、音源の方向に近づくよう移動する。このように、移動体１００は、人間に呼ばれたときに、その人間の近くまで移動するタスクを実行する。
【００２２】
次に、移動体１００の制御系について図２を用いて説明する。移動体１００は、制御部１０１、入出力部１０２、駆動部１０３、電源部１０４、及び外部記憶部１０５などを有している。これらは、例えば、筐体３の内部に設けられている。また、スピーカ１２３、マイクロフォンアレイ１２１、センサ部１２５、ＬＥＤ１２４などは筐体３の外側に設けられている。
【００２３】
入出力部１０２は、周囲の音を受音するためのマイクロフォンアレイ１２１を備えている。マイクロフォンアレイ１２１は、アレイ状に配置された複数のマイクを有している。そして、各マイクロフォンからの出力の時間遅延によって、音の入射方向を測定する。あるいは、指向性を有するマイクロフォンを複数用いて、音の入射方向を測定してもよい。これにより、マイクロフォンアレイ１２１が配置されている方向から、音源方向までの角度が求められる。すなわち、マイクロフォンアレイ１２１が移動体１００から音源までの受音方向を特定する。よって、移動体１００が移動する平面上において、移動体１００周りの３６０°の中から特定の方向が受音方向として推定される。マイクロフォンアレイ１２１は、移動体１００から見て、音源の位置する方向を受音方向と判断する。すなわち、マイクロフォンアレイ１２１が受音した音の移動体１００に向かう方向を受音方向として特定する。ここで、受音方向は、移動体が移動する平面（例えば、水平面）における方向（方位）であってもよく、鉛直方向に対する傾斜度合いを含めた３次元における方向としてもよい。
【００２４】
さらに、入出力部１０２は、音声を出力してユーザと対話等を行なうためのスピーカ１２３、ユーザへの応答や感情等を表現するためのＬＥＤ１２４、タッチセンサなどからなるセンサ部１２５などを備える。また、センサ部１２５は、レーザレンジファインダやＣＣＤカメラなどの各種センサを有している。
【００２５】
駆動部１０３は、モータ１３１及びモータ１３１を駆動するドライバ１３２などを有し、制御部１０１からの制御信号に従って車輪２を回転させる。これにより、移動体１００が所定の位置まで移動する。さらに、モータ１３１、及びドライバ１３２は、２つの車輪２にそれぞれ設けられている。これにより、２つの車輪２を独立して駆動することができる。例えば、ドライバ１３２は、モータ１３１の回転数を制御する。これにより、車輪２を所定の回転数で駆動することができる。よって、移動体１００の目標位置までの移動が可能となる。モータ１３１は移動体１００の内部に取り付けられている。
【００２６】
例えば、駆動部１０３が左右の車輪２を回転させることによって、移動体１００が移動する。２つの車輪２は、それぞれ異なるモータ１３１に接続されている。したがって、車輪２を異なる回転方向、回転速度で回転させることにより、移動体１００の移動方向、移動速度を制御することができる。具体的には、車輪２を同じ方向、異なる速度で回転させることにより、移動体１００の移動方向が変化しながら、移動する。すなわち、２つの車輪２の距離、及び回転速度の差に応じて、移動体１００がカーブしながら移動する。また、車輪２を反対方向に同じ速度で回転させることによって、移動体１００がその場で旋回する。さらに、車輪２を同じ方向、同じ速度で回転させることにより、移動体１００が直進移動する。電源部１０４は、バッテリ１４１及びその放充電を制御するバッテリ制御部１４２を有し、各部に電源を供給する。
【００２７】
外部記憶部１０５は、着脱可能なＨＤＤ、光ディスク、光磁気ディスク等からなり、各種プログラムや制御パラメータなどを記憶し、そのプログラムやデータを必要に応じて制御部１０１内のメモリ（不図示）等に供給する。外部記憶部１０５には、地図データ記憶部５１と、音源候補対象記憶部５２とが設けられている。地図データ記憶部５１は、移動体１００が移動する領域の地図データを記憶する。例えば、地図データとして、移動体１００が移動する領域内の物の配置に応じて移動体１００が移動できる領域と、移動できない領域とがそれぞれ記憶されている。例えば、移動体１００が通常の家庭内の部屋に配置されている場合、地図データとして、ベッド、ソファー、椅子、テーブル、タンス、本棚などの家具の位置が記憶されている。これらの家具の位置は、例えば、移動体１００が移動する平面における２次元座標として記憶される。そして、家具が存在する位置、及びその周辺が、移動できない領域として記憶される。すなわち、これらの家具は、移動体１００の障害物となる。このため、例えば、家具から移動体１００の大きさに合わせた距離だけ離れた位置が、移動体１００が移動できる領域と、移動できない領域との境界となる。この地図データは、後述する経路探索にも用いられる。
【００２８】
さらに、地図データを随時更新してもよい。例えば、センサ部１２５に設けられたレーザレンジファインダや、超音波センサによって、障害物までの距離を測定する。例えば、レーザレンジファインダからは、複数のレーザー光が所定の角度ピッチで出射される。そして、レーザレンジファインダはレーザ光が障害物や壁面で反射された反射光を検出する。反射光が検出される時間に応じて、障害物までの距離を測定する。そして、この障害物までの距離に基づいて、地図データ上の移動できない領域と移動できる領域とを判別する。これにより、部屋内の状況が変化した場合でも移動体１００が障害物に衝突するのを防ぐことができる。
【００２９】
音源候補対象記憶部５２では、地図データ上の音源の候補の対象となる音源候補対象の位置を記憶している。これらの音源候補対象の位置は、音源地図によって記憶されている。例えば、地図データに対して複数の音源候補対象の位置を予め登録することによって、音源地図が生成される。音源候補対象の位置では、頻繁に音が発生する。従って、例えば、地図データ上で、人間が頻繁に存在する位置を音源候補対象の位置として登録することができる。具体的には、ベッド、ソファー、椅子、ドア前後、台所前、玄関、電話付近、電気等のスイッチ付近、テーブル、本棚、タンス、押入れ、洗濯機、冷蔵庫等の位置が音源候補対象の位置として記憶される。音源地図は、地図データ記憶部５１に記憶されている地図データ上に対応付けられている。従って、地図データ上の複数の点に音源候補対象が存在することになる。音源候補対象の位置は、地図データ上の２次元座標として記憶される。従って、音源候補対象の位置は座標リストとして記憶される。あるいは、後述するグリッドマップとして、音源候補対象の位置を記憶してもよい。例えば、グリッドマップの各グリッドが音源候補対象の位置であるか否かを登録しておく。これらの音源候補対象位置は、操作者によって予め登録されている。登録する位置としては、上述のように統計的に人間が存在する可能性が高い点を選ぶことができる。このように、音源地図には、音源となる可能性の高い点が音源候補対象位置として登録されている。
【００３０】
制御部１０１は、ＣＰＵ（Central Processing Unit）、ＲＯＭ（Read Only Memory）、ＲＡＭ（Random Access Memory）、通信用のインターフェースなどを有し、移動体１００の各種動作を制御する。そして、この制御部１０１は、例えばＲＯＭに格納された制御プログラムに従って各種の制御を実行する音源位置推定部１２、停止位置決定部１３、経路探索部１４、自己位置推定部１５、駆動制御部１６、及び音源確認部１７を備えている。音源位置推定部１２は、音源候補対象記憶部５２に記憶された音源候補対象の位置から音源の位置を推定する。例えば、音源候補対象記憶部５２に記憶された複数の音源候補対象の位置から１つの音源候補対象を選択して、この音源候補対象を音源と推定する。そして、選択された音源候補対象の位置を音源位置と推定する。ここで、音源位置推定部１２で推定された音源の位置を推定音源位置とする。なお、音源位置推定部１２は、マイクロフォンアレイ１２１で特定された受音方向に近い音源候補対象を音源と推定する。音源位置推定部１２による音源位置の推定については後述する。
【００３１】
停止位置決定部１３は、音源位置推定部１２によって推定された推定音源位置に応じて目標停止位置を決定する。自己位置推定部１５は、地図データ上における移動体１００の現在の自己位置を推定する。経路探索部１４は、自己位置推定部１５で推定された移動体１００の自己位置から、停止位置決定部１３で決定された目標停止位置までの目標経路探索を行なう。例えば、移動体１００の目標軌道となる目標経路は、しばしば座標の集合として与えられる。座標は、例えば、グリッド状に離散化されたグリッド座標で表現される。グリッド座標を利用するメリットは、最短経路探索を容易に実行できる点や、確実に目的地に到達できる経路を得ることができる点にある。しかしながら、グリッド座標において表現される目標経路は直線と直線が接続された不連続な経路であるため、移動体１００がこのような経路を追従することは難しい。そのため、与えられた離散的な経路座標から、移動体１００の追従制御に利用可能な滑らかな目標経路を、例えば、重み付き移動平均を利用して補間曲線を求めることにより作成することができる。このように、与えられた地図データに対してグリッドマップを作成することによって、容易に目標経路を探索することができる。もちろん、経路探索部１４は、移動体１００が家具等に衝突しないように、移動できない領域を避けて経路探索を行なう。
【００３２】
例えば、グリッドマップをＡ*探索（エースター探索）で探索した目標経路を用いることができる。さらに、グリッドを結んだ線分集合を滑らかにする演算を行なっている。もちろん、上記以外の方法によって目標経路を計画してもよい。例えば、最良優先探索や山登り探索などの探索技法を用いることも可能である。駆動制御部１６は、移動体１００が経路探索部１４で探索された目標経路に追従して移動するよう、制御信号を駆動部１０３に対して出力する。
【００３３】
音源確認部１７は、推定された音源が音源として正しいか否かを確認する。すなわち、推定音源位置が真の音源の位置であるかを確認する。真の音源であるかを確認することで、多数の音源候補対象がある場合でも、確実に音源に対して近づけることができる。具体的には、音源位置確認部１７は、移動体１００が上記の目標停止位置まで移動した後、推定音源位置が真の音源の位置であるかを確認するための音源確認情報を取得する。音源確認情報としては、カメラによって取得された画像情報や、マイクによって取得された音声情報が挙げられる。そして、音源候補対象に対して取得された音源確認情報が真の音源の場合の音源確認情報とどの程度一致するかによって、真の音源か否かを判定する。すなわち、音源確認情報に基づいて、音源位置推定部１２で選択された音源候補対象が真の音源であるか否かを確認する。
推定音源位置に音源が存在しない場合、音源位置推定部１２は他の音源候補対象を選択して、他の音源候補対象の位置を新たな推定音源位置とする。停止位置決定部１３は、新たな推定音源位置に対する目標停止位置を決定する。そして、経路探索部１４は、現在の自己位置から、２つ目に推定された新たな推定音源位置に対応する目標停止位置までの経路を探索する。ここでの自己位置は、１つ目に推定された推定音源位置に対する目標停止位置である。そして、駆動制御部１６が自己位置から２つ目の目標停止位置まで移動するよう制御する。移動体１００は、上記の制御を繰り返して、真の音源に対応する目標停止位置までの移動を行う。これらの制御は、所定の制御プログラムやハードウェアに基づいて実行される。
【００３４】
上記の制御について、図３、及び図４を参照して説明する。図３は、本実施の形態に係る移動体１００の制御方法を示すフローチャートである。図４は移動体１００が移動する領域に対応するマップ２００を平面的に示す図である。すなわち、図４では、移動する領域のマップ２００が、移動できる領域２０１と、移動できない領域２０２とに分けられて、平面的に示されている。移動できない領域２０２は、上記のように家具などに対応している。ここで、ベッド２０３上に存在する人間２０４が音源であるとして説明する。また、音源候補対象記憶部５２には、ベッド２０３上の点が音源候補対象２０５として登録されている。
【００３５】
まず、マイクロフォンアレイ１２１を稼働状態とする（ステップＳ１）。マイクロフォンアレイ１２１が発話を検出する（ステップＳ２）。ここでは、マイクロフォンアレイ１２１からの出力に基づいて、音声認識を行う。そして、移動体１００が呼ばれていると認識された場合のみ、移動体１００が次のステップに進む。移動体１００が呼ばれていると認識できない場合は、ステップＳ１に戻る。
【００３６】
ステップＳ２で移動体１００が呼ばれていると認識された場合、マイクロフォンアレイ１２１で受音方向を特定する（ステップＳ３）。すなわち、人間２０４の移動体１００への呼びかけに対して、マイクロフォンアレイ１２１が音声の入射方向を測定する。そして、移動体１００から音源までの受音方向２１０を特定する。また、受音方向を特定する処理と並行して、自己位置推定を行なう（ステップＳ４）すなわち、制御部１０１の自己位置推定部１５は、マイクロフォンアレイ１２１による受音方向の特定と並行して、現在の自己位置を推定している。例えば、センサ部１２５に設けられたセンサからの出力に基づいて、現在の自己の位置が推定される。さらに、自己位置推定では、マップ上において、移動体１００が向いている方向を自己角度として推定する。この自己位置推定については、ＣＣＤカメラやレーザレンジファインダなどを用いて実行することができる。また、部屋内にランドマークを設定して、自己位置推定を行なってもよい。例えば、ＣＣＤカメラの出力に基づいて画像認識を行なうことで、自己位置を推定することができる。このようにマルチタスクで自己位置推定と受音方向特定とを行なうことによって、処理時間を短縮することができる。
【００３７】
そして、受音方向２１０をグローバル座標系の角度で表現する。具体的には、移動体１００からの受音方向２１０の角度を受音方向角度とし、移動体１００自体の角度を自己位置角度とし、グローバル座標系での音源の角度を受音方向絶対角度とすると、受音方向角度＋自己位置角度＝受音方向絶対角度となる。この受音方向絶対角度は受音方向２１０に対応する値となる。
【００３８】
次に、マイクロフォンアレイ１１２で特定された受音方向２１０と自己位置推定部１５で推定された自己位置と音源地図とに基づいて、音源を推定する。ここでは、図４に示すように、受音方向２１０から受音方向特定の角度誤差分を含む領域２０７に存在する音源候補対象２０５を選択して、その音源候補対象２０５を音源と推定する。すなわち、マイクロフォンアレイ１１２における受音方向特定の角度誤差を受音方向誤差とすると、受音方向２１０から受音方向誤差だけ広がった範囲が、音源が存在する領域２０７となる。従って、受音方向誤差だけ横幅を持った扇形の領域２０７の中から音源候補対象２０５を選択することができる。そして、音源位置推定部１２は、領域２０７の中に存在する音源候補対象２０５を探して、その音源候補対象２０５を音源として推定する。すなわち、音源位置推定部１２は、音源地図に登録されている複数の音源候補対象の中から、領域２０７に存在する音源候補対象２０５を選択する。なお、領域２０７に２以上の音源候補対象がある場合、自己位置に近い音源候補対象を優先して選択する。このように、音源位置推定部１２は、受音方向２１０を基準として受音方向から受音方向誤差だけ広くした領域２０７の中に存在する音源候補対象２０５を選択する。受音方向２１０に対して所定の角度だけ広がった領域２０７から音源候補対象２０５を抽出することによって、確実に音源候補対象を選択することが可能となる。なお、領域２０７は、移動体１００が移動する平面において、受音方向２１０から所定の角度だけ広がる範囲として求めることができる。そして、選択された１つの音源候補対象２０５を音源として推定し、その音源候補対象の位置を推定音源位置とする。この音源候補対象２０５は、後述するステップＳ９で推定された音源が真の音源であることが確認されるまで、仮の音源として認識されている。
【００３９】
推定音源位置が推定されたら、その推定音源位置に対応する目標停止位置２０６を決定する（ステップＳ６）。すなわち、推定音源位置には、通常、人間２０４が存在するため、推定音源位置から所定の距離だけ離れた位置を目標停止位置２０６とする。この目標停止位置２０６は、音源候補対象位置毎に予め設定しておいてもよい。これにより、速やかに目標停止位置２０６を決定することができる。あるいは、推定された推定音源位置の位置に基づいて算出してもよい。これにより、状況が変化している場合でも、適切な目標停止位置を求めることができる。例えば、地図データが変化している場合や、移動体１００の初期位置が異なる場合に好適である。
【００４０】
次に、現在の自己位置と目標停止位置２０６とを使って、経路探索を行なう（ステップＳ７）。すなわち、経路探索部１４が現在の自己位置から目標停止位置２０６までの経路を生成する。経路探索は、例えば、Ａ*探索（エースター探索）により実行することができる。そして、移動体１００は、経路探索で生成された経路に追従しながら、目標停止位置までの移動を行なう（ステップＳ８）。ここでは、自己位置推定部１５において、常時、自己位置推定を行なっておく。すなわち、自己位置を随時更新する。そして、更新された自己位置と目標経路からのずれに対して負のフィードバックを与えるように、経路追従させる。これにより、精度よく、経路に追従して移動させることが可能となる。ここでは、駆動制御部１６が駆動部１０３のドライバ１３２に対して制御信号を出力する。これにより、モータ１３１が所定の回転速度で回転するため、経路追従させることができる。
【００４１】
そして、目標停止位置２０６までの移動が完了したら、推定された音源が正しいか確認する（ステップＳ９）。すなわち、推定音源位置、あるいはその近傍に真の音源が存在するか否かを確認する音源確認情報を取得し、その音源確認情報によって真の音源か否かを確認する。音源確認情報としては、例えば、カメラによって取得された画像情報や、マイクロフォンを用いて音声認識された音声情報が挙げられる。そして、真の音源の場合の画像情報や音声情報と、音源確認情報がどの程度一致するか判断する。そして、音源確認情報の一致度によって真の音源か否かを確認する。
例えば、推定音源位置に向かって、移動体１００が呼ばれたかどうかを確認する。具体的には、目標停止位置で停止した移動体１００が、ＣＣＤカメラを推定音源位置に向けて、自己位置周辺の画像を取得する。ＣＣＤカメラの画像処理によって顔認識を行い、推定音源位置やその近傍の人間２０４の顔を認識する。そして、人間２０４の顔が認識できたら、スピーカ１２３から「呼びましたか？」と人間２０４に対して問い掛ける。問い掛けられた人間２０４が問い掛けに対して、「うん、呼んだよ」と返答したら、移動体１００は、この返答をマイクロフォンアレイ１２１や他のマイクロフォンで受音する。そして、移動体１００は、人間２０４からの返答を音声認識する。この音声認識結果に基づいて、移動体１００は、推定音源位置周辺に存在する人間２０４からの呼びかけがあったと判定する。これにより、推定された音源が正しいことが確認できる。このようにすることによって、音源位置推定部１２によって推定された仮の音源が真の音源であるか否か確認することができる。このように、音声認識を行い、音声認識結果を音源確認情報とすることができる。なお、音源の確認は、顔認識などによって行われてもよい。すなわち、物体認識や顔認識等の画像認識を行い、画像認識結果を音源確認情報とすることができる。そして、音声確認情報が真の音源の場合の音声確認情報とどの程度一致するかによって真の音源であることを確認する。そして、推定された音源が正しい音源である場合、移動タスクを終了する（ステップＳ１０）。
【００４２】
また、人間２０４が正しい音源でない場合、あるいは、推定音源位置周辺に顔が認識できない場合、再度ステップＳ５からステップＳ９までの処理を繰り返す。すなわち、人間２０４からの返答を音声認識することによって、人間２０４が移動体１００を呼んでいないことが確認された場合、次の音源候補対象２０５を探す。例えば、移動体１００からの問い掛けに対して、人間２０４が「呼んでないよ」と返答した場合、音声認識結果に基づいて、推定された音源が真の音源でないと認識する。そして、移動体１００は、次の音源候補対象を探す。例えば、領域２０７に複数の音源候補対象が存在していたら、次の音源候補対象を選択する。この場合、移動体１００の自己位置から近い順に音源候補対象を選択することができる。そして、次に選択された音源候補対象を音源として推定する。１つ目の目標停止位置から、２つ目の目標停止位置まで移動する。真の音源を確認することができるまで、ステップＳ５からステップＳ９までの処理を繰り返していく。
【００４３】
このようにすることによって、確実に移動体１００を音源に近づけることができる。すなわと、音源と移動体１００との障害物がある場合でも、移動体１００が障害物に衝突するのを防ぐことができる。さらに、予め家具などの障害物を考慮して経路探索しているため、障害物を容易に回避することができる。また、超音波センサを用いた場合と比べて、遠い位置に存在する音源に対する移動が可能になる。よって、確実に音源の近くまで移動体１００を移動させることができる。さらに、目標停止位置に移動した後、推定音源位置に対して真の音源が存在するか否かを確認しているため、音源を誤認識することがない。さらに、音源候補対象から一定距離離れた点を目標停止位置としているため、音源となる人間に対して衝突するのを防ぐことができる。よって、音源に対して適した位置に移動することが可能となる。
【００４４】
なお、複数の音源候補対象に対応して、一つの目標停止位置が登録されていてもよい。例えば、図４に示すように３つの音源候補対象２０８ａ〜２０８ｃが、共通の目標停止位置２０９に対応していてもよい。このように、複数の音源候補対象位置に対して共通の目標停止位置を登録しておいてもよい。これにより、登録する目標停止位置の数を少なくすることができる。よって、目標停止位置から移動せずに、複数の推定音源位置に対する音源の確認を行なうことができる。
【００４５】
次に、推定音源位置を求める別の方法について、図５を用いて説明する。図５は、移動体１００の自己位置に対する受音方向２１０を模式的に示す図である。ここでは、移動体１００の自己位置に対して近い順に音源候補対象を選択するための一例について説明する。
【００４６】
まず、音源候補対象の位置を座標として登録しておく。なお、音源候補対象の位置をグリッドの中の特定の座標としてもよい。ここで、音源候補対象を探す範囲をｒ〜ｒ＋ｄｒとする。ｒは移動体１００からの距離である。ｄｒは予め設定しておく。そして、音源候補対象の位置の座標リストの中から、以下の式（１）、（２）を満たす音源候補対象を検索する。
θｓ−σｓ＜ａｔａｎ２（ＹＲ−ＹＳ，ＸＲ−ＸＳ）＜θｓ＋σｓ ・・・（１）
ｒ＜ｓｑｒｔ｛（ＹＲ−ＹＳ）２＋（ＸＲ−ＸＳ）２｝＜ｒ＋ｄｒ ・・・（２）
θｓ：絶対座標系の受音方向
σｓ：受音方向の角度誤差
（ＸＲ，ＹＲ）：ロボット位置
（ＸＳ，ＹＳ）：音源候補対象位置
【００４７】
そして、上記の式（１）、及び式（２）を満足する音源候補対象があれば、その音源候補対象を選択する。なお、ｒ〜ｒ＋ｄｒの中に式（１）、及び式（２）を満足する音源候補対象が２つ以上ある場合、受音方向２１０に近い音源候補対象が選択される。すなわち、ａｔａｎ２（ＹＲ−ＹＳ，ＸＲ−ＸＳ）がθｓに近い音源候補対象を選択する。例えば、音源候補対象２０５ａと音源候補対象２０５ｂがある場合、受音方向２１０に近い音源候補対象２０５ａが選択される。式（１）、及び式（２）を満足する音源候補対象が無ければ、次に探索する範囲をｒ＋ｄｒ〜ｒ＋２ｄｒとする。そして、再度、式（１）、及び式（２）を満足する音源候補対象を探索する。上記の処理をｒ＝０から繰り返し行うことによって、移動体１００に近い音源候補対象から選択することができる。そして、最初に条件を満足した音源候補対象を、音源として推定する。すなわち、音源候補対象を探索する範囲をｄｒずつ段階的に広くしていき、音源候補対象を探索していく。このように、自己位置に近い順に音源候補対象を選択することができる。また、上記の処理では、音源候補対象を探索することによって、移動体１００からの距離が近い音源候補対象が２以上ある場合、受音方向に近い音源候補対象が優先して選択される。すなわち、ｄｒだけ広げられた探索範囲に２つ以上音源候補対象がある場合、受音方向２１０に近い音源候補対象が先に選択される。よって、音源が存在する可能性の高い音源候補対象から順番に選択していくことが可能になる。これにより、移動時間を短縮することができる。
【００４８】
なお、推定音源位置に対応する目標停止位置は、予め登録していなくてもよい。すなわち、音源位置を推定した後、その推定音源位置に応じて算出してもよい。例えば、音源位置を推定した後、その音源候補対象に対する目標停止位置を自動生成してもよい。以下に、推定音源位置に基づいて目標停止位置を算出する方法について、図６を用いて説明する。図６は、移動体１００が移動するマップ２００を模式的に示す図である。ベッド２０３上の音源候補対象２０５の位置が推定音源位置と推定された場合に説明する。目標停止位置を決定するため、音源候補対象２０５の座標を中心とし、所定の半径を有する円を描く。そして、この円の中に移動できる領域２０１が十分広いかを調べる。ここでは、その円の中に移動できる領域２０１が十分広くない場合、円の半径を少しだけ大きくする。これを繰り返し、円の中で、領域２０１が移動体１００が移動するために十分広くなったら、その位置を目標停止位置２０６とする。すなわち、円の半径を徐々に大きくしていく、移動体１００が移動できる程度に広い領域２０１が最初に円の中に現れた位置を目標停止位置２０６とする。そして、上記のように、自己位置から目標停止位置２０６までの目標経路２００を探索する。このように、推定音源位置と、現在の自己位置とに基づいて目標停止位置を算出する。これによって、状況に応じた目標停止位置２０６に移動することができる。すなわち、目標停止位置２０６の決定に、自己位置が考慮されているため、自己位置に近い目標停止位置２０６を求めることができる。これにより、移動時間を短縮することができ、利便性を向上することができる。
【００４９】
また、音源候補対象をセンサ部１２５に設けられたセンサからの出力に基づいて登録するようにしてもよい。例えば、ＣＣＤカメラなどによって物体認識を行い、人が頻繁に存在する可能性が高い物の位置を音源候補対象の位置として登録することができる。例えば、予め人が使う可能性が高い物（例えば、ベッド、ソファー、椅子、冷蔵庫等）をデータベースとして登録しておく。物体認識によって、人が使う可能性が高い物を認識したら、その位置を音源候補対象位置として登録する。物体認識は、移動体１００の移動中、或いは停止中に行なうことができる。そして、音源地図上の音源候補対象の位置を随時、更新することによって、家具等が移動した場合でも、適切に音源候補対象の位置を選択することができる。これにより、音源の推定を確実に行なうことができる。
【００５０】
あるいは、人間と会話した位置の履歴を残しておき、その履歴に基づいて音源候補対象を登録してもよい。すなわち、移動体１００が人間と会話した場所の座標、及び会話した時刻を記憶しておく。そして、単位時間あたりの会話数がしきい値以上になる位置を音源候補対象の位置として登録する。ここで、顔認識等の技術によって、人間を認識することができる。さらに、人間との会話が一定時間以上無い音源候補対象位置を音源地図から削除するようにしてもよい。このように人間と会話する頻度の高い位置を音源候補対象として登録し、会話する頻度が低くなった位置を音源候補対象から消去する。そうすることによって、音源候補対象の数を少なくすることができる。これにより、音源候補対象の数が過剰に増えるのを防ぐことができる。従って、速やかに音源に近づくことができる。このように、移動体１００が会話した位置の履歴に応じて、音源候補対象を登録、又は消去することができる。会話を行なうためには、例えば、音声認識技術によって音声を認識する。そして、認識した音声に応じて会話するための音声を選ぶ。会話するための音声をスピーカから出力することにより会話することができる。また、会話の履歴に基づいて音源候補対象を登録する場合、音源候補対象の座標だけでなく、その音源に対して会話した方向を登録するようにしてもよい。このように、地図データ上の音が発生した位置の履歴に基づいて、音が一定以上発生していない位置の音源候補対象位置を音源候補対象記憶部５２から削除する。これにより、音源候補対象が過剰になるのを防ぐことができる。よって、音源候補対象を適切な数で登録することができる。なお、音が発生した位置は、他の方法で検出するようにしてもよい。
【００５１】
また、移動体１００が目標経路に追従して移動している間に、画像認識等の技術を用いて音源を認識するようにしてもよい。例えば、ＣＣＤカメラが音源候補対象の位置を向いた状態で、目標経路に追従して移動するように制御する。すなわち、移動体１００の方向に応じて、ＣＣＤカメラの向きを変えて、ＣＣＤカメラの視野の中に音源候補対象が常時含まれるようにする。そして、移動中に、ＣＣＤカメラで顔認識を行い、音源となる人間の顔を認識する。そして、音源候補対象の位置に顔が認識された時点で、その音源候補対象の方向に直進する。これにより、移動体１００を速やかに音源候補対象に近づけることができる。通常、顔認識を行なうことができる場合、移動体１００と人間との間に障害物がない。このため、移動体１００を直進させても障害物と衝突する可能性が低くなる。従って、顔を認識した後には、目標停止位置に対して直進させることができる。
【００５２】
なお、音源は、人間に限るものではない。音源は、例えば、電話やインターホンなどの音を発生する機器や犬などの動物であってもよい。さらには、他のロボットが音源であってもよい。本実施の形態では、車輪型の移動体について説明したが、歩行型の移動体であっても適用可能である。
【図面の簡単な説明】
【００５３】
【図１】本発明の実施形態にかかる移動体の構成を示す図である。
【図２】図１に示す移動体に設けられた制御系を概念的に表したブロック図である。
【図３】本発明の実施形態にかかる移動体の制御方法を示すフローチャートである。
【図４】本発明の実施形態にかかる移動体が移動する領域のマップを模式的に示す図である。
【図５】本発明の実施形態にかかる移動体において、受音方向を特定するための方法の一例を説明するための図である。
【図６】本発明の実施形態にかかる移動体において、音源候補対象を選択するための方法の一例を説明するための図である。
【符号の説明】
【００５４】
２ 車輪、３ 筐体、１２ 音源位置推定部、１３ 停止位置決定部、１４ 経路探索部、１５ 自己位置推定部、１６ 駆動制御部、１７ 音源確認部、
５１ 地図データ記憶部、５２ 音源候補対象記憶部、１００ 移動体
１０１ 制御部、１０２ 入出力部、１０３ 駆動部、１０４ 電源部、
１０５ 外部記憶部、１２１ マイクロフォンアレイ、１２３ スピーカ、
１２４ ＬＥＤ、１２５ センサ部、１３１ モータ、１３２ ドライバ、
１４３ バッテリ、１４４ バッテリ制御部、
２００ マップ、２０１ 移動体が移動できる領域、２０２ 移動体が移動できない領域、
２０３ ベッド、２０４ 人間、２０５ 音源候補対象、２０６ 目標停止位置、
２０７ 領域、２０８ａ〜２０８ｃ 音源候補対象、２０９ 目標停止位置、
２１０ 受音方向、２２０ 目標経路、
【技術分野】
【０００１】
本発明は、移動体、及びその制御方法に関し、特に詳しくは自律移動する移動体、及びその制御方法に関する、
【背景技術】
【０００２】
近年、人間が発する音声に応じて動作するロボットが開発されている。例えば、人間が発した音声を受音して、その人間に向かって移動するロボットが開発されている（特許文献１、特許文献２）。
【０００３】
特許文献１のロボットでは、マイクロフォンアレイによって、音源（発話した人間）の方向を推定している。さらに、超音波センサやＣＣＤカメラによって音源までの距離を推定している。そして、音源方向に移動することによって、Ｓ／Ｎ比を向上している。
【０００４】
特許文献２のロボットでは、マイクロフォンアレイによって、人間が発した音声を受音するとともに、過去の音源の方向の履歴から、音源方向を推定している。そして、推定された音源方向に移動している。
【０００５】
【特許文献１】特開２００６−１８１６５１号公報
【特許文献１】特開２００４−１３０４２７号公報
【発明の開示】
【発明が解決しようとする課題】
【０００６】
しかしながら、上記のロボットでは、音源位置に直線的に移動することしかできなかった。従って、音源とロボットの間に障害物がある場合、回避することができないという問題点がある。また、障害物を回避したとしても、音源に直線的に移動するよう制御されているため、もとの経路に復帰するのが困難である。また、特許文献１では、超音波センサなどを用いて音源までの距離を推定しているが、音源までの位置が遠い場合、音源距離を正確に推定することが困難である。さらに、音源とロボットの間に障害物がある場合、音源位置を特定できないという問題点がある。このように、従来の制御では、音源に対して確実に近づけることができないという問題点があった。
【０００７】
本発明は、このような問題を解決するためになされたものであり、音源に対して確実に近づくことができる移動体、及びその制御方法を提供することを目的とする。
【課題を解決するための手段】
【０００８】
本発明の第１の態様にかかる移動体は、目標停止位置まで自律移動する移動体であって、前記移動体の外部で発生した音を受音するマイクを有し、前記マイクが受音した音の前記移動体に向かう方向を前記受音方向として特定する音源方向特定手段と、前記移動体が移動する領域に応じて記憶されている地図データにおいて、音源の候補となる対象の位置を音源候補対象位置として記憶する音源候補対象記憶手段と、前記音源方向特定手段によって特定された音源の方向と、前記音源候補対象記憶手段に記憶された音源候補対象の位置とに基づいて、音源の位置を推定する音源位置推定手段と、前記音源位置推定手段によって推定された音源の位置から目標停止位置を決定する停止位置決定手段と、前記移動体の現在位置から前記停止位置決定手段で決定された目標停止位置まで前記移動体を移動させる移動手段と、を備えるものである。これによって、音源とロボットの間に障害物がある場合でも、音源に対して近づくことができる。さらに、音源候補対象の位置から目標停止位置が決定されているため、音源の推定を確実に行なうことができる。よって、音源に対して確実に近づくことができる。
【０００９】
本発明の第２の態様にかかる移動体は、上記の移動体であって、前記音源位置推定手段が、前記音源候補対象記憶部に記憶された複数の音源候補対象のうち、前記音源方向に対して所定の角度だけ広がった領域に含まれる音源候補対象の位置に基づいて、音源の位置を推定するものである。これにより、音源の位置を正確に推定することができるので、音源に対して確実に近づくことができる。
【００１０】
本発明の第３の態様にかかる移動体は、上記の移動体であって、前記目標停止位置が前記音源候補対象記憶部に記憶された複数の音源候補対象に対応して予め設定されていることを特徴とするものである。これにより、速やかに移動することが可能となる。
【００１１】
本発明の第４の態様にかかる移動体は、上記の移動体であって、前記音源位置推定手段によって推定された音源の位置と前記移動体の位置とに基づいて、前記停止位置決定手段が目標停止位置を算出することを特徴とするものである。これにより、状況が変わった場合でも、音源に対して確実に近づくことができる。
【００１２】
本発明の第５の態様にかかる移動体は、上記の移動体であって、前記目標停止位置に移動した後、前記推定された音源に対して、真の音源であるか否か確認する音源確認情報を取得する音源確認手段をさらに備え、前記推定された音源が真の音源でないと確認された場合、前記音源位置推定手段が前記音源候補対象記憶部に記憶された他の音源候補対象の位置に基づいて音源の位置を推定するものである。これにより、多数の音源候補対象が存在する場合でも、真の音源に対して確実に近づくことができる。
【００１３】
本発明の第６の態様にかかる移動体は、上記の移動体であって、前記地図データ上において音が発生した位置の履歴に基づいて、一定時間以上、音が発生していない位置の音源候補対象を前記音源候補対象記憶手段から消去することを特徴とするものである。これにより、音源候補対象の数が過剰に増えるのを防ぐことができる。従って、速やかに音源に近づくことができる。
【００１４】
本発明の第７の態様にかかる移動体の制御方法は、目標停止位置まで自律移動する移動体の制御方法であって、前記移動体の外部で発生した音をマイクによって受音して、前記マイクが受音した音の前記移動体に向かう方向を前記受音方向として特定するステップと、前記特定された受音方向と、前記移動体が移動する領域の地図データに対して予め登録されている音源候補対象の位置とに基づいて、音源の位置を推定するステップと、前記推定された音源の位置から目標停止位置を決定するステップと、前記移動体の現在位置から前記目標停止位置まで前記移動体を移動するステップと、を備えるものである。これによって、音源とロボットの間に障害物がある場合でも、音源に対して近づくことができる。さらに、音源候補対象の位置から目標停止位置が決定されているため、音源の推定を確実に行なうことができる。よって、音源に対して確実に近づくことができる。
【００１５】
本発明の第８の態様にかかる移動体の制御方法は、上記の制御方法であって、前記音源の位置を推定するステップでは、登録されている複数の前記音源候補対象のうち、前記音源方向に対して所定の角度だけ広がった領域に含まれる音源候補対象の位置に基づいて、音源の位置を推定するものである。これにより、音源の位置を正確に推定することができるので、音源に対して確実に近づくことができる。
【００１６】
本発明の第９の態様にかかる移動体の制御方法は、上記の制御方法であって、前記目標停止位置が登録されている複数の前記音源候補対象に対応して予め設定されていることを特徴とするものである。これにより、速やかに移動することが可能となる。
【００１７】
本発明の第１０の態様にかかる移動体の制御方法は、上記の制御方法であって、前記推定された音源の位置と前記移動体の位置とに基づいて、前記目標停止位置が算出されることを特徴とするものである。これにより、状況が変わった場合でも、音源に対して確実に近づくことができる。
【００１８】
本発明の第１１の態様にかかる移動体の制御方法は、上記の制御方法であって、前記目標停止位置に移動した後、前記推定された音源に対して、音源であるか否か確認する音源確認情報を取得するステップと、前記音源確認情報により、前記推定された音源が真の音源でないと確認された場合、登録されている他の音源候補対象の位置に基づいて音源の位置を推定するものである。これにより、多数の音源候補対象が存在する場合でも、真の音源に対して確実に近づくことができる。
【００１９】
本発明の第１２の態様にかかる移動体の制御方法は、上記の制御方法であって、前記地図データ上において音が発生した位置の履歴に基づいて、一定時間以上、音が発生していない位置の音源候補対象を消去することを特徴とするものである。これにより、音源候補対象の数が過剰に増えるのを防ぐことができる。従って、速やかに音源に近づくことができる。
【発明の効果】
【００２０】
本発明によれば、音源に対して確実に近づくことができる移動体、及びその制御方法を提供することが可能になる。
【発明を実施するための最良の形態】
【００２１】
本実施の形態にかかる移動体について図１を用いて説明する。図１は移動体１００の構成を模式的に示す外観図である。本実施の形態では、移動体１００が、ユーザが発した音声に基づいて自律移動する移動ロボットとして説明する。移動体１００は、車輪２と、筐体３と、を備えている。そして、筐体３の内部には、車輪２と接続されたモータが設けられている。このモータが移動体１００を移動させるための駆動機構となる。モータを駆動することによって、車輪２が回転して、移動体１００が移動する。さらに、移動体１００は、マイクロフォンアレイ１２１を備えている。マイクロフォンアレイ１２１は、移動体１００の外部で発生した音を受音して、音源の方向を推定する。例えば、人間が発話した場合、音源となる発話した人間の方向を推定する。そして、移動体１００は、車輪２を駆動して、音源の方向に近づくよう移動する。このように、移動体１００は、人間に呼ばれたときに、その人間の近くまで移動するタスクを実行する。
【００２２】
次に、移動体１００の制御系について図２を用いて説明する。移動体１００は、制御部１０１、入出力部１０２、駆動部１０３、電源部１０４、及び外部記憶部１０５などを有している。これらは、例えば、筐体３の内部に設けられている。また、スピーカ１２３、マイクロフォンアレイ１２１、センサ部１２５、ＬＥＤ１２４などは筐体３の外側に設けられている。
【００２３】
入出力部１０２は、周囲の音を受音するためのマイクロフォンアレイ１２１を備えている。マイクロフォンアレイ１２１は、アレイ状に配置された複数のマイクを有している。そして、各マイクロフォンからの出力の時間遅延によって、音の入射方向を測定する。あるいは、指向性を有するマイクロフォンを複数用いて、音の入射方向を測定してもよい。これにより、マイクロフォンアレイ１２１が配置されている方向から、音源方向までの角度が求められる。すなわち、マイクロフォンアレイ１２１が移動体１００から音源までの受音方向を特定する。よって、移動体１００が移動する平面上において、移動体１００周りの３６０°の中から特定の方向が受音方向として推定される。マイクロフォンアレイ１２１は、移動体１００から見て、音源の位置する方向を受音方向と判断する。すなわち、マイクロフォンアレイ１２１が受音した音の移動体１００に向かう方向を受音方向として特定する。ここで、受音方向は、移動体が移動する平面（例えば、水平面）における方向（方位）であってもよく、鉛直方向に対する傾斜度合いを含めた３次元における方向としてもよい。
【００２４】
さらに、入出力部１０２は、音声を出力してユーザと対話等を行なうためのスピーカ１２３、ユーザへの応答や感情等を表現するためのＬＥＤ１２４、タッチセンサなどからなるセンサ部１２５などを備える。また、センサ部１２５は、レーザレンジファインダやＣＣＤカメラなどの各種センサを有している。
【００２５】
駆動部１０３は、モータ１３１及びモータ１３１を駆動するドライバ１３２などを有し、制御部１０１からの制御信号に従って車輪２を回転させる。これにより、移動体１００が所定の位置まで移動する。さらに、モータ１３１、及びドライバ１３２は、２つの車輪２にそれぞれ設けられている。これにより、２つの車輪２を独立して駆動することができる。例えば、ドライバ１３２は、モータ１３１の回転数を制御する。これにより、車輪２を所定の回転数で駆動することができる。よって、移動体１００の目標位置までの移動が可能となる。モータ１３１は移動体１００の内部に取り付けられている。
【００２６】
例えば、駆動部１０３が左右の車輪２を回転させることによって、移動体１００が移動する。２つの車輪２は、それぞれ異なるモータ１３１に接続されている。したがって、車輪２を異なる回転方向、回転速度で回転させることにより、移動体１００の移動方向、移動速度を制御することができる。具体的には、車輪２を同じ方向、異なる速度で回転させることにより、移動体１００の移動方向が変化しながら、移動する。すなわち、２つの車輪２の距離、及び回転速度の差に応じて、移動体１００がカーブしながら移動する。また、車輪２を反対方向に同じ速度で回転させることによって、移動体１００がその場で旋回する。さらに、車輪２を同じ方向、同じ速度で回転させることにより、移動体１００が直進移動する。電源部１０４は、バッテリ１４１及びその放充電を制御するバッテリ制御部１４２を有し、各部に電源を供給する。
【００２７】
外部記憶部１０５は、着脱可能なＨＤＤ、光ディスク、光磁気ディスク等からなり、各種プログラムや制御パラメータなどを記憶し、そのプログラムやデータを必要に応じて制御部１０１内のメモリ（不図示）等に供給する。外部記憶部１０５には、地図データ記憶部５１と、音源候補対象記憶部５２とが設けられている。地図データ記憶部５１は、移動体１００が移動する領域の地図データを記憶する。例えば、地図データとして、移動体１００が移動する領域内の物の配置に応じて移動体１００が移動できる領域と、移動できない領域とがそれぞれ記憶されている。例えば、移動体１００が通常の家庭内の部屋に配置されている場合、地図データとして、ベッド、ソファー、椅子、テーブル、タンス、本棚などの家具の位置が記憶されている。これらの家具の位置は、例えば、移動体１００が移動する平面における２次元座標として記憶される。そして、家具が存在する位置、及びその周辺が、移動できない領域として記憶される。すなわち、これらの家具は、移動体１００の障害物となる。このため、例えば、家具から移動体１００の大きさに合わせた距離だけ離れた位置が、移動体１００が移動できる領域と、移動できない領域との境界となる。この地図データは、後述する経路探索にも用いられる。
【００２８】
さらに、地図データを随時更新してもよい。例えば、センサ部１２５に設けられたレーザレンジファインダや、超音波センサによって、障害物までの距離を測定する。例えば、レーザレンジファインダからは、複数のレーザー光が所定の角度ピッチで出射される。そして、レーザレンジファインダはレーザ光が障害物や壁面で反射された反射光を検出する。反射光が検出される時間に応じて、障害物までの距離を測定する。そして、この障害物までの距離に基づいて、地図データ上の移動できない領域と移動できる領域とを判別する。これにより、部屋内の状況が変化した場合でも移動体１００が障害物に衝突するのを防ぐことができる。
【００２９】
音源候補対象記憶部５２では、地図データ上の音源の候補の対象となる音源候補対象の位置を記憶している。これらの音源候補対象の位置は、音源地図によって記憶されている。例えば、地図データに対して複数の音源候補対象の位置を予め登録することによって、音源地図が生成される。音源候補対象の位置では、頻繁に音が発生する。従って、例えば、地図データ上で、人間が頻繁に存在する位置を音源候補対象の位置として登録することができる。具体的には、ベッド、ソファー、椅子、ドア前後、台所前、玄関、電話付近、電気等のスイッチ付近、テーブル、本棚、タンス、押入れ、洗濯機、冷蔵庫等の位置が音源候補対象の位置として記憶される。音源地図は、地図データ記憶部５１に記憶されている地図データ上に対応付けられている。従って、地図データ上の複数の点に音源候補対象が存在することになる。音源候補対象の位置は、地図データ上の２次元座標として記憶される。従って、音源候補対象の位置は座標リストとして記憶される。あるいは、後述するグリッドマップとして、音源候補対象の位置を記憶してもよい。例えば、グリッドマップの各グリッドが音源候補対象の位置であるか否かを登録しておく。これらの音源候補対象位置は、操作者によって予め登録されている。登録する位置としては、上述のように統計的に人間が存在する可能性が高い点を選ぶことができる。このように、音源地図には、音源となる可能性の高い点が音源候補対象位置として登録されている。
【００３０】
制御部１０１は、ＣＰＵ（Central Processing Unit）、ＲＯＭ（Read Only Memory）、ＲＡＭ（Random Access Memory）、通信用のインターフェースなどを有し、移動体１００の各種動作を制御する。そして、この制御部１０１は、例えばＲＯＭに格納された制御プログラムに従って各種の制御を実行する音源位置推定部１２、停止位置決定部１３、経路探索部１４、自己位置推定部１５、駆動制御部１６、及び音源確認部１７を備えている。音源位置推定部１２は、音源候補対象記憶部５２に記憶された音源候補対象の位置から音源の位置を推定する。例えば、音源候補対象記憶部５２に記憶された複数の音源候補対象の位置から１つの音源候補対象を選択して、この音源候補対象を音源と推定する。そして、選択された音源候補対象の位置を音源位置と推定する。ここで、音源位置推定部１２で推定された音源の位置を推定音源位置とする。なお、音源位置推定部１２は、マイクロフォンアレイ１２１で特定された受音方向に近い音源候補対象を音源と推定する。音源位置推定部１２による音源位置の推定については後述する。
【００３１】
停止位置決定部１３は、音源位置推定部１２によって推定された推定音源位置に応じて目標停止位置を決定する。自己位置推定部１５は、地図データ上における移動体１００の現在の自己位置を推定する。経路探索部１４は、自己位置推定部１５で推定された移動体１００の自己位置から、停止位置決定部１３で決定された目標停止位置までの目標経路探索を行なう。例えば、移動体１００の目標軌道となる目標経路は、しばしば座標の集合として与えられる。座標は、例えば、グリッド状に離散化されたグリッド座標で表現される。グリッド座標を利用するメリットは、最短経路探索を容易に実行できる点や、確実に目的地に到達できる経路を得ることができる点にある。しかしながら、グリッド座標において表現される目標経路は直線と直線が接続された不連続な経路であるため、移動体１００がこのような経路を追従することは難しい。そのため、与えられた離散的な経路座標から、移動体１００の追従制御に利用可能な滑らかな目標経路を、例えば、重み付き移動平均を利用して補間曲線を求めることにより作成することができる。このように、与えられた地図データに対してグリッドマップを作成することによって、容易に目標経路を探索することができる。もちろん、経路探索部１４は、移動体１００が家具等に衝突しないように、移動できない領域を避けて経路探索を行なう。
【００３２】
例えば、グリッドマップをＡ*探索（エースター探索）で探索した目標経路を用いることができる。さらに、グリッドを結んだ線分集合を滑らかにする演算を行なっている。もちろん、上記以外の方法によって目標経路を計画してもよい。例えば、最良優先探索や山登り探索などの探索技法を用いることも可能である。駆動制御部１６は、移動体１００が経路探索部１４で探索された目標経路に追従して移動するよう、制御信号を駆動部１０３に対して出力する。
【００３３】
音源確認部１７は、推定された音源が音源として正しいか否かを確認する。すなわち、推定音源位置が真の音源の位置であるかを確認する。真の音源であるかを確認することで、多数の音源候補対象がある場合でも、確実に音源に対して近づけることができる。具体的には、音源位置確認部１７は、移動体１００が上記の目標停止位置まで移動した後、推定音源位置が真の音源の位置であるかを確認するための音源確認情報を取得する。音源確認情報としては、カメラによって取得された画像情報や、マイクによって取得された音声情報が挙げられる。そして、音源候補対象に対して取得された音源確認情報が真の音源の場合の音源確認情報とどの程度一致するかによって、真の音源か否かを判定する。すなわち、音源確認情報に基づいて、音源位置推定部１２で選択された音源候補対象が真の音源であるか否かを確認する。
推定音源位置に音源が存在しない場合、音源位置推定部１２は他の音源候補対象を選択して、他の音源候補対象の位置を新たな推定音源位置とする。停止位置決定部１３は、新たな推定音源位置に対する目標停止位置を決定する。そして、経路探索部１４は、現在の自己位置から、２つ目に推定された新たな推定音源位置に対応する目標停止位置までの経路を探索する。ここでの自己位置は、１つ目に推定された推定音源位置に対する目標停止位置である。そして、駆動制御部１６が自己位置から２つ目の目標停止位置まで移動するよう制御する。移動体１００は、上記の制御を繰り返して、真の音源に対応する目標停止位置までの移動を行う。これらの制御は、所定の制御プログラムやハードウェアに基づいて実行される。
【００３４】
上記の制御について、図３、及び図４を参照して説明する。図３は、本実施の形態に係る移動体１００の制御方法を示すフローチャートである。図４は移動体１００が移動する領域に対応するマップ２００を平面的に示す図である。すなわち、図４では、移動する領域のマップ２００が、移動できる領域２０１と、移動できない領域２０２とに分けられて、平面的に示されている。移動できない領域２０２は、上記のように家具などに対応している。ここで、ベッド２０３上に存在する人間２０４が音源であるとして説明する。また、音源候補対象記憶部５２には、ベッド２０３上の点が音源候補対象２０５として登録されている。
【００３５】
まず、マイクロフォンアレイ１２１を稼働状態とする（ステップＳ１）。マイクロフォンアレイ１２１が発話を検出する（ステップＳ２）。ここでは、マイクロフォンアレイ１２１からの出力に基づいて、音声認識を行う。そして、移動体１００が呼ばれていると認識された場合のみ、移動体１００が次のステップに進む。移動体１００が呼ばれていると認識できない場合は、ステップＳ１に戻る。
【００３６】
ステップＳ２で移動体１００が呼ばれていると認識された場合、マイクロフォンアレイ１２１で受音方向を特定する（ステップＳ３）。すなわち、人間２０４の移動体１００への呼びかけに対して、マイクロフォンアレイ１２１が音声の入射方向を測定する。そして、移動体１００から音源までの受音方向２１０を特定する。また、受音方向を特定する処理と並行して、自己位置推定を行なう（ステップＳ４）すなわち、制御部１０１の自己位置推定部１５は、マイクロフォンアレイ１２１による受音方向の特定と並行して、現在の自己位置を推定している。例えば、センサ部１２５に設けられたセンサからの出力に基づいて、現在の自己の位置が推定される。さらに、自己位置推定では、マップ上において、移動体１００が向いている方向を自己角度として推定する。この自己位置推定については、ＣＣＤカメラやレーザレンジファインダなどを用いて実行することができる。また、部屋内にランドマークを設定して、自己位置推定を行なってもよい。例えば、ＣＣＤカメラの出力に基づいて画像認識を行なうことで、自己位置を推定することができる。このようにマルチタスクで自己位置推定と受音方向特定とを行なうことによって、処理時間を短縮することができる。
【００３７】
そして、受音方向２１０をグローバル座標系の角度で表現する。具体的には、移動体１００からの受音方向２１０の角度を受音方向角度とし、移動体１００自体の角度を自己位置角度とし、グローバル座標系での音源の角度を受音方向絶対角度とすると、受音方向角度＋自己位置角度＝受音方向絶対角度となる。この受音方向絶対角度は受音方向２１０に対応する値となる。
【００３８】
次に、マイクロフォンアレイ１１２で特定された受音方向２１０と自己位置推定部１５で推定された自己位置と音源地図とに基づいて、音源を推定する。ここでは、図４に示すように、受音方向２１０から受音方向特定の角度誤差分を含む領域２０７に存在する音源候補対象２０５を選択して、その音源候補対象２０５を音源と推定する。すなわち、マイクロフォンアレイ１１２における受音方向特定の角度誤差を受音方向誤差とすると、受音方向２１０から受音方向誤差だけ広がった範囲が、音源が存在する領域２０７となる。従って、受音方向誤差だけ横幅を持った扇形の領域２０７の中から音源候補対象２０５を選択することができる。そして、音源位置推定部１２は、領域２０７の中に存在する音源候補対象２０５を探して、その音源候補対象２０５を音源として推定する。すなわち、音源位置推定部１２は、音源地図に登録されている複数の音源候補対象の中から、領域２０７に存在する音源候補対象２０５を選択する。なお、領域２０７に２以上の音源候補対象がある場合、自己位置に近い音源候補対象を優先して選択する。このように、音源位置推定部１２は、受音方向２１０を基準として受音方向から受音方向誤差だけ広くした領域２０７の中に存在する音源候補対象２０５を選択する。受音方向２１０に対して所定の角度だけ広がった領域２０７から音源候補対象２０５を抽出することによって、確実に音源候補対象を選択することが可能となる。なお、領域２０７は、移動体１００が移動する平面において、受音方向２１０から所定の角度だけ広がる範囲として求めることができる。そして、選択された１つの音源候補対象２０５を音源として推定し、その音源候補対象の位置を推定音源位置とする。この音源候補対象２０５は、後述するステップＳ９で推定された音源が真の音源であることが確認されるまで、仮の音源として認識されている。
【００３９】
推定音源位置が推定されたら、その推定音源位置に対応する目標停止位置２０６を決定する（ステップＳ６）。すなわち、推定音源位置には、通常、人間２０４が存在するため、推定音源位置から所定の距離だけ離れた位置を目標停止位置２０６とする。この目標停止位置２０６は、音源候補対象位置毎に予め設定しておいてもよい。これにより、速やかに目標停止位置２０６を決定することができる。あるいは、推定された推定音源位置の位置に基づいて算出してもよい。これにより、状況が変化している場合でも、適切な目標停止位置を求めることができる。例えば、地図データが変化している場合や、移動体１００の初期位置が異なる場合に好適である。
【００４０】
次に、現在の自己位置と目標停止位置２０６とを使って、経路探索を行なう（ステップＳ７）。すなわち、経路探索部１４が現在の自己位置から目標停止位置２０６までの経路を生成する。経路探索は、例えば、Ａ*探索（エースター探索）により実行することができる。そして、移動体１００は、経路探索で生成された経路に追従しながら、目標停止位置までの移動を行なう（ステップＳ８）。ここでは、自己位置推定部１５において、常時、自己位置推定を行なっておく。すなわち、自己位置を随時更新する。そして、更新された自己位置と目標経路からのずれに対して負のフィードバックを与えるように、経路追従させる。これにより、精度よく、経路に追従して移動させることが可能となる。ここでは、駆動制御部１６が駆動部１０３のドライバ１３２に対して制御信号を出力する。これにより、モータ１３１が所定の回転速度で回転するため、経路追従させることができる。
【００４１】
そして、目標停止位置２０６までの移動が完了したら、推定された音源が正しいか確認する（ステップＳ９）。すなわち、推定音源位置、あるいはその近傍に真の音源が存在するか否かを確認する音源確認情報を取得し、その音源確認情報によって真の音源か否かを確認する。音源確認情報としては、例えば、カメラによって取得された画像情報や、マイクロフォンを用いて音声認識された音声情報が挙げられる。そして、真の音源の場合の画像情報や音声情報と、音源確認情報がどの程度一致するか判断する。そして、音源確認情報の一致度によって真の音源か否かを確認する。
例えば、推定音源位置に向かって、移動体１００が呼ばれたかどうかを確認する。具体的には、目標停止位置で停止した移動体１００が、ＣＣＤカメラを推定音源位置に向けて、自己位置周辺の画像を取得する。ＣＣＤカメラの画像処理によって顔認識を行い、推定音源位置やその近傍の人間２０４の顔を認識する。そして、人間２０４の顔が認識できたら、スピーカ１２３から「呼びましたか？」と人間２０４に対して問い掛ける。問い掛けられた人間２０４が問い掛けに対して、「うん、呼んだよ」と返答したら、移動体１００は、この返答をマイクロフォンアレイ１２１や他のマイクロフォンで受音する。そして、移動体１００は、人間２０４からの返答を音声認識する。この音声認識結果に基づいて、移動体１００は、推定音源位置周辺に存在する人間２０４からの呼びかけがあったと判定する。これにより、推定された音源が正しいことが確認できる。このようにすることによって、音源位置推定部１２によって推定された仮の音源が真の音源であるか否か確認することができる。このように、音声認識を行い、音声認識結果を音源確認情報とすることができる。なお、音源の確認は、顔認識などによって行われてもよい。すなわち、物体認識や顔認識等の画像認識を行い、画像認識結果を音源確認情報とすることができる。そして、音声確認情報が真の音源の場合の音声確認情報とどの程度一致するかによって真の音源であることを確認する。そして、推定された音源が正しい音源である場合、移動タスクを終了する（ステップＳ１０）。
【００４２】
また、人間２０４が正しい音源でない場合、あるいは、推定音源位置周辺に顔が認識できない場合、再度ステップＳ５からステップＳ９までの処理を繰り返す。すなわち、人間２０４からの返答を音声認識することによって、人間２０４が移動体１００を呼んでいないことが確認された場合、次の音源候補対象２０５を探す。例えば、移動体１００からの問い掛けに対して、人間２０４が「呼んでないよ」と返答した場合、音声認識結果に基づいて、推定された音源が真の音源でないと認識する。そして、移動体１００は、次の音源候補対象を探す。例えば、領域２０７に複数の音源候補対象が存在していたら、次の音源候補対象を選択する。この場合、移動体１００の自己位置から近い順に音源候補対象を選択することができる。そして、次に選択された音源候補対象を音源として推定する。１つ目の目標停止位置から、２つ目の目標停止位置まで移動する。真の音源を確認することができるまで、ステップＳ５からステップＳ９までの処理を繰り返していく。
【００４３】
このようにすることによって、確実に移動体１００を音源に近づけることができる。すなわと、音源と移動体１００との障害物がある場合でも、移動体１００が障害物に衝突するのを防ぐことができる。さらに、予め家具などの障害物を考慮して経路探索しているため、障害物を容易に回避することができる。また、超音波センサを用いた場合と比べて、遠い位置に存在する音源に対する移動が可能になる。よって、確実に音源の近くまで移動体１００を移動させることができる。さらに、目標停止位置に移動した後、推定音源位置に対して真の音源が存在するか否かを確認しているため、音源を誤認識することがない。さらに、音源候補対象から一定距離離れた点を目標停止位置としているため、音源となる人間に対して衝突するのを防ぐことができる。よって、音源に対して適した位置に移動することが可能となる。
【００４４】
なお、複数の音源候補対象に対応して、一つの目標停止位置が登録されていてもよい。例えば、図４に示すように３つの音源候補対象２０８ａ〜２０８ｃが、共通の目標停止位置２０９に対応していてもよい。このように、複数の音源候補対象位置に対して共通の目標停止位置を登録しておいてもよい。これにより、登録する目標停止位置の数を少なくすることができる。よって、目標停止位置から移動せずに、複数の推定音源位置に対する音源の確認を行なうことができる。
【００４５】
次に、推定音源位置を求める別の方法について、図５を用いて説明する。図５は、移動体１００の自己位置に対する受音方向２１０を模式的に示す図である。ここでは、移動体１００の自己位置に対して近い順に音源候補対象を選択するための一例について説明する。
【００４６】
まず、音源候補対象の位置を座標として登録しておく。なお、音源候補対象の位置をグリッドの中の特定の座標としてもよい。ここで、音源候補対象を探す範囲をｒ〜ｒ＋ｄｒとする。ｒは移動体１００からの距離である。ｄｒは予め設定しておく。そして、音源候補対象の位置の座標リストの中から、以下の式（１）、（２）を満たす音源候補対象を検索する。
θｓ−σｓ＜ａｔａｎ２（ＹＲ−ＹＳ，ＸＲ−ＸＳ）＜θｓ＋σｓ ・・・（１）
ｒ＜ｓｑｒｔ｛（ＹＲ−ＹＳ）２＋（ＸＲ−ＸＳ）２｝＜ｒ＋ｄｒ ・・・（２）
θｓ：絶対座標系の受音方向
σｓ：受音方向の角度誤差
（ＸＲ，ＹＲ）：ロボット位置
（ＸＳ，ＹＳ）：音源候補対象位置
【００４７】
そして、上記の式（１）、及び式（２）を満足する音源候補対象があれば、その音源候補対象を選択する。なお、ｒ〜ｒ＋ｄｒの中に式（１）、及び式（２）を満足する音源候補対象が２つ以上ある場合、受音方向２１０に近い音源候補対象が選択される。すなわち、ａｔａｎ２（ＹＲ−ＹＳ，ＸＲ−ＸＳ）がθｓに近い音源候補対象を選択する。例えば、音源候補対象２０５ａと音源候補対象２０５ｂがある場合、受音方向２１０に近い音源候補対象２０５ａが選択される。式（１）、及び式（２）を満足する音源候補対象が無ければ、次に探索する範囲をｒ＋ｄｒ〜ｒ＋２ｄｒとする。そして、再度、式（１）、及び式（２）を満足する音源候補対象を探索する。上記の処理をｒ＝０から繰り返し行うことによって、移動体１００に近い音源候補対象から選択することができる。そして、最初に条件を満足した音源候補対象を、音源として推定する。すなわち、音源候補対象を探索する範囲をｄｒずつ段階的に広くしていき、音源候補対象を探索していく。このように、自己位置に近い順に音源候補対象を選択することができる。また、上記の処理では、音源候補対象を探索することによって、移動体１００からの距離が近い音源候補対象が２以上ある場合、受音方向に近い音源候補対象が優先して選択される。すなわち、ｄｒだけ広げられた探索範囲に２つ以上音源候補対象がある場合、受音方向２１０に近い音源候補対象が先に選択される。よって、音源が存在する可能性の高い音源候補対象から順番に選択していくことが可能になる。これにより、移動時間を短縮することができる。
【００４８】
なお、推定音源位置に対応する目標停止位置は、予め登録していなくてもよい。すなわち、音源位置を推定した後、その推定音源位置に応じて算出してもよい。例えば、音源位置を推定した後、その音源候補対象に対する目標停止位置を自動生成してもよい。以下に、推定音源位置に基づいて目標停止位置を算出する方法について、図６を用いて説明する。図６は、移動体１００が移動するマップ２００を模式的に示す図である。ベッド２０３上の音源候補対象２０５の位置が推定音源位置と推定された場合に説明する。目標停止位置を決定するため、音源候補対象２０５の座標を中心とし、所定の半径を有する円を描く。そして、この円の中に移動できる領域２０１が十分広いかを調べる。ここでは、その円の中に移動できる領域２０１が十分広くない場合、円の半径を少しだけ大きくする。これを繰り返し、円の中で、領域２０１が移動体１００が移動するために十分広くなったら、その位置を目標停止位置２０６とする。すなわち、円の半径を徐々に大きくしていく、移動体１００が移動できる程度に広い領域２０１が最初に円の中に現れた位置を目標停止位置２０６とする。そして、上記のように、自己位置から目標停止位置２０６までの目標経路２００を探索する。このように、推定音源位置と、現在の自己位置とに基づいて目標停止位置を算出する。これによって、状況に応じた目標停止位置２０６に移動することができる。すなわち、目標停止位置２０６の決定に、自己位置が考慮されているため、自己位置に近い目標停止位置２０６を求めることができる。これにより、移動時間を短縮することができ、利便性を向上することができる。
【００４９】
また、音源候補対象をセンサ部１２５に設けられたセンサからの出力に基づいて登録するようにしてもよい。例えば、ＣＣＤカメラなどによって物体認識を行い、人が頻繁に存在する可能性が高い物の位置を音源候補対象の位置として登録することができる。例えば、予め人が使う可能性が高い物（例えば、ベッド、ソファー、椅子、冷蔵庫等）をデータベースとして登録しておく。物体認識によって、人が使う可能性が高い物を認識したら、その位置を音源候補対象位置として登録する。物体認識は、移動体１００の移動中、或いは停止中に行なうことができる。そして、音源地図上の音源候補対象の位置を随時、更新することによって、家具等が移動した場合でも、適切に音源候補対象の位置を選択することができる。これにより、音源の推定を確実に行なうことができる。
【００５０】
あるいは、人間と会話した位置の履歴を残しておき、その履歴に基づいて音源候補対象を登録してもよい。すなわち、移動体１００が人間と会話した場所の座標、及び会話した時刻を記憶しておく。そして、単位時間あたりの会話数がしきい値以上になる位置を音源候補対象の位置として登録する。ここで、顔認識等の技術によって、人間を認識することができる。さらに、人間との会話が一定時間以上無い音源候補対象位置を音源地図から削除するようにしてもよい。このように人間と会話する頻度の高い位置を音源候補対象として登録し、会話する頻度が低くなった位置を音源候補対象から消去する。そうすることによって、音源候補対象の数を少なくすることができる。これにより、音源候補対象の数が過剰に増えるのを防ぐことができる。従って、速やかに音源に近づくことができる。このように、移動体１００が会話した位置の履歴に応じて、音源候補対象を登録、又は消去することができる。会話を行なうためには、例えば、音声認識技術によって音声を認識する。そして、認識した音声に応じて会話するための音声を選ぶ。会話するための音声をスピーカから出力することにより会話することができる。また、会話の履歴に基づいて音源候補対象を登録する場合、音源候補対象の座標だけでなく、その音源に対して会話した方向を登録するようにしてもよい。このように、地図データ上の音が発生した位置の履歴に基づいて、音が一定以上発生していない位置の音源候補対象位置を音源候補対象記憶部５２から削除する。これにより、音源候補対象が過剰になるのを防ぐことができる。よって、音源候補対象を適切な数で登録することができる。なお、音が発生した位置は、他の方法で検出するようにしてもよい。
【００５１】
また、移動体１００が目標経路に追従して移動している間に、画像認識等の技術を用いて音源を認識するようにしてもよい。例えば、ＣＣＤカメラが音源候補対象の位置を向いた状態で、目標経路に追従して移動するように制御する。すなわち、移動体１００の方向に応じて、ＣＣＤカメラの向きを変えて、ＣＣＤカメラの視野の中に音源候補対象が常時含まれるようにする。そして、移動中に、ＣＣＤカメラで顔認識を行い、音源となる人間の顔を認識する。そして、音源候補対象の位置に顔が認識された時点で、その音源候補対象の方向に直進する。これにより、移動体１００を速やかに音源候補対象に近づけることができる。通常、顔認識を行なうことができる場合、移動体１００と人間との間に障害物がない。このため、移動体１００を直進させても障害物と衝突する可能性が低くなる。従って、顔を認識した後には、目標停止位置に対して直進させることができる。
【００５２】
なお、音源は、人間に限るものではない。音源は、例えば、電話やインターホンなどの音を発生する機器や犬などの動物であってもよい。さらには、他のロボットが音源であってもよい。本実施の形態では、車輪型の移動体について説明したが、歩行型の移動体であっても適用可能である。
【図面の簡単な説明】
【００５３】
【図１】本発明の実施形態にかかる移動体の構成を示す図である。
【図２】図１に示す移動体に設けられた制御系を概念的に表したブロック図である。
【図３】本発明の実施形態にかかる移動体の制御方法を示すフローチャートである。
【図４】本発明の実施形態にかかる移動体が移動する領域のマップを模式的に示す図である。
【図５】本発明の実施形態にかかる移動体において、受音方向を特定するための方法の一例を説明するための図である。
【図６】本発明の実施形態にかかる移動体において、音源候補対象を選択するための方法の一例を説明するための図である。
【符号の説明】
【００５４】
２ 車輪、３ 筐体、１２ 音源位置推定部、１３ 停止位置決定部、１４ 経路探索部、１５ 自己位置推定部、１６ 駆動制御部、１７ 音源確認部、
５１ 地図データ記憶部、５２ 音源候補対象記憶部、１００ 移動体
１０１ 制御部、１０２ 入出力部、１０３ 駆動部、１０４ 電源部、
１０５ 外部記憶部、１２１ マイクロフォンアレイ、１２３ スピーカ、
１２４ ＬＥＤ、１２５ センサ部、１３１ モータ、１３２ ドライバ、
１４３ バッテリ、１４４ バッテリ制御部、
２００ マップ、２０１ 移動体が移動できる領域、２０２ 移動体が移動できない領域、
２０３ ベッド、２０４ 人間、２０５ 音源候補対象、２０６ 目標停止位置、
２０７ 領域、２０８ａ〜２０８ｃ 音源候補対象、２０９ 目標停止位置、
２１０ 受音方向、２２０ 目標経路、
【特許請求の範囲】
【請求項１】
目標停止位置まで自律移動する移動体であって、
前記移動体の外部で発生した音を受音するマイクを有し、前記マイクが受音した音の前記移動体に向かう方向を前記受音方向として特定する受音方向特定手段と、
前記移動体が移動する領域に応じて記憶されている地図データにおいて、音源の候補となる対象の位置を音源候補対象位置として記憶する音源候補対象記憶手段と、
前記受音方向特定手段によって特定された受音方向と、前記音源候補対象記憶手段に記憶された音源候補対象位置とに基づいて、音源の位置を推定する音源位置推定手段と、
前記音源位置推定手段によって推定された音源の位置から目標停止位置を決定する停止位置決定手段と、
前記移動体の現在位置から前記停止位置決定手段で決定された目標停止位置まで前記移動体を移動させる移動手段と、を備える移動体。
【請求項２】
前記音源位置推定手段が、前記音源候補対象記憶部に記憶された複数の音源候補対象のうち、前記受音方向に対して所定の角度だけ広がった領域に含まれる音源候補対象の位置に基づいて、前記音源の位置を推定する請求項１に記載の移動体。
【請求項３】
前記目標停止位置が前記音源候補対象記憶部に記憶された複数の音源候補対象に応じて予め設定されていることを特徴とする請求項１、又は２に記載の移動体。
【請求項４】
前記音源位置推定手段によって推定された音源の位置と前記移動体の位置とに基づいて、前記停止位置決定手段が目標停止位置を算出することを特徴とする請求項１、又は２に記載の移動体。
【請求項５】
前記目標停止位置に移動した後、前記推定された音源に対して、真の音源であるか否か確認する音源確認情報を取得する音源確認手段をさらに備え、
前記音源確認手段が前記推定された音源が真の音源でないと確認した場合、前記音源位置推定手段が前記音源候補対象記憶部に記憶された他の音源候補対象の位置に基づいて音源の位置を推定する請求項１乃至４のいずれかに記載の移動体。
【請求項６】
前記地図データ上において音が発生した位置の履歴に基づいて、一定時間以上、音が発生していない位置の音源候補対象を前記音源候補対象記憶手段から消去することを特徴とする請求項１乃至５のいずれかに記載の移動体。
【請求項７】
目標停止位置まで自律移動する移動体の制御方法であって、
前記移動体の外部で発生した音をマイクによって受音して、前記マイクが受音した音の前記移動体からの方向を前記受音方向として特定するステップと、
前記特定された受音方向と、前記移動体が移動する領域の地図データに対して予め登録されている音源候補対象の位置とに基づいて、音源の位置を推定するステップと、
前記推定された音源の位置から目標停止位置を決定するステップと、
前記移動体の現在位置から前記目標停止位置まで前記移動体を移動するステップと、を備える移動体。
【請求項８】
前記音源の位置を推定するステップでは、登録されている複数の前記音源候補対象のうち、前記受音方向に対して所定の角度だけ広がった領域に含まれる音源候補対象の位置に基づいて、音源の位置を推定する請求項７に記載の移動体の制御方法。
【請求項９】
前記目標停止位置が登録されている複数の前記音源候補対象に応じて予め設定されていることを特徴とする請求項７、又は８に記載の移動体の制御方法。
【請求項１０】
前記推定された音源の位置と前記移動体の位置とに基づいて、前記目標停止位置が算出されることを特徴とする請求項７、又は８に記載の移動体の制御方法。
【請求項１１】
前記目標停止位置に移動した後、前記推定された音源に対して、音源であるか否か確認する音源確認情報を取得するステップと、
前記音源確認情報により、前記推定された音源が真の音源でないと確認された場合、登録されている他の音源候補対象の位置に基づいて音源の位置を推定する請求項７乃至１０のいずれかに記載の移動体の制御方法。
【請求項１２】
前記地図データ上において音が発生した位置の履歴に基づいて、一定時間以上、音が発生していない位置の音源候補対象を消去することを特徴とする請求項７乃至１１のいずれかに記載の移動体の制御方法。
【請求項１】
目標停止位置まで自律移動する移動体であって、
前記移動体の外部で発生した音を受音するマイクを有し、前記マイクが受音した音の前記移動体に向かう方向を前記受音方向として特定する受音方向特定手段と、
前記移動体が移動する領域に応じて記憶されている地図データにおいて、音源の候補となる対象の位置を音源候補対象位置として記憶する音源候補対象記憶手段と、
前記受音方向特定手段によって特定された受音方向と、前記音源候補対象記憶手段に記憶された音源候補対象位置とに基づいて、音源の位置を推定する音源位置推定手段と、
前記音源位置推定手段によって推定された音源の位置から目標停止位置を決定する停止位置決定手段と、
前記移動体の現在位置から前記停止位置決定手段で決定された目標停止位置まで前記移動体を移動させる移動手段と、を備える移動体。
【請求項２】
前記音源位置推定手段が、前記音源候補対象記憶部に記憶された複数の音源候補対象のうち、前記受音方向に対して所定の角度だけ広がった領域に含まれる音源候補対象の位置に基づいて、前記音源の位置を推定する請求項１に記載の移動体。
【請求項３】
前記目標停止位置が前記音源候補対象記憶部に記憶された複数の音源候補対象に応じて予め設定されていることを特徴とする請求項１、又は２に記載の移動体。
【請求項４】
前記音源位置推定手段によって推定された音源の位置と前記移動体の位置とに基づいて、前記停止位置決定手段が目標停止位置を算出することを特徴とする請求項１、又は２に記載の移動体。
【請求項５】
前記目標停止位置に移動した後、前記推定された音源に対して、真の音源であるか否か確認する音源確認情報を取得する音源確認手段をさらに備え、
前記音源確認手段が前記推定された音源が真の音源でないと確認した場合、前記音源位置推定手段が前記音源候補対象記憶部に記憶された他の音源候補対象の位置に基づいて音源の位置を推定する請求項１乃至４のいずれかに記載の移動体。
【請求項６】
前記地図データ上において音が発生した位置の履歴に基づいて、一定時間以上、音が発生していない位置の音源候補対象を前記音源候補対象記憶手段から消去することを特徴とする請求項１乃至５のいずれかに記載の移動体。
【請求項７】
目標停止位置まで自律移動する移動体の制御方法であって、
前記移動体の外部で発生した音をマイクによって受音して、前記マイクが受音した音の前記移動体からの方向を前記受音方向として特定するステップと、
前記特定された受音方向と、前記移動体が移動する領域の地図データに対して予め登録されている音源候補対象の位置とに基づいて、音源の位置を推定するステップと、
前記推定された音源の位置から目標停止位置を決定するステップと、
前記移動体の現在位置から前記目標停止位置まで前記移動体を移動するステップと、を備える移動体。
【請求項８】
前記音源の位置を推定するステップでは、登録されている複数の前記音源候補対象のうち、前記受音方向に対して所定の角度だけ広がった領域に含まれる音源候補対象の位置に基づいて、音源の位置を推定する請求項７に記載の移動体の制御方法。
【請求項９】
前記目標停止位置が登録されている複数の前記音源候補対象に応じて予め設定されていることを特徴とする請求項７、又は８に記載の移動体の制御方法。
【請求項１０】
前記推定された音源の位置と前記移動体の位置とに基づいて、前記目標停止位置が算出されることを特徴とする請求項７、又は８に記載の移動体の制御方法。
【請求項１１】
前記目標停止位置に移動した後、前記推定された音源に対して、音源であるか否か確認する音源確認情報を取得するステップと、
前記音源確認情報により、前記推定された音源が真の音源でないと確認された場合、登録されている他の音源候補対象の位置に基づいて音源の位置を推定する請求項７乃至１０のいずれかに記載の移動体の制御方法。
【請求項１２】
前記地図データ上において音が発生した位置の履歴に基づいて、一定時間以上、音が発生していない位置の音源候補対象を消去することを特徴とする請求項７乃至１１のいずれかに記載の移動体の制御方法。
【図１】
【図２】
【図３】
【図４】
【図５】
【図６】
【図２】
【図３】
【図４】
【図５】
【図６】
【公開番号】特開２００８−１５８８６８（Ｐ２００８−１５８８６８Ａ）
【公開日】平成２０年７月１０日（２００８．７．１０）
【国際特許分類】
【出願番号】特願２００６−３４８０６５（Ｐ２００６−３４８０６５）
【出願日】平成１８年１２月２５日（２００６．１２．２５）
【出願人】（０００００３２０７）トヨタ自動車株式会社 (59,920)
【Ｆターム（参考）】
【公開日】平成２０年７月１０日（２００８．７．１０）
【国際特許分類】
【出願日】平成１８年１２月２５日（２００６．１２．２５）
【出願人】（０００００３２０７）トヨタ自動車株式会社 (59,920)
【Ｆターム（参考）】
[ Back to top ]