JP7162142B2 - エイミング装置、運転制御システム、及びセンサデータの補正量の計算方法 - Google Patents
エイミング装置、運転制御システム、及びセンサデータの補正量の計算方法 Download PDFInfo
- Publication number
- JP7162142B2 JP7162142B2 JP2021537649A JP2021537649A JP7162142B2 JP 7162142 B2 JP7162142 B2 JP 7162142B2 JP 2021537649 A JP2021537649 A JP 2021537649A JP 2021537649 A JP2021537649 A JP 2021537649A JP 7162142 B2 JP7162142 B2 JP 7162142B2
- Authority
- JP
- Japan
- Prior art keywords
- sensor
- unit
- function
- vehicle
- target
- 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
Links
- 238000012937 correction Methods 0.000 title claims description 104
- 238000004364 calculation method Methods 0.000 title claims description 18
- 238000000034 method Methods 0.000 title claims description 4
- 238000001514 detection method Methods 0.000 claims description 146
- 230000009466 transformation Effects 0.000 claims description 62
- 230000004927 fusion Effects 0.000 claims description 56
- 238000006243 chemical reaction Methods 0.000 claims description 22
- 230000010354 integration Effects 0.000 claims description 9
- 230000006870 function Effects 0.000 description 164
- 238000012544 monitoring process Methods 0.000 description 84
- 238000012545 processing Methods 0.000 description 33
- 238000010586 diagram Methods 0.000 description 20
- 239000003550 marker Substances 0.000 description 19
- 230000006399 behavior Effects 0.000 description 18
- 230000005856 abnormality Effects 0.000 description 15
- 238000003672 processing method Methods 0.000 description 8
- 238000012886 linear function Methods 0.000 description 7
- 238000006073 displacement reaction Methods 0.000 description 6
- 230000008859 change Effects 0.000 description 5
- 230000000694 effects Effects 0.000 description 4
- 238000001914 filtration Methods 0.000 description 4
- 238000007689 inspection Methods 0.000 description 3
- 230000035939 shock Effects 0.000 description 3
- 239000007787 solid Substances 0.000 description 3
- 238000013213 extrapolation Methods 0.000 description 2
- 238000009434 installation Methods 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 230000001360 synchronised effect Effects 0.000 description 2
- 206010039203 Road traffic accident Diseases 0.000 description 1
- 238000007792 addition Methods 0.000 description 1
- 238000003491 array Methods 0.000 description 1
- 238000012217 deletion Methods 0.000 description 1
- 230000037430 deletion Effects 0.000 description 1
- 239000000284 extract Substances 0.000 description 1
- 239000000446 fuel Substances 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 239000011159 matrix material Substances 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 239000003973 paint Substances 0.000 description 1
- 230000008439 repair process Effects 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
- 239000000725 suspension Substances 0.000 description 1
- 230000001131 transforming effect Effects 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
- B60W50/02—Ensuring safety in case of control system failures, e.g. by diagnosing, circumventing or fixing failures
- B60W50/0205—Diagnosing or detecting failures; Failure detection models
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W60/00—Drive control systems specially adapted for autonomous road vehicles
- B60W60/001—Planning or execution of driving tasks
- B60W60/0027—Planning or execution of driving tasks using trajectory prediction for other traffic participants
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
- B60W50/02—Ensuring safety in case of control system failures, e.g. by diagnosing, circumventing or fixing failures
- B60W50/029—Adapting to failures or work around with other constraints, e.g. circumvention by avoiding use of failed parts
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
- B60W50/08—Interaction between the driver and the control system
- B60W50/14—Means for informing the driver, warning the driver or prompting a driver intervention
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W60/00—Drive control systems specially adapted for autonomous road vehicles
- B60W60/001—Planning or execution of driving tasks
- B60W60/0015—Planning or execution of driving tasks specially adapted for safety
- B60W60/0018—Planning or execution of driving tasks specially adapted for safety by employing degraded modes, e.g. reducing speed, in response to suboptimal conditions
- B60W60/00186—Planning or execution of driving tasks specially adapted for safety by employing degraded modes, e.g. reducing speed, in response to suboptimal conditions related to the vehicle
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/88—Radar or analogous systems specially adapted for specific applications
- G01S13/93—Radar or analogous systems specially adapted for specific applications for anti-collision purposes
- G01S13/931—Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
- G01S7/02—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S13/00
- G01S7/40—Means for monitoring or calibrating
- G01S7/4004—Means for monitoring or calibrating of parts of a radar system
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T7/00—Image analysis
- G06T7/80—Analysis of captured images to determine intrinsic or extrinsic camera parameters, i.e. camera calibration
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/16—Anti-collision systems
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
- B60W50/02—Ensuring safety in case of control system failures, e.g. by diagnosing, circumventing or fixing failures
- B60W50/0205—Diagnosing or detecting failures; Failure detection models
- B60W2050/021—Means for detecting failure or malfunction
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
- B60W50/02—Ensuring safety in case of control system failures, e.g. by diagnosing, circumventing or fixing failures
- B60W50/0205—Diagnosing or detecting failures; Failure detection models
- B60W2050/0215—Sensor drifts or sensor failures
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
- B60W50/02—Ensuring safety in case of control system failures, e.g. by diagnosing, circumventing or fixing failures
- B60W50/029—Adapting to failures or work around with other constraints, e.g. circumvention by avoiding use of failed parts
- B60W2050/0292—Fail-safe or redundant systems, e.g. limp-home or backup systems
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
- B60W50/08—Interaction between the driver and the control system
- B60W50/14—Means for informing the driver, warning the driver or prompting a driver intervention
- B60W2050/143—Alarm means
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
- B60W50/08—Interaction between the driver and the control system
- B60W50/14—Means for informing the driver, warning the driver or prompting a driver intervention
- B60W2050/146—Display means
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2420/00—Indexing codes relating to the type of sensors based on the principle of their operation
- B60W2420/40—Photo, light or radio wave sensitive means, e.g. infrared sensors
- B60W2420/403—Image sensing, e.g. optical camera
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2420/00—Indexing codes relating to the type of sensors based on the principle of their operation
- B60W2420/40—Photo, light or radio wave sensitive means, e.g. infrared sensors
- B60W2420/408—Radar; Laser, e.g. lidar
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2552/00—Input parameters relating to infrastructure
- B60W2552/50—Barriers
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2556/00—Input parameters relating to data
- B60W2556/25—Data precision
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2556/00—Input parameters relating to data
- B60W2556/35—Data fusion
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/86—Combinations of radar systems with non-radar systems, e.g. sonar, direction finder
- G01S13/867—Combination of radar systems with cameras
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/88—Radar or analogous systems specially adapted for specific applications
- G01S13/93—Radar or analogous systems specially adapted for specific applications for anti-collision purposes
- G01S13/931—Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
- G01S2013/9322—Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles using additional data, e.g. driver condition, road state or weather data
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T2207/00—Indexing scheme for image analysis or image enhancement
- G06T2207/30—Subject of image; Context of image processing
- G06T2207/30244—Camera pose
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T2207/00—Indexing scheme for image analysis or image enhancement
- G06T2207/30—Subject of image; Context of image processing
- G06T2207/30248—Vehicle exterior or interior
- G06T2207/30252—Vehicle exterior; Vicinity of vehicle
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- General Physics & Mathematics (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Human Computer Interaction (AREA)
- Computer Networks & Wireless Communication (AREA)
- Electromagnetism (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Theoretical Computer Science (AREA)
- Traffic Control Systems (AREA)
Description
図1は、センサエイミング機能を有するセンサフュージョン装置1の一実施例を示す機能ブロック図である。図2乃至図4は、センサエイミング機能を有するセンサフュージョン装置1の処理を示す概念図である。図1乃至図4を用いて本発明の第1の実施例であるセンサエイミング機能を有するセンサフュージョン装置1の処理フロー及び動作を説明する。
y=a1x+b1 …(1)
y=a2x+b2 …(2)
y=a3x+b3 …(3)
y=a4x+b4 …(4)
図5は、センサエイミング機能を有するセンサフュージョン装置1の一実施例を示す機能ブロック図である。図5を用いて本発明の第2の実施例であるセンサエイミング機能を有するセンサフュージョン装置1の処理フロー及び動作を説明する。実施例2において、実施例1との相違点を主に説明し、同じ構成には同じ符号を付し、その説明を省略する。
図6は、センサエイミング機能を有するセンサフュージョン装置1の一実施例を示す機能ブロック図である。図6を用いて本発明の第3の実施例であるセンサエイミング機能を有するセンサフュージョン装置1の処理フロー及び動作を説明する。実施例3において、実施例1との相違点を主に説明し、同じ構成には同じ符号を付し、その説明を省略する。
x2+y2=r2 …(5)
図7は、センサエイミング機能を有するセンサフュージョン装置1の一実施例を示す機能ブロック図である。図7を用いて本発明の第4の実施例であるセンサエイミング機能を有するセンサフュージョン装置1の処理フロー及び動作を説明する。実施例4において、実施例1との相違点を主に説明し、同じ構成には同じ符号を付し、その説明を省略する。
図8はセンサエイミング機能を有するセンサフュージョン装置1の一実施例を示す機能ブロック図である。図8を用いて本発明の第5の実施例であるセンサエイミング機能を有するセンサフュージョン装置1の処理フロー及び動作を説明する。実施例5において、実施例1との相違点を主に説明し、同じ構成には同じ符号を付し、その説明を省略する。
図9は、センサエイミング機能を有するセンサフュージョン装置1の一実施例を示す機能ブロック図である。図9を用いて本発明の第6の実施例であるセンサエイミング機能を有するセンサフュージョン装置1の処理フロー及び動作を説明する。実施例6において、実施例1、4及び5との相違点を主に説明し、同じ構成には同じ符号を付し、その説明を省略する。
図10は、センサエイミング機能を有するセンサフュージョン装置1の一実施例を示す機能ブロック図である。図10を用いて本発明の第7の実施例であるセンサエイミング機能を有するセンサフュージョン装置1の処理フロー及び動作を説明する。実施例7において、実施例1及び4との相違点を主に説明し、同じ構成には同じ符号を付し、その説明を省略する。
図11は、センサエイミング機能を有するセンサフュージョン装置1の処理方法を示す概念図である。図1及び図11を用いて本発明の第8の実施例であるセンサエイミング機能を有するセンサフュージョン装置1の動作を説明する。実施例8において、実施例1との相違点を主に説明し、同じ構成には同じ符号を付し、その説明を省略する。
20a 自車挙動検知センサ
30a レーンマーカ検知センサ
40a 配信センシング情報
50a~50c 状態検知センサ
100a センサ座標変換部
110a センサ時刻同期部
120a 移動体静止物分別部
200a センサデータ統合部
300a、300b ターゲット選択部
310a 関数フィッティング部
320a、320b フィッティング結果比較部
330a 座標変換補正値計算部
340a、340b ターゲット検知開始判定部
350a ターゲット検知データ有効性判定部
360a ターゲット記憶部
370a 配列形状推定部
380a 元関数生成部
390a 座標変換補正値記憶部
400a~400c 座標変換補正実施決定部
410a センサ状態推定部
420a 警報提示部
700a、700b センサ検知領域
710a 自車進行経路
800 自車
810a~810g 静止物ターゲット
820a 対象外静止物ターゲット
830a 移動体
900a~900g 関数フィッティング結果
910a~910d センサ観測結果
Claims (9)
- 二つ以上のセンサの検知結果を用いて、前記センサの検知結果の補正量を計算するエイミング装置であって、
前記センサが検知したセンサデータを、当該センサに固有の座標系から所定の統一座標系に変換するセンサ座標変換部と、
前記センサデータから所定の地物を選択するターゲット選択部と、
前記選択された地物の配列状態を近似する関数を各センサ毎に定める関数フィッティング部と、
前記定められた関数が表す線を前記センサの検知領域外に外挿して、前記外挿された線同士を比較するフィッティング結果比較部と、
前記関数の比較結果より、前記センサが検知した地物の座標を変換するための補正量を計算する補正値計算部とを備えることを特徴とするエイミング装置。 - 請求項1に記載のエイミング装置であって、
前記センサは、ミリ波レーダであることを特徴とするエイミング装置。 - 請求項1に記載のエイミング装置であって、
前記センサの少なくとも一つはミリ波レーダであり、少なくとも一つはカメラであることを特徴とするエイミング装置。 - 請求項1に記載のエイミング装置であって、
前記地物は、道路に対して略平行に既知の間隔で配置された構造物であることを特徴とするエイミング装置。 - 請求項4に記載のエイミング装置であって、
前記ターゲット選択部は、前記地物に関する既知の配列状態に対応するフィルタを有することを特徴とするエイミング装置。 - 請求項1に記載のエイミング装置であって、
前記計算された補正量が所定の閾値以上である場合、警報を出力する警報提示部を備えることを特徴とするエイミング装置。 - 請求項1に記載のエイミング装置であって、
状態検知センサが検知した車両に加わった衝撃及び温度の少なくとも一つが入力され、
前記衝撃及び前記温度の少なくとも一つが所定の条件を満たす場合、前記補正量を出力することを特徴とするエイミング装置。 - 車両の運転を制御する運転制御システムであって、
二つ以上のセンサの検知結果を統合して出力するセンサフュージョン装置と、
前記センサフュージョン装置からの出力を用いて車両の運転を制御する運転制御装置とを備え、
前記センサフュージョン装置は、
前記センサが検知したセンサデータを、当該センサに固有の座標系から所定の統一座標系に変換するセンサ座標変換部と、
前記センサデータから所定の地物を選択するターゲット選択部と、
前記選択された地物の配列状態を近似する関数を各センサ毎に定める関数フィッティング部と、
前記定められた関数が表す線を前記センサの検知領域外に外挿して、前記外挿された線同士を比較するフィッティング結果比較部と、
前記関数の比較結果より、前記センサが検知した地物の座標を変換するための補正量を計算する補正値計算部と、
前記センサデータを統合し、統合結果を出力するセンサデータ統合部とを有し、
前記センサ座標変換部は、前記計算された補正量を用いて、前記センサデータを前記統一座標系に変換
することを特徴とする運転制御システム。 - 二つ以上のセンサの検知結果を用いて、前記センサの検知結果の補正量を計算するエイミング装置が実行するセンサデータの補正量の計算方法であって、
前記計算方法は、
前記センサが検知したセンサデータを、当該センサに固有の座標系から所定の統一座標系に変換し、
前記センサデータから所定の地物を選択し、
前記選択された地物の配列状態を近似する関数を各センサ毎に定め、
前記定められた関数が表す線を前記センサの検知領域外に外挿して、前記外挿された線同士を比較し、
前記関数の比較結果より、前記センサが検知した地物の座標を変換するための補正量を計算することを特徴とする計算方法。
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2019142898 | 2019-08-02 | ||
JP2019142898 | 2019-08-02 | ||
PCT/JP2020/027322 WO2021024712A1 (ja) | 2019-08-02 | 2020-07-14 | エイミング装置、運転制御システム、及びセンサデータの補正量の計算方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
JPWO2021024712A1 JPWO2021024712A1 (ja) | 2021-02-11 |
JP7162142B2 true JP7162142B2 (ja) | 2022-10-27 |
Family
ID=74503057
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2021537649A Active JP7162142B2 (ja) | 2019-08-02 | 2020-07-14 | エイミング装置、運転制御システム、及びセンサデータの補正量の計算方法 |
Country Status (4)
Country | Link |
---|---|
US (1) | US20220289245A1 (ja) |
JP (1) | JP7162142B2 (ja) |
DE (1) | DE112020003137T5 (ja) |
WO (1) | WO2021024712A1 (ja) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20230044311A1 (en) * | 2020-01-10 | 2023-02-09 | Hitachi Astemo, Ltd. | Sensor aiming device, driving control system, and correction amount estimation method |
US20220137626A1 (en) * | 2020-11-04 | 2022-05-05 | Canon Kabushiki Kaisha | Apparatus, method, and non-transitory computer-readable storage medium |
JP2022176641A (ja) * | 2021-05-17 | 2022-11-30 | 日立Astemo株式会社 | レーダ装置 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004198159A (ja) | 2002-12-17 | 2004-07-15 | Nissan Motor Co Ltd | 車載センサの軸ずれ計測装置 |
JP2016156725A (ja) | 2015-02-25 | 2016-09-01 | 株式会社デンソー | 搭載角度誤差検出方法および装置、車載レーダ装置 |
JP2017207334A (ja) | 2016-05-17 | 2017-11-24 | 本田技研工業株式会社 | 移動体 |
DE102016009756A1 (de) | 2016-08-10 | 2018-02-15 | Daimler Ag | Verfahren zum Kalibrieren eines Sensorsystems eines Kraftfahrzeugs sowie Sensorsystem |
US20180313942A1 (en) | 2017-04-28 | 2018-11-01 | SZ DJI Technology Co., Ltd. | Calibration of laser sensors |
WO2019097731A1 (ja) | 2017-11-20 | 2019-05-23 | 三菱電機株式会社 | 障害物認識装置および障害物認識方法 |
Family Cites Families (35)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH05288847A (ja) * | 1992-04-09 | 1993-11-05 | Nissan Motor Co Ltd | 接近検知装置 |
JP3341186B2 (ja) * | 1994-03-31 | 2002-11-05 | オムロン株式会社 | 対象判別装置および方法,ならびに対象判別装置を搭載した車両 |
JPH08271247A (ja) * | 1995-03-30 | 1996-10-18 | Mitsubishi Electric Corp | センサのアライメント誤差推定装置 |
US7460951B2 (en) * | 2005-09-26 | 2008-12-02 | Gm Global Technology Operations, Inc. | System and method of target tracking using sensor fusion |
US7991550B2 (en) * | 2006-02-03 | 2011-08-02 | GM Global Technology Operations LLC | Method and apparatus for on-vehicle calibration and orientation of object-tracking systems |
JP2010249613A (ja) | 2009-04-14 | 2010-11-04 | Toyota Motor Corp | 障害物認識装置及び車両制御装置 |
WO2011024220A1 (ja) * | 2009-08-26 | 2011-03-03 | 三菱電機株式会社 | 駐車支援装置 |
JP5610847B2 (ja) * | 2010-05-26 | 2014-10-22 | 三菱電機株式会社 | 角速度推定装置及びコンピュータプログラム及び角速度推定方法 |
US9357208B2 (en) * | 2011-04-25 | 2016-05-31 | Magna Electronics Inc. | Method and system for dynamically calibrating vehicular cameras |
US8775064B2 (en) * | 2011-05-10 | 2014-07-08 | GM Global Technology Operations LLC | Sensor alignment process and tools for active safety vehicle applications |
US9129211B2 (en) * | 2012-03-15 | 2015-09-08 | GM Global Technology Operations LLC | Bayesian network to track objects using scan points using multiple LiDAR sensors |
KR102001659B1 (ko) * | 2012-11-19 | 2019-07-19 | 한국전자통신연구원 | 차량용 카메라 캘리브레이션 장치 및 방법 |
JP6291781B2 (ja) | 2013-10-17 | 2018-03-14 | 株式会社デンソー | 周辺監視装置及び周辺監視システム |
US9174672B2 (en) * | 2013-10-28 | 2015-11-03 | GM Global Technology Operations LLC | Path planning for evasive steering maneuver in presence of target vehicle and surrounding objects |
US10578713B2 (en) * | 2015-06-24 | 2020-03-03 | Panasonic Corporation | Radar axis displacement amount calculation device and radar axis displacement calculation method |
US10582121B2 (en) * | 2016-01-12 | 2020-03-03 | Mitsubishi Electric Research Laboratories, Inc. | System and method for fusing outputs of sensors having different resolutions |
US10545221B2 (en) * | 2017-05-23 | 2020-01-28 | Veoneer, Inc. | Apparatus and method for detecting alignment of sensor in an automotive detection system |
EP3415943A1 (en) * | 2017-06-13 | 2018-12-19 | Veoneer Sweden AB | Error estimation for a vehicle environment detection system |
US11300958B2 (en) * | 2017-07-13 | 2022-04-12 | Waymo Llc | Sensor adjustment based on vehicle motion |
US10656245B2 (en) * | 2017-09-05 | 2020-05-19 | Valeo Radar Systems, Inc. | Automotive radar sensor blockage detection using adaptive overlapping visibility |
JP6802137B2 (ja) | 2017-11-15 | 2020-12-16 | 株式会社日立インダストリアルプロダクツ | 搬送車システム、搬送車制御システム及び搬送車制御方法 |
US10699135B2 (en) * | 2017-11-20 | 2020-06-30 | Here Global B.V. | Automatic localization geometry generator for stripe-shaped objects |
US20180074506A1 (en) * | 2017-11-21 | 2018-03-15 | GM Global Technology Operations LLC | Systems and methods for mapping roadway-interfering objects in autonomous vehicles |
US10732262B2 (en) * | 2017-12-18 | 2020-08-04 | Veoneer Us, Inc. | Apparatus and method for detecting alignment of sensor in an automotive detection system |
US20200049511A1 (en) * | 2018-08-07 | 2020-02-13 | Ford Global Technologies, Llc | Sensor fusion |
JP6970065B2 (ja) * | 2018-09-06 | 2021-11-24 | 株式会社Soken | 物体検出装置 |
CN109143242B (zh) * | 2018-09-07 | 2020-04-14 | 百度在线网络技术(北京)有限公司 | 障碍物绝对速度估计方法、***、计算机设备和存储介质 |
US11016495B2 (en) * | 2018-11-05 | 2021-05-25 | GM Global Technology Operations LLC | Method and system for end-to-end learning of control commands for autonomous vehicle |
US11482008B2 (en) * | 2019-07-05 | 2022-10-25 | Nvidia Corporation | Directing board repositioning during sensor calibration for autonomous vehicles |
EP3767332B1 (en) * | 2019-07-18 | 2023-12-13 | Aptiv Technologies Limited | Methods and systems for radar object detection |
US20230044311A1 (en) * | 2020-01-10 | 2023-02-09 | Hitachi Astemo, Ltd. | Sensor aiming device, driving control system, and correction amount estimation method |
CN111272165B (zh) * | 2020-02-27 | 2020-10-30 | 清华大学 | 一种基于特征点标定的智能车定位方法 |
US20210331695A1 (en) * | 2020-04-28 | 2021-10-28 | Rahul Ramakrishnan | Object detection and tracking for automated operation of vehicles and machinery |
EP3958016A1 (en) * | 2020-08-20 | 2022-02-23 | Zenuity AB | Stationary object detection |
US11912301B1 (en) * | 2020-12-10 | 2024-02-27 | Zoox, Inc. | Top-down scenario exposure modeling |
-
2020
- 2020-07-14 JP JP2021537649A patent/JP7162142B2/ja active Active
- 2020-07-14 WO PCT/JP2020/027322 patent/WO2021024712A1/ja active Application Filing
- 2020-07-14 DE DE112020003137.3T patent/DE112020003137T5/de active Pending
- 2020-07-14 US US17/629,870 patent/US20220289245A1/en active Pending
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004198159A (ja) | 2002-12-17 | 2004-07-15 | Nissan Motor Co Ltd | 車載センサの軸ずれ計測装置 |
JP2016156725A (ja) | 2015-02-25 | 2016-09-01 | 株式会社デンソー | 搭載角度誤差検出方法および装置、車載レーダ装置 |
JP2017207334A (ja) | 2016-05-17 | 2017-11-24 | 本田技研工業株式会社 | 移動体 |
DE102016009756A1 (de) | 2016-08-10 | 2018-02-15 | Daimler Ag | Verfahren zum Kalibrieren eines Sensorsystems eines Kraftfahrzeugs sowie Sensorsystem |
US20180313942A1 (en) | 2017-04-28 | 2018-11-01 | SZ DJI Technology Co., Ltd. | Calibration of laser sensors |
WO2019097731A1 (ja) | 2017-11-20 | 2019-05-23 | 三菱電機株式会社 | 障害物認識装置および障害物認識方法 |
Also Published As
Publication number | Publication date |
---|---|
WO2021024712A1 (ja) | 2021-02-11 |
US20220289245A1 (en) | 2022-09-15 |
DE112020003137T5 (de) | 2022-04-07 |
JPWO2021024712A1 (ja) | 2021-02-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP7162142B2 (ja) | エイミング装置、運転制御システム、及びセンサデータの補正量の計算方法 | |
US20210311167A1 (en) | Multisensor Data Fusion Method and Apparatus | |
JP6714513B2 (ja) | 車両のナビゲーションモジュールに対象物の存在を知らせる車載装置 | |
WO2018076855A1 (zh) | 车辆行驶窄道辅助*** | |
EP3640622B1 (en) | Method and apparatus for determining coping capability boundary information of an unmanned vehicle and computer program therefore | |
JP6060091B2 (ja) | 車間距離制御システム | |
CN110632617B (zh) | 一种激光雷达点云数据处理的方法及装置 | |
CN105799617A (zh) | 用于确定物体传感器的未对准的方法 | |
RU2757038C2 (ru) | Способ и система для предсказания будущего события в беспилотном автомобиле (sdc) | |
JP7356517B2 (ja) | センサエイミング装置、運転制御システム、及び補正量の推定方法 | |
KR20200070854A (ko) | 근거리 컷-인 차량 판단 장치 및 그의 판단 방법과 그를 이용하는 차량 | |
EP3905105A1 (en) | Method for determining a collision free space | |
EP3467545A1 (en) | Object classification | |
JP7232336B2 (ja) | エイミング装置、運転制御システム、及びセンサデータの補正パラメータの計算方法 | |
US20220410882A1 (en) | Intersection collision mitigation risk assessment model | |
EP2172920B1 (en) | Threat assessment for unexpected events | |
CN113432615A (zh) | 基于多传感器融合可驾驶区域的检测方法、***和车辆 | |
WO2022059314A1 (ja) | 信号処理装置 | |
Milanes et al. | Traffic jam driving with NMV avoidance | |
JP7462738B2 (ja) | 車載クラスタ追跡システム | |
Vanpoperinghe et al. | Model-based detection and tracking of vehicle using a scanning laser rangefinder: A particle filtering approach | |
KR102628027B1 (ko) | 객체 인식 장치 및 그 방법 | |
Liu et al. | A detachable and expansible multisensor data fusion model for perception in level 3 autonomous driving system | |
EP4113165A1 (en) | Methods and systems for radar data processing | |
EP3913392B1 (en) | Method and apparatus for rear cross collision warning |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20211110 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20220719 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20220914 |
|
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: 20221011 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20221017 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 7162142 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |