JP2020132154A - 運転経路の計画方法、装置、車両、及びプログラム - Google Patents

運転経路の計画方法、装置、車両、及びプログラム Download PDF

Info

Publication number
JP2020132154A
JP2020132154A JP2020027726A JP2020027726A JP2020132154A JP 2020132154 A JP2020132154 A JP 2020132154A JP 2020027726 A JP2020027726 A JP 2020027726A JP 2020027726 A JP2020027726 A JP 2020027726A JP 2020132154 A JP2020132154 A JP 2020132154A
Authority
JP
Japan
Prior art keywords
length range
curve
reference curve
covering
adjustment
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.)
Granted
Application number
JP2020027726A
Other languages
English (en)
Other versions
JP7132960B2 (ja
Inventor
フゥ シアオシヌ
Xiaoxin Fu
フゥ シアオシヌ
ハオ ダヤン
Dayang Hao
ハオ ダヤン
ジュ ジェヌグアン
Zhenguang Zhu
ジュ ジェヌグアン
チェヌ ジユアン
Zhiyuan Chen
チェヌ ジユアン
ジュ ファヌ
Fan Zhu
ジュ ファヌ
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.)
Baidu Online Network Technology Beijing Co Ltd
Original Assignee
Baidu Online Network Technology Beijing 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 Baidu Online Network Technology Beijing Co Ltd filed Critical Baidu Online Network Technology Beijing Co Ltd
Publication of JP2020132154A publication Critical patent/JP2020132154A/ja
Application granted granted Critical
Publication of JP7132960B2 publication Critical patent/JP7132960B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • 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
    • 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
    • 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/095Predicting travel path or likelihood of collision
    • 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/095Predicting travel path or likelihood of collision
    • B60W30/0956Predicting travel path or likelihood of collision the prediction being responsive to traffic or environmental parameters
    • 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
    • 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
    • B60W60/00Drive control systems specially adapted for autonomous road vehicles
    • B60W60/005Handover processes
    • B60W60/0051Handover processes from occupants to vehicle
    • 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
    • G01C21/3415Dynamic re-routing, e.g. recalculating the route when the user deviates from calculated route or after detecting real-time traffic data or accidents
    • 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/3453Special cost functions, i.e. other than distance or default speed limit of road segments
    • 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/0217Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with energy consumption, time reduction or distance reduction criteria
    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G1/00Traffic control systems for road vehicles
    • G08G1/01Detecting movement of traffic to be counted or controlled
    • G08G1/0104Measuring and analyzing of parameters relative to traffic conditions
    • G08G1/0125Traffic data processing
    • G08G1/0133Traffic data processing for classifying traffic situation
    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G1/00Traffic control systems for road vehicles
    • G08G1/01Detecting movement of traffic to be counted or controlled
    • G08G1/0104Measuring and analyzing of parameters relative to traffic conditions
    • G08G1/0137Measuring and analyzing of parameters relative to traffic conditions for specific applications
    • G08G1/0145Measuring and analyzing of parameters relative to traffic conditions for specific applications for active traffic flow control
    • 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
    • B60W2050/0001Details of the control system
    • B60W2050/0002Automatic control, details of type of controller or control system architecture
    • B60W2050/0004In digital systems, e.g. discrete-time systems involving sampling
    • B60W2050/0005Processor details or data handling, e.g. memory registers or chip architecture
    • 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
    • B60W2050/0001Details of the control system
    • B60W2050/0043Signal treatments, identification of variables or parameters, parameter estimation or state estimation
    • B60W2050/005Sampling
    • 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
    • B60W2050/0001Details of the control system
    • B60W2050/0043Signal treatments, identification of variables or parameters, parameter estimation or state estimation
    • B60W2050/006Interpolation; Extrapolation
    • 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/50Barriers
    • 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/20Static 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/40Dynamic objects, e.g. animals, windblown 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

