(57)【特許請求の範囲】
【請求項１】
位置を検出する担当センサに割り当てられた担当領域において、前記担当センサによって取得されたセンサデータである担当データに基づいて、前記担当センサでは検出されていない欠落領域を特定する欠落領域特定部と、
前記欠落領域特定部によって特定された前記欠落領域を検出したセンサデータであって、前記担当センサ以外のセンサによって取得されたセンサデータを補間データとして抽出する補間データ抽出部と、
前記担当データと、前記補間データ抽出部によって抽出された前記補間データとを統合して前記担当領域の検出データを生成する検出データ生成部と
を備えるセンサデータ統合装置。
【請求項２】
前記欠落領域特定部は、隣接する前記担当データが示す位置間の距離が第１閾値以上に離れている領域を前記欠落領域として特定する
請求項１に記載のセンサデータ統合装置。
【請求項３】
前記センサデータ統合装置は、さらに、
前記担当データによって検出された領域のうち、前記担当センサからの距離が第２閾値以上に離れている領域を遠方領域として特定する遠方領域特定部
を備え、
前記補間データ抽出部は、前記遠方領域特定部によって特定された前記遠方領域を検出したセンサデータであって、前記担当センサ以外のセンサによって取得されたセンサデータについても前記補間データとして抽出する
請求項１又は２に記載のセンサデータ統合装置。
【請求項４】
前記検出データ生成部は、前記担当データと前記補間データとを同一座標系のデータに変換した上で合成することによって、前記検出データを生成する
請求項１から３までのいずれか１項に記載のセンサデータ統合装置。
【請求項５】
コンピュータが、位置を検出する担当センサに割り当てられた担当領域において、前記担当センサによって取得されたセンサデータである担当データに基づいて、前記担当センサでは検出されていない欠落領域を特定し、
コンピュータが、前記欠落領域を検出したセンサデータであって、前記担当センサ以外のセンサによって取得されたセンサデータを補間データとして抽出し、
コンピュータが、前記担当データと前記補間データとを統合して前記担当領域の検出データを生成するセンサデータ統合方法。
【請求項６】
位置を検出する担当センサに割り当てられた担当領域において、前記担当センサによって取得されたセンサデータである担当データに基づいて、前記担当センサでは検出されていない欠落領域を特定する欠落領域特定処理と、
前記欠落領域特定処理によって特定された前記欠落領域を検出したセンサデータであって、前記担当センサ以外のセンサによって取得されたセンサデータを補間データとして抽出する補間データ抽出処理と、
前記担当データと、前記補間データ抽出処理によって抽出された前記補間データとを統合して前記担当領域の検出データを生成する検出データ生成処理と
をコンピュータに実行させるセンサデータ統合プログラム。
【発明の詳細な説明】
【技術分野】
【０００１】
この発明は、複数のセンサによって取得されたセンサデータを統合する技術に関する。
【背景技術】
【０００２】
センサを用いて障害物といった物体を検出して、車両といった移動体の制御等を行うことにより、安全性及び利便性を向上させることが行われている。
移動体には複数のセンサが搭載される場合がある。この場合には、各センサで取得されたセンサデータを統合して利用する必要がある。【０００３】
特許文献１には、各センサの優先順位を事前に設定しておき、全体の処理負荷を軽減する技術が記載されている。
【先行技術文献】
【特許文献】
【０００４】
【特許文献１】国際公開第２０１０／１４０２３９号
【発明の概要】
【発明が解決しようとする課題】
【０００５】
パルス状に発光するレーザを照射し、照射されたレーザに対する散乱光を測定して、遠距離にある対象までの距離と、その対象の性質とを分析するＬｉＤＡＲ（Ｌｉｇｈｔ  Ｄｅｔｅｃｔｉｏｎ  ａｎｄ  Ｒａｎｇｉｎｇ）といったセンサがある。ＬｉＤＡＲのようなセンサを複数用いて周辺を監視する場合、各センサの情報を１つに統合することにより、より広いエリアの監視をすることができる。しかし、センサ数が多くなるほど取得されるセンサデータ数が増える。そのため、取得されたセンサデータ全てについて処理を行うと、処理負荷が高くなる。
ＬｉＤＡＲのようなセンサを複数用いて周辺を監視する場合には、各センサに対する優先度は全て同じである。そのため、特許文献１に記載された技術のように、各センサの優先順位を設定しておき、全体の処理負荷を軽減することは難しい。
この発明は、複数のセンサデータを効率的に統合にすることを目的とする。
【課題を解決するための手段】
【０００６】
この発明に係るセンサデータ統合装置は、
位置を検出する担当センサに割り当てられた担当領域において、前記担当センサによって取得されたセンサデータである担当データでは検出されていない欠落領域を特定する欠落領域特定部と、
前記欠落領域特定部によって特定された前記欠落領域を検出したセンサデータであって、前記担当センサ以外のセンサによって取得されたセンサデータを補間データとして抽出する補間データ抽出部と、
前記担当データと、前記補間データ抽出部によって抽出された前記補間データとを統合して前記担当領域の検出データを生成する検出データ生成部と
を備える。
【発明の効果】
【０００７】
この発明は、担当センサに割り当てられた担当領域における、担当センサでは検出されていない欠落領域について、他のセンサによって取得されたセンサデータを用いて補間する。これにより、効率的にセンサデータを統合することができる。
【図面の簡単な説明】
【０００８】
【図１】実施の形態１に係るセンサデータ統合装置１０の構成図。
【図２】実施の形態１に係るセンサ位置記憶部３１に記憶される情報を示す図。
【図３】実施の形態１に係る担当領域記憶部３２に記憶される情報を示す図。
【図４】実施の形態１に係る担当領域４２の例の説明図。
【図５】実施の形態１に係る担当領域４２の例の説明図。
【図６】実施の形態１に係るセンサデータ統合装置１０の動作のフローチャート。
【図７】実施の形態１に係るセンサデータの説明図。
【図８】実施の形態１に係る欠落領域４５の説明図。
【図９】実施の形態１に係る補間データ抽出処理の説明図。
【図１０】変形例２に係るセンサデータ統合装置１０の構成図。
【図１１】実施の形態２に係るセンサデータ統合装置１０の動作のフローチャート。
【発明を実施するための形態】
【０００９】
実施の形態１．
＊＊＊構成の説明＊＊＊
図１を参照して、実施の形態１に係るセンサデータ統合装置１０の構成を説明する。
図１では、センサデータ統合装置１０が移動体１００に搭載された状態が示されている。移動体１００は、車両、船舶等である。実施の形態１では、移動体１００は、車両である。
なお、センサデータ統合装置１０は、移動体１００又は図示した他の構成要素と、一体化した形態又は分離不可能な形態で実装されてもよいし、取り外し可能な形態又は分離可能な形態で実装されてもよい。
【００１０】
センサデータ統合装置１０は、コンピュータである。
センサデータ統合装置１０は、プロセッサ１１と、メモリ１２と、ストレージ１３と、センサインタフェース１４とのハードウェアを備える。プロセッサ１１は、信号線を介して他のハードウェアと接続され、これら他のハードウェアを制御する。
【００１１】
プロセッサ１１は、プロセッシングを行うＩＣ（Ｉｎｔｅｇｒａｔｅｄ  Ｃｉｒｃｕｉｔ）である。プロセッサ１１は、具体例としては、ＣＰＵ（Ｃｅｎｔｒａｌ  Ｐｒｏｃｅｓｓｉｎｇ  Ｕｎｉｔ）、ＤＳＰ（Ｄｉｇｉｔａｌ  Ｓｉｇｎａｌ  Ｐｒｏｃｅｓｓｏｒ）、ＧＰＵ（Ｇｒａｐｈｉｃｓ  Ｐｒｏｃｅｓｓｉｎｇ  Ｕｎｉｔ）である。
【００１２】
メモリ１２は、データを一時的に記憶する記憶装置である。メモリ１２は、具体例としては、ＳＲＡＭ（Ｓｔａｔｉｃ  Ｒａｎｄｏｍ  Ａｃｃｅｓｓ  Ｍｅｍｏｒｙ）、ＤＲＡＭ（Ｄｙｎａｍｉｃ  Ｒａｎｄｏｍ  Ａｃｃｅｓｓ  Ｍｅｍｏｒｙ）である。
【００１３】
ストレージ１３は、データを保管する記憶装置である。ストレージ１３は、具体例としては、ＨＤＤ（Ｈａｒｄ  Ｄｉｓｋ  Ｄｒｉｖｅ）である。また、ストレージ１３は、ＳＤ（登録商標，Ｓｅｃｕｒｅ  Ｄｉｇｉｔａｌ）メモリカード、ＣＦ（ＣｏｍｐａｃｔＦｌａｓｈ）、ＮＡＮＤフラッシュ、フレキシブルディスク、光ディスク、コンパクトディスク、ブルーレイ（登録商標）ディスク、ＤＶＤ（Ｄｉｇｉｔａｌ  Ｖｅｒｓａｔｉｌｅ  Ｄｉｓｋ）といった可搬記憶媒体であってもよい。
【００１４】
センサインタフェース１４は、移動体１００に搭載されたセンサ１０１と通信するためのインタフェースである。具体例としては、センサインタフェース１４は、センサデータ取得ＬＳＩ（Ｌａｒｇｅ  Ｓｃａｌｅ  Ｉｎｔｅｇｒａｔｉｏｎ）である。
図１では、センサインタフェース１４は、センサ１０１Ａ〜センサ１０１Ｃの３台のセンサ１０１と接続されている。センサインタフェース１４は、複数のセンサ１０１と接続されていればよく、３台に限定されるものではない。実施の形態１では、センサ１０１は、ＬｉＤＡＲであるとする。
【００１５】
センサデータ統合装置１０は、機能構成要素として、データ取得部２１と、位置計算部２２と、欠落領域特定部２３と、補間データ抽出部２４と、位置変換部２５と、検出データ生成部２６とを備える。データ取得部２１と、位置計算部２２と、欠落領域特定部２３と、補間データ抽出部２４と、位置変換部２５と、検出データ生成部２６との機能はソフトウェアにより実現される。
ストレージ１３には、データ取得部２１と、位置計算部２２と、欠落領域特定部２３と、補間データ抽出部２４と、位置変換部２５と、検出データ生成部２６との機能を実現するプログラムが記憶されている。このプログラムは、プロセッサ１１によりメモリ１２に読み込まれ、プロセッサ１１によって実行される。これにより、データ取得部２１と、位置計算部２２と、欠落領域特定部２３と、補間データ抽出部２４と、位置変換部２５と、検出データ生成部２６との機能が実現される。
また、ストレージ１３は、センサ位置記憶部３１と、担当領域記憶部３２との機能を実現する。
【００１６】
図１では、プロセッサ１１は、１つだけ示されている。しかし、センサデータ統合装置１０は、プロセッサ１１を代替する複数のプロセッサを備えていてもよい。これら複数のプロセッサは、データ取得部２１と、位置計算部２２と、欠落領域特定部２３と、補間データ抽出部２４と、位置変換部２５と、検出データ生成部２６との機能を実現するプログラムの実行を分担する。
【００１７】
＊＊＊動作の説明＊＊＊
図２から図９を参照して、実施の形態１に係るセンサデータ統合装置１０の動作を説明する。
実施の形態１に係るセンサデータ統合装置１０の動作は、実施の形態１に係るセンサデータ統合方法に相当する。また、実施の形態１に係るセンサデータ統合装置１０の動作は、実施の形態１に係るセンサデータ統合プログラムの処理に相当する。
【００１８】
図２を参照して、実施の形態１に係るセンサ位置記憶部３１に記憶される情報を説明する。
センサ位置記憶部３１には、センサ１０１毎に、そのセンサ１０１の相対位置情報４１が記憶される。実施の形態１では、相対位置情報４１として、変換行列が記憶される。変換行列は、センサ１０１で取得されたセンサデータの座標系をグローバル座標系に変換するための行列であり、座標系の回転及び並進を示す行列である。
【００１９】
図３を参照して、実施の形態１に係る担当領域記憶部３２に記憶される情報を説明する。
担当領域記憶部３２には、センサ１０１毎に、そのセンサ１０１に割り当てられた担当領域４２が記憶される。担当領域４２は、センサ１０１が障害物といった物体の検出を担当する領域である。担当領域４２は、例えば、センサ１０１の位置を基準とする相対座標系で表される。
【００２０】
図４を参照して、実施の形態１に係る担当領域４２の例を説明する。
図４では、鉛直方向上側から見た状態が示されている。センサ１０１Ａが検出可能な領域４３Ａと、センサ１０１Ｂが検出可能な領域４３Ｂとは、重複領域４４部分が重複している。このような場合には、例えば、重複領域４４内の各位置については、その位置に近い方のセンサ１０１の担当領域４２とする。
具体的には、センサ１０１Ａとセンサ１０１Ｂとを結ぶ直線Ｌ１の垂直二等分線Ｌ２が引かれる。垂直二等分線Ｌ２をセンサ１０１Ａを通るように平行移動させた直線を直線Ｌ３とする。直線Ｌ１に対する直線Ｌ３の鉛直軸回りの角度を角度θ１とする。そして、角度θ１以上θ１＋π以下の領域のうち、センサ１０１Ａが検出可能な領域４３Ａに含まれる領域は、センサ１０１Ａの担当領域４２Ａとする。また、その他のセンサ１０１Ａが検出可能な領域４３Ａのうち、垂直二等分線Ｌ２よりもセンサ１０１Ａ側の領域についても、センサ１０１Ａの担当領域４２Ａとする。
そして、センサ１０１Ｂが検出可能な領域４３Ｂのうち、センサ１０１Ａの担当領域４２Ａを除いた領域を担当領域４２Ｂとする。
【００２１】
図５を参照して、実施の形態１に係る担当領域４２の別の例を説明する。
図５では、図４と同様に、鉛直方向上側から見た状態が示されている。図４の場合と同様に、センサ１０１Ａが検出可能な領域４３Ａと、センサ１０１Ｂが検出可能な領域４３Ｂとは、重複領域４４部分が重複している。このような場合には、例えば、重複領域４４については一方のセンサ１０１の担当領域４２とする。
具体的には、センサ１０１Ａが検出可能な領域４３Ａを、センサ１０１Ａの担当領域４２Ａとする。そして、センサ１０１Ｂが検出可能な領域４３Ｂのうち、重複領域４４を除いた領域を担当領域４２Ｂとする。
【００２２】
なお、各センサ１０１の担当領域４２が一部重複していてもよい。
【００２３】
図６を参照して、実施の形態１に係るセンサデータ統合装置１０の動作を説明する。
図６に示す処理の前提として、センサ位置記憶部３１及び担当領域記憶部３２には、上述した情報が記憶されているものとする。
【００２４】
（ステップＳ１１：データ取得処理）
データ取得部２１は、センサインタフェース１４を介して、各センサ１０１によって取得されたセンサデータを取得する。データ取得部２１は、取得されたセンサデータを、メモリ１２に書き込む。
上述した通り、実施の形態１では、ＬｉＤＡＲである。ＬｉＤＡＲは、レーザの照射角を少しずつずらしながら、パルス状に発光するレーザを照射する。ＬｉＤＡＲは、レーザに対する散乱光を測定して、センサデータを取得する。そのため、データ取得部２１は、各センサ１０１から、順序付けされた複数のセンサデータを取得することになる。
図７に示すように、各センサデータは、センサ１０１の位置を中心として、各角度（θ，ω）における物体までの距離ｍを示す。
【００２５】
（ステップＳ１２：位置計算処理）
位置計算部２２は、ステップＳ１１で取得された各センサデータが示す３次元位置を計算する。
具体的には、位置計算部２２は、メモリ１２から各センサデータを読み出す。位置計算部２２は、センサデータが示す角度（θ，ω）と距離ｍとから、センサデータの取得元のセンサ１０１の位置を基準とする、ｘ軸における距離Ｘと、ｙ軸における距離Ｙと、ｚ軸における距離Ｚとを計算する。ｘ軸における距離Ｘは、“Ｘ＝ｍ×ｃｏｓ（ω）×ｃｏｓ（θ）”により計算できる。ｙ軸における距離Ｙは、“Ｙ＝ｍ×ｃｏｓ（ω）×ｓｉｎ（θ）”により計算できる。ｚ軸における距離Ｚは、“Ｚ＝ｍ×ｓｉｎ（ω）”により計算できる。位置計算部２２は、計算された３次元位置をメモリ１２に書き込む。
【００２６】
ステップＳ１３からステップＳ１９の処理は、各センサ１０１を担当センサとして実行される。
【００２７】
（ステップＳ１３：領域特定処理）
欠落領域特定部２３は、担当センサに割り当てられた担当領域４２において、担当センサによって取得されたセンサデータである担当データでは検出されていない欠落領域４５を特定する。つまり、欠落領域特定部２３は、担当センサからの死角となっているといった理由により、担当データが欠落している欠落領域４５を特定する。すなわち、欠落領域４５は、担当センサでは検出できなかった担当領域４２内の領域である。
具体的には、欠落領域特定部２３は、担当領域記憶部３２から担当センサに対応する担当領域４２を読み出す。欠落領域特定部２３は、担当センサによって取得されたセンサデータである担当データについての３次元位置うち、担当領域４２内の３次元位置をメモリ１２から読み出す。図８に示すように、欠落領域特定部２３は、隣接する担当データが示す位置間の距離が第１閾値以上に離れている領域を欠落領域４５として特定する。図８では、距離Ｄ１と距離Ｄ２との差が第１閾値以上であるため、センサデータＡ１とセンサデータＡ２との間は欠落領域４５として特定される。欠落領域特定部２３は、特定された欠落領域４５をメモリ１２に書き込む。
第１閾値は、事前に設定されメモリ１２に記憶されている。第１閾値は、センサ１０１の距離の検出精度等に応じて設定される。
【００２８】
（ステップＳ１４：補間データ抽出処理）
補間データ抽出部２４は、ステップＳ１３で特定された欠落領域４５を検出したセンサデータであって、担当センサ以外のセンサ１０１によって取得されたセンサデータを補間データとして抽出する。
具体的には、補間データ抽出部２４は、メモリ１２から欠落領域４５を読み出す。補間データ抽出部２４は、センサ位置記憶部３１に記憶された相対位置情報に基づき、欠落領域４５に対応する他のセンサ１０１の角度を計算する。補間データ抽出部２４は、計算された角度についてのセンサデータを補間データとして抽出する。
【００２９】
図８を参照して具体的に説明する。
ここでは、センサ１０１Ａを担当センサとする。また、センサ１０１Ａの座標系をグローバル座標系とする。また、グローバル座標系に対するセンサ１０１Ｂの相対位置を表す変換行列を変換行列Ｒとする。つまり、変換行列Ｒは、センサ１０１Ｂ座標系をセンサ１０１Ａの座標系に変換する行列である。したがって、センサ１０１Ｂの座標系のセンサデータＢに変換行列Ｒを乗じることにより、センサデータＢをセンサ１０１Ａの座標系のセンサデータＡに変換することができる。つまり、Ａ＝ＲＢである。
センサ１０１Ａにおける欠落領域４５の両端の２点は、センサデータＡ１とセンサデータＡ２である。補間データ抽出部２４は、Ａ１＝ＲＢ１により、センサデータＡ１に対応するセンサ１０１ＢにおけるセンサデータＢ１を特定する。同様に、補間データ抽出部２４は、Ａ２＝ＲＢ２により、センサデータＡ２に対応するセンサ１０１ＢにおけるセンサデータＢ２を特定する。補間データ抽出部２４は、センサデータＢ１及びセンサデータＢ２の角度（θ，ω）を特定することにより、欠落領域４５の両端の２点に対応するセンサ１０１Ｂの座標系における角度（θ，ω）を特定する。そして、補間データ抽出部２４は、特定された欠落領域４５の両端の２点の間のセンサデータの間のセンサデータを補間データとして抽出する。
【００３０】
例えば、図９に示すように、ステップＳ１１でデータ取得部２１は、各センサデータを、角度θと角度ωとを行及び列とするテーブルの対応する欄に格納しておく。そして、補間データ抽出部２４は、テーブル上で欠落領域４５の両端の２点の欄を結ぶ直線を引いたときに通過する欄のセンサデータを補間データとして抽出する。
つまり、図９において、センサデータＢ１の角度（θＢ１，ωＢ１）の欄と、センサデータＢ２の角度（θＢ２，ωＢ２）の欄とを結んだ直線が通る欄（ハッチングを付した欄）のセンサデータが補間データとして抽出される。
【００３１】
（ステップＳ１５：位置変換処理）
位置変換部２５は、担当データの位置の座標系と、ステップＳ１４で抽出された補間データの位置の座標系を、グローバル座標系に変換する。
具体的には、位置変換部２５は、センサ位置記憶部３１に記憶された相対位置情報である変換行列により、座標系を変換する。
【００３２】
（ステップＳ１６：検出データ生成処理）
検出データ生成部２６は、担当データと、ステップＳ１５で座標系が変換された補間データとを統合して担当領域４２の検出データを生成する。
【００３３】
＊＊＊実施の形態１の効果＊＊＊
以上のように、実施の形態１に係るセンサデータ統合装置１０は、担当センサに割り当てられた担当領域４２における、担当センサでは検出されていない欠落領域４５について、他のセンサ１０１によって取得されたセンサデータを用いて補間する。これにより、効率的にセンサデータを統合することができる。
つまり、全体としての処理負荷を軽減しつつ、欠落領域４５については他のセンサ１０１により取得されたセンサデータで補間するため、物体の位置及び形状を適切に特定することができる。
【００３４】
＊＊＊他の構成＊＊＊
＜変形例１＞
実施の形態１では、センサ１０１は、ＬｉＤＡＲであるとした。しかし、センサ１０１は、ＬｉＤＡＲに限らず、位置を検出するセンサであれば、他のセンサであってもよい。
【００３５】
＜変形例２＞
実施の形態１では、データ取得部２１と、位置計算部２２と、欠落領域特定部２３と、補間データ抽出部２４と、位置変換部２５と、検出データ生成部２６との機能がソフトウェアで実現された。しかし、変形例２として、データ取得部２１と、位置計算部２２と、欠落領域特定部２３と、補間データ抽出部２４と、位置変換部２５と、検出データ生成部２６との機能はハードウェアで実現されてもよい。この変形例２について、実施の形態１と異なる点を説明する。
【００３６】
図１０を参照して、変形例２に係るセンサデータ統合装置１０の構成を説明する。
データ取得部２１と、位置計算部２２と、欠落領域特定部２３と、補間データ抽出部２４と、位置変換部２５と、検出データ生成部２６との機能がハードウェアで実現される場合、センサデータ統合装置１０は、プロセッサ１１とメモリ１２とストレージ１３とに代えて、処理回路１５を備える。処理回路１５は、データ取得部２１と、位置計算部２２と、欠落領域特定部２３と、補間データ抽出部２４と、位置変換部２５と、検出データ生成部２６との機能と、メモリ１２とストレージ１３との機能とを実現する専用の電子回路である。
【００３７】
処理回路１５は、単一回路、複合回路、プログラム化したプロセッサ、並列プログラム化したプロセッサ、ロジックＩＣ、ＧＡ（Ｇａｔｅ  Ａｒｒａｙ）、ＡＳＩＣ（Ａｐｐｌｉｃａｔｉｏｎ  Ｓｐｅｃｉｆｉｃ  Ｉｎｔｅｇｒａｔｅｄ  Ｃｉｒｃｕｉｔ）、ＦＰＧＡ（Ｆｉｅｌｄ−Ｐｒｏｇｒａｍｍａｂｌｅ  Ｇａｔｅ  Ａｒｒａｙ）が想定される。
処理回路１５の機能を１つの処理回路１５で実現してもよいし、データ取得部２１と、位置計算部２２と、欠落領域特定部２３と、補間データ抽出部２４と、位置変換部２５と、検出データ生成部２６との機能を複数の処理回路１５に分散させて実現してもよい。
【００３８】
＜変形例３＞
変形例３として、一部の機能がハードウェアで実現され、他の機能がソフトウェアで実現されてもよい。つまり、処理回路１５のうち、一部の機能がハードウェアで実現され、他の機能がソフトウェアで実現されてもよい。
【００３９】
プロセッサ１１とメモリ１２とストレージ１３と処理回路１５とを、総称して「プロセッシングサーキットリー」という。つまり、各機能構成要素の機能は、プロセッシングサーキットリーにより実現される。
【００４０】
実施の形態２．
実施の形態２は、センサ１０１から遠い領域についても他のセンサ１０１のセンサデータにより補間する点が実施の形態１と異なる。実施の形態２では、この異なる点を説明し、同じ点については説明を省略する。
【００４１】
＊＊＊動作の説明＊＊＊
図１１を参照して、実施の形態２に係るセンサデータ統合装置１０の動作を説明する。
実施の形態２に係るセンサデータ統合装置１０の動作は、実施の形態２に係るセンサデータ統合方法に相当する。また、実施の形態２に係るセンサデータ統合装置１０の動作は、実施の形態２に係るセンサデータ統合プログラムの処理に相当する。
【００４２】
ステップＳ２１からステップＳ２２の処理は、図６のステップＳ１１からステップＳ１２の処理と同じである。また、ステップＳ２５からステップＳ２６の処理は、図６のステップＳ１５からステップＳ１６の処理と同じである。
【００４３】
（ステップＳ２３：領域特定処理）
欠落領域特定部２３は、実施の形態１と同様に欠落領域４５を特定する。
欠落領域特定部２３は、担当センサに割り当てられた担当領域４２において、担当データによって検出された領域のうち、担当センサからの距離が第２閾値以上に離れている領域を遠方領域４６として特定する。
【００４４】
（ステップＳ２４：補間データ抽出処理）
補間データ抽出部２４は、ステップＳ２４で特定された欠落領域４５及び遠方領域４６を検出したセンサデータであって、担当センサ以外のセンサ１０１によって取得されたセンサデータを補間データとして抽出する。
遠方領域４６についての補間データの抽出方法は、欠落領域４５についての補間データの抽出方法と同じである。つまり、遠方領域４６の両端の２点のセンサデータの角度（θ，ω）を特定し、その間のセンサデータを補間データとして抽出すればよい。
【００４５】
＊＊＊実施の形態２の効果＊＊＊
以上のように、実施の形態２に係るセンサデータ統合装置１０は、欠落領域４５だけでなく、遠方領域４６についても他のセンサ１０１によって取得されたセンサデータを用いて補間する。
ＬｉＤＡＲといったセンサ１０１では、センサ１０１からの距離が遠くなるにつれ、隣接する点間の距離が広がることにより、特定される形状が荒くなってしまう。しかし、センサ１０１からの距離が遠い遠方領域４６については他のセンサ１０１により取得されたセンサデータで補間するため、物体の形状を適切に特定することができる。
【符号の説明】
【００４６】
１０  センサデータ統合装置、１１  プロセッサ、１２  メモリ、１３  ストレージ、１４  センサインタフェース、１５  処理回路、２１  データ取得部、２２  位置計算部、２３  欠落領域特定部、２４  補間データ抽出部、２５  位置変換部、２６  検出データ生成部、３１  センサ位置記憶部、３２  担当領域記憶部、４１  相対位置情報、４２  担当領域、４３  検出可能な領域、４４  重複領域、４５  欠落領域、４６  遠方領域、１００  移動体、１０１  センサ。
【要約】
欠落領域特定部（２３）は、位置を検出する担当センサに割り当てられた担当領域において、担当センサによって取得されたセンサデータである担当データでは検出されていない欠落領域を特定する。補間データ抽出部（２４）は、欠落領域を検出したセンサデータであって、担当センサ以外のセンサによって取得されたセンサデータを補間データとして抽出する。検出データ生成部（２６）は、担当データと、補間データとを統合して担当領域の検出データを生成する。【図１】
0006257868.tif 000002
【図２】
0006257868.tif 000003
【図３】
0006257868.tif 000004
【図４】
0006257868.tif 000005
【図５】
0006257868.tif 000006
【図６】
0006257868.tif 000007
【図７】
0006257868.tif 000008
【図８】
0006257868.tif 000009
【図９】
0006257868.tif 000010
【図１０】
0006257868.tif 000011
【図１１】
0006257868.tif 000012