JP6521082B2 - 走行制御方法および走行制御装置 - Google Patents
走行制御方法および走行制御装置 Download PDFInfo
- Publication number
- JP6521082B2 JP6521082B2 JP2017542606A JP2017542606A JP6521082B2 JP 6521082 B2 JP6521082 B2 JP 6521082B2 JP 2017542606 A JP2017542606 A JP 2017542606A JP 2017542606 A JP2017542606 A JP 2017542606A JP 6521082 B2 JP6521082 B2 JP 6521082B2
- Authority
- JP
- Japan
- Prior art keywords
- lane
- vehicle
- surrounding
- control method
- boundary
- 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
Images
Classifications
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/16—Anti-collision systems
- G08G1/166—Anti-collision systems for active traffic, e.g. moving vehicles, pedestrians, bikes
-
- 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
- B60W10/00—Conjoint control of vehicle sub-units of different type or different function
- B60W10/04—Conjoint control of vehicle sub-units of different type or different function including control of propulsion units
-
- 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
- B60W10/00—Conjoint control of vehicle sub-units of different type or different function
- B60W10/18—Conjoint control of vehicle sub-units of different type or different function including control of braking 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
- B60W10/00—Conjoint control of vehicle sub-units of different type or different function
- B60W10/20—Conjoint control of vehicle sub-units of different type or different function including control of steering systems
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- 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/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0246—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/01—Detecting movement of traffic to be counted or controlled
- G08G1/056—Detecting movement of traffic to be counted or controlled with provision for distinguishing direction of travel
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/09—Arrangements for giving variable traffic instructions
- G08G1/0962—Arrangements for giving variable traffic instructions having an indicator mounted inside the vehicle, e.g. giving voice messages
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/16—Anti-collision systems
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/16—Anti-collision systems
- G08G1/161—Decentralised systems, e.g. inter-vehicle communication
- G08G1/163—Decentralised systems, e.g. inter-vehicle communication involving continuous checking
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/16—Anti-collision systems
- G08G1/167—Driving aids for lane monitoring, lane changing, e.g. blind spot detection
-
- 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
-
- 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/53—Road markings, e.g. lane marker or crosswalk
-
- 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/80—Spatial relation or speed relative to objects
-
- 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
- B60W2710/00—Output or target parameters relating to a particular sub-units
- B60W2710/18—Braking system
-
- 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
- B60W2710/00—Output or target parameters relating to a particular sub-units
- B60W2710/20—Steering 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
- B60W2720/00—Output or target parameters relating to overall vehicle dynamics
- B60W2720/10—Longitudinal speed
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Multimedia (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Electromagnetism (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Traffic Control Systems (AREA)
- Navigation (AREA)
- Image Analysis (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Description
本発明は、車両の走行を制御する走行制御方法および走行制御装置に関する。
従来、地図情報に含まれる車線の数と、他車両から受信した他車両の位置とに基づいて、他車両が、自車両が走行する車線(自車線)に隣接する車線(隣接車線)を走行しているか否かを判断する技術がある(たとえば、特許文献1)。
しかしながら、他車両が備えるセンサによっては、他車両の位置を高い精度で検出することができず、他車両が隣接車線を走行していないと判断した場合でも、実際には、他車両が隣接車線を走行している場合があった。
本発明が解決しようとする課題は、自車両の周囲に存在する移動体の位置を適切に予測可能な走行制御方法を提供することである。
本発明は、自車両が転回している場合に、移動体が走行する道路における車線の進行方向に基づいて、移動体の位置を予測することで、上記課題を解決する。
本発明によれば、自車両の周囲に存在する移動体の位置を適切に予測することができる。
以下、本発明の実施形態を図面に基づいて説明する。なお、本実施形態では、車両に搭載される走行制御装置を例示して説明する。
≪第1実施形態≫
図1は、本実施形態に係る走行制御装置100の構成を示す図である。図1に示すように、本実施形態に係る走行制御装置100は、周囲検知センサ110と、自車位置検出装置120と、地図データベース130と、提示装置140と、駆動制御装置150と、制御装置160とを有している。これら装置は、相互に情報の授受を行うためにCAN(Controller Area Network)その他の車載LANによって接続されている。
図1は、本実施形態に係る走行制御装置100の構成を示す図である。図1に示すように、本実施形態に係る走行制御装置100は、周囲検知センサ110と、自車位置検出装置120と、地図データベース130と、提示装置140と、駆動制御装置150と、制御装置160とを有している。これら装置は、相互に情報の授受を行うためにCAN(Controller Area Network)その他の車載LANによって接続されている。
周囲検知センサ110は、自車両の周囲に存在する障害物(他車両など)や道路標識(レーンマークや縁石など)を検出する。周囲検知センサ110としては、たとえば、自車両の前方を撮像する前方カメラ、自車両の後方を撮像する後方カメラ、自車両の側方を撮像する側方カメラなどを用いることができる。また、周囲検知センサ110として、自車両の周囲の障害物を検出するレーザー距離計(LRF:Laser Range Finder)を用いることもできる。なお、周囲検知センサ110として、上述した複数のセンサのうち1つのセンサを用いる構成としてもよいし、2種類以上のセンサを組み合わせて用いる構成としてもよい。周囲検知センサ110の検出結果は、制御装置160に出力される。
自車位置検出装置120は、GPSユニット、ジャイロセンサ、および車速センサなどから構成されており、GPSユニットにより複数の衛星通信から送信される電波を検出し、対象車両(自車両)の位置情報を周期的に取得するとともに、取得した対象車両の位置情報と、ジャイロセンサから取得した角度変化情報と、車速センサから取得した車速とに基づいて、対象車両の現在位置を検出する。自車位置検出装置120により検出された対象車両の位置情報は、制御装置160に出力される。
地図データベース130は、道路情報を含む地図情報を記憶している。道路情報は、各道路における車線の数、各車線を区画する車線境界線、各車線の進行方向の情報を含む。車線の進行方向としては、「直進」、「右折」、「左折」、「直進および右折」、「直進および左折」などが挙げられる。本実施形態において、地図データベース130は、各車線に対応するノードおよびリンクの情報を記憶しており、これらノードおよびリンクの情報から、車線の数や車線の進行方向を把握することができる(詳細は後述する。)。
提示装置140は、たとえば、ナビゲーション装置が備えるディスプレイ、ルームミラーに組み込まれたディスプレイ、メーター部に組み込まれたディスプレイ、フロントガラスに映し出されるヘッドアップディスプレイ、あるいは、オーディオ装置が備えるスピーカーなどの装置である。
駆動制御装置150は、自車両の走行を制御する。たとえば、駆動制御装置150は、自車両が先行車両に追従する場合には、自車両と先行車両との車間距離が一定距離となるように、加減速度および車速を実現するための駆動機構の動作(エンジン自動車にあっては内燃機関の動作、電気自動車系にあっては電動モータ動作を含み、ハイブリッド自動車にあっては内燃機関と電動モータとのトルク配分も含む)およびブレーキ動作を制御する。また、自車両が車線変更を行う場合や、交差点を右折または左折する場合には、ステアリングアクチュエータの動作を制御して、車輪の動作を制御することで、自車両の転回制御を実行する。なお、駆動制御装置150は、後述する制御装置160の指示により自車両の走行を制御する。また、駆動制御装置150による走行制御方法として、その他の周知の方法を用いることもできる。
制御装置160は、自車両の走行を制御するためのプログラムを格納したROM(Read Only Memory)と、このROMに格納されたプログラムを実行するCPU(Central Processing Unit)と、アクセス可能な記憶装置として機能するRAM(Random Access Memory)とから構成される。なお、動作回路としては、CPU(Central Processing Unit)に代えて又はこれとともに、MPU(Micro Processing Unit)、DSP(Digital Signal Processor)、ASIC(Application Specific Integrated Circuit)、FPGA(Field Programmable Gate Array)などを用いることができる。
制御装置160は、ROMに格納されたプログラムをCPUにより実行することにより、自車両の予定走行経路を探索する経路探索機能と、地図情報に基づいて自車両が走行する車線(自車線)の境界線を検出する第1の境界線検出機能と、周囲検知センサ110による検知結果に基づいて自車線の境界線を検出する第2の境界線検出機能と、地図情報に基づいて検出された車線境界線と、周囲検知センサ110の検知結果に基づいて検出された車線境界線とを統合する境界線統合機能と、周囲車両を検出する周囲車両検出機能と、車線の進行方向と周囲車両の進行方向とが一致するか否かを判定する進行方向判定機能と、周囲車両が走行する車線を予測し、周囲車両を地図上の適切な車線内に配置する周囲車両配置機能と、を実現する。以下において、制御装置160が備える各機能について説明する。
制御装置160の経路探索機能は、自車両の現在位置および目的地から、自車両の走行予定経路を生成する。たとえば、経路探索機能は、自車位置検出装置120から自車両の位置を取得するとともに、図示しない入力装置から、ドライバーが入力した目的地を取得することができる。また、経路探索機能は、公知の方法を用いて、走行予定経路の探索を行うことができる。
制御装置160の第1の境界線検出機能は、地図データベース130に記憶された地図情報に基づいて、自車線を含む車線の車線境界線を検出する。車線境界線とは、レーンマーク(車線を区画するために道路上に白色または黄色などで描かれた実線、二重線、破線など)や、縁石など、車線とそれに隣接する車線、あるいは、車線と路肩との境界を定める線である。地図データベース130が記憶する地図情報には、各車線の境界線の情報が含まれており、第1の境界線検出機能は、地図情報を参照して、自車線を含む車線の車線境界線を地図情報から検出する。なお、図2に示すように、第1の境界線検出機能により検出される車線境界線は、自車両の周囲の車線に限定されず、たとえば、自車両の走行予定経路における車線の車線境界線を検出することもできる。
制御装置160の第2の境界線検出機能は、周囲検知センサ110による検知結果に基づいて自車両の周囲の車線の車線境界線を検出する。たとえば、第2の境界線検出機能は、自車両の周囲に存在するレーンマークや縁石を、前方カメラ、側方カメラ、または後方カメラにより撮像し、撮像した画像を分析することで、自車両の周囲の車線の車線境界線を検出することができる。また、第2の境界線検出機能は、レーザー距離計により、自車両の周囲の路面やレーンマークの輝度、あるいは、測距により縁石の凸部を検出することで、自車両の周囲の車線の車線境界線を検出することができる。
なお、カーブや交差点が多く存在する一般道路では、レーンマークや縁石がある方向を推定することは難しく、また、カメラの解像度にも限度がある。そのため、カメラにより、レーンマークや縁石を高精度に検出できる範囲は、カメラからおおよそ数十メートルの範囲となる。また、レーザー距離計を用いて、レーンマークや縁石を識別することもできる。しかし、この場合も、路面に描かれたレーンマークの輝度を検出するために、レーザー距離計を下向きに設置する必要があり、また、レーザー距離計で縁石の微小な凸部を検出するためには、やはりレーザー距離計を下向きに設置する必要がある。そのため、レーザー距離計を用いた場合も、レーンマークや縁石を高精度に検出できる範囲は、レーザー距離計からおおよそ数十メートルの範囲となる。このように、第2の境界線検出機能で車線境界線を検知可能な範囲は、図2に示すように、自車両からおおよそ数十メートルの範囲、すなわち、自車両の周囲の範囲となる。
制御装置160の境界線統合機能は、第1の境界線検出機能により検出された車線境界線と、第2の境界線検出機能により検出された車線境界線とを統合して、自車両が走行する車線を含む車線の車線境界線を生成する。ここで、図3に示すように、第2の境界線検出機能が車線境界線を高精度に検出できる範囲は、自車両の周囲の範囲であり、自車両から離れるほど車線境界線の検出精度は低くなる。そこで、本実施形態では、第2の境界線検出機能で車線境界線を検出できる範囲の外側においては、第1の境界線検出機能で検出した車線境界線を補完する。
一方、自車位置検出装置120による自車両の位置の検出誤差により、図2に示すように、自車両の実際の位置(図中、破線で示す。)と、自車位置検出装置120の検出結果に基づく自車両の位置(図中、実線で示す。)とに誤差が生じる場合がある。この場合、図3に示すように、地図上の自車両の位置の周囲における車線境界線と、周囲検知センサ110の検出結果に基づく自車両の周囲における車線境界線とにずれが生じる。そのため、図3に示すように第2の境界線検出機能で車線境界線を検出できる範囲の外側を、第1の境界線検出機能で検出した車線境界線で統合するだけでは、実際の車線境界線に適合した車線境界線を生成することができない。
そこで、境界線統合機能は、図4に示すように、周囲検知センサ110により検出された車線境界線と、地図情報に基づく車線境界線とが一致するように、周囲検知センサ110により検出された車線境界線を、地図情報に基づく車線境界線で補完する。これにより、図4に示すように、周囲検知センサ110の検知結果に基づく自車両の位置を地図上の適切な位置に配置することができる。また、図4に示すように、周囲検知センサ110の検知範囲より外側の範囲においても車線境界線を適切に把握することができる。
なお、境界線統合機能は、周囲検知センサ110による検知結果に基づく車線境界線と、地図情報に基づく車線境界線との一致度が所定値以上である場合に、これら車線境界線の統合を行う。境界線統合機能は、たとえば、ICP(Iterative Closest Point)の手法により、これら車線境界線の一致度を判定することができる。ICPとは、「周囲検知センサ110により検出された車線境界線を示す点群」と「地図情報が有する車線境界線を示す点群」との位置合わせを、最小二乗法に基づいて行うものである。そして、境界線統合機能は、車線境界線の一致度が所定値以上であると判断した場合に、周囲検知センサ110の検出結果に基づく車線境界線を、地図情報に基づく車線境界線で補完する。
一方、境界線統合機能は、車線境界線との一致度が所定値未満である場合には、周囲検知センサ110の検出結果に基づいて自車両の地図上の位置を予測する。そして、境界線統合機能は、地図情報から、自車両の地図上の位置を含む車線の車線境界線を検出し、地図情報に基づく車線境界線内に自車両を配置する。このように、境界線統合機能は、車線境界線との一致度が所定値未満である場合には、周囲検知センサ110の検出結果に基づく車線境界線を用いないで、地図情報に基づく車線境界線を用いて、自車両の周囲の車線境界線を設定する。
制御装置160の周囲車両検出機能は、自車両の周囲に存在する周囲車両の位置および車速を検出する。具体的には、周囲車両検出機能は、周囲検知センサ110を構成する前方カメラ、側方カメラ、または後方カメラにより撮像された撮像画像、あるいは、レーザー距離計の検出結果に基づいて、自車両の周囲に存在する周囲車両の位置を検出することができる。また、周囲車両検出機能は、たとえば、カメラにより撮像された画像情報から移動体の種類を解析することで、歩行者、自転車、自動車などを識別することができる。さらに、周囲車両検出機能は、自車両の位置に対する周囲車両の相対位置の変化量と、自車両の車速とに基づいて、周囲車両の車速(絶対速度)を求めることもできる。
制御装置160の進行方向判定機能は、周囲車両が走行していた車線の進行方向と、周囲車両の進行方向とが一致するか否かを判定する。本実施形態において、進行方向判定機能は、自車両が直進または停止している場合には、車線の進行方向と周囲車両の走行方向とは一致すると判定し、自車両が転回している場合には、車線の進行方向と周囲車両の走行方向とは一致しないと判定する。ここで、図5は、自車両が車線変更(転回)を行っている場面を例示している。図5に示すように、自車両が転回している際に、周囲車両を検出した場合には、自車両の転回によるヨーレートの発生に伴い、周囲検知センサ110による周囲車両の検出結果に誤差が生じる場合がある。たとえば、図5に示すように、周囲車両が実際には車線Aを直進している場合でも、自車両が転回している場合には、周囲車両が車線Aから逸脱する方向に進行しているように検出されてしまう場合がある。そこで、進行方向判定機能は、図5に示すように、自車両が転回している場合には、車線の進行方向(図5では直進方向)と周囲車両の走行方向(図5では車線Aから逸脱する方向)とが一致しない傾向が高いため、車線の進行方向と周囲車両の走行方向とは一致しないと判定する。
制御装置160の周囲車両配置機能は、進行方向判定機能の判定結果に基づいて、周囲車両が走行する車線を予測し、予測した車線の地図上の位置に周囲車両を配置する。たとえば、周囲車両配置機能は、自車両が直進または停止しており、車線の進行方向と移動体の走行方向とが一致していると判定された場合には、周囲検知センサ110により検出された周囲車両の位置が、周囲車両が走行する車線であると予測し、予測した周囲車両の地図上の位置に、周囲車両を配置する。自車両が直進または停止している場合には、自車両のヨーレートの発生に伴う周囲車両の位置の検出誤差が少ないため、周囲検知センサ110の検知結果の信頼性が高くなるためである。
一方、周囲車両配置機能は、図5に示すように、自車両が転回しており、車線の進行方向と移動体の走行方向とが一致しないと判定された場合には、周囲車両が走行していた車線を、当該車線の進行方向に、周囲車両を移動させた位置を、周囲車両の位置として予測する。たとえば、図5に示す例において、周囲車両が走行していた車線Aの進行方向は直進方向であるため、周囲車両配置機能は、周囲車両を、車線Aにおいて、車線Aの直進方向に移動させた位置を、周囲車両の位置として予測する。そして、周囲車両配置機能は、図5に示すように、予測した周囲車両の位置に対応する地図上の位置に、周囲車両を配置することで、周囲車両を車線Aに配置することができる。これにより、周囲車両が走行する車線を適切に把握することができる。
具体的には、周囲車両配置機能は、まず、地図データベース130が記憶する地図情報から、周囲車両が走行していた車線の進行方向を検出する。本実施形態では、図6に示すように、地図情報は、各車線に対応するリンク情報を有している。図6に示す例では、周囲車両A〜Cが走行する全ての車線A〜Cのリンクは直進方向に延びている。そのため、周囲車両配置機能は、これら車線A〜Cの進行方向は直進方向であると推定することができる。なお、自車両が走行する車線Fのリンクは、車線Fのノードおよび車線Aのノードを介して、車線Aのリンクと接続しているとともに、車線Fのノードおよび車線Eのノードを介して、車線Eのリンクとも接続している。この場合、周囲車両配置機能は、自車両が進行する車線Fの進行方向を、「直進」および「左折」として推定することができる。そして、周囲車両配置機能は、推定した車線の進行方向を、周囲車両の進行方向として推定する。周囲車両は、周囲車両が走行していた車線を、そのまま走行する傾向が高いためである。これにより、たとえば図5に示す例において、周囲車両配置機能は、周囲車両が、周囲車両が走行している車線の進行方向(直進方向)に走行していると判断し、周囲車両を車線Aの直進方向に配置することができる。
また、周囲車両配置機能は、自車両が転回する前の周囲車両の位置の履歴に基づいて、周囲車両が走行していた車線、および周囲車両の移動量を推定することができる。そして、周囲車両配置機能は、周囲車両を、前回予測時の周囲車両の位置から、周囲車両が走行していた車線の進行方向に、周囲車両の移動量だけ移動させた位置に配置する。これにより、図5に示すように、周囲検知センサ110の検出結果に基づく周囲車両の位置(図5中、破線で示す。)を、周囲車両が実際に走行している車線内の位置(図5中、実線で示す。)に適切に補正することができる。
続いて、図7を参照して、第1実施形態に係る走行制御処理について説明する。図2は、第1実施形態に係る走行制御処理を示すフローチャートである。なお、以下に説明する走行制御処理は、制御装置160により実行される。
ステップS101では、経路探索機能により、自車両の現在位置が検出される。ステップS102では、経路探索機能より、走行予定経路を探索するか否かの判断が行われる。たとえば、経路探索機能は、ステップS101で取得された自車両の現在位置が、予め設定されている走行予定経路上にない場合に、走行予定経路を探索すると判断し、ステップS103に進む。一方、自車両の現在位置が、予め設定されている走行予定経路上にある場合には、ステップS103の処理を行わずに、ステップS104に進む。また、経路探索機能は、自車両が走行する車線が特定されている場合には、自車両が走行予定経路を走行可能な車線を走行しているか否かを判断し、自車両が走行予定経路を走行可能な車線を走行していない場合には、走行予定経路を変更すると判断することができる。
ステップS103では、経路探索機能により、ステップS101で取得した自車両の位置情報に基づいて、自車両の現在位置から目的地までの走行予定経路の探索が行われる。また、経路探索機能は、自車両が走行する道路だけではなく、自車両が走行する車線に基づいて、自車両の走行予定経路を探索する。たとえば、経路探索機能は、ダイキストラ法やA*アルゴリズムなどのグラフ探索理論を用いた手法により、自車両の走行予定経路を車線レベルで決定することができる。たとえば、本実施形態において、地図データベース130は、車線ごとのリンクおよびノードの情報を、地図情報に含めて記憶している。また、リンクには、各車線における走行距離や道路状況などに応じた重みが予め設定されている(たとえば、距離が長いほど、道路状況が悪いほど、リンクの重みは大きくなる)。さらに、経路探索機能は、目的地までの走行経路に適した車線を特定し、特定した車線のリンクの重みを補正する。たとえば、目的地に到達するために右折する必要がある場合には、右折車線のリンクの重みを小さくする補正を行うことができる。そして、経路探索機能は、ダイキストラ法やA*アルゴリズムなどのグラフ探索理論を用いて、自車両の現在位置から目的地までに通る車線のリンクの重みの総和が最も小さくなる車線レベルの経路を、走行予定経路として探索することができる。
ステップS104では、第1の境界線検出機能により、地図情報に基づく車線境界線の検出が行われる。本実施形態では、地図データベース130が記憶する地図情報に、各車線の車線境界線の情報が含まれている。そのため、第1の境界線検出機能は、地図データベース130に記憶された地図情報を参照することで、図2に示すように、自車線を含む車線の車線境界線を検出することができる。
ステップS105では、第2の境界線検出機能により、周囲検知センサ110の検出結果に基づいて、車線境界線の検出が行われる。なお、図3に示すように、周囲検知センサ110による車線境界線の検知範囲は、自車両から所定距離(たとえば数十メートル)以内の範囲、すなわち、自車両の周囲の範囲となる。
ステップS106では、境界線統合機能により、ステップS104において検出した地図情報に基づく車線境界線と、ステップS105で検出した周囲検知センサ110の検出結果に基づく車線境界線との一致度の判定が行われる。一致度が所定値以上である場合には、ステップS107に進み、一方、一致度が所定値未満である場合には、ステップS108に進む。たとえば、図3に示す例では、地図情報に基づく車線境界線と、周囲検知センサ110の検出結果に基づく車線境界線とは少しずれている。しかし、IPCなどの手法により、一致度は所定値以上と判定され、ステップS107に進む。
ステップS107では、境界線統合機能により、周囲検知センサ110の検出結果に基づく車線境界線に、地図情報に基づく車線境界線を補完する処理が行われる。具体的には、境界線統合機能は、周囲検知センサ110により車線境界線を検出可能な範囲よりも外側の範囲を、地図情報に基づく車線境界線で補完する。また、境界線統合機能は、周囲検知センサ110の検出結果に基づく車線境界線と地図情報に基づく車線境界線とが一致するように、地図情報に基づく車線境界線の位置を調整して統合する。これにより、図4に示すように、地図上における自車両の位置を適切に検出することができる。また、図4に示すように、周囲検知センサ110により車線境界線を検出可能な範囲より外側の範囲においても、車線境界線を適切に検出することができるため、自車両がこれから走行する道路の形状や、走行予定経路における自車両の位置などを適切に把握することができる。
一方、ステップS106において、地図情報に基づく車線境界線と周囲検知センサ110の検出結果に基づく車線境界線とが一致しない場合には、ステップS108に進む。ステップS108では、境界線統合機能により、周囲検知センサ110の検出結果に基づいて、地図上における自車両の位置が推定される。たとえば、境界線統合機能は、ステップS103で探索した自車両の走行予定経路と、自車両の速度とに基づいて、自車両の現在位置を推定することができる。
そして、ステップS109では、境界線統合機能により、推定された自車両の地図上の位置を含む車線の車線境界線が地図情報から検出される。これにより、自車両の地図上の位置を含む車線の車線境界線により、自車両が走行する車線や、予定走行経路における自車両の位置を適切に把握することができる。
ステップS110〜S114では、ステップS107またはステップS109で検出された車線に、周囲車両を配置する処理が行われる。まず、ステップS110では、周囲車両検出機能により、周囲車両の位置および車速の検出が行われる。また、周囲車両検出機能は、前回処理時の周囲車両の位置と、今回検出した周囲車両の位置および車速とに基づいて、前回処理時からの周囲車両の移動量も検出する。
ステップS111では、進行方向判定機能により、自車両が転回しているか否かの判断が行われる。進行方向判定機能は、自車両が車線変更などの転回中である場合には、周囲車両の進行方向と車線の進行方向とが一致しないと判断し、ステップS112に進む。一方、自車両が直進または停止中である場合には、周囲車両の進行方向と車線の進行方向とが一致すると判断し、ステップS114に進む。このように、本実施形態では、自車両が転回中であるか否かを判断することで、周囲車両の進行方向と車線の進行方向とに矛盾があるか否かを判断する。そして、周囲車両の進行方向と車線の進行方向とが一致せず、周囲車両の進行方向と車線の進行方向とに矛盾がある場合には、周囲検知センサ110により検出された周囲車両の位置に誤差があると判断し、周囲車両の位置を補正するために、ステップS112に進む。
ステップS112では、周囲車両配置機能により、周囲車両の進行方向の推定が行われる。たとえば、周囲車両配置機能は、道路情報に含まれる車線のリンク情報に基づいて、周囲車両が走行していた車線の進行方向を検出し、検出した車線の進行方向を、周囲車両の進行方向として推定する。たとえば、図5に示す例では、周囲車両が車線Aを走行しており、車線Aの進行方向が直進方向であるため、周囲車両配置機能は、周囲車両の進行方向を車線Aの直進方向として推定することができる。
ステップS113では、周囲車両配置機能により、ステップS112で推定した周囲車両の進行方向に基づいて、周囲車両を地図上に配置する処理が行われる。具体的には、周囲車両配置機能は、前回処理時の周囲車両の位置から、周囲車両の進行方向に、前回処理時からの移動量だけ、周囲車両を移動させた位置を、周囲車両の位置として予測する。そして、周囲車両配置機能は、予測した周囲車両の位置に対応する地図上の位置に、周囲車両を配置する。
一方、ステップS111において、周囲車両配置機能により、自車両が直進または停止しており、車線の進行方向と周囲車両の進行方向とが一致すると判定された場合は、ステップS114に進む。ステップS114では、周囲車両配置機能により、周囲車両を、ステップS110で検出された周囲車両の地図上の位置に配置する処理が行われる。すなわち、周囲車両配置機能は、周囲検知センサ110により検出された周囲車両の位置を周囲車両の位置として予測し、予測した周囲車両の位置(すなわち、周囲検知センサ110により検出された周囲車両の位置)に対応する地図上の位置に、周囲車両を配置する。
以上のように、第1実施形態では、自車両が転回している場合には、周囲車両が走行していた車線の進行方向と周囲車両の進行方向とが一致しないと判断し、周囲車両を、周囲車両が走行していた車線において当該車線の進行方向に移動させた位置を、周囲車両の位置として予測する。これにより、自車両の転回により、周囲検知センサ110より検出された周囲車両の位置に検出誤差が生じ、図5に示すように、周囲車両が走行していた車線とは異なる車線内で誤検出された場合でも、周囲車両が実際に走行する車線を予測することができる。
また、第1実施形態では、周囲車両の位置の履歴に基づいて、周囲車両の移動量を推定し、前回予測時の周囲車両の位置から、周囲車両の進行方向に、周囲車両の移動量だけ周囲車両を移動させた位置を、周囲車両の位置として予測する。これにより、車線レベルにおける周囲車両の位置だけではなく、周囲車両の進行方向における位置も適切に予測することができる。
さらに、第1実施形態では、周囲検知センサ110の検知結果に基づく車線境界線と、地図情報に基づく車線境界線とに基づいて、自車線を含む車線の車線境界線を地図上に生成する。具体的には、周囲検知センサ110の検知結果に基づく自車両の周囲の車線境界線と、地図情報に基づく自車両の周囲の車線境界線との一致度が所定値以上である場合には、周囲検知センサ110の検知結果に基づく自車両の周囲の車線境界線を、地図情報に基づく自車線を含む車線の車線境界線で補完する。すなわち、周囲検知センサ110による車線境界線の検知範囲は、地図情報に基づく車線境界線の範囲よりも小さいため、周囲検知センサ110による車線境界線の検知範囲の外側の範囲を、地図情報に基づく車線境界線で補完する。これにより、図4に示すように、周囲検知センサ110による車線境界線の検知範囲の外側においても、車線境界線を適切に検出することができ、自車両がこれから走行する道路の形状や、走行予定経路における自車両の位置などを適切に把握することができる。また、図4に示すように、自車位置検出装置120による自車両の位置に検出誤差が生じた場合でも、自車両が走行する車線を適切に予測することができ、自車両を地図上の適切な車線上に配置することができる。
また、第1実施形態では、周囲検知センサ110の検知結果に基づく自車線の車線境界線と、地図情報に基づく自車線の車線境界線との一致度が所定値未満である場合には、周囲検知センサ110の検出結果に基づいて、自車両の地図上の位置を推定し、推定した自車両の地図上の位置を含む車線の車線境界線を、地図情報から検出した車線境界線で補完する。これにより、周囲検知センサ110の検知結果に基づく自車線の車線境界線と、地図情報に基づく自車線の車線境界線との一致度が所定値未満であり、周囲検知センサ110の検知結果に基づく自車線の車線境界線と、地図情報に基づく自車線の車線境界線とを統合できない場合でも、自車両の周囲の車線の車線境界線を適切に検出することができる。
≪第2実施形態≫
続いて、第2実施形態に係る走行制御装置について説明する。第2実施形態に係る走行制御装置100は、第1実施形態の走行制御装置100と同様の構成を有し、以下に説明するように動作すること以外は、第1実施形態と同様である。
続いて、第2実施形態に係る走行制御装置について説明する。第2実施形態に係る走行制御装置100は、第1実施形態の走行制御装置100と同様の構成を有し、以下に説明するように動作すること以外は、第1実施形態と同様である。
第2実施形態に係る制御装置160の周囲車両配置機能は、周囲車両が走行する道路における各車線の進行方向、および、周囲車両のウィンカーの点灯状態に基づいて、周囲車両が走行する車線を予測し、周囲車両を予測した車線内に配置する。
ここで、図8は、自車両がT字交差点に進入する場面を例示する図である。図8に示す例では、周囲車両Aは実際には車線Aを走行しているが、周囲検知センサ110の検出誤差により、周囲車両Aが車線Aと車線Bとの間で検出されている。また、周囲車両Bは実際には車線Eを走行しているが、周囲検知センサ110の検出誤差により、周囲車両Bが、周囲車両Bの走行方向と反対に進行可能な車線D内で検出されている。
周囲車両配置機能は、周囲車両Aを地図上に配置する際に、周囲車両Aが走行する道路における各車線の進行方向を検出する。具体的には、周囲車両配置機能は、周囲車両Aが走行する道路における各車線のリンク情報に基づいて、周囲車両Aが走行する道路における各車線の進行方向を検出する。ここで、図9は、図8に示す場面における各車線のリンクおよびノードの一例を示す図である。たとえば、図9に示す例において、車線Aのリンクは、車線Aのノードおよび車線Cのノードを介して、左折方向にある車線Cのリンクとのみ接続している。そのため、周囲車両配置機能は、車線Aの進行方向を「左折」と判断することができる。また、車線Bのリンクは、車線Bのノードおよび車線Dのノードを介して、直進方向にある車線Dのリンクとのみ接続している。そのため、周囲車両配置機能は、車線Bの進行方向を「直進」と判断することができる。
また、周囲車両配置機能は、図8および図9に示すように、車線Aが左折専用車線であり、車線Bが直進専用車線であるため、交差点付近において左折専用車線または右折専用車線と直進専用車線との間で車線変更が禁止されるとの交通ルール情報に基づいて、周囲車両が車線変更禁止区間に存在すると判断することができる。なお、交通ルール情報は、制御装置160のメモリに記憶されている。
さらに、周囲車両配置機能は、周囲車両のウィンカーの点灯状態を検出する。たとえば、周囲車両配置機能は、自車両の前方を撮像する前方カメラ、自車両の後方を撮像する後方カメラなどを用いて、周囲車両のウィンカーの点灯状態を検出することができる。たとえば、図8に示す例において、周囲車両配置機能は、周囲車両Aのウィンカーの点灯状態として「左側のウィンカーが点滅している」ことを検出することができる。
そして、周囲車両配置機能は、周囲車両が走行する道路における各車線の進行方向と、周囲車両のウィンカーの点灯状態とに基づいて、周囲車両を適切な車線内に配置する。たとえば、図8に示す例において、周囲車両配置機能は、車線Bの進行方向が「直進」であり、車線Aの進行方向が「左折」であり、また、左側のウィンカーが点滅していることから、周囲車両Aが走行する車線は、左折専用車線である車線Aであると判断することができる。よって、周囲車両配置機能は、周囲車両Aが走行する車線は車線Aであると予測し、周囲車両Aを地図上の車線Aに配置する。
なお、図8に示すように、周囲車両Aが車線変更禁止区間を走行する場合には、周囲車両配置機能は、周囲車両Aが走行する車線を予測せずに、前回処理時に周囲車両Aを配置した車線A内に、周囲車両を配置する構成としてもよい。たとえば、図8に示す例において、周囲車両配置機能は、周囲車両Aが車線変更禁止区間を走行している場合には、周囲車両Aを車線Aに一度配置した後は、周囲車両Aが車線変更禁止区間を走行している間、周囲車両Aを車線A内に配置することができる。
次に、周囲車両Bの配置方法について説明する。図8に示す例において、周囲車両Bは、周囲車両Bの進行方向と逆方向に進行可能な車線D上で検出されている。一方、周囲車両Bが走行する道路には、車線Dの他に、車線Eおよび車線Fが存在する。図9に示すように、車線Eのリンクは、車線Eのノードおよび車線Gのノードを介して直進方向にある車線Gのリンクと接続しているとともに、車線Eのノードおよび車線Cのノードを介して右折方向にある車線Cのリンクと接続している。そのため、周囲車両配置機能は、車線Eの進行方向を「直進」または「右折」と判断することができる。また、車線Fのリンクは、車線Fのノードおよび車線Hのノードを介して、直進方向にある車線Hのリンクとのみ接続している。そのため、周囲車両配置機能は、車線Fの進行方向を「直進」と判断することができる。
さらに、図8に示す例において、周囲車両配置機能は、周囲車両Bのウィンカーの点灯状態として「無点灯」を検出する。そして、周囲車両配置機能は、車線Eおよび車線Fの進行方向の検出結果に基づいて、周囲車両Bが車線Dを逆走している可能性は低く、車線Eまたは車線Fを走行していると予測し、周囲車両Bを、地図上の車線Eまたは車線Fに配置する。
また、図10は、図9に示す場面において、自車両がT字交差点を右折(転回)する場面を例示している。図10に示すように、自車両が転回している場合には、自車両の姿勢角が変化してヨーレートが発生する。そのため、周囲検知センサ110による周囲車両の位置や速度の検出結果の信頼性は低下し、周囲車両の位置が実際の位置とは異なる位置で検出されることがある。このような場合も、第2実施形態では、周囲車両が走行する道路における各車線の進行方向および周囲車両のウィンカーの点灯状態に基づいて、周囲車両が走行する車線を予測し、周囲車両を、予測した車線に配置することができる。これにより、図10に示す例において、周囲車両配置機能は、周囲車両Aを車線A内に配置することができ、周囲車両Bを車線E内に配置することができる。
次に、図11を参照して、第2実施形態に係る走行制御処理について説明する。図11は、第2実施形態に係る走行制御処理を示すフローチャートである。なお、第2実施形態において、ステップS101〜S110は、第1実施形態と同様であるため、説明は省略する。
すなわち、ステップS110において、周囲車両の位置および速度の検出が行われると、ステップS201に進む。ステップS201では、進行方向判定機能により、自車両が直進または転回しているか否かの判断が行われる。自車両が停止している場合には、周囲車両の位置や速度の検出結果の信頼性は高くなるため、ステップS113に進み、検出された周囲車両の位置に対応する地図上の位置に、周囲車両を配置する処理が行われる。一方、自車両が直進または転回している場合には、周囲車両の位置や速度の検出結果の信頼性は低くなるため、周囲車両が走行する車線を適切に予測するために、ステップS202に進む。
ステップS202では、周囲車両配置機能により、周囲車両が走行する道路における各車線の進行方向が検出される。たとえば、周囲車両配置機能は、図9に示すように、地図データベース130から周囲車両が走行する道路における各車線のリンクおよびノードの情報を取得し、取得したリンクおよびノードの情報に基づいて、各車線の進行方向を検出することができる。また、周囲車両配置機能は、各車線の進行方向の情報から、周囲車両が車線変更禁止区間を走行しているか否かを判断する。
ステップS203では、周囲車両配置機能により、周囲車両のウィンカーの点灯状態の検出が行われる。周囲車両配置機能は、たとえば、自車両の前方を撮像する前方カメラを用いて、周囲車両のウィンカーの点灯状態を検出することができる。
ステップS204では、周囲車両配置機能により、周囲車両が走行する道路における各車線の進行方向と、周囲車両のウィンカーの点灯状態とに基づいて、周囲車両の位置の予測が行われる。そして、ステップS205では、周囲車両配置機能により、ステップS205で予測された周囲車両の位置に対応する地図上の位置に、周囲車両が配置される。
たとえば、図8に示す例では、自車両が交差点に進入するために直進している(ステップS201=Yes)。この場合、周囲車両配置機能は、周囲車両Aが走行する道路における各車線A,Bの進行方向を、それぞれ直進方向および左折方向として検出するとともに、周囲車両Aが、車線変更禁止区間に存在することを検出する(ステップS202)。また、周囲車両配置機能は、周囲車両Aが左側のウィンカーを点滅させていることを検出する(ステップS203)。これにより、周囲車両配置機能は、周囲車両Aは、左折専用車線である車線Aに存在すると予測し(ステップS204)、周囲車両Aを地図上の車線Aに配置する(ステップS205)。
また、周囲車両配置機能は、周囲車両Bが走行する道路における各車線E,Fの進行方向を、それぞれ「直進または右折」、および「直進」として検出する(ステップS202)。また、周囲車両配置機能は、周囲車両Bがウィンカーを点滅させていないことを検出する(ステップS203)。さらに、周囲車両配置機能は、周囲車両Bが車線Dを逆走している可能性は低いと判断し、周囲車両Bは直進可能な車線E,Fを走行していると予測する(ステップS204)。そこで、周囲車両配置機能は、周囲車両Bを車線Eまたは車線Fに配置する(ステップS205)。なお、周囲車両配置機能は、図8に示すように、車線Eおよび車線Fのうち、周囲検知センサ110により周囲車両Bが検出された位置に近い車線に、周囲車両Bを配置することができる。
以上のように、第2実施形態では、周囲車両のウィンカーの点灯状態と、周囲車両が走行する道路における各車線の進行方向とに基づいて、周囲車両が走行する車線を予測し、予測した車線に対応する地図上の位置に周囲車両を配置する。これにより、第2実施形態では、周囲車両のウィンカーの点灯状態、周囲車両が走行する道路における各車線の進行方向を考慮して、周囲車両が走行する車線をより適切に予測することができ、周囲車両を地図上の適切な位置に配置することができる。
また、第2実施形態では、周囲車両が走行する道路の各車線の進行方向に基づいて、周囲車両が車線変更禁止区間を走行しているか否かを判断し、周囲車両が車線変更禁止区間を走行している場合には、周囲車両の位置を、同一の車線内において予測する。これにより、車線変更禁止区間の交通ルールに従って、周囲車両が走行する車線を適切に予測することができ、周囲車両を地図上の適切な位置に配置することができる。
また、第2実施形態では、自車両が転回または直進している場合に、周囲車両の進行方向と車線の進行方向とが一致しないと判断し、周囲車両の配置位置を補正する。これにより、自車両が走行しているために、周囲車両の位置や速度の検出速度が低下する場面でも、周囲車両を適切な位置に配置することができる。
≪第3実施形態≫
続いて、第3実施形態に係る走行制御装置について説明する。第3実施形態に係る走行制御装置100は、第1実施形態の走行制御装置100と同様の構成を有し、以下に説明するように動作すること以外は、第1実施形態と同様である。
続いて、第3実施形態に係る走行制御装置について説明する。第3実施形態に係る走行制御装置100は、第1実施形態の走行制御装置100と同様の構成を有し、以下に説明するように動作すること以外は、第1実施形態と同様である。
第3実施形態において、制御装置160の周囲車両配置機能は、道路指標物および道路形状(道路曲線を含む)に基づいて、自車両および周囲車両の地図上の位置を決定する。なお、道路指標物とは、停止線、標識、信号機、消火栓など、路面またはその近傍に固定され、指標となり得るものである。また、道路形状とは、カーブなどの道路の形状である。
周囲車両配置機能は、周囲検知センサ110を構成するカメラまたはレーザー距離計の検出結果に基づいて、道路指標物および道路形状を検出する。また、周囲車両配置機能は、地図情報から道路指標物および道路形状を検出する。本実施形態では、地図データベース130が記憶する地図情報に、道路指標物の位置や道路形状の情報が含まれている。また、道路指標物の情報には、停止線の幅、道路標識の形状および高さ、信号機や消火栓の形状、大きさ、高さなどの情報も含まれる。さらに、地図データベース130は、各車線の道路形状を、点列または多項式関数として記憶している。また、地図データベース130は、各車線を区画するレーンマークの種類(実線、二重線、破線など)や色(白や黄色など)、縁石の高さなどの情報も記憶している。そのため、周囲車両配置機能は、地図データベース130の地図情報を参照することで、自車両の周囲の道路指標物および道路形状を検出することができる。
ここで、図12Aは、自車両が十字交差点に進入する場面を例示している。図12Aに示す例では、自車位置検出装置120の測定結果に基づいて、自車両の位置が、交差点の停止線からある程度離れた位置で検出されている。一方、図12Bは、図12Aに示す場面における、周囲検知センサ110の検知結果の一例を示す図である。図12Bに示すように、周囲検知センサ110の検知結果では、自車両の直ぐ手前に、交差点の停止線が検出されている。すなわち、図12Aに示す例においては、自車位置検出装置120の検出誤差により、自車位置検出装置120により検出された自車両の位置が、周囲検知センサ110の検出結果に基づく自車両の位置とは異なる位置となっている。
この場合、周囲車両配置機能は、図13に示すように、周囲検知センサ110で検出された停止線と、地図情報に基づいて検出された停止線とをマッチングさせることで、自車両の進行方向において、自車両の位置を補正する。これにより、自車位置検出装置120に検出誤差が生じた場合でも、自車両の位置を適切に予測し、自車両を地図上の適切な位置に配置することができる。
また、周囲車両配置機能は、自車両の位置の補正に合わせて、周囲車両の位置も補正する。すなわち、自車両の位置に誤差が生じている場合、図12に示すように、自車両の位置を基準として検出された周囲車両の位置にも誤差が生じる。そこで、周囲車両配置機能は、自車両の地図上の位置を補正した場合には、自車両と同様の方向に、自車両と同様の移動量だけ、周囲車両の地図上の位置も移動させる。これにより、図13に示すように、周囲車両が走行する車線を適切に予測することができるとともに、周囲車両を地図上の適切な車線内に配置することができる。
次に、図14を参照して、第3実施形態に係る走行制御処理について説明する。図14は、第3実施形態に係る走行制御処理を説明するための図である。なお、図14に示す制御処理は、図7に示す第1実施形態の走行制御処理に続けて実行される。すなわち、図7に示すステップS113またはステップS114の処理が行われた後に、図14に示すステップS301の処理が行われる。
ステップS301では、周囲車両配置機能により、周囲検知センサ110の検出結果に基づいて、自車両の周囲の道路指標物および道路形状の検出が行われる。また、ステップS302では、周囲車両配置機能により、地図情報に基づいて、自車両の周囲の道路指標物および道路形状の検出が行われる。
ステップS303では、周囲車両配置機能により、ステップS301で検出された周囲検知センサ110の検知結果に基づく道路指標物および道路形状と、ステップS302で検出された地図情報に基づく道路指標物および道路形状とのマッチングが行われる。たとえば、周囲車両配置機能は、パターンマッチングの手法を用いることで、周囲検知センサ110の検知結果に基づく道路指標物と、地図情報に基づく道路指標物とをマッチングすることができる。また、周囲車両配置機能は、ICPの手法により、周囲検知センサ110の検知結果に基づく道路形状と、ステップS302で取得された地図情報に基づく道路形状とをマッチングすることができる。
ステップS304では、周囲車両配置機能により、ステップS303のマッチング結果に基づいて、自車両および周囲車両の位置の補正が行われる。たとえば、図13に示すように、周囲検知センサ110により検出された停止線と、地図情報から検出された停止線とが一致するように、自車両および周囲車両の地図上の位置を補正することで、自車両および周囲車両の位置を適切に予測することができる。また、交差点やカーブなどの道路形状においては、周囲検知センサ110の検知結果に基づく道路形状と、地図情報に基づく道路形状とが一致するように、自車両および周囲車両の位置を補正することで、自車両および周囲車両の位置を適切に予測することができる。そして、周囲車両配置機能は、補正した自車両および周囲車両の位置に基づいて、自車両および周囲車両を地図上に配置する。これにより、自車両および周囲車両を地図上の適切な位置に配置することができる。
なお、ステップS304において、自車両および周囲車両の地図上の位置を唐突に変更してしまうと、ドライバーに違和感を与えてしまうことがある。そこで、自車両および周囲車両の位置の移動量(補正量)に所定のフィルタを掛けることで、自車両および周囲車両の位置の変化を緩やかにし、ドライバーの違和感を軽減することができる。
以上のように、第3実施形態では、周囲検知センサ110により検出された道路指標物や道路形状と、地図情報から検出された道路指標物や道路形状とが一致するように、自車両および周囲車両の地図上の位置を補正することで、自車両および周囲車両が走行する車線を適切に予測することができ、自車両および周囲車両を地図上の適切な位置に配置することができる。
また、第3実施形態では、自車両の位置を補正した方向および移動量だけ、周囲車両の位置を移動させることで、周囲車両の位置も適切に補正することができる。周囲車両の位置は、自車両の位置に基づいて決定されるため、自車両の位置に誤差がある場合には、周囲車両の位置にも誤差が生じる。そのため、自車両の位置の補正分だけ周囲車両の位置を補正することで、周囲車両が走行する車線を適切に予測することができ、周囲車両を地図上の適切な位置に配置することができる。
なお、以上に説明した実施形態は、本発明の理解を容易にするために記載されたものであって、本発明を限定するために記載されたものではない。したがって、上記の実施形態に開示された各要素は、本発明の技術的範囲に属する全ての設計変更や均等物をも含む趣旨である。
たとえば、上述した実施形態では、周囲車両が走行する道路における車線の進行方向に基づいて、周囲車両が実際に走行する車線を予測し、周囲車両を地図上の適切な車線に配置する構成を例示したが、この構成に限定されず、たとえば、周囲車両が走行する道路における車線の進行方向に基づいて、周囲車両が実際に走行する車線を予測し、この予測結果に基づいて、自車両の走行を自動で制御する構成としてもよい。
また、上述した第1実施形態では、周囲車両を、周囲車両が走行していた車線において、当該車線の進行方向に移動させた位置を、周囲車両の位置として予測する構成を例示したが、この構成に限定されず、たとえば、周囲車両の位置の履歴に基づいて、周囲車両の進行方向を推定し、周囲車両を、推定した進行方向に移動させた位置を、周囲車両の位置として予測する構成としてもよい。この場合も、周囲検知センサ110による周囲車両の検出位置に誤差が生じた場合でも、周囲車両が走行する車線を適切に予測することができ、周囲車両を地図上の適切な位置に配置することができる。
また、上述した第1実施形態では、自車両が転回している場合に、周囲車両の進行方向と周囲車両が走行していた車線の進行方向とが一致しないと判断し、周囲車両の位置を補正する構成を例示したが、この構成に限定されず、自車両が直進している場合も、周囲車両の進行方向と周囲車両が走行していた車線の進行方向とが一致しないと判断し、周囲車両の位置を補正する構成としてもよい。
さらに、上述した実施形態に加えて、周囲車両が、自車両が走行する車線上に存在する場合には、自車両が転回している場合でも、周囲車両を、周囲検知センサ110で検出された位置に配置する構成とすることができる。この場合も、ヨーレートによる検出誤差が生じにくいため、周囲車両を適切な位置に配置することができる。
なお、上述した実施形態に係る周囲検知センサ110は本発明の検出器に相当する。
100…走行制御装置
110…周囲検知センサ
120…自車両位置検出装置
130…地図データベース
140…提示装置
150…駆動制御装置
160…制御装置
110…周囲検知センサ
120…自車両位置検出装置
130…地図データベース
140…提示装置
150…駆動制御装置
160…制御装置
Claims (14)
- 自車両の周囲の移動体を検出する検出器を用いて、前記移動体の位置を予測する走行制御方法であって、
地図情報から前記移動体が走行する道路における車線の進行方向を検出し、
自車両が転回しているか否かを判断し、
自車両が転回している場合には、前記地図情報から検出された車線の進行方向に基づいて、前記検出器により検出された前記移動体の位置を補正し、
自車両が転回していない場合には、前記地図情報から検出された車線の進行方向に基づいて、前記検出器により検出された前記移動体の位置を補正しない制御方法。 - 請求項1に記載の制御方法であって、
自車両が転回している場合には、前記移動体が走行していた前記車線を、当該車線の進行方向に、前記移動体を移動させた位置に、前記移動体の位置を補正する制御方法。 - 請求項2に記載の制御方法であって、
自車両が転回している場合には、前記移動体の位置の履歴に基づいて、前記移動体の移動量を推定し、前回補正時の前記移動体の位置から、前記移動体が走行していた前記車線を、当該車線の進行方向に、前記移動体を前記移動量だけ移動させた位置に、前記移動体の位置を補正する制御方法。 - 請求項1〜3のいずれかに記載の制御方法であって、
自車両が転回している場合には、前記移動体の位置の履歴に基づいて、前記移動体の移動方向を推定し、推定した前記移動体の移動方向に前記移動体を移動させた位置に、前記移動体の位置を補正する制御方法。 - 請求項1に記載の制御方法であって、
前記移動体のウィンカーの点灯状態と、前記移動体が走行する道路における各車線の進行方向とに基づいて、前記移動体が走行する車線を推定し、前記推定した車線内の位置に、前記移動体の位置を補正する制御方法。 - 請求項5に記載の制御方法であって、
前記各車線の進行方向に基づいて、前記移動体が車線変更禁止区間を走行しているか否かを判断し、前記移動体が前記車線変更禁止区間を走行している間は、前記移動体の位置を同一の車線内において補正する制御方法。 - 請求項1〜6のいずれかに記載の制御方法であって、
前記検出器の検出結果に基づいて道路またはその近傍に設置される道路指標物を検出し、
地図情報に基づいて前記道路指標物を検出し、
前記検出器の検出結果に基づく前記道路指標物の位置と、前記地図情報に基づく前記道路指標物の位置とが一致するように、自車両または前記移動体の位置を補正する制御方法。 - 請求項1〜7のいずれかに記載の制御方法であって、
前記検出器の検出結果に基づいて道路形状を検出し、
前記地図情報に基づいて道路形状を検出し、
前記検出器の検出結果に基づく前記道路形状が、前記地図情報に基づく前記道路形状と一致するように、自車両または前記移動体の位置を補正する制御方法。 - 請求項7または8に記載の制御方法であって、
自車両の位置および前記移動体の位置を、同一の方向に、同一の移動量で補正する制御方法。 - 請求項1〜9のいずれかに記載の制御方法であって、
自車両が直進している場合も、前記車線の進行方向に基づいて、前記移動体の位置を補正する制御方法。 - 請求項1〜10のいずれかに記載の制御方法であって、
前記検出器による検出結果に基づいて、自車両の周囲の車線の境界線を第1境界線として検出し、
前記地図情報に基づいて、自車両が走行する車線を含む車線の境界線を第2境界線として検出し、
前記第1境界線と前記第2境界線とを統合して、車線の境界線を生成する制御方法。 - 請求項11に記載の制御方法であって、
前記第1境界線を検出できる範囲よりも広い範囲において、前記第2境界線を検出することができ、
前記第1境界線と前記第2境界線の一部との一致度が所定値以上である場合には、前記第1境界線を検出できる範囲よりも外側の範囲を、前記第2境界線で補完する制御方法。 - 請求項11または12に記載の制御方法であって、
前記第1境界線と前記第2境界線との一致度が所定値未満である場合に、自車両の地図上の位置を推定し、推定した前記自車両の地図上の位置を含む車線の境界線を、前記第2境界線で補完する制御方法。 - 自車両の周囲の移動体を検出する検出器と、
前記移動体の位置を判断する制御部と、を備える走行制御装置であって、
前記制御部は、
地図情報から前記移動体が走行する道路における車線の進行方向を検出し、
自車両が転回しているか否かを判断し、
自車両が転回している場合には、前記地図情報から検出された車線の進行方向に基づいて、前記検出器により検出された前記移動体の位置を補正し、
自車両が転回していない場合には、前記地図情報から検出された車線の進行方向に基づいて、前記検出器により検出された前記移動体の位置を補正しない走行制御装置。
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| PCT/JP2015/077783 WO2017056247A1 (ja) | 2015-09-30 | 2015-09-30 | 走行制御方法および走行制御装置 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JPWO2017056247A1 JPWO2017056247A1 (ja) | 2018-08-16 |
| JP6521082B2 true JP6521082B2 (ja) | 2019-06-05 |
Family
ID=58423026
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2017542606A Active JP6521082B2 (ja) | 2015-09-30 | 2015-09-30 | 走行制御方法および走行制御装置 |
Country Status (10)
| Country | Link |
|---|---|
| US (1) | US10964217B2 (ja) |
| EP (1) | EP3358545B1 (ja) |
| JP (1) | JP6521082B2 (ja) |
| KR (1) | KR102021709B1 (ja) |
| CN (1) | CN108140316B (ja) |
| BR (1) | BR112018006000A2 (ja) |
| CA (1) | CA2999814A1 (ja) |
| MX (1) | MX383028B (ja) |
| RU (1) | RU2703440C1 (ja) |
| WO (1) | WO2017056247A1 (ja) |
Families Citing this family (19)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| EP3217374A1 (en) * | 2016-03-10 | 2017-09-13 | Volvo Car Corporation | Method and system for estimating a boundary of a road technical field |
| EP3315998B1 (en) * | 2016-10-25 | 2021-12-08 | KNORR-BREMSE Systeme für Nutzfahrzeuge GmbH | Apparatus and method for determining a speed of a vehicle |
| JP6870475B2 (ja) * | 2017-05-25 | 2021-05-12 | 日産自動車株式会社 | 車線情報出力方法および車線情報出力装置 |
| US10583839B2 (en) * | 2017-12-28 | 2020-03-10 | Automotive Research & Testing Center | Method of lane change decision-making and path planning |
| JP7149082B2 (ja) * | 2018-03-08 | 2022-10-06 | 日産自動車株式会社 | 走行支援装置の走行支援方法及び走行支援装置 |
| US10627827B2 (en) * | 2018-05-23 | 2020-04-21 | GM Global Technology Operations LLC | Method for maintaining desired lane by autonomous vehicle in environments with compromised lane markers |
| DE102018118220B4 (de) * | 2018-07-27 | 2020-04-16 | Man Truck & Bus Se | Verfahren zur Schätzung der Lokalisierungsgüte bei der Eigenlokalisierung eines Fahrzeuges, Vorrichtung für die Durchführung von Verfahrensschritten des Verfahrens, Fahrzeug sowie Computerprogramm |
| DE112019003433B4 (de) | 2018-09-25 | 2024-08-22 | Hitachi Astemo, Ltd. | Erkennungsvorrichtung |
| KR102506879B1 (ko) * | 2018-11-23 | 2023-03-08 | 현대자동차주식회사 | 차량의 자율주행 제어 장치 및 방법 |
| WO2020131174A2 (en) * | 2018-12-21 | 2020-06-25 | Polaris Industries Inc. | Managing recreational vehicles and accessories |
| KR102696569B1 (ko) * | 2019-04-09 | 2024-08-21 | 현대자동차주식회사 | 차량 및 그 제어방법 |
| CN110210303B (zh) * | 2019-04-29 | 2023-04-25 | 山东大学 | 一种北斗视觉融合精准车道辨识与定位方法及其实现装置 |
| CN112859826B (zh) * | 2019-11-26 | 2025-02-25 | 北京京东乾石科技有限公司 | 用于控制无人搬运车的方法和装置 |
| WO2022071315A1 (ja) * | 2020-09-30 | 2022-04-07 | 学校法人明治大学 | 自律移動体制御装置、自律移動体制御方法及びプログラム |
| JP7411593B2 (ja) * | 2021-02-10 | 2024-01-11 | 本田技研工業株式会社 | 運転支援装置 |
| JP2022139009A (ja) * | 2021-03-11 | 2022-09-26 | 本田技研工業株式会社 | 運転支援装置、運転支援方法及びプログラム |
| US11804131B2 (en) * | 2021-11-24 | 2023-10-31 | GM Global Technology Operations LLC | Communication system for determining vehicle context and intent of a target vehicle based on perceived lane of travel |
| DE102022202165B4 (de) * | 2022-03-03 | 2026-01-15 | Volkswagen Aktiengesellschaft | Verfahren zum Bereitstellen einer Fahrstreifenlokalisierung für ein Kraftfahrzeug in einem Gebiet einer Infrastruktureinrichtung |
| JP7470157B2 (ja) * | 2022-08-24 | 2024-04-17 | 本田技研工業株式会社 | 車両制御装置、車両制御方法、およびプログラム |
Family Cites Families (11)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH09243389A (ja) * | 1996-03-08 | 1997-09-19 | Alpine Electron Inc | 車載用ナビゲーション装置 |
| JP3822770B2 (ja) * | 1999-12-10 | 2006-09-20 | 三菱電機株式会社 | 車両用前方監視装置 |
| JP2005004442A (ja) * | 2003-06-11 | 2005-01-06 | Matsushita Electric Ind Co Ltd | 走行車線判別装置 |
| JP2005257314A (ja) | 2004-03-09 | 2005-09-22 | Honda Motor Co Ltd | 車両位置検出装置 |
| JP4326992B2 (ja) * | 2004-03-17 | 2009-09-09 | アルパイン株式会社 | 周辺車両識別方法及びこれを用いた走行支援システム |
| JP4742775B2 (ja) * | 2005-09-22 | 2011-08-10 | 日産自動車株式会社 | 他車両情報提供装置 |
| JP4062353B1 (ja) * | 2006-11-10 | 2008-03-19 | トヨタ自動車株式会社 | 障害物進路予測方法、装置、およびプログラム |
| JP4953012B2 (ja) | 2007-08-10 | 2012-06-13 | アイシン・エィ・ダブリュ株式会社 | 画像認識装置と画像認識装置のためのプログラム、及びこれを用いたナビゲーション装置とナビゲーション装置のためのプログラム |
| DE102008036131B4 (de) | 2007-08-29 | 2023-08-24 | Continental Autonomous Mobility Germany GmbH | Verfahren und Vorrichtung zur Erkennung der Verkehrssituation in einer Fahrzeugumgebung |
| JP5804676B2 (ja) * | 2010-06-29 | 2015-11-04 | ダイハツ工業株式会社 | 運転支援装置 |
| JP2013134567A (ja) | 2011-12-26 | 2013-07-08 | Suzuki Motor Corp | 運転支援装置 |
-
2015
- 2015-09-30 CN CN201580083504.7A patent/CN108140316B/zh active Active
- 2015-09-30 KR KR1020187009098A patent/KR102021709B1/ko not_active Expired - Fee Related
- 2015-09-30 CA CA2999814A patent/CA2999814A1/en not_active Abandoned
- 2015-09-30 BR BR112018006000-3A patent/BR112018006000A2/ja not_active IP Right Cessation
- 2015-09-30 MX MX2018003821A patent/MX383028B/es unknown
- 2015-09-30 US US15/763,350 patent/US10964217B2/en active Active
- 2015-09-30 WO PCT/JP2015/077783 patent/WO2017056247A1/ja not_active Ceased
- 2015-09-30 JP JP2017542606A patent/JP6521082B2/ja active Active
- 2015-09-30 EP EP15905401.4A patent/EP3358545B1/en active Active
- 2015-09-30 RU RU2018116014A patent/RU2703440C1/ru active
Also Published As
| Publication number | Publication date |
|---|---|
| EP3358545A4 (en) | 2018-10-10 |
| MX2018003821A (es) | 2018-06-18 |
| KR102021709B1 (ko) | 2019-09-16 |
| JPWO2017056247A1 (ja) | 2018-08-16 |
| WO2017056247A1 (ja) | 2017-04-06 |
| US20180286247A1 (en) | 2018-10-04 |
| MX383028B (es) | 2025-03-13 |
| EP3358545A1 (en) | 2018-08-08 |
| CN108140316A (zh) | 2018-06-08 |
| CA2999814A1 (en) | 2017-04-06 |
| KR20180048913A (ko) | 2018-05-10 |
| RU2703440C1 (ru) | 2019-10-16 |
| US10964217B2 (en) | 2021-03-30 |
| EP3358545B1 (en) | 2021-01-27 |
| BR112018006000A2 (ja) | 2018-10-30 |
| CN108140316B (zh) | 2020-08-18 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP6521082B2 (ja) | 走行制御方法および走行制御装置 | |
| JP6477903B2 (ja) | 走行制御方法および走行制御装置 | |
| US11113547B2 (en) | Planning control in response to a driving obstruction during operation of an autonomous driving vehicle (ADV) | |
| US20170337810A1 (en) | Traffic condition estimation apparatus, vehicle control system, route guidance apparatus, traffic condition estimation method, and traffic condition estimation program | |
| US11613253B2 (en) | Method of monitoring localization functions in an autonomous driving vehicle | |
| US12017681B2 (en) | Obstacle prediction system for autonomous driving vehicles | |
| US20150153184A1 (en) | System and method for dynamically focusing vehicle sensors | |
| JP6809531B2 (ja) | 車両判定方法、走行経路補正方法、車両判定装置、及び走行経路補正装置 | |
| JP7001169B2 (ja) | 運転計画表示方法及び運転計画表示装置 | |
| US11904890B2 (en) | Lane change system for lanes with different speed limits | |
| WO2019021437A1 (ja) | 走行支援方法及び走行支援装置 | |
| US11491976B2 (en) | Collision warning system for safety operators of autonomous vehicles | |
| WO2020008220A1 (ja) | 走行軌道生成方法及び走行軌道生成装置 | |
| WO2020148561A1 (ja) | 運転支援方法及び運転支援装置 | |
| US11588957B2 (en) | Dirty monocular camera detection methods for autonomous driving vehicle | |
| US11242057B2 (en) | Method for optimizing three-point turn of autonomous driving vehicles | |
| US12139134B2 (en) | Control and planning with localization uncertainty | |
| US11662219B2 (en) | Routing based lane guidance system under traffic cone situation | |
| JP7790248B2 (ja) | 走行制御方法及び走行制御装置 | |
| US20210096249A1 (en) | Front and side four-lidar design for autonomous driving vehicles |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| 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: 20190402 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20190415 |
|
| R151 | Written notification of patent or utility model registration |
Ref document number: 6521082 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |