JP7439434B2 - 車両に搭載されているライダーの傾きの検出装置、および車両に搭載されているライダーの傾きの検出方法 - Google Patents

車両に搭載されているライダーの傾きの検出装置、および車両に搭載されているライダーの傾きの検出方法 Download PDF

Info

Publication number
JP7439434B2
JP7439434B2 JP2019178465A JP2019178465A JP7439434B2 JP 7439434 B2 JP7439434 B2 JP 7439434B2 JP 2019178465 A JP2019178465 A JP 2019178465A JP 2019178465 A JP2019178465 A JP 2019178465A JP 7439434 B2 JP7439434 B2 JP 7439434B2
Authority
JP
Japan
Prior art keywords
vehicle
interest
respect
horizontal direction
distance image
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
JP2019178465A
Other languages
English (en)
Other versions
JP2021056060A (ja
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.)
Denso Corp
Original Assignee
Denso Corp
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 Denso Corp filed Critical Denso Corp
Priority to JP2019178465A priority Critical patent/JP7439434B2/ja
Priority to CN202011048495.7A priority patent/CN112578402A/zh
Priority to US17/038,264 priority patent/US11650321B2/en
Publication of JP2021056060A publication Critical patent/JP2021056060A/ja
Application granted granted Critical
Publication of JP7439434B2 publication Critical patent/JP7439434B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/88—Lidar systems specially adapted for specific applications
    • G01S17/93—Lidar systems specially adapted for specific applications for anti-collision purposes
    • G01S17/931—Lidar systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/88—Lidar systems specially adapted for specific applications
    • G01S17/89—Lidar systems specially adapted for specific applications for mapping or imaging
    • G01S17/894—3D imaging with simultaneous measurement of time-of-flight at a 2D array of receiver pixels, e.g. time-of-flight cameras or flash 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
    • B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units, or advanced driver assistance systems for ensuring comfort, stability and safety or drive control systems for propelling or retarding the vehicle
    • B60W30/08—Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
    • B60W30/095—Predicting travel path or likelihood of collision
    • B60W30/0956—Predicting travel path or likelihood of collision the prediction being responsive to traffic or environmental parameters
    • 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
    • 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/005—Handover processes
    • B60W60/0053—Handover processes from vehicle to occupant
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/02—Systems using the reflection of electromagnetic waves other than radio waves
    • G01S17/06—Systems determining position data of a target
    • G01S17/08—Systems determining position data of a target for measuring distance only
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/86—Combinations of lidar systems with systems other than lidar, radar or sonar, e.g. with direction finders
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/88—Lidar systems specially adapted for specific applications
    • G01S17/89—Lidar systems specially adapted for specific applications for mapping or imaging
    • 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/48—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
    • G01S7/4808—Evaluating distance, position or velocity data
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
    • G01S7/48—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
    • G01S7/497—Means for monitoring or calibrating
    • G01S7/4972—Alignment of sensor
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0214—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06V—IMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
    • G06V10/00—Arrangements for image or video recognition or understanding
    • G06V10/20—Image preprocessing
    • G06V10/24—Aligning, centring, orientation detection or correction of the image
    • G06V10/243—Aligning, centring, orientation detection or correction of the image by compensating for image skew or non-uniform image deformations
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06V—IMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
    • G06V10/00—Arrangements for image or video recognition or understanding
    • G06V10/40—Extraction of image or video features
    • G06V10/44—Local feature extraction by analysis of parts of the pattern, e.g. by detecting edges, contours, loops, corners, strokes or intersections; Connectivity analysis, e.g. of connected components
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06V—IMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
    • G06V20/00—Scenes; Scene-specific elements
    • G06V20/50—Context or environment of the image
    • G06V20/56—Context or environment of the image exterior to a vehicle by using sensors mounted on the vehicle
    • G06V20/58—Recognition of moving objects or obstacles, e.g. vehicles or pedestrians; Recognition of traffic objects, e.g. traffic signs, traffic lights or roads
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06V—IMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
    • G06V20/00—Scenes; Scene-specific elements
    • G06V20/50—Context or environment of the image
    • G06V20/56—Context or environment of the image exterior to a vehicle by using sensors mounted on the vehicle
    • G06V20/58—Recognition of moving objects or obstacles, e.g. vehicles or pedestrians; Recognition of traffic objects, e.g. traffic signs, traffic lights or roads
    • G06V20/582—Recognition of moving objects or obstacles, e.g. vehicles or pedestrians; Recognition of traffic objects, e.g. traffic signs, traffic lights or roads of traffic signs
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06V—IMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
    • G06V20/00—Scenes; Scene-specific elements
    • G06V20/60—Type of objects
    • G06V20/64—Three-dimensional objects
    • B60W2420/408—
    • 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
    • B60W2554/00—Input parameters relating to objects
    • B60W2554/20—Static objects

Description

