JP6168784B2 - Perimeter monitoring system and axis deviation detection method for perimeter monitoring system - Google Patents

Perimeter monitoring system and axis deviation detection method for perimeter monitoring system Download PDF

Info

Publication number
JP6168784B2
JP6168784B2 JP2013023442A JP2013023442A JP6168784B2 JP 6168784 B2 JP6168784 B2 JP 6168784B2 JP 2013023442 A JP2013023442 A JP 2013023442A JP 2013023442 A JP2013023442 A JP 2013023442A JP 6168784 B2 JP6168784 B2 JP 6168784B2
Authority
JP
Japan
Prior art keywords
position data
target
detection area
detected
radar
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.)
Active
Application number
JP2013023442A
Other languages
Japanese (ja)
Other versions
JP2014153211A (en
Inventor
洋輔 久保
洋輔 久保
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.)
THE FURUKAW ELECTRIC CO., LTD.
Furukawa Automotive Systems Inc
Original Assignee
THE FURUKAW ELECTRIC CO., LTD.
Furukawa Automotive Systems Inc
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 THE FURUKAW ELECTRIC CO., LTD., Furukawa Automotive Systems Inc filed Critical THE FURUKAW ELECTRIC CO., LTD.
Priority to JP2013023442A priority Critical patent/JP6168784B2/en
Publication of JP2014153211A publication Critical patent/JP2014153211A/en
Application granted granted Critical
Publication of JP6168784B2 publication Critical patent/JP6168784B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Radar Systems Or Details Thereof (AREA)

Description

本発明は、2台以上のレーダ装置を備えて検知エリア内の物標を検知する周辺監視システムに関し、特に2台以上のレーダ装置間の軸ずれを検知することが可能な周辺監視システムに関するものである。   The present invention relates to a periphery monitoring system that includes two or more radar devices and detects a target in a detection area, and particularly relates to a periphery monitoring system that can detect an axis deviation between two or more radar devices. It is.

車両の周辺に存在する障害物等を検知するために、レーダ装置を備えた周辺監視システムが車両に搭載されるようになってきている。また、車両の周辺を広範囲に監視できるように、レーダ装置を2台以上備える周辺監視システムも増えてきており、レーダ装置間の死角をなくすために、各レーダの検知エリアが一部で重複するように配置されている。レーダ装置を2台以上備えた周辺監視システムでは、2台のレーダ装置の検知エリアが重なる重複検知エリアに物標があると、これを2台のレーダ装置で検知することになる。   In order to detect an obstacle or the like existing around the vehicle, a periphery monitoring system including a radar device has been mounted on the vehicle. In addition, an increasing number of peripheral monitoring systems including two or more radar devices so that the periphery of the vehicle can be monitored in a wide range, and in order to eliminate blind spots between the radar devices, the detection areas of each radar partially overlap. Are arranged as follows. In the periphery monitoring system provided with two or more radar devices, if there is a target in the overlapping detection area where the detection areas of the two radar devices overlap, this is detected by the two radar devices.

2台以上のレーダ装置を備える周辺監視装置において、重複検知エリアを共有する2台のレーダ装置間で軸ずれが発生すると、一方のレーダ装置で検知された物標の位置と他方のレーダ装置で検知された物標の位置とが異なることになり、周辺監視システムは物標の位置を正しく検知することができなくなってしまう。   In a periphery monitoring device including two or more radar devices, when an axis deviation occurs between two radar devices sharing an overlap detection area, the position of a target detected by one radar device and the other radar device are detected. The position of the detected target is different, and the periphery monitoring system cannot correctly detect the position of the target.

このような2台のレーダ装置間の軸ずれを検知する従来の技術として、例えば特許文献1、2に記載のものが知られている。特許文献1では、2台のレーダ装置を搭載した車両を停止させておき、2台のレーダ装置の重複検知エリアに軸調整用のターゲットを1つだけ配置し、これを2台のレーダ装置で検知した結果に基づいてそれぞれの軸調整を行うことが記載されている。   As conventional techniques for detecting such an axis deviation between two radar devices, for example, those described in Patent Documents 1 and 2 are known. In Patent Document 1, a vehicle equipped with two radar devices is stopped, and only one target for axis adjustment is arranged in the overlap detection area of the two radar devices. It is described that each axis adjustment is performed based on the detected result.

また特許文献2には、車両走行中に軸ずれを検知して調整を行うことができるレーダ装置の軸調整方法が記載されている。特許文献2では、複数のレーダ装置を備えた周辺監視システムにおいて、各レーダ装置の検知結果をもとに路側物の軌跡ベクトルを作成し、自車が直線走行を行っているとき、各レーダの基準軸と路側物の軌跡ベクトルとでなす角度を求め、これが所定の設定値に一致するように軸調整を行うことが記載されている。   Patent Document 2 describes a method for adjusting the axis of a radar apparatus that can detect and adjust an axis deviation while the vehicle is running. In Patent Document 2, in a periphery monitoring system including a plurality of radar devices, a trajectory vector of a roadside object is created based on the detection result of each radar device. It is described that an angle formed by a reference axis and a trajectory vector of a roadside object is obtained and the axis is adjusted so that the angle matches a predetermined set value.

特開2009−281862号公報JP 2009-281862 A 特開2011−43387号公報JP 2011-43387 A

しかしながら、特許文献1の従来技術では、軸調整を行うために軸調整用のターゲットを配置し、自車を停止させてターゲットを検知する必要があり、軸調整のための特別な検査設備を用意する必要がある。そのため、軸ずれを走行中等に適宜検出することはできず、特定の検査時にしか検知することができないといった問題がある。   However, in the prior art of Patent Document 1, it is necessary to arrange a target for adjusting the axis in order to adjust the axis, stop the vehicle and detect the target, and prepare a special inspection facility for adjusting the axis. There is a need to. Therefore, there is a problem that the shaft misalignment cannot be detected as appropriate during traveling, and can only be detected during a specific inspection.

また、特許文献2に記載の従来技術では、ガードレールや側壁などの直線的な軌跡ベクトルを作成できる路側物が設置されている環境が必要であり、かつ直線走行時にしか軸ずれを検知することができないといった問題がある。また、直線走行であることを判定するためにヨーレートセンサやGPSなどの情報を入力する必要があり、システムが複雑になるとともに処理時間も増大するといった問題がある。   Moreover, in the prior art described in Patent Document 2, an environment in which a roadside object capable of creating a linear trajectory vector such as a guardrail or a side wall is required, and an axis deviation can be detected only during straight running. There is a problem that can not be. In addition, it is necessary to input information such as a yaw rate sensor and GPS in order to determine that the vehicle is running in a straight line, which causes a problem that the system becomes complicated and the processing time increases.

本発明は、上記課題に鑑みてなされたものであり、運用中の物標検知結果を用いてレーダ装置間の軸ずれを検知することが可能な周辺監視システム及び周辺監視システムの軸ずれ検知方法を提供することを目的とする。   The present invention has been made in view of the above problems, and a peripheral monitoring system capable of detecting an axial shift between radar devices using a target detection result in operation and an axial shift detecting method of the peripheral monitoring system The purpose is to provide.