Landscapes

  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Remote Sensing (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Physics & Mathematics (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • General Physics & Mathematics (AREA)
  • Human Computer Interaction (AREA)
  • Chemical & Material Sciences (AREA)
  • Analytical Chemistry (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Mathematical Physics (AREA)
  • Traffic Control Systems (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)

Abstract

【課題】実際の交通シーンの複雑さを表すことが困難であるという問題及び経路がサンプリング精度により大きく影響されるという問題を解決するための運転経路の計画方法等を提供する。【解決手段】 方法は、第1の長さ範囲をカバーする少なくとも1つの参照曲線を決定し、第1の長さ範囲をカバーする少なくとも1つの参照曲線から第1の長さ範囲をカバーする目標参照曲線を選定することであって、目標参照曲線は少なくとも第1の長さ範囲における障害物を回避できる曲線である、選定することと、第1の長さ範囲をカバーする目標参照曲線から、第1の長さ範囲よりも小さく且つ第1の長さ範囲の開始位置と同じ開始位置を有する第2の長さ範囲をカバーする調整対象曲線を抽出することと、第2の長さ範囲内の安全性パラメータに基づいて、調整対象曲線を処理して調整曲線を得ることと、調整曲線及び目標参照曲線に基づいて、第1の長さ範囲をカバーする運転経路を決定することとを含む。【選択図】図1

Description

本発明は、無人運転制御技術の分野に関し、特に運転経路の計画方法、装置、車両、及びプログラムに関する。
従来の自動運転軌跡の計画方法は、通常、動的計画法を事後評価として用いて、失敗のないよう離散最適化問題を解くが、解の精度がサンプリング精度により大きく影響されるという問題があり、他の方式として、2次計画法を用いるが、実際の交通シーンの複雑さを表すことが困難であるという問題がある。
本発明は、実際の交通シーンの複雑さを表すことが困難であるという問題及び経路がサンプリング精度により大きく影響されるという問題を解決するための運転経路の計画方法、装置及び車両を提供する。
本発明の第1態様は、運転経路の計画方法を提供する。当該運転経路の計画方法は、
第1の長さ範囲をカバーする少なくとも1つの参照曲線を決定し、前記第1の長さ範囲をカバーする少なくとも1つの参照曲線から前記第1の長さ範囲をカバーする目標参照曲線を選定することであって、前記目標参照曲線は少なくとも前記第1の長さ範囲における障害物を回避できる曲線である、選定することと、
前記第1の長さ範囲をカバーする目標参照曲線から、前記第1の長さ範囲よりも小さく且つ前記第1の長さ範囲の開始位置と同じ開始位置を有する第2の長さ範囲をカバーする調整対象曲線を抽出することと、
前記第2の長さ範囲内の安全性パラメータに基づいて前記調整対象曲線を処理して調整曲線を得ることと、
前記調整曲線及び前記目標参照曲線に基づいて、前記第1の長さ範囲をカバーする運転経路を決定することと、を含む。
1つの実施形態において、第1の長さ範囲をカバーする少なくとも1つの参照曲線を決定することは、
現在位置に基づいて、初期の運転参照線から、現在位置から前記第1の長さ範囲をカバーする運転参照線分を選定することと、
前記運転参照線分に基づいて、少なくとも1つのサンプル点を決定することと、
決定された少なくとも1つのサンプル点に基づいて、前記第1の長さ範囲をカバーする少なくとも1つの参照曲線を生成することとを含む。
1つの実施形態において、前記第1の長さ範囲をカバーする少なくとも1つの参照曲線から前記第1の長さ範囲をカバーする目標参照曲線を選定することは、
前記第1の長さ範囲内の少なくとも1つの障害物の位置情報を取得することと、
前記第1の長さ範囲内の少なくとも1つの障害物の位置情報に基づいて、前記第1の長さ範囲をカバーする少なくとも1つの参照曲線から、前記少なくとも1つの障害物を回避でき、かつ最小の経路コストを有する1つの参照曲線を前記目標参照曲線として選定することとを含む。
1つの実施形態において、前記第2の長さ範囲内の安全性パラメータに基づいて、前記調整対象曲線を処理して調整曲線を得ることは、
車両パラメータ及び前記第2の長さ範囲内の環境パラメータに基づいて、前記第2の長さ範囲の安全性パラメータを決定することと、
前記第2の長さ範囲内の安全性パラメータに基づいて、前記調整対象曲線を処理して前記調整曲線を得ることとを含む。
1つの実施形態において、前記調整曲線及び前記目標参照曲線に基づいて、前記第1の長さ範囲をカバーする運転経路を決定することは、
前記調整曲線と、前記目標参照曲線における第2の長さ範囲の以外の部分とをスティッチングして、前記第1の長さ範囲をカバーする運転経路を得ることを含む。
1つの実施形態において、前記計画方法は、
前記第2の長さ範囲内の安全性パラメータに基づき前記調整対象曲線に対する処理が失敗した場合、前記目標参照曲線を、前記第1の長さ範囲をカバーする運転経路とすることをさらに含む。
本発明の第2態様は、運転経路の計画装置を提供する。前記装置は、
第1の長さ範囲をカバーする少なくとも1つの参照曲線を決定し、前記第1の長さ範囲をカバーする少なくとも1つの参照曲線から前記第1の長さ範囲をカバーする目標参照曲線を選定する動的計画ユニットであって、前記目標参照曲線は少なくとも前記第1の長さ範囲における障害物を回避できる曲線である、動的計画ユニットと、
前記第1の長さ範囲をカバーする目標参照曲線から、前記第1の長さ範囲よりも小さく且つ前記第1の長さ範囲の開始位置と同じ開始位置を有する第2の長さ範囲をカバーする調整対象曲線を抽出し、前記第2の長さ範囲内の安全性パラメータに基づいて、前記調整対象曲線を処理して調整曲線を得る2次計画ユニットと、
前記調整曲線及び前記目標参照曲線に基づいて、前記第1の長さ範囲をカバーする運転経路を決定する経路処理ユニットと、を含む。
1つの実施形態において、前記動的計画ユニットは、現在位置に基づいて、初期の運転参照線から、現在位置から前記第1の長さ範囲をカバーする運転参照線分を選定し、前記運転参照線分に基づいて、少なくとも1つのサンプル点を決定し、決定された少なくとも1つのサンプル点に基づいて、前記第1の長さ範囲をカバーする少なくとも1つの参照曲線を生成するように構成される。
1つの実施形態において、前記第1の長さ範囲内の少なくとも1つの障害物の位置情報を取得し、前記第1の長さ範囲内の少なくとも1つの障害物の位置情報に基づいて、前記第1の長さ範囲をカバーする少なくとも1つの参照曲線から、前記少なくとも1つの障害物を回避でき、かつ最小の経路コストを有する1つの参照曲線を前記目標参照曲線として選定するように構成される。
1つの実施形態において、前記2次計画ユニットは、車両パラメータ及び前記第2の長さ範囲内の環境パラメータに基づいて、前記第2の長さ範囲内の安全性パラメータを決定し、前記第2の長さ範囲内の安全性パラメータに基づいて、前記調整対象曲線を処理して調整曲線を得るように構成される。
1つの実施形態において、前記経路処理ユニットは、前記調整曲線と、前記目標参照曲線における第2の長さ範囲の以外の部分とをスティッチングして、前記第1の長さ範囲をカバーする運転経路を得るように構成される。
1つの実施形態において、前記経路処理ユニットは、前記第2の長さ範囲内の安全性パラメータに基づき前記調整対象曲線に対する処理が失敗した場合、前記目標参照曲線を、前記第1の長さ範囲をカバーする運転経路とするように構成される。
本発明の第3態様は、車両を提供する。前記車両の機能は、ソフトウェア又は、ハードウェアがソフトウェアを実行することにより実現される。前記ハードウェア又はソフトウェアは、1つ又は複数の上記に記載された機能に対応するモジュールを含む。
1つの可能な実施形態において、前記車両は、上記の運転制御方法を実行する装置を支援するプログラムを記憶するためのメモリと、メモリに記憶されたプログラムを実行するように構成されたプロセッサを含む。前記装置は、他のデバイス又は通信ネットワークと通信するための通信インターフェースも含み得る。
本発明の第4態様は、プロセッサによって実行されると、上記実施形態のいずれかに記載された方法を実施するコンピュータプログラムを記憶したコンピュータ可読記憶媒体を提供する。
本発明によれば、障害物を回避可能な目標参照曲線となるように運転参照線を広い範囲に亘って調整した上で、安全性パラメータに基づいて調整を狭いカバー範囲に亘って行い、最終的に運転経路を得ることにより、運転参照線について、実際の交通の複雑さを考慮しつつ、安全性の調整を行うことができ、最終的に得られる運転経路がサンプリング点の精度に影響されることを回避しつつ、運転経路の信頼性及び精度を向上させることができる、という利点や効果がある。
上記の概要は、単に説明のために過ぎず、いかなる限定をも目的としない。上記に記載されている例示的な様態、実施形態、及び特徴以外に、図面及び下記の詳細説明を参照することによって、本発明のさらなる様態、実施形態、及び特徴の理解を促す。
本発明の実施形態における運転経路の計画方法のフローチャートである。 本発明の実施形態における運転参照線の一部を選定する模式図である。 本発明の実施形態における少なくとも1つの曲線を生成する模式図である。 本発明の実施形態における目標参照曲線を選定する模式図である。 本発明の実施形態における目標参照曲線から第2の長さ範囲の調整対象曲線を選定する模式図である。 本発明の他の実施形態における運転経路の計画方法のフローチャートである。 本発明の実施形態における運転経路の計画装置の構成図である。 本発明の実施形態における車両の構成図である。
図面において特に規定されない限り、複数の図面において同様の図面符号は、同様又は類似的な部材又はエレメントを示す。これらの図面は必ずしも実際の縮尺に従って製図されたものではない。これらの図面は本発明に基づいて開示された幾つかの実施形態を描いたものに過ぎず、本発明の範囲に対する制限としてはならないことを理解すべきである。
下記において、幾つかの例示的実施形態を簡単に説明する。当業者が把握出来るよう、本発明の主旨又は範囲を逸脱しない限り、様々な方式により説明された実施形態に変更可能である。従って、図面と説明は制限を加えるものでなく、本質的には例示的なものである。
本発明は運転経路の計画方法を提供する。1つの実施形態において、図1示すように、前記方法は、下記のステップ101〜ステップ104を含む。
ステップ101において、第1の長さ範囲をカバーする少なくとも1つの参照曲線を決定し、前記第1の長さ範囲をカバーする少なくとも1つの参照曲線から前記第1の長さ範囲をカバーする目標参照曲線を選定することであって、前記目標参照曲線は少なくとも前記第1の長さ範囲における障害物を回避できる曲線である、前記目標参照曲線を選定する。
ステップ102において、前記第1の長さ範囲をカバーする目標参照曲線から、前記第1の長さ範囲よりも小さく且つ前記第1の長さ範囲の開始位置と同じ開始位置を有する第2の長さ範囲をカバーする調整対象曲線を抽出する。
ステップ103において、前記第2の長さ範囲内の安全性パラメータに基づいて前記調整対象曲線を処理して調整曲線を得る。
ステップ104において、前記調整曲線及び前記目標参照曲線に基づいて、前記第1の長さ範囲をカバーする運転経路を決定する。
本実施形態では、長距離の計画は動的計画に依存し、短距離の計画は二次計画に依存する処理方式を提案する。動的計画は、主に、長期間の計画を担当し、サンプリングによって、複雑な交通シーンを容易に表現しモデル化することができ、無人車両の十分な回避能力を確保することができる。
本実施形態では、まず、動的計画について説明する。
ステップ101において、第1の長さ範囲をカバーする少なくとも1つの参照曲線を決定することは、
現在位置に基づいて、初期の運転参照線から、現在位置から前記第1の長さ範囲をカバーする運転参照線分を選定することと、
前記運転参照線分に基づいて、少なくとも1つのサンプル点を決定することと、
決定された少なくとも1つのサンプル点に基づいて、前記第1の長さ範囲をカバーする少なくとも1つの参照曲線を生成することとを含む。
初期の運転参照線は、開始点から終点まで生成された運転参照線であってもよく、ユーザによって必要に応じて再生された運転参照線であってもよい。
ここで、現在位置とは車両が現在位置する位置を指す。車両は常に運転参照線に沿って走行しているため、車両の現在位置は、初期の運転参照線上のある位置である。例えば、図2を参照すると、この図2は、ある距離の間の初期の運転参照線を示したものであり、車両の現在位置も示している。第1の長さ範囲をカバーすることができる運転参照線分を選択することも示している。
なお、第1の長さ範囲及び第2の長さ範囲は、実際の状況に応じて設定されてもよく、例えば、第1の長さ範囲は200mであり、第2の長さ範囲は20mであってもよく、また、第1の長さ範囲と第2の長さ範囲の開始点は同じであり、図2に示すように、第2の長さ範囲は第1の長さ範囲と同じ開始位置を有し、第2の長さ範囲は第1の長さ範囲よりも小さい。
前記運転参照線分に基づいて、少なくとも1つのサンプル点を決定する。サンプリング点は、車線範囲内の縦方向および横方向に選定された複数のサンプリング点であり、初期の運転参照線上に少なくとも1つのサンプリング点を選定した後、対応する車線範囲内で再拡張された横方向(車両走行に沿う方向)、縦方向(車線走行方向と直交する方向)にそれぞれ少なくとも1つのサンプリング点が決定され、第1の長さ範囲内の全てのサンプリング点が得られる。
決定された少なくとも1つのサンプリング点に基づいて、第1の長さ範囲をカバーする少なくとも1つの参照曲線を生成することは、車両の走行方向に沿って、少なくとも1つのサンプリング点からサンプリング点の一部を選択した後、これらのサンプリング点を通る少なくとも1つの参照曲線を生成することができる。ここで、異なるサンプリング点の組み合わせを毎回選択しても良いが、毎回選択されたサンプリング点の少なくとも一部は異なるようにすべきである。サンプリング点を選択する度、走行方向と直交する方向に1つのサンプリング点のみを選択するという原則を採用することができる。例えば、図3を参照すると、曲線を一度生成した場合、サンプリング点1、4、6を選択することができ、曲線を再度生成する場合、サンプリング点1、3、6を選択することができ、他の組み合わせは同様である。図3にも示されるように、毎回選択されたサンプリング点により、少なくとも1つの参照曲線を生成することができる。なお、図においていくつかの曲線は一部が重なり、且つ各曲線の伸びる向きを明確に示していないが、同じサンプリング点を通る曲線は複数存在することを理解するべきである。
さらに、前記第1の長さ範囲をカバーする少なくとも1つの参照曲線から前記第1の長さ範囲をカバーする目標参照曲線を選定することは、
前記第1の長さ範囲内の少なくとも1つの障害物の位置情報を取得することと、
前記第1の長さ範囲内の少なくとも1つの障害物の位置情報に基づいて、前記第1の長さ範囲をカバーする少なくとも1つの参照曲線から、前記少なくとも1つの障害物を回避でき、かつ最小の経路コストを有する1つの参照曲線を前記目標参照曲線として選定することとを含む。
なお、本実施形態において、前記障害物は、車線範囲内に位置する障害物であればよく、例えば、車、人、動物などであってもよく、いずれの車線範囲内に位置する障害物であってもよい。
前記第1の長さ範囲は、第1の長さ範囲に含まれる車線がカバーする範囲であってもよい。
前記第1の長さ範囲内の少なくとも1つの障害物の位置情報は、リアルタイムで取得することができる。リアルタイム取得とは、車両に設けられた赤外線検出ユニット、カメラのような取得ユニットによりリアルタイムに取得することができる。あるいは、ネットワーク側のサーバから障害物の位置情報を取得することができる。ネットワーク側のサーバが障害物の位置情報を取得するのは、路側ユニットが、道路に設置されたカメラ等の機器によって取得した障害物の情報を取得し、さらにサーバ側処理に基づいて最終的に障害物の位置情報を取得する。サーバは、第1の長さ範囲内の少なくとも1つの障害物の位置情報を取得した後、車両がさらに処理を行うように車両に送信してもよいし、あるいは、全ての道路に現在存在する障害物の位置情報を区別することなく車両に送信し、車両が第1の長さ範囲内の少なくとも1つの障害物の位置情報を抽出してもよい。
上記実施形態において、車両の位置や障害物の位置情報に関わらず同じ座標系で表されており、例えばワールド座標系であってもよく、あるいは、高精細地図に用いられる座標系であってもよく、これに限定されるものではない。
前記第1の長さ範囲内の少なくとも1つの障害物の位置情報に基づいて、前記第1の長さ範囲をカバーする少なくとも1つの参照曲線から、前記少なくとも1つの障害物を回避でき、かつ最小の経路コストを有する1つの参照曲線を前記目標参照曲線として選定する。具体的な処理方法として、動的計画法による処理を行うことができる。例えば、C ( i,j )はi番目の層のj番目の曲線を表し、動的計画法を用いて{ ( i,j ) }の組を決定することにより、コストが最小である連続経路を見出すことができる。
図4を参照すると、無人運転車両は、図中左側の車両であり、第1の長さ範囲内に1つの車両、すなわち障害物が存在し、このとき、動的計画法に基づき、目標参照曲線を選定する。
次に、ステップ102を実行し、前記第1の長さ範囲をカバーする目標参照曲線から、前記第1の長さ範囲よりも小さく且つ前記第1の長さ範囲の開始位置と同じ開始位置を有する第2の長さ範囲をカバーする調整対象曲線を抽出する。例えば、図5を参照すると、第1の長さ範囲の目標参照曲線において、同じ開始点から第2の長さ範囲の曲線が調整対象曲線として選定される。
1つの実施形態において、2次計画で目標参照曲線を処理し、具体的に、前記のステップ101、102に基づいて、図6に示すように、ステップ1031及びステップ1032を含む。
ステップ1031において、車両パラメータ及び前記第2の長さ範囲内の環境パラメータに基づいて、前記第2の長さ範囲内の安全性パラメータを決定する。
ステップ1032において、前記第2の長さ範囲内の安全性パラメータに基づいて、前記調整対象曲線を処理して前記調整曲線を得る。
ここで、車両パラメータは、車両の長さ、幅、高さなどのような車両の寸法パラメータであってもよく、前記環境パラメータは、例えば、上述した車線内に存在する障害物の位置情報、路肩、柵などの車線外に存在する静止物の位置情報など、様々な種類を含むことができる。
さらに、車両パラメータ及び前記第2の長さ範囲内の環境パラメータに基づいて、前記第2の長さ範囲内の安全性パラメータを決定し、すなわち、上記の車両パラメータおよび環境パラメータを総合して、車両が対応する静的および動的な障害物または物体を回避できる安全距離を安全性パラメータとして決定する。
具体的に、2次計画において、調整対象曲線は、Frenet Frame座標系における多項式関数l = f ( w,s )として表され、wは多項式の係数であり、x = wを設定し、以下の2つの計算によって処理する。
minimize(最小化) J (x) = x H x;
subject to (仮定) Ax ≦ b。
ここで、曲線の良否及びスコアはJによって計算され、Minimizeは、コストが最小となるJ値を選んだことを示し、xは曲線パラメータを示し、上記計算式において、H,A,bは予め設定されたパラメータであり、bは安全性パラメータであり、Aは、障害物や路肩等の静的又は動的な物体と調整される曲線との距離である。最終的に上記計算を経て得られたxが調整後の結果であり、l = f ( w,s )にxを代入して調整後の調整曲線を得る。
前記調整曲線及び前記目標参照曲線に基づいて、前記第1の長さ範囲をカバーする運転経路を決定することは、前記調整曲線と、前記目標参照曲線における第2の長さ範囲の以外の部分とをスティッチングして、前記第1の長さ範囲をカバーする運転経路を得ることを含む。
すなわち、第2の長さ範囲の調整曲線と、目標参照曲線における、当該第2の長さ範囲の長さを除いた残りの部分をスティッチングし、第1の長さ範囲をカバーする運転経路を得る。
なお、上記フローは周期的に実行されるものであってもよく、その周期の長さは実際の状況に応じて設定されるものであり、例えば1分毎に1回、5分毎に1回設定されるものであってもよい。なお、周期的に実行される処理は、現在の第1の長さ範囲の運転経路が既に走行したものか否かに関わらず、ステップ101から本実施形態に提供される処理ステップを再実行することを示し、この時、前記未完了の運転経路は削除され、その後、初期の運転基準線及び車両の現在位置に基づき、対応する運転経路の計画結果が再び取得され、ここではその説明を省略する。
最後に、前記計画方法は、前記第2の長さ範囲内の安全性パラメータに基づき前記調整対象曲線に対する処理が失敗した場合、前記目標参照曲線を、前記第1の長さ範囲をカバーする運転経路とすることをさらに含む。すなわち、ステップ103またはステップ1031の実行中に前記調整対象曲線を得ることができなかった場合には、ステップ101で求めた目標参照曲線をそのまま最終の運転経路とする。
このように、上記技術案を採用することにより、広い範囲に亘って運転参照線を調整して障害物を回避可能な目標参照曲線を取得した上で、狭いカバー範囲に亘って安全性パラメータに基づく調整を行い、最終的に運転経路を得ることができ、これにより、運転参照線について、実際の交通量の複雑さを考慮しつつ、安全性の調整を行うことができ、最終的に得られる運転経路がサンプリング点の精度に影響される問題を回避しつつ、運転経路の信頼性及び精度を向上させることができる。
1つの実施形態において、図7に示すように、運転経路の計画装置を提供する。前記装置は、動的計画ユニット71、2次計画ユニット72及び経路処理ユニット73を含む
動的計画ユニット71は、第1の長さ範囲をカバーする少なくとも1つの参照曲線を決定し、前記第1の長さ範囲をカバーする少なくとも1つの参照曲線から前記第1の長さ範囲をカバーする目標参照曲線を選定するように構成され、ここで、前記目標参照曲線は、前記第1の長さ範囲における障害物を回避できる曲線である。
2次計画ユニット72は、前記第1の長さ範囲をカバーする目標参照曲線から、第2の長さ範囲をカバーする調整対象曲線を抽出し、前記第2の長さ範囲内の安全性パラメータに基づいて前記調整対象曲線を処理して調整曲線を得るように構成され、ここで、前記第2の長さ範囲は前記第1の長さ範囲よりも短い長さを有し、且つ前記第2の長さ範囲の開始位置と前記第1の長さ範囲の開始位置は同じである。
経路処理ユニット73は、前記調整曲線及び前記目標参照曲線に基づいて、前記第1の長さ範囲をカバーする運転経路を決定するように構成される。
動的計画ユニット71は、現在位置に基づいて、初期の運転参照線から、現在位置から前記第1の長さ範囲をカバーする運転参照線分を選定し、前記運転参照線分に基づいて、少なくとも1つのサンプル点を決定し、決定された少なくとも1つのサンプル点に基づいて、前記第1の長さ範囲をカバーする少なくとも1つの参照曲線を生成するように構成される。
動的計画ユニット71は、前記第1の長さ範囲内の少なくとも1つの障害物の位置情報を取得し、前記第1の長さ範囲内の少なくとも1つの障害物の位置情報に基づいて、前記第1の長さ範囲をカバーする少なくとも1つの参照曲線から、前記少なくとも1つの障害物を回避でき、かつ最小の経路コストを有する1つの参照曲線を前記目標参照曲線として選定するように構成される。
2次計画ユニット72は、車両パラメータ及び前記第2の長さ範囲内の環境パラメータに基づいて、前記第2の長さ範囲内の安全性パラメータを決定し、前記第2の長さ範囲内の安全性パラメータに基づいて、前記調整対象曲線を処理して調整曲線を得るように構成される。
経路処理ユニット73は、前記調整曲線と、前記目標参照曲線における第2の長さ範囲の以外の部分とをスティッチングして、前記第1の長さ範囲をカバーする運転経路を得るように構成される。
経路処理ユニット73は、前記第2の長さ範囲内の安全性パラメータに基づき前記調整対象曲線に対する処理が失敗した場合、前記目標参照曲線を、前記第1の長さ範囲をカバーする運転経路とするように構成される。
本発明の実施形態に係る装置における各モジュールの機能は、具体的には、上述した方法に対応する説明を参照することができ、ここではその説明を省略する。
このように、上記技術案を採用することにより、広い範囲に亘って運転参照線を調整して障害物を回避可能な目標参照曲線を取得した上で、狭いカバー範囲に亘って安全性パラメータに基づく調整を行い、最終的に運転経路を得ることができ、これにより、運転参照線について、実際の交通量の複雑さを考慮しつつ、安全性の調整を行うことができ、最終的に得られる運転経路がサンプリング点の精度に影響される問題を回避しつつ、運転経路の信頼性及び精度を向上させることができる。
図8は、本発明の実施形態に係る車両の構成を示すブロック図である。図8に示すように、この車両は、メモリ810とプロセッサ820とを備え、メモリ810には、プロセッサ820で実行可能なコンピュータプログラムが記憶されている。プロセッサ820は、コンピュータプログラムを実行すると、上記実施形態に係る運転制御方法を実施させる。メモリ810及びプロセッサ820の数は、1つ又は複数であってもよい。
当該車両は、さらに、通信インターフェース830を含み、
通信インターフェース830は、外部機器と通信を行い、データのやり取りを行うためのものである。
メモリ810は、高速度RAMメモリを含んでもよく、少なくとも1つのディスクメモリなどの不揮発性メモリ( non−volatile memory )をさらに含んでもよい。
メモリ810、プロセッサ820、及び通信インターフェース830が互いに独立して具現される場合、メモリ810、プロセッサ820、及び通信インターフェース830は、バスによって相互接続して相互通信を行うことができる。前記バスは、インダストリスタンダードアーキテクチャ(ISA、Industry Standard Architecture)バス、外部デバイス相互接続(PCI、Peripheral ComponentInterconnect)バス、又は拡張インダストリスタンダードアーキテクチャ(EISA、Extended Industry Standard Component)バス等であってもよい。前記バスは、アドレスバス、データバス、制御バス等として分けられることが可能である。表示の便宜上、図8に1本の太線のみで表示するが、バスが1つ又は1種類のみであることを意味しない。
任意選択で、具体的な実現において、メモリ810、プロセッサ820及び通信インターフェース830が1つのチップに集積した場合、メモリ810、プロセッサ820、及び通信インターフェース830は、内部インターフェースによって相互通信を行うことができる。
本発明の実施形態は、プロセッサによって実行されると、上記の実施形態のいずれかに記載の方法を実施するコンピュータプログラムを記憶したコンピュータ可読記憶媒体を提供する。
本明細書において、「1つの実施形態」、「幾つかの実施形態」、「例」、「具体例」或いは「一部の例」などの用語とは、当該実施形態或いは例で説明された具体的特徴、構成、材料或いは特点を結合して、本発明の少なくとも1つの実施形態或いは実施例に含まれることを意味する。また、説明された具体的特徴、構成、材料或いは特点は、いずれか1つ或いは複数の実施形態または例において適切に結合することが可能である。また、矛盾しない限り、当業者は、本明細書の異なる実施形態または例、および、異なる実施形態または例における特徴を結合したり、組み合わせたりすることができる。
また、用語「第1」、「第2」とは比較的重要性を示している又は暗示しているわけではなく、単に説明のためのものであり、示される技術的特徴の数を暗示するわけでもない。そのため、「第1」、「第2」で限定される特徴は、少なくとも1つの当該特徴を明示又は暗示的に含むことが可能である。本出願の記載の中において、「複数」の意味とは、明確的に限定される以外に、2つ又は2つ以上を意味する。
フローチャート又はその他の方式で説明された、いかなるプロセス又は方法に対する説明は、特定な論理的機能又はプロセスのステップを実現するための命令のコードを実行可能な1つ又はそれ以上のモジュール、断片若しくはセグメントとして理解することが可能であり、さらに、本発明の好ましい実施形態の範囲はその他の実現を含み、示された、又は、記載の順番に従うことなく、係る機能に基づいてほぼ同時にまたは逆の順序に従って機能を実行することを含み、これは当業者が理解すべきことである。
フローチャートに示された、又はその他の方式で説明された論理及び/又はステップは、例えば、論理機能を実現させるための実行可能な命令のシーケンスリストとして見なされることが可能であり、命令実行システム、装置、又はデバイス(プロセッサのシステム、又は命令実行システム、装置、デバイスから命令を取得して実行することが可能なその他のシステムを含むコンピュータによるシステム)が使用できるように提供し、又はこれらの命令を組み合わせて使用する命令実行システム、装置、又はデバイスに使用されるために、いかなるコンピュータ読取可能媒体にも具体的に実現されることが可能である。本明細書において、「コンピュータ読取可能媒体」は、命令実行システム、装置、デバイス、又はこれらの命令を組み合わせて実行するシステム、装置又はデバイスが使用できるように提供するため、プログラムを格納、記憶、通信、伝搬又は伝送する装置であってもよい。コンピュータ読み取り可能媒体のより具体的例(非網羅的なリスト)として、1つ又は複数の布配線を含む電気接続部(電子装置)、ポータブルコンピュータディスク(磁気装置)、ランダム・アクセス・メモリ(RAM)、リード・オンリー・メモリ(ROM)、消去書き込み可能リード・オンリー・メモリ(EPROM又はフラッシュメモリ)、光ファイバー装置、及びポータブル読み取り専用メモリ(CDROM)を少なくとも含む。また、コンピュータ読み取り可能媒体は、そのうえで前記プログラムを印字できる紙又はその他の適切な媒体であってもよく、例えば紙又はその他の媒体に対して光学的スキャンを行い、そして編集、解釈又は必要に応じてその他の適切の方式で処理して電子的方式で前記プログラムを得、その後コンピュータメモリに記憶することができるためである。
なお、本発明の各部分は、ハードウェア、ソフトウェア、ファームウェア又はこれらの組み合わせによって実現されることができる。上記実施形態において、複数のステップ又は方法は、メモリに記憶された、適当な命令実行システムによって実行されるソフトウェア又はファームウェアによって実施されることができる。例えば、ハードウェアによって実現するとした場合、別の実施形態と同様に、データ信号に対して論理機能を実現する論理ゲート回路を有する離散論理回路、適切な混合論理ゲート回路を有する特定用途向け集積回路、プログラマブルゲートアレイ(GPA)、フィールドプログラマブルゲートアレイ(FPGA)などといった本技術分野において公知である技術のうちのいずれか1つ又はそれらの組み合わせによって実現される。
当業者は、上記の実施形態における方法に含まれるステップの全部又は一部を実現するのは、プログラムによって対応するハードウェアを指示することによって可能であることを理解することができる。前記プログラムは、コンピュータ読取可能な媒体に記憶されてもよく、当該プログラムが実行されるとき、方法の実施形態に係るステップのうちの1つ又はそれらの組み合わせを含むことができる。
また、本発明の各実施形態における各機能ユニットは、1つの処理モジュールに統合されてよく、別個の物理的な個体であってもよく、2つ又は3つ以上のユニットが1つのモジュールに統合されてもよい。上記の統合モジュールは、ハードウェアで実現されてもよく、ソフトウェア機能モジュールで実現されてもよい。上記の統合モジュールが、ソフトウェア機能モジュールで実現され、しかも独立した製品として販売又は使用される場合、コンピュータ読取可能な記憶媒体に記憶されてもよい。前記記憶媒体は読取専用メモリ、磁気ディスク又は光ディスク等であってもよい。
上記の記載は、単なる本発明の具体的な実施形態に過ぎず、本発明の保護範囲はそれに限定されることなく、当業者が本発明に開示されている範囲内において、容易に想到し得る変形又は置換は、全て本発明の範囲内に含まれるべきである。そのため、本発明の範囲は、記載されている特許請求の範囲に準じるべきである。

Claims (14)

  1. 第1の長さ範囲をカバーする少なくとも1つの参照曲線を決定し、前記第1の長さ範囲をカバーする少なくとも1つの参照曲線から前記第1の長さ範囲をカバーする目標参照曲線を選定することであって、前記目標参照曲線は少なくとも前記第1の長さ範囲における障害物を回避できる曲線である、選定することと、
    前記第1の長さ範囲をカバーする目標参照曲線から、前記第1の長さ範囲よりも小さいく且つ前記第1の長さ範囲の開始位置と同じ開始位置を有する第2の長さ範囲をカバーする調整対象曲線を抽出することと、
    前記第2の長さ範囲内の安全性パラメータに基づいて、前記調整対象曲線を処理して調整曲線を得ることと、
    前記調整曲線及び前記目標参照曲線に基づいて、前記第1の長さ範囲をカバーする運転経路を決定することと、を含む、
    ことを特徴とする運転経路の計画方法。
  2. 第1の長さ範囲をカバーする少なくとも1つの参照曲線を決定することは、
    現在位置に基づいて、初期の運転参照線から、現在位置から前記第1の長さ範囲をカバーする運転参照線分を選定することと、
    前記運転参照線分に基づいて、少なくとも1つのサンプル点を決定することと、
    決定された少なくとも1つのサンプル点に基づいて、前記第1の長さ範囲をカバーする少なくとも1つの参照曲線を生成することとを含む、
    ことを特徴とする請求項1に記載の運転経路の計画方法。
  3. 前記第1の長さ範囲をカバーする少なくとも1つの参照曲線から前記第1の長さ範囲をカバーする目標参照曲線を選定することは、
    前記第1の長さ範囲内の少なくとも1つの障害物の位置情報を取得することと、
    前記第1の長さ範囲内の少なくとも1つの障害物の位置情報に基づいて、前記第1の長さ範囲をカバーする少なくとも1つの参照曲線から、前記少なくとも1つの障害物を回避でき、かつ最小の経路コストを有する1つの参照曲線を前記目標参照曲線として選定することとを含む、
    ことを特徴とする請求項1又は2に記載の運転経路の計画方法。
  4. 前記第2の長さ範囲内の安全性パラメータに基づいて、前記調整対象曲線を処理して調整曲線を得ることは、
    車両パラメータ及び前記第2の長さ範囲内の環境パラメータに基づいて、前記第2の長さ範囲の安全性パラメータを決定することと、
    前記第2の長さ範囲内の安全性パラメータに基づいて、前記調整対象曲線を処理して前記調整曲線を得ることとを含む、
    ことを特徴とする請求項1に記載の運転経路の計画方法。
  5. 前記調整曲線及び前記目標参照曲線に基づいて、前記第1の長さ範囲をカバーする運転経路を決定することは、
    前記調整曲線と、前記目標参照曲線における第2の長さ範囲の以外の部分とをスティッチングして、前記第1の長さ範囲をカバーする運転経路を得ることを含む、
    ことを特徴とする請求項1に記載の運転経路の計画方法。
  6. 前記計画方法は、
    前記第2の長さ範囲内の安全性パラメータに基づき前記調整対象曲線に対する処理が失敗した場合、前記目標参照曲線を、前記第1の長さ範囲をカバーする運転経路とすることをさらに含む、
    ことを特徴とする請求項1〜5のいずれか1項に記載の運転経路の計画方法。
  7. 第1の長さ範囲をカバーする少なくとも1つの参照曲線を決定し、前記第1の長さ範囲をカバーする少なくとも1つの参照曲線から前記第1の長さ範囲をカバーする目標参照曲線を選定する動的計画ユニットであって、前記目標参照曲線は少なくとも前記第1の長さ範囲における障害物を回避できる曲線である、動的計画ユニットと、
    前記第1の長さ範囲をカバーする目標参照曲線から、前記第1の長さ範囲よりも且つ前記第1の長さ範囲の開始位置と同じ開始位置を有する第2の長さ範囲をカバーする調整対象曲線を抽出し、前記第2の長さ範囲内の安全性パラメータに基づいて、前記調整対象曲線を処理して調整曲線を得る2次計画ユニットと、
    前記調整曲線及び前記目標参照曲線に基づいて、前記第1の長さ範囲をカバーする運転経路を決定する経路処理ユニットと、を含む、
    ことを特徴とする運転経路の計画装置。
  8. 前記動的計画ユニットは、
    現在位置に基づいて、初期の運転参照線から、現在位置から前記第1の長さ範囲をカバーする運転参照線分を選定し、前記運転参照線分に基づいて、少なくとも1つのサンプル点を決定し、決定された少なくとも1つのサンプル点に基づいて、前記第1の長さ範囲をカバーする少なくとも1つの参照曲線を生成する、
    ことを特徴とする請求項7に記載の運転経路の計画装置。
  9. 前記動的計画ユニットは、
    前記第1の長さ範囲内の少なくとも1つの障害物の位置情報を取得し、前記第1の長さ範囲内の少なくとも1つの障害物の位置情報に基づいて、前記第1の長さ範囲をカバーする少なくとも1つの参照曲線から、前記少なくとも1つの障害物を回避でき、かつ最小の経路コストを有する1つの参照曲線を前記目標参照曲線として選定する、
    ことを特徴とする請求項7に記載の運転経路の計画装置。
  10. 前記2次計画ユニットは、
    車両パラメータ及び前記第2の長さ範囲内の環境パラメータに基づいて、前記第2の長さ範囲内の安全性パラメータを決定し、前記第2の長さ範囲内の安全性パラメータに基づいて、前記調整対象曲線を処理して調整曲線を得る、
    ことを特徴とする請求項7に記載の運転経路の計画装置。
  11. 前記経路処理ユニットは、
    前記調整曲線と、前記目標参照曲線における第2の長さ範囲の以外の部分とをスティッチングして、前記第1の長さ範囲をカバーする運転経路を得る、
    ことを特徴とする請求項7に記載の運転経路の計画装置。
  12. 前記経路処理ユニットは、前記第2の長さ範囲内の安全性パラメータに基づき前記調整対象曲線に対する処理が失敗した場合、前記目標参照曲線を、前記第1の長さ範囲をカバーする運転経路とする、
    ことを特徴とする請求項7〜11のいずれか1項に記載の運転経路の計画装置。
  13. 1つ又は複数のプロセッサと、
    1つ又は複数のプログラムを記憶する記憶装置と、を含み、
    前記1つ又は複数のプロセッサは、1つ又は複数のプログラムを実行する場合、請求項1〜6のいずれか1項に記載の運転経路の計画方法を実施させる、
    ことを特徴とする車両。
  14. コンピュータにおいて、プロセッサにより実行される場合、請求項1〜6のいずれか1項に記載の運転経路の計画方法を実施することを特徴とするプログラム。
JP2020027726A 2019-02-22 2020-02-21 運転経路の計画方法、装置、車両、及びプログラム Active JP7132960B2 (ja)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN201910133965.0A CN109813328B (zh) 2019-02-22 2019-02-22 一种驾驶路径规划方法、装置及车辆
CN201910133965.0 2019-02-22

Publications (2)

Publication Number Publication Date
JP2020132154A true JP2020132154A (ja) 2020-08-31
JP7132960B2 JP7132960B2 (ja) 2022-09-07

Family

ID=66607255

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2020027726A Active JP7132960B2 (ja) 2019-02-22 2020-02-21 運転経路の計画方法、装置、車両、及びプログラム

Country Status (5)

Country Link
US (1) US11415994B2 (ja)
EP (1) EP3702230B1 (ja)
JP (1) JP7132960B2 (ja)
KR (1) KR102398456B1 (ja)
CN (1) CN109813328B (ja)

Families Citing this family (17)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109765902B (zh) * 2019-02-22 2022-10-11 阿波罗智能技术(北京)有限公司 无人车驾驶参考线处理方法、装置及车辆
CN110749333B (zh) * 2019-11-07 2022-02-22 中南大学 基于多目标优化的无人驾驶车辆运动规划方法
CN111380556B (zh) * 2020-03-03 2022-04-01 北京百度网讯科技有限公司 用于自动驾驶车辆的信息处理方法和装置
CN111473795B (zh) * 2020-04-08 2022-05-17 江苏盛海智能科技有限公司 一种无人驾驶车辆避障方法及终端
CN113804196B (zh) * 2020-09-17 2024-04-12 北京京东乾石科技有限公司 无人车路径规划方法及相关设备
US11886195B2 (en) * 2020-11-30 2024-01-30 Woven By Toyota, U.S., Inc. Active learning and validation system for vehicles
CN112550287B (zh) * 2020-12-16 2022-08-26 重庆大学 一种面向结构化道路的驾驶风险评估方法
CN112572443B (zh) * 2020-12-22 2021-12-07 北京理工大学 一种高速公路车辆换道实时避撞轨迹规划方法及系统
CN113091750B (zh) * 2021-04-12 2023-04-07 京东科技信息技术有限公司 局部路径规划方法、装置、计算机设备和存储介质
CN113320543B (zh) * 2021-06-29 2024-03-22 东软睿驰汽车技术(沈阳)有限公司 行车方法、装置、车辆及存储介质
CN113538683A (zh) * 2021-07-28 2021-10-22 视伴科技(北京)有限公司 一种确定实体流线的规划位置的方法及装置
CN114132325B (zh) * 2021-12-14 2024-03-01 京东鲲鹏(江苏)科技有限公司 车辆的行驶方法和装置
CN114527758A (zh) * 2022-02-24 2022-05-24 北京百度网讯科技有限公司 路径规划方法及装置、设备、介质和产品
CN114506343A (zh) * 2022-03-02 2022-05-17 阿波罗智能技术(北京)有限公司 轨迹规划方法、装置、设备、存储介质及自动驾驶车辆
KR102445049B1 (ko) * 2022-04-15 2022-09-21 국방과학연구소 단일 신경망 추정 자율주행 차량의 모델 예측 제어 방법 및 모델 예측 제어 시스템
CN115235476B (zh) * 2022-09-26 2023-01-17 宁波均胜智能汽车技术研究院有限公司 一种全覆盖路径规划方法、装置、存储介质、电子设备
CN116136417B (zh) * 2023-04-14 2023-08-22 北京理工大学 一种面向越野环境的无人驾驶车辆局部路径规划方法

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2014044141A (ja) * 2012-08-28 2014-03-13 Nissan Motor Co Ltd 車両走行制御装置及びその方法
WO2017014012A1 (ja) * 2015-07-22 2017-01-26 本田技研工業株式会社 経路生成装置、経路生成方法、および経路生成プログラム
JP2017087856A (ja) * 2015-11-05 2017-05-25 マツダ株式会社 車両の制御装置
JP2018138404A (ja) * 2017-02-24 2018-09-06 マツダ株式会社 車両運転支援システム及び方法
JP2018197048A (ja) * 2017-05-23 2018-12-13 トヨタ自動車株式会社 衝突回避制御装置
WO2018235159A1 (ja) * 2017-06-20 2018-12-27 三菱電機株式会社 経路予測装置および経路予測方法

Family Cites Families (36)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3470453B2 (ja) * 1995-04-06 2003-11-25 株式会社デンソー 車間距離制御装置
DE102013013867A1 (de) * 2013-08-20 2015-03-12 Audi Ag Kraftfahrzeug und Verfahren zur Steuerung eines Kraftfahrzeugs
EP2848487B1 (en) 2013-09-12 2020-03-18 Volvo Car Corporation Manoeuvre generation for automated drive
CN103760904B (zh) * 2014-02-13 2016-10-19 北京工业大学 一种语音播报式智能车辆路径规划装置与实施方法
US9623878B2 (en) * 2014-04-02 2017-04-18 Magna Electronics Inc. Personalized driver assistance system for vehicle
CN104238560B (zh) * 2014-09-26 2017-04-05 深圳市中智科创机器人有限公司 一种非线性路径规划方法及系统
US9499197B2 (en) * 2014-10-15 2016-11-22 Hua-Chuang Automobile Information Technical Center Co., Ltd. System and method for vehicle steering control
WO2016110728A1 (ja) * 2015-01-05 2016-07-14 日産自動車株式会社 目標経路生成装置および走行制御装置
CA2976344A1 (en) * 2015-02-10 2016-08-18 Mobileye Vision Technologies Ltd. Sparse map for autonomous vehicle navigation
JP6361567B2 (ja) * 2015-04-27 2018-07-25 トヨタ自動車株式会社 自動運転車両システム
US9821801B2 (en) * 2015-06-29 2017-11-21 Mitsubishi Electric Research Laboratories, Inc. System and method for controlling semi-autonomous vehicles
JP6323402B2 (ja) * 2015-07-01 2018-05-16 株式会社デンソー 車線内走行制御装置、車線内走行制御方法
US9620015B2 (en) * 2015-07-13 2017-04-11 Nissan North America, Inc. Kinematic path prediction of vehicles on curved paths
JP6303217B2 (ja) * 2015-10-28 2018-04-04 本田技研工業株式会社 車両制御装置、車両制御方法、および車両制御プログラム
JP6558239B2 (ja) * 2015-12-22 2019-08-14 アイシン・エィ・ダブリュ株式会社 自動運転支援システム、自動運転支援方法及びコンピュータプログラム
US20190016339A1 (en) * 2016-02-16 2019-01-17 Honda Motor Co., Ltd. Vehicle control device, vehicle control method, and vehicle control program
US9851212B2 (en) * 2016-05-06 2017-12-26 Ford Global Technologies, Llc Route generation using road lane line quality
JP6638556B2 (ja) 2016-05-20 2020-01-29 アイシン・エィ・ダブリュ株式会社 自動運転支援装置及びコンピュータプログラム
CN106114507B (zh) * 2016-06-21 2018-04-03 百度在线网络技术(北京)有限公司 用于智能车辆的局部轨迹规划方法和装置
CN107664502A (zh) 2016-07-28 2018-02-06 奥迪股份公司 动态规划路径的方法、设备和系统
WO2018061612A1 (ja) 2016-09-29 2018-04-05 本田技研工業株式会社 車両制御装置
CN109890684B (zh) * 2016-10-26 2021-09-28 本田技研工业株式会社 车辆控制装置
JP6428746B2 (ja) * 2016-11-07 2018-11-28 本田技研工業株式会社 車両制御システム、車両制御方法、および車両制御プログラム
US20190271985A1 (en) * 2016-11-11 2019-09-05 Honda Motor Co., Ltd. Vehicle control system, vehicle control method, and vehicle control program
JP6743912B2 (ja) * 2016-12-28 2020-08-19 富士通株式会社 経路情報提供装置、経路探索装置、経路情報提供システム、経路情報提供プログラム、及び経路情報提供方法
US11067995B2 (en) * 2017-03-20 2021-07-20 Mobileye Vision Technologies Ltd. Navigation by augmented path prediction
DE102017205508A1 (de) * 2017-03-31 2018-10-04 Robert Bosch Gmbh Verfahren zur automatischen Bewegungssteuerung eines Fahrzeugs
WO2018220827A1 (ja) * 2017-06-02 2018-12-06 本田技研工業株式会社 車両制御システム、車両制御方法、および車両制御プログラム
WO2018220826A1 (ja) * 2017-06-02 2018-12-06 本田技研工業株式会社 車両制御システム、車両制御方法、および車両制御プログラム
US10274961B2 (en) * 2017-07-26 2019-04-30 GM Global Technology Operations LLC Path planning for autonomous driving
CN107992050B (zh) * 2017-12-20 2021-05-11 广州汽车集团股份有限公司 无人驾驶汽车局部路径运动规划方法和装置
CN108334086B (zh) * 2018-01-25 2021-06-22 江苏大学 一种基于软约束二次规划mpc的无人驾驶车辆路径跟踪控制方法
JP2019156193A (ja) * 2018-03-14 2019-09-19 本田技研工業株式会社 車両制御装置
CN109318890A (zh) * 2018-06-29 2019-02-12 北京理工大学 一种基于动态窗口及障碍物势能场的无人车动态避障方法
CN109765902B (zh) * 2019-02-22 2022-10-11 阿波罗智能技术(北京)有限公司 无人车驾驶参考线处理方法、装置及车辆
US11525691B2 (en) * 2019-09-20 2022-12-13 Samsung Electronics Co., Ltd. System and method for autonomous motion planning

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2014044141A (ja) * 2012-08-28 2014-03-13 Nissan Motor Co Ltd 車両走行制御装置及びその方法
WO2017014012A1 (ja) * 2015-07-22 2017-01-26 本田技研工業株式会社 経路生成装置、経路生成方法、および経路生成プログラム
JP2017087856A (ja) * 2015-11-05 2017-05-25 マツダ株式会社 車両の制御装置
JP2018138404A (ja) * 2017-02-24 2018-09-06 マツダ株式会社 車両運転支援システム及び方法
JP2018197048A (ja) * 2017-05-23 2018-12-13 トヨタ自動車株式会社 衝突回避制御装置
WO2018235159A1 (ja) * 2017-06-20 2018-12-27 三菱電機株式会社 経路予測装置および経路予測方法

Also Published As

Publication number Publication date
EP3702230A1 (en) 2020-09-02
EP3702230B1 (en) 2023-05-17
US20200272157A1 (en) 2020-08-27
CN109813328B (zh) 2021-04-30
JP7132960B2 (ja) 2022-09-07
US11415994B2 (en) 2022-08-16
KR102398456B1 (ko) 2022-05-16
CN109813328A (zh) 2019-05-28
KR20200103561A (ko) 2020-09-02

Similar Documents

Publication Publication Date Title
JP2020132154A (ja) 運転経路の計画方法、装置、車両、及びプログラム
US10976741B2 (en) Safety and comfort constraints for navigation
US11131990B1 (en) Method for transferring control to an operator
US11163309B2 (en) Method for autonomous navigation
JP7000637B2 (ja) 運転参照経路の処理方法、装置、車両、及びプログラム
CN111727413A (zh) 用于访问来自其他车辆的补充感知数据的方法
US10896539B2 (en) Systems and methods for updating highly automated driving maps
JP2022172153A (ja) 車両ナビゲーションシステム、車両、及びプログラム
DE102017206847A1 (de) Verfahren zum automatischen Erstellen und Aktualisieren eines Datensatzes für ein autonomes Fahrzeug
CN111091739B (zh) 自动驾驶场景的生成方法、装置和存储介质
CN112753038B (zh) 识别车辆变道趋势的方法和装置
US20190325234A1 (en) Lane post-processing in an autonomous driving vehicle
CN113419546B (zh) 一种无人车的控制方法、装置、介质及电子设备
CN112172790B (zh) 自动停车的控制方法、装置及计算机可读存储介质
DE102018203753A1 (de) Verfahren und Vorrichtung zur robusten Lokalisierung eines Fahrzeugs
CN111338232A (zh) 自动驾驶仿真方法及装置
CN113607161B (zh) 机器人导航路径宽度获取系统、方法、机器人及存储介质
US20220406077A1 (en) Method and system for estimating road lane geometry
CN117037500B (zh) 非结构化道路下小目标轨迹预测方法、设备、介质
US20240182081A1 (en) Autonomous driving crash prevention
CN118113028A (zh) 车辆的信息服务方法、装置、设备、存储介质和程序产品
CN118057124A (zh) 一种自动驾驶路口路径规划方法及装置、非暂时性计算机可读存储介质
CN117079456A (zh) 车辆诱导方法、装置及电子设备、计算机可读存储介质
CN113936058A (zh) 基于车辆的数据获取
CN117889873A (zh) 一种确定路口区域的方法、设备、车辆及程序产品

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20200221

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

A711 Notification of change in applicant

Free format text: JAPANESE INTERMEDIATE CODE: A711

Effective date: 20211029

RD03 Notification of appointment of power of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7423

Effective date: 20211206

A02 Decision of refusal

Free format text: JAPANESE INTERMEDIATE CODE: A02

Effective date: 20220104

RD04 Notification of resignation of power of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7424

Effective date: 20220114

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20220428

C60 Trial request (containing other claim documents, opposition documents)

Free format text: JAPANESE INTERMEDIATE CODE: C60

Effective date: 20220428

A911 Transfer to examiner for re-examination before appeal (zenchi)

Free format text: JAPANESE INTERMEDIATE CODE: A911

Effective date: 20220512

C21 Notice of transfer of a case for reconsideration by examiners before appeal proceedings

Free format text: JAPANESE INTERMEDIATE CODE: C21

Effective date: 20220517

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20220826

R150 Certificate of patent or registration of utility model

Ref document number: 7132960

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150