本開示は、車両に搭載されているライダーの傾きを検出する技術に関する。
車両に搭載されているカメラや、レーザーレーダ、ライダー（ＬｉＤＡＲ）等の検出結果を利用して、車両を自動走行させる技術が知られている（例えば、特許文献１）。
米国特許第９５３７９５６号明細書
しかしながら、ライダーを車両に固定するブラケットの経年劣化や、車両が障害物と衝突した際の衝撃等によって、ライダーが傾いてしまうことがある。この結果、車両の周囲の物標を精度よく認識できないという問題が生じ得る。このため、車両に搭載されているライダーの傾きを検出する技術が望まれている。
本開示は、以下の形態として実現することが可能である。
本開示の一実施形態によれば、車両（１００）に搭載されているライダー（４３）について、前記ライダーが前記車両に正しく取り付けられた場合における位置と、前記ライダーが前記車両に現在取り付けられている位置と、がなす角度のうち、前記車両の車両幅方向に平行な方向である前記車両の水平方向に対する角度が表す前記ライダーの傾きを検出する検出装置（１０）が提供される。この検出装置は、前記ライダーにより検出される検出点群により表される距離画像を取得する距離画像取得部（２２）と、前記車両の走行経路（Ｌｎ）の周辺の周囲情報（ＳＩ）を取得する周囲情報取得部（２３）と、前記走行経路の周辺に存在する物体から決定された注目対象物について、取得された前記周囲情報を用いて検出された前記周囲情報における前記注目対象物の前記水平方向に対する角度と、前記注目対象物について、取得された前記距離画像を用いて検出された前記距離画像における前記注目対象物の前記水平方向に対する角度と、過去に検出された、前記周囲情報における複数の異なる注目対象物の前記水平方向に対する角度と、過去に検出された、前記距離画像における前記複数の異なる注目対象物の前記水平方向に対する角度と、を用いて、前記傾きを決定する検出部（２１）と、を備える。
この形態の検出装置によれば、ライダーにより検出される検出点群により表される距離画像を取得し、車両の走行経路の周辺の周囲情報を取得し、取得された距離画像と、取得された周囲情報とを用いて、ライダーの傾きを決定するので、ライダーの傾きを容易に検出できる。
本開示は、種々の形態で実現することも可能である。例えば、傾き検出装置、傾き検出方法、これらの装置や方法を実現するためのコンピュータプログラム、かかるコンピュータプログラムを記憶した記憶媒体等の形態で実現することができる。
本開示の一実施形態としての傾き検出装置が搭載された車両の一例を示す説明図。 車両および傾き検出装置の概略構成を示すブロック図。 周囲情報の一例を示す説明図。 ライダーの傾きを説明するための説明図。 傾き検出処理の処理手順を示すフローチャート。
Ａ．実施形態：
Ａ１．装置構成：
図１および図２に示すように、車両１００は、計測装置ユニット４０と、傾き検出装置１０と、運転支援制御装置８０とを備える。車両１００は、自動運転と手動運転との切り替えを実行可能な車両である。車両１００の運転者は、インストルメントパネル等に用意された所定のスイッチにより自動運転と手動運転とを切り替えることができる。「自動運転」とは、運転者が運転操作を行うことなく、計測装置ユニット４０によって取得される車室内および車室外の状況に基づいて、車両１００の運転を行うためのアクチュエータ群を含む後述の運転装置６０を駆動することによって、エンジン制御とブレーキ制御と操舵制御とのすべてを運転者に代わって自動で実行する運転を意味する。「手動運転」とは、エンジン制御のための操作（アクセルペダルの踏込）と、ブレーキ制御のための操作（ブレーキベダルの踏込）と、操舵制御のための操作（ステアリングホイールの回転）を、運転者が実行する運転を意味する。
計測装置ユニット４０は、車両１００の屋根に搭載され、固定機構９２およびフレーム９３により車両１００に固定されている。なお、図１では、車両幅方向ＬＨ、車両前方方向ＦＤ、車両後方方向ＲＤおよび鉛直下方Ｇを図示している。図１における各方向を示す符号および矢印は、他の図における各方向を示す符号および矢印に対応する。
計測装置ユニット４０は、車両１００の走行状態に関する情報や、車両１００の周囲の対象物に関する情報等を取得する。図２に示すように、計測装置ユニット４０は、少なくとも、撮像装置４１、ライダー４３、位置センサ４５および６軸センサ４７を備える。
撮像装置４１は、車両１００の周囲に向けられており、車両１００の少なくとも進行方向を撮影する。撮像装置４１は、例えば、広角カメラ、望遠カメラ等のＣＣＤ等の撮像素子または撮像素子アレイを備える撮像装置であり、可視光を受光することによって対象物の外形情報または形状情報を検出結果である画像データとして出力する。
ライダー（ＬｉＤＡＲ：Light Detection And Ranging）４３は、車両１００の進行方向に向けられており、赤外レーザ光を射出し、物標によって反射された反射光を受信することによって、車両１００に対する物標の距離および角度を検出して、物標を検出点群として取得する。検出点とは、ライダー４３が検出可能な範囲において、反射光によって特定される物標の少なくとも一部が存在し得る位置を示す点を意味する。また、検出点群とは、所定期間における検出点の集合を意味し、検出点の３次元座標により距離画像として表される。なお、検出点とは、光の飛行時間ＴＯＦ（Time of Flight）により検出される測距点と、ライダー４３が備える受光素子に入力される輝度値により表される検出点との両方を含む意味である。本実施形態において、ライダー４３の分解能（解像度）は、水平方向、垂直方向のいずれにおいても０．１度から０．２度の範囲の値である。
位置センサ４５は、車両１００の自己位置を検出する。自己位置は、車両１００の緯度及び経度で表される。位置センサ４５として、例えば、全地球航法衛星システム（ＧＮＳＳ）やジャイロセンサ等が挙げられる。なお、自己位置は、車両１００の高度を含んでもよい。
６軸センサ４７は、車両１００の向き（進行方向）、および車両１００の姿勢を検出する。６軸センサ４７としては、例えば、３軸加速度センサと３軸ジャイロセンサとを備えるモーションセンサ等が挙げられる。
図１に示すように、傾き検出装置１０および運転支援制御装置８０は、車両１００の内部に搭載されている。傾き検出装置１０および運転支援制御装置８０は、配線ＣＶによって計測装置ユニット４０と接続されている。
傾き検出装置１０は、車両１００の垂直方向におけるライダー４３の傾きを検出する。図２に示すように、傾き検出装置１０は、ＣＰＵ２０と、メモリ３０と、入出力インターフェース１１とを搭載した１つ又は複数のＥＣＵ（Electronic Control Unit）として構成されている。ＣＰＵ２０、メモリ３０および入出力インターフェース１１は、バス１５を介して双方向に通信可能に接続されている。ＣＰＵ２０は、メモリ３０に記憶されたプログラムを展開して実行することにより、検出部２１、距離画像取得部２２、周囲情報取得部２３および補正部２４として機能する。
検出部２１は、後述の傾き検出処理において、ライダー４３により生成される距離画像と、車両１００の走行経路の周囲の情報（以下、「周囲情報」と呼ぶ）とを照合することにより、車両１００の垂直方向におけるライダー４３の傾きを検出する。本実施形態において、「周囲情報」とは、車両１００の走行経路の勾配を示す情報や、走行経路の周辺に設けられた道路設備や建物等の地物の位置や形状を示す情報を意味する。周囲情報は、例えば、地図情報や、撮像装置４１による撮像画像等の座標情報を含む情報である。また、上述の道路設備は、例えば、ガードレール、交通標識、渋滞情報や案内情報を表示する道路情報表示板、歩道橋が該当する。また、道路設備には、区画線、停止線、横断歩道等の路面標示も含まれる。
図３に例示する周囲情報ＳＩは、車両１００の走行経路Ｌｎの周辺の地図情報である。周囲情報ＳＩには、車両１００の進行方向である車両前方方向ＦＤに存在する、ガードレールＯｂ１、交通標識Ｏｂ３およびＯｂ４、道路照明装置Ｏｂ５、停止線Ｏｂ２、および建物Ｏｂ６等の位置（座標）や形状を示す情報が含まれている。図３において、Ｘ軸およびＹ軸は車両水平方向と平行に、Ｚ軸は鉛直方向と平行に、それぞれ設定されている。Ｘ軸は、車両１００の進行方向と平行であり、＋Ｘ方向は車両前方方向ＦＤであり、－Ｘ方向は車両後方方向ＲＤである。Ｙ軸は、車両１００の幅方向と平行であり、＋Ｙ方向は車両幅方向ＬＨである。
検出部２１は、周囲情報ＳＩおよび距離画像から特定の物体をそれぞれ抽出し、抽出された両物体の水平方向の線分間の角度を求めることによりライダー４３の仰俯角を算出して、ライダー４３の傾きとして決定する。なお、ライダー４３の傾き、およびライダー４３の傾きの検出方法についての詳細な説明は、後述する。
距離画像取得部２２は、ライダー４３により生成される距離画像を取得する。
周囲情報取得部２３は、通信装置６５を介して交通管理システム等から、周囲情報ＳＩを取得する。なお、周囲情報取得部２３は、交通管理システムに代えて、ナビゲーション装置７０から地図データを取得してもよいし、撮像装置４１から車両１００の進行方向の撮像画像を取得してもよい。
補正部２４は、検出部２１により決定されたライダー４３の傾きを用いて、ライダー４３の検出結果を補正する。具体的には、補正部２４は、メモリ３０に格納されているオフセット補正値３１を、決定された傾きの値で更新する。これにより、運転支援制御装置８０がライダー４３により検出される検出点群を用いて車両１００の周囲の物標を認識する際に、オフセット補正値３１を参照することにより、検出点群の垂直方向の位置が補正される。
運転支援制御装置８０は、図示しないＣＰＵと、メモリと、インターフェースとを搭載した１つ又は複数のＥＣＵとして構成されている。運転支援制御装置８０は、車両１００に搭載された後述の運転装置６０を制御することにより、車両１００の制動支援、操舵支援、駆動支援といった運転支援を実行する。
車両１００には、上述の計測装置ユニット４０および運転支援制御装置８０に加えて、報知装置５０と、運転装置６０と、通信装置６５と、ナビゲーション装置７０とが搭載されている。
報知装置５０は、視覚情報や聴覚情報によって車両１００の乗員に向けて種々の情報を報知する。報知装置５０は、車両１００の車室内に向けられた表示装置５１およびスピーカ５３を備える。表示装置５１は、文字や画像等を表示する。スピーカ５３は、音声や警告音等を出力する。
運転装置６０は、いずれも図示しない駆動装置と、操舵装置と、ブレーキ装置とを備える。駆動装置は、内燃機関及びモータの少なくともいずれか１つを含み、走行用の駆動力を発生する。操舵装置は、電動ステアリング機構等を含み、車両１００の操舵を実現する。ブレーキ装置は、ディスクブレーキ等を含み、車両１００の制動を実現する。
通信装置６５は、車両１００と車両１００の外部との間で無線通信を行って、例えば、周囲情報ＳＩ等のデータのやりとりを行う。車両１００の外部としては、交通管理システム、例えば、高度道路交通システム（Intelligent Transport System）や、路側無線機、車両１００の周囲を走行する他車両等が該当する。
ナビゲーション装置７０は、電子地図データを用いて、経路探索や経路誘導を行う。電子地図データは、道路ネットワークデータや道路データ等を含む。
Ａ２．傾き検出処理：
傾き検出処理の説明に先立って、図４を用いてライダー４３の傾きについて説明する。実線に示すように、ライダー４３は、略直方体形状を有し、固定具４３２により車両１００に締結される。ライダー４３の筐体４３１の内部には、赤外レーザ光の発光部や、物標によって反射された反射光の受光部等が収容されている。ライダー４３は、筐体４３１の底面の下辺Ｔ１が車両１００の水平方向と平行となるように車両１００に取り付けられている。実線に示す搭載状態は、本来の正しい姿勢である。
破線に示すライダー４３ａは、ライダー４３が車両１００の垂直方向に傾いた状態を示している。具体的には、ライダー４３ａは、ライダー４３が車両１００の上方に角度θだけ傾いている。ライダー４３ａの筐体の底面の下辺Ｔ１ａは、車両１００の水平方向から鉛直上方に角度θだけずれて、水平方向と交差している。したがって、角度θを検出することによって、ライダー４３の傾きを決定することができる。本実施形態の傾き検出処理では、周囲情報ＳＩおよび距離画像を用いて、ライダー４３の水平方向に対する角度のずれを検出する。すなわち、周囲情報ＳＩおよび距離画像から車両１００の走行経路Ｌｎの周辺に存在する物体をそれぞれ抽出し、周囲情報ＳＩから抽出された物体の水平方向の辺を基準としたときの距離画像から抽出された物体の水平方向の辺のずれ角度を検出することにより、ライダー４３の傾きを決定する。上述のように、本実施形態のライダー４３は、垂直方向の分解能が０．１度から０．２度の範囲の値であるので、物体の水平方向の辺を精度よく検出できる。
図５に示す傾き検出処理は、車両１００の走行中、所定のインターバルで繰り返し実行される。所定のインターバルは、数秒から十数秒としてもよい。傾き検出処理は、車両１００全体を制御する上位のＥＣＵからイグニッションスイッチがオフからオンに切り替わったことを示す信号が傾き検出装置１０に入力されると、開始される。
検出部２１は、位置センサ４５の検出結果から車両１００の現在位置を取得する（ステップＳ１０）。検出部２１は、６軸センサ４７の検出結果から車両１００の進行方向を取得する（ステップＳ１５）。周囲情報取得部２３は、周囲情報ＳＩを取得する（ステップＳ２０）。
このとき、周囲情報取得部２３は、周囲情報ＳＩの向きを車両１００の進行方向と一致させた周囲情報ＳＩを取得する。距離画像取得部２２は、ライダー４３の検出結果から距離画像を取得する（ステップＳ２５）。
検出部２１は、注目対象物を決定する（ステップＳ３０）。本実施形態において「注目対象物」とは、車両１００の走行経路Ｌｎの周辺に存在する物体のうち、車両１００に最も近い位置に存在する物体を意味する。検出部２１は、周囲情報ＳＩを参照して、車両１００の周囲に存在する物体、例えば、道路設備のうち、車両１００に最も近い位置に存在する道路設備を注目対象物として特定する。図３に例示する周囲情報ＳＩにおいては、ガードレールＯｂ１が注目対象物として特定され得る。なお、検出部２１は、特定した注目対象物を距離画像において検出できない場合には、車両１００に次に近い位置に存在する道路設備（図３に示す例では、停止線Ｏｂ２や、交通標識Ｏｂ３）を注目対象物として特定してもよい。
検出部２１は、周囲情報ＳＩおよび距離画像における車両１００の垂直方向における注目対象物の角度をそれぞれ検出する（ステップＳ３５）。具体的には、検出部２１は、周囲情報ＳＩから注目対象物を検出して、注目対象物における車両１００の水平方向と平行な辺を特定し、かかる辺と車両１００の水平方向とのなす角度を求める。より具体的には、まず、検出部２１は、注目対象物を構成する検出点（例えば、代表点）のＸ座標、Ｙ座標およびＺ座標を複数検出し、最小二乗法等を用いて、注目対象物における水平方向と平行な線分、あるいは、近似する線分を求める。次に、検出部２１は、車両１００の水平方向を基準とし、かかる基準に対する線分の角度を求める。なお、注目対象物における車両１００の水平方向と平行な辺は、注目対象物を構成する検出点のうち、端点に該当する検出点同士を結ぶ線分でもよいし、注目対象物を構成する検出点のうち、中間点に該当する検出点と端点に該当する検出点とを結ぶ線分でもよい。また、最小二乗法に代えて、エッジ抽出処理によって求めてもよい。
検出部２１は、同様の手順により、距離画像における注目対象物の角度を検出する。具体的には、距離画像から注目対象物と想定される物体を検出し、検出された注目対象物における車両１００の水平方向と平行な辺を特定し、かかる辺と車両１００の水平方向とのなす角度を求める。
検出部２１は、ライダー４３の傾きを決定する（ステップＳ４０）。具体的には、検出部２１は、上述のステップＳ３５において検出された、周囲情報ＳＩにおける注目対象物の角度と距離画像における注目対象物の角度との差分を検出し、検出された差分をライダー４３の傾きとして決定する。
検出部２１は、決定された傾きが第１閾値範囲に含まれるか否かを判定する（ステップＳ４５）。本実施形態において、「第１閾値範囲」とは、車両１００の水平方向を０度としたとき、車両１００の垂直方向における角度が－５度から＋５度の範囲を意味する。決定された傾きが第１閾値範囲に含まれると判定された場合（ステップＳ４５：ＹＥＳ）、補正部２４は、測距点群の位置を補正する（ステップＳ５０）。具体的には、補正部２４は、メモリ３０に記憶されているオフセット補正値３１を更新する。
上述のステップＳ４５において決定された傾きが第１閾値範囲を超えると判定した場合（ステップＳ４５：ＮＯ）、検出部２１は、報知装置５０を用いて、車両１００の乗員に報知する（ステップＳ５５）。例えば、「自動車ディーラーにおいてライダー４３の点検をしてください。」という報知表示や、音声案内を行わせる。
検出部２１は、決定された傾きが第２閾値範囲に含まれるか否かを判定する（ステップＳ６０）。本実施形態において、「第２閾値範囲」とは、第１閾値範囲よりも車両１００の垂直方向の角度が大きな範囲であり、車両１００の垂直方向における角度が－３０度から＋３０度の範囲、好ましくは、－２５度から＋２５度の範囲を意味する。決定された傾きが第２閾値範囲に含まれないと判定した場合（ステップＳ６０：ＮＯ）、検出部２１は、車両１００の自動運転を停止させる（ステップＳ６５）。具体的には、検出部２１は、運転支援制御装置８０による車両１００の自動運転の実行を停止させる。また、検出部２１は、報知装置５０を用いて、車両１００の運転者に手動運転を行うように促す旨の報知や、車両１００の点検を促す旨の報知を行わせる。
上述のステップＳ６０において決定された傾きが第２閾値範囲に含まれると判定した場合（ステップＳ６０：ＹＥＳ）、または、上述のステップＳ６５の実行後、傾き検出処理は終了する。
以上の構成を有する本実施形態の傾き検出装置１０によれば、ライダー４３により検出される検出点群により表される距離画像を取得し、車両１００の走行経路Ｌｎの周辺の周囲情報ＳＩを取得し、取得された距離画像と取得された周囲情報とを用いてライダー４３の傾きを決定するので、ライダー４３の傾きを容易に検出できる。具体的には、検出部２１は、走行経路Ｌｎの周辺に存在する道路設備から注目対象物を決定し、周囲情報ＳＩにおける車両１００の垂直方向における注目対象物の角度と、距離画像における車両１００の垂直方向における注目対象物の角度との差分を検出することにより、ライダー４３の傾きを決定するので、複雑な処理を要することなく、ライダー４３の傾きを決定できる。また、注目対象物はガードレールＯｂ１であるので、注目対象物を容易に特定できる。
補正部２４は、決定された傾きを用いて検出点群の垂直方向の位置を補正するので、ライダー４３が車両１００への搭載時の姿勢から車両１００の垂直方向に傾いてしまった場合であっても、ライダー４３により検出される検出点群の位置を本来検出され得るべき位置にすることができる。したがって、車両１００の周囲の物標を精度よく認識できないという問題の発生を抑制できる。また、検出部２１は、決定された傾きが第１閾値範囲を超える場合、報知装置５０を用いて車両１００の乗員に報知するので、ライダー４３が本来の正しい姿勢から傾いているために車両１００の点検が必要であることを、車両１００の乗員に知らしめることができる。また、検出部２１は、決定された傾きが第２閾値範囲を超える場合、車両１００の自動運転を停止させるので、ライダー４３の検出結果を車両１００の運転支援に用いられないようにすることができる。このため、車両１００における運転支援において不具合が生じることを抑制できる。
Ｂ．他の実施形態：
（１）上記実施形態において、検出部２１は、建物の水平方向のエッジを比較することにより、ライダー４３の傾きを決定してもよい。具体的には、上述のステップＳ３０において、検出部２１は、車両１００に最も近い位置に存在する建物Ｏｂ６を注目対象物として特定する。次に、上述のステップＳ３５において、検出部２１は、周囲情報ＳＩから注目対象物を検出し、例えば、輝度値に基づいて、注目対象物の水平方向のエッジを抽出する。また、距離画像においても同様に、注目対象物の水平方向のエッジを抽出する。その後、検出部２１は、周囲情報ＳＩにおいて抽出したエッジと、距離画像において抽出したエッジとを比較して、エッジのずれ角度を検出することにより、ライダー４３の傾きを決定してもよい。このような構成によれば、ライダー４３の傾きをより精度よく決定できる。
（２）上記各実施形態において、注目対象物は、ガードレールや、建物に限られず、走行経路Ｌｎ上の区画線、横断歩道、停止線等の路面標示や、交通標識、信号機、歩道橋、道路情報表示板等の道路設備といった車両１００の走行経路Ｌｎおよびその周辺に存在する任意の物体であってもよい。
（３）上記各実施形態において、検出部２１は、距離画像および周囲情報ＳＩにおける注目対象物の角度の過去の検出値を用いて、ライダー４３の傾きを決定してもよい。具体的には、検出部２１は、上述のステップＳ３５において検出した注目対象物の角度をメモリ３０に記憶しておき、例えば、１０個の互いに異なる注目対象物で検出された角度の平均値を用いてライダー４３の傾きを決定してもよい。このとき、所定の基準値からかけ離れている検出値がある場合には、その検出値を除外してもよい。このようにすることで、例えば、工事等で道路設備が一時的に撤去されるなどして、距離画像と周囲情報ＳＩとで検出され得る物体に相違がある場合であっても、ライダー４３の傾きを精度よく決定できる。
（４）上記各実施形態において、ライダー４３の傾きは、車両１００の垂直方向における注目対象物の角度を用いて決定されていたが、車両１００の垂直方向に限らず、車両進行方向における注目対象物の角度を用いてもよい。また、傾き検出装置１０のＣＰＵ２０は、補正部２４を省略してもよく、この場合、検出点群の位置の補正（上述のステップＳ５０）を省略してもよい。また、決定された傾きが第１閾値範囲を超える場合に車両１００の乗員に報知しなくてもよい。また、決定された傾きが第２閾値範囲を超える場合に車両１００の自動運転を停止させなくてもよい。
本開示に記載の制御部等の各部及びその手法は、コンピュータプログラムにより具体化された一つ乃至は複数の機能を実行するようにプログラムされたプロセッサ及びメモリを構成することによって提供された専用コンピュータにより、実現されてもよい。あるいは、本開示に記載の制御部等の各部及びその手法は、一つ以上の専用ハードウエア論理回路によってプロセッサを構成することによって提供された専用コンピュータにより、実現されてもよい。もしくは、本開示に記載の制御部及びその手法は、一つ乃至は複数の機能を実行するようにプログラムされたプロセッサ及びメモリと一つ以上のハードウエア論理回路によって構成されたプロセッサとの組合せにより構成された一つ以上の専用コンピュータにより、実現されてもよい。また、コンピュータプログラムは、コンピュータにより実行されるインストラクションとして、コンピュータ読み取り可能な非遷移有形記録媒体に記憶されていてもよい。
本開示は、上述の実施形態に限られるものではなく、その趣旨を逸脱しない範囲において種々の構成で実現することができる。例えば、発明の概要の欄に記載した各形態中の技術的特徴に対応する実施形態中の技術的特徴は、上述の課題の一部又は全部を解決するために、あるいは、上述の効果の一部又は全部を達成するために、適宜、差し替えや、組み合わせを行うことが可能である。また、その技術的特徴が本明細書中に必須なものとして説明されていなければ、適宜、削除することが可能である。
１０…検出装置、２１…検出部、２２…距離画像取得部、２３…周囲情報取得部、４３…ライダー、１００…車両、Ｌｎ…走行経路、ＳＩ…周囲情報