上記課題を解決するため、本発明の周辺監視システムの第1の態様は、所定の繰り返し周期で検知エリア内の物標を検知するレーダ装置を2台以上備えた周辺監視システムであって、前記2台以上のレーダ装置のそれぞれの前記検知エリアは、一部が別の前記レーダ装置の前記検知エリアの一部と重なる重複検知エリアを含んでおり、前記レーダ装置のそれぞれから前記物標を検知したときの位置データを入力し、前記位置データをもとに前記重複検知エリアのそれぞれに位置する前記物標を判定して該物標の位置データを出力する重複エリア内物標判定手段と、前記重複エリア内物標判定手段から前記重複検知エリア毎の前記物標の位置データを入力し、前記重複検知エリア毎にそれぞれを共有する2台の前記レーダ装置に共通する共通座標系に前記位置データを変換して出力する座標系変換手段と、前記座標系変換手段から前記重複検知エリア毎の前記共通座標系の位置データを入力し、前記重複検知エリア毎に前記2台のレーダ装置の一方で検知された前記位置データと他方で検知された前記位置データとの対応付けを行う物標識別手段と、前記物標識別手段から前記重複検知エリア毎に前記対応付けされた位置データを入力し、いずれかの前記重複検知エリアを共有する前記2台のレーダ装置で検知された物標の個数が異なるとき、あるいは前記対応付けされた位置データ間の差分が所定のしきい値を超えるとき、前記2台の前記レーダ装置間の軸ずれを判定する軸ずれ判定手段と、を有し、前記軸ずれ判定手段は、前記2台のレーダ装置で検知された物標の個数が異なる周期が連続して所定の軸ずれ判定回数以上続くときに前記2台のレーダ装置間の軸ずれを判定することを特徴とする。
In order to solve the above problems, a first aspect of the periphery monitoring system of the present invention is a periphery monitoring system including two or more radar devices that detect a target in a detection area at a predetermined repetition period, The detection area of each of the two or more radar devices includes an overlapping detection area that partially overlaps a part of the detection area of another radar device, and detects the target from each of the radar devices. Input the position data at the time, and determine the target located in each of the overlap detection area based on the position data, to output the position data of the target, overlapping area target determination means, The common position common to the two radar devices which input the position data of the target for each of the overlap detection areas from the overlap area target determination means and share each of the overlap detection areas. Coordinate system conversion means for converting and outputting the position data to a system; and the position data of the common coordinate system for each overlap detection area from the coordinate system conversion means, and the two units for each overlap detection area Object labeling means for associating the position data detected on one side of the radar device with the position data detected on the other side, and the correlated position from the object labeling means for each overlap detection area When data is input and the number of targets detected by the two radar devices sharing one of the overlap detection areas is different, or a difference between the associated position data is a predetermined threshold value when exceeding, the possess and determining axis misalignment determination means for axial displacement between two of the radar apparatus, wherein the axis deviation determining means, the number of target object detected by the two radar devices Different Period is equal to or determining the axial deviation between the two radar apparatus when continuously continues for more than a predetermined axial deviation determination count.

本発明の周辺監視システムの他の態様は、前記対応付けされた位置データ間の差分は、前記繰り返し周期毎に前記対応付けされた位置データ間の距離を算出し、最新の連続する所定回数分にわたって前記距離を平均した平均値であることを特徴とする。   According to another aspect of the periphery monitoring system of the present invention, the difference between the associated position data is calculated by calculating a distance between the associated position data for each repetition period, and for the latest consecutive predetermined number of times. It is the average value which averaged the said distance over.

本発明の周辺監視システムの軸ずれ検知方法の第1の態様は、所定の繰り返し周期で検知エリア内の物標を検知するレーダ装置を2台以上備えた周辺監視システムの軸ずれ検知方法であって、前記2台以上のレーダ装置のそれぞれの前記検知エリアは、一部が別の前記レーダ装置の前記検知エリアの一部と重なる重複検知エリアを含んでおり、前記レーダ装置のそれぞれから前記物標を検知したときの位置データを入力して前記重複検知エリアのそれぞれに位置する前記物標を判定して該物標の位置データを出力する重複エリア内物標判定ステップと、前記重複検知エリア毎の前記物標の位置データを入力してそれぞれの前記重複検知エリアを共有する2台の前記レーダ装置に共通する共通座標系に前記位置データを変換して出力する座標系変換ステップと、前記重複検知エリア毎に前記2台のレーダ装置の一方で検知された前記共通座標系の位置データと他方で検知された前記共通座標系の位置データとの対応付けを行う物標識別ステップと、いずれかの前記重複検知エリアを共有する前記2台のレーダ装置で検知された物標の個数が異なるとき、あるいは前記対応付けされた位置データ間の差分が所定のしきい値を超えるとき、前記2台の前記レーダ装置間の軸ずれを判定する軸ずれ判定ステップと、を有し、前記軸ずれ判定ステップでは、前記2台のレーダ装置で検知された物標の個数が異なる周期が連続して所定の軸ずれ判定回数以上続くときに前記2台のレーダ装置間の軸ずれを判定することを特徴とする。
A first aspect of the axis deviation detection method for the periphery monitoring system of the present invention is an axis deviation detection method for an area monitoring system provided with two or more radar devices that detect a target in a detection area at a predetermined repetition period. In addition, each of the detection areas of the two or more radar apparatuses includes an overlapping detection area that partially overlaps a part of the detection area of another radar apparatus, and the object is detected from each of the radar apparatuses. An overlapping area target determination step for inputting position data when a target is detected, determining the target positioned in each of the overlap detection areas, and outputting the position data of the target, and the overlap detection area A coordinate system for inputting the position data of each target and converting the position data into a common coordinate system common to the two radar devices sharing the overlap detection area and outputting the same An object indicator for associating a replacement step with the position data of the common coordinate system detected by one of the two radar devices for each overlap detection area and the position data of the common coordinate system detected by the other When the number of targets detected by the two radar devices sharing one of the overlapping detection areas is different from that in another step, or the difference between the associated position data has a predetermined threshold value more than time, have a, a shaft deviation determination step of determining an axial deviation between the two said radar device, in the axial deviation determination step, the number of target objects are detected by the two radar devices are different The axis deviation between the two radar devices is determined when the cycle continues for a predetermined number of axis deviation determination times or more .

本発明の周辺監視システムの軸ずれ検知方法の他の態様は、前記対応付けされた位置データ間の差分は、前記繰り返し周期毎に前記対応付けされた位置データ間の距離を算出し、最新の連続する所定回数分にわたって前記距離を平均した平均値であることを特徴とする。   According to another aspect of the axis deviation detection method of the periphery monitoring system of the present invention, the difference between the associated position data is calculated by calculating the distance between the associated position data for each repetition period, It is an average value obtained by averaging the distance over a predetermined number of consecutive times.

本発明によれば、運用中の物標検知結果を用いてレーダ装置間の軸ずれを検知することが可能な周辺監視システム及び周辺監視システムの軸ずれ検知方法を提供することが可能となる。   ADVANTAGE OF THE INVENTION According to this invention, it becomes possible to provide the periphery monitoring system which can detect the axial shift between radar apparatuses using the target detection result in operation, and the axial shift detection method of a peripheral monitoring system.

本発明の第1実施形態に係る周辺監視システムの軸ずれ検知方法の処理の流れを示すフローチャートである。It is a flowchart which shows the flow of a process of the axis deviation detection method of the periphery monitoring system which concerns on 1st Embodiment of this invention. 本発明の第1実施形態に係る周辺監視システムの構成を示すブロック図である。It is a block diagram which shows the structure of the periphery monitoring system which concerns on 1st Embodiment of this invention. 本発明の第1実施形態に係る周辺監視システムの検知エリアを示す概念図である。It is a conceptual diagram which shows the detection area of the periphery monitoring system which concerns on 1st Embodiment of this invention. レーダ装置を3台備える実施形態に係る周辺監視システムの検知エリアを示す概念図である。It is a conceptual diagram which shows the detection area of the periphery monitoring system which concerns on embodiment provided with three radar apparatuses. 1台のレーダ装置で軸ずれが生じたときの検知エリアの一例を示す概念図である。It is a conceptual diagram which shows an example of a detection area when an axis shift arises with one radar apparatus. 軸ずれが生じているときと生じていないときとで検知される物標の位置データの比較図である。It is a comparison figure of the position data of the target detected when the axis deviation has occurred and when it has not occurred. 軸ずれを判定するためのしきい値の一例を示す図である。It is a figure which shows an example of the threshold value for determining an axis deviation.

本発明の好ましい実施の形態における周辺監視システム及び周辺監視システムの軸ずれ検知方法について、図面を参照して詳細に説明する。同一機能を有する各構成部については、図示及び説明簡略化のため、同一符号を付して示す。   A peripheral monitoring system and a method for detecting an axis deviation of the peripheral monitoring system in a preferred embodiment of the present invention will be described in detail with reference to the drawings. Each component having the same function is denoted by the same reference numeral for simplification of illustration and description.

