JP7458429B2 - 経路生成装置 - Google Patents

経路生成装置 Download PDF

Info

Publication number
JP7458429B2
JP7458429B2 JP2022008738A JP2022008738A JP7458429B2 JP 7458429 B2 JP7458429 B2 JP 7458429B2 JP 2022008738 A JP2022008738 A JP 2022008738A JP 2022008738 A JP2022008738 A JP 2022008738A JP 7458429 B2 JP7458429 B2 JP 7458429B2
Authority
JP
Japan
Prior art keywords
vehicle
function
driving
unit
lane
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
JP2022008738A
Other languages
English (en)
Other versions
JP2023107503A (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.)
Honda Motor Co Ltd
Original Assignee
Honda Motor Co Ltd
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 Honda Motor Co Ltd filed Critical Honda Motor Co Ltd
Priority to JP2022008738A priority Critical patent/JP7458429B2/ja
Priority to CN202310013691.8A priority patent/CN116483065A/zh
Priority to US18/098,687 priority patent/US20230234581A1/en
Publication of JP2023107503A publication Critical patent/JP2023107503A/ja
Application granted granted Critical
Publication of JP7458429B2 publication Critical patent/JP7458429B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G01C21/34Route searching; Route guidance
    • G01C21/3407Route searching; Route guidance specially adapted for specific applications
    • 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/10Path keeping
    • B60W30/12Lane keeping
    • 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
    • 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/06Road 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
    • 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/06Road conditions
    • B60W40/072Curvature of the road
    • 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/10Estimation 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 vehicle motion
    • B60W40/114Yaw movement
    • 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
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0214Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0238Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
    • G05D1/024Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors in combination with a laser
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0246Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
    • G05D1/0253Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means extracting relative motion information from a plurality of images taken successively, e.g. visual odometry, optical flow
    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G1/00Traffic control systems for road vehicles
    • G08G1/01Detecting movement of traffic to be counted or controlled
    • G08G1/052Detecting movement of traffic to be counted or controlled with provision for determining speed or overspeed
    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G1/00Traffic control systems for road vehicles
    • G08G1/09Arrangements for giving variable traffic instructions
    • G08G1/0962Arrangements for giving variable traffic instructions having an indicator mounted inside the vehicle, e.g. giving voice messages
    • G08G1/0967Systems involving transmission of highway information, e.g. weather, speed limits
    • G08G1/096708Systems involving transmission of highway information, e.g. weather, speed limits where the received information might be used to generate an automatic action on the vehicle control
    • G08G1/096725Systems involving transmission of highway information, e.g. weather, speed limits where the received information might be used to generate an automatic action on the vehicle control where the received information generates an automatic action on the vehicle control
    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G1/00Traffic control systems for road vehicles
    • G08G1/09Arrangements for giving variable traffic instructions
    • G08G1/0962Arrangements for giving variable traffic instructions having an indicator mounted inside the vehicle, e.g. giving voice messages
    • G08G1/0968Systems involving transmission of navigation instructions to the vehicle
    • G08G1/096805Systems involving transmission of navigation instructions to the vehicle where the transmitted instructions are used to compute a route
    • 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/403Image sensing, e.g. optical camera
    • 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
    • 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/14Yaw
    • 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
    • B60W2552/00Input parameters relating to infrastructure
    • B60W2552/30Road curve radius
    • 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
    • B60W2552/00Input parameters relating to infrastructure
    • B60W2552/53Road markings, e.g. lane marker or crosswalk

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • General Physics & Mathematics (AREA)
  • Mathematical Physics (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Electromagnetism (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Optics & Photonics (AREA)
  • Atmospheric Sciences (AREA)
  • Human Computer Interaction (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Multimedia (AREA)
  • Traffic Control Systems (AREA)
  • Navigation (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)

Description

本発明は、自動運転機能や運転支援機能を有する車両の目標走行経路を生成する経路生成装置に関する。
従来より、自動運転車両の目標走行経路を生成するようにした装置が知られている(例えば特許文献1参照)。特許文献1記載の装置では、カメラまたはレーダセンサを用いて走行車線の左右両側の区画線の位置を認識し、左右の区画線上における互いに向かい合う2点の中心点を求め、複数の中心点を繋ぐことで目標走行経路を生成する。
自動運転機能や運転支援機能を有する車両が普及することで、交通社会全体の安全性や利便性が向上し、持続可能な輸送システムを実現することができる。また、輸送の効率性や円滑性が向上することで、CO2排出量が削減され、環境への負荷を軽減することができる。
特開2018-118589号公報
ところで、熟練運転者がカーブ路を走行するときは、走行車線の中央よりも旋回方向内側にオフセットして走行することがある。しかしながら、上記特許文献1記載の装置では、車両が単に走行車線の中央を走行するための目標走行経路が生成されるだけであり、熟練運転者がカーブ路を走行するときのような自然な目標走行経路を生成することが難しい。
本発明の一態様である経路生成装置は、車両が走行する走行車線を認識する車線認識部と、車線認識部により認識された走行車線の中央を通る走行経路を表す第1関数を導出する第1導出部と、車線認識部により認識された走行車線の曲率半径を算出する曲率半径算出部と、曲率半径算出部により算出された曲率半径に基づいて、走行車線の中央から旋回方向内側へのオフセット量を決定するオフセット決定部と、第1導出部により導出された第1関数と、オフセット決定部により決定されたオフセット量と、に基づいて、オフセット後の車両の目標走行経路を表す第2関数を導出する第2導出部と、を備える。第1関数および第2関数は、車両の進行方向をX軸、車幅方向をY軸とする3次関数である。第2導出部は、第1導出部により導出された第1関数の3次の項の係数を第2関数の3次の項の係数、第2関数の1次の項の係数および定数項を0として、オフセット決定部により決定されたオフセット量に基づいて第2関数の2次の項の係数を導出する。
本発明によれば、熟練運転者がカーブ路を走行するときのような自然な目標走行経路を生成することができる。
熟練運転者がカーブ路を走行するときの車両の走行経路について説明するための図。 本発明の実施形態に係る経路生成装置の要部構成および処理の流れの一例を概略的に示すブロック図。 図2の第1導出部および第2導出部によりそれぞれ導出される第1関数および第2関数について説明するための図。 目標通過地点を定めるための予見時間の設定について説明するための図。 図2のオフセット決定部によるオフセット量の決定について説明するための図。 図2の第2導出部による第2関数の導出について説明するための図。
以下、図1~図6を参照して本発明の実施形態について説明する。本発明の実施形態に係る経路生成装置は、車両の運転者に対する運転支援を行うないし車両を自動運転するように走行用アクチュエータを制御する運転支援機能を有する車両に適用され、車両の目標走行経路(目標走行軌道)を生成する。本実施形態における「運転支援」は、運転者の運転操作を支援する運転支援と、運転者の運転操作によらず車両を自動運転する自動運転とを含み、SAEにより定義されるレベル1~レベル4の自動運転に相当し、「自動運転」は、レベル5の自動運転に相当する。
図1は、熟練運転者がカーブ路を走行するときの車両1の走行経路について説明するための図である。図1に実線矢印で示すように、熟練運転者がカーブ路を走行するときは、左右の区画線2L,2Rで区画された走行車線2の中央2Cよりも旋回方向内側にオフセットして走行することがある。これは、最短距離を走行するためであったり、遠心力により旋回方向外側へ膨らむことを見込んで安心感を得るためであったりする。このため、運転支援または自動運転によりカーブ路を走行するとき、単に走行車線2の中央2Cを走行するように車両1が制御されると、運転者や同乗者が不満や不安を感じるおそれがある。
運転支援中または自動運転中は、所定周期で車両1の走行位置、走行速度、進行方向等の走行状態および車両前方の外部状況が検出され、検出結果に応じて車両1の目標走行経路が生成され、生成された目標走行経路に沿って走行するように車両1が制御される。本実施形態では、カーブに合わせて車両1の目標走行経路を走行車線2の中央2Cより旋回方向内側にオフセットさせることで、熟練運転者がカーブ路を走行するときのような自然な目標走行経路を生成することができるよう、以下のように経路生成装置を構成する。
図2は、本発明の実施形態に係る経路生成装置(以下、装置)100の要部構成および処理の流れの一例を概略的に示すブロック図である。図2に示すように、装置100は、主に電子制御ユニット(ECU)10により構成される。ECU10は、CPU等の演算部、RAM,ROM等の記憶部、I/Oインタフェース、その他の周辺回路を有するコンピュータを含んで構成される。ECU10は、例えば車両1に搭載されて車両1の動作を制御する複数のECU群の一部として構成される。図2の処理は、例えば車両1が始動してECU10が起動されると開始され、所定周期で繰り返される。
ECU10には、車両1に搭載された走行用アクチュエータ3と、車速センサ4と、測位ユニット5と、ヨーレートセンサ6と、外部センサ7とが接続される。走行用アクチュエータ3には、車両1を転舵させるステアリングギアなどの転舵機構が含まれる。車速センサ4は、例えば車輪の回転速度を検出する車輪速センサにより構成され、車両1の走行速度(車速)Vを検出する。測位ユニット5は、測位衛星からの測位信号に基づいて車両1の絶対位置(緯度、経度、高度)を測定する。ヨーレートセンサ6は、車両1の重心の鉛直軸回りの回転角速度(ヨーレート)を検出する。ヨーレートセンサ6の検出値を時間積分することで、車両1の絶対方位(方位角)を算出することができる。
外部センサ7は、車両1の進行方向を中心とする車両前方の外部状況を検出する。外部センサ7は、例えば、CCDやCMOS等の撮像素子を有し、車両前方を撮像するカメラにより構成される。外部センサ7は、ミリ波(電波)を照射し、照射波が物体に当たって戻ってくるまでの時間から、その物体までの距離や方向を測定するミリ波レーダにより構成されてもよい。外部センサ7は、レーザ光を照射し、照射光が物体に当たって戻ってくるまでの時間から、その物体までの距離や方向を測定するライダ(LiDAR)により構成されてもよい。
ECU10は、演算部の機能的構成として、車線認識部11と、第1導出部12と、曲率半径算出部13と、幅員推定部14と、オフセット決定部15と、第2導出部16と、走行制御部17とを有する。すなわち、ECU10の演算部は、車線認識部11と、第1導出部12と、曲率半径算出部13と、幅員推定部14と、オフセット決定部15と、第2導出部16と、走行制御部17として機能する。
車線認識部11は、外部センサ7からの信号に基づいて、車両1の進行方向を中心とする車両前方の道路上の区画線、縁石、ガードレール等の位置を認識することで、車両1が走行する走行車線2を認識する。
図3は、第1導出部12および第2導出部16によりそれぞれ導出される第1関数F1(X)および第2関数F2(X)について説明するための図である。第1導出部12は、車線認識部11により認識された走行車線2の中央2Cを通る走行経路を表す第1関数F1(X)を導出する。
より具体的には、第1導出部12は、車線認識部11による認識結果に基づいて走行車線2に対する車両1の進行方向を特定し、図3に示すように、車両1の現在位置を原点O、特定された進行方向をX軸として、第1関数F1(X)を導出する。測位ユニット5により検出された車両1の絶対位置と、ヨーレートセンサ6の検出値に基づいて算出される車両1の絶対方位とに基づいて、例えばECU10の記憶部に予め記憶された地図上の走行車線2に対する車両1の進行方向を特定してもよい。
次いで、第1導出部12は、最小二乗法等のカーブフィッティング手法を用いて、車線認識部11により認識された左右の区画線(あるいは縁石、ガードレール等)2L,2Rを近似する下式(i),(ii)の3次関数F1L(X),F1R(X)を導出する。
1L(X)=C3L3+C2L2+C1LX+C0L ・・・(i)
1R(X)=C3R3+C2R2+C1RX+C0R ・・・(ii)
次いで、第1導出部12は、左右の区画線2L,2Rに対応する3次関数F1L(X),F1R(X)に基づいて、走行車線2の中央2Cを通る走行経路に対応する下式(iii)の第1関数F1(X)を導出する。
1(X)=C33+C22+C1X+C0 ・・・(iii)
3=(C3L+C3R)/2,C2=(C2L+C2R)/2,
1=(C1L+C1R)/2,C0=(C0L+C0R)/2
一般的なカーブ路の道路形状は、曲率が一定の割合で変化するクロソイド曲線を用いて設計されており、道路形状に対応するクロソイド曲線の一部の区間は、3次関数等の高次関数を用いて近似することができる。3次関数等の高次関数を用いて道路形状を近似する場合、クロソイド曲線を用いて道路形状を近似する場合よりも演算負荷を低減することができる。
曲率半径算出部13は、車速センサ4により検出された車両1の速度Vと、第1導出部12により導出された第1関数F1(X)とに基づいて、所定時間(以下、予見時間)tp後の走行位置における走行車線2の曲率半径Rを算出する。予見時間tpは、目標走行経路が通過すべき目標通過地点Pを定めるために予め設定される、現時点から目標通過地点Pを通過するまでの走行時間である。予見時間tp後の走行位置に相当する目標通過地点PのX座標(予見距離)Xpは、下式(iv)を用いて算出される。
p=Vtp ・・・(iv)
予見時間tp後の走行位置における走行車線2の曲率半径Rは、走行車線2の中央2Cを通る走行経路の旋回半径として、下式(v)を用いて算出される。R>0の場合が左旋回に対応し、R<0の場合が右旋回に対応する。
R={1+(3C3p 2+2C2p+C121.5/(6C3p+2C2) ・・・(v)
図4は、予見時間tpの設定について説明するための図であり、予見時間tpを変えて目標通過地点Pを定めたときの、現時点から1秒後における目標走行経路と実際の走行経路との車幅方向の誤差(平均値)の一例を示す。図4に示すように、予見時間tp(予見距離Xp)が短過ぎ、目標通過地点Pが近過ぎても、予見時間tp(予見距離Xp)が長過ぎ、目標通過地点Pが遠過ぎても、目標走行経路と実際の走行経路との誤差が大きくなる。予見時間tpは、予め行われた試験の結果等に基づいて最適な時間(例えば3.1秒程度)に設定される。
幅員推定部14は、車線認識部11により認識された走行車線2の幅員Wを推定する。例えば、数センチおきに予め定められた幅員W1,W2,W3(W1<W2<W3)のいずれであるかを特定する。
オフセット決定部15は、幅員推定部14により推定された幅員Wと、曲率半径算出部13により算出された曲率半径Rとに基づいて、予見時間tp後の走行位置における走行車線2の中央2Cから旋回方向内側へのオフセット量ΔYを決定する。より具体的には、図3に示すように、予見時間tp後における走行車線2の中央2Cを通る走行経路(第1関数F1(X))上の走行位置(Xp,Yp)と、目標通過地点Pとのオフセット量ΔYを決定する。予見時間tp後における走行車線2の中央2Cを通る走行経路上のY座標Ypは、下式(vi)を用いて算出される。
p=F1(Xp)=C3p 3+C2p 2+C1p+C0 ・・・(vi)
図5は、オフセット決定部15によるオフセット量ΔYの決定について説明するための図であり、ECU10の記憶部に予め記憶された特性の一例を示す。オフセット決定部15は、ECU10の記憶部に記憶された特性を参照し、幅員推定部14により推定された幅員Wと、曲率半径算出部13により算出された曲率半径Rとに基づいて、オフセット量ΔYを決定する。
図5に示すように、オフセット量ΔYは、幅員Wが大きいほど大きく設定され、曲率半径Rの絶対値が大きいほど小さく設定される。オフセット量ΔYには、幅員Wに応じて上限値が設けられる。直線路または直線路に近い極緩やかなカーブ路では、オフセット量ΔYが“0”に設定される。
第2導出部16は、第1導出部12により導出された第1関数F1(X)と、オフセット決定部15により決定されたオフセット量ΔYとに基づいて、オフセット後の車両1の目標走行経路を表す第2関数F2(X)を導出する。換言すると、第2導出部16は、車両1の現在位置である原点Oと、目標通過地点P(Xp,Yp+ΔY)とを通過する目標走行経路を表す下式(vii)の第2関数F2(X)を導出する。
2(X)=C33+C2(^)X2 ・・・(vii)
2(^)=(Yp+ΔY-C3p 3)/Xp 2
式(vii)に示すように、3次関数である第2関数F2(X)により目標走行経路を表すことで、クロソイド曲線を用いて設計された道路形状に沿った目標走行経路を生成することができる。また、式(iii)に示す走行車線2の中央を通る走行経路を表す第1関数F1(X)の3次の項の係数C3を、式(vii)に示す第2関数F2(X)の3次の項の係数として流用することで、走行車線2の形状に応じた自然な目標走行経路を生成することができる。
さらに、式(vii)に示すように、車両1の進行方向をX軸とする座標系において目標走行経路を表す第2関数F2(X)の1次の項の係数を“0”とすることで、車両1の現在の進行方向と目標走行経路上の進行方向とが一致する。すなわち、車両1の現在位置である原点Oにおける、目標走行経路上の進行方向を表す第2関数F2(X)の接線の傾きF2´(0)が“0”となるため、車両1の現在の進行方向と目標走行経路上の進行方向とが一致する。また、第2関数F2(X)の定数項を“0”とすることで、車両1の現在の走行位置と目標走行経路上の走行位置とが原点O上で一致する。これにより、車両1が現在までに実際に走行した走行経路と、今後の目標走行経路とを円滑に接続することができる。
図6は、第2導出部16による第2関数F2(X)の導出について説明するための図であり、高次の項の係数の適合方法を変えたときの第2関数F2(X)の一例を示す。点線で示すように、第1関数F1(X)の3次の項の係数C3と2次の項の係数C2を、そのまま第2関数F2(X)の3次の項の係数C3と2次の項の係数C2として流用しただけでは、旋回方向内側に適切にオフセットした目標走行経路を生成することができない。
一方、第2関数F2(X)が図3の目標通過地点P(Xp,Yp+ΔY)を通るように、高次の項の係数のうちの少なくとも1つを適合することで、目標走行経路を旋回方向内側に適切にオフセットさせることができる。これにより、走行車線2の曲率に応じた適切なオフセット量ΔYを設定することができ、熟練運転者がカーブ路を走行するときのような自然な目標走行経路を生成することができる。
さらに、3次の項の係数C3を流用して2次の項の係数C2(^)を適合する場合(一点鎖線)は、2次の項の係数C2を流用して3次の項の係数C3(^)を適合する場合(二点鎖線)よりも、早い段階でオフセットする目標走行経路を生成することができる。すなわち、高次関数の特性上、車両1の走行位置に相当するX座標が"1"に到達するまでの早い段階では、より次数の低い項の係数を大きく設定することで、旋回方向内側へのオフセット量に相当するY座標を大きくすることができる。この場合、より緩やかにオフセットする目標走行経路を生成することができる。
走行制御部17は、第2導出部16により導出された第2関数F2(X)で表される、旋回方向内側に適切にオフセットする目標走行経路に沿って車両1が走行するように、走行用アクチュエータ3を制御する。これにより、熟練運転者がカーブ路を走行するときのような自然な目標走行経路に沿って車両1を走行させることができる。
本実施形態によれば以下のような作用効果を奏することができる。
(1)装置100は、車両1が走行する走行車線2を認識する車線認識部11と、車線認識部11により認識された走行車線2の中央を通る走行経路を表す第1関数F1(X)を導出する第1導出部12と、車線認識部11により認識された走行車線2の曲率半径Rを算出する曲率半径算出部13と、曲率半径算出部13により算出された曲率半径Rに基づいて、走行車線2の中央から旋回方向内側へのオフセット量ΔYを決定するオフセット決定部15と、第1導出部12により導出された第1関数F1(X)と、オフセット決定部15により決定されたオフセット量ΔYとに基づいて、オフセット後の車両1の目標走行経路を表す第2関数F2(X)を導出する第2導出部16とを備える(図2)。
これにより、走行車線2の曲率に応じた適切なオフセット量ΔYを設定することができ、熟練運転者がカーブ路を走行するときのような自然な目標走行経路を生成することができる(図1、図3)。
(2)第1関数F1(X)および第2関数F2(X)は、車両1の進行方向をX軸、車幅方向をY軸とする2次以上の高次関数である。一般的な道路形状を表すクロソイド曲線を3次関数等の高次関数を用いて近似することで、目標走行経路の生成に要する演算負荷を低減することができる。
(3)第1関数F1(X)および第2関数F2(X)は、3次関数である。第2導出部16は、第1導出部12により導出された第1関数F1(X)の3次の項の係数C3を第2関数F2(X)の3次の項の係数、第2関数F2(X)の1次の項の係数および定数項を“0”として、オフセット決定部15により決定されたオフセット量ΔYに基づいて第2関数F2(X)の2次の項の係数C2(^)を決定する。
走行車線2の中央を通る走行経路を表す第1関数F1(X)の3次の項の係数C3を流用することで、走行車線2の形状に応じた自然な目標走行経路を生成することができる。
また、車両1の進行方向をX軸とする座標系において目標走行経路を表す第2関数F2(X)の1次の項の係数を“0”とすることで、車両1の現在の進行方向と目標走行経路上の進行方向とを一致させることができる。また、第2関数F2(X)の定数項を“0”とすることで、車両1の現在の走行位置と目標走行経路上の走行位置とを一致させることができる。これにより、車両1が現在までに実際に走行した走行経路と、今後の目標走行経路とを円滑に接続することができる。
さらに、高次の項の係数C3,C2(^)のうち2次の項の係数C2(^)を適合することで、より早期かつ緩やかに旋回方向内側にオフセットする目標走行経路を生成することができる(図6)。
(4)第1導出部12および第2導出部16は、車線認識部11による認識結果に基づいて走行車線2に対する車両1の進行方向を特定し、特定された車両1の進行方向をX軸として第1関数F1(X)および第2関数F2(X)をそれぞれ導出する。走行車線2は、車両1の進行方向を中心とする車両前方の画像を撮像するように設けられたカメラなどの外部センサ7による検出結果に基づいて認識されるため、認識結果に基づいて走行車線2に対する車両1の進行方向を特定することができる(図3)。
(5)装置100は、車両1に搭載され、車両1の重心の鉛直軸回りの回転角速度を検出するヨーレートセンサ6をさらに備える(図2)。第1導出部12および第2導出部16は、ヨーレートセンサ6からの信号に基づいて走行車線2に対する車両1の進行方向を特定し、特定された車両1の進行方向をX軸として第1関数F1(X)および第2関数F2(X)をそれぞれ導出する。例えば、測位ユニット5により検出された車両1の絶対位置と、ヨーレートセンサ6の検出値に基づいて算出される車両1の絶対方位とに基づいて、地図上の走行車線2に対する車両1の進行方向を特定することができる(図3)。
(6)装置100は、車両1の運転者に対する運転支援を行うないし車両1を自動運転するように走行用アクチュエータ3を制御する走行制御部17をさらに備える(図2)。走行制御部17は、第2導出部16により導出された第2関数F2(X)に基づいて、走行用アクチュエータ3を制御する。これにより、熟練運転者がカーブ路を走行するときのような自然な目標走行経路に沿って車両1を走行させることができる(図1、図3)。
上記実施形態では、車線認識部11が外部センサ7からの信号に基づいて走行車線2を認識する例を説明したが、走行車線を認識する車線認識部は、このようなものに限らず、例えば地図情報に基づいて地図上の走行車線2を特定するものでもよい。
上記実施形態では、第1関数F1(X)および第2関数F2(X)を3次関数等の高次関数として説明したが、第1関数および第2関数は、このようなものに限らない。第2関数は、少なくとも車両1の現在位置である原点Oと、目標通過地点P(Xp,Yp+ΔY)とを通るものであればよく、例えば1次関数や円、正弦曲線等の関数であってもよい。
上記実施形態では、装置100が走行制御部17を備える例を説明したが、経路生成装置は、このようなものに限らない。例えば、第2導出部16により導出された第2関数F2(X)で表される目標走行経路を車両前方の道路に重畳して表示するようにヘッドアップディスプレイ等の表示部を制御する表示制御部を備えるものでもよい。
以上の説明はあくまで一例であり、本発明の特徴を損なわない限り、上述した実施形態および変形例により本発明が限定されるものではない。上記実施形態と変形例の1つまたは複数を任意に組み合わせることも可能であり、変形例同士を組み合わせることも可能である。
1 車両、2 走行車線、3 走行用アクチュエータ、4 車速センサ、5 測位ユニット、6 ヨーレートセンサ、7 外部センサ、10 電子制御ユニット(ECU)、11 車線認識部、12 第1導出部、13 曲率半径算出部、14 幅員推定部、15 オフセット決定部、16 第2導出部、17 走行制御部、100 経路生成装置(装置)

Claims (4)

  1. 車両が走行する走行車線を認識する車線認識部と、
    前記車線認識部により認識された走行車線の中央を通る走行経路を表す第1関数を導出する第1導出部と、
    前記車線認識部により認識された走行車線の曲率半径を算出する曲率半径算出部と、
    前記曲率半径算出部により算出された曲率半径に基づいて、前記走行車線の中央から旋回方向内側へのオフセット量を決定するオフセット決定部と、
    前記第1導出部により導出された第1関数と、前記オフセット決定部により決定された前記オフセット量と、に基づいて、オフセット後の前記車両の目標走行経路を表す第2関数を導出する第2導出部と、を備え
    前記第1関数および前記第2関数は、前記車両の進行方向をX軸、車幅方向をY軸とする3次関数であり、
    前記第2導出部は、前記第1導出部により導出された前記第1関数の3次の項の係数を前記第2関数の3次の項の係数、前記第2関数の1次の項の係数および定数項を0として、前記オフセット決定部により決定された前記オフセット量に基づいて前記第2関数の2次の項の係数を導出することを特徴とする経路生成装置。
  2. 請求項1に記載の経路生成装置において、
    前記第1導出部および前記第2導出部は、前記車線認識部による認識結果に基づいて前記走行車線に対する前記車両の進行方向を特定し、特定された前記車両の進行方向を前記X軸として前記第1関数および前記第2関数をそれぞれ導出することを特徴とする経路生成装置。
  3. 請求項1または2に記載の経路生成装置において、
    前記車両に搭載され、前記車両の重心の鉛直軸回りの回転角速度を検出するヨーレートセンサをさらに備え、
    前記第1導出部および前記第2導出部は、前記ヨーレートセンサによる検出結果に基づいて前記走行車線に対する前記車両の進行方向を特定し、特定された前記車両の進行方向を前記X軸として前記第1関数および前記第2関数をそれぞれ導出することを特徴とする経路生成装置。
  4. 請求項1~3のいずれか1項に記載の経路生成装置において、
    前記車両の運転者に対する運転支援を行うないし前記車両を自動運転するように走行用アクチュエータを制御する走行制御部をさらに備え、
    前記走行制御部は、前記第2導出部により導出された第2関数に基づいて、前記走行用アクチュエータを制御することを特徴とする経路生成装置。
JP2022008738A 2022-01-24 2022-01-24 経路生成装置 Active JP7458429B2 (ja)

Priority Applications (3)

Application Number Priority Date Filing Date Title
JP2022008738A JP7458429B2 (ja) 2022-01-24 2022-01-24 経路生成装置
CN202310013691.8A CN116483065A (zh) 2022-01-24 2023-01-05 路径生成装置和路径生成方法
US18/098,687 US20230234581A1 (en) 2022-01-24 2023-01-18 Path generation apparatus and path generation method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2022008738A JP7458429B2 (ja) 2022-01-24 2022-01-24 経路生成装置

Publications (2)

Publication Number Publication Date
JP2023107503A JP2023107503A (ja) 2023-08-03
JP7458429B2 true JP7458429B2 (ja) 2024-03-29

Family

ID=87210806

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2022008738A Active JP7458429B2 (ja) 2022-01-24 2022-01-24 経路生成装置

Country Status (3)

Country Link
US (1) US20230234581A1 (ja)
JP (1) JP7458429B2 (ja)
CN (1) CN116483065A (ja)

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2018181209A (ja) 2017-04-20 2018-11-15 マツダ株式会社 車両の運転支援装置
JP2019059441A (ja) 2017-09-28 2019-04-18 トヨタ自動車株式会社 車両運転支援装置
JP2019089549A (ja) 2019-01-29 2019-06-13 株式会社Subaru 車両の走行制御装置
JP2019156066A (ja) 2018-03-09 2019-09-19 株式会社Subaru 車両の走行制御装置

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2018181209A (ja) 2017-04-20 2018-11-15 マツダ株式会社 車両の運転支援装置
JP2019059441A (ja) 2017-09-28 2019-04-18 トヨタ自動車株式会社 車両運転支援装置
JP2019156066A (ja) 2018-03-09 2019-09-19 株式会社Subaru 車両の走行制御装置
JP2019089549A (ja) 2019-01-29 2019-06-13 株式会社Subaru 車両の走行制御装置

Also Published As

Publication number Publication date
CN116483065A (zh) 2023-07-25
US20230234581A1 (en) 2023-07-27
JP2023107503A (ja) 2023-08-03

Similar Documents

Publication Publication Date Title
EP3678109B1 (en) Position correction method for driving-assist vehicle and position error correction device
US10988139B2 (en) Vehicle position control method and device vehicle position control device for correcting position in drive-assisted vehicle
CN107615011B (zh) 停车位置设定装置及方法
CN107851392B (zh) 路径生成装置、路径生成方法及存储路径生成程序的介质
US11577719B2 (en) Autonomous driving control apparatus and autonomous driving control method for vehicle
US20190016339A1 (en) Vehicle control device, vehicle control method, and vehicle control program
US20180099666A1 (en) Vehicle control device
WO2018211582A1 (ja) 走行支援装置の動作予測方法及び動作予測装置
US11631257B2 (en) Surroundings recognition device, and surroundings recognition method
JP6429219B2 (ja) 車両制御装置、車両制御方法、および車両制御プログラム
JPWO2020025991A1 (ja) 走行軌跡補正方法、走行制御方法、及び走行軌跡補正装置
WO2016194168A1 (ja) 走行制御装置及び方法
US20220105929A1 (en) Method and Apparatus for Predicting Specification Motion of Other Vehicle
US10953876B2 (en) Target vehicle speed generation method and target vehicle speed generation device for driving-assisted vehicle
JP2020050108A (ja) 車両制御装置、車両制御方法、及びプログラム
JP2017140857A (ja) 車両制御システム
US12033403B2 (en) Vehicle control device, vehicle control method, and storage medium
JP7458429B2 (ja) 経路生成装置
JP7056379B2 (ja) 車両用走行制御装置
US20220306150A1 (en) Control device, control method, and storage medium
JP2007083817A (ja) 運転支援装置
JP2006293530A (ja) 車両用走行制御装置
JP7241800B2 (ja) 車両制御装置及び車両制御方法
JP7458428B2 (ja) 経路生成装置
US20230294702A1 (en) Control device, control method, and storage medium

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20220928

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20231205

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20240201

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20240318

R150 Certificate of patent or registration of utility model

Ref document number: 7458429

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150