Claims (6)

  1. 車両（１００）に搭載されているライダー（４３）について、前記ライダーが前記車両に正しく取り付けられた場合における位置と、前記ライダーが前記車両に現在取り付けられている位置と、がなす角度のうち、前記車両の車両幅方向に平行な方向である前記車両の水平方向に対する角度が表す前記ライダーの傾きを検出する検出装置（１０）であって、
    前記ライダーにより検出される検出点群により表される距離画像を取得する距離画像取得部（２２）と、
    前記車両の走行経路（Ｌｎ）の周辺の周囲情報（ＳＩ）を取得する周囲情報取得部（２３）と、
    前記走行経路の周辺に存在する物体から決定された注目対象物について、取得された前記周囲情報を用いて検出された前記周囲情報における前記注目対象物の前記水平方向に対する角度と、
    前記注目対象物について、取得された前記距離画像を用いて検出された前記距離画像における前記注目対象物の前記水平方向に対する角度と、
    過去に検出された、前記周囲情報における複数の異なる注目対象物の前記水平方向に対する角度と、
    過去に検出された、前記距離画像における前記複数の異なる注目対象物の前記水平方向に対する角度と、
    を用いて、前記傾きを決定する検出部（２１）と、
    を備える、
    検出装置。
  2. 請求項１に記載の検出装置であって、
    前記検出部は、
    前記周囲情報における前記注目対象物の前記水平方向に対する角度と、前記距離画像における前記注目対象物の前記水平方向に対する角度との差分を検出し、
    検出した前記差分と、前記複数の異なる注目対象物についての前記差分とを用いて、前記傾きを決定する、
    検出装置。
  3. 請求項２に記載の検出装置であって、
    前記注目対象物は、ガードレール（Ｏｂ１）と、歩道橋と、道路情報表示板と、交通標識（Ｏｂ３、Ｏｂ４）とを含む、
    検出装置。
  4. 請求項１から請求項３までのいずれか一項に記載の検出装置であって、
    前記検出部は、決定された前記傾きが予め定められた第１閾値範囲を超える場合、前記車両に搭載された報知装置（５０）を用いて前記車両の乗員に報知する、
    検出装置。
  5. 請求項４に記載の検出装置であって、
    前記検出部は、決定された前記傾きが前記第１閾値範囲より大きな第２閾値範囲を超える場合、前記車両に対して前記車両の自動運転を停止させる、
    検出装置。
  6. 車両に搭載されているライダーについて、前記ライダーが前記車両に正しく取り付けられた場合における位置と、前記ライダーが前記車両に現在取り付けられている位置と、がなす角度のうち、前記車両の車両幅方向に平行な方向である前記車両の水平方向に対する角度が表す前記ライダーの傾きを検出する検出方法であって、
    前記ライダーにより検出される検出点群により表される距離画像を取得し、
    前記車両の走行経路の周辺の周囲情報を取得し、
    前記走行経路の周辺に存在する物体から決定された注目対象物について、取得された前記周囲情報を用いて検出された前記周囲情報における前記注目対象物の前記水平方向に対する角度と、
    前記注目対象物について、取得された前記距離画像を用いて検出された前記距離画像における前記注目対象物の前記水平方向に対する角度と、
    過去に検出された、前記周囲情報における複数の異なる注目対象物の前記水平方向に対する角度と、
    過去に検出された、前記距離画像における複数の異なる注目対象物の前記水平方向に対する角度と、
    を用いて前記傾きを決定する、
    検出方法。
JP2019178465A 2019-09-30 2019-09-30 車両に搭載されているライダーの傾きの検出装置、および車両に搭載されているライダーの傾きの検出方法 Active JP7439434B2 (ja)

Priority Applications (3)

Application Number Priority Date Filing Date Title
JP2019178465A JP7439434B2 (ja) 2019-09-30 2019-09-30 車両に搭載されているライダーの傾きの検出装置、および車両に搭載されているライダーの傾きの検出方法
CN202011048495.7A CN112578402A (zh) 2019-09-30 2020-09-29 检测安装至车辆的光探测和测距装置的倾斜的装置和方法
US17/038,264 US11650321B2 (en) 2019-09-30 2020-09-30 Apparatus and method for detecting tilt of LiDAR apparatus mounted to vehicle

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2019178465A JP7439434B2 (ja) 2019-09-30 2019-09-30 車両に搭載されているライダーの傾きの検出装置、および車両に搭載されているライダーの傾きの検出方法

Publications (2)

Publication Number Publication Date
JP2021056060A JP2021056060A (ja) 2021-04-08
JP7439434B2 true JP7439434B2 (ja) 2024-02-28

Family

ID=75119730

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2019178465A Active JP7439434B2 (ja) 2019-09-30 2019-09-30 車両に搭載されているライダーの傾きの検出装置、および車両に搭載されているライダーの傾きの検出方法

Country Status (3)

Country Link
US (1) US11650321B2 (ja)
JP (1) JP7439434B2 (ja)
CN (1) CN112578402A (ja)

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2022164053A (ja) * 2021-04-15 2022-10-27 株式会社デンソー センシング制御装置、センシング制御方法、センシング制御プログラム
JP2023048634A (ja) * 2021-09-28 2023-04-07 株式会社デンソー 傾き検出装置、傾き検出システム、傾き検出方法、及び傾き検出プログラム
CN114323271B (zh) * 2021-12-29 2024-04-12 广汽丰田汽车有限公司 车辆前照灯路面照度测量方法、装置、测量设备及介质

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2019082700A1 (ja) 2017-10-26 2019-05-02 パイオニア株式会社 制御装置、制御方法、プログラム及び記憶媒体
WO2019172117A1 (ja) 2018-03-05 2019-09-12 株式会社小糸製作所 センサシステム、および画像データ生成装置

Family Cites Families (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP4241651B2 (ja) 2005-03-16 2009-03-18 パナソニック電工株式会社 移動装置
US9537956B1 (en) 2015-12-11 2017-01-03 Uber Technologies, Inc. System for acquiring time-synchronized sensor data
JP6834914B2 (ja) 2017-11-07 2021-02-24 トヨタ自動車株式会社 物体認識装置
JP7119724B2 (ja) * 2018-08-01 2022-08-17 トヨタ自動車株式会社 軸ずれ検出装置及び車両
US10915766B2 (en) * 2019-06-28 2021-02-09 Baidu Usa Llc Method for detecting closest in-path object (CIPO) for autonomous driving
US11352010B2 (en) * 2019-09-30 2022-06-07 Baidu Usa Llc Obstacle perception calibration system for autonomous driving vehicles

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2019082700A1 (ja) 2017-10-26 2019-05-02 パイオニア株式会社 制御装置、制御方法、プログラム及び記憶媒体
WO2019172117A1 (ja) 2018-03-05 2019-09-12 株式会社小糸製作所 センサシステム、および画像データ生成装置

Also Published As

Publication number Publication date
CN112578402A (zh) 2021-03-30
US20210097324A1 (en) 2021-04-01
JP2021056060A (ja) 2021-04-08
US11650321B2 (en) 2023-05-16

Similar Documents

Publication Publication Date Title
KR102610743B1 (ko) 차량의 차로 변경 제어 장치, 그를 포함한 시스템 및 그 방법
JP7439434B2 (ja) 車両に搭載されているライダーの傾きの検出装置、および車両に搭載されているライダーの傾きの検出方法
JP7052786B2 (ja) 表示制御装置および表示制御プログラム
JP2019219986A (ja) 自動運転支援システム
KR102001659B1 (ko) 차량용 카메라 캘리브레이션 장치 및 방법
WO2015087502A1 (ja) 自車位置検出装置
JP7047824B2 (ja) 車両制御装置
JP2007309757A (ja) 対象物認識装置
JP2005170154A (ja) 車両運転支援装置
US20210269063A1 (en) Electronic device for vehicles and operating method of electronic device for vehicle
JP6103265B2 (ja) 車両用歩行者画像取得装置
JP6129268B2 (ja) 車両用運転支援システムおよび運転支援方法
US11928871B2 (en) Vehicle position estimation device and traveling position estimation method
JP7251582B2 (ja) 表示制御装置および表示制御プログラム
WO2020145053A1 (ja) 走行車線推定装置、走行車線推定方法、制御プログラム、およびコンピュータ読み出し可能持続的記録媒体
KR101281499B1 (ko) 자동차 자동 운행 시스템
CN114348015A (zh) 车辆控制装置和车辆控制方法
JP2006344133A (ja) 道路区画線検出装置
JP4375549B2 (ja) 車両位置特定装置
JP6627135B2 (ja) 車両位置判定装置
KR20170082374A (ko) 차선 인식장치
JP7435513B2 (ja) 車両制御装置及び車両制御方法
US20230303065A1 (en) Driving Assistance Method and Driving Assistance Device
CN114572243A (zh) 物标检测装置以及搭载有该物标检测装置的车辆
JP7416114B2 (ja) 表示制御装置および表示制御プログラム

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20220714

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20230425

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20230509

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20230707

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20231003

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20231115

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20240129

R151 Written notification of patent or utility model registration

Ref document number: 7439434

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R151