(第1実施形態)
本発明の第1の実施の形態に係る周辺監視システム及び周辺監視システムの軸ずれ検知方法を、図1乃至3を用いて以下に説明する。図1は、本実施形態の周辺監視システムの軸ずれ検知方法の処理の流れを示すフローチャートであり、図2は、本実施形態の周辺監視システムの構成を示すブロック図である。また、図3は、本実施形態の周辺監視システムにおいて、物標を検知することができる検知エリアを示す概念図である。
(First embodiment)
A perimeter monitoring system and a perimeter monitoring method for the perimeter monitoring system according to the first embodiment of the present invention will be described below with reference to FIGS. FIG. 1 is a flowchart showing the flow of processing of the axis deviation detection method of the periphery monitoring system of this embodiment, and FIG. 2 is a block diagram showing the configuration of the periphery monitoring system of this embodiment. FIG. 3 is a conceptual diagram showing a detection area in which a target can be detected in the periphery monitoring system of the present embodiment.

本実施形態の周辺監視システムは、2台以上のレーダ装置を備えており、隣接する2台のレーダ装置の検知エリアが一部で重複するように、各レーダ装置の基準軸が設定されている。以下では、説明簡単のために本実施形態の周辺監視装置が2台のレーダ装置を備えるものとする。   The periphery monitoring system of this embodiment includes two or more radar devices, and the reference axes of the radar devices are set so that the detection areas of two adjacent radar devices partially overlap. . In the following, for simplicity of explanation, it is assumed that the periphery monitoring device of this embodiment includes two radar devices.

図2に示す本実施形態の周辺監視システム100は、第1のレーダ装置101と第2のレーダ装置102の2台のレーダ装置を備えている。レーダ装置101、102は、それぞれの検知エリアで物標を検知すると、その位置データを出力する。位置データは、レーダ装置101、102のそれぞれにおいて、例えばレーダ装置101または102の位置を中心とする極座標系で表すことができ、中心から物標までの距離と方位で与えることができる。   The periphery monitoring system 100 according to this embodiment shown in FIG. 2 includes two radar devices, a first radar device 101 and a second radar device 102. When the radar devices 101 and 102 detect the target in the respective detection areas, the radar devices 101 and 102 output the position data. In each of the radar apparatuses 101 and 102, the position data can be represented by, for example, a polar coordinate system centered on the position of the radar apparatus 101 or 102, and can be given by the distance and direction from the center to the target.

第1レーダ装置101と第2レーダ装置102のそれぞれの検知エリアの一例を図3に示す。同図において、エリア11は第1のレーダ装置101の検知エリアを示しており、基準軸11aに対し左右対称な所定角度範囲のエリアとしている。同様に、エリア12は第2のレーダ装置102の検知エリアを示しており、基準軸12aに対し左右対称な所定角度範囲のエリアとしている。基準軸11a、12aは、それぞれの検知エリア11、12の中心軸となっている。   An example of the detection areas of the first radar device 101 and the second radar device 102 is shown in FIG. In the figure, an area 11 indicates a detection area of the first radar apparatus 101, and is an area having a predetermined angle range symmetrical to the reference axis 11a. Similarly, an area 12 indicates a detection area of the second radar device 102, and is an area having a predetermined angle range that is symmetrical with respect to the reference axis 12a. The reference axes 11a and 12a are the central axes of the detection areas 11 and 12, respectively.

第1レーダ装置101及び第2レーダ装置102は、それぞれの検知エリア11及び12が一部で重複するように、基準軸11a、12aの向きが設定されている。検知エリア11と12が重複するエリアを、以下では重複検知エリア20とする。第1レーダ装置101と第2レーダ装置102は、それぞれ異なる位置に配置されていることから、例えば重複検知エリア20にある物標1をそれぞれのレーダ装置で検知したとき、それぞれで検知された物標までの距離および方位角は相互に異なってくる。   In the first radar device 101 and the second radar device 102, the orientations of the reference axes 11a and 12a are set so that the detection areas 11 and 12 partially overlap each other. The area where the detection areas 11 and 12 overlap is hereinafter referred to as an overlap detection area 20. Since the first radar device 101 and the second radar device 102 are arranged at different positions, for example, when the target 1 in the overlap detection area 20 is detected by each radar device, the objects detected by the respective radar devices are detected. The distance to the mark and the azimuth are different from each other.

そこで、検知した物標を正しく識別できるようにするために、特に2台のレーダ装置101、102で検知された重複検知エリアにある物標が同一のものであることを識別できるようにするためには、それぞれで検知された物標の位置データを共通の座標系に変換する必要がある。図3では、レーダ装置101、102のそれぞれで検知した物標の位置データを距離と方位角からなる極座標系で表し、共通の座標系として第1レーダ装置101と第2レーダ装置102との中間点Cを原点とする直交座標系(xy座標系)で表すものとしている。各レーダ装置で用いる座標系及び共通の座標系は、これに限定されず任意に選択することができる。   Therefore, in order to be able to correctly identify the detected target, particularly in order to be able to identify that the targets in the overlap detection area detected by the two radar apparatuses 101 and 102 are the same. In this case, it is necessary to convert the position data of each detected target to a common coordinate system. In FIG. 3, the position data of the target detected by each of the radar apparatuses 101 and 102 is represented by a polar coordinate system composed of a distance and an azimuth, and an intermediate between the first radar apparatus 101 and the second radar apparatus 102 as a common coordinate system. The point C is represented by an orthogonal coordinate system (xy coordinate system) with the origin as the origin. The coordinate system used by each radar apparatus and the common coordinate system are not limited to this, and can be arbitrarily selected.

なお、周辺監視システム100がさらに第3のレーダ装置103を備えるときの検知エリアの一例を図4に示す。同図では、第1のレーダ装置101と第2のレーダ装置102との間にさらに第3のレーダ装置103を配置している。このとき、第1のレーダ装置101の検知エリア11と第3のレーダ装置103の検知エリア13とが重複する重複検知エリア21が形成され、さらに第2のレーダ装置102の検知エリア12と第3のレーダ装置103の検知エリア13とが重複する重複検知エリア22が形成される。このように、レーダ装置が3以上備える場合には、隣接するレーダ装置間で検知エリアが重複するように各レーダ装置を配置するのがよい。   An example of the detection area when the periphery monitoring system 100 further includes the third radar device 103 is shown in FIG. In the figure, a third radar device 103 is further arranged between the first radar device 101 and the second radar device 102. At this time, an overlap detection area 21 in which the detection area 11 of the first radar device 101 and the detection area 13 of the third radar device 103 overlap is formed, and further, the detection area 12 and the third of the second radar device 102 are detected. An overlapping detection area 22 is formed, which overlaps with the detection area 13 of the radar apparatus 103. Thus, when three or more radar devices are provided, it is preferable to arrange each radar device so that detection areas overlap between adjacent radar devices.

以下では、本実施形態の周辺監視システム100が2台のレーダ装置101、102を備える場合について、重複検知エリア20で検知された物標の位置データをもとに、第1のレーダ装置101と第2のレーダ装置102との間の軸ずれを検知する方法について説明する。これに限定されず、周辺監視システム100がさらに第3のレーダ装置103を備えるときは、重複検知エリア21で検知された物標の位置データをもとに、第2のレーダ装置102と第3のレーダ装置103との間の軸ずれを同様にして検知することができる。さらには、周辺監視システム100が4つ以上のレーダ装置を備えるときも、同様にして軸ずれを検知することができる。   In the following, when the periphery monitoring system 100 according to the present embodiment includes two radar devices 101 and 102, the first radar device 101 and the first radar device 101 are detected based on the position data of the target detected in the overlap detection area 20. A method for detecting an axis deviation with respect to the second radar apparatus 102 will be described. When the periphery monitoring system 100 further includes the third radar device 103, the second radar device 102 and the third radar device 102 are connected to each other based on the position data of the target detected in the overlap detection area 21. It is possible to detect an axial deviation with respect to the radar apparatus 103 in the same manner. Further, when the periphery monitoring system 100 includes four or more radar devices, the axis deviation can be detected in the same manner.

