JP2022175094A - 追跡装置 - Google Patents
追跡装置 Download PDFInfo
- Publication number
- JP2022175094A JP2022175094A JP2021081239A JP2021081239A JP2022175094A JP 2022175094 A JP2022175094 A JP 2022175094A JP 2021081239 A JP2021081239 A JP 2021081239A JP 2021081239 A JP2021081239 A JP 2021081239A JP 2022175094 A JP2022175094 A JP 2022175094A
- Authority
- JP
- Japan
- Prior art keywords
- target
- hypothesis
- tracer
- observation
- tracking device
- 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.)
- Pending
Links
- 238000009826 distribution Methods 0.000 claims abstract description 114
- 239000000700 radioactive tracer Substances 0.000 claims description 118
- 238000012545 processing Methods 0.000 claims description 64
- 238000013138 pruning Methods 0.000 claims description 14
- 238000004364 calculation method Methods 0.000 claims description 12
- 230000010354 integration Effects 0.000 claims description 4
- 239000000203 mixture Substances 0.000 claims description 3
- 238000000034 method Methods 0.000 abstract description 51
- 238000001514 detection method Methods 0.000 description 40
- 230000008569 process Effects 0.000 description 40
- 238000010586 diagram Methods 0.000 description 10
- 230000006870 function Effects 0.000 description 9
- 230000000694 effects Effects 0.000 description 8
- 238000005070 sampling Methods 0.000 description 5
- 238000007796 conventional method Methods 0.000 description 4
- 238000004088 simulation Methods 0.000 description 4
- 238000004880 explosion Methods 0.000 description 3
- 230000000644 propagated effect Effects 0.000 description 3
- 230000008859 change Effects 0.000 description 2
- 238000004590 computer program Methods 0.000 description 2
- 238000010606 normalization Methods 0.000 description 2
- 239000004065 semiconductor Substances 0.000 description 2
- 230000001133 acceleration Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 230000007423 decrease Effects 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 239000000284 extract Substances 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000000926 separation method Methods 0.000 description 1
- 230000004083 survival effect Effects 0.000 description 1
- 230000002194 synthesizing effect Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/88—Radar or analogous systems specially adapted for specific applications
- G01S13/93—Radar or analogous systems specially adapted for specific applications for anti-collision purposes
- G01S13/931—Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/66—Radar-tracking systems; Analogous systems
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/66—Radar-tracking systems; Analogous systems
- G01S13/72—Radar-tracking systems; Analogous systems for two-dimensional tracking, e.g. combination of angle and range tracking, track-while-scan radar
- G01S13/723—Radar-tracking systems; Analogous systems for two-dimensional tracking, e.g. combination of angle and range tracking, track-while-scan radar by using numerical data
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/66—Tracking systems using electromagnetic waves other than radio waves
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/88—Lidar systems specially adapted for specific applications
- G01S17/93—Lidar systems specially adapted for specific applications for anti-collision purposes
- G01S17/931—Lidar systems specially adapted for specific applications for anti-collision purposes of land vehicles
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S15/00—Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
- G01S15/66—Sonar tracking systems
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S15/00—Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
- G01S15/88—Sonar systems specially adapted for specific applications
- G01S15/93—Sonar systems specially adapted for specific applications for anti-collision purposes
- G01S15/931—Sonar systems specially adapted for specific applications for anti-collision purposes of land vehicles
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/88—Radar or analogous systems specially adapted for specific applications
- G01S13/93—Radar or analogous systems specially adapted for specific applications for anti-collision purposes
- G01S13/931—Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
- G01S2013/9323—Alternative operation using light waves
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/88—Radar or analogous systems specially adapted for specific applications
- G01S13/93—Radar or analogous systems specially adapted for specific applications for anti-collision purposes
- G01S13/931—Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
- G01S2013/9324—Alternative operation using ultrasonic waves
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- General Physics & Mathematics (AREA)
- Electromagnetism (AREA)
- Radar Systems Or Details Thereof (AREA)
- Optical Radar Systems And Details Thereof (AREA)
Abstract
【課題】トラッキングの精度を維持しつつ演算量を抑制する技術を提供する。【解決手段】S130では、追跡装置20は、観測情報と予測分布が示す観測情報との距離に従って、現存追跡子のそれぞれに、観測点を排他的に割り当てる。S150では、追跡装置20は、対象追跡子毎に、第1の仮説及び第2の仮説を含む仮説群に属する仮説のそれぞれについて、仮説の尤度である仮説尤度、及び仮説が正しいと仮定して更新した状態分布を生成する。第1の仮説は、対象観測点が、対象物標を観測した結果であるとする仮説である。第2の仮説は、対象観測点が対象物標を観測した結果ではないとする仮説である。対象追跡子は、観測点が割り当てられた現存追跡子である。対象観測点は、対象追跡子に割り当てられた観測点である。対象物標は、対象追跡子に対応づけられる物標である。【選択図】図6
Description
本開示は、物標を追跡する追跡装置に関する。
追跡中の物標候補を表す追跡子の状態を、観測点の情報を用いて逐次更新するトラッキングとして、NNトラッキング、及びRFSトラッキングが知られている。NNは、Nearest Neighborの略であり、RFSは、Random Finite Setの略である。
NNトラッキングでは、追跡子の状態の更新に、追跡子に最も近い1つの観測点の情報を用いる。RFSトラッキングでは、RFS追跡子から一定の範囲内にあるすべての観測点の情報を用いる。RFSトラッキングは、例えば、特許文献1に開示されている。
NNトラッキングでは、追跡子の状態の更新に、追跡子に最も近い1つの観測点の情報を用いる。RFSトラッキングでは、RFS追跡子から一定の範囲内にあるすべての観測点の情報を用いる。RFSトラッキングは、例えば、特許文献1に開示されている。
RFSトラキングでは、複数の観測点それぞれの検知確率と、複数の追跡子それぞれの存在確率を用いて、複数の追跡子と複数の観測点との対応関係を表す複数の仮説を生成し、各仮説の尤度演算を行い、すべての仮説を考慮したトラッキングが実行される。また、各仮説に従って更新される追跡子の状態を、各仮説の尤度を用いて畳み込むことで、次回の処理サイクルに伝搬する仮説の数を削減する手法も知られている。
しかしながら、発明者の詳細な検討の結果、RFSトラッキングでは、観測点や追跡子の数が増加するに従って仮説の数、ひいてはトラッキングに要する演算量、特に仮説の尤度の算出に要する演算量が指数関数的に増大する。その結果、RFSトラッキングは、リアルタイムでの処理が要求される車載の追跡装置等への適用が困難であるという課題が見出された。
本開示の1つの局面は、トラッキングの精度を維持しつつ演算量を抑制する技術を提供する。
本開示の1つの局面は、追跡装置であって、情報取得部(20:S100)と、追跡子生成部(20:S180)と、状態予測部(20:S110)と、状態更新部(20:S130~S170)と、を備える。
情報取得部は、処理サイクル毎に、車両の周囲に存在する物標の状態を観測するセンサから観測情報を取得するように構成される。追跡子生成部は、情報取得部により観測情報が取得された1つ以上の観測点である観測点群のうち、予め設定された生成条件を満たす観測点について、観測情報の状態を確率的に示した状態分布を有する追跡子を生成するように構成される。状態予測部は、前回の処理サイクルまでに生成された追跡子である現存追跡子のそれぞれについて、現存追跡子が有する状態分布から、現存追跡子の今回の処理サイクルでの観測情報の状態を予測した状態分布である予測分布を生成するように構成される。状態更新部は、現存追跡子のそれぞれについて、状態予測部にて生成された予測分布、及び今回の処理サイクルで得られた観測点群の観測情報を用いて、現存追跡子が有する状態分布を更新するように構成される。
また、状態更新部は、観測割当部(20:S130,S144)と、仮説生成部(20:S310~S320)と、を備える。
観測割当部は、情報取得部にて取得された観測情報と予測分布が示す観測情報との距離に従って、現存追跡子のそれぞれに、観測点を排他的に割り当てるように構成される。仮説生成部は、対象追跡子毎に、第1の仮説、及び第2の仮説を含む仮説群に属する仮説のそれぞれについて、仮説の尤度である仮説尤度、及び仮説が正しいと仮定して更新した状態分布である仮説分布を生成するように構成される。第1の仮説は、対象観測点が対象物標を観測した結果であるとする仮説である。第2の仮説は、対象観測点が対象物標を観測した結果ではないとする仮説である。対象追跡子は、観測割当部により観測点が割り当てられた現存追跡子である。対象観測点は、対象追跡子に割り当てられた観測点である。対象物標は、対象追跡子に対応づけられる物標である。
観測割当部は、情報取得部にて取得された観測情報と予測分布が示す観測情報との距離に従って、現存追跡子のそれぞれに、観測点を排他的に割り当てるように構成される。仮説生成部は、対象追跡子毎に、第1の仮説、及び第2の仮説を含む仮説群に属する仮説のそれぞれについて、仮説の尤度である仮説尤度、及び仮説が正しいと仮定して更新した状態分布である仮説分布を生成するように構成される。第1の仮説は、対象観測点が対象物標を観測した結果であるとする仮説である。第2の仮説は、対象観測点が対象物標を観測した結果ではないとする仮説である。対象追跡子は、観測割当部により観測点が割り当てられた現存追跡子である。対象観測点は、対象追跡子に割り当てられた観測点である。対象物標は、対象追跡子に対応づけられる物標である。
このような構成によれば、一つの観測点が複数の追跡子に割り当てられることがないため、追跡子と観測点との組み合わせの数、すなわち仮説の数が削減され、追跡処理の演算負荷を軽減できる。
以下、図面を参照しながら、本開示の実施形態を説明する。
[1.第1実施形態]
[1-1.構成]
本実施形態のレーダシステム1は、車両に搭載され、当該レーダシステム1を搭載する車両の周囲に存在する種々の物標を検出するために用いられる。
[1.第1実施形態]
[1-1.構成]
本実施形態のレーダシステム1は、車両に搭載され、当該レーダシステム1を搭載する車両の周囲に存在する種々の物標を検出するために用いられる。
検知エリアは、例えば車両の前方に設定される。但し、検知エリアは、車両の前方に限定されるものではなく、車両の後方、右側方、左側方、右前方、右後方、左前方、左後方のいずれかが検知エリアとなるように一つ又は複数設定されてもよい。また、検知エリアが複数存在する場合、各検知エリアは互いに異なるように設定されてもよいし、検知エリアの一部が互いに重なり合うように設定されてもよい。
図1に示すように、レーダシステム1は、レーダセンサ10と、追跡装置20とを備える。
レーダセンサ10は、検知エリアにレーザ光を照射し、反射光を受光することで、レーザ光を反射した点を表す観測点の位置情報を生成するLiDARが用いられる。LiDARは、Light Detection and Rangingの略である。但し、レーダセンサ10は、LiDARに限定されるものではなく、観測点の位置情報が得られればよく、ミリ波レーダ、超音波レーダ等であってもよい。
レーダセンサ10は、検知エリアにレーザ光を照射し、反射光を受光することで、レーザ光を反射した点を表す観測点の位置情報を生成するLiDARが用いられる。LiDARは、Light Detection and Rangingの略である。但し、レーダセンサ10は、LiDARに限定されるものではなく、観測点の位置情報が得られればよく、ミリ波レーダ、超音波レーダ等であってもよい。
検知エリアは、例えば車両の前方に設定される。但し、検知エリアは、車両の前方に限定されるものではなく、車両の後方、右側方、左側方、右前方、右後方、左前方、左後方のいずれかが検知エリアとなるように一つ又は複数設定されてもよい。検知エリアが複数存在する場合、検知エリア毎にレーダセンサ10を備えてもよい。各検知エリアは互いに重なり合うことがないように設定されてもよいし、検知エリアの一部が互いに重なり合うように設定されてもよい。検知エリアの範囲は、水平角度範囲θh及び垂直角度範囲θvによって規定される。
レーダセンサ10は、検知エリア内を、水平方向には角度分解能Δθh、垂直方向には角度分解能Δθで走査する。すなわち、レーダセンサ10は、予め設定された処理サイクル毎に、検知エリア内に、(θh/Δθh)×(θv/Δθv)本の光線を照射し、光線毎に所定回のサンプリングを実施する。サンプリング間隔は、指定された距離分解能ΔRを満たすように設定される。つまり、レーダセンサ10は、最大検距離Rmaxを光が往復するのに要する時間を、サンプリング間隔で除した回数(すなわち、2×Rmax/c/ΔR回)のサンプリングを1秒間に実行する。
そして、光線毎にサンプリングされた値によって示される波形から、ピーク閾値以上の信号強度を有するピークを抽出して、そのピークのサンプリングタイミング(すなわち距離)、照射した光線の水平角度及び垂直角度を用いて、観測点の位置情報を生成する。ピーク閾値は、所望のS/Nが得られるように設定される。位置情報は、必ずしも、距離、水平角度、垂直角度を用いた3次元の極座標系で表されている必要はなく、3次元の直交座標系で表されてもよい。
追跡装置20は、CPU21と、RAM、ROM、フラッシュメモリ等の半導体メモリ(以下、メモリ22)とを有するマイクロコンピュータを備える。追跡装置20は、コプロセッサを備えてもよい。
追跡装置20は、CPU21がメモリ22に記憶されたプログラムを実行することで、少なくとも追跡処理を実行する。
追跡処理は、レーダセンサ10から得られる観測点の位置情報に基づいて、検知エリア内に存在する物標に関する情報である物標情報を生成する。
追跡処理は、レーダセンサ10から得られる観測点の位置情報に基づいて、検知エリア内に存在する物標に関する情報である物標情報を生成する。
追跡処理によって生成された物標情報は、運転支援のために実施される種々の処理や、レーダセンサ10の軸ずれを推定する処理等に用いられる。運転支援には、例えば、車間距離制御(すなわち、ACC)、車線維持支援(すなわち、LKA)、車線変更支援(すなわち、LCA)、車線逸脱警報、追越支援、介入制御、自動制動、及び自動運転等が含まれる。ACCは、Auto Cruise Controlの略であり、LKAは、Lane Keeping Assistの略であり、LCAはLane Change Assistの略である。
[1-2.トラッキングの概要]
追跡処理にて採用するRFSトラッキングの一種であるFMBフィルタを用いた処理(以下、FMB)の概要について説明する。FMBは、PMBフィルタを用いた既存の処理(以下、PNB)を改良して処理を高速化した手法である。FMBは、Fast Multi-Bernoulliの略であり、PMBは、Poisson Multi-Bernoulliの略である。
追跡処理にて採用するRFSトラッキングの一種であるFMBフィルタを用いた処理(以下、FMB)の概要について説明する。FMBは、PMBフィルタを用いた既存の処理(以下、PNB)を改良して処理を高速化した手法である。FMBは、Fast Multi-Bernoulliの略であり、PMBは、Poisson Multi-Bernoulliの略である。
ここでは、推定する物標の状態として、物標の位置を用いる。但し、推定する物標の状態は、位置に限られるものではない。また、ここでは、理解を容易にするため、2つの物標を追跡子A,Bで追跡中に、2つの観測点が得られた場合を例にして説明する。
RFSトラッキングでは、図2に示すように、2つの追跡子A,Bと2つの観測点との組み合わせを表す7個の仮説が考慮される。すなわち、仮説iをKi(追跡子Aを観測した観測点,追跡子Bを観測した観測点)で表し、2つの観測点を「観1」,「観2」、いずれの観測点にも対応しない場合を「未」で表すものとする。7個の仮説は、K1(観1,観2)、K2(未,観2)、K3(観1,未)、K4(観2,観1)、K5(未,観1)、K6(観2,未)、K7(未,未)となる。
そして、PMBでは、仮説K1~K7のそれぞれについて、状態分布及び仮説尤度を算出し、算出した仮説尤度を用いて全ての仮説K1~K7の状態分布を畳みこむことで、仮説K1~K7を一つに統合する。なお、状態分布は、追跡子の状態(すなわち、位置)を確率的に表した分布である。状態分布には、例えば、ガウス分布が用いられる。状態分布は、観測によって得られる観測情報に基づき拡張カルマンフィルタ(以下、EKF)等を用いて前回の処理サイクルで得られた状態分布を更新することで算出される。但し、前回の処理サイクルで得られた状態分布に対して、仮説毎に、各仮説が正しいと仮定して更新された状態分布がそれぞれ生成される。仮説尤度は、着目する仮説のもっともらしさを表す値である。仮説尤度は、追跡子から観測点までの近さ、観測に用いたセンサの誤差、検知確率、誤検知確率、前回の処理サイクルでの追跡子の存在確率等から算出される。
次に、前述の処理を、n個の追跡子で物標を追跡中に、n個の観測が得られた場合に一般化すると、PMBにおいて考慮すべき仮説の数Knumは、(1)式で表される。
例えば、n=5の場合、図3に示すように、仮説の数は1545個となる。LiDARの観測では、n=300前後となり、組み合わせ爆発により仮説の数は、リアルタイムでの処理が可能な演算量を超えてしまう。
そこで、FMBでは、追跡の対象となる路上障害物は「静止」しており、予測不能な動きをしないこと、及び、LiDARの測距精度は極めて高いが、未検知及び誤検知は無視できない程度に発生することを前提とする。
これらの前提の下では、図4に示すように、着目する追跡子には、必ず最近傍の観測点が割り当てられ、追跡子に最近傍の観測点以外が割り当てられる仮説4~6の尤度は、必ず0に近い値となる。
すると、図5に示すように、追跡子毎に考慮が必要な仮説は、最近傍の観測点にて観測されたか、観測されなかったかの2パターンのみとなる。つまり、考慮すべき仮説の数Knumは、(1)式で算出される数から2n個に減少する。
[1-3.処理]
次に、追跡装置20が実行する追跡処理について、図6のフローチャートを用いて説明する。
次に、追跡装置20が実行する追跡処理について、図6のフローチャートを用いて説明する。
追跡処理は、レーダセンサ10にて、検知エリア全体の走査に要する時間(以下、処理サイクル)毎に実行される。
追跡処理が開始されると、S100では、追跡装置20は、レーダセンサ10から観測結果を表す観測情報を取得する。観測情報には、検知エリアの中で、信号強度が閾値を超えるすべての観測点(以下、観測点群)が含まれる。
追跡処理が開始されると、S100では、追跡装置20は、レーダセンサ10から観測結果を表す観測情報を取得する。観測情報には、検知エリアの中で、信号強度が閾値を超えるすべての観測点(以下、観測点群)が含まれる。
続くS110では、追跡装置20は、前回の処理サイクルまでに生成された追跡子(以下、現存追跡子)の数をnとして、現存追跡子T1~Tnのそれぞれについて、今回の処理サイクルにおける現存追跡子の状態分布を予測する。更に、追跡装置20は、現存追跡子T1~Tnのそれぞれについて、現存追跡子Tiに対応づけられる物標の存在確率を、(2)式に従って算出する。
rk|k-1は、予測後の現存追跡子の存在確率、rk―1|k-1は、予測前の現存追跡子の存在確率、Psは、物標の生存確率を表す定数であり、1未満であるが1に近い値が用いられる。
状態分布の予測は、拡張カルマンフィルタ(以下、EKF)で使用される手法を用いる。なお、状態分布は、ガウス分布で表される。EKFでは、前回の処理サイクルでの追跡子の状態分布におけるピークの位置(すなわち、状態分布の平均値)を、追跡子が持つ速度情報に従って、1サイクルの時間経過分だけ移動させる。更に、EKFでは、状態分布の広がり(すなわち、ガウス分布の分散)を、1サイクルの時間経過分だけ拡散させることで、状態分布の予測値(以下、予測分布)が得られる。
続くS120では、追跡装置20は、現存追跡子T1~Tnのそれぞれについて、予測分布の平均値が示す位置からの距離が上限距離以下となる探査範囲を設定する。距離は、マハラノビス距離を用いる。但し、ユークリッド距離等、その他の距離を用いてもよい。
続くS130では、追跡装置20は、現存追跡子T1~Tnのそれぞれに、観測点群に属する観測点を排他的に割り当てる。具体的には、着目する現存追跡子について設定された探査範囲内に存在する観測点のうち、探査範囲の中心に最も近い観測点を、着目する現存追跡子に割り当てる。この処理をゲーティングともいう。ゲーティングの結果、各現存追跡子には、最大で1つの観測点が割り当てられる。また、各観測点は、いずれか1つの現存追跡子に割り当てられる場合と、いずれの現存追跡子にも割り当てられない場合とがある。
探査範囲を規定する上限距離は、例えば、図7に示すように、ガウス分布において、それより外側での存在確率がほぼ0となる範囲である5σに相当する距離を用いる。但し、誤検知を抑制するために、上限距離を5σより小さく設定してもよい。つまり、上限距離を大きくするほど、存在するにも関わらず検知できない未検知確率は減少するが、着目する現存追跡子に対して、その現存追跡子を観測したものではない観測点が対応づけられる誤検知確率が増大する。逆に、上限距離を小さくするほど、未検知確率は増大するが誤検知確率が減少する。
続くS140では、追跡装置20は、現存追跡子T1~Tnを識別する識別子iを1に設定する。
続くS150では、追跡装置20は、現存追跡子Tiの状態分布を更新する追跡子更新処理を実行する。
続くS150では、追跡装置20は、現存追跡子Tiの状態分布を更新する追跡子更新処理を実行する。
ここで、追跡子更新処理の詳細を図8のフローチャートを用いて説明する。追跡子更新処理では、先に説明したFMBが適用される。
S310では、追跡装置20は、現存追跡子Tiに割り当てられた観測点が、現存追跡子Tiを観測したものであるとの仮説(以下、検知仮説)に基づいて現存追跡子Tiの状態を更新する。具体的には、現存追跡子Tiの状態分布を、EKFによって更新し、現存追跡子Tiに対応づけられる物標の存在確率rrdetを(3)式に従って更新する。
S310では、追跡装置20は、現存追跡子Tiに割り当てられた観測点が、現存追跡子Tiを観測したものであるとの仮説(以下、検知仮説)に基づいて現存追跡子Tiの状態を更新する。具体的には、現存追跡子Tiの状態分布を、EKFによって更新し、現存追跡子Tiに対応づけられる物標の存在確率rrdetを(3)式に従って更新する。
続くS320では、追跡装置20は、現存追跡子Tiに割り当てられた観測点が、現存追跡子Tiを観測したものではないとの仮説(以下、未検知仮説)に基づいて現存追跡子Tiの状態を更新する。具体的には、S120では、S210で算出された予測分布を、現存追跡子Tiの推定分布とし、現存追跡子Tiに対応づけられる物標の存在確率rrmisを(4)式に従って更新する。
Pdは、レーダセンサ10の検知確率、すなわち、実在する物標を検知できる確率を表す。検知確率Pdは、レーダセンサ10の性能によって決まる定数である。なお、未検知には、現存追跡子Tiに対応する物標がそもそも存在しない場合と、現存追跡子Tiに対応する物票は存在するが、レーダセンサ10によって検知されなかった場合とがあり、(4)式は、後者の場合の確率を示す。
続くS330では、追跡装置20は、未検知仮説に基づく新規の追跡子を生成する。具体的には、追跡装置20は、観測点の位置を分布の平均、レーダセンサ10の誤差分散を分布の分散とする新規追跡子の状態分布を生成する。更に、追跡装置20は、新規追跡子に対応付けられる物標の存在確率rrnewを、(5)式に従って算出する。
Dnewは、バースレートであり、走査範囲内の決められた方位に照射される複数の光線について、1つの光線における1サンプル当たり何個の観測点が検知されるかを表す。Cは、レーダセンサ10の誤検知確率、すなわち、実在しない物標を検知する確率を表し、クラッタレートともいう。バースレートDnew及び誤検知確率Cは、いずれも実験的に決定される定数である。
続くS340では、追跡装置20は、検知仮説の仮説尤度W1、及び未検知仮説の仮説尤度W2を算出する。具体的には、検知仮説に関する正規化前の仮説尤度WD1は、(6)式により算出され、未検知仮説に関する正規化前の仮説尤度WD2は、(7)式により算出される。更に、(8)(9)式により、仮説尤度WD1,WD2を正規化することで、合計値が1となる仮説尤度W1,W2が算出される。
続くS350では、追跡装置20は、現存追跡子Tiについて生成された2つの仮説を統合することで、状態分布を更新する。具体的には、現存追跡子Tiの状態分布p(i)を、(10)式に従って生成し、現存追跡子Tiに対応づけられる物標の存在確率rを(11)式に従って算出する。
つまり、図9に示すように、二つの仮説に基づく二つの状態分布(以下、仮説分布)の平均μ1,μ2を、仮説尤度W1,W2を用いて合成した(すなわち、畳み込んだ)値が、更新後の状態分布p(i)における分布の平均となる。また、二つの仮説分布の分散P1,P2を、仮説尤度W1,W2を用いて合成した(すなわち、畳み込んだ)値が、更新後の状態分布p(i)における分布の分散となる。
続くS360では、追跡装置20は、S330で生成された新規追跡子の存在確率を、(12)式に従って統合して、追跡子更新処理を終了する。
追跡子更新処理が終了すると、図6に戻り、続くS160では、追跡装置20は、識別子iをインクリメントする。
続くS170では、追跡装置20は、識別子iが現存追跡子の数nより大きいか否かを判定する。追跡装置20は、i>nであれば、全ての現存追跡子に対して追跡子更新処理が実行されたものとして処理をS180に移行し、i≦nであれば、追跡子更新処理が実行されていない現存追跡子が存在するため、処理をS150に戻す。
続くS170では、追跡装置20は、識別子iが現存追跡子の数nより大きいか否かを判定する。追跡装置20は、i>nであれば、全ての現存追跡子に対して追跡子更新処理が実行されたものとして処理をS180に移行し、i≦nであれば、追跡子更新処理が実行されていない現存追跡子が存在するため、処理をS150に戻す。
S180では、追跡装置20は、先のS130にて、現存追跡子T1~Tnに割り当てられなかったことを生成条件とし、生成条件を満たす観測点のそれぞれに基づいて、新規の追跡子を生成する。具体的には、追跡装置20は、観測点の位置を分布の平均、レーダセンサ10の誤差分散を分布の分散とするガウス分布で示される新規追跡子の状態分布を生成する。更に、追跡装置20は、新規追跡子に対応づけられる物標の存在確率を、(5)式に従って算出する。
続くS190では、追跡装置20は、前回の処理サイクルから引き継いだ現存追跡子T1~Tn、及び今回の処理サイクルにて生成された新規追跡子のうち、追跡子に対応づけられる物標の存在確率rが追跡子剪定閾値以下である追跡子を消去する。追跡子剪定閾値は、次回の処理サイクルに伝搬される追跡子の数が、追跡装置20にて処理可能な数に収まるように、追跡装置20の処理能力に応じて設定される。
続くS200では、追跡装置20は、S190にて消去されずに残った追跡子のうち、該追跡子に対応づけられる物標の存在確率rが物標化閾値以上である追跡子を抽出し、該抽出された追跡子のそれぞれに対応づけられる物標を、実在する物標として認識する。
続くS210では、追跡装置20は、S200にて、実在すると認識された物標(以下、認識物標)が有るか否かを判定し、認識物標が有れば処理をS220に移行し、認識物標が無ければ処理を終了する。
S220では、追跡装置20は、認識物標に対応づけられる追跡子の情報を用いて認識物標に関する情報である物標情報を生成して、処理を終了する。物標情報には、少なくとも位置情報が含まれる。
[1-4.用語の対応]
本実施形態において、S100が本開示における情報取得部に相当し、S110が本開示における状態予測部に相当し、S120が本開示における範囲設定部に相当し、S130~S170が本開示における状態更新部に相当する。また、S180が本開示における追跡子生成部に相当し、S190が本開示における追跡子剪定部に相当し、S130が本開示における観測割当部に相当する。更に、S310~S320が本開示における仮説生成部に相当し、S340~S350が本開示における仮説統合部に相当し、S110、S150、S180が本開示における判定値生成部に相当する。なお、S130にて、観測点が割り当てられた現存追跡子が、本開示における対象追跡子に相当し、対象追跡子に割り当てられた観測点が、本開示における対象観測点に相当し、対象追跡子に対応づけられる物標が、本開示における対象物標に相当する。検知仮説が本開示における第1の仮説に相当し、非検知仮説が本開示における第2の仮説に相当する。
本実施形態において、S100が本開示における情報取得部に相当し、S110が本開示における状態予測部に相当し、S120が本開示における範囲設定部に相当し、S130~S170が本開示における状態更新部に相当する。また、S180が本開示における追跡子生成部に相当し、S190が本開示における追跡子剪定部に相当し、S130が本開示における観測割当部に相当する。更に、S310~S320が本開示における仮説生成部に相当し、S340~S350が本開示における仮説統合部に相当し、S110、S150、S180が本開示における判定値生成部に相当する。なお、S130にて、観測点が割り当てられた現存追跡子が、本開示における対象追跡子に相当し、対象追跡子に割り当てられた観測点が、本開示における対象観測点に相当し、対象追跡子に対応づけられる物標が、本開示における対象物標に相当する。検知仮説が本開示における第1の仮説に相当し、非検知仮説が本開示における第2の仮説に相当する。
[1-5.効果]
以上詳述した第1実施形態によれば、以下の効果を奏する。
(1a)追跡装置20では、現存追跡子T1~Tnに対して観測点を割り当てるときに、着目する現存追跡子Tiについて設定された探査範囲内に存在する観測点を対象として、最も近い距離にある観測点を割り当てる。つまり、現存追跡子Tiとの距離が遠いため仮説尤度がほぼ0となるような観測点に関する仮説は、生成されることがなく、演算をする前に除去されるため、追跡処理の演算負荷を軽減できる。
以上詳述した第1実施形態によれば、以下の効果を奏する。
(1a)追跡装置20では、現存追跡子T1~Tnに対して観測点を割り当てるときに、着目する現存追跡子Tiについて設定された探査範囲内に存在する観測点を対象として、最も近い距離にある観測点を割り当てる。つまり、現存追跡子Tiとの距離が遠いため仮説尤度がほぼ0となるような観測点に関する仮説は、生成されることがなく、演算をする前に除去されるため、追跡処理の演算負荷を軽減できる。
(1b)追跡装置20では、現存追跡子Ti毎に、現存追跡子Tiに割り当てられた1つの観測点に対する検知仮説及び非検知仮説の2つの仮説を生成する。つまり、観測点の割り当て方についての仮説数が2n個となり、現存追跡子の数nに対して仮説数が指数関数的に増大するPMBと比較して、追跡処理で扱う仮説数を大幅に削減できる。なお、追跡処理では、仮説毎に算出する必要がある仮説尤度の演算負荷が最も重いため、仮説数を削減することで、演算負荷を大幅に削減できる。その結果、PMBと比較して低負荷で、かつ、非検知仮説を考慮しないNNと比較して高性能な追跡処理を実現できる。
(1c)追跡装置20では、現存追跡子Ti毎に生成される2つの仮説を畳み込みによって統合することで、仮説の数、ひいては追跡子の数を半減させ、更に、現存追跡子及び新規追跡子のうち、存在確率が追跡子剪定閾値以下となる追跡子を削除する。これにより、次回の処理サイクルに伝搬される追跡子の数が削減されるため、追跡処理に要する演算負荷を更に軽減できる。
(1d)追跡装置20では、処理サイクル毎に、現存追跡子Tiに対応づけられる物標の存在確率を、仮説尤度を用いて更新するため、現存追跡子Tiに対応づけられる物標が実在するか実在しない(すなわち、ノイズである)かの切り分け性能を向上させることができる。
[1-6.実験]
フレーム毎に追跡処理に要する演算時間を、本実施形態に対応するFMBを用いた場合、従来技術であり仮説統合を行わないPMB、及び従来技術であり仮説統合を行うPHDを用いた場合について、シミュレーションによって算出した結果を図10、図11に示す。PHDは、Probability Hypothesis Densityの略である。
フレーム毎に追跡処理に要する演算時間を、本実施形態に対応するFMBを用いた場合、従来技術であり仮説統合を行わないPMB、及び従来技術であり仮説統合を行うPHDを用いた場合について、シミュレーションによって算出した結果を図10、図11に示す。PHDは、Probability Hypothesis Densityの略である。
シミュレーションの条件は、図12に示すように、観測点の抽出に用いる閾値レベルを2.40σ、水平方向の視野角を19.4°、垂直方向の視野角を1.3°、水平方向の角度分解能及び垂直方向の角度分解能をいずれも0.1°とした。つまり、走査に用いる光線本数は、水平方向に194本、垂直方向に13本となる。各光線においてA/D変換のサンプリング間隔は、距離分解能が1.9mに相当する時間とし、最大検知距離を250mとして、光線一本当たりのサンプリング数を132個とした。また、本処理の適用範囲を103.2m~131.7mの範囲として、適用範囲内の最大サンプル数を37364個、想定雑音量を306個とした。
図10に示すように、FMBを適用した場合、PMBを適用した場合と比較して、演算時間が1/10程度に減少する。また、PHDと比較しても減少することがわかる。
図11に示すように、予測、ゲーティング、仮説生成、更新、剪定に分けて演算時間を測定した結果、PMBに足しては、仮説生成及び更新で大幅に演算時間が削減されていることがわかる。また、PHDと略同様な演算時間となるが、剪定の演算時間が削減されることがわかる。なお、S110が予測、S120がゲーティング、S130が仮説生成、S150が更新、S190が剪定に相当する。
図11に示すように、予測、ゲーティング、仮説生成、更新、剪定に分けて演算時間を測定した結果、PMBに足しては、仮説生成及び更新で大幅に演算時間が削減されていることがわかる。また、PHDと略同様な演算時間となるが、剪定の演算時間が削減されることがわかる。なお、S110が予測、S120がゲーティング、S130が仮説生成、S150が更新、S190が剪定に相当する。
[2.第2実施形態]
[2-1.第1実施形態との相違点]
第2実施形態は、基本的な構成は第1実施形態と同様であるため、相違点について以下に説明する。なお、第1実施形態と同じ符号は、同一の構成を示すものであって、先行する説明を参照する。
[2-1.第1実施形態との相違点]
第2実施形態は、基本的な構成は第1実施形態と同様であるため、相違点について以下に説明する。なお、第1実施形態と同じ符号は、同一の構成を示すものであって、先行する説明を参照する。
前述した第1実施形態では、すべての追跡子に対してFMBを適用している。これに対し、第2実施形態では、組み合わせ爆発が生じない追跡子に対してはPMBを適用する点で、第1実施形態と相違する。
[2-2.処理]
次に、第2実施形態の追跡装置20が、図6に示した第1実施形態の追跡処理に代えて実行する追跡処理について、図13のフローチャートを用いて説明する。
次に、第2実施形態の追跡装置20が、図6に示した第1実施形態の追跡処理に代えて実行する追跡処理について、図13のフローチャートを用いて説明する。
S100~S120は、追跡装置20は、第1実施形態の場合と同様の処理を実行する。
続くS140では、追跡装置20は、現存追跡子T1~Tnの識別に用いる識別子iを1に初期化する。
続くS140では、追跡装置20は、現存追跡子T1~Tnの識別に用いる識別子iを1に初期化する。
続くS142では、追跡装置20は、現存追跡子Tiの探査範囲は、他の追跡子の探査範囲との重複があるか否かを判定し、重複がある場合は処理をS144に移行し、重複がない場合は、処理をS152に移行する。例えば、図14に示すように、追跡子A~Hと、観測点1~18とが位置する場合、追跡子A,B,D~Gは、探査範囲に重複があると判定され、追跡子C,Hは、探査範囲に重複がないと判定される。
S144では、追跡装置20は、現存追跡子Tiの探査範囲内に存在する直近の観測点を、現存追跡子Tiに割り当てる。例えば、図13では、追跡子Aには「観1」、追跡子Bには「観2」、追跡子Dには「観8」、追跡子Eには「観10」、追跡子Fには「観12」、追跡子Gには「観14」が割り当てられる。
続くS150では、追跡装置20は、第1実施形態の場合と同様に追跡子更新処理を実行して、S160に処理を進める。
S152では、追跡装置20は、現存追跡子Tiについて設定された探査範囲内に存在するすべての観測点を、現存追跡子Tiに割り当てる。例えば、図13では、追跡子Cには「観3」「観4」「観5」「観6」、追跡子Hには「観15」「観16」が割り当てられる。
S152では、追跡装置20は、現存追跡子Tiについて設定された探査範囲内に存在するすべての観測点を、現存追跡子Tiに割り当てる。例えば、図13では、追跡子Cには「観3」「観4」「観5」「観6」、追跡子Hには「観15」「観16」が割り当てられる。
続くS154では、追跡装置20は、PMBを用いた追跡子更新処理を実行して、処理をS160に進める。
探査範囲が他の追跡子の探査範囲と重複しない追跡子では、図15に示すように、割り当てられた観測点の数をmとすると、生成される仮説の数はm+1個となる。つまり、組み合わせ爆発は生じないため、すべての仮説を考慮するPMBの手法を用いて計算することが可能となる。
探査範囲が他の追跡子の探査範囲と重複しない追跡子では、図15に示すように、割り当てられた観測点の数をmとすると、生成される仮説の数はm+1個となる。つまり、組み合わせ爆発は生じないため、すべての仮説を考慮するPMBの手法を用いて計算することが可能となる。
以下、S160~S220の処理は、第1実施形態の場合と同様である。
[2-3.用語の対応]
本実施形態において、S142が本開示における振分部に相当し、S144が本開示における観測割当部に相当し、S152~S154が本開示における精密更新部に相当する。
[2-3.用語の対応]
本実施形態において、S142が本開示における振分部に相当し、S144が本開示における観測割当部に相当し、S152~S154が本開示における精密更新部に相当する。
[2-4.効果]
以上詳述した第2実施形態によれば、前述した第1実施形態の効果(1a)~(1d)を奏し、さらに、以下の効果を奏する。
以上詳述した第2実施形態によれば、前述した第1実施形態の効果(1a)~(1d)を奏し、さらに、以下の効果を奏する。
(2a)本実施形態では、探査範囲が他とは重ならないことを条件として、部分的にPMBを適用することで、処理負荷を大幅に増大させることなく、PMBを適用した追跡子に対する追跡処理の精度を向上させることができる。
[3.第3実施形態]
[3-1.第1実施形態との相違点]
第2実施形態は、基本的な構成は第1実施形態と同様であるため、相違点について以下に説明する。なお、第1実施形態と同じ符号は、同一の構成を示すものであって、先行する説明を参照する。
[3-1.第1実施形態との相違点]
第2実施形態は、基本的な構成は第1実施形態と同様であるため、相違点について以下に説明する。なお、第1実施形態と同じ符号は、同一の構成を示すものであって、先行する説明を参照する。
前述した第1実施形態では、追跡子の状態分布としてガウス分布を使用している。これに対し、第3実施形態では、ガウス分布の代わりに混合ガウス分布を用いる点で、第1実施形態と相違する。
[3-2.処理]
次に、第3実施形態の追跡装置20が、図6に示す第1実施形態の追跡処理に代えて実行する追跡処理について、図16のフローチャートを用いて説明する。
次に、第3実施形態の追跡装置20が、図6に示す第1実施形態の追跡処理に代えて実行する追跡処理について、図16のフローチャートを用いて説明する。
S100では、追跡装置20は、第1実施形態の場合と同様の処理を実行する。
続くS115では、追跡装置20は、第1実施形態のS110の処理に加えて、状態分布に含まれる各極大値の尤度(以下、混合尤度)を、(13)式を用いて更新する。
続くS115では、追跡装置20は、第1実施形態のS110の処理に加えて、状態分布に含まれる各極大値の尤度(以下、混合尤度)を、(13)式を用いて更新する。
つまり、前記の処理サイクルで算出された混合尤度、すなわち予測前の混合尤度を、そのまま、予測分布における混合尤度として用いる。なお、(13)式におけるjは、状態分布に存在する極大値(すなわち、混合ガウス分布を形成する個々のガウス分布のピーク)を識別するための識別子である。ここでは、状態分布に存在する極大値の数をm個とする。
続くS120~S140では、追跡装置20は、第1実施形態の場合と同様の処理を実行する。
続くS155では、追跡装置20は、状態分布として混合ガウス分布を用いる追跡子更新処理を実行する。
続くS155では、追跡装置20は、状態分布として混合ガウス分布を用いる追跡子更新処理を実行する。
ここで、追跡子更新処理の詳細を図17のフローチャートを用いて説明する。追跡子更新処理では、図8に示した第1実施形態の追跡子更新処理と相違する点について説明する。
S310では、追跡装置20は、第1実施形態の場合と同様の処理を実行する。
S310では、追跡装置20は、第1実施形態の場合と同様の処理を実行する。
続くS315では、追跡装置20は、検知仮説で更新された状態分布(すなわち、仮説分布)における各極大値の尤度を、(14)(15)式を用いて算出する。
(14)式は、現存追跡子Tiに割り当てられた観測点と、その現存追跡子Tiの予測分布において着目する極大値が示す距離に応じて、各極大値の混合尤度が更新されることを意味する。(15)式は、同じ予測分布に属する複数の極大値の混合尤度の合計値が1となるように、各混合尤度を正規化することを意味する。
続くS320では、追跡装置20は、第1実施形態の場合と同様の処理を実行する。
続くS325では、追跡装置20は、未検知仮説を採用した場合、予測分布をそのまま更新後の状態分布(すなわち、仮説分布)として用い、仮説分布における各極大値の混合尤度を、(16)式を用いて算出する。
続くS325では、追跡装置20は、未検知仮説を採用した場合、予測分布をそのまま更新後の状態分布(すなわち、仮説分布)として用い、仮説分布における各極大値の混合尤度を、(16)式を用いて算出する。
つまり、未検知仮説による仮説分布の混合尤度も、S115にて算出された予測分布の混合尤度がそのまま用いられる。
続く330~S340では、追跡装置20は、第1実施形態の場合と同様の処理を実行する。
続く330~S340では、追跡装置20は、第1実施形態の場合と同様の処理を実行する。
続くS352では、追跡装置20は、現存追跡子Tiについて生成された仮説を統合する。具体的には、現存追跡子Tiの更新後の状態分布p(i)を、(17)式に従って生成し、現存追跡子Tiに対応づけられる物標の存在確率rを(18)式に従って算出する。
(17)式は、図18に示すように、更新後の状態分布が、検知仮説の仮説分布における各極大値を個別に表すm個のガウス分布、及び非検知仮説の仮説分布における各極大値を個別に表すm個のガウス分布を、単純に足し合わせた分布となることを意味する。(18)式は、(11)式と同じである。
続くS354では、追跡装置20は、S350にて更新された状態分布中の各極大値の混合尤度を、(19)(20)式を用いて算出する。
(19)式は、検知仮説の仮説分布に基づく極大値の混合尤度であり、(20)式は、未検知仮説の仮説分布に基づく各極大値の混合尤度である。つまり、本実施形態では、追跡更新処理を行う毎に、更新後の状態分布に含まれる極大値の数は、更新前の状態分布に含まれる極大値の数の2倍になる。
続くS360では、追跡装置20は、第1実施形態の場合と同様の処理を実行して、追跡子更新処理を終了する。
図16に戻り、追跡子更新処理が終了すると、続くS160~S190では、追跡装置20は、第1実施形態の場合と同様の処理を実行する。
図16に戻り、追跡子更新処理が終了すると、続くS160~S190では、追跡装置20は、第1実施形態の場合と同様の処理を実行する。
続くS195では、追跡装置20は、S155にて更新された状態分布中において混合尤度が極大値剪定閾値以下となる極大値を消去する。更に、追跡装置20は、一つでも極大値が消去された状態分布については、その状態分布中の各極大値の混合尤度を、混合尤度の合計が1となる(すなわち、正規化される)ように再計算する。
続くS200~S220では、追跡装置20は、第1実施形態の場合と同様の処理を実行して、追跡処理を終了する。
[3-3.用語の対応]
本実施形態において、S354が本開示における混合尤度算出部に相当し、S195が本開示における極大値剪定部に相当する。
[3-3.用語の対応]
本実施形態において、S354が本開示における混合尤度算出部に相当し、S195が本開示における極大値剪定部に相当する。
[3-4.効果]
以上詳述した第3実施形態によれば、前述した第1実施形態の効果(1a)~(1d)を奏し、さらに、以下の効果を奏する。
以上詳述した第3実施形態によれば、前述した第1実施形態の効果(1a)~(1d)を奏し、さらに、以下の効果を奏する。
(3a)本実施形態では、状態分布として、単純なガウス分布の代わりに混合ガウス分布を用いているため、仮説の統合による情報の消失を抑制でき、ロバスト性を向上させることができる。
(3b)本実施形態では、状態分布に含まれる極大値毎に混合尤度を算出し、混合尤度が極大値剪定閾値以下となる極大値を除去するため、状態分布が必要以上に複雑化すること、ひいては、極大値の数が増大することによる演算負荷の増大を抑制できる。
[4.他の実施形態]
以上、本開示の実施形態について説明したが、本開示は前述の実施形態に限定されることなく、種々変形して実施することができる。
以上、本開示の実施形態について説明したが、本開示は前述の実施形態に限定されることなく、種々変形して実施することができる。
(3a)上記実施形態では、追跡処理によって更新の対象となる状態として、観測点の位置を用いているが、本開示は、観測点の位置に限定されるものではなく、観測点の速度や加速度等、物標から得られる情報であればよい。
(3b)上記実施形態では、追跡子の状態を、PMBフィルタを用いて更新しているが、追跡子の状態は、RFSの理論において使用されるPMBフィルタ以外のフィルタ、例えば、PHDフィルタ、LMBフィルタ、PMBMフィルタ等を用いてもよい。LMBは、Labeled Multi-Bernoulliの略であり、PMBMは、Poisson Multi-Bernoulli Mixtureの略である。
(3c)上記実施形態では、追跡子に対応づけられる物標が存在するか否かの判定に用いる存在判定値として、0~1の値で表される存在確率を用いているが、本開示は存在確率に限定されるものではない。例えば、存在判定値として、1以上の値も許容される基数情報を用いてもよい。
(3d)本開示に記載の追跡装置20及びその手法は、コンピュータプログラムにより具体化された一つ乃至は複数の機能を実行するようにプログラムされたプロセッサ及びメモリを構成することによって提供された専用コンピュータにより、実現されてもよい。あるいは、本開示に記載の追跡装置20及びその手法は、一つ以上の専用ハードウェア論理回路によってプロセッサを構成することによって提供された専用コンピュータにより、実現されてもよい。もしくは、本開示に記載の追跡装置20及びその手法は、一つ乃至は複数の機能を実行するようにプログラムされたプロセッサ及びメモリと一つ以上のハードウェア論理回路によって構成されたプロセッサとの組み合わせにより構成された一つ以上の専用コンピュータにより、実現されてもよい。また、コンピュータプログラムは、コンピュータにより実行されるインストラクションとして、コンピュータ読み取り可能な非遷移有形記録媒体に記憶されてもよい。追跡装置20に含まれる各部の機能を実現する手法には、必ずしもソフトウェアが含まれている必要はなく、その全部の機能が、一つあるいは複数のハードウェアを用いて実現されてもよい。
(3e)上記実施形態における1つの構成要素が有する複数の機能を、複数の構成要素によって実現したり、1つの構成要素が有する1つの機能を、複数の構成要素によって実現したりしてもよい。また、複数の構成要素が有する複数の機能を、1つの構成要素によって実現したり、複数の構成要素によって実現される1つの機能を、1つの構成要素によって実現したりしてもよい。また、上記実施形態の構成の一部を省略してもよい。また、上記実施形態の構成の少なくとも一部を、他の上記実施形態の構成に対して付加又は置換してもよい。
(3f)前述した追跡装置20の他、当該追跡装置20を構成要素とするシステム、当該追跡装置20としてコンピュータを機能させるためのプログラム、このプログラムを記録した半導体メモリ等の非遷移的実体的記録媒体、物標追跡方法など、種々の形態で本開示を実現することもできる。
1…レーダシステム、10…レーダセンサ、20…追跡装置、21…CPU、22…メモリ。
Claims (8)
- 処理サイクル毎に、車両の周囲に存在する物標の状態を観測するセンサから観測情報を取得するように構成された情報取得部(20:S100)と、
前記情報取得部により前記観測情報が取得された1つ以上の観測点である観測点群のうち、予め設定された生成条件を満たす前記観測点について、前記観測情報の状態を確率的に示した状態分布を有する追跡子を生成するように構成された追跡子生成部(20:S180)と、
前回の処理サイクルまでに生成された前記追跡子である現存追跡子のそれぞれについて、前記現存追跡子が有する前記状態分布から、前記現存追跡子の今回の処理サイクルでの前記観測情報の状態を予測した前記状態分布である予測分布を生成するように構成された状態予測部(20:S110)と、
前記現存追跡子のそれぞれについて、前記状態予測部にて生成された前記予測分布、及び今回の処理サイクルで得られた前記観測点群の前記観測情報を用いて、前記現存追跡子が有する前記状態分布を更新するように構成された状態更新部(20:S130~S170)と、
を備え、
前記状態更新部は、
前記情報取得部にて取得された前記観測情報と前記予測分布が示す前記観測情報との距離に従って、前記現存追跡子のそれぞれに、前記観測点を排他的に割り当てるように構成された観測割当部(20:S130,S144)と、
対象追跡子毎に、対象観測点が対象物標を観測した結果であるとする第1の仮説、及び前記対象観測点が前記対象物標を観測した結果ではないとする第2の仮説を含む仮説群に属する仮説のそれぞれについて、前記仮説の尤度である仮説尤度、及び前記仮説が正しいと仮定して更新した前記状態分布である仮説分布を生成するように構成された仮説生成部(20:S310~S320)と、
を備え、
前記対象追跡子は、前記観測割当部により前記観測点が割り当てられた前記現存追跡子であり、前記第1の仮説は、対象観測点が対象物標を観測した結果であるとする仮説であり、前記第2の仮説は、前記対象観測点が前記対象物標を観測した結果ではないとする仮説であり、前記対象観測点は、前記対象追跡子に割り当てられた前記観測点であり、前記対象物標は、前記対象追跡子に対応づけられる物標である、
追跡装置。 - 請求項1に記載の追跡装置であって、
前記状態更新部は、
前記仮説生成部にて前記仮説群に属する仮説毎に生成された前記仮説分布を、前記仮説尤度を用いた畳み込みによって統合することで、更新後の前記状態分布を生成するように構成された仮説統合部(20:S340~S350)を更に備える
追跡装置。 - 請求項1又は請求項2に記載の追跡装置であって、
前記観測割当部は、前記現存追跡子のそれぞれに、前記観測点を最大で1つ割り当てるように構成された、
追跡装置。 - 請求項1から請求項3までのいずれか1項に記載の追跡装置であって、
前記追跡子のそれぞれについて、該追跡子に対応づけられる物標が存在するか否かの判定に用いる存在判定値を算出するように構成された判定値生成部(20:S110,S150,S180)と、
前記存在判定値が剪定閾値以下となる前記追跡子を除去するように構成された追跡子剪定部(20:S190)と、
を更に備える追跡装置。 - 請求項1から請求項4までのいずれか1項に記載の追跡装置であって、
前記観測割当部は、前記現存追跡子のそれぞれについて探査範囲を設定するように構成された範囲設定部(20:S120)を更に備え、
前記観測割当部は、前記探査範囲内に存在する前記観測点を割り当てるように構成された
追跡装置。 - 請求項5に記載の追跡装置であって、
前記探査範囲内に存在する全ての前記観測点を用いて前記追跡子の状態を更新するように構成された精密更新部(20:S152~S154)と、
前記探査範囲が他と重複する前記追跡子については、前記状態更新部が適用され、前記探査範囲が他と重複しない前記追跡子については、前記精密更新部が適用されるように、前記追跡子を振り分けるように構成された振分部(20:S142)と、
を更に備える
追跡装置。 - 請求項1から請求項6までのいずれか1項に記載の追跡装置であって、
前記状態分布は、混合ガウス分布によって表される
追跡装置。 - 請求項7に記載の追跡装置であって、
前記状態分布を表す前記混合ガウス分布の構成要素となる複数のガウス分布のそれぞれについて、前記ガウス分布の尤度である混合尤度を算出するように構成された混合尤度算出部(20:S354)と、
前記混合尤度が極大値剪定値以下となる前記ガウス分布を前記状態分布から除去する極大値剪定部(20:S195)と、
を更に備える追跡装置。
Priority Applications (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2021081239A JP2022175094A (ja) | 2021-05-12 | 2021-05-12 | 追跡装置 |
DE112022002527.1T DE112022002527T5 (de) | 2021-05-12 | 2022-04-26 | Tracking-vorrichtung |
PCT/JP2022/018928 WO2022239644A1 (ja) | 2021-05-12 | 2022-04-26 | 追跡装置 |
US18/505,976 US20240069187A1 (en) | 2021-05-12 | 2023-11-09 | Tracking apparatus |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2021081239A JP2022175094A (ja) | 2021-05-12 | 2021-05-12 | 追跡装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2022175094A true JP2022175094A (ja) | 2022-11-25 |
Family
ID=84028279
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2021081239A Pending JP2022175094A (ja) | 2021-05-12 | 2021-05-12 | 追跡装置 |
Country Status (4)
Country | Link |
---|---|
US (1) | US20240069187A1 (ja) |
JP (1) | JP2022175094A (ja) |
DE (1) | DE112022002527T5 (ja) |
WO (1) | WO2022239644A1 (ja) |
Family Cites Families (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP2264679A4 (en) * | 2008-03-11 | 2013-08-21 | Panasonic Corp | TAG SENSOR SYSTEM AND SENSOR DEVICE, AND OBJECT POSITION ESTIMATING DEVICE, AND OBJECT POSITION ESTIMATING METHOD |
JP2011123551A (ja) * | 2009-12-08 | 2011-06-23 | Toyota Central R&D Labs Inc | 死角領域推定装置及びプログラム |
CN102449427A (zh) * | 2010-02-19 | 2012-05-09 | 松下电器产业株式会社 | 物体位置修正装置、物体位置修正方法及物体位置修正程序 |
JP5906379B2 (ja) * | 2011-09-29 | 2016-04-20 | パナソニックIpマネジメント株式会社 | 移動体位置推定装置、移動体位置推定方法、及び、移動体位置推定プログラム |
JP6482844B2 (ja) * | 2014-12-11 | 2019-03-13 | 株式会社メガチップス | 状態推定装置、プログラムおよび集積回路 |
US10922820B2 (en) | 2017-07-31 | 2021-02-16 | National Technology & Engineering Solutions Of Sandia, Llc | Data-driven delta-generalized labeled multi-bernoulli tracker |
JP7384390B2 (ja) | 2019-11-15 | 2023-11-21 | 国立大学法人東北大学 | プローブ型センサー |
-
2021
- 2021-05-12 JP JP2021081239A patent/JP2022175094A/ja active Pending
-
2022
- 2022-04-26 DE DE112022002527.1T patent/DE112022002527T5/de active Pending
- 2022-04-26 WO PCT/JP2022/018928 patent/WO2022239644A1/ja active Application Filing
-
2023
- 2023-11-09 US US18/505,976 patent/US20240069187A1/en active Pending
Also Published As
Publication number | Publication date |
---|---|
US20240069187A1 (en) | 2024-02-29 |
DE112022002527T5 (de) | 2024-04-11 |
WO2022239644A1 (ja) | 2022-11-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109581353B (zh) | 一种基于汽车雷达的多目标跟踪方法及系统 | |
Folster et al. | Data association and tracking for automotive radar networks | |
JP6266887B2 (ja) | 推定装置 | |
CN110361734B (zh) | 微弱动目标检测方法、装置、计算机设备及存储介质 | |
CN113536850B (zh) | 基于77g毫米波雷达的目标物体大小测试方法和装置 | |
JP2002168953A (ja) | 車両周辺監視装置 | |
Li et al. | An adaptive 3D grid-based clustering algorithm for automotive high resolution radar sensor | |
JP7173735B2 (ja) | レーダ装置及び信号処理方法 | |
US11797098B2 (en) | Methods for recognizing human hand and hand gesture from human, and display apparatus | |
JP2018066716A (ja) | 物体追跡装置 | |
CN112912759B (zh) | 物体跟踪装置 | |
CN115151836A (zh) | 用于探测车辆周围环境中的移动对象的方法和机动车辆 | |
JP2009236720A (ja) | 移動目標検出装置 | |
US11994577B2 (en) | Object tracking device | |
US20230184926A1 (en) | Radar anti-spoofing system for identifying ghost objects created by reciprocity-based sensor spoofing | |
WO2022239644A1 (ja) | 追跡装置 | |
CN114137562A (zh) | 一种基于改进全局最邻近的多目标跟踪方法 | |
Polychronopoulos et al. | Integrated object and road border tracking using 77 GHz automotive radars | |
CN116699596A (zh) | 一种车辆的毫米波雷达的速度修正方法及装置 | |
JP2014002012A (ja) | レーダ装置、及び、プログラム | |
KR102361816B1 (ko) | 표적 탐지 방법 및 기록 매체 | |
JP7460499B2 (ja) | 物体追跡装置 | |
JP2020008351A (ja) | トラキング装置、方法及びプログラム | |
JP2004219300A (ja) | 目標追尾装置 | |
CN113678023B (zh) | 雷达装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20231206 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20240820 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20240905 |