JP2021117760A - Object tracking device and object tracking method - Google Patents

Object tracking device and object tracking method Download PDF

Info

Publication number
JP2021117760A
JP2021117760A JP2020010981A JP2020010981A JP2021117760A JP 2021117760 A JP2021117760 A JP 2021117760A JP 2020010981 A JP2020010981 A JP 2020010981A JP 2020010981 A JP2020010981 A JP 2020010981A JP 2021117760 A JP2021117760 A JP 2021117760A
Authority
JP
Japan
Prior art keywords
tracking
unit
detection
certainty
output
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.)
Granted
Application number
JP2020010981A
Other languages
Japanese (ja)
Other versions
JP7334632B2 (en
Inventor
英之 原
Hideyuki Hara
英之 原
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Isuzu Motors Ltd
Original Assignee
Isuzu Motors Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Isuzu Motors Ltd filed Critical Isuzu Motors Ltd
Priority to JP2020010981A priority Critical patent/JP7334632B2/en
Publication of JP2021117760A publication Critical patent/JP2021117760A/en
Application granted granted Critical
Publication of JP7334632B2 publication Critical patent/JP7334632B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Abstract

To improve the performance of object tracking according to an object tracking status upon the object tracking.SOLUTION: An object tracking device includes: an object detection unit 321 which detects the position of an object to be detected and included in an image taken by an image-taking device 1; a tracking unit 322 which tracks, as a tracking object, an object detected in the past by the object detection unit 321; an association unit 323 which associates the object detected by the object detection unit 321 with the tracking object tracked by the tracking unit 322; a calculation unit 325 which increases or decreases the degree of presence certainty indicating the certainty of the presence of the tracking object based on whether or not the detected object has been associated with the tracking object; and an output unit 326 which outputs an output position based on the position of the detected object in association with identification information for identifying the tracking object when the presence certainty is greater than or equal to a first threshold value.SELECTED DRAWING: Figure 2

Description

本発明は、物体追跡装置及び物体追跡方法に関する。 The present invention relates to an object tracking device and an object tracking method.

従来、車両の前方に存在するオブジェクトを検出することが行われている。例えば、特許文献1には、車載カメラにより撮像した撮像画像に基づいて、車両の前方に存在する検出対象のオブジェクトとして、車両の前方を走行する車両を検出し、検出した車両を追跡する技術が開示されている。 Conventionally, an object existing in front of a vehicle has been detected. For example, Patent Document 1 discloses a technique of detecting a vehicle traveling in front of a vehicle as a detection target object existing in front of the vehicle based on an image captured by an in-vehicle camera and tracking the detected vehicle. It is disclosed.

特開2018−18393号公報Japanese Unexamined Patent Publication No. 2018-18393

特許文献1に記載された発明では、テンプレート画像を用いたマッチング処理により検出したオブジェクトを追跡している。特許文献1に記載された発明では、オブジェクトがテンプレート画像に類似していないと追跡対象とする物体を検出できず、オブジェクトの追跡を適切に実施できないという問題があった。 In the invention described in Patent Document 1, the object detected by the matching process using the template image is tracked. In the invention described in Patent Document 1, there is a problem that the object to be tracked cannot be detected unless the object is similar to the template image, and the tracking of the object cannot be performed appropriately.

本発明はこの点に鑑みてなされたものであり、オブジェクトを追跡する場合に、オブジェクトの追跡状況に応じて、オブジェクトを追跡する性能を向上させることができる物体追跡装置及び物体追跡方法を提供することを目的とする。 The present invention has been made in view of this point, and provides an object tracking device and an object tracking method capable of improving the performance of tracking an object according to the tracking status of the object when tracking the object. The purpose is.

本発明の第1の態様の物体追跡装置は、撮像装置が撮像した撮像画像に含まれる検出対象のオブジェクトである検出オブジェクトの位置を検出する物体検出部と、前記物体検出部が過去に検出したオブジェクトを追跡オブジェクトとして追跡する追跡部と、前記物体検出部が検出した前記検出オブジェクトと、前記追跡部が追跡している前記追跡オブジェクトとを関連付ける関連付け部と、前記検出オブジェクトが前記追跡オブジェクトに関連付けられたか否かに基づいて、前記追跡オブジェクトが存在することの確かさを示す存在確信度を増減させる算出部と、前記存在確信度が第1閾値以上である場合に、前記追跡オブジェクトを識別する識別情報に関連付けて、前記検出オブジェクトの位置に基づく出力位置を出力する出力部と、を備える。 The object tracking device according to the first aspect of the present invention includes an object detection unit that detects the position of a detection object that is an object to be detected included in the captured image captured by the image pickup device, and the object detection unit that has detected in the past. A tracking unit that tracks an object as a tracking object, an association unit that associates the detection object detected by the object detection unit with the tracking object that the tracking unit is tracking, and the detection object that associates with the tracking object. A calculation unit that increases or decreases the existence certainty indicating the certainty that the tracking object exists based on whether or not the tracking object is present, and identifies the tracking object when the existence certainty is equal to or higher than the first threshold value. It includes an output unit that outputs an output position based on the position of the detected object in association with the identification information.

前記追跡部は、前記追跡オブジェクトの前記存在確信度が前記第1閾値より小さな第2閾値以下である場合に、当該追跡オブジェクトの追跡を終了してもよい。 The tracking unit may end the tracking of the tracking object when the certainty of existence of the tracking object is equal to or less than the second threshold value smaller than the first threshold value.

前記撮像装置から前記検出オブジェクトまでの距離を取得する取得部と、前記検出オブジェクトまでの距離が第1距離の場合には、前記検出オブジェクトまでの距離が前記第1距離よりも大きい第2距離の場合に比べて前記第1閾値を相対的に小さく設定する設定部と、をさらに備えてもよい。 When the distance between the acquisition unit that acquires the distance from the imaging device to the detection object and the detection object is the first distance, the distance to the detection object is larger than the first distance. A setting unit for setting the first threshold value relatively smaller than in the case may be further provided.

前記物体追跡装置は、前記撮像装置から前記検出オブジェクトまでの距離を取得する取得部と、前記関連付け部が前記検出オブジェクトと前記追跡オブジェクトとを関連付けない場合に、前記撮像装置から当該検出オブジェクトまでの距離が短いほど、当該検出オブジェクトを前記追跡部が追跡するための新たな追跡オブジェクト情報に含まれる前記存在確信度の初期値を相対的に大きく設定する設定部と、をさらに備えてもよい。 The object tracking device is from the imaging device to the detection object when the acquisition unit that acquires the distance from the image pickup device to the detection object and the association unit do not associate the detection object with the tracking object. As the distance is shorter, the tracking unit may further include a setting unit that sets a relatively large initial value of the existence certainty included in the new tracking object information for the tracking unit to track.

前記算出部は、前記追跡オブジェクトの現在位置が前記撮像画像の端部を含む所定領域内であり、且つ、当該追跡オブジェクトに前記検出オブジェクトが関連付けられなかった場合に、当該追跡オブジェクトの前記存在確信度を前記第2閾値以下にしてもよい。 The calculation unit determines the existence of the tracking object when the current position of the tracking object is within a predetermined area including the edge of the captured image and the detection object is not associated with the tracking object. The degree may be set to be equal to or less than the second threshold value.

前記追跡部は、前記追跡オブジェクトの一つ前の推定位置及び前記追跡オブジェクトの速度を含む状態情報に基づいて、当該追跡オブジェクトの現在位置を推定し、前記出力部は、当該追跡オブジェクトに前記検出オブジェクトが関連付けられず、且つ、前記存在確信度が前記第1閾値以上である場合に、前記追跡部が推定した当該追跡オブジェクトの現在位置を前記出力位置として出力してもよい。 The tracking unit estimates the current position of the tracking object based on the state information including the estimated position immediately before the tracking object and the speed of the tracking object, and the output unit detects the detection on the tracking object. When the objects are not associated and the certainty of existence is equal to or higher than the first threshold value, the current position of the tracking object estimated by the tracking unit may be output as the output position.

前記追跡部は、前記追跡オブジェクトに関連付けられた前記検出オブジェクトの位置の履歴を示す履歴情報に基づいて、当該追跡オブジェクトの現在位置を推定し、前記出力部は、当該追跡オブジェクトに前記検出オブジェクトが関連付けられず、且つ、前記存在確信度が前記第1閾値以上である場合に、前記追跡部が推定した当該追跡オブジェクトの現在位置を前記出力位置として出力してもよい。 The tracking unit estimates the current position of the tracking object based on the history information indicating the history of the position of the detection object associated with the tracking object, and the output unit causes the detection object to be attached to the tracking object. When the existence certainty is not related and the existence certainty is equal to or higher than the first threshold value, the current position of the tracking object estimated by the tracking unit may be output as the output position.

本発明の第2の態様の物体追跡方法は、撮像装置が撮像した撮像画像に含まれる検出対象のオブジェクトである検出オブジェクトの位置を検出するステップと、過去に検出したオブジェクトを追跡オブジェクトとして追跡するステップと、前記検出オブジェクトと、追跡している前記追跡オブジェクトとを関連付けるステップと、前記検出オブジェクトが前記追跡オブジェクトに関連付けられたか否かに基づいて、前記追跡オブジェクトが存在することの確かさを示す存在確信度を増減させるステップと、前記存在確信度が第1閾値以上である場合に、前記追跡オブジェクトを識別する識別情報に関連付けて、前記検出オブジェクトの位置に基づく出力位置を出力するステップと、を備える。 The object tracking method according to the second aspect of the present invention includes a step of detecting the position of a detection object, which is an object to be detected included in the captured image captured by the imaging device, and tracking an object detected in the past as a tracking object. Indicates the certainty that the tracking object exists based on the step, the step of associating the detection object with the tracking object being tracked, and whether the detection object is associated with the tracking object. A step of increasing or decreasing the existence certainty, and a step of outputting an output position based on the position of the detected object in association with the identification information that identifies the tracking object when the existence certainty is equal to or higher than the first threshold value. To be equipped with.

本発明によれば、オブジェクトを追跡する場合に、オブジェクトの追跡状況に応じて、オブジェクトを追跡する性能を向上させるという効果を奏する。 According to the present invention, when tracking an object, it is possible to improve the performance of tracking the object according to the tracking status of the object.

実施形態の物体追跡装置の概要を説明するための図である。It is a figure for demonstrating the outline of the object tracking apparatus of an embodiment. 物体追跡装置が搭載された車両の構成を示す図である。It is a figure which shows the structure of the vehicle which mounted the object tracking device. 算出部による存在確信度の算出方法について説明するための図である。It is a figure for demonstrating the calculation method of the existence certainty degree by a calculation part. 出力部による出力位置の出力の別の例を示す図である。It is a figure which shows another example of the output of an output position by an output part. 出力部による出力位置の出力の別の例を示す図である。It is a figure which shows another example of the output of an output position by an output part. 物体追跡装置による追跡オブジェクトの追跡の処理手順を示すフローチャートである。It is a flowchart which shows the processing procedure of the tracking object by the object tracking device.

[物体追跡装置の概要]
図1(a)及び(b)は、本実施形態の物体追跡装置の概要を説明するための図である。図1(a)は、物体追跡装置が搭載された車両の前方を撮像した撮像画像を示す。物体追跡装置は、例えば、ECU(Electronic Control Unit)によって実現される。物体追跡装置は、車両の前方を撮像した撮像画像に含まれるオブジェクトの位置を検出する。図1(a)の例では、オブジェクトは、物体追跡装置が搭載された車両の前方を走行する他の車両である。
[Overview of object tracking device]
1A and 1B are diagrams for explaining an outline of the object tracking device of the present embodiment. FIG. 1A shows a captured image of the front of a vehicle equipped with an object tracking device. The object tracking device is realized by, for example, an ECU (Electronic Control Unit). The object tracking device detects the position of the object included in the captured image captured in front of the vehicle. In the example of FIG. 1A, the object is another vehicle traveling in front of a vehicle equipped with an object tracking device.

物体追跡装置は、検出したオブジェクトを追跡オブジェクトとして追跡する。物体追跡装置は、所定時間前までの検出オブジェクトの履歴に基づいて、追跡オブジェクトの現在位置を推定する。図1(a)において物体追跡装置が追跡している複数の追跡オブジェクトを矩形の枠線で示す。図1(a)には、識別情報「1」〜「4」の追跡オブジェクトをそれぞれ示す。物体追跡装置は、追跡オブジェクトが存在することの確かさを示す存在確信度を算出する。識別情報「1」〜「4」の追跡オブジェクトが図1(a)の時刻に生成されたとすれば、図1(a)のボックスに示すように、識別情報「1」〜「4」の追跡オブジェクトの存在確信度は、いずれも初期値である0.5となる。 The object tracking device tracks the detected object as a tracking object. The object tracking device estimates the current position of the tracking object based on the history of the detected object up to a predetermined time ago. In FIG. 1A, a plurality of tracking objects tracked by the object tracking device are shown by a rectangular frame. FIG. 1A shows tracking objects of the identification information “1” to “4”, respectively. The object tracking device calculates an existence certainty that indicates the certainty that the tracking object exists. Assuming that the tracking objects of the identification information "1" to "4" are generated at the time of FIG. 1 (a), the tracking of the identification information "1" to "4" is as shown in the box of FIG. 1 (a). The existence certainty of the objects is 0.5, which is the initial value.

図1(b)は、図1(a)の撮像画像の次の撮像タイミングにおいて撮像された撮像画像を示す。物体追跡装置は、図1(b)に示す撮像画像に含まれる検出オブジェクトの位置を検出する。図1(b)には、識別情報「1」〜「4」の追跡オブジェクトに加えて、物体追跡装置が新たに検出した検出オブジェクトに対応する識別情報「5」の追跡オブジェクトを示す。 FIG. 1B shows an captured image captured at the next imaging timing of the captured image of FIG. 1A. The object tracking device detects the position of the detected object included in the captured image shown in FIG. 1 (b). FIG. 1B shows, in addition to the tracking objects of the identification information “1” to “4”, the tracking objects of the identification information “5” corresponding to the detection objects newly detected by the object tracking device.

物体追跡装置は、検出したオブジェクトと、追跡オブジェクトとを関連付ける。物体追跡装置は、検出オブジェクトが追跡オブジェクトに関連付けられたか否かに基づいて、追跡オブジェクトの存在確信度を増減させる。図1(b)の例では、物体追跡装置は、識別情報「1」〜「4」の追跡オブジェクトと、検出された検出オブジェクトとを関連付ける。物体追跡装置は、検出オブジェクトに関連付けられた識別情報「1」〜「4」の追跡オブジェクトの存在確信度をいずれも0.5だけ増加させて存在確信度を1.0とする。一方、物体追跡装置は、新たに検出した検出オブジェクトに対応する識別情報「5」の追跡オブジェクトの存在確信度を初期値である0.5とする。 The object tracking device associates the detected object with the tracking object. The object tracking device increases or decreases the certainty of existence of the tracking object based on whether the detected object is associated with the tracking object. In the example of FIG. 1B, the object tracking device associates the tracking objects with the identification information “1” to “4” with the detected detection objects. The object tracking device increases the existence certainty of the tracking objects of the identification information "1" to "4" associated with the detection object by 0.5 to make the existence certainty 1.0. On the other hand, the object tracking device sets the existence certainty of the tracking object of the identification information "5" corresponding to the newly detected detection object to 0.5, which is the initial value.

物体追跡装置は、追跡オブジェクトの存在確信度が第1閾値より大きい場合に、識別情報に関連付けて、検出オブジェクトに基づく出力位置を出力する。図1(b)の例では、第1閾値は1.0である。物体追跡装置は、存在確信度が1.0以上である識別情報「1」〜「4」の追跡オブジェクトの出力位置を識別情報に関連付けて自動運転装置へ出力させる。詳細については後述するが、物体追跡装置は、検出オブジェクトの位置と追跡オブジェクトの位置の履歴に基き、出力位置に加えて、位置の微分値である速度または加速度等を算出するものとする。速度は、物体追跡装置が搭載された車両に対する追跡オブジェクトの相対速度であってもよく、絶対速度であってもよい。加速度は、物体追跡装置が搭載された車両に対する追跡オブジェクトの相対加速度であってもよく、絶対加速度であってもよい。 The object tracking device outputs an output position based on the detected object in association with the identification information when the existence certainty of the tracking object is larger than the first threshold value. In the example of FIG. 1B, the first threshold value is 1.0. The object tracking device associates the output positions of the tracking objects with the identification information "1" to "4" having the existence certainty of 1.0 or more with the identification information and outputs them to the automatic driving device. Although the details will be described later, the object tracking device shall calculate the velocity or acceleration, which is a differential value of the position, in addition to the output position, based on the position of the detected object and the history of the position of the tracking object. The velocity may be the relative velocity of the tracking object to the vehicle equipped with the object tracking device, or may be the absolute velocity. The acceleration may be the relative acceleration of the tracking object to the vehicle equipped with the object tracking device, or may be the absolute acceleration.

物体追跡装置は、検出オブジェクトが追跡オブジェクトに関連付けられたか否かに基づいて、追跡オブジェクトの存在確信度を増減させる。物体追跡装置は、繰り返し検出された追跡オブジェクトの存在確信度が比較的大きくなるように存在確信度を算出することにより、一時的にオブジェクトが検出できなかった場合であっても、繰り返し検出された追跡オブジェクトの出力位置の出力が中断されることを抑制することができる。また、一瞬だけ誤検知されたオブジェクトに対して、存在確信度が十分に大きくない場合には追跡オブジェクトの出力位置の出力を抑制することができる。したがって、物体追跡装置は、オブジェクトを追跡する場合に、オブジェクトを追跡する性能を向上させることができる。 The object tracking device increases or decreases the certainty of existence of the tracking object based on whether the detected object is associated with the tracking object. The object tracking device calculates the existence certainty so that the existence certainty of the repeatedly detected tracking object becomes relatively large, so that the object is repeatedly detected even if the object cannot be detected temporarily. It is possible to suppress the output of the output position of the tracking object from being interrupted. In addition, if the existence certainty is not sufficiently high for an object that is falsely detected for a moment, the output of the output position of the tracking object can be suppressed. Therefore, the object tracking device can improve the performance of tracking an object when tracking the object.

[車両の構成]
図2は、物体追跡装置3が搭載された車両100の構成を示す図である。車両100は、撮像装置1、自動運転装置2及び物体追跡装置3を備える。物体追跡装置3は、記憶部31及び制御部32を備える。撮像装置1は、車両100の前方を撮像する。撮像装置1は、例えば、複数のカメラを備えるステレオカメラであり、複数のカメラの間における視差に基づいて、撮像装置1から検出オブジェクトまでの距離を測定する。撮像装置1は、所定のフレームレートで車両100の前方を撮像する。自動運転装置2は、例えば、物体追跡装置3とは同一又は別のECUにより実現される。自動運転装置2は、車両100の走行を自動制御する。自動運転装置2は、物体追跡装置3が出力した追跡オブジェクトとの衝突の危険が生じないように車両100の走行を制御する。
[Vehicle configuration]
FIG. 2 is a diagram showing a configuration of a vehicle 100 equipped with an object tracking device 3. The vehicle 100 includes an image pickup device 1, an automatic driving device 2, and an object tracking device 3. The object tracking device 3 includes a storage unit 31 and a control unit 32. The image pickup device 1 takes an image of the front of the vehicle 100. The image pickup device 1 is, for example, a stereo camera including a plurality of cameras, and measures the distance from the image pickup device 1 to the detection object based on the parallax between the plurality of cameras. The image pickup apparatus 1 images the front of the vehicle 100 at a predetermined frame rate. The automatic driving device 2 is realized by, for example, the same or different ECU as the object tracking device 3. The automatic driving device 2 automatically controls the running of the vehicle 100. The automatic driving device 2 controls the running of the vehicle 100 so that there is no risk of collision with the tracking object output by the object tracking device 3.

記憶部31は、例えば、ROM(Read Only Memory)及びRAM(Random Access Memory)等により構成される。記憶部31は、制御部32を機能させるための各種プログラムや各種データを記憶する。制御部32は、記憶部31に記憶されたプログラムを実行することにより、物体検出部321、追跡部322、関連付け部323、取得部324、算出部325、出力部326及び設定部327として機能する。 The storage unit 31 is composed of, for example, a ROM (Read Only Memory), a RAM (Random Access Memory), or the like. The storage unit 31 stores various programs and various data for operating the control unit 32. The control unit 32 functions as an object detection unit 321, a tracking unit 322, an association unit 323, an acquisition unit 324, a calculation unit 325, an output unit 326, and a setting unit 327 by executing a program stored in the storage unit 31. ..

物体検出部321は、撮像装置1が撮像した撮像画像に含まれる検出対象のオブジェクトである検出オブジェクトの位置を検出する。具体的には、物体検出部321は、学習済みの機械学習モデルの入力を撮像画像として、この撮像画像に含まれる検出オブジェクトの位置と種類を機械学習モデルに出力させる。検出オブジェクトの種類は、例えば、大型四輪自動車、中型四輪自動車、普通四輪自動車、自動二輪車、自転車又は歩行者等である。 The object detection unit 321 detects the position of the detection object, which is the object to be detected included in the captured image captured by the image pickup device 1. Specifically, the object detection unit 321 uses the input of the trained machine learning model as an captured image, and outputs the position and type of the detected object included in the captured image to the machine learning model. The types of detection objects are, for example, large four-wheeled vehicles, medium-sized four-wheeled vehicles, ordinary four-wheeled vehicles, motorcycles, bicycles, pedestrians, and the like.

[オブジェクトの追跡]
追跡部322は、物体検出部321が過去に検出したオブジェクトを追跡オブジェクトとして追跡する。記憶部31には、追跡中の追跡オブジェクトの一つ前の推定位置や速度等の状態を含む状態情報に加え、追跡オブジェクトの識別情報が記憶されている。記憶部31には、追跡中の追跡オブジェクトの識別情報と、物体検出部321が過去に検出した検出オブジェクトの位置と、この検出オブジェクトが検出された検出時刻とが関連付けられた履歴を示す履歴情報が記憶されていてもよい。
[Object Tracking]
The tracking unit 322 tracks an object detected in the past by the object detection unit 321 as a tracking object. The storage unit 31 stores identification information of the tracking object in addition to the state information including the state such as the estimated position and the speed immediately before the tracking object being tracked. The storage unit 31 stores the identification information of the tracking object being tracked, the position of the detection object detected in the past by the object detection unit 321 and the history information indicating the history associated with the detection time when the detection object is detected. May be remembered.

追跡部322は、追跡中の追跡オブジェクトの状態情報に含まれる追跡オブジェクトの一つ前の推定位置や速度等を記憶部31から読み出す。追跡部322は、読み出した追跡オブジェクトの一つ前の推定位置や速度等の状態に基づいて、公知のトラッキング処理により、追跡オブジェクトの現在位置を推定する。トラッキング処理は、例えば、カルマンフィルタ又はパーティクルフィルタにより実現される。 The tracking unit 322 reads from the storage unit 31 the estimated position, speed, etc. immediately before the tracking object included in the state information of the tracking object being tracked. The tracking unit 322 estimates the current position of the tracking object by a known tracking process based on the state such as the estimated position and speed immediately before the read tracking object. The tracking process is realized by, for example, a Kalman filter or a particle filter.

また、追跡部322は、履歴情報を参照して、追跡オブジェクトの識別情報と、所定時間前までの検出時刻とに関連付けられた過去の検出オブジェクトの位置を記憶部31から読み出してもよい。追跡部322は、読み出した追跡中の追跡オブジェクトの過去の検出オブジェクトの位置及び対応する検出時刻に基づいて、公知のトラッキング処理により、追跡オブジェクトの現在位置を推定してもよい。 Further, the tracking unit 322 may refer to the history information and read the position of the past detection object associated with the identification information of the tracking object and the detection time up to a predetermined time from the storage unit 31. The tracking unit 322 may estimate the current position of the tracking object by a known tracking process based on the position of the past detection object of the tracked object being read and the corresponding detection time.

追跡部322は、記憶部31に記憶されている追跡オブジェクト情報を読み出す。追跡オブジェクト情報は、追跡オブジェクトを識別する識別情報と、追跡オブジェクトの状態と特徴を示す情報と、追跡オブジェクトの存在確信度を示す情報とを含む。追跡部322は、追跡オブジェクト情報に含まれる追跡オブジェクトの存在確信度が第2閾値より大きいか否かを判定する。第2閾値は、第1閾値より小さいものとする。追跡部322は、追跡オブジェクトの存在確信度が第2閾値以下である場合に、この追跡オブジェクトの追跡を終了する。追跡部322は、追跡を終了した追跡オブジェクト情報を記憶部31から削除する。 The tracking unit 322 reads out the tracking object information stored in the storage unit 31. The tracking object information includes identification information that identifies the tracking object, information that indicates the state and characteristics of the tracking object, and information that indicates the certainty of existence of the tracking object. The tracking unit 322 determines whether or not the existence certainty of the tracking object included in the tracking object information is greater than the second threshold value. The second threshold value shall be smaller than the first threshold value. The tracking unit 322 ends the tracking of the tracking object when the certainty of existence of the tracking object is equal to or less than the second threshold value. The tracking unit 322 deletes the tracking object information for which tracking has been completed from the storage unit 31.

[検出オブジェクトと追跡オブジェクトとの関連付け]
関連付け部323は、物体検出部321が検出した検出オブジェクトと、追跡部322が追跡している追跡オブジェクトとを関連付ける。関連付け部323は、追跡オブジェクトを示す追跡オブジェクト情報を記憶部31から読み出す。追跡オブジェクト情報に含まれる追跡オブジェクトの状態と特徴は、履歴情報において追跡オブジェクトの識別情報に関連付けられた過去の検出オブジェクトから関連付け部323が抽出することにより作成される。
[Association of discovery object with tracking object]
The association unit 323 associates the detection object detected by the object detection unit 321 with the tracking object tracked by the tracking unit 322. The association unit 323 reads the tracking object information indicating the tracking object from the storage unit 31. The state and characteristics of the tracking object included in the tracking object information are created by the association unit 323 extracting from the past detection objects associated with the identification information of the tracking object in the history information.

関連付け部323は、物体検出部321が検出した検出オブジェクトの位置等の状態及びエッジ等の特徴と、読み出した追跡オブジェクト情報に含まれる追跡オブジェクトの状態及び特徴とが相違する程度を示す相違度を求める。例えば、関連付け部323は、物体検出部321が検出した検出オブジェクトの位置と、追跡部322が推定した追跡オブジェクトの現在位置との間の距離を考慮して相違度を求める。その場合、関連付け部323は、検出オブジェクトの位置と、追跡部322が推定した追跡オブジェクトの現在位置との距離が大きいほど、相違度が大きくなるように相違度を補正してもよい。この距離は、検出オブジェクトと追跡オブジェクトとの三次元の距離であるが、撮像画像上における画素の数であってもよい。 The association unit 323 determines the degree of difference indicating the degree of difference between the state such as the position and the edge of the detected object detected by the object detection unit 321 and the feature such as the edge and the state and the feature of the tracking object included in the read tracking object information. Ask. For example, the association unit 323 obtains the degree of difference in consideration of the distance between the position of the detection object detected by the object detection unit 321 and the current position of the tracking object estimated by the tracking unit 322. In that case, the association unit 323 may correct the degree of difference so that the greater the distance between the position of the detection object and the current position of the tracking object estimated by the tracking unit 322, the greater the degree of difference. This distance is a three-dimensional distance between the detection object and the tracking object, but may be the number of pixels on the captured image.

関連付け部323は、物体検出部321が検出した複数の検出オブジェクトと、追跡部322が追跡している複数の追跡オブジェクトとの間において、検出オブジェクトと追跡オブジェクトとを関連付けた複数の組み合わせを生成する。関連付け部323は、求めた相違度の和が最小となるように追跡オブジェクトと検出オブジェクトとを関連付けるものの組み合わせを決定する。その際、それぞれの追跡オブジェクトとの間の相違度がいずれも所定の上限値以上となる検出オブジェクトは新しい追跡オブジェクトとして記憶される。また、それぞれの検出オブジェクトとの間の相違度がいずれも所定の上限値以下とならない追跡オブジェクトはその時刻において関連付け不可の追跡オブジェクトとして記憶される。 The association unit 323 generates a plurality of combinations in which the detection object and the tracking object are associated with each other between the plurality of detection objects detected by the object detection unit 321 and the plurality of tracking objects tracked by the tracking unit 322. .. The association unit 323 determines a combination of objects that associate the tracking object and the detection object so that the sum of the obtained differences is minimized. At that time, the detection object whose difference between each tracking object is equal to or more than a predetermined upper limit value is stored as a new tracking object. Further, a tracking object whose difference between the detected objects and the detection objects does not fall below a predetermined upper limit value is stored as a tracking object that cannot be associated at that time.

[ハンガリアンアルゴリズム]
例えば、関連付け部323は、複数の検出オブジェクトと、複数の追跡オブジェクトとの間において、ハンガリアンアルゴリズムを用いることにより、相違度が最小となる組み合わせを一意に定めることができる。
[Hungarian algorithm]
For example, the association unit 323 can uniquely determine the combination that minimizes the difference between the plurality of detection objects and the plurality of tracking objects by using the Hungarian algorithm.

関連付け部323は、追跡オブジェクトの識別情報と、検出オブジェクトの位置と、検出オブジェクトが検出された検出時刻とを関連付けて、記憶部31が記憶している履歴情報に追加する。関連付け部323は、検出オブジェクトが追跡オブジェクトに関連付けられない場合に、この検出オブジェクトを追跡部322が追跡するための新たな追跡オブジェクト情報を作成する。関連付け部323は、作成した追跡オブジェクト情報を記憶部31に記憶させる。関連付け部323は、追跡オブジェクトの識別情報と、追跡オブジェクトの状態及び特徴を示す情報と、追跡オブジェクトの存在確信度を示す情報とをそれぞれ作成してこの追跡オブジェクト情報に含める。関連付け部323は、他の追跡オブジェクトの追跡に使用した識別情報は、一定期間は再利用しないようにする。関連付け部323は、追跡オブジェクトの存在確信度を初期値とする。 The association unit 323 associates the identification information of the tracking object with the position of the detection object and the detection time when the detection object is detected, and adds the identification information to the history information stored in the storage unit 31. The association unit 323 creates new tracking object information for the tracking unit 322 to track the detection object when the detection object is not associated with the tracking object. The association unit 323 stores the created tracking object information in the storage unit 31. The association unit 323 creates identification information of the tracking object, information indicating the state and characteristics of the tracking object, and information indicating the certainty of existence of the tracking object, and includes the information indicating the existence certainty of the tracking object in the tracking object information. The association unit 323 prevents the identification information used for tracking other tracking objects from being reused for a certain period of time. The association unit 323 sets the existence certainty of the tracking object as an initial value.

取得部324は、撮像装置1から検出オブジェクトまでの距離を取得する。取得部324は、撮像装置1がステレオカメラである場合には、撮像装置1から検出オブジェクトまでの距離を撮像装置1により測定した測定結果を取得する。取得部324は、撮像装置1から検出オブジェクトまでの距離をレーザレーダ(不図示)等の他の測距装置により測定した測定結果を取得してもよい。 The acquisition unit 324 acquires the distance from the image pickup apparatus 1 to the detection object. When the image pickup device 1 is a stereo camera, the acquisition unit 324 acquires the measurement result obtained by measuring the distance from the image pickup device 1 to the detection object by the image pickup device 1. The acquisition unit 324 may acquire a measurement result obtained by measuring the distance from the image pickup device 1 to the detection object by another distance measuring device such as a laser radar (not shown).

[存在確信度の算出]
算出部325は、追跡オブジェクトと検出オブジェクトとが関連付けられたか否かに基づいて、追跡オブジェクトが存在することの確かさを示す存在確信度を増減させる。図3は、算出部325による存在確信度の算出方法について説明するための図である。図3には、時刻k〜時刻k+7においてある単一の追跡オブジェクトに対して、算出部325が算出した存在確信度の変化を示す。関連付け部323は、時刻kにおいて検出オブジェクトを追跡するための新たな追跡オブジェクト情報を作成したものとする。図3では一例として、算出部325は、この追跡オブジェクト情報に含まれる追跡オブジェクトの存在確信度に初期値0.5を割り当てる。
[Calculation of existence certainty]
The calculation unit 325 increases or decreases the certainty of existence indicating the certainty that the tracking object exists, based on whether or not the tracking object and the detection object are associated with each other. FIG. 3 is a diagram for explaining a method of calculating the existence certainty by the calculation unit 325. FIG. 3 shows the change in the certainty of existence calculated by the calculation unit 325 for a single tracking object from time k to time k + 7. It is assumed that the association unit 323 has created new tracking object information for tracking the detected object at time k. As an example in FIG. 3, the calculation unit 325 assigns an initial value of 0.5 to the existence certainty of the tracking object included in the tracking object information.

算出部325は、時刻k+1において関連付け部323が追跡オブジェクトに検出オブジェクトを関連付けた場合、追跡オブジェクトの存在確信度にインクリメント値0.5を加算して存在確信度を1.0とする。算出部325は、時刻k+2及び時刻k+3において関連付け部323が追跡オブジェクトに検出オブジェクトを関連付けた場合、追跡オブジェクトの存在確信度にインクリメント値0.5をそれぞれ加算して存在確信度を順に1.5及び2.0とする。 When the association unit 323 associates the detection object with the tracking object at time k + 1, the calculation unit 325 adds an increment value of 0.5 to the existence certainty of the tracking object to set the existence certainty to 1.0. When the association unit 323 associates the detection object with the tracking object at the time k + 2 and the time k + 3, the calculation unit 325 adds an increment value of 0.5 to the existence certainty of the tracking object to increase the existence certainty of 1.5 in order. And 2.0.

また、算出部325は、取得部324が検出オブジェクトと追跡オブジェクトとを関連付けた際の相違度が小さいほど、インクリメント値を相対的に大きくしてもよい。例えば、算出部325は、取得部324が検出オブジェクトと追跡オブジェクトとを関連付けた際の相違度が10ポイントだった場合、追跡オブジェクトの存在確信度に0.2のインクリメント値を加算する。一方、算出部325は、取得部324が検出オブジェクトと追跡オブジェクトとを関連付けた際の相違度が5ポイントだった場合、追跡オブジェクトの存在確信度に0.4のインクリメント値を加算してもよい。 Further, the calculation unit 325 may increase the increment value relatively as the degree of difference when the acquisition unit 324 associates the detection object with the tracking object is smaller. For example, the calculation unit 325 adds an increment value of 0.2 to the existence certainty of the tracking object when the difference degree when the acquisition unit 324 associates the detection object with the tracking object is 10 points. On the other hand, the calculation unit 325 may add an increment value of 0.4 to the existence certainty of the tracking object when the difference degree when the acquisition unit 324 associates the detection object and the tracking object is 5 points. ..

算出部325は、時刻k+4において関連付け部323が追跡オブジェクトに検出オブジェクトを関連付けなかった場合、追跡オブジェクトの存在確信度からデクリメント値0.5を減算して存在確信度を1.5とする。算出部325は、時刻k+5〜時刻k+7において関連付け部323が追跡オブジェクトに検出オブジェクトを関連付けなかった場合、追跡オブジェクトの存在確信度からデクリメント値0.5をそれぞれ減算して存在確信度を順に1.0、0.5及び0.0とする。図3の例では、追跡オブジェクトの追跡を終了するか否かを判定するための第2閾値は0.0であり、時刻k+7において追跡オブジェクトの存在確信度が第2閾値以下となるため、この追跡オブジェクトの追跡部322による追跡は終了される。 When the association unit 323 does not associate the detection object with the tracking object at time k + 4, the calculation unit 325 subtracts the decrement value 0.5 from the existence certainty of the tracking object to set the existence certainty to 1.5. When the association unit 323 does not associate the detection object with the tracking object at time k + 5 to time k + 7, the calculation unit 325 subtracts the decrement value 0.5 from the existence certainty of the tracking object to determine the existence certainty in order. It is set to 0, 0.5 and 0.0. In the example of FIG. 3, the second threshold value for determining whether or not to end the tracking of the tracking object is 0.0, and the existence certainty of the tracking object becomes equal to or less than the second threshold value at time k + 7. The tracking by the tracking unit 322 of the tracking object is terminated.

関連付け部323が撮像画像の端部に位置する追跡オブジェクトに検出オブジェクトを関連付けなかった場合、追跡オブジェクトは、撮像装置1の撮像範囲の外へ移動した可能性が高い。算出部325は、追跡オブジェクトの現在位置が撮像画像の端部を含む所定領域内である場合、追跡オブジェクトに検出オブジェクトが関連付けられなければ、追跡オブジェクトが撮像範囲の外へ移動したと推定し、追跡オブジェクトの存在確信度を第2閾値以下にする。例えば、追跡オブジェクトの存在確信度がとり得る最大値を2.0と仮定すると、算出部325は、追跡オブジェクトの存在確信度をこの最大値と同じ値だけ減算させることにより存在確信度を第2閾値以下にする。所定領域は、例えば、撮像装置1の1フレームに相当する時間よりも短い時間において追跡オブジェクトが撮像範囲の外へ移動することが予想される領域として当業者が定める。 If the association unit 323 does not associate the detection object with the tracking object located at the end of the captured image, the tracking object is likely to have moved out of the imaging range of the imaging device 1. When the current position of the tracking object is within a predetermined area including the edge of the captured image, the calculation unit 325 estimates that the tracking object has moved out of the imaging range if the tracking object is not associated with the detection object. Set the certainty of existence of the tracking object to the second threshold or less. For example, assuming that the maximum value that the existence certainty of the tracking object can take is 2.0, the calculation unit 325 subtracts the existence certainty of the tracking object by the same value as this maximum value to reduce the existence certainty. Make it below the threshold. The predetermined area is defined by those skilled in the art as, for example, a region in which the tracking object is expected to move out of the imaging range in a time shorter than the time corresponding to one frame of the imaging device 1.

算出部325は、検出オブジェクトの位置に基づいて、出力位置を算出する。算出部325は、一例としては、追跡中のオブジェクトの推定位置と、物体検出部321が検出した検出オブジェクトの位置との両方を用いて、カルマンフィルタにより出力位置を算出する。具体的にはカルマンフィルタは観測オブジェクトの位置と遷移方程式に基づく予測オブジェクトの位置との残差にカルマンゲインを乗じて,予測オブジェクト位置に加えることによって、位置の修正ステップを実行する。 The calculation unit 325 calculates the output position based on the position of the detected object. As an example, the calculation unit 325 calculates the output position by the Kalman filter using both the estimated position of the object being tracked and the position of the detected object detected by the object detection unit 321. Specifically, the Kalman filter executes the position correction step by multiplying the residual between the position of the observed object and the position of the predicted object based on the transition equation by the Kalman gain and adding it to the predicted object position.

また、算出部325は、追跡オブジェクトの存在確信度に基づいて、カルマンフィルタ等のトラッキング手法における設定パラメータの値を変更してもよい。例えば、算出部325は、追跡オブジェクトの存在確信度が大きいほど、カルマンフィルタの遷移方程式におけるプロセスノイズの値を小さくしてもよい。また、算出部325は、カルマンフィルタにより出力位置を算出する例に限定されない。例えば、算出部325は、パーティクルフィルタにより出力位置を算出してもよく、状態空間モデルに基づかず、単に物体検出部321が検出した検出オブジェクトの位置をそのまま出力位置としてもよい。 Further, the calculation unit 325 may change the value of the setting parameter in the tracking method such as the Kalman filter based on the existence certainty of the tracking object. For example, the calculation unit 325 may reduce the value of the process noise in the transition equation of the Kalman filter as the certainty of existence of the tracking object increases. Further, the calculation unit 325 is not limited to the example of calculating the output position by the Kalman filter. For example, the calculation unit 325 may calculate the output position by the particle filter, or may simply use the position of the detected object detected by the object detection unit 321 as the output position without being based on the state space model.

算出部325は、記憶部31が記憶している履歴情報を参照して、追跡オブジェクトの識別情報に関連付けられた複数の検出オブジェクトの位置の変化の時間微分値を追跡オブジェクトの速度として算出する。算出部325は、追跡オブジェクトの速度の時間微分値である追跡オブジェクトの加速度を算出する。 The calculation unit 325 refers to the history information stored in the storage unit 31 and calculates the time differential value of the change in the position of the plurality of detection objects associated with the identification information of the tracking object as the velocity of the tracking object. The calculation unit 325 calculates the acceleration of the tracking object, which is the time derivative of the velocity of the tracking object.

上記のように、算出部325は、複数の過去の検出オブジェクトの位置を考慮したオブジェクトの位置と、物体検出部321が検出した検出オブジェクトの位置との両方を用いて出力位置を算出する。このため、算出部325は、物体検出部321が検出オブジェクトの位置として本来の位置と大きく異なる位置を検出した場合等に、出力位置が誤って出力されることを抑制することができる。 As described above, the calculation unit 325 calculates the output position using both the position of the object in consideration of the positions of the plurality of past detection objects and the position of the detection object detected by the object detection unit 321. Therefore, the calculation unit 325 can prevent the output position from being erroneously output when the object detection unit 321 detects a position that is significantly different from the original position as the position of the detection object.

[出力位置の出力]
出力部326は、追跡オブジェクトの存在確信度が第1閾値以上である場合に、追跡オブジェクトを識別する識別情報に関連付けて、算出部325が算出した出力位置を出力する。図3の例では、第1閾値は1.0である。時刻k+1において追跡オブジェクトの存在確信度は1.0であるため、出力部326は、時刻k+1において追跡オブジェクトの存在確信度が第1閾値以上であると判定し、この追跡オブジェクトの識別情報に関連付けて、自動運転装置2へ出力位置を出力する。同様に、出力部326は、時刻k+2及び時刻k+3において追跡オブジェクトの存在確信度が第1閾値以上であると判定し、この追跡オブジェクトの識別情報に関連付けて、自動運転装置2へ出力位置を出力する。
[Output of output position]
The output unit 326 outputs the output position calculated by the calculation unit 325 in association with the identification information that identifies the tracking object when the existence certainty of the tracking object is equal to or higher than the first threshold value. In the example of FIG. 3, the first threshold value is 1.0. Since the existence certainty of the tracking object is 1.0 at time k + 1, the output unit 326 determines that the existence certainty of the tracking object is equal to or higher than the first threshold value at time k + 1, and associates it with the identification information of this tracking object. Then, the output position is output to the automatic operation device 2. Similarly, the output unit 326 determines that the existence certainty of the tracking object is equal to or higher than the first threshold value at the time k + 2 and the time k + 3, and outputs the output position to the automatic driving device 2 in association with the identification information of the tracking object. do.

出力部326は、時刻k+4及び時刻k+5において追跡オブジェクトの存在確信度が第1閾値以上であると判定する。このとき、追跡オブジェクトに検出オブジェクトが関連付け部323により関連付けられていないので、出力部326は、追跡部322が推定した追跡オブジェクトの現在位置を出力位置として出力する。一方、出力部326は、時刻k、時刻k+6及び時刻k+7において追跡オブジェクトの存在確信度が第1閾値未満であると判定し、自動運転装置2へ出力位置を出力しない。 The output unit 326 determines that the existence certainty of the tracking object is equal to or higher than the first threshold value at the time k + 4 and the time k + 5. At this time, since the detection object is not associated with the tracking object by the association unit 323, the output unit 326 outputs the current position of the tracking object estimated by the tracking unit 322 as the output position. On the other hand, the output unit 326 determines that the certainty of existence of the tracking object is less than the first threshold value at the time k, the time k + 6 and the time k + 7, and does not output the output position to the automatic operation device 2.

図4及び図5は、出力部326による出力位置の出力の別の例を示す図である。図4の時刻k〜時刻k+6については図3と同じであるため、説明を省略する。出力部326は、時刻k+6において追跡オブジェクトの存在確信度が第1閾値未満であるため、自動運転装置2へ出力位置を出力しない。このとき、存在確信度が第2閾値である0.0より大きいため、追跡部322による追跡オブジェクトの追跡は終了されない。 4 and 5 are diagrams showing another example of output at the output position by the output unit 326. Since the time k to the time k + 6 in FIG. 4 are the same as those in FIG. 3, the description thereof will be omitted. The output unit 326 does not output the output position to the automatic operation device 2 because the certainty of existence of the tracking object is less than the first threshold value at the time k + 6. At this time, since the existence certainty is greater than 0.0, which is the second threshold value, the tracking of the tracking object by the tracking unit 322 is not completed.

時刻k+7では、算出部325が存在確信度をインクリメント値である0.5だけ加算して存在確信度を1.0とし、存在確信度が第1閾値以上になる。このため、出力部326は、出力を中断する前と同じ識別情報に関連付けて、出力位置の出力を再開する。出力部326は、出力を中断する前と同じ識別情報に関連付けて出力位置を出力することにより、意図せず追跡オブジェクトの識別情報が付し直されることを抑制することができる。 At time k + 7, the calculation unit 325 adds the existence certainty by 0.5, which is an increment value, to set the existence certainty to 1.0, and the existence certainty becomes equal to or higher than the first threshold value. Therefore, the output unit 326 resumes the output at the output position in association with the same identification information as before the output was interrupted. By outputting the output position in association with the same identification information as before the output is interrupted, the output unit 326 can prevent the identification information of the tracking object from being unintentionally reattached.

図5の時刻kにおいて本来存在しない検出オブジェクトが誤検出されたものとする。出力部326は、時刻kにおいて関連付け部323が検出オブジェクトに対応する追跡オブジェクト情報を作成した状態では、追跡オブジェクトの存在確信度の初期値0.5は第1閾値である1.0より小さいと判定し、出力位置を出力しない。次の時刻k+1において関連付け部323が検出オブジェクトと追跡オブジェクトとを関連付けなかった場合、追跡オブジェクトの存在確信度は、デクリメント値である0.5だけ減算されて0.0となる。出力部326は、存在確信度が第1閾値よりも小さいと判定し、出力位置を出力しない。このとき、追跡オブジェクトの存在確信度が第2閾値である0.0以下であるため、追跡部322による追跡オブジェクトの追跡は終了される。 It is assumed that a detection object that does not originally exist is erroneously detected at time k in FIG. According to the output unit 326, when the association unit 323 creates the tracking object information corresponding to the detected object at time k, the initial value 0.5 of the existence certainty of the tracking object is smaller than the first threshold value of 1.0. Judge and do not output the output position. If the association unit 323 does not associate the detection object with the tracking object at the next time k + 1, the existence certainty of the tracking object is subtracted by 0.5, which is the decrement value, to become 0.0. The output unit 326 determines that the existence certainty is smaller than the first threshold value, and does not output the output position. At this time, since the existence certainty of the tracking object is 0.0 or less, which is the second threshold value, the tracking of the tracking object by the tracking unit 322 is completed.

以上のように、本来存在しないオブジェクトが一時的に誤検出された場合には、以降の時刻において、検出オブジェクトと関連付けられないので、追跡オブジェクトの存在確信度が第1閾値以上になる可能性は小さい。したがって、出力部326は、誤検出したオブジェクトの出力位置を自動運転装置2へ出力することを抑制することができる。また、出力部326は、追跡オブジェクトの出力位置を自動運転装置2へ出力する例に限定されない。例えば、出力部326は、追跡オブジェクトの出力位置を識別情報に関連付けてディスプレイに出力してもよい。また、本実施形態においては、出力情報をオブジェクトの位置であるとして記載したが、これに限定されない。出力部326は追跡オブジェクトの識別情報に関連付けて、追跡オブジェクトの状態として定義されている位置以外の情報である速度や加速度又は大きさの情報を自動運転装置2へ出力してもよい。 As described above, if an object that does not originally exist is temporarily falsely detected, it will not be associated with the detected object at a later time, so there is a possibility that the existence certainty of the tracking object will exceed the first threshold value. small. Therefore, the output unit 326 can suppress the output position of the erroneously detected object to the automatic operation device 2. Further, the output unit 326 is not limited to the example of outputting the output position of the tracking object to the automatic driving device 2. For example, the output unit 326 may output the output position of the tracking object to the display in association with the identification information. Further, in the present embodiment, the output information is described as the position of the object, but the present invention is not limited to this. The output unit 326 may output information on speed, acceleration, or magnitude, which is information other than the position defined as the state of the tracking object, to the automatic driving device 2 in association with the identification information of the tracking object.

[変数の設定]
図2の設定部327は、初期値及び第1閾値等の各種の変数を設定する。検出オブジェクトまでの距離が比較的小さい場合には、車両100と検出オブジェクトとの接触等を抑制するため、出力部326が出力位置を出力しやすくなるように第1閾値を設定することが好ましい。
[Variable settings]
The setting unit 327 of FIG. 2 sets various variables such as an initial value and a first threshold value. When the distance to the detection object is relatively small, it is preferable to set the first threshold value so that the output unit 326 can easily output the output position in order to suppress the contact between the vehicle 100 and the detection object.

一方、検出オブジェクトまでの距離が比較的大きい場合には、出力部326が出力位置を出力しにくくなるように第1閾値を設定することにより、出力部326が誤った出力位置を出力することを抑制することができ、自動運転装置2による自動運転の誤作動を抑止する効果等が期待できる。 On the other hand, when the distance to the detection object is relatively large, the output unit 326 outputs an incorrect output position by setting the first threshold value so that the output unit 326 does not easily output the output position. It can be suppressed, and the effect of suppressing the malfunction of the automatic operation by the automatic operation device 2 can be expected.

そこで、設定部327は、第2距離が第1距離よりも大きいと仮定すると、取得部324が取得した検出オブジェクトまでの距離が第1距離の場合には、検出オブジェクトまでの距離が第2距離の場合に比べて、第1閾値を相対的に小さく設定する。例えば、設定部327は、検出オブジェクトまでの距離が100メートルのときには、第1閾値を相対的に大きい1.0に設定する。設定部327は、検出オブジェクトまでの距離が10メートルのときには、検出オブジェクトまでの距離が100メートルの場合に比べて、第1閾値を相対的に小さい0.1とする。このようにして、設定部327は、車両100の安全を確保しつつ、出力部326が誤った出力位置を出力することを抑制することができる。 Therefore, assuming that the second distance is larger than the first distance, the setting unit 327 sets the distance to the detection object as the second distance when the distance to the detection object acquired by the acquisition unit 324 is the first distance. The first threshold value is set relatively small as compared with the case of. For example, the setting unit 327 sets the first threshold value to 1.0, which is relatively large, when the distance to the detection object is 100 meters. When the distance to the detection object is 10 meters, the setting unit 327 sets the first threshold value to 0.1, which is relatively small as compared with the case where the distance to the detection object is 100 meters. In this way, the setting unit 327 can prevent the output unit 326 from outputting an erroneous output position while ensuring the safety of the vehicle 100.

また、設定部327は、第1閾値の代わりに、新たな追跡オブジェクト情報に含まれる存在確信度の初期値を設定してもよい。設定部327は、撮像装置1から検出オブジェクトまでの距離が短いほど、存在確信度の初期値を相対的に大きく設定してもよい。例えば、設定部327は、撮像装置1から検出オブジェクトまでの距離が100メートルの場合には、存在確信度の初期値を相対的に小さい0.1とする。一方、撮像装置1から検出オブジェクトまでの距離が10メートルの場合には、存在確信度の初期値を相対的に大きい1.0としてもよい。このようにして、設定部327は、撮像装置1から検出オブジェクトまでの距離が大きい場合に、出力部326が出力位置を出力しにくくすることにより、出力部326が誤った出力位置を出力することを抑制することができる。 Further, the setting unit 327 may set an initial value of the existence certainty included in the new tracking object information instead of the first threshold value. The setting unit 327 may set the initial value of the existence certainty to be relatively large as the distance from the image pickup apparatus 1 to the detection object is shorter. For example, when the distance from the image pickup apparatus 1 to the detection object is 100 meters, the setting unit 327 sets the initial value of the existence certainty to 0.1, which is relatively small. On the other hand, when the distance from the image pickup apparatus 1 to the detection object is 10 meters, the initial value of the existence certainty may be set to 1.0, which is relatively large. In this way, when the distance from the image pickup apparatus 1 to the detection object is large, the setting unit 327 makes it difficult for the output unit 326 to output the output position, so that the output unit 326 outputs an erroneous output position. Can be suppressed.

また、設定部327は、インクリメント値をデクリメント値よりも大きく設定してもよい。設定部327は、インクリメント値をデクリメント値よりも大きく設定することにより、追跡オブジェクトの存在確信度が第1閾値未満となって出力部326が追跡オブジェクトの出力位置を出力しなくなった場合に、早いタイミングで出力部326に追跡オブジェクトの出力位置の出力を再開させることができる。 Further, the setting unit 327 may set the increment value to be larger than the decrement value. By setting the increment value larger than the decrement value, the setting unit 327 is faster when the existence certainty of the tracking object becomes less than the first threshold value and the output unit 326 stops outputting the output position of the tracking object. At the timing, the output unit 326 can restart the output of the output position of the tracking object.

[追跡オブジェクトの追跡の処理手順]
図6は、物体追跡装置3による追跡オブジェクトの追跡の処理手順を示すフローチャートである。この処理手順は、追跡部322による追跡オブジェクトの追跡中に開始する。追跡部322が複数のオブジェクトを追跡中である場合には、それぞれの追跡オブジェクトについて図6に示す一連の処理を繰り返すものとする。
[Procedure for tracking tracking objects]
FIG. 6 is a flowchart showing a processing procedure for tracking a tracking object by the object tracking device 3. This processing procedure starts during the tracking of the tracking object by the tracking unit 322. When the tracking unit 322 is tracking a plurality of objects, it is assumed that the series of processes shown in FIG. 6 is repeated for each tracking object.

まず、物体検出部321は、撮像装置1が撮像した撮像画像に含まれる検出対象のオブジェクトである検出オブジェクトの位置を検出する(S101)。関連付け部323は、追跡オブジェクトに検出オブジェクトを関連付けるか否かを判定する(S102)。算出部325は、S102の判定において追跡オブジェクトに検出オブジェクトを関連付け部323が関連付けた場合に(S102のYES)、この追跡オブジェクトの存在確信度をインクリメント値だけ加算する(S103)。 First, the object detection unit 321 detects the position of the detection object, which is the object to be detected included in the captured image captured by the image pickup device 1 (S101). The association unit 323 determines whether or not to associate the detection object with the tracking object (S102). When the association unit 323 associates the detection object with the tracking object in the determination of S102 (YES in S102), the calculation unit 325 adds the existence certainty of the tracking object by the increment value (S103).

出力部326は、追跡オブジェクトの存在確信度が第1閾値以上であるか否かを判定する(S104)。出力部326は、S104の判定において追跡オブジェクトの存在確信度が第1閾値以上である場合に(S104のYES)、追跡オブジェクトを識別する識別情報に関連付けて、追跡オブジェクトの出力位置を自動運転装置2へ出力する(S105)。追跡部322は、追跡オブジェクト情報に含まれる追跡オブジェクトの存在確信度が第2閾値より大きいか否かを判定する(S106)。追跡部322は、S106の判定において追跡オブジェクト情報に含まれる追跡オブジェクトの存在確信度が第2閾値以下である場合に(S106のNO)、この追跡オブジェクトの追跡を終了する(S107)。 The output unit 326 determines whether or not the existence certainty of the tracking object is equal to or higher than the first threshold value (S104). When the existence certainty of the tracking object is equal to or higher than the first threshold value in the determination of S104 (YES in S104), the output unit 326 automatically sets the output position of the tracking object in association with the identification information that identifies the tracking object. Output to 2 (S105). The tracking unit 322 determines whether or not the existence certainty of the tracking object included in the tracking object information is greater than the second threshold value (S106). The tracking unit 322 ends the tracking of the tracking object when the existence certainty of the tracking object included in the tracking object information is equal to or less than the second threshold value in the determination of S106 (NO in S106) (S107).

算出部325は、S102の判定において追跡オブジェクトに検出オブジェクトを関連付け部323が関連付けなかった場合に(S102のNO)、この追跡オブジェクトの存在確信度をデクリメント値だけ減算し(S108)、S104の判定に進む。出力部326は、S104の判定において追跡オブジェクトの存在確信度が第1閾値未満である場合に(S104のNO)、追跡オブジェクトの出力位置を自動運転装置2へ出力せず、S106の判定に進む。追跡部322は、S106の判定において追跡オブジェクト情報に含まれる追跡オブジェクトの存在確信度が第2閾値より大きい場合に(S106のYES)、処理を終了する。 When the association unit 323 does not associate the detection object with the tracking object in the determination of S102 (NO in S102), the calculation unit 325 subtracts the existence certainty of the tracking object by the decrement value (S108), and determines in S104. Proceed to. When the existence certainty of the tracking object is less than the first threshold value in the determination of S104 (NO in S104), the output unit 326 does not output the output position of the tracking object to the automatic driving device 2 and proceeds to the determination of S106. .. The tracking unit 322 ends the process when the existence certainty of the tracking object included in the tracking object information is greater than the second threshold value in the determination of S106 (YES in S106).

[本発明による効果]
本実施形態によれば、算出部325は、検出オブジェクトが追跡オブジェクトに関連付けられたか否かに基づいて、追跡オブジェクトの存在確信度を増減させる。算出部325は、繰り返し検出された追跡オブジェクトの存在確信度が比較的大きくなるように存在確信度を算出することにより、一時的にオブジェクトが検出できなかった場合に、繰り返し検出された追跡オブジェクトの出力位置の出力が中断されることを抑制することができる。このため、算出部325は、意図せず追跡オブジェクトに異なる識別情報が付し直されることを抑制することができる。また、一瞬だけ誤検知されたオブジェクトに対して、存在確信度が十分に大きくない場合には追跡オブジェクトの出力位置の出力を抑制することができる。したがって、物体追跡装置は、オブジェクトを追跡する場合に、オブジェクトを追跡する性能を向上させることができる。
[Effect of the present invention]
According to the present embodiment, the calculation unit 325 increases or decreases the certainty of existence of the tracking object based on whether or not the detection object is associated with the tracking object. The calculation unit 325 calculates the existence certainty so that the existence certainty of the repeatedly detected tracking object becomes relatively large, so that when the object cannot be detected temporarily, the repeatedly detected tracking object It is possible to suppress the interruption of the output at the output position. Therefore, the calculation unit 325 can prevent the tracking object from being unintentionally reattached with different identification information. In addition, if the existence certainty is not sufficiently high for an object that is falsely detected for a moment, the output of the output position of the tracking object can be suppressed. Therefore, the object tracking device can improve the performance of tracking an object when tracking the object.

以上、本発明を実施の形態を用いて説明したが、本発明の技術的範囲は上記実施の形態に記載の範囲には限定されず、その要旨の範囲内で種々の変形及び変更が可能である。例えば、装置の全部又は一部は、任意の単位で機能的又は物理的に分散・統合して構成することができる。また、複数の実施の形態の任意の組み合わせによって生じる新たな実施の形態も、本発明の実施の形態に含まれる。組み合わせによって生じる新たな実施の形態の効果は、もとの実施の形態の効果を併せ持つ。 Although the present invention has been described above using the embodiments, the technical scope of the present invention is not limited to the scope described in the above embodiments, and various modifications and changes can be made within the scope of the gist thereof. be. For example, all or a part of the device can be functionally or physically distributed / integrated in any unit. Also included in the embodiments of the present invention are new embodiments resulting from any combination of the plurality of embodiments. The effect of the new embodiment produced by the combination also has the effect of the original embodiment.

1 撮像装置
2 自動運転装置
3 物体追跡装置
31 記憶部
32 制御部
100 車両
321 物体検出部
322 追跡部
323 関連付け部
324 取得部
325 算出部
326 出力部
327 設定部
1 Imaging device 2 Automatic driving device 3 Object tracking device 31 Storage unit 32 Control unit 100 Vehicle 321 Object detection unit 322 Tracking unit 323 Association unit 324 Acquisition unit 325 Calculation unit 326 Output unit 327 Setting unit

Claims (8)

撮像装置が撮像した撮像画像に含まれる検出対象のオブジェクトである検出オブジェクトの位置を検出する物体検出部と、
前記物体検出部が過去に検出したオブジェクトを追跡オブジェクトとして追跡する追跡部と、
前記物体検出部が検出した前記検出オブジェクトと、前記追跡部が追跡している前記追跡オブジェクトとを関連付ける関連付け部と、
前記検出オブジェクトが前記追跡オブジェクトに関連付けられたか否かに基づいて、前記追跡オブジェクトが存在することの確かさを示す存在確信度を増減させる算出部と、
前記存在確信度が第1閾値以上である場合に、前記追跡オブジェクトを識別する識別情報に関連付けて、前記検出オブジェクトの位置に基づく出力位置を出力する出力部と、
を備える物体追跡装置。
An object detection unit that detects the position of a detection object, which is an object to be detected included in the captured image captured by the image pickup device, and an object detection unit.
A tracking unit that tracks an object detected in the past by the object detection unit as a tracking object,
An association unit that associates the detection object detected by the object detection unit with the tracking object tracked by the tracking unit.
A calculation unit that increases or decreases the certainty of existence indicating the certainty that the tracking object exists based on whether or not the detection object is associated with the tracking object.
An output unit that outputs an output position based on the position of the detected object in association with the identification information that identifies the tracking object when the existence certainty is equal to or higher than the first threshold value.
An object tracking device equipped with.
前記追跡部は、前記追跡オブジェクトの前記存在確信度が前記第1閾値より小さな第2閾値以下である場合に、当該追跡オブジェクトの追跡を終了する、
請求項1に記載の物体追跡装置。
The tracking unit ends tracking of the tracking object when the certainty of existence of the tracking object is equal to or less than a second threshold value smaller than the first threshold value.
The object tracking device according to claim 1.
前記撮像装置から前記検出オブジェクトまでの距離を取得する取得部と、
前記検出オブジェクトまでの距離が第1距離の場合には、前記検出オブジェクトまでの距離が前記第1距離よりも大きい第2距離の場合に比べて前記第1閾値を相対的に小さく設定する設定部と、をさらに備える、
請求項1又は2に記載の物体追跡装置。
An acquisition unit that acquires the distance from the imaging device to the detection object, and
When the distance to the detection object is the first distance, the setting unit which sets the first threshold value relatively smaller than the case where the distance to the detection object is the second distance larger than the first distance. And further prepare,
The object tracking device according to claim 1 or 2.
前記撮像装置から前記検出オブジェクトまでの距離を取得する取得部と、
前記関連付け部が前記検出オブジェクトと前記追跡オブジェクトとを関連付けない場合に、前記撮像装置から当該検出オブジェクトまでの距離が短いほど、当該検出オブジェクトを前記追跡部が追跡するための新たな追跡オブジェクト情報に含まれる前記存在確信度の初期値を相対的に大きく設定する設定部と、をさらに備える、
請求項1又は2に記載の物体追跡装置。
An acquisition unit that acquires the distance from the imaging device to the detection object, and
When the association unit does not associate the detection object with the tracking object, the shorter the distance from the imaging device to the detection object, the more new tracking object information for the tracking unit to track the detection object. A setting unit for setting a relatively large initial value of the included certainty of existence is further provided.
The object tracking device according to claim 1 or 2.
前記算出部は、前記追跡オブジェクトの現在位置が前記撮像画像の端部を含む所定領域内であり、且つ、当該追跡オブジェクトに前記検出オブジェクトが関連付けられなかった場合に、当該追跡オブジェクトの前記存在確信度を前記第2閾値以下にする、
請求項2に記載の物体追跡装置。
The calculation unit determines the existence of the tracking object when the current position of the tracking object is within a predetermined area including the edge of the captured image and the detection object is not associated with the tracking object. To make the degree less than or equal to the second threshold value,
The object tracking device according to claim 2.
前記追跡部は、前記追跡オブジェクトの一つ前の推定位置及び前記追跡オブジェクトの速度を含む状態情報に基づいて、当該追跡オブジェクトの現在位置を推定し、
前記出力部は、当該追跡オブジェクトに前記検出オブジェクトが関連付けられず、且つ、前記存在確信度が前記第1閾値以上である場合に、前記追跡部が推定した当該追跡オブジェクトの現在位置を前記出力位置として出力する、
請求項1から5のいずれか一項に記載の物体追跡装置。
The tracking unit estimates the current position of the tracking object based on the state information including the estimated position immediately before the tracking object and the velocity of the tracking object.
When the detection object is not associated with the tracking object and the certainty of existence is equal to or higher than the first threshold value, the output unit determines the current position of the tracking object estimated by the tracking unit as the output position. Output as,
The object tracking device according to any one of claims 1 to 5.
前記追跡部は、前記追跡オブジェクトに関連付けられた前記検出オブジェクトの位置の履歴を示す履歴情報に基づいて、当該追跡オブジェクトの現在位置を推定し、
前記出力部は、当該追跡オブジェクトに前記検出オブジェクトが関連付けられず、且つ、前記存在確信度が前記第1閾値以上である場合に、前記追跡部が推定した当該追跡オブジェクトの現在位置を前記出力位置として出力する、
請求項1から5のいずれか一項に記載の物体追跡装置。
The tracking unit estimates the current position of the tracking object based on the history information indicating the history of the position of the detection object associated with the tracking object.
When the detection object is not associated with the tracking object and the certainty of existence is equal to or higher than the first threshold value, the output unit determines the current position of the tracking object estimated by the tracking unit as the output position. Output as,
The object tracking device according to any one of claims 1 to 5.
撮像装置が撮像した撮像画像に含まれる検出対象のオブジェクトである検出オブジェクトの位置を検出するステップと、
過去に検出したオブジェクトを追跡オブジェクトとして追跡するステップと、
前記検出オブジェクトと、追跡している前記追跡オブジェクトとを関連付けるステップと、
前記検出オブジェクトが前記追跡オブジェクトに関連付けられたか否かに基づいて、前記追跡オブジェクトが存在することの確かさを示す存在確信度を増減させるステップと、
前記存在確信度が第1閾値以上である場合に、前記追跡オブジェクトを識別する識別情報に関連付けて、前記検出オブジェクトの位置に基づく出力位置を出力するステップと、
を備える物体追跡方法。
The step of detecting the position of the detection object, which is the object to be detected included in the captured image captured by the image pickup device, and
Steps to track previously detected objects as tracking objects,
A step of associating the detected object with the tracking object being tracked,
A step of increasing or decreasing the certainty of existence, which indicates the certainty that the tracking object exists, based on whether or not the detection object is associated with the tracking object.
A step of outputting an output position based on the position of the detected object in association with the identification information that identifies the tracking object when the existence certainty is equal to or higher than the first threshold value.
An object tracking method that includes.
JP2020010981A 2020-01-27 2020-01-27 Object tracking device and object tracking method Active JP7334632B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2020010981A JP7334632B2 (en) 2020-01-27 2020-01-27 Object tracking device and object tracking method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2020010981A JP7334632B2 (en) 2020-01-27 2020-01-27 Object tracking device and object tracking method

Publications (2)

Publication Number Publication Date
JP2021117760A true JP2021117760A (en) 2021-08-10
JP7334632B2 JP7334632B2 (en) 2023-08-29

Family

ID=77174971

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2020010981A Active JP7334632B2 (en) 2020-01-27 2020-01-27 Object tracking device and object tracking method

Country Status (1)

Country Link
JP (1) JP7334632B2 (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP7412614B1 (en) 2023-02-07 2024-01-12 三菱電機インフォメーションシステムズ株式会社 Tracking devices, tracking methods and tracking programs

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2002074368A (en) * 2000-08-25 2002-03-15 Matsushita Electric Ind Co Ltd Moving object recognizing and tracking device
JP2015155878A (en) * 2014-02-21 2015-08-27 株式会社デンソー Obstacle detection device for vehicle
JP2017102824A (en) * 2015-12-04 2017-06-08 クラリオン株式会社 Tracker
JP2019041334A (en) * 2017-08-28 2019-03-14 株式会社Soken Video output device and video generation program

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2002074368A (en) * 2000-08-25 2002-03-15 Matsushita Electric Ind Co Ltd Moving object recognizing and tracking device
JP2015155878A (en) * 2014-02-21 2015-08-27 株式会社デンソー Obstacle detection device for vehicle
JP2017102824A (en) * 2015-12-04 2017-06-08 クラリオン株式会社 Tracker
JP2019041334A (en) * 2017-08-28 2019-03-14 株式会社Soken Video output device and video generation program

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP7412614B1 (en) 2023-02-07 2024-01-12 三菱電機インフォメーションシステムズ株式会社 Tracking devices, tracking methods and tracking programs

Also Published As

Publication number Publication date
JP7334632B2 (en) 2023-08-29

Similar Documents

Publication Publication Date Title
JP4962581B2 (en) Lane marking detector
CN110555362B (en) Object recognition device
KR101961571B1 (en) Object recognition device using plurality of object detection means
EP2759959A2 (en) Method and system for detecting multi-lanes
US20060062432A1 (en) Collision time estimation apparatus for vehicles, collision time estimation method for vehicles, collision alarm apparatus for vehicles, and collision alarm method for vehicles
JP6458651B2 (en) Road marking detection device and road marking detection method
US8730325B2 (en) Traveling lane detector
US11151395B2 (en) Roadside object detection device, roadside object detection method, and roadside object detection system
JP2019067159A (en) Dividing line recognition device
JP6462557B2 (en) Vehicle pitch angle estimation device
JP2014009975A (en) Stereo camera
KR20180122382A (en) Mainly a detection method and mainly a detection device
JP2021117760A (en) Object tracking device and object tracking method
CN113569812A (en) Unknown obstacle identification method and device and electronic equipment
EP3435286A1 (en) Imaging control device and imaging control method
JP4421121B2 (en) Intruder detection method
JP4151631B2 (en) Object detection device
JP2019190847A (en) Stereo camera device
JP7283268B2 (en) Information processing equipment and in-vehicle system
WO2020036039A1 (en) Stereo camera device
CN111899525A (en) Distance measuring method, distance measuring device, electronic device, and storage medium
JP2017072450A (en) Own vehicle location recognition device
JP2005329765A (en) Run lane recognition device
JP2019020171A (en) Vehicle width detector, vehicle width detection method, and program
CN113581069B (en) Computer vision-based vehicle collision prevention early warning method and device

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20220330

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20230309

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20230322

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20230516

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20230718

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20230731

R150 Certificate of patent or registration of utility model

Ref document number: 7334632

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150