つぎに、レーダ装置の軸ずれの一例として、第1のレーダ装置101で軸ずれが生じ、第2のレーダ装置102では軸ずれが生じていないときの、それぞれの検知エリアを図5に示す。同図では、第1のレーダ装置101の基準軸11aが角度Δθだけ回転して軸ずれした例を示している。このとき、検知エリア11は全体的に角度Δθだけ回転して検知エリア11’に移動する。ここで、重複検知エリア20に物標1が検知されたとする。レーダ装置101で軸ずれが生じていないときと軸ずれが生じているときの、それぞれで検知される物標1の位置データの比較を図6に示す。図6は、レーダ装置101の位置を原点としたときの物標1の位置データを示している。   Next, as an example of the axis deviation of the radar apparatus, each detection area when the axis deviation occurs in the first radar apparatus 101 and no axis deviation occurs in the second radar apparatus 102 is shown in FIG. In the figure, an example in which the reference axis 11a of the first radar apparatus 101 is rotated by an angle Δθ and shifted is shown. At this time, the detection area 11 is rotated by an angle Δθ as a whole and moved to the detection area 11 ′. Here, it is assumed that the target 1 is detected in the overlap detection area 20. FIG. 6 shows a comparison of position data of the target 1 detected when the radar apparatus 101 has no axis deviation and when an axis deviation has occurred. FIG. 6 shows the position data of the target 1 when the position of the radar apparatus 101 is the origin.

図6において、軸ずれが生じていないときのレーダ装置101では、物標1の位置データとして、極座標系で表した距離L1と方位角θ1が検知される。これに対し、軸ずれが生じたときのレーダ装置101では、物標1の位置データとして距離L1と方位角θ1’が検知される。すなわち、基準軸11aがΔθだけ回転して軸ずれしたことにより、軸ずれが生じていないときの物標1の方位角θ1がθ1’(=θ1+Δθ)であると誤検知されてしまう。なお、ここでは、基準軸11aがΔθだけ回転して軸ずれした場合を例に説明するが、これに限定されず、例えばレーダ装置101の位置ずれ等により距離と方位角の両方がずれる場合も含む。   In FIG. 6, the radar apparatus 101 when no axis misalignment detects the distance L1 and the azimuth angle θ1 expressed in the polar coordinate system as the position data of the target 1. On the other hand, in the radar apparatus 101 when the axis deviation occurs, the distance L1 and the azimuth angle θ1 ′ are detected as the position data of the target 1. That is, since the reference axis 11a rotates by Δθ and is displaced, the azimuth angle θ1 of the target 1 when no axial displacement occurs is erroneously detected as θ1 ′ (= θ1 + Δθ). Here, a case where the reference axis 11a is rotated by Δθ and is displaced will be described as an example. However, the present invention is not limited to this. For example, both the distance and the azimuth may be shifted due to a positional deviation of the radar apparatus 101. Including.

一方、第2のレーダ装置102は軸ずれが生じていないことから、物標1の正しい位置として距離L2と方位角θ2を検知する。第1のレーダ装置101に軸ずれが生じていないときは、第1のレーダ装置101で検知した極座標系の位置データ(L1、θ1)を図3に示した共通の直交座標系に変換した位置データ(x1、y1)が、第2のレーダ装置102で検知した位置データ(L2、θ2)を共通の直交座標系に変換した位置データ(x2、y2)とほぼ等しくなる。すなわち、x1とx2が略等しく、y1とy2が略等しくなる。なお、レーダ装置ではその性能により誤差が発生することから、位置データが等しいか否かは、レーダ性能に基づく誤差を超える範囲で判定する必要がある。   On the other hand, the second radar apparatus 102 detects the distance L2 and the azimuth angle θ2 as the correct position of the target 1 because no axis deviation has occurred. When the first radar apparatus 101 is not displaced, the position obtained by converting the polar coordinate system position data (L1, θ1) detected by the first radar apparatus 101 into the common orthogonal coordinate system shown in FIG. The data (x1, y1) is substantially equal to the position data (x2, y2) obtained by converting the position data (L2, θ2) detected by the second radar device 102 into a common orthogonal coordinate system. That is, x1 and x2 are substantially equal, and y1 and y2 are substantially equal. Since the radar apparatus generates an error due to its performance, it is necessary to determine whether the position data are equal within a range exceeding the error based on the radar performance.

これに対し、第1のレーダ装置101に軸ずれが生じているときは、第1のレーダ装置101で検知した極座標系の位置データ(L1、θ1’)を共通の直交座標系に変換すると、上記の座標(x1、y1)とは異なる座標(x1’、y1’)となる。第1のレーダ装置101で軸ずれが生じていることが不明のときは、第1のレーダ装置101で検知された座標(x1’、y1’)に位置する物標と第2のレーダ装置102で検知された座標(x2、y2)に位置する物標とが異なる物標であると誤判断されるおそれがある。   On the other hand, when the first radar apparatus 101 is misaligned, the polar coordinate system position data (L1, θ1 ′) detected by the first radar apparatus 101 is converted into a common orthogonal coordinate system. The coordinates (x1 ′, y1 ′) are different from the coordinates (x1, y1). When it is unclear that the first radar apparatus 101 is misaligned, the target located at the coordinates (x1 ′, y1 ′) detected by the first radar apparatus 101 and the second radar apparatus 102 There is a possibility that the target located at the coordinates (x2, y2) detected in is erroneously determined to be a different target.

そこで、本実施形態の周辺監視装置100では、図5に例示するように重複検知エリア20に物標1があるとき、その位置データを用いて第1のレーダ装置101と第2のレーダ装置102との間で軸ずれが生じていることを検知できるようにしている。これにより、第1のレーダ装置101と第2のレーダ装置102とで検知された同一の物標を異なる物標と誤判断するのを防止している。   Therefore, in the periphery monitoring device 100 of the present embodiment, when the target 1 is in the overlap detection area 20 as illustrated in FIG. 5, the first radar device 101 and the second radar device 102 are used using the position data. It is possible to detect the occurrence of an axis deviation between This prevents erroneous determination of the same target detected by the first radar device 101 and the second radar device 102 as a different target.

本実施形態の周辺監視装置100を、図2を用いて以下に説明する。本実施形態の周辺監視装置100は、第1のレーダ装置101と第2のレーダ装置102の2台のレーダ装置を備えており、さらに重複エリア内物標判定手段111、座標系変換手段112、物標識別手段113、及び軸ずれ判定手段114を備えている。第1のレーダ装置101及び第2のレーダ装置102は、ともに所定の繰り返し周期Tで検知エリア11、12内の物標を検知する。また、重複エリア内物標判定手段111、座標系変換手段112、物標識別手段113、及び軸ずれ判定手段114の各処理も、同じ繰り返し周期Tで実行される。   The surroundings monitoring apparatus 100 of this embodiment is demonstrated below using FIG. The periphery monitoring device 100 of the present embodiment includes two radar devices, a first radar device 101 and a second radar device 102, and further includes an overlapping area target determination unit 111, a coordinate system conversion unit 112, An object labeling unit 113 and an axis deviation determination unit 114 are provided. Both the first radar device 101 and the second radar device 102 detect the target in the detection areas 11 and 12 at a predetermined repetition period T. In addition, the processes of the overlapping area target determination unit 111, the coordinate system conversion unit 112, the object marker distinction unit 113, and the axis deviation determination unit 114 are also executed at the same repetition period T.

重複エリア内物標判定手段111は、第1のレーダ装置101及び第2のレーダ装置102のそれぞれで検知された物標が、重複検知エリア20内に位置するか否かを判定する。そして、重複検知エリア20内に位置すると判定された物標の位置データを座標系変換手段112に出力する。   The overlapping area target determination unit 111 determines whether or not the targets detected by the first radar apparatus 101 and the second radar apparatus 102 are located in the overlapping detection area 20. Then, the position data of the target determined to be located in the overlap detection area 20 is output to the coordinate system conversion unit 112.

