JP6493364B2 - 運転支援装置 - Google Patents
運転支援装置 Download PDFInfo
- Publication number
- JP6493364B2 JP6493364B2 JP2016224957A JP2016224957A JP6493364B2 JP 6493364 B2 JP6493364 B2 JP 6493364B2 JP 2016224957 A JP2016224957 A JP 2016224957A JP 2016224957 A JP2016224957 A JP 2016224957A JP 6493364 B2 JP6493364 B2 JP 6493364B2
- Authority
- JP
- Japan
- Prior art keywords
- vehicle
- turn
- intersection
- turning
- host vehicle
- 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
- B60Q—ARRANGEMENT OF SIGNALLING OR LIGHTING DEVICES, THE MOUNTING OR SUPPORTING THEREOF OR CIRCUITS THEREFOR, FOR VEHICLES IN GENERAL
- B60Q9/00—Arrangement or adaptation of signal devices not provided for in one of main groups B60Q1/00 - B60Q7/00, e.g. haptic signalling
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60Q—ARRANGEMENT OF SIGNALLING OR LIGHTING DEVICES, THE MOUNTING OR SUPPORTING THEREOF OR CIRCUITS THEREFOR, FOR VEHICLES IN GENERAL
- B60Q9/00—Arrangement or adaptation of signal devices not provided for in one of main groups B60Q1/00 - B60Q7/00, e.g. haptic signalling
- B60Q9/008—Arrangement or adaptation of signal devices not provided for in one of main groups B60Q1/00 - B60Q7/00, e.g. haptic signalling for anti-collision purposes
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60R—VEHICLES, VEHICLE FITTINGS, OR VEHICLE PARTS, NOT OTHERWISE PROVIDED FOR
- B60R16/00—Electric or fluid circuits specially adapted for vehicles and not otherwise provided for; Arrangement of elements of electric or fluid circuits specially adapted for vehicles and not otherwise provided for
- B60R16/02—Electric or fluid circuits specially adapted for vehicles and not otherwise provided for; Arrangement of elements of electric or fluid circuits specially adapted for vehicles and not otherwise provided for electric constitutive elements
- B60R16/023—Electric or fluid circuits specially adapted for vehicles and not otherwise provided for; Arrangement of elements of electric or fluid circuits specially adapted for vehicles and not otherwise provided for electric constitutive elements for transmission of signals between vehicle parts or subsystems
- B60R16/0231—Circuits relating to the driving or the functioning of the vehicle
- B60R16/0232—Circuits relating to the driving or the functioning of the vehicle for measuring vehicle parameters and indicating critical, abnormal or dangerous conditions
-
- 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/87—Combinations of radar systems, e.g. primary radar and secondary radar
-
- 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
- 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/0104—Measuring and analyzing of parameters relative to traffic conditions
- G08G1/0108—Measuring and analyzing of parameters relative to traffic conditions based on the source of data
- G08G1/0112—Measuring and analyzing of parameters relative to traffic conditions based on the source of data from the vehicle, e.g. floating car data [FCD]
-
- 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/0104—Measuring and analyzing of parameters relative to traffic conditions
- G08G1/0125—Traffic data processing
- G08G1/0133—Traffic data processing for classifying traffic situation
-
- 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/04—Detecting movement of traffic to be counted or controlled using optical or ultrasonic detectors
-
- 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/052—Detecting movement of traffic to be counted or controlled with provision for determining speed or overspeed
-
- 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
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60Q—ARRANGEMENT OF SIGNALLING OR LIGHTING DEVICES, THE MOUNTING OR SUPPORTING THEREOF OR CIRCUITS THEREFOR, FOR VEHICLES IN GENERAL
- B60Q1/00—Arrangement of optical signalling or lighting devices, the mounting or supporting thereof or circuits therefor
- B60Q1/26—Arrangement of optical signalling or lighting devices, the mounting or supporting thereof or circuits therefor the devices being primarily intended to indicate the vehicle, or parts thereof, or to give signals, to other traffic
- B60Q1/34—Arrangement of optical signalling or lighting devices, the mounting or supporting thereof or circuits therefor the devices being primarily intended to indicate the vehicle, or parts thereof, or to give signals, to other traffic for indicating change of drive direction
- B60Q1/36—Arrangement of optical signalling or lighting devices, the mounting or supporting thereof or circuits therefor the devices being primarily intended to indicate the vehicle, or parts thereof, or to give signals, to other traffic for indicating change of drive direction using movable members, e.g. arms with built-in flashing lamps
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60Y—INDEXING SCHEME RELATING TO ASPECTS CROSS-CUTTING VEHICLE TECHNOLOGY
- B60Y2400/00—Special features of vehicle units
- B60Y2400/30—Sensors
- B60Y2400/301—Sensors for position or displacement
- B60Y2400/3017—Radars
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60Y—INDEXING SCHEME RELATING TO ASPECTS CROSS-CUTTING VEHICLE TECHNOLOGY
- B60Y2400/00—Special features of vehicle units
- B60Y2400/30—Sensors
- B60Y2400/303—Speed sensors
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60Y—INDEXING SCHEME RELATING TO ASPECTS CROSS-CUTTING VEHICLE TECHNOLOGY
- B60Y2400/00—Special features of vehicle units
- B60Y2400/30—Sensors
- B60Y2400/304—Acceleration sensors
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60Y—INDEXING SCHEME RELATING TO ASPECTS CROSS-CUTTING VEHICLE TECHNOLOGY
- B60Y2400/00—Special features of vehicle units
- B60Y2400/83—Steering input members
-
- 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/932—Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles using own vehicle data, e.g. ground speed, steering wheel direction
-
- 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/9327—Sensor installation details
- G01S2013/93271—Sensor installation details in the front of the 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
- 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/9327—Sensor installation details
- G01S2013/93274—Sensor installation details on the side of the vehicles
-
- 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/0104—Measuring and analyzing of parameters relative to traffic conditions
- G08G1/0108—Measuring and analyzing of parameters relative to traffic conditions based on the source of data
- G08G1/0116—Measuring and analyzing of parameters relative to traffic conditions based on the source of data from roadside infrastructure, e.g. beacons
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Mechanical Engineering (AREA)
- Computer Networks & Wireless Communication (AREA)
- Human Computer Interaction (AREA)
- Chemical & Material Sciences (AREA)
- Analytical Chemistry (AREA)
- Electromagnetism (AREA)
- Automation & Control Theory (AREA)
- Traffic Control Systems (AREA)
Description
自車両(100)に搭載された第1のセンサ装置(16L、16R)を用いて、前記自車両(100)の周辺に存在する物体の前記自車両(100)に対する位置と、前記物体の移動方向と、前記物体の移動速度と、を含む物体情報を取得する物体情報取得手段(ステップ1002、1302)と、
前記自車両(100)に搭載された第2のセンサ装置(15、17、13L、13R)を用いて、前記自車両(100)の車速である自車速(V)と、前記自車両(100)のヨーレート(Y)と、前記自車両(100)の方向指示器の状態を示す方向指示器信号と、を含む自車両情報を取得する自車両情報取得手段(601)と、
前記自車両情報に基いて、前記自車両(100)が左折又は右折を開始しようとしているか否かを判定する右左折開始判定手段(ステップ602、802)と、
前記自車両(100)が前記左折又は前記右折を開始しようとしていると一旦判定された場合、前記自車速(V)及び前記ヨーレート(Y)に基いて現時点における前記自車両(100)の予想経路を推定する予想経路推定手段(ステップ624、824)と、
前記物体情報と前記予想経路とに基づいて前記自車両(100)の運転者の注意を喚起するための要求信号を発生する注意喚起要求手段(ステップ1014、1320)と、
前記要求信号に応答して前記運転者の注意を喚起する作動を行う注意喚起手段(20、21、30、31)と、
を備える。
前記予想経路を表す予想経路式(fL、fR)として円の式を用いるように構成されている。この場合、その円の中心((Cx,Cy))は、前記自車両(100)の現在位置(OL、OR)から、前記自車両(100)の現時点の進行方向(TD)と直交する方向に、少なくとも現時点での前記ヨーレート(Y)を用いて推定される推定旋回半径(RL、RR)の長さだけ、前記自車両(100)が左折中のときは前記進行方向(TD)に対して左側に、前記自車両(100)が右折中のときは前記進行方向(TD)に対して右側に移動した位置である。更に、その円の半径は、前記推定旋回半径(RL、RR)である。
前記自車両(100)が前記左折又は前記右折を開始しようとしているとの判定が前記右左折開始判定手段(ステップ602、802)によりなされた時点から現時点までの前記自車両(100)の旋回角度(θtotal)を少なくとも前記ヨーレート(Y)を用いて算出し(ステップ614、814)、
左折又は右折を行う際に要する旋回角度から前記算出された旋回角度(θtotal)を減算した角度であって、左折又は右折を終了するまでに必要な角度、である旋回残余角度と前記推定旋回半径(R、Rest)との積に基づく値を前記予想経路の有効長さ(LLe、LRe)として算出し(ステップ626、826)、
前記予想経路の前記有効長さ(LLe、LRe)以内の部分に所定時間以内に交差する物体である注意喚起対象物体が存在するか否かを前記物体情報を用いて判定し、当該注意喚起対象物体が存在すると判定した場合に前記要求信号を発生するように構成されている(ステップ1014、1320)。
前記右左折開始判定手段は、
前記自車速が所定の第1車速閾値(V1th)以上あり且つ当該第1車速閾値よりも高い第2車速閾値(V2th)以下である場合に前記方向指示器信号により前記方向指示器が非作動状態から作動状態へと変化したことが示された場合に成立する条件、
前記方向指示器信号により前記方向指示器が作動状態であることが示されている場合に前記自車速が前記第1車速閾値(V1th)以上あり且つ前記第2車速閾値(V2th)以下となった場合に成立する条件、及び、
前記自車速が前記第1車速閾値(V1th)以上であり且つ前記第2車速閾値(V2th)以下となると同時に、前記方向指示器信号により前記方向指示器が非作動状態から作動状態へと変化したことが示された場合に成立する条件、
の少なくとも一つの条件について、当該少なくとも一つの条件のうちの何れか一つが成立したと判定したときに、前記自車両(100)が左折又は右折を開始しようとしているか否かを判定するように構成されている(ステップ602、ステップ802)。
前記予想経路推定手段は、
現時点における前記自車両(100)の左端(OL)が通過すると予想される左側予想経路と、現時点における前記自車両(100)の右端(OR)が通過すると予想される右側予想経路と、を前記予想経路として推定し(ステップ624、824)、
前記左側予想経路を表す左側予想経路式(fL)及び前記右側予想経路を表す右側予想経路式(fR)として円の式を用いるように構成されている。
右側予想経路式(fR)の円の中心(Cx,Cy)は、前記自車両(100)の前記右端(OR)から、前記自車両(100)の現時点の進行方向(TD)と直交する方向に、前記推定旋回半径として算出される前記右端(OR)の旋回半径である右側旋回半径(RR)の長さだけ、前記自車両(100)が左折中のときは前記進行方向(TD)に対して左側に、前記自車両(100)が右折中のときは前記進行方向(TD)に対して右側に移動した位置であり、その円の半径は、前記右側旋回半径(RR)である。
前記旋回残余角度と前記左側旋回半径(RL)との積に基づく値を前記左側予想経路の前記有効長さである左側有効長さ(LLe)として算出し、
前記旋回残余角度と前記右側旋回半径(RR)との積に基づく値を前記右側予想経路の前記有効長さである右側有効長さ(LRe)として算出するように構成されている(ステップ626、826)。
前記注意喚起要求手段は、
前記物体情報取得手段で取得された前記物体情報に基づいて、前記物体の現時点の移動方向に延びる直線の式(g)を算出し(ステップ1004)、
前記直線の式(g)により表される直線が、前記左側予想経路の前記有効長さ(LLe)以内の部分と、前記右側予想経路の前記有効長さ(LRe)以内の部分と、の少なくとも一方と1又は2個の第1交点で交差している場合、
前記第1交点が2個のときには、前記2個の第1交点のうち、前記直線が、前記物体の現時点の移動方向において最初に交差している交点(P)に前記物体が到達するまでの第1時間(t1)を算出し(ステップ1010)、
前記第1交点が1個のときには、前記物体が前記第1交点に到達するまでの第1時間(t1)を算出し(ステップ1010)、
前記第1時間(t1)が第1所定時間以下であるという時間条件が成立している場合に、前記注意喚起対象物体が存在すると判定して前記要求信号を発生するように構成されている(ステップ1014)。
前記注意喚起要求手段は、
前記物体情報取得手段で取得された前記物体情報に基づいて、前記物体の現時点の移動方向に延びる直線の式(g)を算出し(ステップ1304)、
前記直線の式(g)により表される直線が、前記左側予想経路式(fL)により表される第1の円と、前記右側予想経路式(fR)により表される第2の円と、の少なくとも一方と2又は4個の第2交点で交差している場合、
前記第2交点が4個のときには、前記4個の第2交点のうちの2個の交点であって、前記直線の式(g)により表される直線が、前記物体の現時点の移動方向において、前記第1の円と前記第2の円との間の領域である対象領域(r)の外から当該対象領域(r)の中に進入する部分で前記第1の円又は前記第2の円と交差している2個の交点(Q1、Q2)、を特定し、前記自車両(100)の前記左端(OL)から前記特定された2個の交点(Q1、Q2)のうちの前記左側予想経路上の交点までの前記自車両(100)の旋回方向における当該左側予想経路に沿った長さ(LL1、LL2)と、前記自車両(100)の前記右端(OR)から前記特定された2個の交点(Q1、Q2)のうちの前記右側予想経路上の交点までの前記自車両(100)の旋回方向における当該右側予想経路に沿った長さ(LR1、LR2)と、のうち、より短い長さを有する交点を対象交点(Qt)として抽出し(ステップ1312)、前記物体が当該抽出した対象交点(Qt)に到達するまでの第2時間(t2)を算出し(ステップ1314)、
前記第2交点が2個のときには、前記2個の第2交点のうちの1個の交点であって、前記直線の式(g)により表される直線が、前記物体の現時点の移動方向において、前記対象領域(r)の外から前記対象領域(r)の中に進入する部分で前記第1の円又は前記第2の円と交差している1個の交点(Q)、を抽出し、前記物体が当該抽出した交点(Q)に到達するまでの第2時間(t2)を算出し(ステップ1314)、
前記第2時間(t2)が第2所定時間以下であるという時間条件が成立しているか否かを判定し(ステップ1316)、
前記時間条件が成立していると判定された交点が前記左側予想経路上に位置している場合、前記自車両の前記左端から当該判定された交点までの前記自車両の旋回方向における当該左側予想経路に沿った長さが前記左側予想経路の前記左側有効長さ以下である、又は、
前記時間条件が成立していると判定された交点が前記右側予想経路上に位置している場合、前記自車両の前記右端から当該判定された交点までの前記自車両の旋回方向における当該右側予想経路に沿った長さが前記右側予想経路の前記右側有効長さ以下である、
という長さ条件が成立している場合に、前記注意喚起対象物体が存在すると判定して前記要求信号を発生するように構成されている(ステップ1320)。
以下、図面を参照しながら第1実施形態に係る車両の運転支援装置(以下、「第1実施装置」と称する。)について説明する。第1実施装置は、図1に示した車両100に適用される。第1実施装置は、運転支援ECU10、表示ECU20及び警報ECU30を備える。
次に、第1実施装置の作動の概要について説明する。以下では、車両100が旋回場所で左折又は右折するときの第1実施装置の作動について説明する。なお、「旋回場所」とは、交差点、駐車場の入口が隣接している道路、施設の駐車場等である。以下では、交差点を例に挙げて説明する。車両100が交差点で左折又は右折する場合は、まず、車両100は交差点で左折又は右折を開始しようとし、その後、実際に左折又は右折を行い、最後に、左折又は右折を終了する。このとき、車両100の予想経路を歩行者及び他車両等の物体が横切ることがある。第1実施装置は、車両100が左折又は右折する場合、交差点内における車両100の予想経路が円弧形状になると仮定して、当該予想経路を推定する。具体的には、第1実施装置は、交差点での車両100の旋回角度θtotal(後述)を算出し、当該旋回角度θtotalに基づいて旋回残余角度を算出し、当該旋回残余角度に基づいて当該予想経路の有効長さを算出する。そして、第1実施装置は、当該予想経路の有効長さ以内の部分を物体が横切る可能性がある場合、表示装置21及びブザー31を用いて運転者に対して注意喚起を行う。
左折開始条件は、以下の条件Ls1、Ls2及びLs3のうちの何れか1つが成立した場合に成立する。
(条件Ls1)車速Vが第1車速閾値V1th以上且つ第2車速閾値V2th以下である場合(V1th≦V≦V2th)に、左側方向指示器が不灯状態から点滅状態へと変化する。
なお、第1車速閾値V1th及び第2車速閾値V2thは、車両100が左折を開始しようとしているときの一般的な速度範囲の下限値及び上限値のそれぞれになるように予め設定されている。これは、右折についても同様である。例えば、第1車速閾値V1th及び第2車速閾値V2thは、それぞれ0km/h及び20km/hである。
(条件Ls2)左側方向指示器が点滅状態である場合に、車速Vが第1車速閾値V1th以上であり且つ第2車速閾値V2th以下の速度に変化する。
(条件Ls3)車速Vが第1車速閾値V1th以上であり且つ第2車速閾値V2th以下の速度に変化すると同時に、左側方向指示器が不灯状態から点滅状態へと変化する。
右折開始条件は、以下の条件Rs1、Rs2及びRs3のうちの何れか1つが成立した場合に成立する。
(条件Rs1)車速Vが第1車速閾値V1th以上であり且つ第2車速閾値V2th以下である場合(V1th≦V≦V2th)に、右側方向指示器が不灯状態から点滅状態へと変化する。
(条件Rs2)右側方向指示器が点滅状態である場合に、車速Vが第1車速閾値V1th以上であり且つ第2車速閾値V2th以下の速度に変化する。
(条件Rs3)車速Vが第1車速閾値V1th以上であり且つ第2車速閾値V2th以下の速度に変化すると同時に、右側方向指示器が不灯状態から点滅状態へと変化する。
左折状態開始条件は、以下の条件Lt1乃至Lt6の条件が全て成立した場合に成立する。
(条件Lt1)車速Vが下限車速閾値VLth以上であり且つ上限車速閾値VUth以下である(VLth≦V≦VUth)。
なお、下限車速閾値VLth及び上限車速閾値VUthは、車両100が実際に左折を行うときの一般的な速度範囲の下限値及び上限値のそれぞれになるように予め設定されている。これは、右折についても同様である。加えて、下限車速閾値VLthは第1車速閾値V1thよりも大きく、且つ、上限車速閾値VUthは第2車速閾値V2th以下になるように予め設定されている(VLth>V1th、VUth≦V2th)。例えば、下限車速閾値VLth及び上限車速閾値VUthは、それぞれ5km/h及び20km/hである。
(条件Lt2)前後加速度Gxがゼロ以上であり且つ加速閾値Gxaよりも小さいか、或いは、前後加速度Gxがゼロよりも小さく且つその前後加速度Gxの絶対値が減速閾値Gxdよりも小さい。
例えば、加速閾値Gxa及び減速閾値Gxdは、それぞれ4m/s2及び4m/s2である。
(条件Lt3)アクセルペダル操作量APが操作量閾値APthよりも小さい。
例えば、操作量閾値APthは、2%である。
(条件Lt4)ヨーレートYがゼロよりも大きく且つ右左折判定閾値Yth(旋回開始指標閾値)よりも大きい。
例えば、右左折判定閾値Ythは、8°/secである。
(条件Lt5)横加速度Gyがゼロよりも大きく且つ右左折判定閾値Gythよりも大きい。
例えば、右左折判定閾値Gythは、3m/s2である。
(条件Lt6)操舵角θswがゼロよりも大きく且つ右左折判定閾値θswthよりも大きい。
例えば、右左折判定閾値θswthは、45°である。
右折状態開始条件は、以下の条件Rt1乃至Rt6の条件が成立した場合に成立する。
(条件Rt1)車速Vが下限車速閾値VLth以上であり且つ上限車速閾値VUth以下である(VLth≦V≦VUth)。
(条件Rt2)前後加速度Gxがゼロ以上であり且つ上記加速閾値Gxaよりも小さいか、或いは、前後加速度Gxがゼロよりも小さく且つその前後加速度Gxの絶対値が上記減速閾値Gxdよりも小さい。
(条件Rt3)アクセルペダル操作量APが上記閾値操作量閾値APthよりも小さい。
(条件Rt4)ヨーレートYがゼロよりも小さく且つその絶対値が上記右左折判定閾値Ythよりも大きい。
(条件Rt5)横加速度Gyがゼロよりも小さく且つその絶対値が上記右左折判定閾値Gythよりも大きい。
(条件Rt6)操舵角θswがゼロよりも小さく且つその絶対値が上記右左折判定閾値θswthよりも大きい。
以下では、車両100が左折を開始しようとしているがまだ実際には左折を行っていないと判定された場合を「ケースL1」とも称する。加えて、車両100が実際に交差点で左折していると判定された場合を「ケースL2」とも称する。
以下では、車両100が右折を開始しようとしているがまだ実際には右折を行っていないと判定された場合を「ケースR1」とも称する。加えて、車両100が実際に交差点で右折していると判定された場合を「ケースR2」とも称する。
第1実施装置は、後述するように、予想経路を推定するために車両100のヨーレートYを使用する。但し、ヨーレートセンサ17により検出されるヨーレートYは安定していない。そこで、第1実施装置は、車両100が左折又は右折を開始しようとしていると判定された場合、左折又は右折が終了したと判定されるまで、所定演算時間Tcalの経過ごとにヨーレートYを平滑化し、平滑化された値を平滑ヨーレートYsとして算出する。
但し、車両100が左方向に旋回しているときのヨーレートYの符号(正の値)と、車両100が右方向に旋回しているときのヨーレートYの符号(負の値)は異なる。そこで、第1実施装置は、左折時は、下記の式(1L)又は式(2L)に則って平滑ヨーレートYsを算出し、右折時は、下記の式(1R)又は式(2R)に則って平滑ヨーレートYsを算出する。なお、Mは所定の正の整数である。
(左折時)
n≧Mのとき、Ys(n)={Y(n-(M-1))+・・・+Y(n-1)+Y(n)}/M…(1L)
n<Mのとき、Ys(n)={Y(0)+・・・+Y(n-1)+Y(n)}/(n+1)…(2L)
(右折時)
n≧Mのとき、Ys(n)={(-Y(n-(M-1)))+・・・+(-Y(n-1))+(-Y(n))}/M…(1R)
n<Mのとき、Ys(n)={(-Y(0))+・・・+(-Y(n-1))+(-Y(n))}/(n+1)…(2R)
一方、車両100が右折を開始しようとしていると判定された場合、第1実施装置は、n≧Mのとき、n周期目の平滑ヨーレートYs(n)を、最新のヨーレートY(n)に−1を乗じた値(即ち、Y(n)の符号を反転した値)を含む、直近に取得されたM個のヨーレートYのそれぞれに−1を乗じた値の平均値として算出する。第1実施装置は、n<Mのとき、n周期目の平滑ヨーレートYs(n)を、Y(0)からY(n)までのn+1個のヨーレートYのそれぞれに−1を乗じた値の平均値として算出する。
なお、左折時及び右折時の平滑ヨーレートYsは常に正の値とは限らない。即ち、例えば、車両100の左折時であっても、一時的に車両100が右方向に旋回した場合(例えば、ステアリングハンドル14aが一時的に車両を右折させる方向に回転された場合)、その周期におけるヨーレートYは負の値となる。このとき、式(1L)又は式(2L)に則って算出される平滑ヨーレートYsが負の値となる場合もある。同様に、車両100の右折時であっても、一時的に車両100が左方向に旋回した場合(例えば、ステアリングハンドル14aが一時的に車両を左折させる方向に回転された場合)、その周期におけるヨーレートYは正の値となるため、当該ヨーレートYに−1を乗じると負の値となる。このとき、式(1R)又は式(2R)に則って算出される平滑ヨーレートYsが負の値となる場合もある。
Y(i)(i:a〜b−1)≠0、且つ、Y(b)=0のとき、Ys(b)=0…(3)
Y(j)(j:b+1〜d)=0のとき、Ys(j)=0…(4)
(左折時)
Y(k)(k:d+1〜n)≠0のとき、
n−d≧Mのとき、Ys(n)={Y(n-(M-1))+・・・+Y(n-1)+Y(n)}/M…(5L)
n−d<Mのとき、Ys(n)={Y(d+1)+・・・+Y(n-1)+Y(n)}/(n−d)…(6L)
(右折時)
Y(k)(k:d+1〜n)≠0のとき、
n−d≧Mのとき、Ys(n)={(-Y(n-(M-1)))+・・・+(-Y(n-1))+(-Y(n))}/M…(5R)
n−d<Mのとき、Ys(n)={(-Y(d+1))+・・・+(-Y(n-1))+(-Y(n))}/(n−d)…(6R)
一方、車両100が右折を開始しようとしていると判定された場合において、上記と同一の状況では、第1実施装置は、ノンゼロ値のヨーレートの個数が連続してM個以上であるときは、n周期目の平滑ヨーレートYs(n)を、直近に取得されたM個のヨーレートYのそれぞれに−1を乗じた値の平均値として算出する。第1実施装置は、ノンゼロ値のヨーレートの個数が連続してM個に満たないときは、n周期目の平滑ヨーレートYs(n)を、d+1周期目以降の全てのノンゼロ値のヨーレートYのそれぞれに−1を乗じた値の平均値として算出する。
<<瞬時旋回角度θの算出>>
第1実施装置は、後述するように、予想経路の有効長さを算出するために、車両100が0周期目からn周期目までの間に旋回した角度である旋回角度θtotal(n)を使用する。第1実施装置は、この旋回角度θtotal(n)を算出するために、車両100が所定演算時間Tcalの間に旋回した角度である瞬時旋回角度θを使用する。第1実施装置は、この瞬時旋回角度θを、下記式(7)及び式(8)に則って算出する。
n=0のとき、θ(0)=0°…(7)
n≧1のとき、θ(n)=Ys(n)・Tcal…(8)
即ち、第1実施装置は、車両100が左折又は右折を開始しようとしていると判定された時点の周期(n=0)では、瞬時旋回角度θ(0)をゼロに設定する。そして、それ以降(n≧1)は、第1実施装置は、車両100が左折又は右折を終了したと判定されるまで、n周期目の瞬時旋回角度θ(n)を、平滑ヨーレートYs(n)と所定演算時間Tcalとの積として算出する。
第1実施装置は、0周期目からn周期目までの間に車両100が旋回した旋回角度θtotal(n)を、下記式(9)及び式(10)に則って算出する。
n=0のとき、θtotal(0)=0°…(9)
n≧1のとき、θtotal(n)=θtotal(n-1)+θ(n)…(10)
即ち、第1実施装置は、車両100が左折又は右折を開始しようとしていると判定された時点の周期(n=0)では、旋回角度θtotal(0)を0°に設定(初期化)する。そして、それ以降(n≧1)は、第1実施装置は、旋回角度θtotal(n)を、直前の旋回角度θtotal(n-1)に瞬時旋回角度θ(n)を加えることにより算出する。これにより、車両100が交差点で左折又は右折する際の旋回角度を適切に算出することができる。
第1実施装置は、後述するように2つの予想経路を推定する。この2つの予想経路は、半径の異なる2つの円の式により表される。これら2つの円の半径は、それぞれ、車両100の位置O(図2参照)が通過すると予想される円の半径である旋回半径Rに基づいて算出される。第1実施装置は、この旋回半径Rを、車両100が左折又は右折を開始しようとしていると判定されてから左折又は右折が終了したと判定されるまで、所定演算時間Tcalの経過ごとに下記式(11)乃至式(14)に則って算出する。
(ケースL1、ケースR1)
Ys(n)≦Y0のとき、R(n)=12700m…(11)
Ys(n)>Y0のとき、R(n)=V(n)/Ys(n)…(12)
(ケースL2、ケースR2)
Ys(n)≦Y0のとき、R(n)=R(c)…(13)
Ys(n)>Y0のとき、R(n)=V(n)/Ys(n)…(14)
これに対し、第1実施装置は、平滑ヨーレートYs(n)≦Y0の場合、ケースL1又はケースR1のときと、ケースL2又はケースR2のときとで旋回半径R(n)の算出方法を切り替える。ここで、平滑ヨーレートYs(n)≦Y0の場合とは、典型的には以下の場合である。
・車両100が一時停止している場合。
・車両100が直進している場合。
・車両100が右折又は左折しようとしている方向とは反対方向に車両100が(少なくとも一時的に)旋回した結果、平滑ヨーレートYsが負の値として算出される場合。
なお、ケースL1及びケースR1において平滑ヨーレートYs(n)≦Y0のときの旋回半径R(n)の値は12700mに限られない。当該R(n)には、一般的な交差点における車両100の旋回半径に比べて大幅に大きい任意の値が設定され得る。
第1実施装置は、旋回半径R(n)に基づいて、ケースL1、L2におけるn周期目の車両100の旋回中心座標(Cx(n),Cy(n))及びケースR1、R2におけるn周期目の車両100の旋回中心座標(Cx(n),Cy(n))をそれぞれ以下に述べるように算出する。
即ち、第1実施装置は、ケースL1、L2における旋回中心座標(Cx(n),Cy(n))を、原点O(n)から、n周期目の車両100の進行方向と直交する方向に、旋回半径R(n)の長さだけ、当該進行方向に対して左側に移動した位置として算出する。なお、「n周期目の車両100の進行方向」は、n周期目の平滑ヨーレートYs(n)から算出され得る。
一方、第1実施装置は、ケースR1、R2における旋回中心座標(Cx(n),Cy(n))を、原点O(n)から、n周期目の車両100の進行方向TDと直交する方向に、旋回半径R(n)の長さだけ、当該進行方向TDに対して右側に移動した位置として算出する(図4参照)。
第1実施装置は、旋回半径R(n)に基づいて、左側旋回半径RL(n)及び右側旋回半径RR(n)を、下記の式(15)乃至式(18)に則って算出する。
(ケースL1、L2)
RL(n)=R(n)−w/2…(15)
RR(n)=R(n)+w/2…(16)
(ケースR1、R2)
RL(n)=R(n)+w/2…(17)
RR(n)=R(n)−w/2…(18)
なお、wは第1実施装置が搭載される予定の車両ごとに予め設定されている。しかしながら、wは車幅よりも大きい長さであってもよいし、車幅よりも小さい長さであってもよい。
第1実施装置は、車両100が左折又は右折を開始しようとしていると判定された場合、左折又は右折が終了したと判定されるまで、所定演算時間Tcalの経過ごとに、車両100の左端OLが通過すると予想される予想経路(左側予想経路)と、車両100の右端ORが通過すると予想される予想経路(右側予想経路)と、をそれぞれ推定する。第1実施装置は、n周期目の左側予想経路を表す左側予想経路式fL(n)と、n周期目の右側予想経路を表す右側予想経路式fR(n)と、を下記式(19)及び式(20)に則って算出する(図4参照)。
(左側予想経路式fL(n))
(x−Cx(n))2+(y−Cy(n))2=RL(n)2…(19)
(右側予想経路式fR(n))
(x−Cx(n))2+(y−Cy(n))2=RR(n)2…(20)
なお、上述したように、ケースL1又はケースR1において平滑ヨーレートYs(n)≦Y0(=10−6)のときは、R(n)=12700mである(式(11)参照)。このため、この場合の左側予想経路式fL(n)及び右側予想経路式fR(n)は、図3に示すように、いずれもn周期目の車両100の進行方向TDに延びる直線の式に近似される。
第1実施装置は、後述する注意喚起を、左側予想経路の有効長さLLe以内の部分及び右側予想経路の有効長さLRe以内の部分の少なくとも一方に所定時間以内に交差する物体が存在する場合に行う。第1実施装置は、車両100が左折又は右折を開始しようとしていると判定された場合、左折又は右折が終了したと判定されるまで、所定演算時間Tcalの経過ごとに、当該左側予想経路の有効長さLLe及び当該右側予想経路の有効長さLReを、下記式(21)乃至式(23)に則って算出する。以下では、左側予想経路の有効長さLLeを単に「左側有効長さLLe」とも称し、右側予想経路の有効長さLReを単に「右側有効長さLRe」とも称する。
(ケースL1、ケースR1においてYs(n)≦Y0)
LLe(n)=LRe(n)=15m…(21)
(ケースL1、ケースR1においてYs(n)>Y0、又はケースL2、ケースR2)
LLe(n)=RL(n)・(90°−θtotal(n))・π/180°…(22)
LRe(n)=RR(n)・(90°−θtotal(n))・π/180°…(23)
第1実施装置は、車両100が左折又は右折を開始しようとしていると判定された場合、左折又は右折が終了したと判定されるまで、所定演算時間Tcalの経過ごとに、車両100の周辺に存在する物体の物体情報(車両100に対する物体の位置、物体の移動方向及び物体の移動速度)を取得する。図5の例では、第1実施装置は、n周期目の車両100の周辺に存在する物体A、B、C及びDのn周期目の物体情報をそれぞれ取得する。
第1実施装置は、物体情報に基づいて、その物体の位置からその移動方向に延びる半直線の予想経路式gを算出する。図5の例では、第1実施装置は、物体A〜Dのn周期目の物体情報に基づいて、物体A〜Dのそれぞれの位置から、それぞれの移動方向(図5の矢印参照)に延びるn周期目の予想経路式ga(n)、gb(n)、gc(n)及びgd(n)をそれぞれ算出する。以下、予想経路式g(n)を、単に「式g(n)」とも称する。この場合、式g(n)は、式ga(n)、gb(n)、gc(n)及びgd(n)の何れかである。
第1実施装置は、式g(n)によって表される直線が、左側予想経路の左側有効長さLLe(n)以内の部分と、右側予想経路の右側有効長さLRe(n)以内の部分と、の少なくとも一方と交差しているという条件(以下、「第1交差条件」とも称する。)が成立しているか否かを判定する。なお、本明細書では、「2つの線が交差している」とは、一方の線が他方の線を横切っている場合を意味しており、2つの線が接している場合は含まれない。
図5の例では、式ga(n)によって表される直線は、太い実線により示された左側有効長さLLe(n)以内の部分と点A1で交差しているとともに、太い実線により示された右側有効長さLRe(n)以内の部分と点A2で交差している。このため、式ga(n)は第1交差条件を満たしている。式gb(n)によって表される直線は、左側有効長さLLe(n)以内の部分と点B1で交差しているため、式gb(n)は、第1交差条件を満たしている。これに対し、式gc(n)及び式gd(n)によって表される直線は、左側有効長さLLe(n)以内の部分及び右側有効長さLRe(n)以内の部分の何れとも交差していないため、式gc(n)及び式gd(n)は、第1交差条件を満たしていない。
第1実施装置は、式g(n)が第1交差条件を満たしている場合、式g(n)によって表される直線が左側有効長さLLe(n)以内の部分及び/又は右側有効長さLRe(n)以内の部分と交差している交点(第1交点)の数を算出する。
交点の数が2個の場合、第1実施装置は、式g(n)によって表される直線が、物体の移動方向において最初に交差している交点の座標を、交点P(n)の座標として算出する。
一方、交点の数が1個の場合、第1実施装置は、当該交点の座標を、交点P(n)の座標として算出する。
図5の例では、上述したように、式ga(n)については交点の数が点A1、A2の2個である。このため、第1実施装置は、式ga(n)によって表される直線が物体Aの移動方向(図5の下方向)に最初に交差している交点A1の座標を、交点Pa(n)の座標として算出する。一方、式gb(n)については交点の数が点B1の1個である。このため、第1実施装置は、当該交点B1の座標を、交点Pb(n)の座標として算出する。
第1実施装置は、時間条件が成立するか否かを判定するために、物体が予想経路に到達すると予想される時間t1を算出する。具体的には、第1実施装置は、式g(n)によって表される直線が左側有効長さLLe(n)以内の部分又は右側有効長さLRe(n)以内の部分と交点P(n)で交差している物体について、その物体が交点P(n)に到達するまでの時間t1(n)(第1時間)を算出する。時間t1(n)は、その物体のn周期目の位置から交点P(n)までの直線の長さを、その物体のn周期目の移動速度v(n)で除することにより算出される。
図5の例では、第1実施装置は、物体Aが交点Pa(n)に到達するまでの時間t1a(n)及び物体Bが交点Pb(n)に到達するまでの時間t1b(n)をそれぞれ算出する。
第1実施装置は、時間t1(n)が第1所定時間(本例では4秒)以下であるという時間条件が成立しているか否かを判定する。第1実施装置は、何れかの式g(n)についてこの時間条件が成立している場合、対象物体が存在すると判定する。一方、第1実施装置は、いずれの式g(n)についてもこの時間条件が成立していない場合、対象物体が存在しないと判定する。
図5の例において、例えば、t1a(n)=3秒、t1b(n)=10秒の場合、時間t1a(n)が第1所定時間以下であり、式ga(n)について時間条件が成立しているため、第1実施装置は、対象物体(即ち、物体A)が存在すると判定する。一方、例えば、t1a(n)=5秒、t1b(n)=10秒の場合、両方とも第1所定時間を超過しており、いずれの式ga(n)及びgb(n)についても時間条件が成立していないため、第1実施装置は、対象物体が存在しないと判定する。
第1実施装置は、対象物体が存在すると判定した場合は、要求信号を発生して注意を喚起する作動を行い、対象物体が存在しないと判定した場合は、要求信号は発生せず、従って、注意を喚起する作動は行わない。
次に、第1実施装置の具体的な作動について説明する。第1実施装置の運転支援ECU10のCPUは、図6乃至図9にフローチャートにより示したルーチンを所定演算時間Tcalの経過毎に実行するようになっている。以下では、運転支援ECU10のCPUを単に「CPU」と称し、表示ECU20のCPUを「表示CPU」と称し、警報ECU30のCPUを「警報CPU」と称する。
ステップ606:CPUは、旋回角度θtotalを0°に初期化する(θtotal(0)=0°。式(9)参照。)。ステップ606の処理は、ステップ602において「Yes」と判定された場合に実行される。このため、旋回角度θtotalの初期化は、左折開始条件が成立したときに1回のみ行われ、その後は、車両100が左折を終了するまでは行われない。
ステップ608:CPUは、運転支援ECU10のRAMに格納されているヨーレートY(n)に基づいて、上述したようにしてn周期目の平滑ヨーレートYs(n)を算出し、当該RAMに格納する(式(1L)、(2L)、(3)、(4)、(5L)及び(6L)参照)。
ステップ612:CPUは、上述したようにして0周期目からn周期目までに車両100が旋回した旋回角度θtotal(n)を算出し、運転支援ECU10のRAMに格納する(式(9)及び(10)参照)。
ステップ620:CPUは、ステップ618で算出された旋回半径R(n)に基づいて、上述したようにしてn周期目の旋回中心座標(Cx(n),Cy(n))を算出し、運転支援ECU10のRAMに格納する。
ステップ622:CPUは、ステップ618で算出された旋回半径R(n)から、車両100の半車幅長w/2を減ずることにより、n周期目の左側旋回半径RL(n)を算出する(式(15)参照)。加えて、CPUは、ステップ618で算出された旋回半径R(n)に、車両100の半車幅長w/2を加えることにより、n周期目の右側旋回半径RR(n)を算出する(式(16)参照)。CPUは、これらの左側旋回半径RL(n)及び右側旋回半径RR(n)を運転支援ECU10のRAMに格納する。
ステップ1004:CPUは、ステップ1002で取得された物体情報に基づいて、物体のn周期目の予想経路式g(n)を算出し、運転支援ECU10のRAMに格納する。
ステップ1010:CPUは、上述したようにして、物体が交点P(n)に到達するまでの時間t1(n)を算出し、運転支援ECU10のRAMに格納する。
・車両100が左折するために信号待ちで停止している場合。
・車両100が左折を開始しようとしてから旋回が可能な地点まで直進している場合。
・車両100が左折を開始しようとしてから旋回が可能な地点まで直進しているときに、車両100が一時的に右方向に旋回し、その結果、平滑ヨーレートYsが負の値として算出された場合。
ステップ632:CPUは、ステップ630で設定された旋回半径R(n)に基づいて、上述したようにしてn周期目の旋回中心座標(Cx(n),Cy(n))を算出し、運転支援ECU10のRAMに格納する。
・前回の左折又は前回の右折が終了したと判定された後に左折開始条件が成立したと初めて判定された後、ステップ602の判定が行われる場合。
・前回の左折又は前回の右折が終了したと判定された後、左折開始条件が一度も成立していない場合。
ステップ650:CPUは、ステップ612と同一の処理を行い、旋回角度θtotal(n)を算出する(式(10)参照)。
・車両100が実際に左折を開始してから、交差点の中央付近で対向車及び歩行者等の通過を待つために一時停止している場合。
・車両100が実際に左折を開始した後で、車両100が一時的に右方向に旋回し、その結果、平滑ヨーレートYsが負の値として算出された場合。
ステップ806:CPUは、旋回角度θtotalを0°に初期化する(式(9)参照。)。旋回角度θtotalの初期化は、右折開始条件が成立したときに1回のみ行われ、その後は、車両100が右折を終了するまでは行われない。
ステップ808:CPUは、運転支援ECU10のRAMに格納されているヨーレートY(n)に−1を乗じた値に基づいて、上述したようにしてn周期目の平滑ヨーレートYs(n)を算出する(式(1R)、(2R)、(3)、(4)、(5R)及び(6R)参照)。
ステップ812:CPUは、ステップ612と同一の処理を行い、旋回角度θtotal(n)を算出する(式(9)及び(10)参照)。
ステップ820:CPUは、ステップ620と同一の処理を行い、n周期目の旋回中心座標(Cx(n),Cy(n))を算出する。なお、ステップ620におけるステップ618は、本ステップではステップ818に置き換えられる。
ステップ822:CPUは、ステップ818で算出された旋回半径R(n)に、車両100の半車幅長w/2を加えることにより、n周期目の左側旋回半径RL(n)を算出する(式(17)参照)。加えて、CPUは、ステップ818で算出された旋回半径R(n)から、車両100の半車幅長w/2を減ずることにより、n周期目の右側旋回半径RR(n)を算出する(式(18)参照)。CPUは、これらの左側旋回半径RL(n)及び右側旋回半径RR(n)を運転支援ECU10のRAMに格納する。
・車両100が右折するために信号待ちで停止している場合。
・車両100が右折を開始しようとしてから旋回が可能な地点まで直進している場合。
・車両100が右折を開始しようとしてから旋回が可能な地点まで直進しているときに、車両100が一時的に左方向に旋回し、その結果、平滑ヨーレートYsが負の値として算出された場合。
ステップ832:CPUは、ステップ632と同一の処理を行い、n周期目の旋回中心座標(Cx(n),Cy(n))を算出する。なお、ステップ632におけるステップ630は、本ステップでは、ステップ830に置き換えられる。
・前回の左折又は前回の右折が終了したと判定された後に右折開始条件が成立したと初めて判定された後、ステップ802の判定が行われる場合。
・前回の左折又は前回の右折が終了したと判定された後、右折開始条件が一度も成立していない場合。
ステップ850:CPUは、ステップ812と同一の処理を行い、旋回角度θtotal(n)を算出する(式(10)参照)。
・車両100が実際に右折を開始してから、交差点の中央付近で対向車及び歩行者等の通過を待つために一時停止している場合。
・車両100が実際に右折を開始した後で、車両100が一時的に左方向に旋回し、その結果、平滑ヨーレートYsが負の値として算出された場合。
加えて、第1実施装置は、左側予想経路の左側有効長さLLeを、旋回残余角度(90°−旋回角度θtotal)と左側旋回半径RLとの積に基づく値を用いて算出し、右側予想経路の右側有効長さLReを、旋回残余角度と右側旋回半径RRとの積に基づく値を用いて算出する。別言すれば、左側有効長さLLeは、左側予想経路式fLによって表される円のうち、旋回残余角度(90°−旋回角度θtotal)に対応する円弧の長さであり、右側有効長さLReは、右側予想経路式fRによって表される円のうち、旋回残余角度に対応する円弧の長さである。
即ち、第1実施装置によれば、左側有効長さLLe及び右側有効長さLReは、車両100の旋回角度θtotalに基づいて算出され、それらの有効長さLLe及びLReは、旋回角度θtotalが大きくなるほど(即ち、交差点での左折又は右折が進行するほど)短くなる。このため、予想経路の有効長さLLe及びLRe以内の部分が、車両100が進入する予定の車線を越えて、その予定の車線に対する対向車線又はその対向車線に付随する歩道に及ぶ可能性を大幅に低減できる。これによれば、GNSS及び/又は無線通信による自己位置推定ができない場合であっても、車両100が交差点で左折又は右折状態にあるときに運転者に不要に注意喚起してしまう可能性を低減でき、運転者に対してより適切に注意喚起することができる。
<第1変形装置の作動の概要>
次に、第1実施形態の変形例に係る車両の運転支援装置(以下、「第1変形装置」と称する。)について説明する。第1実施装置では、n周期目の予想経路は、n周期目の平滑ヨーレートYs(n)が閾値Y0(=10−6)より大きい場合、当該平滑ヨーレートYs(n)から算出されたn周期目の旋回半径R(n)(即ち、R(n)=V(n)/Ys(n)。式(12)及び式(14)参照。)に基づいて算出される。従って、第1実施装置は、例えば、車両100が左折を開始しようとした時点においても、その時点の平滑ヨーレートYsが閾値Y0より大きければ、その時点の平滑ヨーレートYsから算出された旋回半径Rに基づいて予想経路を推定する。
しかしながら、運転者が車両100を左折させる場合、一般的には、運転者によるステアリングホイール14aの回転操作開始以降、操舵角θswが徐々に大きくなって最大操舵角に達した後、暫く最大操舵角に維持され、その後、徐々に小さくなり、左折が終了する。
この場合、推定ヨーレートYestは、次のようにして算出される。
・平滑ヨーレートYsが、現時点における平滑ヨーレートYsの変化量ΔYs(厳密には、平滑ヨーレートYsの時間微分値)で増加し続けると仮定する。変化量ΔYsは、「平滑ヨーレート変化量ΔYs」とも称される。
・第1変形装置は、車両100が、角度閾値θthから現時点の旋回角度θtotalを減じた角度である暫定旋回残余角度Δθ(=θth−θtotal)だけ旋回するのに要する所要時間Treqを、上記仮定の下で算出する。
・第1変形装置は、この暫定旋回残余角度Δθをこの所要時間Treqで除することにより、推定ヨーレートYestを算出する(Yest=Δθ/Treq)。
ところで、上記の仮定は、操舵角増加期間における現時点の平滑ヨーレート変化量ΔYsがゼロより大きいことを前提としている。即ち、操舵角増加期間の現時点において得られた平滑ヨーレート変化量ΔYsがゼロ以下である場合(別言すると、現時点において、平滑ヨーレートYsが減少している又は変化していない場合)、上記の方法に則って推定ヨーレートYestを算出すると、その推定ヨーレートYestは現時点における平滑ヨーレートYs以下になる。このため、この推定ヨーレートYestから算出される旋回半径に基づいて推定される予想経路は、実際の走行経路からより乖離することになってしまう。
即ち、操舵角増加期間における現時点の平滑ヨーレート変化量ΔYsがゼロ以下の場合において、現時点よりも前の周期でゼロより大きい変化量ΔYsがあるときは、第1変形装置は、「その中で最も現時点に近い周期の平滑ヨーレート変化量ΔYs」で平滑ヨーレートYsが増加し続けると仮定し、上記と同様の方法で推定ヨーレートYestを算出する。
一方、操舵角増加期間における現時点の平滑ヨーレート変化量ΔYsがゼロ以下の場合において、現時点よりも前の周期でゼロより大きい平滑ヨーレート変化量ΔYsがないとき、第1変形装置は、現時点の平滑ヨーレートYsから算出された旋回半径Rに基づいて予想経路を推定する。但し、現時点の平滑ヨーレートYsが閾値Y0以下の場合、第1変形装置は、現時点の平滑ヨーレートYsから算出された旋回半径Rではなく、所定値(本例では12700m)に設定された旋回半径Rから予想経路を推定する(後述)。
これに対し、操舵角増加期間終了後(即ち、車両100の旋回角度θtotalが角度閾値θth以上になった場合)は、操舵角θswは徐々に小さくなっていくため、平滑ヨーレートYsも次第に小さくなる。従って、現時点の平滑ヨーレートYsに基づいて旋回半径Rを求め、その旋回半径Rに基づいて予想経路を推定すると、その予想経路は実際の走行経路から乖離してしまう。
第1変形装置は、実際の走行経路により近い予想経路の推定に必要な旋回半径(第1推定旋回半径Rest1、旋回半径R及び第2推定旋回半径Rest2)を算出するために、操舵角増加期間中(即ち、旋回角度θtotalが角度閾値θth(45°)に達するまで)は、現時点における平滑ヨーレート変化量ΔYsを、下記式(24)及び式(25)に則って算出する。なお、第1変形装置は、操舵角増加期間終了後は平滑ヨーレート変化量ΔYsを算出しない。
n=0のとき、ΔYs(0)=0…(24)
n≧1のとき、ΔYs(n)=Ys(n)−Ys(n-1)…(25)
上述したように、第1変形装置は、変化量ΔYsの値に応じて旋回半径の算出方法を切り替えるが、変化量ΔYsのままでは説明が煩雑になる。このため、以下では、変化量ΔYsを変換した値である変換値ΔYscを導入して説明を簡略化する。変換値ΔYscは下記式(26)乃至式(28)に則って算出される。
ΔYs(n)>0のとき、ΔYsc(n)=ΔYs(n)…(26)
ΔYs(n)≦0のとき、
ΔYs(i)>0(iは0以上n−1以下の整数)を満たすiが存在し、そのiの中でnに最も近いiをeとするとき、ΔYsc(n)=ΔYs(e)…(27)
ΔYs(i)>0を満たすiが存在しない場合は、ΔYsc(n)=0…(28)
〔所要時間Treqの算出〕
上述したように、車両100の旋回角度θtotalがまだ角度閾値θth(=45°)に達しておらず(操舵角増加期間中)、且つ、変換値ΔYsc(n)がゼロより大きい場合、第1変形装置は、平滑ヨーレートYsが変換値ΔYsc(n)の割合で増加し続けると仮定して、車両100が暫定旋回残余角度Δθ(n)(=45°−θtotal(n))だけ旋回するのに要する所要時間Treq(n)を式(32)に則って算出する。
加えて、第1変形装置は、n周期目の暫定旋回残余角度Δθ(n)(=θth−θtotal(n))を求め、その暫定旋回残余角度Δθ(n)と上記のようにして求めたn周期目の所要時間Treq(n)とを下記式(33)に代入することにより、旋回角度θtotal(n)が角度閾値θth(=45°)に達するまでの推定ヨーレートYest(n)を算出する。
Yest(n)=Δθ(n)/Treq(n)…(33)
即ち、第1変形装置は、車両100が暫定旋回残余角度Δθ(n)を所要時間Treq(n)かけて旋回するときのヨーレートの平均値を、n周期目の推定ヨーレートYest(n)として算出する。
更に、第1変形装置は、下記式(34)又は式(35)に則って第1推定旋回半径Rest1(n)を算出する。これらの式において、Y0は、「0」に近い推定ヨーレートYest(n)によって車速V(n)を除することによって第1推定旋回半径Rest1(n)が過大になることを回避するための閾値であって、例えば、10−6である。
Yest(n)>Y0のとき、Rest1(n)=V(n)/Yest(n)…(34)
Yest(n)≦Y0のとき、Rest1(n)=12700m…(35)
〔旋回半径Rの算出〕
上述したように、車両100の旋回角度θtotalがまだ角度閾値θth(=45°)に達しておらず(操舵角増加期間中)、且つ、変換値ΔYsc(n)がゼロ(即ち、それより前の周期の平滑ヨーレート変化量ΔYsが全てゼロ以下、式(28)を参照。)の場合、第1変形装置は、下記式(36)及び式(37)に則って旋回半径R(n)を算出する。
Ys(n)>Y0のとき、R(n)=V(n)/Ys(n)…(36)
Ys(n)≦Y0のとき、R(n)=12700m…(37)
但し、本願発明者らは、Ys(n)≦Y0(=10−6)のときは、交差点内における予想経路の形状が略直線状であるほうが運転者に適切に注意喚起できるとの知見を得た。このため、第1変形装置は、Ys(n)≦Y0のときは、旋回半径R(n)を所定値(本例では12700m)に設定する(式(37)参照)。これにより、交差点内における予想経路の形状を略直線状とすることができる。なお、Ys(n)≦Y0のときとは、典型的には以下の場合である。
・車両100が一時停止している場合。
・車両100が直進している場合。
・車両100が左折又は右折しようとしている方向とは反対方向に車両100が旋回した結果、平滑ヨーレートYsが負の値として算出される場合。
〔第2推定旋回半径Rest2の算出〕
上述したように、車両100の旋回角度θtotalが角度閾値θth(45°)以上になった場合(操舵角増加期間終了後)、第1変形装置は、下記式(38)乃至式(41)に則って第2推定旋回半径Rest2を算出する。
ΔYsc(m)>0の場合において、
Yest(m)>Y0のとき、Rest2(n)=V(n)/Yest(m)…(38)
Yest(m)≦Y0のとき、Rest2(n)=12700m…(39)
ΔYsc(m)=0の場合において、
Ys(m)>Y0のとき、Rest2(n)=V(n)/Ys(m)…(40)
Ys(m)≦Y0のとき、Rest2(n)=12700m…(41)
一方、第1変形装置は、m周期目の変換値ΔYsc(m)がゼロの場合(即ち、操舵角増加期間中の平滑ヨーレート変化量ΔYsが全てゼロ以下の場合)は、車速V(n)をm周期目の平滑ヨーレートYs(m)で除した値を、第2推定旋回半径Rest2(n)として算出する(式(40)参照)。但し、m周期目の平滑ヨーレートYs(m)が閾値Y0以下の場合、式(40)に代わって、式(41)により、第2推定旋回半径Rest2(n)を所定値(本例では12700m)に設定する。
次に、図11A及び図11Bを参照して、第1変形装置の具体的な作動について説明する。第1変形装置の運転支援ECU10が備えるCPUは、所定のタイミングになると、図11Aのステップ1100から処理を開始してステップ1102に進み、図6のステップ601と同一の処理を行い、自車両情報を取得する。
ステップ1108:CPUは、図6のステップ608と同一の処理を行い、n周期目の平滑ヨーレートYs(n)を算出する(式(1L)、(2L)、(3)、(4)、(5L)及び(6L)参照)。
ステップ1110:CPUは、図6のステップ610と同一の処理を行い、n周期目の瞬時旋回角度θ(n)を算出する(式(7)及び(8)参照)。
ステップ1112:CPUは、図6のステップ612と同一の処理を行い、n周期目の旋回角度θtotal(n)を算出する(式(9)及び(10)参照)。
ステップ1120:CPUは、上述したようにして、ステップ1118で算出された平滑ヨーレート変化量ΔYs(n)を変換してn周期目の変換値ΔYsc(n)を算出し、運転支援ECU10のRAMに格納する(式(26)乃至(28)参照)。
ステップ1126:CPUは、上記式(33)に則って、暫定旋回残余角度Δθ(n)をステップ1124で算出された所要時間Treq(n)で除することにより、n周期目の推定ヨーレートYest(n)を算出して運転支援ECU10のRAMに格納する。
・前回の左折又は前回の右折が終了したと判定された後に左折開始条件が成立したと初めて判定された後、ステップ1104の判定が行われる場合。
・前回の左折又は前回の右折が終了したと判定された後、左折開始条件が一度も成立していない場合。
ステップ1156:CPUは、図8のステップ808と同一の処理を行い、n周期目の平滑ヨーレートYs(n)を算出する(式(1R)、(2R)、(3)、(4)、(5R)及び(6R)参照)。
ステップ1158:CPUは、図8のステップ810と同一の処理を行い、n周期目の瞬時旋回角度θ(n)を算出する(式(7)及び(8)参照)。
ステップ1160:CPUは、図8のステップ812と同一の処理を行い、n周期目の旋回角度θtotal(n)を算出する(式(9)及び(10)参照)。
・前回の左折又は前回の右折が終了したと判定された後に右折開始条件が成立したと初めて判定された後、ステップ1152の判定が行われる場合。
・前回の左折又は前回の右折が終了したと判定された後、右折開始条件が一度も成立していない場合。
次に、第2実施形態に係る車両の運転支援装置(以下、「第2実施装置」と称する。)について説明する。第2実施装置は、注意喚起を行うべき物体が存在するか否かを判定する演算上の手法が第1実施装置と相違する。即ち、第1実施装置は、物体の予想経路式g(n)によって表される直線が、「車両100の予想経路の有効長さLLe及び/又はLRe以内の部分」と1個又は2個の交点で交差しているか否かを判定し、交差している場合は、判定の対象となる交点を特定し、その交点について時間条件が成立するときに注意喚起を行った。
第2実施装置は、第1実施装置と同様、車両100の周辺に存在する物体の物体情報を取得する。図12の例では、第2実施装置は、n周期目の車両100の周辺に存在する物体E、F、G、H及びIのn周期目の物体情報をそれぞれ取得する。
第2実施装置は、第1実施装置と同様、物体の予想経路式gを算出する。図12の例では、第2実施装置は、物体E〜Iの式ge(n)、gf(n)、gg(n)、gh(n)及びgi(n)をそれぞれ算出する。
第2実施装置は、第1実施装置(又は、第1変形装置)と同様にして、左側予想経路式fL(n)と右側予想経路式fR(n)を求める。更に、第2実施装置においては、左側予想経路式fL(n)と右側予想経路式fR(n)との間に対象領域r(n)が設けられている。第2実施装置は、式g(n)によって表される直線が、左側予想経路式fL(n)によって表される曲線と右側予想経路式fR(n)によって表される曲線との少なくとも一方と交差しているという条件(以下、第2交差条件とも称する。)が成立しているか否かを判定する。
第2実施装置は、式g(n)が第2交差条件を満たしている場合、式g(n)によって表される直線が左側予想経路及び/又は右側予想経路と交差している交点(第2交点)の数を算出する。
第2交点の数が4個の場合、第2実施装置は、式g(n)によって表される直線が、物体の移動方向において、対象領域r(n)外から対象領域r(n)内に進入する部分で左側予想経路及び右側予想経路の何れかと交差している2個の交点の座標を、順に交点Q1(n)の座標、交点Q2(n)の座標として算出する。即ち、交点Q1(n)は物体の移動方向において1個目の交点であり、交点Q2(n)は物体の移動方向において3個目の交点である。
加えて、交点Q1(n)、交点Q2(n)及び交点Q(n)のそれぞれが右側予想経路上に位置している場合、車両100の右端OR(n)からその旋回方向における交点Q1(n)、交点Q2(n)及び交点Q(n)までの右側予想経路の長さ(経路に沿った弧の長さ)をそれぞれLR1(n)、LR2(n)及びLR(n)と規定する。
なお、例えば、LL1(n)の長さは、旋回中心座標(Cx(n),Cy(n))から交点Q1(n)に向かうベクトルと、旋回中心座標(Cx(n),Cy(n))から車両100の位置O(n)に向かうベクトルとがなす角度に左側旋回半径RL(n)を乗じることにより算出される。他の長さの算出方法についても同様である。
第2実施装置は、特定された第2交点の数が2個であり、従って、交点Q1(n)及び交点Q2(n)の座標が算出される場合、車両100からその旋回方向における交点Q1(n)までの右側又は左側予想経路の長さと、車両100からその旋回方向における交点Q2(n)までの右側又は左側予想経路の長さと、を比較し、その長さが短い方の交点を対象交点Qt(n)として特定する。以下、具体的に説明する。
第2実施装置は、時間条件が成立するか否かを判定するために、物体が予想経路に到達すると予想される時間t2を算出する。具体的には、第2実施装置は、式g(n)によって表される直線が左側又は右側予想経路と対象交点Qt(n)又は交点Q(n)で交差している物体について、その物体が対象交点Qt(n)又は交点Q(n)に到達するまでの時間t2(n)(第2時間)を算出する。時間t2(n)は、その物体の位置から対象交点Qt(n)又は交点Q(n)までの直線の長さを、その物体の移動速度v(n)で除することにより算出される。
第2実施装置は、時間t2(n)が第2所定時間(本例では4秒)以下であるという時間条件が成立しているか否かを判定する。第2実施装置は、何れかの式g(n)についてこの時間条件が成立している場合、物体が第2所定時間以内に車両100の予想経路を横切る可能性があると判定する。この場合、第2実施装置は、物体が車両100の予想経路を横切る場所が、予想経路の有効長さ以内の部分に位置しているか否かを、下記式(42)乃至式(45)の不等式により示される長さ条件が成立しているか否かを判定することにより判定する。
<<対象交点Qt(n)の座標が算出された場合>>
・対象交点Qt(n)が左側予想経路上に位置している場合
長さLLt(n)≦左側有効長さLLe(n)…(42)
・対象交点Qt(n)が右側予想経路上に位置している場合
長さLRt(n)≦右側有効長さLRe(n)…(43)
<<交点Q(n)の座標が算出された場合>>
・交点Q(n)が左側予想経路上に位置している場合
長さLL(n)≦左側有効長さLLe(n)…(44)
・交点Q(n)が右側予想経路上に位置している場合
長さLR(n)≦右側有効長さLRe(n)…(45)
式ge(n)については、対象交点Qte(n)が算出されており、この対象交点Qte(n)は左側予想経路上に位置しているため、第2実施装置は、式(42)の長さ条件が成立するか否かを判定する。図12から明らかなように、長さLLte(n)は左側有効長さLLe(n)よりも短いため、式(42)の長さ条件が成立する。
式gf(n)については、対象交点Qtf(n)が算出されており、この対象交点Qtf(n)は右側予想経路上に位置しているため、第2実施装置は、式(43)の長さ条件が成立するか否かを判定する。図12から明らかなように、長さLRtf(n)は右側有効長さLRe(n)よりも短いため、式(43)の長さ条件が成立する。
式gg(n)については、交点Qg(n)が算出されており、この交点Qg(n)は右側予想経路上に位置しているため、第2実施装置は、式(45)の長さ条件が成立するか否かを判定する。図12から明らかなように、長さLRg(n)は右側有効長さLRe(n)よりも長いため、式(45)の長さ条件は成立しない。
式gh(n)については、交点Qh(n)が算出されており、この交点Qh(n)は左側予想経路上に位置しているため、第2実施装置は、式(44)の長さ条件が成立するか否かを判定する。図12から明らかなように、長さLLh(n)は左側有効長さLLe(n)よりも長いため、式(44)の長さ条件は成立しない。
以上より、式ge(n)及び式gf(n)については時間条件及び長さ条件が成立するため、第2実施装置は、対象物体(即ち、物体E及び物体F)が存在すると判定する。
第2実施装置は、第1実施装置と同様、対象物体が存在すると判定した場合は、要求信号を発生して注意を喚起する作動を行い、対象物体が存在しないと判定した場合は、要求信号は発生せず、従って、注意を喚起する作動は行わない。
次に、第2実施装置の具体的な作動について説明する。第2実施装置の運転支援ECU10が有するCPUは、図6のステップ628において、図13にフローチャートにより示したルーチンを実行するようになっている。なお、このルーチンでは、1つの物体についての物体情報が取得された場合について説明するが、複数の物体についての物体情報が取得された場合は、各物体情報についてこのルーチンが繰り返される。CPUは、ステップ628に進むと、図13のステップ1300から処理を開始し、以下に述べるステップ1302及びステップ1304の処理を順に行う。
ステップ1304:CPUは、ステップ1302で取得された物体情報に基づいて、物体のn周期目の予想経路式g(n)を算出し、運転支援ECU10のRAMに格納する。
ステップ1314:CPUは、上述したようにして、物体が交点Qt(n)又は交点Q(n)に到達するまでの時間t2(n)を算出し、運転支援ECU10のRAMに格納する。
同様に、右折開始条件は、条件Rs1乃至Rs3の3つの条件を備えており、これらのうちの何れか1つの条件を満たす場合に成立したが、この構成に限られない。例えば、右折開始条件は、条件Rs1乃至Rs3のうちの1つ又は2つの条件を備えており、これらのうちの1つの条件を満たす場合に成立する構成であってもよい。
Claims (5)
- 自車両に搭載された第1のセンサ装置を用いて、前記自車両の周辺に存在する物体の前記自車両に対する位置と、前記物体の移動方向と、前記物体の移動速度と、を含む物体情報を取得する物体情報取得手段と、
前記自車両に搭載された第2のセンサ装置を用いて、前記自車両の車速である自車速と、前記自車両のヨーレートと、前記自車両の方向指示器の状態を示す方向指示器信号と、を含む自車両情報を取得する自車両情報取得手段と、
前記自車両情報に基いて、前記自車両が左折又は右折を開始しようとしているか否かを判定する右左折開始判定手段と、
前記自車両が前記左折又は前記右折を開始しようとしていると一旦判定された場合、前記自車速及び前記ヨーレートに基いて現時点における前記自車両の予想経路を推定する予想経路推定手段と、
前記物体情報と前記予想経路とに基づいて前記自車両の運転者の注意を喚起するための要求信号を発生する注意喚起要求手段と、
前記要求信号に応答して前記運転者の注意を喚起する作動を行う注意喚起手段と、
を備えた運転支援装置において、
前記予想経路推定手段は、
前記予想経路を表す予想経路式として円の式を用いるように構成され、その円の中心は、前記自車両の現在位置から、前記自車両の現時点の進行方向と直交する方向に、少なくとも現時点での前記ヨーレートを用いて推定される推定旋回半径の長さだけ、前記自車両が左折中のときは前記進行方向に対して左側に、前記自車両が右折中のときは前記進行方向に対して右側に移動した位置であり、その円の半径は、前記推定旋回半径であり、
前記注意喚起要求手段は、
前記自車両が前記左折又は前記右折を開始しようとしているとの判定が前記右左折開始判定手段によりなされた時点から現時点までの前記自車両の旋回角度を少なくとも前記ヨーレートを用いて算出し、
左折又は右折を行う際に要する旋回角度から前記算出された旋回角度を減算した角度であって、左折又は右折を終了するまでに必要な角度、である旋回残余角度と前記推定旋回半径との積に基づく値を前記予想経路の有効長さとして算出し、
前記予想経路の前記有効長さ以内の部分に所定時間以内に交差する物体である注意喚起対象物体が存在するか否かを前記物体情報を用いて判定し、当該注意喚起対象物体が存在すると判定した場合に前記要求信号を発生するように構成された、
運転支援装置。 - 請求項1に記載の運転支援装置において、
前記右左折開始判定手段は、
前記自車速が所定の第1車速閾値以上であり且つ当該第1車速閾値よりも高い第2車速閾値以下である場合に前記方向指示器信号により前記方向指示器が非作動状態から作動状態へと変化したことが示された場合に成立する条件、
前記方向指示器信号により前記方向指示器が作動状態であることが示されている場合に前記自車速が前記第1車速閾値以上であり且つ前記第2車速閾値以下となった場合に成立する条件、及び、
前記自車速が前記第1車速閾値以上であり且つ前記第2車速閾値以下となると同時に、前記方向指示器信号により前記方向指示器が非作動状態から作動状態へと変化したことが示された場合に成立する条件、
の少なくとも一つの条件について、当該少なくとも一つの条件のうちの何れか一つが成立したと判定したときに前記自車両が左折又は右折を開始しようとしていると判定するように構成された、
運転支援装置。 - 請求項1又は請求項2に記載の運転支援装置において、
前記予想経路推定手段は、
現時点における前記自車両の左端が通過すると予想される左側予想経路と、現時点における前記自車両の右端が通過すると予想される右側予想経路と、を前記予想経路として推定し、
前記左側予想経路を表す左側予想経路式及び前記右側予想経路を表す右側予想経路式として円の式を用いるように構成されており、
左側予想経路式の円の中心は、前記自車両の前記左端から、前記自車両の現時点の進行方向と直交する方向に、前記推定旋回半径として算出される前記左端の旋回半径である左側旋回半径の長さだけ、前記自車両が左折中のときは前記進行方向に対して左側に、前記自車両が右折中のときは前記進行方向に対して右側に移動した位置であり、その円の半径は、前記左側旋回半径であり、
右側予想経路式の円の中心は、前記自車両の前記右端から、前記自車両の現時点の進行方向と直交する方向に、前記推定旋回半径として算出される前記右端の旋回半径である右側旋回半径の長さだけ、前記自車両が左折中のときは前記進行方向に対して左側に、前記自車両が右折中のときは前記進行方向に対して右側に移動した位置であり、その円の半径は、前記右側旋回半径であり、
前記注意喚起要求手段は、
前記旋回残余角度と前記左側旋回半径との積に基づく値を前記左側予想経路の前記有効長さである左側有効長さとして算出し、
前記旋回残余角度と前記右側旋回半径との積に基づく値を前記右側予想経路の前記有効長さである右側有効長さとして算出するように構成された、
運転支援装置。 - 請求項3に記載の運転支援装置において、
前記注意喚起要求手段は、
前記物体情報取得手段で取得された前記物体情報に基づいて、前記物体の現時点の移動方向に延びる直線の式を算出し、
前記直線の式により表される直線が、前記左側予想経路の前記有効長さ以内の部分と、前記右側予想経路の前記有効長さ以内の部分と、の少なくとも一方と1又は2個の第1交点で交差している場合、
前記第1交点が2個のときには、前記2個の第1交点のうち、前記直線が、前記物体の現時点の移動方向において最初に交差している交点に前記物体が到達するまでの第1時間を算出し、
前記第1交点が1個のときには、前記物体が前記第1交点に到達するまでの第1時間を算出し、
前記第1時間が第1所定時間以下であるという時間条件が成立している場合に、前記注意喚起対象物体が存在すると判定して前記要求信号を発生するように構成された、
運転支援装置。 - 請求項3に記載の運転支援装置において、
前記注意喚起要求手段は、
前記物体情報取得手段で取得された前記物体情報に基づいて、前記物体の現時点の移動方向に延びる直線の式を算出し、
前記直線の式により表される直線が、前記左側予想経路式により表される第1の円と、前記右側予想経路式により表される第2の円と、の少なくとも一方と2又は4個の第2交点で交差している場合、
前記第2交点が4個のときには、前記4個の第2交点のうちの2個の交点であって、前記直線の式により表される直線が、前記物体の現時点の移動方向において、前記第1の円と前記第2の円との間の領域である対象領域の外から当該対象領域の中に進入する部分で前記第1の円又は前記第2の円と交差している2個の交点、を特定し、前記自車両の前記左端から前記特定された2個の交点のうちの前記左側予想経路上の交点までの前記自車両の旋回方向における当該左側予想経路に沿った長さと、前記自車両の前記右端から前記特定された2個の交点のうちの前記右側予想経路上の交点までの前記自車両の旋回方向における当該右側予想経路に沿った長さと、のうち、より短い長さを有する交点を対象交点として抽出し、前記物体が当該抽出した対象交点に到達するまでの第2時間を算出し、
前記第2交点が2個のときには、前記2個の第2交点のうちの1個の交点であって、前記直線の式により表される直線が、前記物体の現時点の移動方向において、前記対象領域の外から前記対象領域の中に進入する部分で前記第1の円又は前記第2の円と交差している1個の交点を、抽出し、前記物体が当該抽出した交点に到達するまでの第2時間を算出し、
前記第2時間が第2所定時間以下であるという時間条件が成立しているか否かを判定し、
前記時間条件が成立していると判定された交点が前記左側予想経路上に位置している場合、前記自車両の前記左端から当該判定された交点までの前記自車両の旋回方向における当該左側予想経路に沿った長さが前記左側予想経路の前記左側有効長さ以下である、又は、
前記時間条件が成立していると判定された交点が前記右側予想経路上に位置している場合、前記自車両の前記右端から当該判定された交点までの前記自車両の旋回方向における当該右側予想経路に沿った長さが前記右側予想経路の前記右側有効長さ以下である、
という長さ条件が成立している場合に、前記注意喚起対象物体が存在すると判定して前記要求信号を発生するように構成された、
運転支援装置。
Priority Applications (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2016224957A JP6493364B2 (ja) | 2016-11-18 | 2016-11-18 | 運転支援装置 |
US15/717,052 US10607490B2 (en) | 2016-11-18 | 2017-09-27 | Driving support apparatus |
DE102017126120.6A DE102017126120B4 (de) | 2016-11-18 | 2017-11-08 | Fahrunterstützungsvorrichtung |
CN201711169378.4A CN108068693B (zh) | 2016-11-18 | 2017-11-17 | 驾驶辅助装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2016224957A JP6493364B2 (ja) | 2016-11-18 | 2016-11-18 | 運転支援装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2018081613A JP2018081613A (ja) | 2018-05-24 |
JP6493364B2 true JP6493364B2 (ja) | 2019-04-03 |
Family
ID=62068697
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2016224957A Active JP6493364B2 (ja) | 2016-11-18 | 2016-11-18 | 運転支援装置 |
Country Status (4)
Country | Link |
---|---|
US (1) | US10607490B2 (ja) |
JP (1) | JP6493364B2 (ja) |
CN (1) | CN108068693B (ja) |
DE (1) | DE102017126120B4 (ja) |
Families Citing this family (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP6321532B2 (ja) * | 2014-11-28 | 2018-05-09 | 株式会社デンソー | 車両の走行制御装置 |
JP6515912B2 (ja) * | 2016-12-22 | 2019-05-22 | トヨタ自動車株式会社 | 車両運転支援装置 |
JP6678609B2 (ja) * | 2017-03-01 | 2020-04-08 | 株式会社東芝 | 情報処理装置、情報処理方法、情報処理プログラム、および移動体 |
CN107963077B (zh) * | 2017-10-26 | 2020-02-21 | 东软集团股份有限公司 | 一种车辆通过路口的控制方法、装置及系统 |
JP7150245B2 (ja) * | 2018-06-01 | 2022-10-11 | マツダ株式会社 | 車両用警報システム |
US10982962B2 (en) | 2018-09-17 | 2021-04-20 | Ford Global Technologies, Llc | V2X location accuracy enhancement |
JP7157390B2 (ja) * | 2019-01-30 | 2022-10-20 | トヨタ自動車株式会社 | 運転支援装置 |
KR20210097869A (ko) * | 2020-01-30 | 2021-08-10 | 현대자동차주식회사 | 이동체에서 주행 가이드 라인 제어 방법 및 장치 |
JP6951494B2 (ja) * | 2020-03-26 | 2021-10-20 | 日立建機株式会社 | 作業車両 |
JP7533284B2 (ja) | 2021-03-02 | 2024-08-14 | トヨタ自動車株式会社 | 情報処理装置、情報処理方法、およびシステム |
CN113147894B (zh) * | 2021-05-12 | 2022-11-25 | 中国第一汽车股份有限公司 | 提升汽车低速机动性的方法 |
CN113771850A (zh) * | 2021-09-08 | 2021-12-10 | 恒大新能源汽车投资控股集团有限公司 | 车辆道路行驶控制方法及装置、计算机可读存储介质 |
US20230316912A1 (en) * | 2022-03-31 | 2023-10-05 | Denso Corporation | Path prediction based on intersection information from map messages |
Family Cites Families (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5249696B2 (ja) * | 2008-09-24 | 2013-07-31 | 富士重工業株式会社 | 車両の運転支援装置 |
JP5210233B2 (ja) * | 2009-04-14 | 2013-06-12 | 日立オートモティブシステムズ株式会社 | 車両用外界認識装置及びそれを用いた車両システム |
US8120476B2 (en) * | 2009-07-22 | 2012-02-21 | International Truck Intellectual Property Company, Llc | Digital camera rear-view system |
EP2590152B1 (en) * | 2010-06-29 | 2016-04-20 | Honda Motor Co., Ltd. | Device for estimating vehicle travel path |
US9046378B2 (en) * | 2010-07-27 | 2015-06-02 | Toyota Jidosha Kabushiki Kaisha | Driving assistance device |
KR101397732B1 (ko) | 2011-04-20 | 2014-05-20 | 도요타 지도샤(주) | 차량용 주변 경계 장치 |
US8564425B2 (en) * | 2011-08-19 | 2013-10-22 | Ahmad I. S. I. Al-Jafar | Blind spot monitoring system |
JP5737423B2 (ja) * | 2011-11-14 | 2015-06-17 | トヨタ自動車株式会社 | 運転支援装置 |
JP5842996B2 (ja) * | 2012-03-16 | 2016-01-13 | 日産自動車株式会社 | 不慮予測感度判定装置 |
US9399464B2 (en) * | 2012-07-06 | 2016-07-26 | Toyota Jidosha Kabushiki Kaisha | Vehicle cruise control device |
CN102926337A (zh) * | 2012-10-30 | 2013-02-13 | 东南大学 | 信号控制交叉口进口车道安全行车提示标线设置方法 |
JP6180968B2 (ja) * | 2014-03-10 | 2017-08-16 | 日立オートモティブシステムズ株式会社 | 車両制御装置 |
JP6394103B2 (ja) | 2014-06-20 | 2018-09-26 | 富士通株式会社 | 音声処理装置、音声処理方法および音声処理プログラム |
JP6149846B2 (ja) * | 2014-11-14 | 2017-06-21 | トヨタ自動車株式会社 | 注意喚起装置 |
US10118610B2 (en) * | 2016-08-31 | 2018-11-06 | Ford Global Technologies, Llc | Autonomous vehicle using path prediction |
-
2016
- 2016-11-18 JP JP2016224957A patent/JP6493364B2/ja active Active
-
2017
- 2017-09-27 US US15/717,052 patent/US10607490B2/en active Active
- 2017-11-08 DE DE102017126120.6A patent/DE102017126120B4/de active Active
- 2017-11-17 CN CN201711169378.4A patent/CN108068693B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN108068693B (zh) | 2021-01-15 |
JP2018081613A (ja) | 2018-05-24 |
DE102017126120B4 (de) | 2020-07-02 |
DE102017126120A1 (de) | 2018-05-24 |
US10607490B2 (en) | 2020-03-31 |
US20180144637A1 (en) | 2018-05-24 |
CN108068693A (zh) | 2018-05-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6493364B2 (ja) | 運転支援装置 | |
JP6515912B2 (ja) | 車両運転支援装置 | |
JP6544348B2 (ja) | 車両運転支援装置 | |
JP6323385B2 (ja) | 車両走行制御装置 | |
JP6819431B2 (ja) | 注意喚起装置 | |
JP6065889B2 (ja) | 運転支援装置 | |
US20200279481A1 (en) | Server and Vehicle Assistance System | |
JP6536557B2 (ja) | 運転支援装置 | |
JP6693447B2 (ja) | 走行制御装置 | |
JP2019188867A (ja) | 車両の制御装置 | |
JP2020196292A (ja) | 自動運転支援装置 | |
WO2020003452A1 (ja) | 運転支援方法及び運転支援装置 | |
JP7219200B2 (ja) | 車両制御装置 | |
JP7215596B2 (ja) | 運転制御方法及び運転制御装置 | |
JP6597585B2 (ja) | 運転支援装置 | |
JP2022060078A (ja) | 運転支援装置 | |
JP2018138402A (ja) | 車両運転支援システム及び方法 | |
JP2006277548A (ja) | 車両用制御装置 | |
JP2018138406A (ja) | 車両運転支援システム及び方法 | |
JP2018138403A (ja) | 車両運転支援システム及び方法 | |
JP7386692B2 (ja) | 走行支援方法及び走行支援装置 | |
JP2023006734A (ja) | 車両走行制御装置及び車両走行制御方法 | |
JP2017004339A (ja) | 車両用運転者支援装置 | |
JP2018106355A (ja) | 運転支援装置 | |
JP7330085B2 (ja) | 車両制御装置、車両制御方法及び交通管理システム |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20181107 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20181113 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20190111 |
|
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: 20190205 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20190218 |
|
R151 | Written notification of patent or utility model registration |
Ref document number: 6493364 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |