JP6958001B2 - 車線変更支援装置 - Google Patents

車線変更支援装置 Download PDF

Info

Publication number
JP6958001B2
JP6958001B2 JP2017114771A JP2017114771A JP6958001B2 JP 6958001 B2 JP6958001 B2 JP 6958001B2 JP 2017114771 A JP2017114771 A JP 2017114771A JP 2017114771 A JP2017114771 A JP 2017114771A JP 6958001 B2 JP6958001 B2 JP 6958001B2
Authority
JP
Japan
Prior art keywords
target
lane change
blind spot
determination
change support
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
JP2017114771A
Other languages
English (en)
Other versions
JP2019001183A (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.)
Toyota Motor Corp
Original Assignee
Toyota Motor 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 Toyota Motor Corp filed Critical Toyota Motor Corp
Priority to JP2017114771A priority Critical patent/JP6958001B2/ja
Priority to DE102018113514.9A priority patent/DE102018113514A1/de
Priority to US16/002,569 priority patent/US10457278B2/en
Priority to CN201810581878.7A priority patent/CN109017791B/zh
Publication of JP2019001183A publication Critical patent/JP2019001183A/ja
Application granted granted Critical
Publication of JP6958001B2 publication Critical patent/JP6958001B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Conjoint control of vehicle sub-units of different type or different function
    • B60W10/04Conjoint control of vehicle sub-units of different type or different function including control of propulsion units
    • B60W10/06Conjoint control of vehicle sub-units of different type or different function including control of propulsion units including control of combustion engines
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Conjoint control of vehicle sub-units of different type or different function
    • B60W10/18Conjoint control of vehicle sub-units of different type or different function including control of braking systems
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Conjoint control of vehicle sub-units of different type or different function
    • B60W10/30Conjoint control of vehicle sub-units of different type or different function including control of auxiliary equipment, e.g. air-conditioning compressors or oil pumps
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Purposes 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
    • B60W30/08Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
    • B60W30/09Taking automatic action to avoid collision, e.g. braking and steering
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Purposes 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
    • B60W30/18Propelling the vehicle
    • B60W30/18009Propelling the vehicle related to particular drive situations
    • B60W30/18163Lane change; Overtaking manoeuvres
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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
    • B60W40/00Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
    • B60W40/02Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to ambient conditions
    • B60W40/04Traffic conditions
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Details 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/08Interaction between the driver and the control system
    • B60W50/14Means for informing the driver, warning the driver or prompting a driver intervention
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Drive control systems specially adapted for autonomous road vehicles
    • B60W60/001Planning or execution of driving tasks
    • B60W60/0015Planning or execution of driving tasks specially adapted for safety
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Drive control systems specially adapted for autonomous road vehicles
    • B60W60/001Planning or execution of driving tasks
    • B60W60/0027Planning or execution of driving tasks using trajectory prediction for other traffic participants
    • B60W60/00274Planning or execution of driving tasks using trajectory prediction for other traffic participants considering possible movement changes
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Drive control systems specially adapted for autonomous road vehicles
    • B60W60/001Planning or execution of driving tasks
    • B60W60/0027Planning or execution of driving tasks using trajectory prediction for other traffic participants
    • B60W60/00276Planning or execution of driving tasks using trajectory prediction for other traffic participants for two or more other traffic participants
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Drive control systems specially adapted for autonomous road vehicles
    • B60W60/007Emergency override
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Conjoint control of vehicle sub-units of different type or different function
    • B60W10/20Conjoint control of vehicle sub-units of different type or different function including control of steering systems
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Details 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/08Interaction between the driver and the control system
    • B60W50/14Means for informing the driver, warning the driver or prompting a driver intervention
    • B60W2050/143Alarm means
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Details 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/08Interaction between the driver and the control system
    • B60W50/14Means for informing the driver, warning the driver or prompting a driver intervention
    • B60W2050/146Display means
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Indexing codes relating to the type of sensors based on the principle of their operation
    • B60W2420/40Photo, light or radio wave sensitive means, e.g. infrared sensors
    • B60W2420/408Radar; Laser, e.g. lidar
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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
    • B60W2510/00Input parameters relating to a particular sub-units
    • B60W2510/20Steering systems
    • B60W2510/202Steering torque
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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
    • B60W2520/00Input parameters relating to overall vehicle dynamics
    • B60W2520/10Longitudinal speed
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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
    • B60W2520/00Input parameters relating to overall vehicle dynamics
    • B60W2520/10Longitudinal speed
    • B60W2520/105Longitudinal acceleration
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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
    • B60W2520/00Input parameters relating to overall vehicle dynamics
    • B60W2520/12Lateral speed
    • B60W2520/125Lateral acceleration
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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
    • B60W2540/00Input parameters relating to occupants
    • B60W2540/10Accelerator pedal position
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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
    • B60W2540/00Input parameters relating to occupants
    • B60W2540/12Brake pedal position
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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
    • B60W2540/00Input parameters relating to occupants
    • B60W2540/18Steering angle
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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
    • B60W2540/00Input parameters relating to occupants
    • B60W2540/20Direction indicator values
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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
    • B60W2540/00Input parameters relating to occupants
    • B60W2540/215Selection or confirmation of options
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Input parameters relating to objects
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Input parameters relating to objects
    • B60W2554/80Spatial relation or speed relative to objects
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Input parameters relating to objects
    • B60W2554/80Spatial relation or speed relative to objects
    • B60W2554/801Lateral distance
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Output or target parameters relating to a particular sub-units
    • B60W2710/06Combustion engines, Gas turbines
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Output or target parameters relating to a particular sub-units
    • B60W2710/18Braking system
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Output or target parameters relating to a particular sub-units
    • B60W2710/20Steering systems
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Output or target parameters relating to a particular sub-units
    • B60W2710/30Auxiliary equipments
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Purposes 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
    • B60W30/14Adaptive cruise control
    • B60W30/143Speed control

Landscapes

  • Engineering & Computer Science (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Automation & Control Theory (AREA)
  • Chemical & Material Sciences (AREA)
  • Combustion & Propulsion (AREA)
  • Human Computer Interaction (AREA)
  • Physics & Mathematics (AREA)
  • Mathematical Physics (AREA)
  • Traffic Control Systems (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)

Description

本発明は、自車両が走行中の車線である自車線から当該自車線に隣接する車線である隣接目標車線へと車線変更するための走行を支援する機能を備えた車線変更支援装置に関する。
従来から、車線変更を行うための操舵操作(ハンドル操作)を支援する車線変更支援装置が知られている(例えば、特許文献1を参照。)。車線変更支援装置の一つ(以下、「従来装置」と称呼される。)は、車両に備えられた複数のレーダセンサ(例えば、ミリ波レーダやレーザレーダなど)によって、車両の周囲に存在する立体物(例えば、他車両)を検出し、その立体物の自車両に対する「縦位置、横位置及び相対車速」、並びに、その立体物の「幅及び長さ」等の情報(以下、「物標情報」とも称呼する。)を取得する。そして、従来装置は、取得した物標情報に基づいて、自車両が車線変更を行っても安全であるかどうかを監視し、安全であると判定した場合に車線変更支援を実行する。
特開2009−274594号公報
ところで、レーダセンサは、周知であるように、自身の周囲にレーダ波を送信し且つそのレーダ波が立体物によって反射されることにより生成される反射波を受信し、その受信した反射波に基づいて物標を認識し且つその物標の自車両に対する位置及び速度を特定するための位置速度情報を取得する。以下、レーダセンサが認識する物標を「センサ物標」と称呼する。
更に、センサ物標に基づいて一つの立体物を示すと考えられる物標(以下、「判定対象物標」と称呼される。)が特定される。
一方、一時的にその立体物を検出している可能性が高いセンサ物標が一つも検出されないことにより判定対象物標が特定できなくなる場合、その立体物に対応する判定対象物標を推定する外挿処理を行うことにより、判定対象物標の認識を継続することが行われる。そして、外挿処理を最大外挿継続時間以上行ったときに、判定対象物標がロストした(存在しなくなった、或いは、認識できなくなった)と判定される。
ところで、複数のレーダセンサの何れからもレーダ波が放射されない自車両近傍の死角領域に、自車両に対する相対速度の低い立体物(他車両)が進入した場合、レーダセンサによって、その立体物を検出している可能性が高いセンサ物標が一つも検出されなくなる。
従って、この場合、従来装置は、その立体物に対応する判定対象物標の外挿処理を行うことによって、判定対象物標の認識を継続する。
しかしながら、その立体物の自車両に対する相対速度が低いため、立体物が最大外挿継続時間以上の長時間、当該死角領域にとどまりつづけることがあり得る。この場合、死角領域に立体物が存在するのにも関わらず、その立体物に対応する判定対象物標が存在しなくなったと判定される可能性がある。
この結果、自車両の近傍の死角領域に車線変更の障害となる立体物が存在しているにも関わらず、車線変更支援制を実行してしまうことがあり得る。
本発明は上述した課題に対処するためになされた。即ち、本発明の目的の一つは、自車両の近傍の「レーダセンサの死角領域」にいる立体物が存在しているか否かを精度良く推定することができ、以て、「車線変更支援の障害となる当該死角領域に立体物が存在する可能性が高い状況下で、車線変更支援制御を行ってしまう可能性」を低くすることができる車線変更支援装置(以下、「本発明装置」とも称呼する。)を提供することにある。
本発明装置は、複数のレーダセンサ(16FC、16FL、16FR、16RL、16RL及び16RR)と、物標特定手段(10)と、制御実行手段(10)と、制御禁止手段(10)と、を備える。
複数のレーダセンサは、それぞれが、自車両の周囲に送信するレーダ波の立体物による反射点をセンサ物標として検出し、前記検出したセンサ物標の前記自車両に対する位置(Xobj、Yobj)及び速度(Vxobj、Vyobj)を特定するための位置速度情報を検出する。
前記物標特定手段は、所定時間が経過する毎に、前記位置速度情報に基づいて前記自車両の周囲に存在する立体物を示す判定対象物標を特定する(ステップ1215、ステップ1325、1515)。
前記制御実行手段は、前記自車両が走行中の車線である自車線から当該自車線に隣接する車線である目標隣接車線へと当該自車線が車線変更するための走行を支援するように当該自車両の舵角を制御する車線変更支援制御を実行する(ステップ1840)。
前記制御禁止手段は、前記制御実行手段が前記車線変更支援制御を実行することを禁止する。
更に、前記物標特定手段は、所定時間前に特定された前記判定対象物標である前回判定対象物標に対応する前記センサ物標が検出されなくなった場合、前記対応する前記センサ物標が検出されなくなった前記前回判定対象物標である着目判定対象物標に対応する前記センサ物標が検出されない限り、前記着目判定対象物標の前記自車両に対する位置及び速度に基づいて、当該着目判定対象物標に対応する外挿判定対象物標を特定する外挿処理、を最大外挿継続時間が経過するまで継続的に行ない、前記外挿処理が、前記最大外挿継続時間が経過する時点まで継続されたときに前記着目判定対象物標に対応する立体物がロストしたと判定する。
又。前記制御実行手段は、前記目標隣接車線に前記立体物が存在しない場合において前記制御禁止手段により前記車線変更支援制御を実行することが禁止されていないとき、前記車線変更支援制御を実行する。
ところで、図10に示されるように、判定対象物標として一定時間以上認識していた「自車両SVに対する相対速度の低い立体物150」は、レーダセンサの左死角領域RdL又は右死角領域Rdrに進入した後、当該速度にて走行し続けることがあり得る。この場合、進入した左死角領域RdL又は右死角領域Rdrに、立体物150が長時間とどまり続けることがあり得る。
この場合、立体物150が死角領域に入ることにより立体物150からのセンサ物標が検出されなくなるので、物標特定手段は、判定対象物標の外挿を開始する。その後も、立体物150が死角領域に存在し続けて、その推定物標に統合できるセンサ物標が検出されないと、物標特定手段は判定対象物標の外挿を継続する。
更に、立体物150が死角領域に存在し続けて、最大外挿継続時間以上経過すると、立体物150が死角領域に存在しているにも関わらず、立体物150に対応する判定対象物標がロストと判定される。この場合において、車線変更支援制御要求があったとき、レーダセンサの死角領域に車線変更支援の障害となる立体物150が存在しているにも関わらず、制御実行手段が車線変更支援制御を実行してしまうことがあり得る。
そこで、前記制御禁止手段は、前記前回判定対象物標に対応するセンサ物標が検出されなくなった場合(ステップ1410にて「No」との判定)、前記対応する前記センサ物標が検出されなくなった前記前回判定対象物標である着目判定対象物標の前記自車両に対する速度(Vxf)の大きさが閾値相対速度より小さく、且つ、前記着目判定対象物標の前記自車両に対する位置が前記複数のレーダセンサの何れもが前記センサ物標を検出できない死角領域(Rd)の全体を包含する死角進入判定領域(DL1又はDR1)の範囲内にあるという条件を含む死角領域進入判定条件が成立している場合(ステップ1426での「Yes」との判定、ステップ1428での「Yes」との判定を参照。)、前記着目判定対象物標が前記死角領域に進入した可能性が高いと判定し(ステップ1427、ステップ1429)、前記外挿処理が前記最大外挿継続時間が経過する時点まで継続されて前記着目判定対象物標に対応する立体物がロストしたと判定されても、前記制御実行手段が前記車線変更支援制御を実行することを禁止する(ステップ1820での「No」との判定、ステップ1835での「No」との判定を参照。)ように構成される。
そして、前記制御禁止手段は、前記制御実行手段が前記車線変更支援制御を実行することを禁止してからの経過時間が閾値時間より大きくなった場合、前記制御実行手段が前記車線変更支援制御を実行することを許容するように構成される。
これによれば、判定対象物標に対応する立体物が死角領域にとどまっている間に、その死角領域が存在する側の車線への車線変更支援制御の実行を禁止することができる。
又、死角領域に進入したと判定された物標が長時間にわたって検出できない場合、その物標は死角領域に実際には存在していなかったと判定できる。よって、上記態様によれば、判定対象物標に対応する立体物が死角領域に存在しないのに、その死角領域が存在する側の車線への車線変更支援制御が禁止されてしまう可能性を低くすることができる。
本発明装置の一態様において、
前記物標特定手段は、
前記判定対象物標が継続して特定されている時間が長くなるほど大きくなる判定対象物標の信頼度(AGE)を取得するように構成され、
前記制御禁止手段は、
前記着目判定対象物標の前記信頼度が第1閾値信頼度以上であるという条件が更に成立しているとき(ステップ1426での「Yes」との判定、ステップ1428での「Yes」との判定を参照。)に前記死角領域進入判定条件が成立していると判定するように構成されている。
これによれば、着目判定対象物標が「死角領域に進入し且つ死角領域に長時間とどまる可能性が高い立体物」であることをより精度良く判定することができる。
本発明装置の一態様において、
前記制御禁止手段は、
前記車線変更支援制御を実行することを禁止している状態において、前記物標特定手段により新規な前記判定対象物標が特定され、且つ、前記新規な判定対象物標の前記自車両に対する位置が前記死角進入判定領域を包含する死角離脱判定領域の範囲内であるという条件を含む死角領域離脱判定条件が成立している場合、前記着目判定対象物標が前記死角領域から離脱した可能性が高いと判定して(ステップ1615での「Yes」との判定、ステップ1715での「Yes」との判定)前記制御実行手段が前記車線変更支援制御を実行することを許容する(ステップ1620、ステップ1720)ように構成されている。
これによれば、着目判定対象物標に対応する立体物が死角領域に存在しないのに、その死角領域が存在する側の車線への車線変更支援制御が禁止されてしまう可能性を低くすることができる。
本発明装置の一態様において、
前記物標特定手段は、
前記判定対象物標が継続して特定されている時間が長くなるほど大きくなる判定対象物標の信頼度を取得するように構成され、
前記制御禁止手段は、
前記新規な判定対象物標の前記信頼度が第2閾値信頼度以上であるという条件が更に成立しているときに前記死角領域離脱判定条件が成立していると判定する(ステップ1615での「Yes」との判定、ステップ1715での「Yes」との判定)ように構成されている。
これによれば、着目判定対象物標に対応する立体物が死角領域に存在しない可能性が高いことを精度良く判定することができる。
本発明装置の一態様において、
記制御実行手段は、前記特定された判定対象物標及び前記ロストしたと判定される前の前記着目判定対象物標の前記自車両に対する位置及び速度に基づいて、これらの判定対象物標が示す立体物が前記車線変更支援制御を実行する上での障害にならないと判定したとき(ステップ1820にて「Yes」との判定)前記車線変更支援制御を実行する(ステップ1840)ように構成されている。
これによれば、判定対象物標に対応する立体物が死角領域にとどまっている間に、最大外挿継続時間が経過することによりその判定対象物標がロスト判定された場合でも、その死角領域が存在する側の車線への車線変更支援制御の実行を禁止することができる。
本発明装置の一態様において、
前記物標特定手段は、
前記判定対象物標が継続して特定されている時間が長くなるほど大きくなる判定対象物標の信頼度を取得するように構成され、
前記制御禁止手段は、
前記着目判定対象物標の前記信頼度が第1閾値信頼度以上であるという条件が更に成立しているときに前記死角領域進入判定条件が成立していると判定するように構成され、
前記制御禁止手段は、
前記車線変更支援制御を実行することを禁止している状態において、前記物標特定手段により新規な前記判定対象物標が特定され、且つ、前記新規な判定対象物標の前記自車両に対する位置が前記死角進入判定領域を包含する死角離脱判定領域の範囲内であり、且つ、前記新規な判定対象物標の前記信頼度が前記第1閾値信頼度より大きい値に設定された第2閾値信頼度以上であるという条件を含む死角領域離脱判定条件が成立している場合、前記着目判定対象物標が前記死角領域から離脱した可能性が高いと判定して前記制御実行手段が前記車線変更支援制御を実行することを許容するように構成されている。
本発明装置の一態様において
前記物標特定手段は、
前記判定対象物標の存在確率を演算する(ステップ1422)ように構成され、
前記制御禁止手段は、
前記制御実行手段が前記車線変更支援制御を実行することを禁止している期間において、
前記着目判定対象物標とは相違する他の判定対象物標であって前記存在確率が閾値存在確率以上の他の判定対象物標が、前記死角離脱判定領域内の所定範囲に進入した場合(ステップ1615にて「Yes」との判定、ステップ1715にて「Yes」との判定)、前記制御実行手段が前記車線変更支援制御を実行することを許容する(ステップ1620、ステップ1720)ように構成されている。
存在確率が高い他の判定対象物標が死角離脱判定領域内の所定範囲に進入した場合、着目判定対象物標は死角領域に存在していなかったと考えることができる。よって、上記態様によれば、判定対象物標に対応する立体物が死角領域に存在しないのに、その死角領域が存在する側の車線への車線変更支援制御が禁止されてしまう可能性を低くすることができる。
本発明装置の一態様において、
前記制御禁止手段は、
前記制御実行手段が前記車線変更支援制御を実行することを禁止している期間において、前記自車両の運転者の操舵操作により前記車線変更支援制御に優先して前記舵角が変更されることによって前記自車両が前記自車線から逸脱した場合(ステップ1615にて「Yes」との判定、ステップ1715にて「Yes」との判定)、前記制御実行手段が前記車線変更支援制御を実行することを許容する(ステップ1620、ステップ1720)ように構成されている。
仮に、死角内物標存在側車線の側の死角領域に立体物が存在しているのであれば、運転者は死角内物標存在側車線への車線変更を行うような操舵操作を行わない筈である。それにも関わらず、その車線への車線変更が運転者の操舵操作によって行われた場合には、死角内物標存在側車線の側の死角領域に立体物が存在しない可能性が高いと判断できる。更に、死角内物標存在側車線とは反対側の車線への車線変更が運転者の操舵操作によって行われた場合、死角領域に存在している立体物が自車両の横移動に追従することにより死角領域に留まり続けることは極めて困難である。よって、この場合にも、死角内物標存在側車線の側の死角領域に立体物が存在しなくなった可能性が高いと判定できる。よって、上記態様によれば、判定対象物標に対応する立体物が死角領域に存在しないのに、その死角領域が存在する側の車線への車線変更支援制御が禁止されてしまう可能性を低くすることができる。
本発明装置の一態様において、
前記制御禁止手段は、
前記制御実行手段が前記車線変更支援制御を実行することを禁止している期間において、前記自車両の車速が、閾値車速より小さくなった場合、前記制御実行手段が前記車線変更支援制御を実行することを許容するように構成されている。
自車両が低速走行している場合に判定対象物標が自車両に長時間略等速で走行する可能性は低い。よって、上記態様によれば、判定対象物標に対応する立体物が死角領域に存在しないのに、その死角領域が存在する側の車線への車線変更支援制御が禁止されてしまう可能性を低くすることができる。
上記説明においては、本発明の理解を助けるために、後述する実施形態に対応する発明の構成に対し、その実施形態で用いた名称及び/又は符号を括弧書きで添えている。しかしながら、本発明の各構成要素は、上記名称及び/又は符号によって規定される実施形態に限定されるものではない。本発明の他の目的、他の特徴及び付随する利点は、以下の図面を参照しつつ記述される本発明の実施形態についての説明から容易に理解されるであろう。
図1は、本発明の実施形態に係る車線変更支援装置の概略構成図である。 図2は、図1に示した周辺レーダセンサの配設位置を示した自車両の平面図である。 図3は、車線維持制御を説明するための自車両及び道路の平面図である。 図4(A)及び(B)は、センサ物標を統合するグルーピング処理を説明するための図である。 図5(A)及び(B)は、センサ物標を統合するグルーピング処理を説明するための図である。 図6は、センサ物標を統合するグルーピング処理を説明するための図である。 図7は、フュージョン物標の外挿を説明するための自車両、立体物及び道路の平面図である。 図8は、縦相対速度と上昇率と関係を示したグラフである。 図9は、縦相対速度と最大外挿時間と存在確率との関係を示したグラフである。 図10は、死角進入判定領域を説明するための自車両、立体物及び道路の平面図である。 図11は、死角離脱判定領域を説明するための自車両、立体物及び道路の平面図である。 図12は、図1に示した運転支援ECUのCPUが実行するルーチンを示したフローチャートである。 図13は、図1に示した運転支援ECUのCPUが実行するルーチンを示したフローチャートである。 図14は、図1に示した運転支援ECUのCPUが実行するルーチンを示したフローチャートである。 図15は、図1に示した運転支援ECUのCPUが実行するルーチンを示したフローチャートである。 図16は、図1に示した運転支援ECUのCPUが実行するルーチンを示したフローチャートである。 図17は、図1に示した運転支援ECUのCPUが実行するルーチンを示したフローチャートである。 図18は、図1に示した運転支援ECUのCPUが実行するルーチンを示したフローチャートである。
以下、本発明の各実施形態に係る車線変更支援装置について図面を参照しながら説明する。
<第1実施形態>
(構成)
本発明の第1実施形態に係る車線変更支援装置(以下、「第1装置」とも称呼される。)は、図1に示したように、車両(以下において、他の車両と区別するために、「自車両」と称呼される。)に適用され、運転支援ECU10、エンジンECU30、ブレーキECU40、ステアリングECU50、メータECU60及び表示ECU70を備えている。尚、以下において、運転支援ECU10は、単に、「DSECU」とも称呼される。
これらのECUは、マイクロコンピュータを主要部として備える電気制御装置(Electric Control Unit)であり、図示しないCAN(Controller Area Network)を介して相互に情報を送信可能及び受信可能に接続されている。本明細書において、マイクロコンピュータは、CPU、ROM、RAM、不揮発性メモリ及びインターフェースI/F等を含む。CPUはROMに格納されたインストラクション(プログラム、ルーチン)を実行することにより各種機能を実現するようになっている。これらのECUは、幾つか又は全部が一つのECUに統合されてもよい。
DSECUは、以下に列挙するセンサ(スイッチを含む。)と接続されていて、それらのセンサの検出信号又は出力信号を受信するようになっている。尚、各センサは、DSECU以外のECUに接続されていてもよい。その場合、DSECUは、センサが接続されたECUからCANを介してそのセンサの検出信号又は出力信号を受信する。
アクセルペダル11aの操作量を検出するアクセルペダル操作量センサ11。
ブレーキペダル12aの操作量を検出するブレーキペダル操作量センサ12。
操舵ハンドルSWの操舵角θを検出する操舵角センサ13。
操舵ハンドルSWの操作により自車両のステアリングシャフトUSに加わる操舵トルクTraを検出する操舵トルクセンサ14。
自車両の走行速度(車速)を検出し、自車両の前後方向の速度(即ち、縦速度)である車速Vsxを検出する車速センサ15。
周辺レーダセンサ16a及びカメラセンサ16bを含む周辺センサ16。
操作スイッチ17。
自車両SVのヨーレートYRtを検出するヨーレートセンサ18。
自車両SVの前後方向の加速度Gxを検出する前後加速度センサ19。
自車両SVの横(車幅)方向(自車両SVの中心軸線に直交する方向)の加速度Gyを検出する横加速度センサ20。
周辺レーダセンサ16aは、図2に示したように、中央前方周辺センサ16FC、右前方周辺センサ16FR、左前方周辺センサ16FL、右後方周辺センサ16RR、及び、左後方周辺センサ16RLを備えている。周辺レーダセンサ16aは、単に、「レーダセンサ」と称呼される場合がある。
周辺センサ16FC,16FR,16FL,16RR及び16RLを個々に区別する必要が無い場合には、それらは周辺レーダセンサ16aと称呼される。周辺センサ16FC,16FR,16FL,16RR及び16RLは、実質的に互いに同一の構成を有する。
周辺レーダセンサ16aは、レーダ送受信部と信号処理部(図示略)とを備えている。レーダ送受信部は、ミリ波帯の電波であるレーダ波(以下、「ミリ波」と称呼する。)を放射し、更に、放射範囲内に存在する立体物(例えば、他車両、歩行者、自転車及び建造物等)によって反射されたミリ波(即ち、反射波)を受信する。レーダ波を反射する立体物の点は「反射点」とも称呼される。
信号処理部は、送信したミリ波と受信した反射波との位相差、それらの周波数差、及び、反射波の減衰レベル及びミリ波を送信してから反射波を受信するまでの時間等に基づいて、自車両SVと立体物の反射点との距離、自車両SVと立体物の反射点との相対速度、及び、自車両SVに対する立体物の反射点の方位、を表す反射点情報(位置速度情報)を所定時間が経過する毎に取得(検出)する。この立体物の反射点は物標と見做され、且つ、「センサ物標」と称呼される。
中央前方周辺センサ16FCは、車体のフロント中央部に設けられ、自車両SVの前方領域に存在するセンサ物標を検出する。右前方周辺センサ16FRは、車体の右前コーナー部に設けられ、主に自車両SVの右前方領域に存在するセンサ物標を検出する。左前方周辺センサ16FLは、車体の左前コーナー部に設けられ、主に自車両SVの左前方領域に存在するセンサ物標を検出する。右後方周辺センサ16RRは、車体の右後コーナー部に設けられ、主に自車両SVの右後方領域に存在するセンサ物標を検出する。左後方周辺センサ16RLは、車体の左後コーナー部に設けられ、主に自車両SVの左後方領域に存在するセンサ物標を検出する。例えば、周辺レーダセンサ16aは、自車両SVからの距離が100メートル程度の範囲に入るセンサ物標を検出する。尚、周辺レーダセンサ16aはミリ波帯以外の周波数帯の電波(レーダ波)を用いるレーダセンサであってもよい。
DSECUは、図2に示したように、X−Y座標を規定している。X軸は、自車両SVの前後方向に沿って自車両SVの前端部の幅方向中心位置を通るように伸び、前方を正の値として有する座標軸である。Y軸は、X軸と直交し、自車両SVの左方向を正の値として有する座標軸である。X軸の原点及びY軸の原点は、自車両SVの前端部の幅方向中心位置である。
周辺レーダセンサ16aは、上述した反射点情報(位置速度情報)に基づいて、以下に述べる「センサ物標についての情報」をDSECUに所定時間(演算周期)が経過する毎に送信する。センサ物標についての情報は、以下、「センサ物標情報」と称呼される。尚、DSECUは、演算周期が経過する毎に、上述した反射点情報(位置速度情報)を周辺レーダセンサ16aから直接取得して、反射点情報に基づいてセンサ物標情報を演算して求めるようにして、センサ物標情報を取得してもよい。
・センサ物標のX座標位置(Xobj)。即ち、自車両SVとセンサ物標とのX軸方向の符号付き距離。X座標位置Xobjは、縦距離Xobj又は縦位置Xobjとも称呼される。
・センサ物標のY座標位置(Yobj)。即ち、自車両SVとセンサ物標とのY軸方向の符号付き距離。Y座標位置Yobjは、横位置Yobjとも称呼される。
・センサ物標の自車両SVに対するX軸方向の速度(即ち、縦相対速度)Vxobj。尚、縦絶対速度Vaxobjは、縦相対速度Vxobjに自車両SVの車速Vが加えられた値である。
・センサ物標の自車両SVに対するY軸方向の速度(即ち、横相対速度)Vyobj。尚、横絶対速度Vayobjは、横相対速度Vyobjと等しい値に設定される。
・センサ物標を識別(特定)するためのセンサ物標識別情報(センサ物標ID)
ところで、一つの立体物が二以上の反射点を有する場合がある。従って、周辺レーダセンサ16aのそれぞれは、一つの立体物に対して、複数のセンサ物標を検出する場合がある。即ち、周辺レーダセンサ16aのそれぞれは、複数組のセンサ物標情報を取得する場合がある。更に、二以上の周辺レーダセンサ16aが、一つの立体物に対して複数組のセンサ物標情報を取得する場合がある。
そこで、DSECUは、一つの立体物を検出している可能性が高い複数のセンサ物標をグルーピング(統合、フュージョン)することにより、自車両SVの周囲に存在する立体物を示す判定対象物標として、複数のセンサ物標が示す一つの物標(フュージョン物標)を認識(特定)する。
更に、DSECUは、その「フュージョン物標の属性値(属性値についての情報)」を後述するように取得する。フュージョン物標の属性値についての情報は「フュージョン物標情報又はフュージョン物標属性値」と称呼され、以下に述べる情報を含む。
・フュージョン物標のX座標位置(Xf)。即ち、自車両SVとフュージョン物標とのX軸方向の符号付き距離。本例において、X座標位置Xfは、フュージョン物標の中心点のX座標位置である。
・フュージョン物標のY座標位置(Yf)。即ち、自車両SVとフュージョン物標とのY軸方向の符号付き距離。本例において、Y座標位置Yfは、フュージョン物標の中心点のY座標位置である。
・フュージョン物標の自車両SVに対するX軸方向の速度(即ち、縦相対速度)Vxf。
・フュージョン物標の自車両SVに対するY軸方向の速度(即ち、横相対速度)Vyf。
・フュージョン物標の長さLf(フュージョン物標のX軸方向の長さ)。
・フュージョン物標の幅Wf(フュージョン物標のY軸方向の長さ)。
・フュージョン物標を識別(特定)するためのフュージョン物標識別情報(フュージョン物標ID)
・フュージョン物標を新規生成した時点のフュージョン物標のX座標位置(Xfs)
・フュージョン物標を新規生成した時点のフュージョン物標のY座標位置(Yfs)
・後述するフュージョン物標のAGE
・後述するフュージョン物標の存在確率Trst
カメラセンサ16bは、ステレオカメラであるカメラ部、及び、カメラ部によって撮影して得られた画像データを解析して道路の白線を認識するレーン認識部を備えている。カメラセンサ16b(カメラ部)は、自車両SVの前方の風景を撮影する。カメラセンサ16b(レーン認識部)は、所定の角度範囲(自車両SV前方に広がる範囲)を有する画像処理領域の画像データを解析して、自車両SVの前方の道路に形成された白線(区画線)を認識(検出)する。カメラセンサ16bは、認識した白線に関する情報をDSECUに送信する。
DSECUは、カメラセンサ16bから供給された情報に基づいて、図3に示したように、自車両SVの走行している車線(以下、「自車線」とも称呼する。)における左右の白線WLの幅方向の中心位置となる車線中心ラインCLを特定する。この車線中心ラインCLは、後述する車線維持支援制御における目標走行ラインとして利用される。更に、DSECUは、車線中心ラインCLのカーブの曲率Cuを演算する。尚、曲率Cuは、車線中心ラインCLが右にカーブしているとき正の値となり、車線中心ラインCLが左にカーブしているとき負の値となるように定義されている。
加えて、DSECUは、左白線及び右白線で区画される車線における自車両SVの位置及び向きを演算する。例えば、DSECUは、図3に示したように、自車両SVの基準点P(例えば、重心位置)と車線中心ラインCLとの道路幅方向の符号付き距離Dyを演算する。符号付き距離Dyの大きさは、自車両SVが車線中心ラインCLに対して道路幅方向に偏移している距離を示す。符号付き距離Dyは、自車両SVの基準点Pが車線中心ラインCLに対して道路幅方向の右側に偏移しているとき正の値となり、自車両SVの基準点Pが車線中心ラインCLに対して道路幅方向の左側に偏移しているとき負の値となるように定義されている。この符号付き距離Dyは以下において「横偏差Dy」とも称呼される。
DSECUは、車線中心ラインCLの方向と自車両SVの向いている方向(自車両SVの前後軸の方向)とのなす角度θyを演算する。この角度θyは以下において「ヨー角θy」とも称呼される。ヨー角θyは、自車両SVの向いている方向が車線中心ラインCLの方向に対して右回り側であるとき正の値となり、自車両SVの向いている方向が車線中心ラインCLの方向に対して左回り側であるとき負の値となるように定義されている。以下、曲率Cu、横偏差Dy、及び、ヨー角θyを表す情報(Cu、Dy、θy)は「車線関連車両情報」と称呼される場合がある。
カメラセンサ16bは、自車線の左白線及び右白線の種類(例えば、実線であるか破線であるか等)及び白線の形状等についての情報をDSECUに供給する。更に、カメラセンサ16bは、自車線に隣接する車線の左白線及び右白線の種類及び白線の形状等についてもDSECUに供給する。即ち、カメラセンサ16bは、「白線に関する情報」についてもDSECUに供給する。白線が実線である場合、車両がその白線を跨いで車線変更することは禁止されている。一方、白線が破線(一定の間隔で断続的に形成されている白線)の場合、車両がその白線を跨いで車線変更することは許可されている。車線関連車両情報(Cu、Dy、θy)、及び、白線に関する情報は、「車線情報」と称呼される場合がある。
操作スイッチ17は、何れも後述する「車線変更支援制御、車線維持制御、及び、追従車間距離制御」のそれぞれを実行するか否かについての選択を行うために運転者により操作される操作器である。従って、操作スイッチ17は、運転者の操作に応じて、上記の各制御の実行が選択されたか否かを示す信号を出力する。加えて、操作スイッチ17は、上記の各制御を実行する際の運転者の好みを反映するためのパラメータを運転者に入力又は選択させる機能も備えている。
エンジンECU30は、エンジンアクチュエータ31と接続されている。エンジンアクチュエータ31は、内燃機関の吸入空気量を調整するためのスロットル弁の開度を変更するスロットル弁アクチュエータを含む。エンジンECU30は、エンジンアクチュエータ31を駆動することによって、内燃機関32が発生するトルクを変更することにより、自車両SVの駆動力を制御し加速状態(加速度)を変更することができる。
ブレーキECU40は、ブレーキアクチュエータ41に接続されている。ブレーキアクチュエータ41は、ブレーキECU40からの指示に応じて摩擦ブレーキ機構42のブレーキキャリパ42bに内蔵されたホイールシリンダに供給する油圧を調整し、その油圧によりブレーキパッドをブレーキディスク42aに押し付けて摩擦制動力を発生させる。従って、ブレーキECU40は、ブレーキアクチュエータ41を制御することによって、自車両SVの制動力を制御し加速状態(減速度)を変更することができる。
ステアリングECU50は、周知の電動パワーステアリングシステムの制御装置であって、モータドライバ51に接続されている。モータドライバ51は、転舵用モータ52に接続されている。転舵用モータ52は、車両の「操舵ハンドル、操舵ハンドルに連結されたステアリングシャフト及び操舵用ギア機構等を含むステアリング機構」に組み込まれている。転舵用モータ52は、モータドライバ51から供給される電力によってトルクを発生し、このトルクによって操舵アシストトルクを加えたり、左右の操舵輪を転舵したりすることができる。即ち、転舵用モータ52は、自車両SVの舵角(転舵輪の転舵角度)を変更することができる。
ステアリングECU50は、ウインカーレバースイッチ53と接続されている。ウインカーレバースイッチ53は、後述するターンシグナルランプ61を作動(点滅)させるために運転者によって操作されるウインカーレバーの操作位置を検出する検出スイッチである。
ウインカーレバーはステアリングコラムに設けられている。ウインカーレバーは、初期位置から右回り操作方向に所定角度回転された第1段階位置と、第1段階位置よりも更に所定回転角度だけ右回り操作方向に回転された第2段階位置と、の2つの位置に操作できるようになっている。ウインカーレバーは、右回り操作方向の第1段階位置に運転者によって維持されている限りその位置を維持するが、運転者がウインカーレバーから手を離すと初期位置に自動的に戻るようになっている。ウインカーレバースイッチ53は、ウインカーレバーが右回り操作方向の第1段階位置にあるとき、ウインカーレバーが右回り操作方向の第1段階位置に維持されていることを示す信号をステアリングECU50に出力する。
同様に、ウインカーレバーは、初期位置から左回り操作方向に所定角度回転された第1段階位置と、第1段階位置よりも更に所定回転角度だけ左回り操作方向に回転された第2段階位置と、の2つの位置に操作できるようになっている。ウインカーレバーは、左回り操作方向の第1段階位置に運転者によって維持されている限りその位置を維持するが、運転者がウインカーレバーから手を離すと初期位置に自動的に戻るようになっている。ウインカーレバースイッチ53は、ウインカーレバーが左回り操作方向の第1段階位置にあるとき、ウインカーレバーが左回り操作方向の第1段階位置に維持されていることを示す信号をステアリングECU50に出力する。尚、このようなウインカーレバーについては、例えば、特開2005−138647号公報に開示されている。
DSECUは、ウインカーレバースイッチ53からの信号に基づいて、ウインカーレバーが右回り操作方向の第1段階位置に保持されている継続時間を計測するようになっている。更に、DSECUは、その計測した継続時間が予め設定した支援要求確定時間(例えば、0.8秒)以上であると判定したとき、運転者が右側車線への車線変更を行うために車線変更支援を受けたいという要求(以下、「車線変更支援要求」とも称呼される。)を発していると判定するようになっている。
更に、DSECUは、ウインカーレバースイッチ53からの信号に基づいて、ウインカーレバーが左回り操作方向の第1段階位置に保持されている継続時間を計測するようになっている。更に、DSECUは、その計測した継続時間が予め設定した支援要求確定時間以上であると判定したとき、運転者が左側車線への車線変更を行うために車線変更支援要求を発していると判定するようになっている。
メータECU60は、左右のターンシグナルランプ61(ウインカーランプ)及び情報ディスプレイ62と接続されている。
メータECU60は、図示しないウインカー駆動回路を介して、ウインカーレバースイッチ53からの信号及びDSECUからの指示等に応じて左又は右のターンシグナルランプ61を点滅させるようになっている。例えば、メータECU60は、ウインカーレバーが左回り操作方向の第1段階位置に維持されていることを示す信号をウインカーレバースイッチ53が出力しているとき、左のターンシグナルランプ61を点滅させる。更に、メータECU60は、ウインカーレバーが右回り操作方向の第1段階位置に維持されていることを示す信号をウインカーレバースイッチ53が出力しているとき、右のターンシグナルランプ61を点滅させる。
情報ディスプレイ62は、運転席の正面に設けられたマルチインフォメーションディスプレイである。情報ディスプレイ62は、車速及びエンジン回転速度等の計測値に加えて、各種の情報を表示する。例えば、メータECU60は、DSECUからの運転支援状態に応じた表示指令を受信すると、その表示指令により指定された画面を情報ディスプレイ62に表示させる。
表示ECU70は、ブザー71及び表示器72に接続されている。表示ECU70は、DSECUからの指示に応じ、ブザー71を鳴動させて運転者への注意喚起を行うことができる。更に、表示ECU70は、DSECUからの指示に応じ、表示器72に注意喚起用のマーク(例えば、ウォーニングランプ)を点灯させたり、警報画像を表示したり、警告メッセージを表示したり、運転支援制御の作動状況を表示したりすることができる。尚、表示器72はヘッドアップディスプレイであるが、他のタイプのディプレイであってもよい。
(基本的な運転支援制御の概要)
前述したように、DSECUは、追従車間距離制御、車線維持制御及び車線変更支援制御を実行するようになっている。車線維持制御は、追従車間距離制御が実行されている場合に限り実行される。車線変更支援制御は、車線維持制御が実行されている場合に限り実行される。
追従車間距離制御は、自車両SVの直前を走行している先行車(即ち、追従対象車両)と自車両SVとの車間距離を所定の距離に維持しながら、自車両SVを先行車に追従させる制御である。追従車間距離制御は周知である(例えば、特開2014−148293号公報、特開2006−315491号公報、特許第4172434号明細書、及び、特許第4929777号明細書等を参照。)。
車線維持制御は、自車両SVの位置が「自車両SVが走行しているレーン(自車線)」内の目標走行ライン(例えば、自車線の中央ライン)付近に維持されるように、操舵トルクをステアリング機構に付与して自車両SVの舵角を変更し、以て、運転者の操舵操作を支援する制御である。車線維持制御は周知である(例えば、特開2008−195402号公報、特開2009−190464号公報、特開2010−6279号公報、及び、特許第4349210号明細書、等を参照。)。
車線変更支援制御は、自車両SVが、自車線(元車線)から「運転者が希望する、元車線に隣接する車線(目標隣接車線)」に移動するように、操舵トルクをステアリング機構に付与することにより自車両SVの舵角を変更し、以て、運転者の操舵操作(車線変更のためのハンドル操作)を支援する制御である。車線変更支援制御は周知である(例えば、特開2016−207060号公報、及び、特開2017−74823号公報、等を参照。)。車線変更支援制御は、例えば、自車両SVを所定の時間にて元車線から目標隣接車線へと道路の幅方向に移動させるように、元車線の車線中央ラインを基準とした「自車両SVの目標横位置」を車線変更支援制御開始からの時間tの関数として設定し、自車両SVの横位置をその目標横位置に一致させるように自車両SVの舵角を変更する制御である。
<フュージョン物標情報取得の概要>
ところで、DSECUは、車線変更支援制御を実行する前に自車両SVが安全に車線変更を行うことができるか否かを判定する。
例えば、DSECUは、車線維持制御が実行され且つ車線変更支援制御の実行が選択されている場合に車線変更支援要求が発生したとき、車線変更支援制御許可条件を満たすか否かを判定する。即ち、DSECUは、目標隣接車線に立体物が存在するか否か、更に、目標隣接車線に立体物が存在する場合には、その立体物の位置が、自車両SVが車線変更を行った場合に安全な位置であるか否かを判定する。そのような判定を行うため、DSECUは、自車両の近傍に存在する立体物の、自車両SVに対する位置(例えば、立体物の中心位置)、相対縦速度及び相対横速度に加え、その立体物の端部(幅方向端部及び長さ方向端部)と自車両SVとの最短距離を精度良く取得する必要がある。この最短距離を取得するためには、その立体物の幅及び長さを取得する必要がある。
そこで、DSECUは、自車両SVの周囲に存在する立体物を前述した「フュージョン物標」を生成することによって認識し、且つ、前述した「フュージョン物標情報(例えば、フュージョン物標の「長さ、幅及び座標位置」)」を立体物情報として取得する。
以下、フュージョン物標情報を取得する際の第1装置の作動の概要について説明する。尚、フュージョン物標の生成・更新方法については後述する。
DSECUは、所定の演算周期(Δt)が経過する毎に、周辺レーダセンサ16aが検知したセンサ物標を後述するグルーピング処理によってグルーピング(統合)してフュージョン物標を生成又は更新する。更に、DSECUは、生成又は更新されたフュージョン物標のフュージョン物標情報を、そのフュージョン物標に属するセンサ物標(即ち、グルーピングされたセンサ物標)のセンサ物標情報に基づいて生成する。
ところが、総てのセンサ物標が正確なセンサ物標情報を有しているとは限らない。即ち、センサ物標が周辺レーダセンサ16aによって誤検出された物標(所謂、ゴースト物標)である場合、及び、センサ物標情報がノイズの影響によって誤った情報になっている場合、等において、センサ物標情報の精度が低下する。
そこで、DSECU(又は、周辺レーダセンサ16a)は、センサ物標について、「AGE」と称呼される「センサ物標が検知され続けている期間の長さを表す情報」を演算している。具体的に述べると、DSECUは、初めて検知されたセンサ物標の「AGE」の値を「0」に設定し、一演算周期Δtが経過する毎に、前回の演算時において検知されたセンサ物標と同じセンサ物標(同一の識別情報を有するセンサ物標)が検知された場合、そのセンサ物標についての「AGE」の値をインクリメント(+1)する。センサ物標が、ゴースト或いはノイズによって検知されている場合、そのセンサ物標が長時間に渡って同一の物標として検出され続ける可能性は低いので、そのセンサ物標のAGEは大きくならない。
更に、DSECUは、「AGE」の値が所定閾値以上のセンサ物標を「高AGEセンサ物標」と認識する。換言すると、DSECUは、検出され続けている期間が閾値時間以上であるセンサ物標を高AGEセンサ物標として認識する。DSECUは、「AGE」の値が所定閾値より小さいセンサ物標を「低AGEセンサ物標」と認識する。
そして、DSECUは、フュージョン物標情報のうち、少なくとも、フュージョン物標の長さLf(以下「物標長さLf」とも称呼される。)、フュージョン物標の幅Wf(以下「物標幅Wf」とも称呼される。)、及び、位置(Xf、Yf)を、「フュージョン物標に属するセンサ物標のうちの高AGEセンサ物標」のセンサ物標情報を用いて演算する。
具体的に述べると、DSECUは、最大縦位置Xmaxhと最小縦位置Xminhとの差の大きさ(=|Xmaxh−Xminh|)をフュージョン物標の長さLfとして演算する。ここで、最大縦位置Xmaxhは、「フュージョン物標に属する高AGE物標のX座標位置Xobjの中の最大値」である。最小縦位置Xminhは、「フュージョン物標に属する高AGE物標のX座標位置Xobjの中の最小値」である。
同様に、最大横位置Ymaxhと最小横位置Yminhとの差の大きさ(=|Ymaxh−Yminh|)をフュージョン物標FBnの幅Wfとして演算する。ここで、最大横位置Ymaxhは、「フュージョン物標に属する高AGE物標のY座標位置Yobjの中の最大値」である。最小横位置Yminhは、「フュージョン物標FBnに属する高AGE物標のY座標位置Yobjの中の最小値」である。ここで、フュージョン物標に属する高AGE物標の中からより精度の高い高AGE物標を選択して、選択した高AGEセンサ物標を用いて、フュージョン物標の幅Wfを算出してもよい。
なお、DSECUは、フュージョン物標の相対縦速度及び相対横速度を、フュージョン物標に属する高AGEセンサ物標の相対速度(縦相対速度Vxf及び横相対速度Vyf)の平均を算出することにより取得する。
(フュージョン物標の生成・更新及びロスト判定)
次に、DSECUが実行するフュージョン物標の生成・更新及びロスト判定の方法について説明する。
DSECUは、所定時間(演算周期)Δtが経過する毎に、周辺レーダセンサ16aからセンサ物標情報を取得する。周辺レーダセンサ16aのそれぞれの物標検知範囲は、他の周辺レーダセンサ16aと部分的に重複している。更に、周辺レーダセンサ16aのそれぞれは、自車両SVの周辺に立体物が一つしか存在していない場合であっても、その立体物から複数のセンサ物標を認識する場合がある。従って、一つの立体物から複数のセンサ物標が取得される場合が発生する。
この場合、DSECUは、後述するグルーピング処理を行なって「一つの立体物nから得られている可能性が高い複数のセンサ物標」をグルーピング(統合、フュージョン)することにより、その一つの立体物nに対応するフュージョン物標FBnを生成する。換言すると、DSECUは、複数のセンサ物標のそれぞれのセンサ物標情報に基づいて、当該複数のセンサ物標を統合してフュージョン物標FBnを生成する。そして、DSECUは、そのフュージョン物標FBnのフュージョン物標情報を、当該フュージョン物標FBnに統合された(即ち、当該フュージョン物標FBnに属する)センサ物標のうちの高AGEセンサ物標のセンサ物標情報に基づいて生成する。以下、図4の(A)及び(B)に示した例を用いて、「グルーピング処理」について詳述する。
いま、図4(A)に示したように、センサ物標B0,B1及びB2が検出されたと仮定する。この例において、センサ物標B0は右前方周辺センサ16FRによって検出されたセンサ物標であり、センサ物標B1及びセンサ物標B2は、中央前方周辺センサ16FCによって検出されたセンサ物標である。更に、この例では、現時点までに(換言すると、前回の演算時において)フュージョン物標が生成されていない。
このように、今回の演算の開始時点においてフュージョン物標FBnが生成されていない場合、DSECUは、新規のフュージョン物標FBnを生成するためのグルーピング処理を次に述べるように行う。尚、このグルーピング処理は、「新規物標生成グルーピング処理」と称呼される。
まず、DSECUは、複数のセンサ物標(例えば、センサ物標B0乃至B2)の中から、任意の一つのセンサ物標(例えば、センサ物標B0)をグルーピング基準物標Bsとして選択する。次に、DSECUは、グルーピング基準物標Bs(例えば、センサ物標B0)に対して、「グルーピング候補となる他のセンサ物標Bn(例えば、センサ物標Bn、n=1、2)」が、下記(条件G1)及び(条件G2)の両条件を満たしているか否かを判定する。グルーピング候補のセンサ物標Bnが下記(条件G1)及び(条件G2)の両条件を満たしている場合、センサ物標Bnはグルーピング条件を満たしていると判定される。
(条件G1)位置を判定の基準とした条件
図4(B)の左側の図に示されるように、
「グルーピング候補のセンサ物標BnのX座標位置Xobj(=XBn)」と「グルーピング基準物標BsのX座標位置Xobj(=XBs)」との差分の絶対値(=|XBn−XBs|)が所定の閾値縦距離Xth以下であり、且つ
「グルーピング候補のセンサ物標BnのY座標位置Yobj(=YBn)」と「グルーピング基準物標BsのY座標位置Yobj(=YBs)」との差分の絶対値(=|YBn−YBs|)が所定の閾値横距離Yth以下であること。
尚、ここで、閾値縦距離Xthは、「物標長さL0×0.5+所定値α」である。閾値横距離Ythは、「物標幅W0×0.5+所定値β」である。物標長さL0及び物標幅W0には、判定に適した任意の固定値が使用される。例えば、物標長さL0には自動二輪車両の標準的長さが設定され、物標幅W0には自動二輪車両の標準的車幅が設定される。
(条件G2)速度を判定の基準とした条件
図4(B)の右側の図に示されるように、
「グルーピング候補のセンサ物標Bnの縦相対速度Vxobj(=VxBn)」と「グルーピング基準物標Bsの縦相対速度Vxobj(=VxBs)」との差分の絶対値(=|VxBn−VxBs|)が、所定の閾値縦速度差Vxth以下であり、且つ
「グルーピング候補のセンサ物標Bnの横相対速度Vyobj(=VyBn)」と「グルーピング基準物標Bsの横相対速度Vyobj(=VyBs)」との差分の絶対値(=|VyBn−VyBs|)が、所定の閾値横速度差Vyth以下であること。
なお、条件G2が成立しているか否かは、絶対速度を用いて判定されてもよい。即ち、条件G2は以下のとおりであってもよい。
「グルーピング候補のセンサ物標Bnの縦絶対速度」と「グルーピング基準物標Bsの縦絶対速度」との差分の絶対値が、閾値縦速度差Vxth以下であり、且つ
「グルーピング候補のセンサ物標Bnの横絶対速度」と「グルーピング基準物標Bsの横絶対速度」との差分の絶対値が、閾値横速度差Vyth以下であること。
グルーピング候補のセンサ物標Bnがグルーピング基準物標Bsに対して、(条件G1)及び(条件G2)の両条件からなるグルーピング条件を満たしている場合、DSECUは、センサ物標Bnとグルーピング基準物標Bsとを統合して、新規のフュージョン物標FBnを生成する(即ち、新規の判定対象物標を特定する。)。更に、DSECUは、新規のフュージョン物標FBnに対して、フュージョン物標FBnを他のフュージョン物標と区別(識別)するための識別情報(ID)を設定する。
例えば、図4(A)において、グルーピング候補のセンサ物標B1がグルーピング基準物標B0に対して、(条件G1)及び(条件G2)の両条件を満たしていると仮定する。この場合、DSECUは、センサ物標B1とセンサ物標B0とを統合してフュージョン物標FB1を新たに生成する。この場合、フュージョン物標FB1の識別情報は、例えば「ID1」である。
更に、図4(A)において、グルーピング候補のセンサ物標B2もグルーピング基準物標B0に対して、(条件G1)及び(条件G2)の両条件を満たしている場合、DSECUは、センサ物標B2もセンサ物標B0と統合する。即ち、センサ物標B2は、フュージョン物標FB1に統合される。
これに対し、グルーピング候補のセンサ物標Bnがグルーピング基準物標Bsに対して、(条件G1)及び(条件G2)の少なくとも一方を満たしていない場合、DSECUは、そのセンサ物標Bnを別のグルーピング基準物標Bsとして選択する。そして、DSECUは、そのグルーピング基準物標Bsに対して、グルーピング候補となるセンサ物標(即ち、それまでにフュージョン物標として統合されていないセンサ物標)が(条件G1)及び(条件G2)のグルーピング条件の両方を満たしているか否かを判定する。以上の処理が、新規物標生成グルーピング処理である。
一方、前回の演算(演算周期Δt前の演算)においてフュージョン物標FBnが生成されていた場合(即ち、今回の演算の開始時点において既にフュージョン物標FBnが生成されている場合)、DSECUは、そのフュージョン物標FBnを次のように更新する。更に、DSECUは、更新したフュージョン物標FBnの存在確率を演算する。以下では、図5(A)に示されるように、今回の演算を開始するときに既に2つのフュージョン物標FB1及びFB2(即ち、FBn,n=1,2)が生成されている例を用いて、フュージョン物標の更新(生成)方法について説明する。以下、前回の演算において生成又は更新されたフュージョン物標を「前回フュージョン物標」と称呼し、前回フュージョン物標の物標情報を「前回フュージョン物標情報」と称呼する。
DSECUは、前回フュージョン物標FBnの前回フュージョン物標情報に基づいて、今回の演算におけるフュージョン物標FBnの位置及び相対速度を推定する。この推定されたフュージョン物標は「推定物標FBn’」と称呼される。例えば、図5(A)に示された例においては、前回フュージョン物標FB1及びFB2に基づいて推定物標FB1’及びFB2’がそれぞれ生成されている。
より具体的に述べると、前回の演算時におけるX−Y座標(以下、「前回X−Y座標」と称呼する。)において、前回フュージョン物標FBnのX−Y座標位置を(Xfn、Yfn)、前回フュージョン物標FBnの縦相対速度をVxfn、前回フュージョン物標FBnの横相対速度をVyfnとする。このとき、DSECUは、前回X−Y座標における推定物標FBn’のX−Y座標位置(Xfn’、Yfn’)を、以下の式に従って算出する。

Xfn’=Xfn+Δt・Vxfn
Yfn’=Yfn+Δt・Vyfn
その後、DSECUは、その求めた「前回X−Y座標における推定物標FBn’のX−Y座標位置(Xfn’、Yfn’)及び」を、今回の演算時におけるX−Y座標(以下、「今回X−Y座標」と称呼する。)におけるX−Y座標位置へと変換(座標変換)する。更に、DSECUは、前回X−Y座標における「前回フュージョン物標FBnの相対速度(Vxfn,Vyfn)」を今回X−Y座標における相対速度へと変換(座標変換)し、これを今回X−Y座標における推定物標FBn’の相対速度として設定する。尚、DSECUは、前回X−Y座標と今回X−Y座標との関係を、「自車両SVの車速V、横偏差Dy、及び、ヨー角θy」と、時間Δtと、から認識し、この関係からX−Y座標位置及び相対速度等の上記座標変換を行う。
更に、DSECUは、推定物標FBn’の「物標幅及び物標長さ」を、前回フュージョン物標FBnの「物標幅Wf及び物標長さLf」とそれぞれ同じ値に設定する。これにより、DSECUは、推定物標FBn’(即ち、FB1’及びFB2’)を生成する。
推定物標FBn’は、今回の演算時において新たに検知されたセンサ物標(以下、「今回検知センサ物標」とも称呼する。)を既に生成されているフュージョン物標にグルーピング(統合)するための判定基準となる物標である。従って、推定物標FBn’の識別情報は、前回フュージョン物標FBnの識別情報と同一の情報に設定される。即ち、例えば、推定物標FB1’の識別情報は、前回フュージョン物標FB1の識別情報である「ID1」に維持される。推定物標FB2’の識別情報は、前回フュージョン物標FB2の識別情報である「ID2」に維持される。
次に、DSECUは、推定物標FBn’に対してグルーピング候補となる今回センサ物標を抽出する。この抽出は、推定物標FBn’の位置に基づいて行われる。より具体的に述べると、DSECUは、推定物標FBn’の位置に基づいて定められるグルーピング対象領域にある「今回検知センサ物標」をその推定物標FBn’のグルーピング対象として抽出する。
図5(A)に示した例において、センサ物標BFC1は、中央前方周辺センサ16FCが今回検知した今回検知センサ物標である。センサ物標BFL1、BFL2及びBFL3は、左前方周辺センサ16FLが今回検知した今回検知センサ物標である。センサ物標BRL1は、左後方周辺センサ16RLが今回検知した今回検知センサ物標である。右前方周辺センサ16FL及び右後方周辺センサ16RRは、いずれも今回検知センサ物標を検知していない。推定物標FB1’に対するグルーピング候補は、点線R1で囲まれたグルーピング対象領域に存在する「センサ物標BFC1、センサ物標BFL1、BFL2及びBFL3、並びに、センサ物標BRL1」である。推定物標FB2’に対するグルーピング候補は、点線R2で囲まれたグルーピング対象領域に存在する「センサ物標BRL1」である。
DSECUは、推定物標FBn’に基づいて、今回検知センサ物標を前回フュージョン物標FBnに関連付けるためのグルーピング処理(以下、「第1グルーピング処理」と称呼される。)を実行する。
即ち、DSECUは、先ず、推定物標FBn’をグルーピング基準物標として選択する。次いで、DSECUは、そのグルーピング基準物標(即ち、推定物標FBn’)に対して、グルーピング候補である今回検知センサ物標が、上述の(条件G1)及び(条件G2)からなるグルーピング条件を満たしているか否かを判定する。このように、グルーピング基準物標が推定物標FBn’である場合、グルーピング基準物標の物標情報としては推定物標FBn’の物標情報(X−Y座標位置、縦相対速度及び横相対速度)が使用される。尚、第1グルーピング処理において、条件G1にて使用される閾値縦距離Xthは「物標長さL1×0.5+所定値α」であり、条件G2にて使用される閾値横距離Ythは「物標幅W1×0.5+所定値β」である。物標長さL1及び物標幅W1には、推定物標FBn’の「物標長さ及び物標幅」がそれぞれ使用される。
グルーピング候補の今回検知センサ物標がグルーピング基準物標として選択された推定物標FBn’に対して、(条件G1)及び(条件G2)の両条件を満たしている場合、DSECUは、推定物標FBn’とその今回検知センサ物標とを統合して、フュージョン物標FBnを更新(生成)する。DSECUは、この処理を、グルーピング候補の今回検知センサ物標の総てに対して行ってフュージョン物標FBnを更新する。このフュージョン物標FBnの識別情報は、推定物標FBn’の識別情報と同じ情報に維持される。尚、当然ではあるが、グルーピング候補の今回検知センサ物標がグルーピング基準物標として選択された推定物標FBn’に対して、(条件G1)及び(条件G2)の少なくとも一方の条件を満たしていない場合、DSECUは、推定物標FBn’とその今回検知センサ物標とを統合しない。
図5(B)に示される例において、推定物標FB1’に対し、点線R1により囲まれたグルーピング候補の今回検知センサ物標のうち、センサ物標BFC1及びセンサ物標BFL1が(条件G1)及び(条件G2)の両条件(即ち、グルーピング条件)を満たしていると仮定する。この場合、図6に示されるように、DSECUは、推定物標FB1’と「センサ物標BFC1及びセンサ物標BFL1」とを統合することによりフュージョン物標FB1を更新(生成)する。従って、推定物標FB1’に統合できると判定されたセンサ物標の数(グルーピング物標数)は「2」である。更に、DSECUは、更新したフュージョン物標FB1の存在確率を演算する。尚、存在確率の演算方法の詳細については後述する。
更に、図5(B)に示される例において、推定物標FB2’に対し、グルーピング候補であるセンサ物標BRL1はグルーピング条件を満たしていないと仮定する。即ち、推定物標FB2’に対し、点線R2により囲まれたグルーピング候補の今回検知センサ物標のうちグルーピング条件を満たしているセンサ物標は存在しない。換言すると、推定物標FB2’に対して統合できると判定されたセンサ物標の数(グルーピング物標数)は「0」である。この場合、図6に示されるように、DSECUは、フュージョン物標FB2を外挿する。即ち、DSECUは、推定物標FB2’を、前回フュージョン物標FB2を外挿することにより得られた今回フュージョン物標FB2と見做し、今回フュージョン物標の物標情報を推定物標FB2’の物標情報によって置換する。この処理を、フュージョン物標の外挿又は外挿処理と称呼する。尚、フュージョン物標を外挿する場合、フュージョン物標の存在確率は変化しないで維持される。即ち、DSECUは、それまでにフュージョン物標FB2の存在確率として演算された値を、外挿されたフュージョン物標FB2の存在確率として維持する。
更に、第1グルーピング処理により何れの推定物標とも統合されなかった今回検知センサ物標(以下、「残余センサ物標」とも称呼する。)が存在する場合、DSECUは、残余センサ物標同士のグルーピングを試みる。この処理は、第2グルーピング処理と称呼される。
例えば、図6に示された例においては、点線R3により囲まれた「センサ物標BFL2及びBFL3、並びに、センサ物標BRL1」は、残余センサ物標である。DSECUは、これらの残余センサ物標に対し、前述した「新規物標生成グルーピング処理」と同様の処理を第2グルーピング処理として実行する。
即ち、DSECUは、残余センサ物標の一つをグルーピング基準物標として選択し、選択したグルーピング基準物標に対してグルーピング候補となる残余センサ物標を抽出する。次いで、DSECUは、抽出したグルーピング候補となる残余センサ物標が、グルーピング基準物標に対して、上述のグルーピング条件を満たしているか否かを判定する。そして、DSECUは、グルーピング基準物標とグルーピング条件を満たす残余センサ物標とを統合することにより、新規のフュージョン物標FBnを生成する。DSECUは、この新規のフュージョン物標FBnに対して、そのフュージョン物標FBnを他のフュージョン物標と区別(識別)するための識別情報(ID)を設定する。DSECUは、このような処理を、残余センサ物標の総てに対して行う。
ところで、上述した前回フュージョン物標FB2のように、第1グルーピング処理において「前回フュージョン物標FBnに対応する推定物標FBn’」に統合できるセンサ物標(今回検知センサ物標)が一つも存在しなかった場合、その前回フュージョン物標FBnに対応する立体物は自車両SVの周囲に存在しなくなったと考えることができる。即ち、推定物標FBn’に対して統合できる今回検知センサ物標の数(グルーピング物標数)が「0」の場合、フュージョン物標FBnがロストしたと考えることができる。
ところが、このような状況は、図7に示されるように、DSECUがフュージョン物標FB2として検出していた立体物150が、周辺レーダセンサ16aの何れからもミリ波が放射されない左死角領域RdL又は右死角領域Rdrに一時的に進入した場合にも発生し得る。尚、以下において、左死角領域RdL又は右死角領域Rdrを区別する必要がない場合、これらの死角領域は「死角領域Rd」と称呼される。即ち、このような状況は、今回の演算タイミングにおいて、フュージョン物標FB2に対応する立体物150が実際には自車両SVの周囲に存在しているが、その立体物150からセンサ物標(今回検知センサ物標)が検出されていない状況である可能性がある。
従って、推定物標FBn’に対するグルーピング物標数が「0」である場合、DSECUが「フュージョン物標FBnはロスト(消滅)した」と直ちに判定した場合、その判定は誤判定である可能性がある。
このような誤判定を回避するために、推定物標FBn’に対するグルーピング物標数が「0」の場合、DSECUは、推定物標FBn’に基づいて今回フュージョン物標FBnを外挿する。フュージョン物標の外挿を開始するときに、DSECUは最大外挿継続時間tgを演算する。尚、最大外挿継続時間tgの演算方法については後述する。そして、フュージョン物標の外挿は、その外挿を開始してからの継続時間(外挿継続時間)が所定の最大外挿継続時間tg以上になるまで継続され、外挿継続時間が最大外挿継続時間tgに到達すると終了する。但し、フュージョン物標の外挿は、外挿継続時間が最大外挿継続時間tgに到達する前に、その外挿によるフュージョン物標に対応した推定物標に対して統合されるセンサ物標が現れ、当該センサ物標がその推定物標に統合されたとき終了する。
一時的に周辺レーダセンサ16aの死角領域Rdに入った立体物が、死角領域Rdから出てきた場合、外挿によるフュージョン物標に対応した推定物標に対してグルーピング条件を満たすセンサ物標が検出される。この場合、DSECUは、当該センサ物標及び当該推定物標を統合してフュージョン物標を生成し、フュージョン物標の外挿を終了する。これによって、上述した誤判定が発生する可能性を低減することができる。
これに対し、外挿継続時間が最大外挿継続時間tg以上になるまで、外挿によるフュージョン物標に対応した推定物標に対してグルーピング条件を満たすセンサ物標が検出されない場合、そのフュージョン物標は死角領域Rdに一時的に入っているのではなく、自車両SVの周囲に存在しなくなった可能性が高い。従って、この場合、DSECUは、フュージョン物標がロストしたと判定する。
(存在確率の演算)
後述するように、DSECUは、フュージョン物標の存在確率に基づいて、最大外挿継続時間を演算する。そのため、DSECUは、フュージョン物標を更新した場合、更新したフュージョン物標の存在確率を演算する。具体的に述べると、DSECUは、下記(A)式にて、前回フュージョン物標の存在確率Trstpreに、所定の存在確率rup・Cyを加算して、今回の演算におけるフュージョン物標の存在確率Trstを算出する。

Trst=Trstpre+rup・Cy・・・(A)
(Trst:今回の演算におけるフュージョン物標の存在確率、Trstpre:前回フュージョン物標の存在確率、rup:存在確率の上昇率、Cy:演算サイクル数)
従って、周辺レーダセンサ16aによって、フュージョン物標に統合できるセンサ物標が継続して検出され続け、フュージョン物標を更新できる演算サイクル数(演算回数:所定時間Δtの経過毎に実行される演算の回数)が多くなるほど、存在確率は大きくなるように演算される。このとき、DSECUは、図8に示されたように、存在確率の上昇率rupをフュージョン物標の縦相対速度Vxfの大きさ(絶対値)が大きくなるほど、大きくなるように設定する。
これにより、下記のような縦相対速度Vxfの大きさが小さいフュージョン物標の存在確率は、大きくなりにくくなる。
・路面、壁及び路側物等を誤検知(誤検出)したときに生じる縦相対速度Vxfの大きさが小さいフュージョン物標及びセンサゴーストを検知(検出)したときに生じる縦相対速度Vxfの大きさが小さいフュージョン物標
・自車両SVと略等速の他車両を検知したときに生じる縦相対速度Vxobjの大きさが小さいフュージョン物標
一方で、大きな大きさの縦相対速度Vxobjを有しながら遠方から自車両SVに接近してくるようなフュージョン物標の存在確率は、大きくなりやすい。
(最大外挿継続時間の演算)
DSECUは、フュージョン物標の存在確率に基づいて、最大外挿継続時間を演算する。具体的に述べると、DSECUは、図9に示されたように、存在確率が大きくなるほど最大外挿継続時間が長くなり、且つ、縦相対速度Vxfの大きさが小さくなるほど最大外挿継続時間が長くなるように、最大外挿継続時間を演算する。
(作動の概要)
ところで、図10に示されるように、フュージョン物標として一定時間以上認識していた自車両SVに対する相対速度の大きさが小さい立体物150は、周辺レーダセンサ16aの死角領域Rd(左死角領域RdL又は右死角領域Rdr)に進入した後、その大きさが小さい相対速度にて走行し続けることがあり得る。この場合、進入した死角領域Rdに、立体物150が長時間とどまり続ける。
この場合、立体物150からのセンサ物標が検出されなくなる。従って、立体物150に対応する推定物標に統合できるセンサ物標が検出されなくなるので、DSECUはフュージョン物標の外挿を開始する。その後も、立体物150が死角領域Rdに存在し続けて、その推定物標に統合できるセンサ物標が検出されないと、DSECUはフュージョン物標の外挿を継続する。
更に、立体物150が死角領域Rdに存在し続けて、最大外挿継続時間tg以上経過すると、立体物150が死角領域Rdに存在しているにも関わらず、DSECUは立体物150に対応するフュージョン物標をロストと判定してしまう。この状況において、車線変更支援制御要求が発生すると、周辺レーダセンサ16aの死角領域Rdに車線変更支援の障害となる立体物150が存在しているにも関わらず、DSECUは車線変更支援制御を実行してしまう。
このような状況に対処するため、第1装置のDSECUは、フュージョン物標の外挿を開始するときに、そのフュージョン物標が「死角領域Rdに進入し且つ死角領域Rdに長時間とどまる可能性が高い立体物である」か否かを判定する。
具体的に述べると、DSECUは、推定物標に対して統合できると判定されたセンサ物標の数(グルーピング物標数)が「0」である場合、その推定物標に対応するフュージョン物標(以下、「外挿対象フュージョン物標」と称呼する。)のAGE(フュージョン物標のAGEについては後述する。)が第1閾値AGE以上であり、且つ、外挿対象フュージョン物標の相対速度(縦相対速度Vxf)の絶対値|Vxf|が閾値相対速度Vxthより小さい場合、外挿対象フュージョン物標が死角領域Rdに長時間とどまる可能性がある立体物であると判定する。閾値相対速度Vgxthは、判定に適切な任意の速度に設定される。尚、外挿対象フュージョン物標の相対速度の条件を満たすこと(即ち、|Vxf|<Vgxth)のみをもって、外挿対象フュージョン物標が死角領域Rdに長時間とどまる可能性がある立体物であると判定するようにしてもよい。
尚、フュージョン物標のAGEは、そのフュージョン物標に属するセンサ物標のAGEの中で最も大きいAGEに設定される。フュージョン物標のAGEは、フュージョン物標が新規に生成されてから継続して生成され続けている期間(そのフュージョンの更新回数、即ち、演算回数)を表している。フュージョン物標のAGEは、「フュージョン物標の信頼度」とも称呼される。第1閾値AGEは、「第1閾値信頼度」とも称呼される。第1閾値AGEは、判定に適切な任意の値に設定される。
更に、DSECUは、外挿対象フュージョン物標の位置が、左死角進入判定領域DL1の範囲内にあった場合、外挿対象フュージョン物標に対応する立体物が左死角領域RdLに進入した可能性が高いと判定する。左死角進入判定領域DL1は、左死角領域RdLを包含し、左死角領域RdLの面積より大きい面積を有するように設定される。
同様に、DSECUは、外挿対象フュージョン物標の位置が、右死角進入判定領域DR1の範囲内にあった場合、外挿対象フュージョン物標に対応する立体物が右死角領域Rdrに進入した可能性が高いと判定する。右死角進入判定領域DR1は、右死角領域Rdrを包含し、右死角領域Rdrの面積より大きい面積を有するように設定される。
そして、DSECUは、外挿対象フュージョン物標が、死角領域Rd(左死角領域RdL及び右死角領域Rdrの何れか)に長時間とどまる可能性がある立体物であり、且つ、死角領域Rd(左死角領域RdL及び右死角領域Rdrの何れか)に進入した可能性が高い立体物を表していたと判定し場合、外挿対象フュージョン物標が進入した可能性が高いと判定された死角領域Rd(左死角領域RdL及び右死角領域Rdrの何れか)が存在する側の車線(以下、「死角内物標存在側車線」と称呼する。)への車線変更支援制御を実行しない。換言すると、この場合、DSECUは、死角内物標存在側車線を隣接目標車線とする車線変更支援制御の実行可否状態を実行禁止状態に設定する。
更に、DSECUは、死角内物標存在側車線を隣接目標車線とする車線変更支援制御の実行可否状態を実行禁止状態に設定すると、死角領域Rdに進入した可能性が高いと判定された立体物が当該死角領域Rdから離脱した可能性が高いか否かを判定する。そして、DSECUは、死角領域Rdに進入した可能性が高いと判定された立体物が当該死角領域Rdから離脱した可能性が高いと判定した場合、死角内物標存在側車線を隣接目標車線とする車線変更支援制御の実行可否状態を実行許可状態に設定する
具体的に述べると、左車線への車線変更支援制御の実行可否状態が実行禁止状態に設定された場合、DSECUは、その要因となった外挿対象フュージョン物標に対応する立体物が左死角領域RdLから離脱した可能性が高いか否かを判定する。
この場合、DSECUは、図11に示されたように、フュージョン物標Fs1が新規に生成されたときの当該フュージョン物標Fs1の位置が左死角離脱判定領域DL2の範囲内にあり、且つ、フュージョン物標Fs1のAGEが第2閾値AGE以上となった場合、外挿対象フュージョン物標に対応する立体物が左死角領域RdLから離脱した可能性が高いと判定する。尚、フュージョン物標Fs1が新規に生成されたときの位置の条件を満たすことのみをもって、外挿対象フュージョン物標に対応する立体物が左死角領域RdLから離脱した可能性が高いと判定するようにしてもよい。
尚、左死角離脱判定領域DL2は、左死角進入判定領域DRL1より広い範囲に設定され、左死角進入判定領域DRL1を包含する。第2閾値AGEは、第1閾値AGEより大きい値に設定されている。これにより、新規生成フュージョン物標Fs1に対応する立体物が、直ぐに左死角進入判定領域DRL1に再進入した場合に、直ぐに左方向(左車線)への車線変更支援制御の実行を禁止する状態にすることができる。第2閾値AGEは、「第2閾値信頼度」とも称呼される。第2閾値AGEは、判定に適切な任意の値に設定される。
DSECUは、外挿対象フュージョン物標に対応する立体物が左死角領域RdLから離脱した可能性が高いと判定した場合、左車線への車線変更支援制御の実行可否状態を実行許可状態に設定する。
一方、右車線への車線変更支援制御の実行可否状態が実行禁止状態に設定された場合、DSECUは、その要因となった外挿対象フュージョン物標に対応する立体物が右死角領域Rdrから離脱した可能性が高いか否かを判定する。
この場合、DSECUは、図11に示されたように、フュージョン物標Fs2が新規に生成されたときの当該フュージョン物標Fs2の位置が右死角離脱判定領域DR2の範囲内にあり、且つ、フュージョン物標Fs2のAGEが第2閾値AGE以上となった場合、外挿対象フュージョン物標に対応する立体物が右死角領域Rdrから離脱した可能性が高いと判定する。尚、フュージョン物標Fs2が新規に生成されたときの位置の条件を満たすことのみをもって、外挿対象フュージョン物標に対応する立体物が右死角領域Rdrから離脱した可能性が高いと判定するようにしてもよい。
DSECUは、外挿対象フュージョン物標に対応する立体物が右死角領域Rdrから離脱した可能性が高いと判定した場合、右車線への車線変更支援制御の実行可否状態を実行許可状態に設定する。
(具体的作動)
次に、第1装置の具体的な作動について説明する。DSECUのCPU(以下、単に「CPU」と称呼される。)は、所定のタイミングになると、所定時間(所定演算周期)Δtが経過する毎に、図12乃至図18に示したルーチンを実行する。
従って、CPUは、所定のタイミングになると図12の新規物標生成ルーチンのステップ1200から処理を開始してステップ1205に進み、前述した前回フュージョン物標が存在していないか否かを判定する。換言すると、CPUは、前回の演算時(一演算周期Δt前)においてフュージョン物標が生成も更新もされていなかったか否かを判定する。前回フュージョン物標が存在していない場合、CPUはステップ1205にて「Yes」と判定して、以下に述べるステップ1210乃至ステップ1220の処理を順に行った後、ステップ1295に進み、本ルーチンを一旦終了する。
ステップ1210:CPUは、今回の演算時において周辺レーダセンサ16aによって検知されているセンサ物標(即ち、今回検知センサ物標)を取得する。尚、図示されていないが、CPUは、ステップ1210にてセンサ物標が一つも取得されなかった場合、ステップ1295に直接進んで本ルーチンを一旦終了する。
ステップ1215:CPUは、上述した新規物標生成グルーピング処理を行い、新規のフュージョン物標を生成する。
ステップ1220:CPUは、フュージョン物標情報である「物標幅Wf、物標長さLf、フュージョン物標の座標位置(Xf,Yf)及びフュージョン物標の相対速度(縦相対速度Vxf及び横相対速度Vyf)」を上述した手法により取得する。なお、本例において、フュージョン物標の座標位置(Xf,Yf)は、フュージョン物標の中心位置の座標(Xfc,Yfc)である。CPUは、新規に生成されたフュージョン物標情報に、フュージョン物標情報の一つである識別情報(ID)を付与し、更に、そのフュージョン物標情報の一つである演算サイクル数Cyの値を「1」に設定する。
尚、ステップ1205の処理の時点で前回フュージョン物標が存在している場合、CPUはステップ1205にて「No」と判定してステップ1295に直接進み、本ルーチンを一旦終了する。
更に、CPUは、所定のタイミングになると、図13に示した既存フュージョン物標トラッキングルーチンのステップ1300から処理を開始してステップ1310に進み、前回フュージョン物標が存在しているか否かを判定する。換言すると、CPUは、前回の演算時(一演算周期Δt前)においてフュージョン物標が生成又は更新されていたか否かを判定する。前回フュージョン物標が存在していない場合、CPUはステップ1310にて「No」と判定し、ステップ1395に直接進んで本ルーチンを一旦終了する。
前回フュージョン物標が存在している場合、CPUはステップ1310にて「Yes」と判定してステップ1315に進み、今回の演算時において周辺レーダセンサ16aによって検知されているセンサ物標(即ち、今回検知センサ物標)を取得する。
その後、CPUはステップ1320に進み、前述した方法に則って、前回フュージョン物標情報に基づいて推定物標を生成する。このとき、推定物標の識別情報は、その推定物標が生成された元となった前回フュージョン物標情報の識別情報と同一に設定される。
その後、CPUはステップ1325に進み、ステップ1320にて生成した推定物標に基づいて、前述した第1グルーピング処理を実施する。即ち、CPUは、ステップ1315にて取得したセンサ物標を前回フュージョン物標に紐づける(関連付ける)ように、推定物標に対して上記グルーピング条件を満足するセンサ物標(今回検知センサ物標)同士を統合することによって今回フュージョン物標を更新(生成)する。
その後、CPUはステップ1330に進み、ステップ1315にて取得したセンサ物標のうち、推定物標に統合できないと判定されたセンサ物標が存在しているか否かを判定する。
推定物標に統合できないと判定されたセンサ物標が存在している場合、CPUはステップ1330にて「Yes」と判定してステップ1335に進み、第2グルーピングフラグXg2の値を「1」に設定する。その後、CPUはステップ1340に進む。尚、第2グルーピングフラグXg2の値は、自車両SVのイグニッション・キー・スイッチがオフからオンに変更されたときに実行される図示しないイニシャルルーチンにおいて「0」に設定されるようになっている。
これに対し、推定物標に統合できないと判定されたセンサ物標が存在していない場合、CPUはステップ1330にて「No」と判定してステップ1340に直接進む。
CPUは、ステップ1340に進むと、図14に示したルーチンの処理を行なうことにより、物標情報更新処理及びロスト判定処理を行なう。尚、図14に使用される下記のフラグの値は、CPUにより実行される上述したイニシャルルーチンにおいて「0」に設定される。
左死角進入判定フラグXdL:左死角進入判定フラグXdLは、その値が「1」の場合、左死角領域RdLに長時間とどまる可能性が高いフュージョン物標が左死角領域RdLに進入した可能性が高いこと(即ち、左死角領域RdLにフュージョン物標が存在している可能性が高いこと)を表している。左死角進入判定フラグXdLは、その値が「0」の場合、左死角領域RdLに進入したフュージョン物標が左死角領域RdLから離脱した可能性が高いこと(即ち、左死角領域RdLにフュージョン物標が存在しない可能性が高いこと)を表している。
右死角進入判定フラグXdr:右死角進入判定フラグXdrは、その値が「1」の場合、右死角領域Rdrに長時間とどまる可能性が高いフュージョン物標が右死角領域Rdrに進入した可能性が高いこと(即ち、右死角領域Rdrにフュージョン物標が存在している可能性が高いこと)を表している。右死角進入判定フラグXdrは、その値が「0」の場合、右死角領域Rdrに進入したフュージョン物標が右死角領域Rdrから離脱した可能性が高いこと(即ち、右死角領域Rdrにフュージョン物標が存在しない可能性が高いこと)を表している。
CPUは、ステップ1340に進んだとき図14のステップ1400を介してステップ1405に進み、任意の推定物標を選択する。次いで、CPUはステップ1410に進み、ステップ1325の第1グルーピング処理において「ステップ1405にて選択した推定物標に統合できると判定されたセンサ物標」の数(グルーピング物標数)が「1」以上であったか否かを判定する。
そのグルーピング物標数が「1」以上であった場合、CPUは、ステップ1410にて「Yes」と判定する。そして、CPUはステップ1415に進み、そのフュージョン物標を構成するように統合したセンサ物標のセンサ物標情報に基づいて、そのフュージョン物標のフュージョン物標情報である「物標幅Wf、物標長さLf、中心位置の座標(Xfc、Yfc)、相対速度(縦相対速度Vxf及び横相対速度Vyf)及び演算サイクル数Cy」を演算する。この場合、演算サイクル数Cyは、「+1」だけインクリメントされる。更に、CPUは、そのフュージョン物標情報に含まれる連続外挿フレーム数fの値を「0」に設定する。この連続外挿フレーム数fの値については後述する。
CPUは、ステップ1415の処理を終了するとステップ1420に進み、そのフュージョン物標情報を、ステップ1415にて演算したフュージョン物標情報へと更新する。
次いで、CPUは、ステップ1422に進み、そのフュージョン物標情報の今回の存在確率Trstを演算する。より具体的に述べると、CPUは、先ず、ステップ1420にて更新したフュージョン物標情報に含まれる縦相対速度Vxfの絶対値をブロックBK1に示したルックアップテーブルMap1に適用することにより、存在確率の上昇率rupを演算する。このルックアップテーブルMap1は図8に示したグラフのルックアップテーブルである。尚、ルックアップテーブルはマップと称呼される場合がある。次に、CPUは、前回の存在確率Trstpre、存在確率の上昇率rup及び演算サイクル数Cyを上述した(A)式(Trst=Trstpre+rup・Cy)に適用して今回の存在確率Trstを演算する。演算サイクル数Cyは、そのフュージョン物標が生成されてからの更新回数(演算回数)である。
次いで、CPUはステップ1425に進み、今回の演算時における推定物標の総てが選択されたか否かを判定する。推定物標の総てが選択されていない場合、CPUはステップ1425にて「No」と判定してステップ1405に戻り、未選択の推定物標を選択する。これに対し、推定物標の総てが選択されていた場合、CPUはステップ1425にて「Yes」と判定し、ステップ1495を経由して図13のステップ1395へと進む。
一方、CPUがステップ1410の処理を行う時点において、ステップ1405にて選択した推定物標に対して統合できると判定されたセンサ物標の数(グルーピング物標数)が「0」であった場合、前述したフュージョン物標の外挿(外挿処理)を行う。即ち、この場合、CPUはステップ1410にて「No」と判定してステップ1425に進み、「ステップ1405にて選択され且つ統合できるセンサ物標の数が「0」であった推定物標の元となった前回フュージョン物標」が既に外挿中でないか否かを判定する。実際には、CPUは、この判定を、この前回フュージョン物標に対する連続外挿フレーム数fの値が「0」であるか否か判定することによって実施する。
連続外挿フレーム数fの値は、前回フュージョン物標が外挿中ではない場合に前述のステップ1415にて「0」に設定されている。よって、CPUがステップ1425の処理を行なう場合、連続外挿フレーム数fの値が「0」であれば、前回フュージョン物標は「既に外挿中」ではないと判定できる。
前回フュージョン物標が外挿中ではない場合(連続外挿フレーム数fの値が「0」である場合)、CPUは、ステップ1425にて「Yes」と判定してステップ1426に進み、左死角進入判定フラグON条件が満たされているか否かを判定する。左死角進入判定フラグON条件は、下記の条件LIN1、条件LIN2及び条件LIN3の総てが満たされたとき満たされる条件である。
(条件LIN1)前回フュージョン物標の相対速度(縦相対速度Vxf)の絶対値|Vxf|が閾値相対速度Vgxthより小さい。
(条件LIN2)前回フュージョン物標のAGEが第1閾値AGE以上である。
(条件LIN3)前回フュージョン物標の座標位置(Xf、Yf)が左死角進入判定領域DL1の範囲内にある。
尚、左死角進入判定領域DL1の範囲は、例えば、以下のように規定されている(図10を参照。)。
縦位置XdL1範囲(X軸方向の範囲):−J1<XdL1<J2
横位置YdL1範囲(Y軸方向の範囲):K1<YdL1<K2
中心位置(X,Y):((−J1+J2)/2,(K1+K2)/2)
J1,J2及びK2は正の値であり、K1は0以上の値である。前述したように、左死角進入判定領域DL1の範囲に、左死角領域RdLが含まれる。より具体的に述べると、これらの値は以下のように設定される。
−J1は、自車両SVの後端のX座標位置より小さい値であり、且つ、左死角領域RdLの後端のX座標位置以下の値である。
J2は、自車両SVの前端のX座標位置より大きい値であり、且つ、左死角領域RdLの前端のX座標位置以上の値である。
K1は、0以上の値であり且つ自車両SVの左端のY座標位置以下の値に設定される。
K2は、自車両SVの左端のY座標位置より大きい値であり、且つ、左死角領域RdLの左端のY座標位置以上の値に設定される。
左死角進入判定フラグON条件が満たされている場合、立体物が左死角領域RdLに進入した可能性が高いと考えられる。そこで、この場合CPUはステップ1426にて「Yes」と判定してステップ1427に進み、左死角進入判定フラグXdLの値を「1」に設定した後、ステップ1430に進む。
これに対し、左死角進入判定フラグON条件が満たされていない場合、CPUはステップ1426にて「No」と判定してステップ1428に進み、右死角進入判定フラグON条件が満たされているか否かを判定する。右死角進入判定フラグON条件は、下記の条件RIN1、条件RIN2及び条件RIN3の総てが満たされたとき満たされる条件である。
(条件RIN1)前回フュージョン物標の相対速度(縦相対速度Vxf)の絶対値|Vxf|が閾値相対速度Vgxthより小さい。
(条件RIN2)前回フュージョン物標のAGEが第1閾値AGE以上である。
(条件RIN3)前回フュージョン物標の座標位置(Xf、Yf)が右死角進入判定領域DR1の範囲内にある。
尚、右死角進入判定領域DR1の範囲は、例えば、以下のように規定されている(図10を参照。)。
縦位置Xdr1範囲(X軸方向の範囲):−J3<Xdr1<J4
横位置Ydr1範囲(Y軸方向の範囲):−K3<Ydr1<−K4
中心位置(X,Y):((−J3+J4)/2,(−K3+(−K4))/2)
J3,J4及びK3は正の値であり、K4は0以上の値である。前述したように、右死角進入判定領域DR1の範囲に、右死角領域Rdrが含まれる。より具体的に述べると、これらの値は以下のように設定される。
−J3は、自車両SVの後端のX座標位置より小さい値であり、且つ、右死角領域Rdrの後端のX座標位置以下の値である。
J4は、自車両SVの前端のX座標位置より大きい値であり、且つ、右死角領域Rdrの前端のX座標位置以上の値である。
−K4は、0以下の値であり且つ自車両SVの右端のY座標位置以上の値に設定される。
−K3は、自車両SVの右端のY座標位置より小さい値であり、且つ、右死角領域Rdrの左端のY座標位置以下の値に設定される。
右死角進入判定フラグON条件が満たされている場合、立体物が右死角領域RdRに進入した可能性が高いと考えられる。そこで、この場合、CPUはステップ1428にて「Yes」と判定してステップ1429に進み、右死角進入判定フラグXdrの値を「1」に設定した後、ステップ1430に進む。
これに対し、右死角進入判定フラグON条件が満たされていない場合、CPUはステップ1428にて「No」と判定してステップ1430に進む。
CPUはステップ1430に進むと、フュージョン物標の外挿処理を継続させる時間の最大値である最大外挿継続時間tgを決定する。具体的に述べると、CPUは、前回フュージョン物標の存在確率Trst及び縦相対速度の絶対値|Vxf|をブロックBK2に示したルックアップテーブルMap2に適用することによって、最大外挿継続時間tgを決定する。このルックアップテーブルMap2は図9に示したグラフのルックアップテーブルである。
その後、CPUはステップ1435に進み、前述したフュージョン物標の外挿処理を実行し、今回の演算タイミングにおけるフュージョン物標のフュージョン物標情報(今回フュージョン物標情報)を、推定物標の物標情報に更新する。即ち、今回フュージョン物標情報は推定物標の物標情報により置換される。その後、CPUはステップ1440に進み、フュージョン物標の連続外挿フレーム数fの値を「+1」だけインクリメントする。尚、以下では、ステップ1435の処理を行った後であって、連続外挿フレーム数fが1以上のフュージョン物標は「外挿中のフュージョン物標」と称呼される。
一方、CPUがステップ1425の処理を行う時点において、「ステップ1405にて選択され且つ統合できるセンサ物標の数が「0」であった推定物標の元となった前回フュージョン物標」が「外挿中のフュージョン物標」である場合(即ち、連続外挿フレーム数fが「1」以上である場合)、CPUはステップ1425にて「No」と判定する。そして、CPUはステップ1445に進み、最大外挿継続時間tgから外挿継続時間(演算周期Δt×連続外挿フレーム数f)を減算することにより、残余外挿時間tg’を演算する。
その後、CPUはステップ1450に進み、ステップ1445にて演算した残余外挿時間tg’が0以下であるか否かを判定する。
残余外挿時間tg’が0より大きい場合、CPUはステップ1450にて「No」と判定してステップ1435に進み、フュージョン物標の外挿処理を実施する。このように、「フュージョン物標の外挿」は、ステップ1410にて推定物標に対してグルーピングできたセンサ物標の数が1以上にならない限り、演算周期Δtが経過する毎に繰り返し行われる。その後、CPUは、ステップ1440にて連続外挿フレーム数fの値を更新し、ステップ1425へと進む。
これに対し、フュージョン物標の外挿処理が繰り返して行われて残余外挿時間tg’が0以下となった場合、CPUはステップ1450にて「Yes」と判定してステップ1455に進み、「外挿中のフュージョン物標」をロストしたと判定する。即ち、CPUは、外挿中のフュージョン物標が消失したと判定する。尚、このとき、CPUは、連続外挿フレーム数fの値を「0」に設定しておく。
ところで、前述したように、推定物標に統合できないと判定されたセンサ物標が存在している場合、図13のステップ1335にて第2グルーピングフラグXg2の値が「1」に設定される。第2グルーピングフラグXg2の値が「1」に設定されると、図15に示した第2グルーピングルーチンにより、推定物標に統合できないと判定されたセンサ物標に基づいて新規のフュージョン物標が生成される。
具体的に述べると、CPUは、所定のタイミングにて図15のルーチンのステップ1500から処理を開始して、ステップ1510に進み、第2グルーピングフラグXg2の値が「1」であるか否かを判定する。
第2グルーピングフラグXg2の値が「1」である場合、CPUはステップ1510にて「Yes」と判定して、以下に述べるステップ1515乃至ステップ1525の処理を順に行った後、ステップ1595に進み、本ルーチンを一旦終了する。
ステップ1515:CPUは、前述した第2グルーピング処理を実行する。
ステップ1520:CPUは、ステップ1515にて生成された新規のフュージョン物標のフュージョン物標情報を演算する。このとき、CPUは、新規のフュージョン物標情報の一つである演算サイクル数Cyの値を「1」に設定する。
ステップ1525:第2グルーピングフラグXg2の値を「0」に設定する。
尚、ステップ1510の処理の時点で第2グルーピングフラグXg2の値が「0」である場合、CPUはステップ1510にて「No」と判定してステップ1595に直接進み、本ルーチンを一旦終了する。
更に、CPUは、図16に示した左死角進入判定フラグOFFルーチンを、所定時間Δtが経過する毎に実行するようになっている。従って、CPUは、所定のタイミングになると図16のルーチンのステップ1600から処理を開始して、ステップ1610に進み、左死角進入判定フラグXdLの値が「1」であるか否かを判定する。
左死角進入判定フラグXdLの値が「1」である場合、CPUはステップ1610にて「Yes」と判定してステップ1615に進み、下記の左死角進入判定フラグOFF条件の総てが満たされているか否かを判定する。
・新規物標生成グルーピング処理(ステップ1215)及び第2グルーピング処理(ステップ1515)にて新規なフュージョン物標が生成(特定)され、且つ、その新規なフュージョン物標の座標位置(Xfs、Yfs)が左死角離脱判定領域DL2の範囲内にあること。
・その新規なフュージョン物標のAGEが第2閾値AGE以上になったこと。
尚、左死角離脱判定領域DL2の範囲は、例えば、以下のように規定されている(図11を参照。)。
縦位置XdL2範囲(X軸方向の範囲):−J1’<XdL2<J2’
横位置YdL2範囲(Y軸方向の範囲):K1’<YdL2<K2’
中心位置(X,Y):((−J1’+J2’)/2,(K1’+K2’)/2)
J1’,J2’及びK2’は正の値であり、K1’は0以上の値である。前述したように、左死角離脱判定領域DL2の範囲に、左死角進入判定領域DL1が含まれる。より具体的に述べると、これらの値は以下のように設定される。
−J1’は、自車両SVの後端のX座標位置より小さい値であり、且つ、左死角進入判定領域DL1の後端のX座標位置(−J1)以下の値である。
J2’は、自車両SVの前端のX座標位置より大きい値であり、且つ、左死角進入判定領域DL1の前端のX座標位置(J2)以上の値である。
K1’は、0以上の値であり且つ左死角進入判定領域DL1の左端のY座標位置(K1)以下の値に設定される。
K2’は、左死角進入判定領域DL1の左端のY座標位置(K2)以上の値に設定される。
左死角進入判定フラグOFF条件が満たされない場合、CPUはステップ1615にて「No」と判定してステップ1695に進み、本ルーチンを一旦終了する。
これに対し、左死角進入判定フラグOFF条件が満たされる場合、左死角領域RdLに進入した可能性が高い立体物が左死角領域RdLから離脱した可能性が高いと考えられる。そこで、この場合、CPUはステップ1615にて「Yes」と判定してステップ1620に進み、左死角進入判定フラグXdLの値を「0」に設定し、その後ステップ1695に進んで本ルーチンを一旦終了する。
更に、CPUは、図17に示した右死角進入判定フラグOFFルーチンを、所定時間Δtが経過する毎に実行するようになっている。従って、CPUは、所定のタイミングになると図17のルーチンのステップ1700から処理を開始して、ステップ1710に進み、右死角進入判定フラグXdrの値が「1」であるか否かを判定する。
右死角進入判定フラグXdrの値が「1」である場合、CPUはステップ1710にて「Yes」と判定してステップ1715に進み、下記の右死角進入判定フラグOFF条件の総てが満たされているか否かを判定する。
・新規物標生成グルーピング処理(ステップ1215)及び第2グルーピング処理(ステップ1515)にて新規なフュージョン物標が生成(特定)され、且つ、その新規なフュージョン物標の座標位置(Xfs、Yfs)が右死角離脱判定領域DR2の範囲内にあること。
・その新規なフュージョン物標のAGEが第2閾値AGE以上になったこと。
尚、右死角離脱判定領域DR2の範囲は、例えば、以下のように規定されている(図11を参照。)。
縦位置Xdr2範囲(X軸方向の範囲):−J3’<Xdr2<J4’
横位置Ydr2範囲(Y軸方向の範囲):−K3’<Ydr2<−K4’
中心位置(X,Y):((−J3’+J4’)/2,(−K3’+(−K4’))/2)
J3',J4'及びK3'は正の値であり、K4'は0以上の値である。前述したように、右死角離脱判定領域DR2の範囲に、右死角進入判定領域DR1が含まれる。より具体的に述べると、これらの値は以下のように設定される。
−J3'は、自車両SVの後端のX座標位置より小さい値であり、且つ、右死角進入判定領域DR1の後端のX座標位置(−J3)以下の値である。
J4'は、自車両SVの前端のX座標位置より大きい値であり、且つ、右死角進入判定領域DR1の前端のX座標位置(J4)以上の値である。
−K4'は、0以下の値であり且つ右死角進入判定領域DR1の左端のY座標位置(−K4)以上の値に設定される。
−K3'は、右死角進入判定領域DR1の右端のY座標位置(−K3)以下の値に設定される。
右死角進入判定フラグOFF条件が満たされない場合、CPUはステップ1715にて「No」と判定してステップ1795に進み、本ルーチンを一旦終了する。
これに対し、右死角進入判定フラグOFF条件が満たされる場合、右死角領域Rdrに進入した可能性が高い立体物が右死角領域Rdrから離脱した可能性が高いと考えられる。そこで、この場合、CPUはステップ1715にて「Yes」と判定してステップ1720に進み、右死角進入判定フラグXdrの値を「0」に設定し、その後ステップ1795に進んで本ルーチンを一旦終了する。
加えて、CPUは、図18に示した車線変更支援制御実行ルーチンを、所定時間Δtが経過する毎に実行するようになっている。従って、CPUは、所定のタイミングになると、図18のステップ1800から処理を開始してステップ1810に進み、車線変更支援制御の前提条件が成立しているか否かを判定する。車線変更支援制御の前提条件は、次の2つの条件が総て成立しているときに成立する条件である。
・追従車間距離制御及び車線維持制御が実行中であること。
・操作スイッチ17によって車線変更支援制御の実行が選択されていること。
車線変更支援制御の前提条件が成立していない場合、CPUはステップ1810にて「No」と判定してステップ1895に進み、本ルーチンを一旦終了する。
これに対し、車線変更支援制御の前提条件が成立している場合、CPUはステップ1810にて「Yes」と判定してステップ1815に進み、ウインカーレバーの操作によって右車線又は左車線への車線変更支援要求が発生しているか否かを判定する。
右車線又は左車線への車線変更支援要求が発生していない場合、CPUはステップ1815にて「No」と判定してステップ1895に進み、本ルーチンを一旦終了する。
右車線又は左車線への車線変更支援要求が発生している場合、CPUはステップ1815にて「Yes」と判定してステップ1820に進み、フュージョン物標情報に基づいて、車線変更支援制御の許可条件が成立しているか否かを判定する。尚、CPUは、ステップ1815にて車線変更支援要求が発生していると判定した場合に、更に、その要求に基づいて隣接目標車線を特定し、自車線とその隣接目標車線との境界となる白線が破線であるか否かを判定し、その境界となる白線が破線である場合にステップ1815にて「Yes」と判定してステップ1820に進んでもよい。
本実施形態における車線変更支援制御の許可条件は、以下の総ての条件が成立したときに成立する条件である。
・自車両SVと隣接目標車線に位置しているフュージョン物標(外挿中フュージョン物標を含む。)との衝突余裕時間(そのフュージョン物標の縦距離をそのフュージョン物標の縦相対速度で除した値)が閾値時間以上であること。
・自車両SVの隣接目標車線側の真横(自車両SVの前端及び後端それぞれのX軸座標位置の範囲内)にフュージョン物標(外挿中フュージョン物標を含む。)が存在していないこと。
車線変更支援制御許可条件が成立してない場合、CPUはステップ1820にて「No」と判定してステップ1895に進み、本ルーチンを一旦終了する。
車線変更支援制御許可条件が成立している場合、CPUはステップ1820にて「Yes」と判定してステップ1825に進み、車線変更支援要求が左方向への車線変更であるか否か(隣接目標車線が左車線であるか否か)を判定する。
隣接目標車線が左車線である場合、CPUはステップ1825にて「Yes」と判定してステップ1830に進み、左死角進入判定フラグXdLの値が「0」に設定されているか否かを判定する。
左死角進入判定フラグXdLの値が「0」に設定されている場合、CPUはステップ1830にて「Yes」と判定してステップ1840に進み、左車線への車線変更支援制御を実行する。
これに対し、左死角進入判定フラグXdLの値が「1」に設定されている場合、左死角領域RdLに立体物(他車両)が存在している可能性が高い。換言すると、左車線への車線変更支援制御が許容されない状態になっている。従って、この場合、CPUはステップ1830にて「No」と判定して、直接ステップ1895に進み、本ルーチンを一旦終了する。即ち、CPUは左車線への車線変更支援制御の実行を行わない(禁止する)。
CPUがステップ1825の処理を実行する時点において、車線変更支援要求が左方向への車線変更でない(隣接目標車線が左車線でない)場合、換言すると、車線変更支援要求が右方向への車線変更である場合、CPUはステップ1825にて「No」と判定してステップ1835に進み、右死角進入判定フラグXdrの値が「0」に設定されているか否かを判定する。
右死角進入判定フラグXdrの値が「0」に設定されている場合、CPUはステップ1835にて「Yes」と判定してステップ1840に進み、右車線への車線変更支援制御を実行する。
これに対し、右死角進入判定フラグXdrの値が「1」に設定されている場合、右死角領域Rdrに立体物(他車両)が存在している可能性が高い。換言すると、右車線への車線変更支援制御が許容されない状態になっている。従って、この場合、CPUはステップ1835にて「No」と判定して、直接ステップ1895に進み、本ルーチンを一旦終了する。即ち、CPUは左車線への車線変更支援制御の実行を行わない(禁止する)。
以上説明したように、第1装置は、フュージョン物標に対応する立体物が死角領域にとどまっている可能性が高いと判定した場合、最大外挿継続時間が経過することによりそのフュージョン物標がロスト(消滅)したと判定した場合(即ち、ステップ1820の条件が成立した場合)であっても、その死角領域が存在する側の車線への車線変更支援制御を禁止することができる。
更に、第1装置によれば、フュージョン物標に対応する立体物が死角領域Rdから離脱した可能性が高くなってから、その死角領域が存在する側の車線への車線変更支援制御が許可される。従って、死角領域に立体物が存在する可能性が高い状況下で車線変更支援制御が行われてしまう可能性を低くすることができる。
<第2実施形態>
次に、本発明の第2実施形態に係る車線変更支援装置(以下、「第2装置」と称呼される場合がある。)について説明する。
<作動の概要>
第2装置は、外挿対象フュージョン物標に対応する立体物が死角領域Rdに進入した可能性が高いとの判定(以下、「死角領域進入判定」と称呼する。)がなされた時点から当該死角領域Rdから離脱した可能性が高いと判定される時点までの間に、その死角領域進入判定が誤判定であると考えられる事象が発生したとき、死角内物標存在側車線を隣接目標車線とする車線変更支援制御の実行可否状態を実行許可状態に設定する点、のみにおいて、第1装置と相違している。
具体的に述べると、DSECUは、次に述べる判定取消条件の何れか一つを満たすか否かを判定する。当該条件1乃至条件5の何れか一つを満たすと判定された場合、DSECUは、死角領域Rdに進入した可能性が高いと判定された立体物が当該死角領域Rdから離脱した可能性が高いと判定される前の時点であっても、死角内物標存在側車線を隣接目標車線とする車線変更支援制御の実行可否状態を実行許可状態に設定する。
判定取消条件1:死角内物標存在側車線が左車線であって、その左車線を隣接目標車線とする車線変更支援制御の実行可否状態が実行禁止状態に設定されている場合(即ち、XdL=1の場合)に、存在確率の高いフュージョン物標が「左死角離脱判定領域DL2」の範囲内に新たに進入したこと。
判定取消条件2:死角内物標存在側車線が右車線であって、その右車線を隣接目標車線とする車線変更支援制御の実行可否状態が実行禁止状態に設定されている場合(即ち、Xdr=1の場合)に、存在確率の高いフュージョン物標が「右死角離脱判定領域DR2」の範囲内に新たに進入したこと。
判定取消条件1及び2が設定される理由は、以下のとおりである。即ち、車線変更支援制御の実行可否状態が実行禁止状態に設定されている場合に「存在確率の高いフュージョン物標」が「死角内物標存在側車線が存在する側の死角離脱判定領域」内に進入してくるということは、そもそもその「死角内物標存在側車線が存在する側の死角領域Rd」内には立体物は存在していない可能性が高いと判断できる。
判定取消条件1及び2が成立しているか否かの判定方法は以下のとおりである。
即ち、DSECUは、存在確率Trstが閾値存在確率以上であるフュージョン物標(外形)と、死角内物標存在側車線が存在する側の死角離脱判定領域と、が重複する部分を有する場合、判定取消条件1又は判定取消条件2が満たされると判定する。
尚、死角離脱判定領域(左死角離脱判定領域、又は、右死角離脱判定領域)の中心座標位置(ARx、ARy)及び存在確率Trstが閾値存在確率以上であるフュージョン物標の「座標位置(Xf、Yf)、長さLf、及び、幅Wf」が、以下の関係式の両方を満たす場合、そのフュージョン物標と死角離脱判定領域とが重複する領域を有すると判定できる。
|Xf−ARx|<((死角離脱判定領域の長さ×0.5)+(フュージョン物標の長さLf×0.5))
|Yf−ARy|<((死角離脱判定領域の長さ×0.5)+(フュージョン物標の長さLf×0.5))
判定取消条件3:運転者の操舵操作(オーバーライド操舵操作)によって、死角内物標存在側車線又は死角内物標存在側車線と逆側の車線への車線変更が行われたこと。
判定取消条件3が成立しているか否かの判定方法は以下のとおりである。
仮に、死角内物標存在側車線の側の死角領域Rdに立体物が存在しているのであれば、運転者は死角内物標存在側車線への車線変更を行うような操舵操作を行わない筈である。それにも関わらず、その車線への車線変更が運転者の操舵操作によって行われた場合には、死角内物標存在側車線の側の死角領域Rdに立体物が存在しない可能性が高いと判断できる。更に、死角内物標存在側車線とは反対側の車線への車線変更が運転者の操舵操作によって行われた場合、死角領域Rdに存在している立体物が自車両SVの横移動に追従することにより死角領域Rdに留まり続けることは極めて困難である。よって、この場合にも、死角内物標存在側車線の側の死角領域Rdに立体物が存在しなくなった可能性が高いと判定できる。
判定取消条件3が成立しているか否かの判定方法は以下のとおりである。
即ち、DSECUは、次の3つの条件の何れかが成立したときに、判定取消条件3が成立したと判定する。尚、次の3つの条件において、自車両SVの左右の移動方向は考慮しない。
・自車両SVが、運転者の操舵操作によって自車両SVが走行中の車線と左車線との間の白線を跨いだこと。
・自車両SVが、運転者の操舵操作によって自車両SVが走行中の車線と右車線との間の白線を跨いだこと。
・運転者の操舵操作によって自車両SVの横移動量が閾値移動量以上になったこと。具体的に述べると、DSECUは、死角進入判定フラグがOFFからONになったときの白線中央(車線中心ラインCL)までのオフセット値(横偏差Dy)と現在の白線中央までのオフセット値(横偏差Dy)との差の大きさ(絶対値)が所定値以上になったとき、自車両SVの横移動量が閾値移動量以上になったと判定する。尚、所定値は判定に適切な値に適宜設定される。運転者の操舵操作は、操舵トルクTraに基づき検出される。
判定取消条件4:自車両SVが低速で走行中であること。
自車両SVが非常に低速で走行中である場合、死角領域Rdに進入したフュージョン物標が、自車両SVに長時間追従走行している可能性は低く、この場合、外挿対象フュージョン物標に対応する立体物が死角領域Rdに存在しない可能性が高いと判断できる。この取消条件4の判定は次のように行われる。即ち、DSECUは、自車両SVの車速が閾値車速(閾値低速車速)より小さいか否かを判定し、自車両SVの車速が閾値車速(閾値低速車速)より小さいと判定したとき、判定取消条件4が成立すると判定する。尚、この閾値車速は、判定に適切な任意の車速に設定される。
判定取消条件5:フュージョン物標をロストしたまま非常に長い時間経過したこと。
死角領域Rdに進入した可能性が高いと判定したフュージョン物標がロストされたまま非常に長い時間が経過したときには、そのフュージョン物標に対応する立体物が死角領域Rdに存在しない可能性が高いと判断できる。この場合、DSECUは、死角進入判定フラグ(XdL又はXdr)が「0」から「1」になった時点からの経過時間が閾値時間より大きくなった場合に、判定取消条件5が満たされると判定する。尚、閾値時間は、判定に適切な任意の時間に設定される。
(具体的作動)
第2装置のCPUは、以下に述べる相違点以外は、第1装置のCPUが実施するルーチンと同じルーチン(図12乃至図18に示したルーチン)を実行する。
第2装置のCPUは、ステップ1615及びステップ1715のそれぞれにて既述の判定に加えて、更に、判定取消条件1乃至5の何れか一つが満たされるか否かについても判定する。
即ち、ステップ1615(ステップ1715)の処理の時点で、既に述べた条件、及び、判定取消条件1乃至5の何れか一つが満たされる場合、CPUはステップ1615(ステップ1715)にて「Yes」と判定して、ステップ1620(ステップ1720)に進む。
ステップ1615(ステップ1715)の処理の時点で、既に述べた条件、及び、判定取消条件1乃至5の、何れの一つもが満たされない場合、CPUはステップ1615(ステップ1715)にて「No」と判定して、ステップ1695(ステップ1795)に進み、本ルーチンを一旦終了する。
以上説明した第2装置によれば、第1装置と同様の構成を奏する。更に、第2装置によれば、「死角領域に立体物が存在していないにも関わらず、立体物が存在していると誤判定され、それにより、その死角領域が存在する側の車線への車線変更支援制御が禁止されてしまう可能性」を低くすることができる。
<変形例>
以上、本発明の各実施形態について具体的に説明したが、本発明は、上述の各実施形態に限定されるものではなく、本発明の技術的思想に基づく各種の変形が可能である。
例えば、第1装置及び第2装置は、自車両の周囲に存在する立体物を示す判定対象物標として、フュージョン物標を使用しているが、当該フュージョン物標に代えて、単独のセンサ物標に基づいて特定した「立体物を示す物標」を、判定対象物標(車線変更支援制御を安全に行えるか否かの判定の対象となる物標)として使用してもよい。更に、例えば、第1装置及び第2装置は、1又は複数のセンサ物標に基づいて、当該フュージョン物標の生成方法とは異なる他の方法により生成した立体物を示す物標を判定対象物標として使用してもよい。
例えば、第2装置は、ステップ1615(ステップ1715)の処理の時点で、判定取消条件1乃至5の任意の位置以上の組み合わせが成立しているか否かを判定するように構成されてもよい。例えば、上述の各実施形態においては、追従車間距離制御及び車線維持制御の実行中であることが、車線変更支援制御を実行するための前提となっているが、必ずしも、そのような前提は必要としない。
10…運転支援ECU、15…車速センサ、16a…周辺レーダセンサ、16FC…中央前方周辺センサ、16FR…右前方周辺センサ、16FL…左前方周辺センサ、16RR…右後方周辺センサ、16RL…左後方周辺センサ、16b…カメラセンサ、17…操作スイッチ、52…転舵用モータ、53…ウインカーレバースイッチ

Claims (9)

  1. それぞれが、自車両の周囲に送信するレーダ波の立体物による反射点をセンサ物標として検出し、前記検出したセンサ物標の前記自車両に対する位置及び速度を特定するための位置速度情報を検出する複数のレーダセンサと、
    所定時間が経過する毎に、前記位置速度情報に基づいて前記自車両の周囲に存在する立体物を示す判定対象物標を特定する物標特定手段と、
    前記自車両が走行中の車線である自車線から当該自車線に隣接する車線である目標隣接車線へと当該自車線が車線変更するための走行を支援するように当該自車両の舵角を制御する車線変更支援制御を実行する制御実行手段と、
    前記制御実行手段が前記車線変更支援制御を実行することを禁止する制御禁止手段と、
    を備えた、
    車線変更支援装置であって、
    前記物標特定手段は、
    所定時間前に特定された前記判定対象物標である前回判定対象物標に対応する前記センサ物標が検出されなくなった場合、前記対応する前記センサ物標が検出されなくなった前記前回判定対象物標である着目判定対象物標に対応する前記センサ物標が検出されない限り、前記着目判定対象物標の前記自車両に対する位置及び速度に基づいて、当該着目判定対象物標に対応する外挿判定対象物標を特定する外挿処理、を最大外挿継続時間が経過するまで継続的に行ない、前記外挿処理が、前記最大外挿継続時間が経過する時点まで継続されたときに前記着目判定対象物標に対応する立体物がロストしたと判定するように構成され、
    前記制御実行手段は、
    前記目標隣接車線に前記立体物が存在しない場合において前記制御禁止手段により前記車線変更支援制御を実行することが禁止されていないとき、前記車線変更支援制御を実行するように構成された、
    車線変更支援装置において、
    前記制御禁止手段は、
    記前回判定対象物標に対応する前記センサ物標が検出されなくなった場合、前記対応する前記センサ物標が検出されなくなった前記前回判定対象物標である着目判定対象物標の前記自車両に対する速度の大きさが閾値相対速度より小さく、且つ、前記着目判定対象物標の前記自車両に対する位置が前記複数のレーダセンサの何れもが前記センサ物標を検出できない死角領域の全体を包含する死角進入判定領域の範囲内にあるという条件を含む死角領域進入判定条件が成立している場合、前記着目判定対象物標が前記死角領域に進入した可能性が高いと判定し、前記外挿処理が前記最大外挿継続時間が経過する時点まで継続されて前記着目判定対象物標に対応する立体物がロストしたと判定されても、前記制御実行手段が前記車線変更支援制御を実行することを禁止し、
    前記制御実行手段が前記車線変更支援制御を実行することを禁止してからの経過時間が閾値時間より大きくなった場合、前記制御実行手段が前記車線変更支援制御を実行することを許容する、
    ように構成された、
    車線変更支援装置。
  2. 請求項1に記載の車線変更支援装置において、
    前記物標特定手段は、
    前記判定対象物標が継続して特定されている時間が長くなるほど大きくなる判定対象物標の信頼度を取得するように構成され、
    前記制御禁止手段は、
    前記着目判定対象物標の前記信頼度が第1閾値信頼度以上であるという条件が更に成立しているときに前記死角領域進入判定条件が成立していると判定するように構成された、
    車線変更支援装置。
  3. 請求項1に記載の車線変更支援装置において、
    前記制御禁止手段は、
    前記車線変更支援制御を実行することを禁止している状態において、前記物標特定手段により新規な前記判定対象物標が特定され、且つ、前記新規な判定対象物標の前記自車両に対する位置が前記死角進入判定領域を包含する死角離脱判定領域の範囲内であるという条件を含む死角領域離脱判定条件が成立している場合、前記着目判定対象物標が前記死角領域から離脱した可能性が高いと判定して前記制御実行手段が前記車線変更支援制御を実行することを許容するように構成された、
    車線変更支援装置。
  4. 請求項3に記載の車線変更支援装置において、
    前記物標特定手段は、
    前記判定対象物標が継続して特定されている時間が長くなるほど大きくなる判定対象物標の信頼度を取得するように構成され、
    前記制御禁止手段は、
    前記新規な判定対象物標の前記信頼度が第2閾値信頼度以上であるという条件が更に成立しているときに前記死角領域離脱判定条件が成立していると判定するように構成された、
    車線変更支援装置。
  5. 請求項3に記載の車線変更支援装置において、
    記制御実行手段は、
    前記特定された判定対象物標及び前記ロストしたと判定される前の前記着目判定対象物標の前記自車両に対する位置及び速度に基づいて、これらの判定対象物標が示す立体物が前記車線変更支援制御を実行する上での障害にならないと判定したとき前記車線変更支援制御を実行するように構成された、
    車線変更支援装置。
  6. 請求項1に記載の車線変更支援装置において、
    前記物標特定手段は、
    前記判定対象物標が継続して特定されている時間が長くなるほど大きくなる判定対象物標の信頼度を取得するように構成され、
    前記制御禁止手段は、
    前記着目判定対象物標の前記信頼度が第1閾値信頼度以上であるという条件が更に成立しているときに前記死角領域進入判定条件が成立していると判定するように構成され、
    前記制御禁止手段は、
    前記車線変更支援制御を実行することを禁止している状態において、前記物標特定手段により新規な前記判定対象物標が特定され、且つ、前記新規な判定対象物標の前記自車両に対する位置が前記死角進入判定領域を包含する死角離脱判定領域の範囲内であり、且つ、前記新規な判定対象物標の前記信頼度が前記第1閾値信頼度より大きい値に設定された第2閾値信頼度以上であるという条件を含む死角領域離脱判定条件が成立している場合、前記着目判定対象物標が前記死角領域から離脱した可能性が高いと判定して前記制御実行手段が前記車線変更支援制御を実行することを許容するように構成された、
    車線変更支援装置。
  7. 請求項1乃至請求項6の何れか一項に記載の車線変更支援装置において、
    前記物標特定手段は、
    前記判定対象物標の存在確率を演算するように構成され、
    前記制御禁止手段は、
    前記制御実行手段が前記車線変更支援制御を実行することを禁止している期間において、
    前記着目判定対象物標とは相違する他の判定対象物標であって前記存在確率が閾値存在確率以上の他の判定対象物標が、前記死角離脱判定領域内の所定範囲に進入した場合、前記制御実行手段が前記車線変更支援制御を実行することを許容するように構成された、
    車線変更支援装置。
  8. 請求項1乃至請求項7の何れか一項に記載の車線変更支援装置において、
    前記制御禁止手段は、
    前記制御実行手段が前記車線変更支援制御を実行することを禁止している期間において、前記自車両の運転者の操舵操作により前記車線変更支援制御に優先して前記舵角が変更されることによって前記自車両が前記自車線から逸脱した場合、前記制御実行手段が前記車線変更支援制御を実行することを許容するように構成された、
    車線変更支援装置。
  9. 請求項1乃至請求項8の何れか一項に記載の車線変更支援装置において、
    前記制御禁止手段は、
    前記制御実行手段が前記車線変更支援制御を実行することを禁止している期間において、前記自車両の車速が、閾値車速より小さくなった場合、前記制御実行手段が前記車線変更支援制御を実行することを許容するように構成された、
    車線変更支援装置。
JP2017114771A 2017-06-09 2017-06-09 車線変更支援装置 Active JP6958001B2 (ja)

Priority Applications (4)

Application Number Priority Date Filing Date Title
JP2017114771A JP6958001B2 (ja) 2017-06-09 2017-06-09 車線変更支援装置
DE102018113514.9A DE102018113514A1 (de) 2017-06-09 2018-06-06 Spurwechselunterstützungsvorrichtung
US16/002,569 US10457278B2 (en) 2017-06-09 2018-06-07 Lane changing support apparatus
CN201810581878.7A CN109017791B (zh) 2017-06-09 2018-06-07 车道变更辅助装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2017114771A JP6958001B2 (ja) 2017-06-09 2017-06-09 車線変更支援装置

Publications (2)

Publication Number Publication Date
JP2019001183A JP2019001183A (ja) 2019-01-10
JP6958001B2 true JP6958001B2 (ja) 2021-11-02

Family

ID=64332574

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2017114771A Active JP6958001B2 (ja) 2017-06-09 2017-06-09 車線変更支援装置

Country Status (4)

Country Link
US (1) US10457278B2 (ja)
JP (1) JP6958001B2 (ja)
CN (1) CN109017791B (ja)
DE (1) DE102018113514A1 (ja)

Families Citing this family (22)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP6780461B2 (ja) * 2016-11-14 2020-11-04 いすゞ自動車株式会社 運転支援システム及び運転支援方法
JP6572880B2 (ja) * 2016-12-28 2019-09-11 トヨタ自動車株式会社 運転支援装置
US11625045B2 (en) * 2017-08-31 2023-04-11 Uatc, Llc Systems and methods for controlling an autonomous vehicle with occluded sensor zones
US11396297B2 (en) * 2018-02-26 2022-07-26 Honda Motor Co., Ltd. Vehicle control system, vehicle control method, and program
US10839263B2 (en) * 2018-10-10 2020-11-17 Harman International Industries, Incorporated System and method for evaluating a trained vehicle data set familiarity of a driver assitance system
JP7303667B2 (ja) * 2019-05-31 2023-07-05 株式会社Subaru 自動運転支援装置
KR20210035523A (ko) * 2019-09-24 2021-04-01 현대자동차주식회사 차량 주행제어 방법 및 장치
DE102020000593A1 (de) * 2020-01-30 2021-08-05 Daimler Ag Verfahren zum Betrieb eines Assistenzsystems
US11400930B2 (en) * 2020-02-14 2022-08-02 GM Global Technology Operations LLC Simultaneous lane change situational awareness
JP7439910B2 (ja) * 2020-04-06 2024-02-28 日産自動車株式会社 車両挙動推定方法、車両制御方法及び車両挙動推定装置
KR102368441B1 (ko) * 2020-05-28 2022-02-28 쌍용자동차 주식회사 사각지대경고장치를 결합한 사각지대 감시장치 및 방법
JP2022018618A (ja) 2020-07-16 2022-01-27 トヨタ自動車株式会社 車両制御装置
KR20220026005A (ko) * 2020-08-24 2022-03-04 현대모비스 주식회사 레이더 센서를 기반으로 한 차선 변경 충돌 예측 시스템 및 방법
CN112668428A (zh) * 2020-12-21 2021-04-16 北京百度网讯科技有限公司 车辆变道的检测方法、路侧设备、云控平台和程序产品
CN113064172B (zh) * 2021-03-16 2023-12-19 安徽卡思普智能科技有限公司 基于毫米波雷达与机器视觉融合的汽车安全换道方法
US20220396313A1 (en) * 2021-06-15 2022-12-15 Steering Solutions Ip Holding Corporation Systems and methods for active blind zone assist
FR3130228A1 (fr) * 2021-12-10 2023-06-16 Psa Automobiles Sa - Procédé et dispositif de contrôle d’un système de changement de voie automatique
CN114379557B (zh) * 2021-12-23 2023-12-15 浙江吉利控股集团有限公司 自动变道方法、自动变道控制装置和自动变道***
CN114516331B (zh) * 2022-02-10 2024-04-09 苏州挚途科技有限公司 车辆换道控制方法、装置和电子设备
JP7441255B2 (ja) 2022-03-17 2024-02-29 本田技研工業株式会社 制御装置、制御装置の動作方法、プログラム及び記憶媒体
FR3137887A1 (fr) * 2022-07-18 2024-01-19 Psa Automobiles Sa Procédé et dispositif de contrôle d’un système SALC d’un premier véhicule en fonction de la présence d’un deuxième véhicule sur une voie latérale de destination
EP4358063A1 (en) * 2022-10-19 2024-04-24 Continental Autonomous Mobility Germany GmbH Blind spot detection control apparatus and method

Family Cites Families (28)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS4929777A (ja) 1972-07-18 1974-03-16
JP3765687B2 (ja) * 1998-06-03 2006-04-12 本田技研工業株式会社 車両走行安全装置
JP4013856B2 (ja) * 2003-07-08 2007-11-28 日産自動車株式会社 後側方警報装置
JP2005138647A (ja) 2003-11-05 2005-06-02 Tokai Rika Co Ltd 車両用方向指示装置
JP4349210B2 (ja) 2004-06-02 2009-10-21 トヨタ自動車株式会社 運転支援装置
JP4172434B2 (ja) 2004-07-30 2008-10-29 トヨタ自動車株式会社 車間距離制御装置
JP4507976B2 (ja) 2005-05-11 2010-07-21 トヨタ自動車株式会社 車両用走行制御装置
JP4678247B2 (ja) * 2005-06-23 2011-04-27 マツダ株式会社 車両の制御装置
JP4929777B2 (ja) 2006-03-23 2012-05-09 トヨタ自動車株式会社 車両用走行制御装置
JP2008129974A (ja) * 2006-11-24 2008-06-05 Alpine Electronics Inc 周辺監視装置
JP2009190464A (ja) 2008-02-12 2009-08-27 Toyota Motor Corp 車線維持支援装置
JP2009274594A (ja) 2008-05-15 2009-11-26 Hitachi Ltd 車線変更支援装置
JP4702398B2 (ja) 2008-05-26 2011-06-15 トヨタ自動車株式会社 運転支援装置
JP5233432B2 (ja) * 2008-06-16 2013-07-10 アイシン・エィ・ダブリュ株式会社 運転支援システム、運転支援方法及び運転支援プログラム
JP5220492B2 (ja) 2008-06-27 2013-06-26 株式会社豊田中央研究所 車線維持支援装置
US10046716B2 (en) * 2011-02-10 2018-08-14 Denso Corporation In-vehicle camera and vehicle control system
JP2012226392A (ja) * 2011-04-14 2012-11-15 Honda Elesys Co Ltd 運転支援システム
US9586525B2 (en) * 2011-11-28 2017-03-07 Robert Bosch Gmbh Camera-assisted blind spot detection
DE102012201046A1 (de) * 2012-01-25 2013-07-25 Robert Bosch Gmbh Verfahren und Vorrichtung zur Unterstützung eines Fahrers
JP6158523B2 (ja) 2013-02-04 2017-07-05 トヨタ自動車株式会社 車間距離制御装置
DE102014001115A1 (de) * 2014-01-28 2015-07-30 Man Truck & Bus Ag Verfahren und Fahrerassistenzsystem zur Unterstützung eines Fahrers eines Kraftfahrzeuges bei einem Fahrspurwechsel
JP6318864B2 (ja) * 2014-05-29 2018-05-09 トヨタ自動車株式会社 運転支援装置
JP6443011B2 (ja) * 2014-12-01 2018-12-26 株式会社デンソー 物標検出装置
JP6365390B2 (ja) 2015-04-27 2018-08-01 トヨタ自動車株式会社 車線変更支援装置
JP6507862B2 (ja) * 2015-06-02 2019-05-08 トヨタ自動車株式会社 周辺監視装置及び運転支援装置
CN104960523A (zh) * 2015-06-25 2015-10-07 奇瑞汽车股份有限公司 一种智能车智能变道辅助***及其控制方法
JP6555067B2 (ja) 2015-10-13 2019-08-07 トヨタ自動車株式会社 車線変更支援装置
CN106428001B (zh) * 2016-09-28 2018-11-16 浙江吉利控股集团有限公司 一种用于车辆的变道预警方法及***

Also Published As

Publication number Publication date
JP2019001183A (ja) 2019-01-10
DE102018113514A1 (de) 2018-12-13
CN109017791A (zh) 2018-12-18
CN109017791B (zh) 2022-05-06
US20180354510A1 (en) 2018-12-13
US10457278B2 (en) 2019-10-29

Similar Documents

Publication Publication Date Title
JP6958001B2 (ja) 車線変更支援装置
JP6816658B2 (ja) 物標情報取得装置
JP6583252B2 (ja) 運転支援装置
JP6897349B2 (ja) 運転支援装置
JP6586930B2 (ja) 車両走行制御装置
JP6627822B2 (ja) 車線変更支援装置
US9159235B2 (en) Method of operating a driver assistance system of a motor vehicle
JP6828602B2 (ja) 物標検出装置
JP6898591B2 (ja) 車両運転支援装置
JP2018103769A (ja) 車両の車線変更支援装置
JP6805970B2 (ja) 物標情報取得装置
JP2019003234A (ja) 運転支援装置
JP2018103941A (ja) 運転支援装置
JP4983564B2 (ja) 車両用追従装置
JP2018103766A (ja) 車両の車線変更支援装置
JP2018103862A (ja) 運転支援装置
JP2018203097A (ja) 操舵支援装置
JP2007141179A (ja) 車両の運転支援方法及び運転支援装置
JP6970547B2 (ja) 車両制御装置及び車両制御方法
JP7067379B2 (ja) 車両の車線変更支援装置
WO2020027241A1 (ja) 車両走行制御装置
JP7091956B2 (ja) 車両の車線変更支援装置
JP2019029901A (ja) 周辺監視装置
JP2009126433A (ja) 車両制御装置
JP5614079B2 (ja) 運転支援装置

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20190827

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20200729

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20200901

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20201030

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20210511

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20210705

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20210920

R151 Written notification of patent or utility model registration

Ref document number: 6958001

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R151