座標系変換手段112は、重複エリア内物標判定手段111から入力した物標の位置データを、第1のレーダ装置101と第2のレーダ装置102に共通する座標系に変換する。上記の例では、レーダ装置101、102のそれぞれで設定された極座標系の位置データを、共通の直交座標系の位置データに変換する。これにより、レーダ装置101、102とも軸ずれが生じていないときは、重複エリア内物標判定手段111から入力した第1のレーダ装置101で検知した位置データ及び第2のレーダ装置102で検知した位置データは、ともに略等しい直交座標系の位置データ(x、y)に変換される。   The coordinate system conversion unit 112 converts the position data of the target input from the overlapping area target determination unit 111 into a coordinate system common to the first radar device 101 and the second radar device 102. In the above example, the polar coordinate system position data set in each of the radar apparatuses 101 and 102 is converted into the common orthogonal coordinate system position data. As a result, when no axis deviation occurs in the radar apparatuses 101 and 102, the position data detected by the first radar apparatus 101 and the second radar apparatus 102 detected from the overlapping area target determination unit 111 are detected. The position data is converted into position data (x, y) in an orthogonal coordinate system that is both substantially equal.

物標識別手段113は、座標系変換手段112から共通座標系の位置データを入力し、重複検知エリア20内に複数の物標が検知されているかを判定する。そして、重複検知エリア20内に複数の物標が検知されているときは、第1のレーダ装置101で検知された物標と第2のレーダ装置102で検知された物標のそれぞれの位置データを比較し、距離的に近い物標同士を同一の物標であると判定して対応づけを行う。   The object marker distinction unit 113 inputs the position data of the common coordinate system from the coordinate system conversion unit 112 and determines whether a plurality of targets are detected in the overlap detection area 20. When a plurality of targets are detected in the overlap detection area 20, the position data of each of the targets detected by the first radar device 101 and the targets detected by the second radar device 102 are detected. Are compared, and it is determined that targets that are close in distance are the same target, and the correspondence is performed.

軸ずれ判定手段114は、物標識別手段113から共通座標系の位置データを入力し、これを用いて第1のレーダ装置101と第2のレーダ装置102との間で軸ずれが生じているか否かを判定する。物標識別手段113で重複検知エリア20内に1つの物標が検知されたと判定されたときは、軸ずれ判定手段114は、以下の条件のいずれかが成立するときに軸ずれが発生していると判定する。   The axis deviation determination means 114 receives the position data of the common coordinate system from the object labeling means 113, and uses this to determine whether or not an axis deviation occurs between the first radar apparatus 101 and the second radar apparatus 102. Determine whether or not. When it is determined that one target has been detected in the duplication detection area 20 by the object identification unit 113, the axis deviation determination unit 114 causes an axis deviation when any of the following conditions is satisfied. It is determined that

(1)重複検知エリアにおいて、2台のレーダ装置の一方で物標が検知され他方で物標が検知されない周期が連続して所定回数以上継続する。
(2)重複検知エリアにおいて、2台のレーダ装置の両方で物標が検知され、それぞれで検知された物標の位置データ間の差分の連続する所定回数分の平均値が所定のしきい値を超える。
なお、上記(1)、(2)に記載の所定回数は、繰り返し周期Tの連続する回数であり、あらかじめ設定しておくものとする。
(1) In the overlap detection area, a cycle in which the target is detected on one of the two radar devices and the target is not detected on the other continues continuously for a predetermined number of times or more.
(2) In the overlap detection area, the target is detected by both of the two radar devices, and the average value for a predetermined number of consecutive differences between the position data of the detected targets is a predetermined threshold value. Over.
Note that the predetermined number of times described in the above (1) and (2) is the number of times that the repetition period T continues, and is set in advance.

上記(2)の物標の位置データ間の差分の連続する所定回数分の平均値に対する所定のしきい値は、例えば図7のように設定することができる。図7では、x座標の差分Δx=x1−x2を横軸にとり、y座標の差分Δy=y1−y2を縦軸にとったとき、原点から差分点(Δx、Δy)までの差分ベクトルの大きさ(原点から点(Δx、Δy)までの距離)に対してしきい値を設定している。しきい値の一例として、ここでは第1のしきい値R1と第2のしきい値R2を設け、差分ベクトルの大きさが第1のしきい値R1を超えると運転者に注意メッセージを出力し、さらにしきい値R2を超えると警告メッセージを出力するようにすることができる。   The predetermined threshold value for the average value for a predetermined number of consecutive differences between the position data of the target (2) can be set as shown in FIG. 7, for example. In FIG. 7, when the x-axis difference Δx = x1−x2 is taken on the horizontal axis and the y-coordinate difference Δy = y1−y2 is taken on the vertical axis, the magnitude of the difference vector from the origin to the difference point (Δx, Δy). A threshold value is set for (the distance from the origin to the point (Δx, Δy)). As an example of the threshold value, a first threshold value R1 and a second threshold value R2 are provided here, and a warning message is output to the driver when the magnitude of the difference vector exceeds the first threshold value R1. When the threshold value R2 is exceeded, a warning message can be output.

また、物標識別手段113で重複検知エリア20内に複数の物標が検知されたと判定されたときは、軸ずれ判定手段114は、物標物標識別手段113で物標間の対応づけが行われた結果をもとに、下記の条件のいずれかが成立するときに軸ずれが発生していると判定する。   Further, when it is determined that the plurality of targets are detected in the duplication detection area 20 by the target mark identification unit 113, the axis deviation determination unit 114 is configured to associate the targets with the target mark identification unit 113. Based on the results obtained, it is determined that an axis deviation has occurred when any of the following conditions is met.

(3)重複検知エリアにおいて、2台のレーダ装置のそれぞれで検知された物標の個数が一致しない周期が連続して所定回数以上継続する。
(4)重複検知エリアにおいて、2台のレーダ装置の両方で同数の物標が検知され、それぞれ対応付けされた位置データ間の差分の連続する所定回数分の平均値が所定のしきい値を超えるものが1組以上ある。
(3) In the overlap detection area, a period in which the number of targets detected by each of the two radar devices does not match continues continuously for a predetermined number of times.
(4) In the overlap detection area, the same number of targets are detected by both of the two radar devices, and the average value for a predetermined number of consecutive differences between the associated position data has a predetermined threshold value. There is more than one set.

なお、物標識別手段113において、重複検知エリア20内に1つの物標が検知されたと判定された場合も、第1のレーダ装置101で検知された1つの物標と第2のレーダ装置102で検知された1つの物標とが同一の物標であるとして対応づけすることができることから、以下では重複検知エリア20内で1つの物標が検知されたときも物標識別手段113で対応付けを行うものとして説明する。   It should be noted that even if it is determined that one target has been detected in the overlap detection area 20 in the object-mark-separating means 113, one target detected by the first radar device 101 and the second radar device 102 are detected. Since one target detected in step (1) can be associated with the same target, the following is also handled by the target identification means 113 when one target is detected in the overlap detection area 20. The description will be given assuming that

本実施形態の周辺監視装置100による軸ずれ検知方法を、図1を用いてさらに詳細に説明する。図1において、周辺監視装置100による計測が開始されると(ステップS1)、第1のレーダ装置101及び第2のレーダ装置102のそれぞれで物標を検知する(ステップS2)。そして、第1のレーダ装置101及び第2のレーダ装置102のそれぞれにおいて、物標が検知されたときは物標の位置データを算出して重複エリア内物標判定手段111に出力する(ステップS3)。   The axis deviation detection method by the periphery monitoring device 100 of this embodiment will be described in more detail with reference to FIG. In FIG. 1, when measurement by the periphery monitoring device 100 is started (step S1), a target is detected by each of the first radar device 101 and the second radar device 102 (step S2). Then, in each of the first radar apparatus 101 and the second radar apparatus 102, when a target is detected, the position data of the target is calculated and output to the overlapping area target determination unit 111 (step S3). ).

