(57)【要約】【課題】複数のマイクに入力された音波発生源の音声信号に基づき、３次元空間上の任意の位置に存在する音波発生源の位置を推定する。【解決手段】音波の発生源の位置を推定するロボットシステムであって、３次元空間内に設けられたロボット２０と、ロボット２０の任意の位置に設けられ、音波を受信する複数の音波受信装置と、いずれか２つの音波受信装置がそれぞれ受信した音波の到達時間差を算出し、到達時間差に基づいて、ロボット２０上の基準位置と音波の発生源との成す角度を算出する角度算出部３０−１と、算出した角度と各音波受信装置との位置情報をパラメータとした方程式を解くことにより、音波の発生源の位置を推定する位置推定部３０−２と、推定した音波の発生源の位置に対するロボット２０の向きを示す方向ベクトルおよび方向ベクトルに垂直な面を推定する正面推定部３０−３と、を備える。【選択図】図２
2018034221.tif 000002
【特許請求の範囲】
【請求項１】
音波の発生源の位置を推定するロボットシステムであって、
３次元空間内に設けられたロボットと、
前記ロボットの任意の位置に設けられ、音波を受信する複数の音波受信装置と、
いずれか２つの音波受信装置がそれぞれ受信した音波の到達時間差を算出し、前記到達時間差に基づいて、前記ロボット上の基準位置と前記音波の発生源との成す角度を算出する角度算出部と、
前記算出した角度および前記各音波受信装置の位置関係をパラメータとした方程式を解くことにより、前記音波の発生源の位置を推定する位置推定部と、
前記推定した音波の発生源の位置に対する前記ロボットの向きを示す方向ベクトルおよび前記方向ベクトルに垂直な面を推定する正面推定部と、を備えることを特徴とするロボットシステム。
【請求項２】
前記角度算出部は、３つ以上の音波受信装置のうち、２つの音波受信装置を一組として、複数の組合せを選定し、各組み合わせにおける各音波受信装置がそれぞれ受信した音波の到達時間差を算出して、前記ロボット上の基準位置と前記音波の発生源との成す角度を算出し、
前記位置推定部は、前記算出された複数の角度に基づいて、前記音波の発生源の位置を推定することを特徴とする請求項１記載のロボットシステム。
【請求項３】
前記ロボットは、音声信号を出力するスピーカ、光信号を出力する光源、または本体若しくは本体の一部を駆動する駆動部を備え、
前記推定した面に対して、前記スピーカからの音声信号の出力、前記光源からの光信号の出力または前記本体若しくは本体の一部の方向転換の少なくとも一つのフィードバック動作を実行するフィードバック実行部を更に含むことを特徴とする請求項１または請求項２記載のロボットシステム。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、音波の発生源の位置を推定する機能を有するロボットシステムに関する。
【背景技術】
【０００２】
従来から、音響処理や光学処理等の信号処理により、オブジェクトや利用者の位置を推定する技術やシステムがある。例えば、特許文献１に開示されている技術では、オブジェクトの先端と表示装置上の複数位置との間で超音波の送受信を行わせ、その送受信に要する時間に基づいて距離を求め、オブジェクト先端の平面位置座標を推定する。
【０００３】
また、特許文献２に開示されている技術では、オブジェクトから赤外線および超音波を同時に出力し、赤外線を表示装置上のフォトダイオードで受光すると共に、超音波を画面上の２つのマイクでそれぞれ受信する。そして、赤外線が受光されてから超音波が受信されるまでの間の時間差に基づいて、マイクからデバイスまで距離を求め、オブジェクトの位置を推定する。
【０００４】
また、特許文献３に開示されている技術では、配置された固定マイクに対して入力された音声信号に基づき、着席している話者の発話向きを推定する。
【先行技術文献】
【特許文献】
【０００５】
【特許文献１】特開２００１−１２５７４０号公報
【特許文献２】特開２００５−１２２５３４号公報
【特許文献３】特許第０５２３５７２５号明細書
【発明の概要】
【発明が解決しようとする課題】
【０００６】
しかしながら、特許文献１に開示されている技術では、オブジェクトの先端（利用者の口）が接する表示装置上の平面位置座標を推定するため、利用シーンがオブジェクトと表示装置（ロボット）とが近い場合に限られてしまう。このため、利用者がロボットに接近しなければならず、利用者がロボットから離れている場合は、この技術を使うことができない。
【０００７】
特許文献２に開示されている技術では、送受信における時刻同期を取るために赤外線を用いるが、オブジェクト（利用者）に赤外線送受信機を装着する必要があると共に、装置が高価なものになってしまう。利用者と受光部との間に遮蔽物等があると、推定精度が劣化しやすい。
【０００８】
特許文献３に開示されている技術では、予め固定されたマイクに対して入力された音声信号に基づき、着席している話者の発話向きを推定するが、ロボット等にマイクが装着されてマイクが動的に変化する場合や利用者が移動している場合は、推定精度が劣化しやすい。
【０００９】
本発明は、このような事情に鑑みてなされたものであり、複数のマイクに入力された音波発生源の音声信号に基づき、３次元空間上の任意の位置に存在する音波発生源の位置を推定することができるロボットシステムを提供することを目的とする。
【課題を解決するための手段】
【００１０】
（１）上記の目的を達成するために、本発明は、以下のような手段を講じた。すなわち、本発明のロボットシステムは、音波の発生源の位置を推定するロボットシステムであって、３次元空間内に設けられたロボットと、前記ロボットの任意の位置に設けられ、音波を受信する複数の音波受信装置と、いずれか２つの音波受信装置がそれぞれ受信した音波の到達時間差を算出し、前記到達時間差に基づいて、前記ロボット上の基準位置と前記音波の発生源との成す角度を算出する角度算出部と、前記算出した角度および前記各音波受信装置の位置関係をパラメータとした方程式を解くことにより、前記音波の発生源の位置を推定する位置推定部と、前記推定した音波の発生源の位置に対する前記ロボットの向きを示す方向ベクトルおよび前記方向ベクトルに垂直な面を推定する正面推定部と、を備えることを特徴とする。
【００１１】
このように、ロボットの任意の位置に設けられ、音波を受信する複数の音波受信装置のうち、いずれか２つの音波受信装置がそれぞれ受信した音波の到達時間差を算出し、その到達時間差に基づいて、ロボット上の基準位置と音波の発生源との成す角度を算出し、その記算出した角度および各音波受信装置の位置関係をパラメータとした方程式を解くことにより、音波の発生源の位置を推定し、その推定した音波の発生源の位置に対するロボットの向きを示す方向ベクトルおよび方向ベクトルに垂直な面を推定するので、音波の発生源がロボットから離れている場合であっても、その位置を推定することが可能となる。また、音波を用いるため、例えば、赤外線のような光を用いる場合と比較して小型で安価にすることができ、利便性を高めることが可能となる。また、音波は光よりも回折するため、遮蔽物の影響を受けにくいという長所がある。さらに、音波受信装置の位置が固定されていない場合であっても音波の発生源の位置を推定することができるため、ロボットが動く場合にも適用することが可能となる。さらに、音波の到達時間差を利用することから、雑音環境下や音波の発生源の位置が動く状況下であっても、音波受信装置の数を増やすことなく、位置推定精度を高く維持することができる。
【００１２】
（２）また、本発明のロボットシステムにおいて、前記角度算出部は、３つ以上の音波受信装置のうち、２つの音波受信装置を一組として、複数の組合せを選定し、各組み合わせにおける各音波受信装置がそれぞれ受信した音波の到達時間差を算出して、前記ロボット上の基準位置と前記音波の発生源との成す角度を算出し、前記位置推定部は、前記算出された複数の角度に基づいて、前記音波の発生源の位置を推定することを特徴とする。
【００１３】
このように、３つ以上の音波受信装置のうち、２つの音波受信装置を一組として、複数の組合せを選定し、各組み合わせにおける各音波受信装置がそれぞれ受信した音波の到達時間差を算出して、ロボット上の基準位置と音波の発生源との成す角度を算出し、その算出された複数の角度に基づいて、音波の発生源の位置を推定するので、音波の発生源の空間上の位置を高い精度で推定することが可能となる。
【００１４】
（３）また、本発明のロボットシステムにおいて、前記ロボットは、音声信号を出力するスピーカ、光信号を出力する光源、または本体若しくは本体の一部を駆動する駆動部を備え、前記推定した面に対して、前記スピーカからの音声信号の出力、前記光源からの光信号の出力または前記本体若しくは本体の一部の方向転換の少なくとも一つのフィードバック動作を実行するフィードバック実行部を更に含むことを特徴とする。
【００１５】
このように、音波の発生源に対して、少なくとも一つのフィードバック動作を実行するので、ロボットに対し、音に反応する機能を付与することが可能となる。
【発明の効果】
【００１６】
本発明によれば、音波の発生源がロボットから離れている場合であっても、その位置を推定することが可能となる。また、音波を用いるため、例えば、赤外線のような光を用いる場合と比較して小型で安価にすることができ、利便性を高めることが可能となる。また、音波は光よりも回折するため、遮蔽物の影響を受けにくいという長所がある。さらに、音波受信装置の位置が固定されていない場合であっても音波の発生源の位置を推定することができるため、ロボットが動く場合にも適用することが可能となる。さらに、音波の到達時間差を利用することから、雑音環境下や音波の発生源の位置が動く状況下であっても、音波受信装置の数を増やすことなく、位置推定精度を高く維持することができる。
【図面の簡単な説明】
【００１７】
【図１】本実施形態に係るロボットシステムの概略構成を示す図である。
【図２】本実施形態に係るロボットシステムの機能を示すブロック図である。
【図３】本実施形態に係るロボットシステムの動作を示すフローチャートである。
【発明を実施するための形態】
【００１８】
本発明者らは、音に反応するロボットの実現を想起し、ロボットに複数マイクを装着し、これらのマイクから入力された音波の発生源の音声信号に基づいて、３次元空間上の任意位置にいる音波の発信源の位置を推定し、その推定した位置情報を用いて、音波の発信源にフィードバック動作を行うことによって、ロボットに対し、音に反応する機能を付与することができることを見出し、本発明をするに至った。
【００１９】
すなわち、本発明のロボットシステムは、音波の発生源の位置を推定するロボットシステムであって、３次元空間内に設けられたロボットと、前記ロボットの任意の位置に設けられ、音波を受信する複数の音波受信装置と、いずれか２つの音波受信装置がそれぞれ受信した音波の到達時間差を算出し、前記到達時間差に基づいて、前記ロボット上の基準位置と前記音波の発生源との成す角度を算出する角度算出部と、前記算出した角度と前記各音波受信装置との位置情報をパラメータとした方程式を解くことにより、前記音波の発生源の位置を推定する位置推定部と、前記推定した音波の発生源の位置に対する前記ロボットの向きを示す方向ベクトルおよび前記方向ベクトルに垂直な面を推定する正面推定部と、を備えることを特徴とする。
【００２０】
これにより、本発明者らは、音波の発生源がロボットから離れている場合であっても、その位置を推定することを可能とした。また、音波を用いることで、例えば、赤外線のような光を用いる場合と比較して小型で安価にすることを可能とすると共に、利便性を高めることを可能とした。さらに、ロボット上に装着された複数の音波受信装置の位置が既知であれば、音波受信装置がロボットと共に動く場合であっても音波の発生源の位置を推定することを可能とした。さらに、音波の到達時間差を利用することから、雑音環境下や音波の発生源の位置が動く状況下であっても、音波受信装置の数を増やすことなく、位置推定精度を高く維持することを可能とした。以下、本発明の実施形態について、図面を参照しながら具体的に説明する。
【００２１】
図１は、本実施形態に係るロボットシステムの概略構成を示す図である。図１に示すように、ロボットシステム１は、ロボット２０と、音波の発生源としての利用者１０の位置を推定する位置推定装置としてのＰＣ３０から構成されている。より具体的には、ロボット２０、ＰＣ（Personal Computer）３０、ロボット２０の任意の位置に設けられた音波受信装置としての複数のマイク２０ａ、２０ｂ、２０ｃから構成されている。図１では、ロボット２０の各端部に３つのマイク２０ａ、２０ｂ、２０ｃが設けられている。そして、マイク２０ａ、２０ｂ、２０ｃは、３次元空間上の任意位置にいる利用者１０から発信された音波を受信する。
【００２２】
ここで、本実施形態に係るロボットシステムでは、音波を利用するが、音波とは、いずれの音域も含む概念であるが、好ましくは、人の声である１００Ｈｚ〜２０００Ｈｚの帯域の「可聴音」を利用する。しかし、本発明の技術的思想は、可聴音に限定されるわけではない。
【００２３】
また、本実施形態では、一例として、ロボット２０に３つのマイク２０ａ、２０ｂ、２０ｃが装着されているが、本発明の技術的思想は、３つのマイクに限定されるわけでなくそれ以上であっても良いし、利用者１０の２次元平面上の任意位置を推定する場合は２つのマイクであっても良い。
【００２４】
ＰＣ３０は、ロボット２０に内蔵されているか、または、ロボット２０と無線インタフェースまたは有線インタフェースで接続されており、ロボット２０のマイク２０ａ、２０ｂ、２０ｃで音波を受信したときに、受信波を示すデータがＰＣ３０に発信されるように構成されている。ＰＣ３０では、受信波に相関処理を行って、任意の２つのマイクの各組合せが受信した音波の到達時間差を求め、そのマイクの各組合せと利用者１０の位置の成す角度を算出すると共に、利用者１０の位置を推定する。
【００２５】
このため、本実施形態では、利用者１０が音波を発信するタイミングが任意時刻であっても、到達時間差を算出することができる。また、同一直線上とならないようにマイク２０ａ、２０ｂ、２０ｃを装着すれば、利用者１０の３次元空間上の位置座標を求めることが可能となると共に、利用者１０の空間上の位置に対するロボット２０からの向きを特定する方向ベクトル、および、方向ベクトルに垂直な面を推定することが可能となる。
【００２６】
ＰＣ３０は、推定された利用者１０の空間上の位置、または、推定された利用者１０の空間上の位置に対するロボット２０からの向きを特定する方向ベクトル、または、推定された方向ベクトルに垂直な面をロボット２０に送信し、利用者１０へのフィードバックを実行する。
【００２７】
図２は、本実施形態に係るロボットシステム１の機能を示すブロック図である。ＰＣ３０の角度算出部３０−１は、ロボット２０のマイク２０ａ、２０ｂ、２０ｃが、利用者１０から受信した音波に対して相関処理を行い、任意の２つのマイクの各組合せが発信した音波の到達時間差を求め、そのマイクの各組合せと利用者１０の位置の成す角度をそれぞれ算出する。
【００２８】
また、ＰＣ３０の位置推定部３０−２は、角度算出部３０−１が算出した各角度および制約条件として利用者の位置関係を反映した方程式を従属して解くことにより、利用者１０の空間上の位置を一意に推定する。さらに、正面推定部３０−３は、位置推定部３０−２が推定した利用者１０の空間上の位置に対するロボット２０からの向きを特定する方向ベクトルを推定する。また、正面推定部３０−３は、ロボット２０上の任意の一点を通り、方向ベクトルと平行な直線と垂直に交わる平面を推定する。その他の構成については、図１で説明したとおりであるため、説明を省略する。
【００２９】
ロボット２０のフィードバック実行部２０−１は、音声信号を出力するスピーカ、光信号を出力する光源、またはロボット２０の本体若しくは本体の一部を駆動する駆動部を備えている。この駆動部は、モータやアクチュエータ等から動力を得てロボット２０の可動部を駆動する機能を有する。フィードバック実行部２０−１は、ＰＣ３０から送信された利用者１０の空間上の位置、または、利用者１０の空間上の位置に対するロボット２０からの向きを特定する方向ベクトル、または、方向ベクトルに垂直な面に基づき、利用者１０へのフィードバックを実行する。例えば、推定した面に対して、スピーカからの音声信号の出力、光源からの光信号の出力またはロボット２０の本体若しくは本体の一部の方向転換の少なくとも一つのフィードバック動作を実行する。
【００３０】
図３は、本実施形態に係るロボットシステム１の動作を示すフローチャートである。まず、空間上の未知の位置にいる利用者１０は、１００Ｈｚ〜２０００Ｈｚの帯域の音波を断続的にそれぞれ発信する（ステップＳ１）。次に、ロボット２０に装着された３つのマイク２０ａ、２０ｂ、２０ｃで、利用者１０から発信された音波をそれぞれ受信する（ステップＳ２）。ここで、ｉ＝１、２、３を３つのマイク２０ａ、２０ｂ、２０ｃの識別子として、受信された音波の波形をＰｉ（ｘ）で表す。
【００３１】
次に、ロボット２０からＰＣ３０に対して、受信波形Ｐｉ（ｘ）を送信する（ステップＳ３）。次に、ＰＣ３０において、ロボット２０から送信された受信波形Ｐｉ（ｘ）に相関処理を施して、利用者１０から発信された音波が３つのマイク２０ａ、２０ｂ、２０ｃで受信されるまでの到達時間差を算出する（ステップＳ４）。ここで、任意の２つのマイクの各組合せ（ｈ，ｉ）に対して、その到達時間差は、式（１）で示される相互相関値：Ｄｈｉ（τ）を用いて求める。
【数１】
2018034221.tif 000003
ただし、ｔは任意の時刻とする。そして、Ｄｈｉ（τ）を最大とするτを算出し、その値を到達時間差Ａｈｉとする。
【００３２】
次に、ＰＣ３０において、任意の２つのマイクの各組合せ（ｈ，ｉ）に対して、利用者１０との距離差ｒｈｉを算出する（ステップＳ５）。ここで、音速をＣとすると、ｒｈｉは、式（２）で求められる。
【数２】
2018034221.tif 000004
【００３３】
次に、ＰＣ３０において、任意の２つのマイクの各組合せ（ｈ，ｉ）に対して、利用者１０の位置との成す角度を算出する（ステップＳ６）。ここで、マイク２０ａ、２０ｂ、２０ｃが利用者１０から離れているとき、利用者から発信された音波は、マイク２０ａ、２０ｂ、２０ｃに平行波として到達すると考えて良い。ゆえに、ロボット２０に装着された任意の２つのマイクの各組合せ（ｈ，ｉ）間距離を２Ｌｈｉとすると、任意の２つのマイクの各組合せ（ｈ，ｉ）を結ぶ直線と利用者１０の位置との成す角φｈｉ（ｊ）は、式（３）で求められる。
【数３】
2018034221.tif 000005
【００３４】
次に、ＰＣ３０において、任意の２つのマイクの各組合せ（ｈ，ｉ）に対して、利用者１０の３次元空間座標を推定する（ステップＳ７）。ここで、利用者１０の３次元空間座標は、任意の２つのマイクの各組合せ（ｈ，ｉ）の中点と成す角φの平面上にあると考えることができる。ロボット２０の中心を原点とし、ロボット２０に装着されたマイクの３次元空間座標をそれぞれ（ｘｈ，ｙｈ，ｚｈ）、（ｘｉ，ｙｉ，ｚｉ）、ただし（ｈ，ｉ＝１，…，ｎ）とし、利用者１０の３次元空間座標を（ｕｊ，ｖｊ，ｗｊ）、ただし（ｊ＝１，…，ｍ）とすると、余弦定理より、式（４）が与えられる。
【００３５】
ここで、利用者１０は、ｗｊ＞０に存在することを前提とする。すなわち、利用者１０がロボット２０の正面に存在していることを前提としている。式（４）においては、マイクおよび利用者１０の数が一般的な場合を示しており、マイクの数をｎ、利用者の数をｍとする。
【数４】
2018034221.tif 000006
【００３６】
ここで、ロボット２０に装着されたマイクの数が３つ以上あれば、数３の式数が未知数を満たし、連立方程式を解くことができる。すなわち、ロボット２０に装着されたマイク２０ａ、２０ｂ、２０ｃの３次元空間座標をそれぞれ（ｘｉ，ｙｉ，ｚｉ）、ただし（ｉ＝１，２，３）として、式（４）に基づき、φｈｉ（ｊ）を用いた連立方程式を立て、非線形連立方程式を従属して解くことにより、利用者１０の３次元空間座標を（ｕ１，ｖ１，ｗ１）を一意に算出することができる。
【００３７】
さらに、ロボット２０に装着されたマイクの数が４つ以上ある場合、式（４）で示した連立方程式において、式数が未知数を上回り、方程式の解と方程式の解として複数の候補（ｕｉ，ｖｉ，ｗｉ）が得られるが、任意に抽出した（ｗｉ，ｖｉ，ｗｉ）＝（αｋ，βｋ，γｋ）、ただし（ｋ＝１，…，ｎ）に対して、式（５）で示した誤差δが小さくなる（αｋ，βｋ，γｋ）を、利用者１０の３次元空間座標（ｕｉ，ｖｉ，ｗｉ）として採用する。
【数５】
2018034221.tif 000007
【００３８】
次に、ＰＣ３０において、利用者１０の３次元空間座標に対するロボット２０からの向きを特定する方向ベクトルを推定する（ステップＳ８）。すなわち、ロボット２０に設けられる各マイクの位置は、任意であるため、ロボット２０に対する利用者１０の正面を特定する必要があるため、方向ベクトルを推定する。ここで、ロボット２０の中心を原点としているため、利用者１０の３次元空間座標に対するロボット２０から方向ベクトルは、式（６）で与えられる。
【数６】
2018034221.tif 000008
【００３９】
ここで、利用者の数が２人以上の場合であっても、マイク２０ａ、２０ｂ、２０ｃで受信する音波が任意の時刻で重なければ、利用者各々の方向ベクトルを求めることができる。そして、ロボット２０の中心を原点とした空間上の任意の１点（ｘｐ，ｙｐ，ｚｐ）を通り、式（６）で与えた方向ベクトルに平行な直線の方程式を式（７）のように立てる。
【数７】
2018034221.tif 000009
ここで、（ｘｐ，ｙｐ，ｚｐ）は、利用者１０のロボット２０から向きを得るために算出する方向ベクトルに平行な直線の起点である。例えば、マイク２０ａの装着位置を起点にする場合は、（ｘｐ，ｙｐ，ｚｐ）＝（ｘ１，ｙ１，ｚ１）とすれば良い。なお、ロボット２０から外れた点を（ｘｐ，ｙｐ，ｚｐ）としても、発明の本質は変わらない。
【００４０】
次に、ＰＣ３０において、利用者１０に対する正面を推定する。すなわち、式（７）で与えられる直線の方程式に垂直な平面との交点を推定する（ステップＳ９）。ここで、（ｘｐ，ｙｐ，ｚｐ）を通り、式（７）に垂直な平面は、式（８）で求められる。
【数８】
2018034221.tif 000010
【００４１】
最後に、ステップＳ６で推定された利用者１０の空間上の位置、または、ステップＳ７で推定された利用者１０の空間上の位置に対するロボット２０からの向きを特定する方向ベクトル、または、ステップＳ８で推定された方向ベクトルに垂直な面をロボット２０に送信し、利用者１０へのフィードバックを実行する（ステップＳ１０）。
【００４２】
ロボット２０によるフィードバック動作は、例えば、ステップＳ７で推定された利用者１０の空間上の位置に対するロボット２０からの向きを特定する方向ベクトルに基づき、ロボットから２０から光を照射すれば、ロボット２０が利用者１０に対してフィードバックを通知することができる。また、ステップＳ７で推定された利用者１０の空間上の位置に対するロボット２０からの向きを特定する方向へ、ロボット２０の音声を放射し、利用者１０に対してフィードバックを通知することもできる。さらに、ステップＳ８で推定された方向ベクトルに垂直な面に基づきロボット２０の顔（ディスプレイ等）を向ければ、ロボット２０が利用者１０の方向を振り向くことが可能となる。
【００４３】
ここで、利用者１０から音波が継続的に発信されている場合、ステップＳ２に戻り、再度、その音波を受信し、利用者１０の空間上の位置を推定しても良い。これにより、例えば、ロボット２０が利用者１０の方向に顔を向けるフィードバック動作を実行した場合、ロボット２０は、利用者１０の動きに追従して、顔を向けることが可能となる。また、利用者１０の動きが高速であっても、式（１）のτの最大閾値を与えることにより、利用者１０の空間上の位置を正確に求めることができ、利用者１０の高速追従が実現できる。
【００４４】
なお、例えば、マイク２０ａ、２０ｂ、２０ｃを全指向性マイクとし、その他に指向性マイクを一つ、ロボットに固定することによって、利用者１０が、ｗｊ≦０となる場合、すなわち、利用者１０がロボット２０の裏側に存在する場合であっても、利用者１０の位置を推定することが可能となる。
【００４５】
以上説明したように、本実施形態によれば、利用者１０が発信した音波を各マイク２０ａ、２０ｂ、２０ｃが受信して、任意の２つのマイクの各組合せが受信した音波の到達時間差を求め、求めた各到達時間差に基づいて各マイクの各組合せと各マイクの成す角度を算出し、算出した各角度および制約条件として各マイクの位置関係を反映した方程式を従属して解くことにより、利用者１０の空間上の位置を一意に推定し、推定した利用者１０の空間上の位置に対するロボット２０の向きを特定する方向ベクトルを推定すると共に、方向ベクトルに垂直な面を推定するので、利用者１０がロボット２０から離れている場合でも、実現可能である。また、赤外線を利用しないことにより、小型で安価かつ利便性の高い装置を提供でき、遮蔽物があっても実現可能である。さらに、固定されていないマイクでも利用者の位置を推定することができ、動的制御があるロボットにもマイクを装着可能である。加えて、音波の到達時間差を利用することで、雑音環境下や利用者の位置が移動している状況下であっても測定精度を向上でき、マイクの数を増やすことなく、実現可能である。
【符号の説明】
【００４６】
１  ロボットシステム
１０  利用者
２０  ロボット
２０−１  フィードバック実行部
２０ａ、２０ｂ、２０ｃ  マイク
３０  ＰＣ
３０−１  角度算出部
３０−２  位置推定部
３０−３  正面推定部
【図１】
2018034221.tif 000011
【図２】
2018034221.tif 000012
【図３】
2018034221.tif 000013