JP7229278B2 - 経路計画のための二次計画法に基づき、片側に寄せる方法 - Google Patents

経路計画のための二次計画法に基づき、片側に寄せる方法 Download PDF

Info

Publication number
JP7229278B2
JP7229278B2 JP2020570513A JP2020570513A JP7229278B2 JP 7229278 B2 JP7229278 B2 JP 7229278B2 JP 2020570513 A JP2020570513 A JP 2020570513A JP 2020570513 A JP2020570513 A JP 2020570513A JP 7229278 B2 JP7229278 B2 JP 7229278B2
Authority
JP
Japan
Prior art keywords
segment
boundary
shape
point
transition point
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
JP2020570513A
Other languages
English (en)
Other versions
JP2022531031A (ja
JPWO2021203426A5 (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.)
Baidu USA LLC
Original Assignee
Baidu USA LLC
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 USA LLC filed Critical Baidu USA LLC
Publication of JP2022531031A publication Critical patent/JP2022531031A/ja
Publication of JPWO2021203426A5 publication Critical patent/JPWO2021203426A5/ja
Application granted granted Critical
Publication of JP7229278B2 publication Critical patent/JP7229278B2/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
    • B60W60/00Drive control systems specially adapted for autonomous road vehicles
    • B60W60/001Planning or execution of driving tasks
    • EFIXED CONSTRUCTIONS
    • E04BUILDING
    • E04HBUILDINGS OR LIKE STRUCTURES FOR PARTICULAR PURPOSES; SWIMMING OR SPLASH BATHS OR POOLS; MASTS; FENCING; TENTS OR CANOPIES, IN GENERAL
    • E04H6/00Buildings for parking cars, rolling-stock, aircraft, vessels or like vehicles, e.g. garages
    • E04H6/42Devices or arrangements peculiar to garages, not covered elsewhere, e.g. securing devices, safety devices, monitoring and operating schemes; centering devices
    • E04H6/422Automatically operated car-parks
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F17/00Digital computing or data processing equipment or methods, specially adapted for specific functions
    • G06F17/10Complex mathematical operations
    • G06F17/11Complex mathematical operations for solving equations, e.g. nonlinear equations, general mathematical optimization problems
    • 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
    • EFIXED CONSTRUCTIONS
    • E04BUILDING
    • E04HBUILDINGS OR LIKE STRUCTURES FOR PARTICULAR PURPOSES; SWIMMING OR SPLASH BATHS OR POOLS; MASTS; FENCING; TENTS OR CANOPIES, IN GENERAL
    • E04H6/00Buildings for parking cars, rolling-stock, aircraft, vessels or like vehicles, e.g. garages
    • E04H6/42Devices or arrangements peculiar to garages, not covered elsewhere, e.g. securing devices, safety devices, monitoring and operating schemes; centering devices
    • E04H6/422Automatically operated car-parks
    • E04H6/424Positioning devices
    • 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/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0221Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving a learning process
    • 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/0223Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of the vehicle
    • 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/0234Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using optical markers or beacons
    • G05D1/0236Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using optical markers or beacons 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/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/0242Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using non-visible light signals, e.g. IR or UV signals
    • 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
    • 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/0257Control of position or course in two dimensions specially adapted to land vehicles using a radar
    • 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/0276Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
    • 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/0276Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
    • G05D1/0278Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using satellite positioning signals, e.g. GPS
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F17/00Digital computing or data processing equipment or methods, specially adapted for specific functions
    • G06F17/10Complex mathematical operations
    • G06F17/11Complex mathematical operations for solving equations, e.g. nonlinear equations, general mathematical optimization problems
    • G06F17/12Simultaneous equations, e.g. systems of linear equations
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06VIMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
    • G06V20/00Scenes; Scene-specific elements
    • G06V20/50Context or environment of the image
    • G06V20/56Context or environment of the image exterior to a vehicle by using sensors mounted on the vehicle
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06VIMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
    • G06V20/00Scenes; Scene-specific elements
    • G06V20/50Context or environment of the image
    • G06V20/56Context or environment of the image exterior to a vehicle by using sensors mounted on the vehicle
    • G06V20/588Recognition of the road, e.g. of lane markings; Recognition of the vehicle driving pattern in relation to the road
    • 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
    • G08G1/096827Systems involving transmission of navigation instructions to the vehicle where the transmitted instructions are used to compute a route where the route is computed onboard
    • 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/096833Systems involving transmission of navigation instructions to the vehicle where different aspects are considered when computing the route
    • G08G1/096844Systems involving transmission of navigation instructions to the vehicle where different aspects are considered when computing the route where the complete route is dynamically recomputed based on new data
    • 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)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Mathematical Physics (AREA)
  • Theoretical Computer Science (AREA)
  • Architecture (AREA)
  • Computational Mathematics (AREA)
  • Mathematical Analysis (AREA)
  • Mathematical Optimization (AREA)
  • Pure & Applied Mathematics (AREA)
  • Mechanical Engineering (AREA)
  • Transportation (AREA)
  • Data Mining & Analysis (AREA)
  • Electromagnetism (AREA)
  • Multimedia (AREA)
  • Human Computer Interaction (AREA)
  • Operations Research (AREA)
  • General Engineering & Computer Science (AREA)
  • Algebra (AREA)
  • Databases & Information Systems (AREA)
  • Software Systems (AREA)
  • Atmospheric Sciences (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Optics & Photonics (AREA)
  • Structural Engineering (AREA)
  • Civil Engineering (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Traffic Control Systems (AREA)
  • Navigation (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)

Description

本開示の実施形態は一般に自律車両の運転に関する。より具体的には、本開示の実施形態は、自律運転車両(ADV) の経路計画に関する。
(例えばドライバのいない)自律モードで走行する車両は、乗る人(特にドライバ)から運転に関わる幾つかの責任を取り除くことができる。車両は、自律モードで走行するとき、搭載されたセンサを使用して様々な位置に進むことができるため、人間との最小限の相互作用で、場合によってはいかなる乗客も無しで車両が走行することができる。
動きの計画及び制御は、自律運転における重要な操作である。全ての自動運転の終わりに、乗客が乗り降りするのに便利な車線の右側でADV が止まることが望まれている。しかしながら、ADV の本体全体と車線の右側の境界との距離が小さく、ADV が右側の境界と平行になるように、ADV が正確に片側に寄ることは困難である。
本開示の実施形態は、同様の参照符号が同様の要素を示す添付図面に限定されることなく、例として図示されている。
一実施形態に係るネットワーク化されたシステムを示すブロック図である。 一実施形態に係る自律車両の例を示すブロック図である。 一実施形態に係る自律車両と共に使用される認知・計画システムの例を示すブロック図である。 一実施形態に係る自律車両と共に使用される認知・計画システムの例を示すブロック図である。 一実施形態に係る計画モジュールの例を示すブロック図である。 一実施形態に係る計画モジュールの処理流れ図である。 ADV を車線の片側の目的地点で片側に寄せるための方法の例を示す図である。 ADV を車線の片側の目的地点で片側に寄せるための方法の例を示す図である。 ADV を車線の片側の目的地点で片側に寄せるための方法の例を示すフローチャートである。
本開示の様々な実施形態及び態様を、以下の詳細な記述を参照して説明し、添付図面は様々な実施形態を示す。以下の記述及び図面は本開示の例示であり、本開示を限定していると解釈されない。本開示の様々な実施形態の完全な理解を提供すべく、多くの特定の詳細な記述を説明する。しかしながら、場合によっては、本開示の実施形態の簡潔な記述を提供すべく、周知又は従来の詳細な記述を説明しない。
本明細書における「一実施形態」又は「実施形態」の言及は、実施形態と併せて記載されている特定の特徴、構造又は特性が本開示の少なくとも1つの実施形態に含まれ得ることを意味する。本明細書の様々な箇所における「一実施形態」という表現は全て、必ずしも同一の実施形態について言及しているわけではない。
ある実施形態によれば、乗客が乗り降りするのに便利な車線の右側でADV が止まることが望まれている場合がある。ADV が二次計画法に基づき正確に片側に寄る方法が、本明細書に開示されている。本方法は距離精度及び成功率を提供し得る。この方法を使用することによって、ADV の本体全体と車線の右側又は境界との距離が小さくなり、ADV は車線の右側又は境界と平行になる。
ある実施形態によれば、ADV を車線の片側の目的地点で片側に寄せるための要求に応じて、第1のセグメント、第2のセグメント及び移行点を含む経路を計画する。目的地点までの距離及び車線の片側の境界までの所定の距離の内の少なくとも1つに基づき、移行点を決定する。出発点から移行点までの第1のセグメントを、二次計画法(QP)演算を使用して生成する。移行点から目的地点までの第2のセグメントを、境界の形状に基づき生成する。計画された経路に従って、ADV を目的地点まで片側に寄せるように制御する。
図1は、本開示の一実施形態に係る自律車両のネットワーク構成を示すブロック図である。ネットワーク構成100 は、ネットワーク102 を介して一又は複数のサーバ103-104 に通信可能に結合され得る自律車両101 を備えている。図1参照。一台の自律車両が図示されているが、多くの自律車両がネットワーク102 を介して互いに及び/又はサーバ103-104 に結合され得る。ネットワーク102 は、ローカルエリアネットワーク(LAN) 、インターネットのような広域ネットワーク(WAN) 、セルラーネットワーク、衛星ネットワーク、又は有線若しくは無線のこれらの組み合わせのようなあらゆるタイプのネットワークであってもよい。一又は複数のサーバ103-104 は、ウェブサーバ若しくはクラウドサーバ、アプリケーションサーバ、バックエンドサーバ又はこれらの組み合わせのような、あらゆる種類のサーバ或いは一群のサーバであってもよい。サーバ103-104 は、データ分析サーバ、コンテンツサーバ、交通情報サーバ、地図・特定地点(MPOI)サーバ又は位置サーバなどであってもよい。
自律車両は、車両がドライバからの入力がほとんどない状態又は全くない状態で環境を進む自律モードで走行するように構成され得る車両を指す。このような自律車両は、車両が走行する環境に関する情報を検出するように構成された一又は複数のセンサを有するセンサシステムを備えることができる。車両及び車両の関連する一又は複数の制御部は、検出された情報を使用して環境を進む。自律車両101 は、手動モード、完全な自律モード又は部分的な自律モードで走行することができる。
一実施形態では、自律車両101 は、認知・計画システム110 、車両制御システム111 、無線通信システム112 、ユーザインタフェースシステム113 及びセンサシステム115 を備えているが、これらに限定されない。自律車両101 は、エンジン、車輪、ハンドル、トランスミッションなどの通常の車両に含まれるある共通の部品を更に備えてもよく、共通の部品は、例えば加速信号若しくは加速コマンド、減速信号若しくは減速コマンド、ステアリング信号若しくはステアリングコマンド、制動信号若しくは制動コマンドなどの様々な通信信号及び/又は通信コマンドを使用して、車両制御システム111 及び/又は認知・計画システム110 によって制御されてもよい。
部品110-115 は、相互接続、バス、ネットワーク又はこれらの組み合わせにより互いに通信可能に結合されてもよい。例えば、部品110-115 は、コントローラエリアネットワーク(CAN) バスを介して互いに通信可能に結合されてもよい。CAN バスは、マイクロコントローラ及びデバイスがホストコンピュータ無しでアプリケーションで互いに通信し得るように設計された車両バス規格である。CAN バスは、自動車内の多重電気配線のために本来設計されたメッセージに基づくプロトコルであるが、他の多くの状況でも使用される。
一実施形態では、センサシステム115 は、一又は複数のカメラ211 、全地球測位システム(GPS) ユニット212 、慣性計測装置(IMU) 213 、レーダユニット214 及び光検出・距測(LIDAR) ユニット215 を有するが、これらに限定されない。図2参照。GPS ユニット212 は、自律車両の位置に関する情報を提供すべく動作可能な送受信機を有してもよい。IMU 213 は、慣性加速度に基づき自律車両の位置及び向きの変化を検知し得る。レーダユニット214 は、無線信号を利用して自律車両のローカル環境内の物体を検知するシステムに相当してもよい。ある実施形態では、レーダユニット214 は、物体の検知に加えて物体の速度及び/又は進路を更に検知してもよい。LIDAR ユニット215 は、レーザを使用して自律車両が位置する環境内の物体を検知してもよい。LIDAR ユニット215 は、システムの部品の中で特に一又は複数のレーザ源、レーザスキャナ及び一又は複数の検出器を含み得る。カメラ211 は、自律車両を囲む環境の画像を取り込むための一又は複数のデバイスを含んでもよい。カメラ211 はスチールカメラ及び/又はビデオカメラであってもよい。カメラは、例えばカメラを回転及び/又は傾斜するプラットフォームに取り付けることにより、機械的に移動可能であってもよい。
センサシステム115 は、ソナーセンサ、赤外線センサ、ステアリングセンサ、スロットルセンサ、制動センサ及びオーディオセンサ(例えばマイクロホン)のような他のセンサを更に有してもよい。オーディオセンサは、自律車両を囲む環境から音を取り込むように構成されてもよい。ステアリングセンサは、車両のハンドル、車輪又はこれらの組み合わせのステアリング角を検知するように構成されてもよい。スロットルセンサ及び制動センサは、車両のスロットル位置及び制動位置を夫々検知する。ある状況では、スロットルセンサ及び制動センサは、一体化されたスロットル/制動センサとして一体化されてもよい。
一実施形態では、車両制御システム111 は、ステアリングユニット201 、(加速ユニットとも称される)スロットルユニット202 及び制動ユニット203 を有するが、これらに限定されない。ステアリングユニット201 は車両の方向又は進路を調節するためのユニットである。スロットルユニット202 は、モータ又はエンジンの速度を制御することにより、車両の速度及び加速度を制御するためのユニットである。制動ユニット203 は、摩擦を与えて車両の車輪又はタイヤの速度を落とすことにより、車両を減速させるためのユニットである。尚、図2に示されているような部品はハードウェア、ソフトウェア又はこれらの組み合わせで実装されてもよい。
無線通信システム112 は、自律車両101 とデバイス、センサ、他の車両などの外部のシステムとの通信を可能にするためのユニットである。図1再度参照。例えば、無線通信システム112 は、一又は複数のデバイスと直接無線で通信することができるか、又は通信ネットワークを介して、例えばネットワーク102 を介してサーバ103-104 と無線で通信することができる。無線通信システム112 は、別の部品又はシステムと通信するために、あらゆるセルラー通信ネットワーク又は例えばWiFi(登録商標)を使用した無線ローカルエリアネットワーク(WLAN)を使用することができる。無線通信システム112 は、例えば赤外線リンク、Bluetooth (登録商標)などを使用して、デバイス(例えば車両101 内の乗客のモバイル機器、表示装置、スピーカ)と直接通信することができる。ユーザインタフェースシステム113 は、例えばキーボード、タッチスクリーン表示装置、マイクロホン及びスピーカなどを含む、車両101 内に実装される周辺機器の一部であってもよい。
自律車両101 の機能の一部又は全ては、特に自律運転モードで走行するとき、認知・計画システム110 によって制御又は管理されてもよい。認知・計画システム110 は、センサシステム115 、車両制御システム111 、無線通信システム112 及び/又はユーザインタフェースシステム113 から情報を受信し、受信した情報を処理して出発点から目的地点までのルート又は経路を計画し、その後、計画・制御情報に基づき車両101 を運転するために必要なハードウェア(例えば一又は複数のプロセッサ、メモリ、記憶部)及びソフトウェア(例えばオペレーティングシステム、計画・ルーティングプログラム)を有している。或いは、認知・計画システム110 は車両制御システム111 と一体化されてもよい。
例えば、乗客としてのユーザは、例えばユーザインタフェースを介して、旅行の出発位置及び目的地を指定してもよい。認知・計画システム110 は旅行に関連するデータを得る。例えば、認知・計画システム110 は、サーバ103-104 の一部であってもよいMPOIサーバから位置及びルートの情報を得てもよい。位置サーバは位置サービスを提供し、MPOIサーバは地図サービス及びある位置のPOI を提供する。或いは、このような位置及びMPOIの情報は、認知・計画システム110 の永続記憶装置にローカルにキャッシュされてもよい。
自律車両101 がルートに沿って移動している間、認知・計画システム110 は、交通情報システム又は交通情報サーバ(TIS) からリアルタイムの交通情報を更に得てもよい。尚、第三者のエンティティによって、サーバ103-104 を作動してもよい。或いは、サーバ103-104 の機能は認知・計画システム110 と一体化されてもよい。リアルタイムの交通情報、MPOI情報及び位置情報、並びにセンサシステム115 によって検出又は検知されたリアルタイムのローカル環境データ(例えば障害物、物体、近くの車両)に基づき、認知・計画システム110 は最適なルートを計画し、指定された目的地に安全且つ効率的に到着すべく、計画されたルートに従って、例えば車両制御システム111 を介して車両101 を運転することができる。
サーバ103 は、様々なクライアントのためにデータ分析サービスを行うためのデータ分析システムであってもよい。一実施形態では、データ分析システム103 はデータコレクタ121 及び機械学習エンジン122 を有している。データコレクタ121 は、様々な車両、つまり自律車両又は人間のドライバが運転する通常の車両から運転統計データ123 を収集する。運転統計データ123 は、発せられる運転コマンド(例えばスロットルコマンド、制動コマンド、ステアリングコマンド)、及び様々な時点で車両のセンサによって取り込まれる車両の応答(例えば速度、加速度、減速度、方向)を示す情報を含む。運転統計データ123 は、例えば(出発位置及び目的地位置を含む)ルート、MPOI、道路状況、天候状況などの、様々な時点の運転環境について記述する情報を更に含んでもよい。
運転統計データ123 に基づき、機械学習エンジン122 は、様々な目的のために一組の規則、アルゴリズム及び/又は予測モデル124 を生成又は教育する。一実施形態では、アルゴリズム124 は、ADV を車線の片側の目的地点で片側に寄せる要求に応じて、第1のセグメント、第2のセグメント及び移行点を含む経路を計画するためのアルゴリズム若しくはモデル、目的地点までの距離及び車線の片側の境界までの所定の距離の内の少なくとも1つに基づき、移行点を決定するためのアルゴリズム、QP演算を使用して出発点から移行点までの第1のセグメントを生成するためのアルゴリズム、移行点から目的地点までの第2のセグメントを境界の形状に基づき生成するためのアルゴリズム、及び/又は計画された経路に従って、ADV を目的地点まで片側に寄せるように制御するためのアルゴリズム若しくはモデルを含んでもよい。そのため、リアルタイムで自律運転中に使用するために、アルゴリズム124 をADV (例えば図3Aのモデル313 )にアップロードすることができる。
図3A及び3Bは、一実施形態に係る自律車両と共に使用される認知・計画システムの例を示すブロック図である。システム300 は、認知・計画システム110 、車両制御システム111 及びセンサシステム115 を有するが、これらに限定されない図1の自律車両101 の一部として実装されてもよい。認知・計画システム110 は、位置特定モジュール301 、認知モジュール302 、予測モジュール303 、決定モジュール304 、計画モジュール305 、制御モジュール306 及びルーティングモジュール307 を有するが、これらに限定されない。図3A及び図3B参照。
モジュール301-307 の一部又は全ては、ソフトウェア、ハードウェア又はこれらの組み合わせで実装されてもよい。例えば、これらのモジュールは、永続記憶装置352 にインストールされてメモリ351 にロードされ、一又は複数のプロセッサ(不図示)によって実行されてもよい。尚、これらのモジュールの一部又は全ては図2の車両制御システム111 の一部又は全てのモジュールと通信可能に結合されてもよく又は一体化されてもよい。モジュール301-307 の一部は、一体化されたモジュールとして共に一体化されてもよい。
位置特定モジュール301 は、(例えばGPS ユニット212 を使用して)自律車両300 の現在位置を決定し、ユーザの旅行又はルートに関連するあらゆるデータを管理する。(地図・ルートモジュールとも称される)位置特定モジュール301 は、ユーザの旅行又はルートに関連するあらゆるデータを管理する。ユーザは、例えばユーザインタフェースを介してログインし、旅行の出発位置及び目的地を指定してもよい。位置特定モジュール301 は、地図・ルート情報311 のように自律車両300 の他の部品と通信して旅行に関連するデータを得る。例えば、位置特定モジュール301 は、位置サーバ及び地図・POI (MPOI)サーバから位置・ルート情報を得てもよい。位置サーバは位置サービスを提供し、MPOIサーバは、地図・ルート情報311 の一部としてキャッシュされてもよい地図サービス及び特定の位置のPOI を提供する。自律車両300 がルートに沿って移動している間、位置特定モジュール301 は、交通情報システム又は交通情報サーバからリアルタイムの交通情報を更に得てもよい。
センサシステム115 によって与えられるセンサデータ及び位置特定モジュール301 によって得られる位置特定情報に基づき、認知モジュール302 によって周辺環境の認知情報を決定する。認知情報は、一般のドライバが運転している車両を囲む何をドライバが認知しているかを表してもよい。認知情報は、例えば物体の形態で車線の構成、信号機の信号、別の車両の相対位置、歩行者、建物、横断歩道又は他の交通に関連する標識(例えば一時停止の標識、譲れの標識)などを含み得る。車線の構成は、一又は複数の車線、例えば車線の形状(例えば直線又は湾曲)、車線の幅、道路の車線の数、一方通行又は対面通行の車線、合流又は分離する車線、出口車線などについて記述する情報を含む。
認知モジュール302 は、自律車両の環境内の物体及び/又は特徴を識別するために、一又は複数のカメラによって取り込まれる画像を処理して分析するためのコンピュータビジョンシステム又はコンピュータビジョンシステムの機能を有してもよい。物体は、交通信号、道路の境界、他の車両、歩行者及び/又は障害物などを含み得る。コンピュータビジョンシステムは、物体認識アルゴリズム、ビデオ追跡及び他のコンピュータビジョン技術を使用してもよい。ある実施形態では、コンピュータビジョンシステムは環境をマップして物体を追跡し、物体の速度などを推定することができる。認知モジュール302 は更に、レーダ及び/又はLIDAR のような他のセンサによって与えられる他のセンサのデータに基づき、物体を検出することができる。
物体毎に、予測モジュール303 は、物体がこの状況下でどのようにふるまうかを予測する。一組の地図/ルート情報311 及び交通規則312 を考慮して、ある時点での運転環境を認知する認知データに基づき予測する。例えば、物体が反対方向の車両であり、現在の運転環境が交差点を含んでいる場合、予測モジュール303 は、車両が真っ直ぐ進むか又は曲がる虞があると予測する。交差点に信号機がないと認知データが示す場合、予測モジュール303 は、車両が交差点に入る前に完全に止まらなければならないかもしれないと予測する場合がある。車両が現在、左折専用車線又は右折専用車線にいると認知データが示す場合、予測モジュール303 は、車両が左折又は右折する虞があると予測する場合がある。
物体毎に、決定モジュール304 は、物体に対応する方法を決定する。例えば、特定の物体(例えば交差するルートにある別の車両)及びこの物体について記述するメタデータ(例えば速度、方向、回転角)に関して、決定モジュール304 は、物体に対処する方法(例えば追い越す、譲る、止まる、通過する)を決定する。決定モジュール304 は、永続記憶装置352 に記憶されてもよい交通規則又は運転規則312 のような一組の規則に従って、このような決定を行ってもよい。
ルーティングモジュール307 は、出発点から目的地点までの一又は複数のルート又は経路を提供するように構成されている。例えばユーザから受けた出発位置から目的地位置までの所与の旅行のために、ルーティングモジュール307 は、地図・ルート情報311 を得て、目的地位置に到着するための出発位置からのあらゆる可能なルート又は経路を決定する。ルーティングモジュール307 は、ルーティングモジュール307 が決定した目的地位置に到着するための出発位置からのルート毎に地形図の形態で基準線を生成してもよい。基準線は、他の車両、障害物又は交通状況のような他のものからのいかなる干渉もなく理想的なルート又は経路を示す。すなわち、道路に他の車両、歩行者又は障害物がない場合、ADV は基準線に正確に又は厳密に従うべきである。その後、地形図を決定モジュール304 及び/又は計画モジュール305 に与える。決定モジュール304 及び/又は計画モジュール305 は、位置特定モジュール301 からの交通状況、認知モジュール302 によって認知される運転環境及び予測モジュール303 によって予測される交通状況のような他のモジュールによって与えられる他のデータを考慮して、可能なルートの全てを調べて最適なルートの内の1つを選択して修正する。ADV を制御するための実際の経路又はルートは、ある時点での特定の運転環境に応じて、ルーティングモジュール307 によって与えられる基準線と近くてもよく、又はこの基準線と異なってもよい。
ある実施形態では、基準点を、ステーション-横方向(SL)座標のような相対座標系に変換してもよい。ステーション-横方向座標系は、基準線をたどるために固定基準点を基準とする座標系である。例えば、(S, L)=(1, 0) 座標は、基準線上の固定点(つまり基準点)の前方に1メートルであり、横方向にゼロメートルオフセットしていることを意味し得る。(S, L)=(2, 1) 基準点は、基準線に沿って固定基準点の前方に2メートルであり、基準線から横方向に1メートルオフセットしている、例えば左に1メートルオフセットしていることを意味し得る。
認知された物体毎の決定結果に基づき、計画モジュール305 は、ルーティングモジュール307 によって与えられた基準線を基準として使用して、自律車両のための経路又はルート、及び運転パラメータ(例えば距離、速度及び/又は回転角)を計画する。すなわち、所与の物体に関して、決定モジュール304 が物体に対処するためになすべきことを決定する一方、計画モジュール305 はその方法を決定する。例えば、所与の物体に関して、決定モジュール304 が物体を通過すると決定してもよい一方、計画モジュール305 は、物体の左側を通過するか又は右側を通過するかを決定してもよい。計画モジュール305 によって、自律車両300 が次の移動サイクル(例えば、次のルート/経路セグメント)でどのように移動するかについて記述している情報を含む計画・制御データを生成する。例えば、計画・制御データは、自律車両300 に時速30マイル(mph) の速度で10メートル移動し、次に25 mphの速度で右の車線に変わるように指示してもよい。
計画・制御データに基づき、制御モジュール306 は、計画・制御データによって定められたルート又は経路に応じて、適切なコマンド又は信号を車両制御システム111 に送信することにより、自律車両を制御して運転する。計画・制御データは、経路又はルートに沿って様々な時点で適切な車両設定又は運転パラメータ(例えばスロットルコマンド、制動コマンド、ステアリングコマンド)を使用して、ルート又は経路の第1の地点から第2の地点に車両を運転するための十分な情報を含む。
一実施形態では、計画段階を、運転サイクルとも称される多くの計画サイクルで、例えば100 ミリ秒(ms)の時間間隔毎に行う。計画サイクル又は運転サイクル毎に、計画・制御データに基づき一又は複数の制御コマンドを発する。すなわち、100 ms毎に、計画モジュール305 は、例えば目標位置、及びADV が目標位置に到着するのに必要な時間を含む次のルートセグメント又は経路セグメントを計画する。或いは、計画モジュール305 は、特定の速度、方向及び/又はステアリング角などを更に指定してもよい。一実施形態では、計画モジュール305 は、次の所定の時間、例えば5秒間のルートセグメント又は経路セグメントを計画する。計画サイクル毎に、計画モジュール305 は、前のサイクルで計画された目標位置に基づき、現在のサイクル(例えば次の5秒間)の目標位置を計画する。その後、制御モジュール306 は、現在のサイクルの計画・制御データに基づき一又は複数の制御コマンド(例えばスロットルコマンド、制動コマンド、ステアリング制御コマンド)を生成する。
尚、決定モジュール304 及び計画モジュール305 は、一体化されたモジュールとして一体化されてもよい。決定モジュール304 /計画モジュール305 は、自律車両のための運転経路を決定するためにナビゲーションシステム又はナビゲーションシステムの機能を有してもよい。例えば、ナビゲーションシステムは、最終目的地に通じる車道に基づく経路に沿って自律車両を一般に前進させながら、認知された障害物を実質的に避ける経路に沿って自律車両を移動させるための一連の速度及び方向進路を決定してもよい。ユーザインタフェースシステム113 を介したユーザの入力に従って、目的地を設定してもよい。自律車両の走行中、ナビゲーションシステムは運転経路を動的に更新してもよい。ナビゲーションシステムは、自律車両のための運転経路を決定するようにGPS システムからのデータ及び一又は複数の地図を組み込むことができる。
一実施形態によれば、計画モジュール305 は、ADV を車線の片側の目的地点で片側に寄せる要求に応じて、第1のセグメント、第2のセグメント及び移行点を含む経路を計画するように構成されている。計画モジュール305 は、目的地点までの距離及び車線の片側の境界までの所定の距離の内の少なくとも1つに基づき、移行点を決定するように構成されている。計画モジュール305 は、QP演算を使用して出発点から移行点までの第1のセグメントを生成するように構成されている。計画モジュール305 は、移行点から目的地までの第2のセグメントを境界の形状に基づき生成するように更に構成されている。制御モジュール306 は、計画された経路に従って、ADV を目的地点まで片側に寄せるべく制御するように構成されている。
図4は計画モジュールの例を示すブロック図400 であり、図5は、一実施形態に係る計画モジュールの処理流れ図500 である。計画モジュール305 は、これらに限定されない第1のセグメントモジュール401 、第2のセグメントモジュール402 及び移行点モジュール403 を有し、これらのモジュールは、計画された経路に従ってADV を目的地点まで片側に寄せるためにQPアルゴリズム又はモデル314 を使用して協働する。図4及び図5参照。尚、モジュール401-403 は、より少数のモジュール又は単一のモジュールに一体化されてもよい。
一実施形態によれば、計画モジュール305 は、ADV を車線の片側の目的地点で片側に寄せる要求に応じて、第1のセグメント、第2のセグメント及び移行点を含む経路を計画するように構成されている。移行点モジュール403 は、目的地点までの距離及び車線の片側の境界までの所定の距離の内の少なくとも1つに基づき、移行点を決定するように構成されてもよい。第1のセグメントモジュール401 は、QPモジュール501 によるQP最適化を使用して出発点から移行点までの第1のセグメントを生成するように構成されている。第2のセグメントモジュール402 は、移行点から目的地点までの第2のセグメントを境界の形状に基づき生成するように構成されている。制御モジュール306 は、計画された経路に従って、ADV を目的地点まで片側に寄せるべく制御するように構成されている。
一実施形態では、第1のセグメントモジュール401 は、制約モジュール502 及び費用関数モジュール503 を有するQPモジュール501 と経路生成器504 とを有しているが、これらに限定されない。制約モジュール502 は、車線の右側の境界に基づき、第1のセグメントのための右側の制約を決定するように構成されてもよい。制約モジュール502 は、第1のセグメントのための左側の制約を決定するように更に構成されてもよい。費用関数モジュール503 は、計画された経路と基準線との距離及び計画された経路の平滑化レベルの内の少なくとも1つに基づき、費用関数を決定するように構成されている。経路生成器504 は、経路の第1のセグメントを生成するように構成されている。
一実施形態では、第2のセグメントモジュール402 は、決定モジュール505 と、制約モジュール507 及び費用関数モジュール508 を有するQPモジュール506 と、経路生成器509 とを有しているが、これらに限定されない。決定モジュール505 は、境界の形状が平滑であるか否かを決定するように構成されてもよい。制約モジュール502 は、第2のセグメントのための右側の制約及び左側の制約を決定するように更に構成されてもよい。費用関数モジュール508 は、計画された経路と基準線との距離及び計画された経路の平滑化レベルの内の少なくとも1つに基づき、費用関数を決定するように構成されている。経路生成器509 は、経路の第2のセグメントを生成するように構成されている。
図6及び図7は、ADV を車線の片側の目的地点で片側に寄せるための方法の例を示す図である。全ての自動運転の終わりに、乗客が乗り降りするのに便利な車線の右側でADV が止まることが望まれてもよい。しかしながら、ADV の本体全体と車線の右側の境界との距離が小さくなり、ADV が右側の境界と平行になるように、ADV が正確に片側に寄ることは困難である。例えば、ADV が車線の右側の境界まで僅かな距離で片側に寄るのは困難な場合があり、ADV が右側の境界と平行になるのは困難な場合がある。
本明細書には、二次計画法(QP)に基づきADV を正確に片側に寄せるための方法が開示されている。この方法を使用することにより、ADV の本体全体と車線の右側の境界との距離が小さく、ADV が右側の境界と平行であるように、ADV が正確に片側に寄ることができる。本方法により、ADV を片側に寄せる際に高い距離精度及び高い成功率がもたらされ得る。
2つの部分、つまりQPセグメント領域(例えば601, 701)のQPセグメント(例えば721 )及び保持セグメント領域(例えば602, 702)の保持セグメント(例えば722 )を含む経路を生成することによって、ADV を正確に道路の片側に寄せるための経路を計画してもよい。図6及び図7参照。QPセグメント(例えば721 )はADV を道路の片側に更に近づけるように構成されてもよく、保持セグメント(例えば722 )はADV を道路の片側と平行に保つように構成されてもよい。
一実施形態では、ADV が走行する車線(例えば605, 705)の左側の車線境界(例えば603, 703)及び右側の車線境界(例えば604, 704)を得てもよい。車線(例えば605, 705)が左側から通過することが許可されているか否かのような車線の車線タイプを更に得てもよい。例えば、図6に示されている車線605 は、左側から通過することが許可されている。別の例では、図7に示されている車線705 は、左側から通過することが許可されていない。
例えばルーティングモジュール307 によって生成された基準線に応じて、車線のサンプル地点をSL座標に投影してもよい。SL投影は、平滑な基準線の連続曲率導関数に基づいてもよい。デカルト座標空間では、障害物及びADV の状態が、位置及び進路(x,y,θ)並びにADV に関する曲率及び曲率の導関数(κ,dκ)を用いて記述されてもよい。そのため、これらを、ADV のステーション、横方向及び横方向導関数を表すSL座標(s, l, dl, ddl, dddl) にマップしてもよい。SL座標系では、経路の経路座標は、ステーションS(経路に沿った距離)及び横方向座標L(点と経路とを交差する線上で測定されて、交差する点で経路に対して垂直である経路からの点の距離)である。
上述されているように、ADV に関するSL座標系は、基準線をたどるために固定基準点を基準とする座標系である。例えば、(S, L)=(1, 0) 座標は、基準線上の固定点(つまり基準点)の前方に1メートルであり、横方向にゼロメートルオフセットしていることを意味し得る。(S, L)=(2, 1) 基準点は、基準線に沿って固定基準点の前方に2メートルであり、基準線から横方向に1メートルオフセットしている、例えば左に1メートルオフセットしていることを意味し得る。
一実施形態では、認知モジュール302 は、ADV に取り付けられたセンサに基づき、運転環境を検出するように構成されてもよい。例えば、認知モジュール302 は、右側が安全か否かをチェックしてもよい。右側に障害物がある場合、特に右側から割り込む動的な障害物がある場合、片側に寄ることを禁止する。
移行点(例えば606, 706)はQPセグメント(例えば721 )の端である。移行点(例えば606, 706)を、目的地点(例えば720 )までの距離と、車線(例えば605, 705)の右側の境界(例えば604, 704)までの所望の距離とに応じて決定してもよい。例えば、ADV が次の計画サイクルで目的地点(例えば720 )に更に近づくにつれて、移行点は前方に移ってもよい。
ADV は、QPセグメント(例えば721 )の左側の制約(例えば610, 710)及び右側の制約(例えば611, 711)を決定するように構成されてもよい。右側の制約(例えば611, 711)は、QPセグメント(例えば721 )の右側の車線境界(例えば604, 704)に基づいてもよい。例えば、右側の制約(例えば611, 711)は、右側の車線境界(例えば604, 704)からADV の幅の半分、離れるように決定されてもよい。
一実施形態では、QPセグメント(例えば721 )の左側の制約(例えば610, 710)を決定してもよい。QPセグメント(例えば721 )の左側の制約(例えば610, 710)は、車線(例えば605, 705)が左から通過することが許可されているか否かのような、車線の車線タイプに基づいてもよい。例えば、図6に示されている車線605 では、左側から通過することが許可されているため、左側の制約610 を、例えばADV の幅分、車線605 の左側の車線境界603 を越えて広げてもよい。別の例では、図7に示されている車線705 では、左側から通過することが許可されていないため、左側の制約710 を、車線705 の左側の車線境界703 を越えて広げなくてもよい。
QPセグメント(例えば721 )の左側の制約(例えば610, 710)を決定する際、初めの幾つかの左側の制約が、クルーズコントロールのように夫々の位置で維持されてもよい。初めの幾つかの左側の制約の数は2、3、4、5、6、7、8、9、10又はこれらの値の間のあらゆる値であってもよい。図6に示されているように、第1の地点607 はADV の現在位置で維持されてもよい。第2の地点608 及び第3の地点609 は、クルーズコントロールのように維持されてもよい。障害物を回避し得るために、車線605 が左側から通過することを許可されているので、左側の制約を車線の左側まで広げてもよい。一実施形態では、曲線610 を使用して、初めの幾つかの左側の制約(例えば607, 608, 609 )を移行点606 に接続してもよい。例として、曲線610 は円弧、つまり円の円周の一部であってもよい。別の例として、曲線は、楕円形の曲線、放物線の曲線のような他の曲線の一部であってもよい。
QPセグメント(例えば721 )の左側の制約(例えば610, 710)及び右側の横方向の制約(例えば611, 711)を得た後、QP最適化(QPソルバ)を使用してQPセグメント(例えば721 )を生成してもよい。QP最適化は、特別なタイプの数理最適化問題、特に線形制約付二次最適化問題、すなわち、複数の変数に対する線形制約を受けるこれらの変数の二次関数を最適化する(最小化又は最大化する)問題を解く処理である。QPは特定のタイプの非線形計画法である。
一実施形態では、一組の制約を満たしながら、目的関数又は費用関数の総費用が最小値に達するように、目的関数又は費用関数に対してQP最適化を行ってもよい。一実施形態では、多項式又は多項式関数を使用して、計画された経路を表してもよい。曲線が曲線に沿って連続的である(例えば、2つの隣接するセグメントの接点での導関数が取得可能である)ように、多項式最適化又は多項式適合という用語は、多項式関数(例えば五次又は四次の多項式関数)によって表される曲線(本例では、生成される経路)の形状の最適化を指す。自律運転の分野では、出発点から終点までの多項式曲線を、制御点(又は基準点)に夫々対応する多くのセグメント(又は部分)に分割してもよい。このように分割された多項式曲線は区分的多項式と称され得る。区分的多項式を最適化する場合、一組の初期状態制約及び最終状態制約に加えて、2つの隣接するセグメント間の一組の接点制約及び一組の境界制約を満たす必要がある。
例えば、経路に関する多項式関数は、
l(s) = p0+p1s+p2s2+…+pnsn
のように1次元であってもよい。
ここで、s, lは、n次の多項式に関するステーション-横方向1次元(s, l)幾何座標を表し、p0..n は、解くべき1次元多項式の係数である。例えば、同次多項式関数に関してnは5であってもよい。
QP最適化を使用して、SL座標における費用関数に基づく経路を最適化してもよい。QP最適化を行って、費用関数に基づき、SL座標におけるステーション座標に関する横方向座標l = f(s)の最適な関数を見つけてもよい。費用関数は車線費用及び平滑費用の組み合わせであってもよい。一実施形態では、費用関数は以下の通りであってもよい。
Figure 0007229278000001
QPセグメント721 の左側の制約710 及び右側の横方向の制約711 に応じて、上記の費用関数に基づきQP最適化によってQPセグメント721 の計画経路を生成してもよい。図7参照。
しかしながら、QPセグメント(例えば721 )を含む経路のみでは、車線705 の右側の境界704 である道路の片側と平行にADV を保つことができない場合がある。更に、右側の車線境界704 は直線で平滑なライン上にない場合がある。保持セグメント(例えば722 )によって、制御モジュール306 がADV の向きを調節するための時間が与えられてもよい。ADV が車線705 の右側の境界704 と平行であるように保持セグメント722 を設けることが有利な場合がある。
一実施形態では、移行点706 と目的地点720 との間の右側の車線境界704 が直線で平滑なラインの形状である場合、右側の車線境界704 の形状に基づき、保持セグメント722 を生成してもよい。例えば、SL座標では、図7に示されているように、右側の車線境界704 を上方に平行移動させて移行点706 でQPセグメント721 と接続することにより、保持セグメント722 を生成してもよい。
右側の車線境界704 の形状が複雑であり、直線で平滑なラインの形状ではない場合、上述した処理と同様の別のQP最適化(QPソルバ)によって保持セグメントを生成してもよい。
一実施形態では、保持セグメント領域702 の右側の車線境界704 の形状に基づき、保持セグメント722 の右側の制約711 を決定してもよい。例えば、保持セグメント722 の右側の制約711 は、右側の車線境界704 の形状で右側の車線境界704 からADV の幅の半分、離れてもよい。保持セグメント722 の左側の制約710 は、ADV の本体全体と車線705 の右側の境界704 との間の所定の距離閾値に基づいてもよい。例えば、保持セグメント722 の左側の制約710 は、保持セグメント722 の右側の制約711 から所定の距離閾値分、離れてもよい。ADV の本体全体と車線705 の右側の境界704 との間の所定の距離閾値は、10cm、15cm、20cm、30cm、50cm又はこれらの値の間のあらゆる値であってもよい。例えば、所定の距離閾値は15cm~20cmの間であってもよい。このようにして、ADV の本体全体と車線の右側の境界との距離が所定の距離閾値より小さく、ADV が右側の境界と平行であるように、ADV を正確に片側に寄せることができる。
図8は、ある実施形態に従って、ADV を車線の片側の目的地点で片側に寄せるための方法の例を示すフローチャート800 である。処理800 を、ソフトウェア、ハードウェア又はこれらの組み合わせを有してもよい処理論理回路によって行ってもよい。例えば、処理800 を計画モジュール305 により行ってもよい。ステップ801 では、処理論理回路が、ADV を車線の片側の目的地点で片側に寄せる要求に応じて、第1のセグメント、第2のセグメント及び移行点を含む経路を計画する。図8参照。ステップ801 は、ステップ802 、ステップ803 及びステップ804 を有する。ステップ802 では、処理論理回路が、目的地点までの距離及び車線の片側の境界までの所定の距離の内の少なくとも1つに基づき、移行点を決定する。ステップ803 では、処理論理回路が、二次計画法(QP)最適化を使用して出発点から移行点までの第1のセグメントを生成する。ステップ804 では、処理論理回路が、移行点から目的地点までの第2のセグメントを境界の形状に基づき生成する。ステップ805 では、処理論理回路が、計画された経路に従って、ADV を目的地点まで片側に寄せるように制御する。
尚、図示されて上述されている部品の一部又は全てはソフトウェア、ハードウェア又はこれらの組み合わせで実装されてもよい。例えば、このような部品は永続記憶装置にインストールされて記憶されたソフトウェアとして実装されることができ、このソフトウェアは、本明細書を通して記載されている処理又は演算を行うために、プロセッサ(不図示)によってメモリにロードされて実行され得る。或いは、このような部品は、集積回路(例えばアプリケーションに特化したIC若しくはASIC)、デジタルシグナルプロセッサ(DSP) 又はフィールドプログラマブルゲートアレイ(FPGA)のような専用のハードウェアにプログラムされるか又は埋め込まれる実行可能なコードとして実装されることができ、この実行可能なコードは、アプリケーションから対応するドライバ及び/又はオペレーティングシステムを介してアクセスされ得る。更に、このような部品は、一又は複数の特定の命令を介してソフトウェア部品によってアクセス可能な命令セットの一部としてプロセッサ又はプロセッサコアの特定のハードウェア論理回路として実装され得る。
前述の詳細な記述の一部は、コンピュータメモリ内のデータビットに対する演算のアルゴリズム及び記号表現の点から示されている。これらのアルゴリズムの記述及び表現は、データ処理の技術分野における当業者が自身の仕事内容を当該技術分野の他の人に最も効率的に伝えるべく使用する方法である。アルゴリズムは、本明細書では一般に、所望の結果をもたらすセルフコンシステントシーケンスの演算であると考えられている。演算は、物理量の物理的操作を必要とする演算である。
しかしながら、これらの用語及び同様の用語の全ては適切な物理量と関連しており、これらの量に適用される単なる便利なラベルに過ぎないことに留意すべきである。上記の記述から明らかなように、特に具体的に述べられていない限り、本明細書を通じて、以下の特許請求の範囲に定義されているような用語を使用した記述は、コンピュータシステムのレジスタ及びメモリ内の物理(電子)量として表されるデータを操作して、コンピュータシステムのメモリ又はレジスタ又は他のこのような情報記憶部、送信装置又は表示装置内の物理量として同様に表される他のデータに変換するコンピュータシステム又は同様の電子コンピュータデバイスの動作及び処理を指すことが認識される。
本開示の実施形態は、本明細書における演算を行うための装置に更に関する。このようなコンピュータプログラムは、非一時的なコンピュータ可読媒体に記憶されている。機械可読媒体は、機械(例えばコンピュータ)が読み取り可能な形態で情報を記憶するためのあらゆる機構を含んでいる。例えば、機械可読(例えば、コンピュータ可読)媒体は、機械(例えばコンピュータ)可読記憶媒体(例えば読み出し専用メモリ(ROM )、ランダムアクセスメモリ(RAM )、磁気ディスク記憶媒体、光記憶媒体、フラッシュメモリデバイス)を含んでいる。
前述の図面に示されている処理又は方法を、ハードウェア(例えば回路、専用論理回路など)、(例えば、非一時的なコンピュータ可読媒体に埋め込まれた)ソフトウェア又はこれら両方の組み合わせを備えた処理論理回路によって行ってもよい。処理又は方法が複数の連続的な演算の点から上述されているが、記載されている演算の一部を異なる順に行ってもよいと認識されるべきである。更に、一部の演算を連続的ではなく並行して行ってもよい。
本開示の実施形態は、特定のプログラミング言語を参照して記載されていない。様々なプログラミング言語を使用して、本明細書に記載されているような本開示の実施形態の教示を実施してもよいことが認識される。
前述の明細書では、本開示の実施形態は、本開示の特定の例示的な実施形態を参照して記載されている。以下の特許請求の範囲に記載されているような本開示のより広い趣旨及び範囲から逸脱することなく、様々な変更がなされ得ることは明らかである。従って、明細書及び図面は限定的な意味ではなく例示の意味で考慮されるべきである。

Claims (16)

  1. 自律運転車両(ADV) を運転するためにコンピュータが実行する方法であって、
    ADV を車線の片側の目的地点で片側に寄せる要求に応じて、第1のセグメント、第2のセグメント及び移行点を含む経路を計画し、
    計画された経路に従って、前記ADV を前記目的地点まで片側に寄せるように制御し、
    前記経路を計画する際、
    前記目的地点までの距離及び前記車線の片側の境界までの所定の距離の内の少なくとも1つに基づき、前記移行点を決定し、
    二次計画法(QP)最適化を使用して、出発点から前記移行点までの前記第1のセグメントを生成し、
    前記第2のセグメントと前記境界との間の距離を所定の距離閾値より小さくするように、前記車線の片側の境界の形状に基づき、前記移行点から前記目的地点までの前記第2のセグメントを生成することを特徴とする方法。
  2. 前記QP最適化を使用して前記出発点から前記移行点までの前記第1のセグメントを生成する際、前記車線の片側の境界に基づき、第1の制約を決定することを特徴とする請求項1に記載の方法。
  3. 前記QP最適化を使用して前記出発点から前記移行点までの前記第1のセグメントを生成する際、第2の制約を決定することを特徴とする請求項2に記載の方法。
  4. 前記QP最適化は費用関数に基づいており、計画された経路と基準線との距離及び計画された経路の平滑さの内の少なくとも1つに基づき、前記費用関数を決定することを特徴とする請求項1に記載の方法。
  5. 前記境界の形状に基づき、前記移行点から前記目的地点までの前記第2のセグメントを生成する際、前記境界の形状が直線で平滑なラインの形状であるか否かを決定することを特徴とする請求項1に記載の方法。
  6. 前記境界の形状に基づき、前記移行点から前記目的地点までの前記第2のセグメントを生成する際、更に
    前記境界の形状が直線で平滑なラインの形状であると決定し、
    前記境界の形状を使用して前記第2のセグメントを生成することを特徴とする請求項5に記載の方法。
  7. 前記境界の形状に基づき、前記移行点から前記目的地点までの前記第2のセグメントを生成する際、更に
    前記境界の形状が直線で平滑なラインの形状ではないと決定し、
    第2のQP最適化を使用して前記第2のセグメントを生成することを特徴とする請求項5に記載の方法。
  8. 命令が記憶されている非一時的な機械可読媒体であって、
    前記命令は、プロセッサによって実行されるとき、前記プロセッサに、
    ADV を車線の片側の目的地点で片側に寄せる要求に応じて、第1のセグメント、第2のセグメント及び移行点を含む経路を計画させ、
    計画された経路に従って、前記ADV を前記目的地点まで片側に寄せるように制御させ、
    前記経路を計画させる際、
    前記目的地点までの距離及び前記車線の片側の境界までの所定の距離の内の少なくとも1つに基づき、前記移行点を決定させ、
    二次計画法(QP)最適化を使用して出発点から前記移行点までの前記第1のセグメントを生成させ、
    前記第2のセグメントと前記境界との間の距離を所定の距離閾値より小さくするように、前記境界の形状に基づき、前記移行点から前記目的地点までの第2のセグメントを生成させることを特徴とする機械可読媒体。
  9. 前記QP最適化を使用して前記出発点から前記移行点までの前記第1のセグメントを生成させる際、前記境界に基づき第1の制約を決定させることを特徴とする請求項8に記載の機械可読媒体。
  10. 前記QP最適化を使用して前記出発点から前記移行点までの前記第1のセグメントを生成させる際、第2の制約を決定させることを特徴とする請求項9に記載の機械可読媒体。
  11. 前記QP最適化は費用関数に基づいており、計画された経路と基準線との距離及び計画された経路の平滑さの内の少なくとも1つに基づき、前記費用関数を決定させることを特徴とする請求項8に記載の機械可読媒体。
  12. 前記境界の形状に基づき、前記移行点から前記目的地点までの前記第2のセグメントを生成させる際、前記境界の形状が直線で平滑なラインの形状であるか否かを決定させることを特徴とする請求項8に記載の機械可読媒体。
  13. 前記境界の形状に基づき、前記移行点から前記目的地点までの前記第2のセグメントを生成させる際、更に
    前記境界の形状が直線で平滑なラインの形状であると決定させ、
    前記境界の形状を使用して前記第2のセグメントを生成させることを特徴とする請求項12に記載の機械可読媒体。
  14. 前記境界の形状に基づき、前記移行点から前記目的地点までの前記第2のセグメントを生成させる際、更に
    前記境界の形状が直線で平滑なラインの形状ではないと決定させ、
    第2のQP最適化を使用して前記第2のセグメントを生成させることを特徴とする請求項12に記載の機械可読媒体。
  15. データ処理システムであって、
    プロセッサと、
    前記プロセッサに結合されて命令を記憶するメモリと
    を備えており、
    前記命令は、前記プロセッサによって実行されるとき、前記プロセッサに請求項1~7のいずれか1つに記載の方法を実行させることを特徴とするデータ処理システム。
  16. コンピュータ上で動作しているとき、請求項1~7のいずれか1つに記載の方法を前記コンピュータに実行させるためのコンピュータプログラム。
JP2020570513A 2020-04-10 2020-04-10 経路計画のための二次計画法に基づき、片側に寄せる方法 Active JP7229278B2 (ja)

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/CN2020/084257 WO2021203426A1 (en) 2020-04-10 2020-04-10 Pull over method based on quadratic programming for path planning

Publications (3)

Publication Number Publication Date
JP2022531031A JP2022531031A (ja) 2022-07-06
JPWO2021203426A5 JPWO2021203426A5 (ja) 2022-07-13
JP7229278B2 true JP7229278B2 (ja) 2023-02-27

Family

ID=75208089

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2020570513A Active JP7229278B2 (ja) 2020-04-10 2020-04-10 経路計画のための二次計画法に基づき、片側に寄せる方法

Country Status (5)

Country Link
US (1) US11529969B2 (ja)
EP (1) EP4132827A4 (ja)
JP (1) JP7229278B2 (ja)
CN (1) CN112601869B (ja)
WO (1) WO2021203426A1 (ja)

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2017022474A1 (ja) 2015-07-31 2017-02-09 日立オートモティブシステムズ株式会社 車両用操舵支援制御装置
JP2017210234A (ja) 2016-05-27 2017-11-30 ローベルト ボツシユ ゲゼルシヤフト ミツト ベシユレンクテル ハフツングRobert Bosch Gmbh 少なくとも一時的に走行ルート上を自動誘導される自動車の自動的停車のための装置及び方法
US20190086932A1 (en) 2017-09-18 2019-03-21 Baidu Usa Llc Smooth road reference line for autonomous driving vehicles based on 2d constrained smoothing spline
JP2019043364A (ja) 2017-09-01 2019-03-22 本田技研工業株式会社 車両制御装置、車両制御方法、およびプログラム
WO2020217315A1 (ja) 2019-04-23 2020-10-29 三菱電機株式会社 駐車支援装置および駐車支援方法

Family Cites Families (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR101063302B1 (ko) * 2010-10-05 2011-09-07 국방과학연구소 무인차량의 자율주행 제어 장치 및 방법
US9120485B1 (en) * 2012-09-14 2015-09-01 Google Inc. Methods and systems for smooth trajectory generation for a self-driving vehicle
US9523984B1 (en) * 2013-07-12 2016-12-20 Google Inc. Methods and systems for determining instructions for pulling over an autonomous vehicle
US9428187B2 (en) * 2014-06-05 2016-08-30 GM Global Technology Operations LLC Lane change path planning algorithm for autonomous driving vehicle
JP6637400B2 (ja) * 2016-10-12 2020-01-29 本田技研工業株式会社 車両制御装置
WO2018217526A1 (en) * 2017-05-23 2018-11-29 Uber Technologies, Inc. Path segment risk regression system for on-demand transportation services
US10515321B2 (en) * 2017-09-11 2019-12-24 Baidu Usa Llc Cost based path planning for autonomous driving vehicles
US10571921B2 (en) * 2017-09-18 2020-02-25 Baidu Usa Llc Path optimization based on constrained smoothing spline for autonomous driving vehicles
US10816977B2 (en) * 2018-01-26 2020-10-27 Baidu Usa Llc Path and speed optimization fallback mechanism for autonomous vehicles
JP6847885B2 (ja) * 2018-03-20 2021-03-24 株式会社東芝 情報処理装置、情報処理方法及びプログラム
US11117569B2 (en) * 2018-06-27 2021-09-14 Baidu Usa Llc Planning parking trajectory generation for self-driving vehicles using optimization method
CN109596138B (zh) * 2018-12-29 2020-12-25 北京智行者科技有限公司 自动驾驶充电车停车路径规划方法及系统
CN109927716B (zh) * 2019-03-11 2020-11-10 武汉环宇智行科技有限公司 基于高精度地图的自主垂直泊车方法

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2017022474A1 (ja) 2015-07-31 2017-02-09 日立オートモティブシステムズ株式会社 車両用操舵支援制御装置
JP2017210234A (ja) 2016-05-27 2017-11-30 ローベルト ボツシユ ゲゼルシヤフト ミツト ベシユレンクテル ハフツングRobert Bosch Gmbh 少なくとも一時的に走行ルート上を自動誘導される自動車の自動的停車のための装置及び方法
JP2019043364A (ja) 2017-09-01 2019-03-22 本田技研工業株式会社 車両制御装置、車両制御方法、およびプログラム
US20190086932A1 (en) 2017-09-18 2019-03-21 Baidu Usa Llc Smooth road reference line for autonomous driving vehicles based on 2d constrained smoothing spline
WO2020217315A1 (ja) 2019-04-23 2020-10-29 三菱電機株式会社 駐車支援装置および駐車支援方法

Also Published As

Publication number Publication date
JP2022531031A (ja) 2022-07-06
US11529969B2 (en) 2022-12-20
CN112601869B (zh) 2022-10-28
EP4132827A1 (en) 2023-02-15
CN112601869A (zh) 2021-04-02
US20210316749A1 (en) 2021-10-14
WO2021203426A1 (en) 2021-10-14
EP4132827A4 (en) 2024-01-10

Similar Documents

Publication Publication Date Title
US11442450B2 (en) Method for determining passable area in planning a path of autonomous driving vehicles
US11815891B2 (en) End dynamics and constraints relaxation algorithm on optimizing an open space trajectory
US11377112B2 (en) Low-speed, backward driving vehicle controller design
US11567506B2 (en) Speed planning guidance line for mild slow down
US11880201B2 (en) Fastest lane determination algorithm under traffic jam
US11628858B2 (en) Hybrid planning system for autonomous vehicles
EP3925844B1 (en) Relative speed based speed planning for buffer area
US11713057B2 (en) Feedback based real time steering calibration system
US11787440B2 (en) Lane boundary and vehicle speed based nudge decision
US11535277B2 (en) Dual buffer system to ensure a stable nudge for autonomous driving vehicles
US11061403B2 (en) Path planning with a preparation distance for a lane-change
US11577758B2 (en) Autonomous vehicle park-and-go scenario design
US11608056B2 (en) Post collision damage reduction brake system incorporating front obstacle avoidance
EP4026747A1 (en) Sound source detection and localization for autonomous driving vehicle
US11724717B2 (en) Implementation of dynamic cost function of self-driving vehicles
JP7229278B2 (ja) 経路計画のための二次計画法に基づき、片側に寄せる方法
US11242057B2 (en) Method for optimizing three-point turn of autonomous driving vehicles
US20230202516A1 (en) Planning under prediction with confidence region for an autonomous driving vehicle
US11679757B2 (en) Control assistant system to align driving and riding experience between gasoline and electric vehicles
US20230065284A1 (en) Control and planning with localization uncertainty

Legal Events

Date Code Title Description
A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20201214

A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20201214

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20220802

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20221101

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20230214

R150 Certificate of patent or registration of utility model

Ref document number: 7229278

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150