重複エリア内物標判定手段111では、第1のレーダ装置101及び第2のレーダ装置102から入力した位置データをもとに、検知された物標が重複検知エリア20内に位置するか否かを判定する。そして、重複検知エリア20内に位置すると判定された物標の位置データを座標系変換手段112に出力する(ステップS4)。   The overlapping area target determination unit 111 determines whether or not the detected target is located in the overlapping detection area 20 based on the position data input from the first radar device 101 and the second radar device 102. Determine. Then, the position data of the target determined to be located in the overlap detection area 20 is output to the coordinate system conversion means 112 (step S4).

座標系変換手段112は、重複エリア内物標判定手段111から入力した物標の位置データを、共通の座標系に変換する(ステップS5)。共通の座標系に変換された位置データは、物標識別手段113に出力される。物標識別手段113は、座標系変換手段112から共通座標系の位置データを入力し、第1のレーダ装置101で検知された物標と第2のレーダ装置102で検知された物標とのそれぞれの位置データを比較し、距離的に近い物標同士を同一の物標であると判定して対応づけを行う(ステップS6)。   The coordinate system conversion means 112 converts the target position data input from the overlapping area target determination means 111 into a common coordinate system (step S5). The position data converted into the common coordinate system is output to the object labeling means 113. The target mark distinction means 113 inputs the position data of the common coordinate system from the coordinate system conversion means 112, and the target detected by the first radar apparatus 101 and the target detected by the second radar apparatus 102 are detected. The respective position data are compared, and the targets that are close in distance are determined to be the same target, and are associated (step S6).

軸ずれ判定手段114は、物標識別手段113から同一の物標として対応づけされた共通座標系の位置データを入力し、これを用いて第1のレーダ装置101と第2のレーダ装置102との間で軸ずれが生じているか否かを判定する。まず、ステップS7において、重複検知エリア20内に物標が検知されたか否かを判定し、レーダ装置101、102のいずれかで物標が検知されているときはステップS8に進み、レーダ装置101、102の両方で物標が検知されていないときは当該周期の処理を終了する。   The axis misalignment determining means 114 receives the position data of the common coordinate system associated as the same target from the object marker distinguishing means 113, and uses this to input the first radar device 101, the second radar device 102, and the like. It is determined whether or not an axis deviation occurs between the two. First, in step S7, it is determined whether or not a target is detected in the overlap detection area 20, and if a target is detected in any of the radar apparatuses 101 and 102, the process proceeds to step S8, and the radar apparatus 101 is detected. , 102, when the target is not detected, the processing of the cycle ends.

ステップS8では、レーダ装置101、102の両方で同数の物標が検知されたか否かを判定する。そして、同数の物標が検知されているときはステップS9に進み、物標の個数が異なるときはステップS11に進む。ステップS9では、対応付けされた位置データ間の差分を算出して保存し、つぎにステップS10に進む。   In step S8, it is determined whether or not the same number of targets have been detected by both the radar apparatuses 101 and 102. When the same number of targets is detected, the process proceeds to step S9, and when the number of targets is different, the process proceeds to step S11. In step S9, the difference between the associated position data is calculated and stored, and then the process proceeds to step S10.

ステップS10では、ステップS9で算出して保存された位置データの差分を読み出し、最新の連続する所定回数分の差分の平均値を算出する。そして、差分の平均値が所定のしきい値以下か否かを判定する。その結果、差分の平均値が所定のしきい値を超えると判定されるとステップS13に進み、しきい値以下と判定されると軸ずれが十分に小さいと判定して当該周期の処理を終了する。   In step S10, the difference between the position data calculated and stored in step S9 is read, and the average value of the difference for the latest predetermined number of times is calculated. Then, it is determined whether or not the average difference value is equal to or less than a predetermined threshold value. As a result, if it is determined that the average value of the differences exceeds a predetermined threshold value, the process proceeds to step S13. To do.

これに対し、ステップS8において重複検知エリア20で検知された物標の個数が異なると判定されたときは、ステップS11で連続して物標の個数が異なると判定された回数をカウントする。そして、ステップS12において連続して物標の個数が異なると判定された回数が所定の軸ずれ判定回数以上か否かを判定し、所定の軸ずれ判定回数以上のときはステップS13に進み、軸ずれ判定回数未満のときは当該周期の処理を終了する。   On the other hand, when it is determined in step S8 that the number of targets detected in the overlap detection area 20 is different, the number of times that the number of targets continuously determined in step S11 is counted. Then, it is determined whether or not the number of times that the number of targets is successively different in step S12 is equal to or greater than a predetermined axis deviation determination number. When it is less than the number of deviation determinations, the process of the cycle is terminated.

ステップS13では、レーダ装置101と102との間で軸ずれが発生していると判定し、これを運転者等に通知する。これにより、運転者等は軸ずれを知ることができ、軸ずれを調整して周辺監視システム100を再び正常な状態で使用することが可能となる。本実施形態の周辺監視システム100及び軸ずれ検知方法によれば、周辺監視システム100の運用中に、物標検知結果を用いてレーダ装置間の軸ずれを容易に検知することができ、軸ずれによる物標の誤検知を防止することが可能となる。   In step S13, it is determined that an axis deviation has occurred between the radar apparatuses 101 and 102, and this is notified to the driver or the like. Accordingly, the driver or the like can know the shaft misalignment, and can adjust the shaft misalignment and use the periphery monitoring system 100 again in a normal state. According to the periphery monitoring system 100 and the axis deviation detection method of the present embodiment, the axis deviation between the radar devices can be easily detected using the target detection result during the operation of the area monitoring system 100. This makes it possible to prevent false detection of the target due to.

(第2実施形態)
本発明の第2の実施の形態に係る周辺監視システム及び周辺監視システムの軸ずれ検知方法を、以下に説明する。本実施形態では、レーダ装置101、102が物標の位置データに加えて物標の速度データも検知し、該速度データを用いて軸ずれをさらに高精度に検知することが可能となっている。物標の速度は、物標の位置データの履歴から算出されたトラッキングデータより得られる。
(Second Embodiment)
A periphery monitoring system and a method for detecting an axis deviation of the periphery monitoring system according to the second embodiment of the present invention will be described below. In the present embodiment, the radar devices 101 and 102 can detect target speed data in addition to target position data, and can detect an axis deviation with higher accuracy using the speed data. . The speed of the target is obtained from tracking data calculated from the history of the position data of the target.

本実施形態では、重複エリア内物標判定手段111により重複検知エリア内に位置すると判定された物標の速度データを物標識別手段113に出力する。物標識別手段113では、共通座標系の位置データと速度データを用いて、第1のレーダ装置101で検知された物標と第2のレーダ装置102で検知された物標との対応付けをさらに高精度に行う。すなわち、本実施形態では距離的に近くかつ速度が最も近い物標同士を同一の物標であると判定して対応づけを行う。   In the present embodiment, the speed data of the target determined to be located in the overlap detection area by the overlap area target determination unit 111 is output to the target label distinction unit 113. The object-mark distinction unit 113 associates the target detected by the first radar apparatus 101 with the target detected by the second radar apparatus 102 using the position data and velocity data of the common coordinate system. Furthermore, it is performed with high accuracy. In other words, in the present embodiment, targets that are close in distance and closest in speed are determined to be the same target and are associated with each other.

第1実施形態では、位置データを用いた距離だけで同一の物標か否かを判定していたが、距離的に近い物標が2台以上あると、同一の物標として対応付けするのが困難になる場合が予想される。そこで、本実施形態では距離的に近いことに加えて、トラッキングにより得られた第1のレーダ装置101で観測される速度データ(Vx1、Vy1)及び第2のレーダ装置102で観測される速度データ(Vx2、Vy2)を基に、Vx1とVx2とが略等しく、かつVy1とVy2とが略等しいことを確認することにより、同一の物標としての対応付けをより高精度に行うことが可能となる。   In the first embodiment, it is determined whether or not the target is the same only by the distance using the position data. However, if there are two or more targets that are close in distance, they are associated as the same target. Is expected to be difficult. Therefore, in this embodiment, in addition to being close in distance, velocity data (Vx1, Vy1) observed by the first radar device 101 and velocity data observed by the second radar device 102 obtained by tracking. Based on (Vx2, Vy2), by confirming that Vx1 and Vx2 are approximately equal and Vy1 and Vy2 are approximately equal, it is possible to perform matching as the same target with higher accuracy. Become.

また、速度を用いた軸ずれ検知として、上記の位置および速度データを用いて同一物標とされた物標に対して、第1のレーダ装置101で観測される速度データ(Vx1、Vy1)、及び第2のレーダ装置102で観測される速度データ(Vx2、Vy2)を基に、Vx成分の差分ΔVx=Vx1−Vx2及びVy成分の差分ΔVy=Vy1−Vy2を算出する。そして、差分ΔVxを横軸にとり、差分ΔVyを縦軸にとったとき、原点から差分点(ΔVx、ΔVy)までの差分ベクトルの大きさ(原点から点(ΔVx、ΔVy)までの距離)に対してしきい値を設定し、該しきい値を用いて軸ずれの判定を行うことができる。しきい値の一例として、ここでは第1のしきい値Vr1と第2のしきい値Vr2を設け、差分ベクトルの大きさが第1のしきい値Vr1を超えると運転者に注意メッセージを出力し、さらにしきい値Vr2を超えると警告メッセージを出力するようにすることができる。   Further, as axis deviation detection using speed, speed data (Vx1, Vy1) observed by the first radar apparatus 101 with respect to a target that is the same target using the position and speed data described above, And Vx component difference ΔVx = Vx1−Vx2 and Vy component difference ΔVy = Vy1−Vy2 based on velocity data (Vx2, Vy2) observed by the second radar apparatus 102. When the difference ΔVx is taken on the horizontal axis and the difference ΔVy is taken on the vertical axis, the magnitude of the difference vector from the origin to the difference point (ΔVx, ΔVy) (distance from the origin to the point (ΔVx, ΔVy)) Thus, the threshold value can be set, and the axis deviation can be determined using the threshold value. As an example of the threshold value, a first threshold value Vr1 and a second threshold value Vr2 are provided here, and a warning message is output to the driver when the magnitude of the difference vector exceeds the first threshold value Vr1. In addition, a warning message can be output when the threshold value Vr2 is exceeded.

なお、本実施の形態における記述は、本発明に係る周辺監視システム及び周辺監視システムの軸ずれ検知方法の一例を示すものであり、これに限定されるものではない。本実施の形態における周辺監視システム及び周辺監視システムの軸ずれ検知方法の細部構成及び詳細な動作などに関しては、本発明の趣旨を逸脱しない範囲で適宜変更可能である。   In addition, the description in this Embodiment shows an example of the periphery monitoring system which concerns on this invention, and the axis deviation detection method of a periphery monitoring system, It is not limited to this. The detailed configuration and detailed operation of the periphery monitoring system and the axis deviation detection method of the periphery monitoring system in the present embodiment can be changed as appropriate without departing from the spirit of the present invention.

11、12、11’ 検知エリア
11a、12a 基準軸
20 重複検知エリア
100 周辺監視システム
101 第1のレーダ装置
102 第2のレーダ装置
111 重複エリア内物標判定手段
112 座標系変換手段
113 物標識別手段
114 軸ずれ判定手段
11, 12, 11 ′ Detection area 11a, 12a Reference axis 20 Overlap detection area 100 Perimeter monitoring system 101 First radar device 102 Second radar device 111 Overlap area target determination means 112 Coordinate system conversion means 113 Means 114 Axis deviation judgment means

Claims (4)

所定の繰り返し周期で検知エリア内の物標を検知するレーダ装置を2台以上備えた周辺監視システムであって、
前記2台以上のレーダ装置のそれぞれの前記検知エリアは、一部が別の前記レーダ装置の前記検知エリアの一部と重なる重複検知エリアを含んでおり、
前記レーダ装置のそれぞれから前記物標を検知したときの位置データを入力し、前記位置データをもとに前記重複検知エリアのそれぞれに位置する前記物標を判定して該物標の位置データを出力する重複エリア内物標判定手段と、
前記重複エリア内物標判定手段から前記重複検知エリア毎の前記物標の位置データを入力し、前記重複検知エリア毎にそれぞれを共有する2台の前記レーダ装置に共通する共通座標系に前記位置データを変換して出力する座標系変換手段と、
前記座標系変換手段から前記重複検知エリア毎の前記共通座標系の位置データを入力し、前記重複検知エリア毎に前記2台のレーダ装置の一方で検知された前記位置データと他方で検知された前記位置データとの対応付けを行う物標識別手段と、
前記物標識別手段から前記重複検知エリア毎に前記対応付けされた位置データを入力し、いずれかの前記重複検知エリアを共有する前記2台のレーダ装置で検知された物標の個数が異なるとき、あるいは前記対応付けされた位置データ間の差分が所定のしきい値を超えるとき、前記2台の前記レーダ装置間の軸ずれを判定する軸ずれ判定手段と、を有し、
前記軸ずれ判定手段は、前記2台のレーダ装置で検知された物標の個数が異なる周期が連続して所定の軸ずれ判定回数以上続くときに前記2台のレーダ装置間の軸ずれを判定する
ことを特徴とする周辺監視システム。
A perimeter monitoring system including two or more radar devices that detect a target in a detection area at a predetermined repetition period,
Each of the detection areas of the two or more radar devices includes an overlap detection area that partially overlaps a part of the detection area of another radar device,
Position data when the target is detected is input from each of the radar devices, the target located in each of the overlap detection areas is determined based on the position data, and the position data of the target is obtained. An overlapping area target judging means for outputting;
The position data of the target for each overlap detection area is input from the overlap area target determination means, and the position is in a common coordinate system common to the two radar devices sharing each overlap detection area. Coordinate system conversion means for converting and outputting data;
The position data of the common coordinate system for each overlap detection area is input from the coordinate system conversion means, and the position data detected by one of the two radar devices and the other detected by the other for each overlap detection area. An object labeling means for performing association with the position data;
When the position data associated with each overlap detection area is input from the object distinguishing means, and the number of targets detected by the two radar devices sharing any of the overlap detection areas is different , or when the difference between the correspondence position data exceeds the predetermined threshold, have a, and determining axis misalignment determination means for axial displacement between the two said radar device,
The axis misalignment determining means determines an axis misalignment between the two radar devices when a period in which the number of targets detected by the two radar devices is different continues for a predetermined number of times of axis misalignment determination. A peripheral monitoring system characterized by:
前記対応付けされた位置データ間の差分は、前記繰り返し周期毎に前記対応付けされた位置データ間の距離を算出し、最新の連続する所定回数分にわたって前記距離を平均した平均値である
ことを特徴とする請求項1に記載の周辺監視システム。
The difference between the associated position data is an average value obtained by calculating the distance between the associated position data for each repetition period and averaging the distance over a predetermined number of consecutive times. The perimeter monitoring system according to claim 1, wherein
所定の繰り返し周期で検知エリア内の物標を検知するレーダ装置を2台以上備えた周辺監視システムの軸ずれ検知方法であって、
前記2台以上のレーダ装置のそれぞれの前記検知エリアは、一部が別の前記レーダ装置の前記検知エリアの一部と重なる重複検知エリアを含んでおり、
前記レーダ装置のそれぞれから前記物標を検知したときの位置データを入力して前記重複検知エリアのそれぞれに位置する前記物標を判定して該物標の位置データを出力する重複エリア内物標判定ステップと、
前記重複検知エリア毎の前記物標の位置データを入力してそれぞれの前記重複検知エリアを共有する2台の前記レーダ装置に共通する共通座標系に前記位置データを変換して出力する座標系変換ステップと、
前記重複検知エリア毎に前記2台のレーダ装置の一方で検知された前記共通座標系の位置データと他方で検知された前記共通座標系の位置データとの対応付けを行う物標識別ステップと、
いずれかの前記重複検知エリアを共有する前記2台のレーダ装置で検知された物標の個数が異なるとき、あるいは前記対応付けされた位置データ間の差分が所定のしきい値を超えるとき、前記2台の前記レーダ装置間の軸ずれを判定する軸ずれ判定ステップと、を有し、
前記軸ずれ判定ステップでは、前記2台のレーダ装置で検知された物標の個数が異なる周期が連続して所定の軸ずれ判定回数以上続くときに前記2台のレーダ装置間の軸ずれを判定する
ことを特徴とする周辺監視システムの軸ずれ検知方法。
A method for detecting an axis deviation of a peripheral monitoring system including two or more radar devices that detect a target in a detection area at a predetermined repetition cycle,
Each of the detection areas of the two or more radar devices includes an overlap detection area that partially overlaps a part of the detection area of another radar device,
An overlapping area target that inputs position data when the target is detected from each of the radar devices, determines the target located in each of the overlapping detection areas, and outputs the position data of the target. A determination step;
Coordinate system conversion that inputs the position data of the target for each overlap detection area, converts the position data to a common coordinate system common to the two radar devices sharing the overlap detection area, and outputs the same Steps,
An object-label-specific step for associating the position data of the common coordinate system detected by one of the two radar devices with the position data of the common coordinate system detected by the other for each overlap detection area;
When the number of targets detected by the two radar devices sharing any of the overlapping detection areas is different, or when the difference between the associated position data exceeds a predetermined threshold, and determining axis misalignment determination step the axial displacement between the two said radar device, was closed,
In the axis misalignment determining step, an axis misalignment between the two radar devices is determined when a period in which the number of targets detected by the two radar devices is different continues for a predetermined number of times of axis misalignment determination. A method for detecting a misalignment of a peripheral monitoring system, characterized in that:
前記対応付けされた位置データ間の差分は、前記繰り返し周期毎に前記対応付けされた位置データ間の距離を算出し、最新の連続する所定回数分にわたって前記距離を平均した平均値である
ことを特徴とする請求項に記載の周辺監視システムの軸ずれ検知方法。
The difference between the associated position data is an average value obtained by calculating the distance between the associated position data for each repetition period and averaging the distance over a predetermined number of consecutive times. The method for detecting an axis deviation of the periphery monitoring system according to claim 3 , wherein
JP2013023442A 2013-02-08 2013-02-08 Perimeter monitoring system and axis deviation detection method for perimeter monitoring system Active JP6168784B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2013023442A JP6168784B2 (en) 2013-02-08 2013-02-08 Perimeter monitoring system and axis deviation detection method for perimeter monitoring system

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2013023442A JP6168784B2 (en) 2013-02-08 2013-02-08 Perimeter monitoring system and axis deviation detection method for perimeter monitoring system

Publications (2)

Publication Number Publication Date
JP2014153211A JP2014153211A (en) 2014-08-25
JP6168784B2 true JP6168784B2 (en) 2017-07-26

Family

ID=51575212

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2013023442A Active JP6168784B2 (en) 2013-02-08 2013-02-08 Perimeter monitoring system and axis deviation detection method for perimeter monitoring system

Country Status (1)

Country Link
JP (1) JP6168784B2 (en)

Families Citing this family (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105738871A (en) * 2014-12-24 2016-07-06 松下知识产权经营株式会社 Radar system
JP6825569B2 (en) * 2015-09-30 2021-02-03 ソニー株式会社 Signal processor, signal processing method, and program
WO2017149813A1 (en) * 2016-02-29 2017-09-08 株式会社日立製作所 Sensor calibration system
JP6848725B2 (en) * 2017-06-29 2021-03-24 株式会社デンソー Horizontal axis deviation determination method in the object detection device for vehicles and the object detection device for vehicles
US20190004160A1 (en) * 2017-06-30 2019-01-03 Delphi Technologies, Inc. Lidar sensor alignment system
DE102017212868A1 (en) * 2017-07-26 2019-01-31 Robert Bosch Gmbh Device and method for detecting a position of an object
JP6943678B2 (en) * 2017-08-14 2021-10-06 本田技研工業株式会社 External recognition device
US10830871B2 (en) * 2018-03-21 2020-11-10 Zoox, Inc. Sensor calibration
JP6970065B2 (en) * 2018-09-06 2021-11-24 株式会社Soken Object detector
JP7203583B2 (en) * 2018-11-30 2023-01-13 古河電気工業株式会社 Sensor system, sensor device, and anomaly detection method
WO2021024289A1 (en) * 2019-08-02 2021-02-11 三菱電機株式会社 Vehicle-mounted object detection device
EP4043910A4 (en) * 2019-10-10 2023-08-23 Kyocera Corporation Electronic apparatus, control method for electronic apparatus, and control program for electronic apparatus
JP2021148561A (en) * 2020-03-18 2021-09-27 株式会社Soken Radar device
JP2023183977A (en) * 2022-06-17 2023-12-28 ソニーグループ株式会社 Information processing apparatus, information processing method, and measurement system

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH08271247A (en) * 1995-03-30 1996-10-18 Mitsubishi Electric Corp Device for estimating alignment error of sensor
JP2004037239A (en) * 2002-07-03 2004-02-05 Fuji Heavy Ind Ltd Identical object judging method and system, and misregistration correcting method and system
JP4726621B2 (en) * 2005-12-13 2011-07-20 アルパイン株式会社 In-vehicle sensor correction device
JP5055169B2 (en) * 2008-03-05 2012-10-24 本田技研工業株式会社 Vehicle safety device
DE102009024064A1 (en) * 2009-06-05 2010-12-09 Valeo Schalter Und Sensoren Gmbh Driver assistance means for determining a target angle of a device external object and method for correcting a target angle parameter characteristic

Also Published As

Publication number Publication date
JP2014153211A (en) 2014-08-25

Similar Documents

Publication Publication Date Title
JP6168784B2 (en) Perimeter monitoring system and axis deviation detection method for perimeter monitoring system
US10725474B2 (en) Action planning device having a trajectory generation and determination unit that prevents entry into a failure occurrence range
JP4713048B2 (en) A method and apparatus for recognizing misadjustment in a vehicle radar system or a vehicle sensor system.
EP3239737B1 (en) Misalignment detection for a vehicle radar sensor
CN102959600B (en) Device for estimating vehicle travel path
KR20160056129A (en) System and method for correcting position information of surrounding vehicle
JP2004037239A (en) Identical object judging method and system, and misregistration correcting method and system
JP2005032063A (en) On-vehicle obstacle detector
US11148592B2 (en) Motorcycle driving assistance device
JP7134361B2 (en) In-vehicle object detection device
JP2010170315A (en) Autonomous mobile device
JP2021096265A (en) Measurement device, method for measurement, and program
CN112119330A (en) Object detection device and object detection method
JP5976027B2 (en) Sensor axis deviation detection device and sensor axis deviation detection method
JP4850531B2 (en) In-vehicle radar system
KR101981175B1 (en) System for preventing collision of crane and method thereof
US10810448B2 (en) Image-capturing device
WO2021024711A1 (en) Aiming device, driving control system, and method for calculating correction amount for sensor data
JP6967157B2 (en) Methods and devices for checking the validity of lateral movement
US20230059090A1 (en) Method for suppressing ambiguous measurement data from environmental sensors
JP2014112348A (en) Action analyzing apparatus, action analyzing system, and action analyzing method
CN110967040B (en) Method and system for identifying horizontal deviation angle of sensor
JP2008083995A (en) Map information processing apparatus and mobile robotic device
JP6973302B2 (en) Target recognition device
WO2016063533A1 (en) In-vehicle object determining apparatus

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20160114

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20161212

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20161216

A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20170131

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: 20170609

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20170627

R151 Written notification of patent or utility model registration

Ref document number: 6168784

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R151

S531 Written request for registration of change of domicile

Free format text: JAPANESE INTERMEDIATE CODE: R313531

R350 Written notification of registration of transfer

Free format text: JAPANESE INTERMEDIATE CODE: R350