JP6539408B2 - 学習に基づくモデル予測制御を利用して自律走行車の路面摩擦を決定する方法及びシステム - Google Patents

学習に基づくモデル予測制御を利用して自律走行車の路面摩擦を決定する方法及びシステム Download PDF

Info

Publication number
JP6539408B2
JP6539408B2 JP2018510415A JP2018510415A JP6539408B2 JP 6539408 B2 JP6539408 B2 JP 6539408B2 JP 2018510415 A JP2018510415 A JP 2018510415A JP 2018510415 A JP2018510415 A JP 2018510415A JP 6539408 B2 JP6539408 B2 JP 6539408B2
Authority
JP
Japan
Prior art keywords
cost
location
destination
friction
road
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
JP2018510415A
Other languages
English (en)
Other versions
JP2019512111A (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 com Times Technology Beijing Co Ltd
Baidu USA LLC
Original Assignee
Baidu com Times Technology Beijing Co Ltd
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 com Times Technology Beijing Co Ltd, Baidu USA LLC filed Critical Baidu com Times Technology Beijing Co Ltd
Publication of JP2019512111A publication Critical patent/JP2019512111A/ja
Application granted granted Critical
Publication of JP6539408B2 publication Critical patent/JP6539408B2/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
    • 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/068Road friction coefficient
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/04Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
    • G05B13/042Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
    • 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, or advanced driver assistance systems for ensuring comfort, stability and safety or drive control systems for propelling or retarding the vehicle
    • B60W30/14Adaptive cruise control
    • 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
    • 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 or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/0088Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot characterized by the autonomous decision making process, e.g. artificial intelligence, predefined behaviours
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • 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/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/096877Systems involving transmission of navigation instructions to the vehicle where the input to the navigation device is provided by a suitable I/O arrangement
    • G08G1/096888Systems involving transmission of navigation instructions to the vehicle where the input to the navigation device is provided by a suitable I/O arrangement where input information is obtained using learning systems, e.g. history databases
    • 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/0019Control system elements or transfer functions
    • B60W2050/0022Gains, weighting coefficients or weighting functions
    • B60W2050/0024Variable gains
    • 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/0019Control system elements or transfer functions
    • B60W2050/0028Mathematical models, e.g. for simulation
    • 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/0062Adapting control system settings
    • B60W2050/0075Automatic parameter input, automatic initialising or calibrating means
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W50/00Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
    • B60W2050/0062Adapting control system settings
    • B60W2050/0075Automatic parameter input, automatic initialising or calibrating means
    • B60W2050/0083Setting, resetting, calibration
    • B60W2050/0088Adaptive recalibration
    • 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/12Lateral 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
    • B60W2540/00Input parameters relating to occupants
    • B60W2540/10Accelerator pedal position
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2540/00Input parameters relating to occupants
    • B60W2540/12Brake pedal position
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2540/00Input parameters relating to occupants
    • B60W2540/18Steering angle
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2552/00Input parameters relating to infrastructure
    • B60W2552/40Coefficient of friction
    • 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
    • B60W2556/00Input parameters relating to data
    • B60W2556/10Historical 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
    • B60W2556/00Input parameters relating to data
    • B60W2556/45External transmission of data to or from the vehicle
    • B60W2556/50External transmission of data to or from the vehicle for navigation systems
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W50/00Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
    • B60W50/0097Predicting future conditions

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Mechanical Engineering (AREA)
  • Transportation (AREA)
  • Mathematical Physics (AREA)
  • Medical Informatics (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Evolutionary Computation (AREA)
  • Health & Medical Sciences (AREA)
  • Artificial Intelligence (AREA)
  • Databases & Information Systems (AREA)
  • Business, Economics & Management (AREA)
  • Game Theory and Decision Science (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Software Systems (AREA)
  • Traffic Control Systems (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
  • Human Computer Interaction (AREA)
  • Navigation (AREA)

Description

本発明の実施形態は、一般的に自律走行車を動作させることに関するものである。より具体的に、本発明の実施形態は、自律走行車に対する路面摩擦を決定することに関するものである。
自律モード(例えば、無人運転)で走行している車両は、搭乗者、特に運転者を運転に関連する担当事項の一部を軽減することができる。自律モードで動作する際、車両は車載センサーを用いて様々な場所へ案内されることができ、それによりヒューマン・インタラクションの最も少ない場合、又は乗客なしの場合に走行することを可能にさせる。
運動計画及び制御は、自律走行において重要な動作である。しかし、従来の運動計画動作は、異なるタイプの車両の機能の差を考慮せず、主に経路の曲率(curvature)と速度から与えられた経路を完了する難しさを推定する。同一の運動計画及び制御があらゆるタイプの車両に適用されるが、これは一部状況では正確で順調でないことがある。
また、路面摩擦は、自律走行で車両経路制御を高めるのに重要である。しかし、直接的な測定方法を利用して路面摩擦を決定することは難しい。
本開示の実施形態は、自律走行車を作動させるためのコンピューターで実現する方法、不揮発性機械可読媒体及びデータ処理システムを提供する。
本開示の一態様によると、自律走行車を操作するためのコンピュータ実施方法を提供し、この方法は、出発の位置から目的地の位置まで自律走行車(ADV)を走行させるための計画データを受信するステップと、前記計画データに基づいて、一連の制御命令を生成するステップであって、前記制御命令は、前記出発の位置から前記目的地の位置までの複数の時点で適用されるステップと、コスト関数を、前記制御命令、現在行程で推定される第1の路面摩擦、及び前記出発の位置から前記目的地の位置までの前の行程の間で推定された第2の路面摩擦に適用して、コストを算出するステップと、前記コストを最小にするように、前記前の行程の前の終了コストを考慮して、前記コスト関数を利用して前記現在行程の第1の路面摩擦を推定するステップと、を含む。
本開示の他の態様によると、コマンドを記憶し、前記コマンドがプロセッサにより実行されるときに、前記プロセッサに動作を実行させる、不揮発性機械読み取り可能な媒体を提供し、前記動作は、出発の位置から目的地の位置まで自律走行車(ADV)を走行させるための計画データを受信することと、前記計画データに基づいて、一連の制御命令を生成することであって、前記制御命令は、前記出発の位置から前記目的地の位置までの複数の時点で適用されることと、コスト関数を、前記制御命令、現在行程で推定される第1の路面摩擦、及び前記出発の位置から前記目的地の位置までの前の行程の間で推定された第2の路面摩擦に適用して、コストを算出することと、前記コストを最小にするように、前記前の行程の前の終了コストを考慮して、前記コスト関数を利用して前記現在行程の第1の路面摩擦を推定することと、を含む。
本開示のもう一つの態様によると、プロセッサと、前記プロセッサに連結されてコマンドを記憶するメモリと、を含み、前記コマンドが前記プロセッサによって実行されるとき、前記プロセッサに動作を実行させる、データ処理システムであって、前記動作は、出発の位置から目的地の位置まで自律走行車(ADV)を走行させるための計画データを受信することと、
前記計画データに基づいて、一連の制御命令を生成することであって、前記制御命令は、前記出発の位置から前記目的地の位置までの複数の時点で適用されることと、
コスト関数を、前記制御命令、現在行程で推定される第1の路面摩擦及び前記出発の位置から前記目的地の位置までの前の行程の間で推定された第2の路面摩擦に適用して、コストを算出することと、
前記コストを最小にするように、前記前の行程の前の終了コストを考慮し、前記コスト関数を利用して前記現在行程の第1の路面摩擦を推定することと、を含む。
本発明の実施形態は図面の各図において限定的ではなく例示的な形態で示され、図面における同じ図面符号が類似した素子を示す。
本発明の一つの実施形態にかかるネットワークシステムを示すブロック図である。 本発明の一つの実施形態にかかる自律走行車の一例を示すブロック図である。 本発明の一つの実施形態にかかる自律走行車とともに利用される感知及び計画システムの一例を示すブロック図である。 本発明の一つの実施形態にかかるモデル予測コントローラの一例を示すブロック図である。 本発明の一つの実施形態にかかる路面摩擦を推定するプロセスを示すトランザクション図(transactional diagram)である。 本発明の一つの実施形態にかかる路面摩擦を推定するプロセスを示すフローチャートである。 本発明の他の実施形態にかかる路面摩擦を推定するプロセスを示すフローチャートである。 一つの実施形態にかかるデータ処理システムを示すブロック図である。
以下、説明の詳細を参照しながら、本発明の様々な実施形態及び態様を説明し、図面は、前記様々な実施形態を示す。以下の説明及び図面は、本発明を説明するためのものであり、本発明を限定するものではない。本発明の様々な実施形態を完全に理解するために、多数の特定の詳細を説明する。なお、いくつかの例では、本発明の実施形態に対する簡単な説明を提供するために、周知又は従来技術の詳細について説明していない。
本明細書において「一つの実施形態」又は「実施形態」の記載は、当該実施形態と組み合わせて説明された特定特徴、構造又は特性が本発明の少なくとも一つの実施形態に含まれてもよいことを意味している。語句「一つの実施形態では」は、本明細書全体において同一つの実施形態を指すとは限らない。
日常的な通勤において、運転者は、一般的に、家と職場という二つの固定場所の間を定期的に移動する。したがって、彼らは、ほぼ同一の出発の位置と目的地の位置である。いくつかの実施形態によれば、学習に基づくモデル予測制御(MPC)メカニズムは、自律走行の制御アルゴリズムを最適化するため、路面摩擦のような未知のパラメータの推定を学習して適応的にアップデートすることに適用される。出発の位置から目的地の位置までの各行程について、路面摩擦は出発の位置から目的地の位置の間の経路に沿って異なる時点で送信された制御命令(例えば、スロットル、ブレーキ、ステアリング命令)に応答する車両反応(例えば、位置、速度、方向)に基づいて推定される。
現在行程の路面摩擦はMPC方法を利用して、同一の出発の位置から目的地の位置までの前の行程中に推定された路面摩擦に基づいて推定される。コストは、各行程に対して現在行程と最後の行程の路面摩擦の間の差に基づいてコスト関数を利用して算出される。最後の二回の行程のコストの差が所定の閾値以下になるまで、路面摩擦は、出発の位置から目的地の位置までの各行程について繰り返し推定される。この時点で、最後に推定された路面摩擦が、出発の位置から目的地の位置の間の道路に対する最終路面摩擦に指定される。路面摩擦は、出発の位置から目的地の位置まで自律走行車を走行させるための目的で、後続制御命令の決定又は調整に適用されることができる。
一つの実施形態において、計画データは、例えば、計画モジュールから受信され、自律走行車(ADV)を出発の位置から目的地の位置まで走行させる。これに応答して、一連の制御命令が計画データに基づいて生成され、当該制御命令は、出発の位置から目的地の位置までの異なる時点に適用される。コスト関数を制御命令、現在行程で推定される第1の路面摩擦、及び出発の位置から目的地の位置への前の行程で推定された第2の路面摩擦に適用することでコストを算出する。前の行程の終了コストを考慮しながら、コスト関数を利用して、コストが最小となるように、現在行程の第1の路面摩擦を推定する。終了コストは、前の行程の目的地で算出されたコストである。
図1は本発明に係る一つの実施形態に係る自律走行車のネットワーク配置を示すブロック図である。図1を参照して、ネットワーク配置100はネットワーク102によって一つ以上のサーバ103〜104に通信可能に接続することができる自律走行車101を含む。一つの自律走行車を示すが、ネットワーク102によって複数の自律走行車は互いに接続され、及び/又はサーバ103〜104に接続されることができる。ネットワーク102は、任意のタイプのネットワーク、例えば有線又は無線のローカルエリアネットワーク(LAN)、例えばインターネットのような広域ネットワーク(WAN)、セルラーネットワーク、衛星ネットワーク又はその組み合わせであってもよい。サーバ103〜104は任意のタイプのサーバ又はサーバクラスタ、例えばWebサーバ又はクラウドサーバ、アプリケーションサーバ、バックエンドサーバ又はその組み合わせであってもよい。サーバ103〜104は、データ分析サーバ、内容サーバ、交通情報サーバ、地図(マップ)及び興味のあるポイント(MPOI)サーバ又は位置サーバ等であってもよい。
自律走行車とは、運転手からの入力が非常に少ない又はない場合に案内して環境を通過する自動運転モードに設置される車両である。自律走行車は、車両が走行している環境にかかる情報を検出するように配置される一つまたは複数のセンサを含むセンサシステムを備える。車両及びその関連しているコントローラが、検出された情報で案内して環境を通過する。自律走行車101が手動モード、完全自動運転モードまたは部分自動運転モードで運転されることできる。
一つの実施形態において、自律走行車101は、感知及び計画システム110と、車両制御システム111と、無線通信システム112と、ユーザインターフェースシステム113と、インフォテイメントシステム114と、センサシステム115とを含むが、これらに制限されない。自律走行車101は、通常の車両に含まれるある一般的な構成要素(部材)、例えばエンジン、車輪、ハンドル、変速器等をさらに含んでもよく、前記構成要素は、車両制御システム111及び/又は感知及び計画システム110により多種の通信信号及び/又はコマンド(例えば加速信号又はコマンド、減速信号又はコマンド、ステアリング信号又はコマンド、ブレーキ信号又はコマンド等)を使用して制御されることができる。
構成要素110〜115は、インターコネクト、バス、ネットワーク又はそれらの組み合わせを介して互いに通信可能に接続することができる。例えば、構成要素110〜115は、コントローラローカルエリアネットワーク(CAN)バスを介して互いに通信可能に接続することができる。CANバスは、マイクロコントローラ及び装置がホストコンピューターのない応用において互いに通信することを許可するような車両バス標準として設計される。それは、最初に自動車内における複数の電線のために設計されたメッセージに基づくプロトコルであるが、他のたくさんの環境(状況)にも用いられる。
いま、図2を参照して、一つの実施形態において、センサシステム115は、一つ以上のカメラ211と、全地球測位システム(GPS)ユニット212と、慣性計測ユニット(IMU)213と、レーダーユニット214と、光検出及び測距(LIDAR)ユニット215とを含むが、これらに制限されない。GPSシステム212は、送受信機を含んでもよく、前記送受信機は、自律走行車の位置に関する情報を提供するように操作されることができる。IMUユニット213は、慣性加速度に基づいて自律走行車の位置及び方向変化を感知することができる。レーダーユニット214は、無線信号を利用して自律走行車のローカル環境内の対象を感知するシステムを示すことができる。いくつかの実施形態において、対象を感知する以外、レーダーユニット214は、さらに対象の速度及び/又は走行方向を感知することができる。LIDARユニット215はレーザを使用して自律走行車の所在する環境における対象を感知することができる。その他のシステム構成要素以外、LIDARユニット215は一つ以上のレーザ光源、レーザースキャナ及び一つ以上の検出器をさらに含んでもよい。カメラ211は、自律走行車の周辺環境の画像をキャプチャするための一つ以上の装置を含んでもよい。カメラ211は、スチルカメラ及び/又はビデオカメラであってもよい。カメラは、例えば回転及び/又は傾斜のプラットフォームに取り付けられる、機械的に移動可能なものであってもよい。
センサシステム115は、その他のセンサ、例えばソナーセンサ、赤外線センサ、ステアリングセンサ、スロットルセンサ、ブレーキセンサ、及びオーディオセンサ(例えばマイクロフォン)をさらに含んでもよい。オーディオセンサは、自律走行車周辺の環境から音をキャプチャするように配置されてもよい。ステアリングセンサは、ハンドル、車両の車輪又はその組み合わせのステアリング角を感知するように配置されることができる。スロットルセンサ及びブレーキセンサは、それぞれ車両のスロットル位置及びブレーキ位置を感知する。いくつかの場合、スロットルセンサ及びブレーキセンサは、集積型スロットル/ブレーキセンサに一体化されてもよい。
一つの実施形態において、車両制御システム111は、ステアリングユニット201と、スロットルユニット202(加速ユニットとも呼ばれる)と、ブレーキユニット203とを含むが、これらに制限されない。ステアリングユニット201は、車両の方向又は走行方向を調整することに用いられる。スロットルユニット202は、モーター又はエンジンの速度を制御して、さらに車両の速度及び加速度を制御することに用いられる。ブレーキユニット203は、摩擦を提供することによって車両の車輪又はタイヤをスローダウンして車両を減速させることに用いられる。注意すべきなのは、図2に示すような構成要素はハードウェア、ソフトウェア又はその組み合わせで実現されることができる。
図1を再び参照して、無線通信システム112は、自律走行車101と、例えば装置、センサ、その他の車両等の外部システムとの間に通信することを可能にさせる。例えば、無線通信システム112は、一つ以上の装置に直接に又は通信ネットワークを介して無線通信し、例えばネットワーク102によってサーバ103〜104に通信できる。無線通信システム112は、任意のセルラー通信ネットワーク又は無線ローカルエリアネットワーク(WLAN)(例えばWiFi)を使用して他の構成要素やシステムに通信できる。無線通信システム112は、例えば赤外線リンク、ブルートゥース等を使用して装置(例えば、乗客の移動装置、表示装置、車両101内のスピーカー)に直接に通信できる。ユーザインターフェースシステム113は、車両101内で実行される周辺装置の一部であってもよく、例えばキーボード、タッチスクリーンディスプレイ装置、マイクロフォン、及びスピーカー等を含む
自律走行車101の一部又は全ての機能は、特に自動運転モードで操作する場合、感知及び計画システム110により制御されたり管理されたりすることができる。感知及び計画システム110は、必要なハードウェア(例えば、プロセッサ、メモリ、記憶装置)、及びソフトウェア(例えば、オペレーティングシステム、計画及びルーティングプログラム)を含み、センサシステム115、車両制御システム111、無線通信システム112、及び/又はユーザインターフェースシステム113から情報を受信し、受信された情報を処理し、出発地から目的地までのルートや経路を計画し、そして計画及び制御情報に基づいて車両101を運転させる。あるいは、感知及び計画システム110と車両制御システム111とは一体化されてもよい。
例えば、乗客とするユーザは、例えばユーザインターフェースによって旅程の出発位置及び目的位置を指定することができる。感知及び計画システム110は旅程関連データを取得する。例えば、感知及び計画システム110は、MPOIサーバから位置及びルート情報を取得することができ、前記MPOIサーバはサーバ103〜104の一部であってもよい。位置サーバは、位置サービスを提供し、かつ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は、異なる時点での環境記述情報、例えば、ルート(出発地及び目的地の位置)、MPOIs、道路条件、天気条件等を更に含む。
運転統計情報123に基づいて、機器学習エンジン122は、様々な目的で規則、アルゴリズム及び/又は予測モデルのセット124を実行したり、訓練させる。一つの実施形態で、路面摩擦を決定するためのMPCモデルは、同一のタイプ又は類似するタイプの車両の運転統計情報に基づいて、特定タイプの自律走行車に対して生成される。MPCモデルの係数またはゲインは、車両が多様な運転条件で運転者によって運転されている間にキャプチャー且つ記録された運転統計情報123に基づいて決定されることができる。一つの実施形態で、MPCモデルは、路面摩擦をリアルタイムで決定するために、コスト関数を含み、または、コスト関数を呼び出すことができる。反復的な行程の間のコストを最小にするように路面摩擦は出発の位置から目的地の位置までの反復的な行程の間のコストに基づいて決定され、決定されることができる。MPCモデル及び対応するコスト関数は、対応タイプの車両上にアップロードされて、リアルタイムで特定の道路の路面摩擦を決定するために適用される。
図3は、本発明の1実施形態にかかる自動車両とともに使用される感知及び計画システムの例を示すブロック図である。システム300は、図1における自律走行車101の一部として実現されることができるが、感知及び計画システム110、車両制御システム111、及びセンサシステム115に限定されない。図3を参照し、感知及び計画システム110は、位置決めモジュール301と、感知モジュール302と、決定モジュール303と、計画モジュール304と、制御モジュール305とを含むが、それらに限定されない。
モジュール301〜305の一部またはすべては、ソフトウェア、ハードウェア、またはそれらの組み合わせによって実現されてもよい。例えば、これらのモジュールが不揮発性の記憶装置352にインストールされ、メモリ351にロードされて一つまたは複数のプロセッサ(図示せず)によって実行されてもよい。一部またはすべてのモジュールは、図2に示す車両制御システム111における一部またはすべてのモジュールに通信可能に連結されたり、統合されたりしてもよい。また、モジュール301〜305の一部、一つの集積モジュールとして一体化されてもよい。
位置決めモジュール301(地図及びルーティングモジュールとも言われる)は、ユーザの旅程又はルートに関連する任意のデータを管理する。ユーザは、例えばユーザインターフェースを介してログインするとともに旅程の出発位置及び目的位置を指定してもよい。位置決めモジュール301は、旅程に関連するデータを取得するように、自律走行車300(システム)のその他の構成要素(例えば地図及びルート情報311)と通信する。例えば、位置決めモジュール301は、位置サーバと、地図及びPOI(MPOI)サーバから位置及びルート情報を取得することができる。位置サーバは、位置サービスを提供し、かつMPOIサーバは、地図サービスとある位置のPOIとを提供し、地図及びルート情報311の一部としてキャッシュされてもよい。自律走行車300がルートに沿って走行する期間に、位置決めモジュール301は、さらに交通情報システムやサーバからリアルタイム交通情報を取得することができる。
センサシステム115により提供されたセンサデータ、及び位置決めモジュール301により得られた位置決め情報に基づいて、感知モジュール302は周辺環境に対する感知を決定する。感知情報は、普通の運転者が自分で運転している車両周辺から感知したもの(状況)を示すことができる。感知情報例えば対象形式で現される車線配置(例えば、ストレート又はカーブ)、トラフィック信号、他の車両の相対位置、歩行者、建築物、横断歩道又はその他の交通関連標識(例えば、停止標識、譲り標識)などを含んでもよい。
感知モジュール302は、コンピュータビジョンシステム又はコンピュータビジョンシステムの機能を含んでもよく、自律走行車環境における対象及び/又は特徴を認識するように、一つ以上のカメラによりキャプチャされた画像を処理及び分析することに用いられる。前記対象は交通信号、車道の境界線、他の車両、歩行者及び/又は障害物等を含んでもよい。コンピュータビジョンシステムは、対象認識アルゴリズム、ビデオトラッキング及びその他のコンピュータビジョン技術を使用することができる。いくつかの実施形態において、コンピュータビジョンシステムは、環境の地図を描き、対象を追跡し、かつ対象の速度を推定することなどができる。感知モジュール302は、その他のセンサ(例えばレーダー及び/又はLIDAR)により提供されたその他のセンサデータに基づいて対象を検出することもできる。
それぞれの対象に対して、決定モジュール303は、如何に対象を処理する決定をする。例えば、特定な対象(例えば、交差ルートにおける他の車両)及び対象を記述するメタデータ(例えば、速度、方向、ステアリング角)に対して、決定モジュール303は、遇う対象に如何に対応する(例えば、追い越し、道譲り、停止、通過)ことを決定する。決定モジュール303は、不揮発性の記憶装置352(図示せず)に記憶されてもよい1セットのルール(例えば交通ルール又は運転ルール312)に基づいてこのような決定をすることができる。
感知したそれぞれ対象に対する決定に基づいて、計画モジュール304は、自律走行車のためにルート又は経路及び運転パラメータ(例えば、距離、速度及び/又はステアリング角)を計画する。すなわち、所定対象に対して、決定モジュール303は前記対象に対して如何に対応するかを決定し、計画モジュール304は如何に実行するかを決定する。例えば、所定対象に対して、決定モジュール303は、前記対象を追い越すことを決定することができ、計画モジュール304は、前記対象の左側に追い越すか、右側に追い越すかを決定することができる。計画モジュール304は、計画及び制御データを生成し、車両300が次の移動周期(例えば、次のルート/経路セグメント)に如何に移動するかを記述する情報を含む。例えば、計画及び制御データは車両300が30マイル/時間(mph)の速度で10メートル移動し、次に25mphの速度で右車線まで変わることを指示することができる。
計画及び制御データに基づいて、制御モジュール305は計画及び制御データにより定義されたルート又は経路に基づいて、車両制御システム111へ適切なコマンド又は信号を送信することによって自律走行車を制御及び運転する。前記ルート又は経路に沿って違う場所で適時に適切な車両設置又は運転パラメータ(例えば、スロットル、ブレーキ及びステアリングコマンド)を使用して車両を第1点から第2点まで運転するように、計画及び制御データは十分な情報を含む。
注意すべきなのは、決定モジュール303及び計画モジュール304は、集積モジュールに一体化されてもよい。決定モジュール303/計画モジュール304は、自律走行車の運転経路を決定するために、ナビゲーションシステム又はナビゲーションシステムの機能を含んでもよい。例えば、ナビゲーションシステムは、自律走行車が以下の経路に沿って移動することを実現するための一連の速度及びディレクショナ進行方向を決定することができ、前記経路は、自律走行車を総体的に最終目的位置を向けて通じる車線経路に進ませると同時に、感知された障害物を大体避けることができる。目的地はユーザインターフェースシステム113により実現されたユーザ入力に基づいて設定されることができる。ナビゲーションシステムは、自律走行車が走行していると同時に走行経路を動的に更新することができる。ナビゲーションシステムは、自律走行車用の走行経路を決定するように、GPSシステム及び一つ以上の地図からのデータを合併することができる。
決定モジュール303/計画モジュール304は、自律走行車環境における潜在障害物を、認識・評価・回避又はその他の方式で迂回するために、衝突回避システム又は衝突回避システムの機能をさらに含んでもよい。例えば、衝突回避システムは、以下の方式によって自律走行車のナビゲーションにおける変更を実現することができ、制御システム111の中の一つ以上のサブシステムを動作してターン操縦、ステアリング操縦、ブレーキ操縦等を採る。衝突回避システムは、周辺の交通モード、道路状況等に基づいて障害物を回避可能な操縦を自動的に決定することができる。衝突回避システムは、その他のセンサシステムは、自律走行車がターンして入ろうとする隣接領域における車両、建築障害物等が検出された際にターン操縦を採らないように配置できる。衝突回避システムは、使用可能でありかつ自律走行車の乗員の安全性を最大化させる操縦を自動的に選択することができる。衝突回避システムは、自律走行車の乗員室内で最小の加速度を出現させることが予測された回避操縦を選択することができる。
一つの実施形態によれば、制御モジュール305は、2つの固定された又はあらかじめ設定された位置の間の道路の路面摩擦を決定するため、MPCコントローラ310を含む。この二つの位置は、一般的に、運転者が定期的に往復して走行する通勤経路の出発の位置や目的地の位置であることができる。MPCコントローラ310は二つの位置の間の反復的な行程から繰り返して収集された運転統計情報に基づいて路面摩擦を推定する。一つまたは複数の前の行程で推定された路面摩擦を考慮し、現在行程の路面摩擦は、現在行程の運転統計情報に基づいて推定される。
一つの実施形態において、コスト関数315のようなコスト関数は、運転統計情報と推定された路面摩擦とに基づいてコストを算出するために適用され、現在行程のコストと最後の行程のコストの間の差が最小となるようにする。このプロセスは、この二つの位置の間を走行する各行程について繰り返し実行され、同一の位置の間の最後の二つの行程のコストが収束するまで、つまり、最も近い二回の行程のコスト間の差があらかじめ決められた閾値の以下になるまで、繰り返し推定して調整される。この時点で、最新推定された路面摩擦は、道路の最終路面摩擦として指定される。その後に、制御命令は最終路面摩擦を考慮して生成され、送信される。MPCコントローラ310及びコスト関数315は、図1のデータ分析システム103のようなデータ分析システムによってオフラインで生成され、モデリングされることができる。
図4は、本発明の一つの実施形態にかかるモデル予測制御器の一例を示すブロック図である。図4を参照して、MPCコントローラ310は摩擦決定モジュール401及びコスト算出機402を含み、MPCコントローラ310は制御モジュール305の一部である。計画モジュール304から受信された計画データに応答して、制御モジュール305は一つ以上の制御命令(例えば、スロットルやブレーキやステアリング命令)を車両のプラットフォームまたはシャシ403に生成して送信して、計画モジュール304によって計画された経路によって車両を運転する。車両応答(例えば、位置、速度、方向)は、異なる時点でキャプチャーして記録されることができ、応答は後続計画及び制御命令を決定するために制御モジュール及び/又は計画モジュールにフィードバックされる。
一つの実施形態によれば、MPCコントローラ310は、学習に基づくモデル予測制御方法を適用し、自律走行の制御アルゴリズムを最適化するため、路面摩擦の推定を学習して適応的にアップデートする。出発の位置から目的地の位置までの各行程について、路面摩擦は出発の位置と目的地の位置の間の経路に沿って異なる時点に送信された制御命令(例えば、スロットル、ブレーキ、ステアリング命令)に応答する車両反応(例えば、位置、速度、方向)に基づいて推定される。
MPCコントローラ310の摩擦決定モジュール401は、同一の出発の位置から目的地の位置への前の行程の間で推定された路面摩擦に基づき、現在行程の路面摩擦を推定する。推定された路面摩擦は、路面摩擦データ411の一部として推定して記録され、ここで、路面摩擦データ411はハードディスクのような不揮発性記憶装置に記憶されることができる。コスト算出機は、一つ以上のコスト関数315を利用し、現在行程と前の行程の間の路面摩擦の差に基づき、各行程に対するコストを算出する。上記のとおり、コスト関数315は、オフラインで生成され、モデリングされることができる。コストは、さらに、不揮発性記憶装置に記憶された終了コスト412の一部として記録される前の行程の終了コストを考慮して算出されることができる。「終了コスト」という用語は、コスト関数を利用して特定の行程の目的地の位置で算出されたコストを示す。
最後の二回の行程のコストの差が所定の閾値の以下になるまで、路面摩擦は出発の位置から目的地の位置までの各行程についてMPCコントローラ310によって繰り返し推定される。この時点で、最後に推定された路面摩擦が今後の出発の位置と目的地の位置の間の道路に対する最終路面摩擦に指定される。路面摩擦は、出発の位置から目的地の位置まで自律走行車を走行させるための目的で後続制御命令を決定するのに適用されることができる。
一つの実施形態において、計画データは、例えば、計画モジュール304から受信されて自律走行車(ADV)を出発の位置から目的地の位置まで走行させる。これに応答して、一連の制御命令が計画データに基づいて制御モジュールによって生成され、ここの制御命令は、出発の位置から目的地の位置までの異なる時点で適用される。MPCコントローラのコスト算出機402は、コスト関数315を、制御命令、現在行程で推定される第1の路面摩擦、及び出発の位置から目的地の位置への前の行程で推定された第2の路面摩擦(例えば、摩擦データ411)に適用することにより、コストを算出する。摩擦決定モジュール401はコストを最小にするように前の行程の前の終了コスト412を考慮して、コスト関数を利用して現在行程の第1の路面摩擦を推定する。終了コスト412は現在行程の目的地で算出されたコストである。
図5は、本発明の一つの実施形態にかかる路面摩擦を推定するプロセスを示すトランザクション図(transactional diagram)である。図5を参照すると、車両が2つの既知の位置(この例では、位置501と位置502)の間で繰り返し走行する際、前の運転統計情報は路面摩擦を推定するのに適用されることができる。例えば、位置501は家の位置であってもよく、位置502は特定ユーザの職場であってもよい。ユーザは、車を位置501と502との間で毎日定期的に運転する。計画モジュールからの計画データが受信されて、位置501から位置502に車を運転させる際、指示された位置501から位置502までの経路に沿って、(時間チック1、2、...k、...、n−1のような)異なる時点で車両に適用される一連の制御命令が生成される。
各時点について、車両応答(例えば、位置、速度や方向)は、例えば前の時点又は時間スロット(命令サイクルとも称される)で送信された制御命令に応答して測定して記録される。また、各時点に対応する道路セグメントと関連する路面摩擦は、同一時点に対する前の行程から推定された摩擦を考慮して推定される。コスト関数は、位置501と位置502の間において現在行程で推定された摩擦と、前の行程で推定された摩擦との差に基づいてコストを算出するのに適用される。上記の差は、二回の繰り返し行程の間の、路面摩擦を推定する誤差を示す。目標は、(誤差を示す)コストを最小にするように、現在行程の路面摩擦を推定することである。したがって、路面摩擦の推定は各行程について、実際の路面摩擦にさらに近づく。行程の数が増加するにつれて、繰り返し実行される路面摩擦の推定は、実際路面摩擦を示すことに十分に近接する。
図5を再び参照すると、行程511が位置501から位置502への第1の全行程であると仮定すると、システムは、時間または命令サイクル1ないしNで表示される各道路セグメントに初期路面摩擦を初期設定し、これは道路セグメント摩擦と呼ばれる。各命令サイクルについて、命令サイクル期間に送信された制御命令(例えば、スロットル、ブレーキ、ステアリング)に応答し、車両からの応答(例えば、位置、速度、方向)が測定される。命令サイクルは制御命令が送信される周期的な期間を示している。例えば、制御命令が0.1秒毎に送信されることができる。0.1秒の時間周期が命令サイクルと呼ばれる。
一般的に、制御命令に応答する車両からの応答は、路面摩擦の影響を受ける。行程511に対するコストは、制御命令、車両からの応答、現在行程の推定された路面摩擦(例えば、初期路面摩擦)、及び前の行程で推定された路面摩擦(例えば、前の行程で決定された「実際の」摩擦)を考慮してコスト関数(コスト関数Jと表記される)を利用して算出される。この例で、行程511は第1の全行程なので、システムは、所定の初期値を割り当てられる。一つの実施形態で、トライ道路(try road)に対する通常の摩擦は約0.9となることに対し、路面摩擦は大きな値(例えば、2)に初期割り当てられることができる。行程の路面摩擦は、位置501と位置502の間の道路セグメントに関連する複数の道路セグメント摩擦で示される。各道路セグメントは、時点または命令サイクルの一つに対応する。時点または命令サイクル1ないしNに対する道路セグメント摩擦は、コストを最小にするように推定されたり、調整される。コストは、行程に対する終了のコストとも呼ばれる。この例で、終了コストQ0は行程511に対して算出して維持される。
車両が位置501から位置502まで再び走行するとき(この例では行程512)、前の行程即ち行程511で推定された路面摩擦に基づいて行程に対する路面摩擦を推定するために、上記プロセスを繰り返し行う。図5に示されるように、行程512の場合、コスト関数は、前の行程(例えば、行程511)の終了コストであるJ+Q0を基にしている。行程512に対するコストは、行程511の終了コストQ0を考慮してコスト関数を利用して算出される。行程511の終了コストを考慮したコスト関数のコストを最小にするように行程512に対する路面摩擦が推定される。具体的に、行程512に対する路面摩擦は、行程512の間で推定された道路セグメント摩擦と、この例では、行程511期間において対応する道路セグメント1ないしNについて推定された、対応する道路セグメント摩擦との差に基づいて推定されることができる。コストは、現在行程で推定された道路セグメント摩擦と前の行程で推定された道路セグメント摩擦との誤差の和または総計を示す。
前記処理は、現在行程の終了コストとこの前の行程の終了コストの間の差が収束するまで繰り返し行われる。つまり、前記過程は、現在行程と最後の行程の間の終了コストの差が所定の閾値の以下になるまで繰り返し実行される。このような状況で、最新に推定された最新行程の路面摩擦が実際の路面摩擦を表す推定路面摩擦になる。前のコストや路面摩擦推定をフィードバックとして考慮して、コストプロセスを繰り返し実行することにより、推定の正確性を時間につれて向上させることができる。
コスト関数は、MPCコントローラ310の一部としてのMPCアルゴリズムまたはモデルに基づいて生成されて、モデリングされることができる。モデル予測制御器は、プロセスの動的モデル、ほとんどの場合は線形経験(linear empirical)モデルに依存する。MPCの主な利点は、未来のタイムスロットを考慮しながら現在のタイムスロットを最適化することができるということである。これは有限の時間範囲(finite time−horizon)を最適化することによって達成されるが、現在のタイムスロットだけを具現する。MPCは未来の事件を予測する能力を持っており、それに応じて制御動作をとることができる。MPCモデルは独立変数の変化によるモデリングされたシステムの従属変数の変化を予測する。コントローラが調整できない独立変数は障害(disturbances)として使われる。このようなプロセスにおける従属変数は制御目標またはプロセス制約を示す他の測定値である。このような変更は独立変数と従属変数の双方に対する制約を遵守しながら、従属変数を目標に近く維持するように算出される。
一つの実施形態で、コスト関数(J)は、以下のように具現され:

Figure 0006539408


ここで、eは現在行程(J)期間の時点(k)に対応する路面摩擦と、現在行程に対する推定路面摩擦(例えば、前の行程を基づいて決定された路面摩擦)との誤差を示す。
Figure 0006539408

は、車が目的地に到達したかどうかを示す定数である。車両が目的地に到達すれば、
Figure 0006539408

を1とすることができる。そうでなければ0とする。Qj−1は、前の行程(j−1)の終了コストを示す。
従来のMPC関数は、前の行程の終了コストを考慮しないのに対して、上記のMPCコスト関数は、前の行程の終了コストを考慮するため、拡張(augmented)MPCコスト関数と呼ばれる。ここで、名称上(nominal)でコスト関数と呼ばれる従来のMPCコスト関数は、前の行程Qj−1の終了コストを考慮せず、先頭の部分のみを含み、即ち、
Figure 0006539408
一つの実施形態で、上記のMPCコスト関数は、次の公式で示すことができる。
Figure 0006539408

ここで、qkは時点(k)での車両の状態を示す状態の行列である。
Figure 0006539408

はqkの転置(transpose)を示す。
一つの実施形態で、Q={x、y、v、s、e}。xとyは、時間(k)での車両の位置、例えば車両の緯度と經度を示す。vは、時間(k)での車両速度を示す。skは、時間(k)での道路セグメントに対応する推定路面摩擦を示す。eは現在行程と最後行程で推定された、時間kに対応する道路セグメントの路面摩擦の誤差を示す。Mは状態加重行列(state weighting matrix)(例えば、5x5行列)である。μkは推定摩擦skを考慮して時間kに送信された制御命令を表す入力行列を示す。
Figure 0006539408

はμkの転置を示す。一つの実施形態で、μ={α、θ、sk+1−s}であり、ここで、αkは速度制御命令(例えば、スロットルまたはブレーキ命令)を示し、θはステアリング命令を示す。sk+1−sは同一の行程内でタイムスロット(k+1)と、タイムスロット(k)で決定された路面摩擦との差を示す。Nは、入力加重行列(例えば、3x3行列)である。M及びNはデータ分析システム103のようなデータ分析システムによってあらかじめ決定されることができる。この例で、MPCモデルの独立変数はμkである。従属変数は、車両の位置、方向/角度、速度や回転角速度などである。
図6は本発明の一つの実施形態にかかる路面摩擦を推定するプロセスを示すフローチャートである。プロセス600は、ソフトウェア、ハードウェア、又はこれらの組み合わせを含む処理ロジックによって実行されることができる。例えば、プロセス600は、図3のMPCコントローラ310によって実行されることができる。図6を参照すれば、操作601で、処理ロジックは出発の位置から目的地の位置に自律走行車(ADV)を走行させるための計画データを受信する。計画データに基づいて、操作602で、処理ロジックは出発の位置から目的地の位置までの経路に沿って異なる時点または命令サイクルに適用される一連の制御命令(例えば、スロットル、ブレーキ、ステアリング命令)を生成する。操作603で、処理ロジックは、コスト関数を、制御命令、現在行程で推定される第1の路面摩擦、及び出発の位置から目的地の位置への前の行程で推定された第2の路面摩擦に適用することによりコストを算出する。操作604で、処理ロジックは、コストを最小にするように、出発の位置と目的地の位置の間の前の行程の終了コストを考慮して、コスト関数を利用して現在行程に対する第1の路面摩擦を推定したり、調整する。
図7は、本発明の他の一つの実施形態にかかる路面摩擦を推定するプロセスを示すフローチャートである。プロセス700は、ソフトウェア、ハードウェア、又はこれらの組み合わせを含めることができる処理ロジックによって実行されることができる。例えば、プロセス700は、図3のMPCコントローラ310によって実行されることができる。図7を参照すれば、操作701で、処理ロジックは出発の位置から目的地の位置までの経路に沿って異なる時点または命令サイクルに適用される一連の制御命令(例えば、スロットル、ブレーキ、ステアリング命令)を生成する。操作702で、処理ロジックは、コスト関数を、制御命令、前の制御命令に対する車両応答、現在行程で推定される第1の路面摩擦、及び出発の位置から目的地の位置への前の行程で推定された第2の路面摩擦に適用することでコストを算出する。操作703で、処理ロジックは、コストを最小にするように、出発の位置と目的地の位置の間の前の行程の終了コストを考慮して、コスト関数を利用して現在行程に対する第1の路面摩擦を推定したり、調整する。操作704で、処理ロジックは、現在行程の終了コストと前の行程の終了コストとを比較してコストが収束されるかを判断する。操作705で、現在行程及び前の行程のコストが収束する場合、最新推定された路面摩擦が最終推定(例えば、実際に)路面摩擦として指定される。そうでなければ、操作701〜704は、出発の位置から目的地の位置への後続の行程で繰り返し実行されることができる。
注意すべきなのは、前記の示されたとともに記述された一部又は全部の構成要素は、ソフトウェア、ハードウェア又はその組み合わせで実現されることができる。例えば、このような構成要素は、永続記憶装置にインストールされるとともに記憶されたソフトウェアとして実現されてもよく、前記ソフトウェアは、本出願にわたって記載の手順又は動作を実施するように、プロセッサ(図示せず)でメモリにロードして実行されてもよい。あるいは、このような構成要素は、(集積回路(例えば特定用途向けIC又はASIC)、デジタル信号プロセッサ(DSP)、又はフィールドプログラマブルゲートアレイ(FPGA))にプログラミングされ又は嵌め込みされた専用ハードウェアにおける実行可能なコードとして実現されてもよく、前記実行可能なコードは、アプリケーションからの対応するドライバープログラム及び/又はオペレーティングシステムによってアクセスされてもよい。なお、このような構成要素は、プロセッサ又はプロセッサコアにおける特定のハードウェアロジックとして実現されてもよく、ソフトウェア構成要素が一つ以上の特定コマンドによってアクセス可能なコマンドセットの一部とする。
図8は、本出願の一つの実施形態と組み合わせて使用されるデータ処理システムを例示的に示すブロック図である。例えば、システム1500は、上記プロセス又は方法のいずれか(例えば、図1の感知及び計画システム110、及びサーバ103〜104のいずれか)を実行する上記任意のデータ処理システムを示してもよい。システム1500は、多数の異なる構成要素を含んでもよい。これらの構成要素は、集積回路(IC)、集積回路の一部、分散型電子装置又は回路基板に(例えばコンピュータシステムのマザーボード又はアドインカード)適用された他のモジュール、又は他の方式でコンピュータシステムのシャシーに組み込まれた構成要素として実現されることができる。
さらに、システム1500は、コンピュータシステムの多数の構成要素の高レベルビューを示すことを目的とする。しかしながら、いくつかの実現形態では、付加的構成要素が存在する場合があることを理解すべきである。また、他の実現形態において示される構成要素が異なる配置を有してもよい。システム1500は、デスクトップコンピュータ、ラップトップコンピュータ、タブレットコンピュータ、サーバ、携帯電話、メディアプレーヤー、パーソナルディジタルアシスタント(PDA)、スマート腕時計、パーソナルコミュニケーター、ゲーム装置、ネットワークルータ又はハブ、無線アクセスポイント(AP)又はリピーター、セットトップボックス、又はそれらの組合せを示してもよい。また、単一の機器又はシステムのみを示したが、用語「機器」又は「システム」は、さらに、独立又は共同で一つ(又は複数)のコマンドセットを実行することにより本明細書に説明される任意の1種又は複数種の方法を実行する機器又はシステムの任意のセットを含むことを理解すべきである。
一つの実施形態において、システム1500は、バス又は相互接続部材1510によって接続されたプロセッサ1501、メモリ1503及び装置1505〜1508を備える。プロセッサ1501は、単一のプロセッサコア又は複数のプロセッサコアを含む単一のプロセッサ又は複数のプロセッサを示してもよい。プロセッサ1501は、マイクロプロセッサ、中央処理装置(CPU)等のような一つ又は複数の汎用プロセッサを示してもよい。より具体的には、プロセッサ1501は、複雑コマンドセット計算(CISC)マイクロプロセッサ、縮小コマンドセットコンピュータ(RISC)マイクロプロセッサ、超長コマンド語(VLIW)マイクロプロセッサ、又は他のコマンドセットを実現するプロセッサ、又はコマンドセットの組合せを実現するプロセッサであってもよい。プロセッサ1501は、さらに、専用集積回路(ASIC)、セルラ又はベースバンドプロセッサ、フィールドプログラマブルゲートアレイ(FPGA)、デジタル信号プロセッサ(DSP)、グラフィックプロセッサ、ネットワークプロセッサ、通信プロセッサ、暗号プロセッサ、コプロセッサ、組み込みプロセッサのような一つ又は複数の専用プロセッサ、あるいはコマンド処理可能な任意の他のタイプのロジックであってもよい。
プロセッサ1501(超低電圧プロセッサのような低電力マルチコアプロセッサソケットであってもよい)は、前記システムの各種構成要素と通信するための主処理ユニット及び中央ハブとして用いられてもよい。このようなプロセッサは、システムオンチップ(SoC)として実現されることができる。プロセッサ1501は、コマンドを実行することにより本明細書に説明される動作及びステップを実行するためのコマンドを実行するように構成される。また、システム1500は、選択可能なグラフィックサブシステム1504と通信するグラフィックインターフェースをさらに含んでもよく、グラフィックサブシステム1504は、表示コントローラ、グラフィックプロセッサ及び/又は表示装置をさらに備えてもよい。
プロセッサ1501は、メモリ1503と通信してもよく、メモリ1503は、一つの実施形態において複数のメモリによって所定量のシステムメモリを提供する。メモリ1503は、ランダムアクセスメモリ(RAM)、動的RAM(DRAM)、シンクロナスDRAM(SDRAM)、静的RAM(SRAM)又は他のタイプのメモリのような一つ又は複数の揮発性記憶装置(又はメモリ)を備えてもよい。メモリ1503は、プロセッサ1501又は任意の他の装置により実行されるコマンド列を含む情報を記憶できる。例えば、複数種のオペレーティングシステム、装置ドライバー、ファームウェア(例えば、基本入出力システム又はBIOS)及び/又はアプリケーションの実行可能なコード及び/又はデータはメモリ1503にロードされて、プロセッサ1501により実行されてもよい。オペレーティングシステムは、ロボットオペレーティングシステム(ROS)、Microsoft(登録商標)会社からのWindows(登録商標)オペレーティングシステム、アップル会社からのMacOS(登録商標)/iOS(登録商標)、Google(登録商標)会社からのAndroid(登録商標)、Linux、Unix又は他のリアルタイム又は組み込みオペレーティングシステムのような任意のタイプのオペレーティングシステムであってもよい。
システム1500は、I/O装置、例えば装置1505〜1508をさらに備えてもよく、ネットワークインターフェース装置1505、選択可能な入力装置1506及び他の選択可能なI/O装置1507を備える。ネットワークインターフェース装置1505は、無線送受信機及び/又はネットワークインターフェースカード(NIC)を備えてもよい。前記無線送受信機は、WiFi送受信機、赤外送受信機、ブルートゥース送受信機、WiMax送受信機、無線セルラーホン送受信機、衛星送受信機(例えば、全地球測位システム(GPS)送受信機)又は他の無線周波数(RF)送受信機又はそれらの組合せであってもよい。NICはイーサネットカードであってもよい。
入力装置1506は、マウス、タッチパッド、タッチスクリーン(それは表示装置1504と集積されてもよい)、ポインタデバイス(例えばスタイラス)及び/又はキーボード(例えば、物理キーボード又はタッチスクリーンの一部として表示された仮想キーボード)を備えてもよい。例えば、入力装置1506は、タッチスクリーンに接続されるタッチスクリーンコントローラを含んでもよい。タッチスクリーン及びタッチスクリーンコントローラは、例えば複数種のタッチ感度技術(容量、抵抗、赤外及び表面音波の技術を含むが、それらに限定されない)のいずれか、及びタッチスクリーンの一つ又は複数の接触点を決定するための他の近接センサアレイ又は他の素子を用いてそのタッチ点及び移動又は断続を検出することができる。
I/O装置1507は音声装置を備えてもよい。音声装置は、スピーカ及び/又はマイクロホンを含んでもよく、それにより音声認識、音声コピー、デジタル記録及び/又は電話機能のような音声サポートの機能を促進する。他のI/O装置1507は、汎用シリアルバス(USB)ポート、パラレルポート、シリアルポート、印刷機、ネットワークインターフェース、バスブリッジ(例えば、PCI〜PCIブリッジ)、センサ(例えば、加速度計、ジャイロスコープ、磁力計、光センサ、コンパス、近接センサ等のような動きセンサ)又はそれらの組合せをさらに備えてもよい。装置1507は、結像処理サブシステム(例えば、カメラ)をさらに備えてもよく、前記結像処理サブシステムは、カメラ機能(例えば、写真及びビデオ断片の記録)を促進するための電荷カップリング装置(CCD)又は相補型金属酸化物半導体(CMOS)光学センサのような光学センサを備えてもよい。あるセンサは、センサハブ(図示せず)によって相互接続部材1510に接続されてもよく、キーボード又は熱センサのような他の装置は、組み込みコントローラ(図示せず)により制御されてもよく、これはシステム1500の特定配置又は設計により決められる。
データ、アプリケーション、一つ又は複数のオペレーティングシステム等のような情報の永続記憶を提供するために、大容量記憶装置(図示せず)は、プロセッサ1501に接続されてもよい。様々な実施形態において、薄型化と軽量化のシステム設計を実現しかつシステムの応答能力を向上させるために、このような大容量記憶装置は、ソリッドステート装置(SSD)によって実現されることができる。なお、他の実施形態において、大容量記憶装置は、主にハードディスクドライブ(HDD)で実現されてもよく、少量のSSD記憶量は、SSDキャッシュとして停電イベント期間にコンテキスト状態及び他のこのような情報の不揮発性記憶を実現し、それによりシステム動作が再開する時に通電を速く実現することができる。さらに、フラッシュデバイスは、例えばシリアルペリフェラルインターフェース(SPI)によってプロセッサ1501に接続されてもよい。このようなフラッシュデバイスは、システムソフトウェアの不揮発性記憶に用いられてもよく、前記システムソフトウェアは、前記システムのBIOS及び他のファームウェアを備える。
記憶装置1508は、任意の1種又は複数種の本明細書に記載の方法又は機能を体現する一つ又は複数のコマンドセット又はソフトウェア(例えば、モジュール、ユニット及び/又はロジック1528)が記憶されるコンピュータアクセス可能な記憶媒体1509(機械可読記憶媒体又はコンピュータ可読媒体とも呼ばれる)を備えてもよい。処理モジュール/ユニット/ロジック1528は、例えば、計画モジュール304及び/又は制御モジュール305のような上記構成要素のいずれかを示してもよい。処理モジュール/ユニット/ロジック1528は、さらにデータ処理システム1500、メモリ1503及びプロセッサ1501により実行される期間にメモリ1503内及び/又はプロセッサ1501内に完全又は少なくとも部分的に存在してもよく、ここで、メモリ1503及びプロセッサ1501も、機器アクセス可能な記憶媒体を構成する。処理モジュール/ユニット/ロジック1528は、さらにネットワークによってネットワークインターフェース装置1505を経由して送受信されてもよい。
コンピュータ可読記憶媒体1509は、以上に説明された、いくつかのソフトウェア機能を永続的に記憶してもよい。コンピュータ可読記憶媒体1509は、例示的な実施形態において単一の媒体として示されたが、用語「コンピュータ可読記憶媒体」は、前記一つ又は複数のコマンドセットが記憶される単一の媒体又は複数の媒体(例えば、集中型又は分散型データベース、及び/又は関連するキャッシュ及びサーバ)を備えることを理解すべきである。用語「コンピュータ可読記憶媒体」は、さらにコマンドセットを記憶又はコーディング可能な任意の媒体を備えることを理解すべきであり、前記コマンドセットは、機器により実行されかつ前記機器に本発明の任意の1種又は複数種の方法を実行させる。従って、用語「コンピュータ可読記憶媒体」は、ソリッドステートメモリ及び光学媒体と磁気媒体又は任意の他の非一時的機械可読媒体を備えるが、それらに限定されないことを理解すべきである。
本明細書に記載の処理モジュール/ユニット/ロジック1528、構成要素及び他の特徴は、ディスクリートハードウェア構成要素として実現されてもよく、又はハードウェア構成要素(例えばASICS、FPGA、DSP又は類似装置)の機能に統合されてもよい。さらに、処理モジュール/ユニット/ロジック1528は、ハードウェア装置内のファームウェア又は機能回路として実現されてもよい。また、処理モジュール/ユニット/ロジック1528は、ハードウェア装置及びソフトウェアコンポーネントの任意の組合せで実現されてもよい。
なお、システム1500は、データ処理システムの各種の構成要素を有するように示されているが、構成要素の相互接続のいかなる特定のアーキテクチャー又は方式を示すものではないことに注意すべきであり、それは、このような詳細が本発明の実施形態に密接な関係がないためである。また、より少ない構成要素又はより多くの構成要素を有するネットワークコンピュータ、ハンドヘルドコンピュータ、携帯電話、サーバ及び/又は他のデータ処理システムは、本発明の実施形態と共に使用されてもよい。
上記詳細な説明の一部は、コンピュータメモリにおけるデータビットに対する演算のアルゴリズム及び記号表現で示される。これらのアルゴリズムの説明及び表現は、データ処理分野における当業者によって使用される、それらの作業実質を所属分野の他の当業者に最も効果的に伝達する方法である。ここで、アルゴリズムは、通常、所望の結果につながる首尾一貫した動作列(sequence of operations)と考えられる。これらの動作とは、物理量に対して物理的動作を行う必要となるステップを指す。
ただし、これらの全ての及び類似の用語は、いずれも適切な物理量に関連付けられ、かつただこれらの量に適用される適切なラベルであることに注意すべきである。特に断らない限り、本出願の全体にわたって用語(例えば、添付している特許請求の範囲に説明された用語)による説明とは、コンピュータシステム又は類似の電子計算装置の動作及び処理であり、前記コンピュータシステム又は電子計算装置は、コンピュータシステムのレジスタ及びメモリに物理(例えば、電子)量としてデータを示し、かつ前記データをコンピュータシステムメモリ又はレジスタ又は他のこのような情報記憶装置、伝送又は表示装置内において類似に物理量として示される他のデータに変換する。
本発明の実施形態は、さらに本明細書における動作を実行するための装置に関する。このようなコンピュータプログラムは、不揮発性のンピュータ可読媒体に記憶される。機器可読媒体は、機器(例えば、コンピュータ)可読な形態で情報を記憶する任意の機構を備える。例えば、機器可読(例えば、コンピュータ可読)媒体は、機器(例えば、コンピュータ)可読記憶媒体(例えば、読み出し専用メモリ(「ROM」)、ランダムアクセスメモリ(「RAM」)、磁気ディスク記憶媒体、光記憶媒体、フラッシュメモリメモリ)を備える。
上記図面に示される手順又は方法は、ハードウェア(例えば、回路、専用ロジック等)、ソフトウェア(例えば、不揮発性のコンピュータ可読媒体に具現化される)、又は両方の組合せを含む処理ロジックにより実行されてもよい。前記手順又は方法は、本明細書において特定の順序に応じて説明されるが、説明された動作の一部は、異なる順序に応じて実行されてもよい。また、いくつかの動作は、順番ではなく並行に実行されてもよい。
本発明の実施形態は、いずれかの特定のプログラミング言語を参照して説明されていないが、複数種のプログラミング言語で本明細書に記載の本発明の実施形態の教示を実現できることを理解すべきである。
以上の明細書では、本発明の具体的な例示的な実施形態を参照してその実施形態を説明した。明らかなように、添付している特許請求の範囲に記載の本発明のより広い趣旨及び範囲を逸脱しない限り、様々な変形が可能である。従って、限定的なものではなく例示的なものとして本明細書及び図面を理解すべきである。

Claims (22)

  1. 自律走行車を操作するためのコンピュータ実施方法であって、
    出発の位置から目的地の位置まで自律走行車を走行させるための計画データを受信するステップと、
    前記計画データに基づいて、一連の制御命令を生成するステップであって、前記制御命令は、 前記出発の位置から前記目的地の位置までの複数の時点で適用されるステップと、
    コスト関数を、前記制御命令、現在行程で推定される第1の路面摩擦、及び前記出発の位置から前記目的地の位置までの前の行程の間で推定された第2の路面摩擦に適用して、コストを算出するステップと、
    前記コストを最小にするように、前記前の行程の前の終了コストを考慮して、前記コスト関数を利用して前記現在行程の第1の路面摩擦を推定するステップと、を含む、
    ことを特徴とするコンピュータ実施方法。
  2. 前記終了コストは、前記コスト関数を利用して前記前の行程の目的地の位置で算出された前のコストを含む、
    ことを特徴とする請求項1に記載の方法。
  3. 前記自律走行車が前記目的地の位置に到達した際に、前記現在行程の現在終了コストを算出するステップと、
    前記前の行程の前の終了コストと前記現在行程の現在終了コストとを比較して、前記前の終了コストと現在終了コストとの差が所定の閾値未満かを判断するステップと、
    前記差が前記所定の閾値を超過すると判断されたことに応答して、一連の制御命令を生成して、前記出発の位置から前記目的地の位置までの新たな行程に対する制御命令にコスト関数を適用することによりコストを算出することを、繰り返し実行するステップと、をさらに含む、
    ことを特徴とする請求項1に記載の方法。
  4. 前記差が前記所定の閾値未満であると判断されたことに応答して、前記現在行程の前記第1の路面摩擦を前記出発の位置と前記目的地の位置との間の最終路面摩擦として指定するステップを、さらに含む、
    ことを特徴とする請求項3に記載の方法。
  5. 前記最終路面摩擦を利用して、前記出発の位置から前記目的地の位置までの後続の行程で前記自律走行車に対する後続制御命令を決定する、
    ことを特徴とする請求項4に記載の方法。
  6. 前記第1の路面摩擦を推定するステップは、
    前記出発の位置と前記目的地の位置との間の前記複数の時点に対応する複数の道路セグメントの複数の第1の道路セグメント摩擦を推定するステップと、
    前記複数の第1の道路セグメント摩擦と、前記前の行程の間における対応する時点で推定された複数の第2の道路セグメント摩擦との差を決定するステップであって、前記コストは、前記第1の道路セグメント摩擦と前記第2の道路セグメント摩擦との差に基づいて算出されるステップと、を含む、
    ことを特徴とする請求項1に記載の方法。
  7. 前記コストは、前記第1の道路セグメント摩擦と前記第2の道路セグメント摩擦との差の合計に基づいて算出される、
    ことを特徴とする請求項6に記載の方法。
  8. 前記第1の道路セグメント摩擦のそれぞれは、対応する道路セグメントの時点で送信された制御命令に応答した自律走行車の速度及び自律走行車の位置に基づいて推定される、
    ことを特徴とする請求項6に記載の方法。
  9. コマンドを記憶し、前記コマンドがプロセッサにより実行されるときに、前記プロセッサに動作を実行させる、不揮発性機械読み取り可能な媒体であって、
    前記動作は、
    出発の位置から目的地の位置まで自律走行車を走行させるための計画データを受信することと、
    前記計画データに基づいて、一連の制御命令を生成することであって、前記制御命令は、前記出発の位置から前記目的地の位置までの複数の時点で適用される、ことと、
    コスト関数を、前記制御命令、現在行程で推定される第1の路面摩擦、及び前記出発の位置から前記目的地の位置までの前の行程の間で推定された第2の路面摩擦に適用して、コストを算出することと、
    前記コストを最小にするように、前記前の行程の前の終了コストを考慮して、前記コスト関数を利用して前記現在行程の第1の路面摩擦を推定することと、を含む、
    ことを特徴とする機械読み取り可能な媒体。
  10. 前記終了コストは、前記コスト関数を利用して前記前の行程の目的地の位置で算出された前のコストを含む、
    ことを特徴とする請求項9に記載の機械読み取り可能な媒体。
  11. 前記動作は、
    前記自律走行車が前記目的地の位置に到達した際に、前記現在行程の現在終了コストを算出することと、
    前記前の行程の前の終了コストと前記現在行程の現在終了コストとを比較して、前記前の終了コストと前記現在終了コストとの差が所定の閾値未満かを判断することと、
    前記差が前記所定の閾値を超過すると判断されたことに応答して、一連の制御命令を生成して、前記出発の位置から前記目的地の位置までの新たな行程に対する制御命令にコスト関数を適用することによりコストを算出することを、繰り返し実行することと、をさらに含む、
    ことを特徴とする請求項9に記載の機械読み取り可能な媒体。
  12. 前記動作は、
    前記差が前記所定の閾値未満であると判断されたことに応答して、前記現在行程の前記第1の路面摩擦を前記出発の位置と前記目的地の位置との間の最終路面摩擦として指定すること、をさらに含む、
    ことを特徴とする請求項11に記載の機械読み取り可能な媒体。
  13. 前記最終路面摩擦を利用して前記出発の位置から前記目的地の位置までの後続の行程で前記自律走行車に対する後続制御命令を決定する、
    ことを特徴とする請求項12に記載の機械読み取り可能な媒体。
  14. 前記第1の路面摩擦を推定することは、
    前記出発の位置と前記目的地の位置との間の前記複数の時点に対応する複数の道路セグメントの複数の第1の道路セグメント摩擦を推定することと、
    前記複数の第1の道路セグメント摩擦と、前記前の行程の間における対応する時点で推定された複数の第2の道路セグメント摩擦との差を決定することであって、前記コストは前記第1の道路セグメント摩擦と前記第2の道路セグメント摩擦との差に基づいて算出される、ことと、を含む、
    ことを特徴とする請求項9に記載の機械読み取り可能な媒体。
  15. 前記コストは、前記第1の道路セグメント摩擦と前記第2の道路セグメント摩擦との差の合計に基づいて算出される、
    ことを特徴とする請求項14に記載の機械読み取り可能な媒体。
  16. 前記第1の道路セグメント摩擦のそれぞれは、対応する道路セグメントの時点で送信された制御命令に応答した自律走行車の速度及び自律走行車の位置に基づいて推定される、
    ことを特徴とする請求項14に記載の機械読み取り可能な媒体。
  17. プロセッサと、
    前記プロセッサに連結されてコマンドを記憶するメモリと、を含み、前記コマンドが前記プロセッサによって実行されるとき、前記プロセッサに動作を実行させる、データ処理システムであって、
    前記動作は、
    出発の位置から目的地の位置まで自律走行車を走行させるための計画データを受信することと、
    前記計画データに基づいて、一連の制御命令を生成することであって、前記制御命令は、前記出発の位置から前記目的地の位置までの複数の時点で適用されることと、
    コスト関数を、前記制御命令、現在行程で推定される第1の路面摩擦及び前記出発の位置から前記目的地の位置までの前の行程の間で推定された第2の路面摩擦に適用して、コストを算出することと、
    前記コストを最小にするように、前記前の行程の前の終了コストを考慮し、前記コスト関数を利用して前記現在行程の第1の路面摩擦を推定することと、を含む、
    ことを特徴とするデータ処理システム。
  18. 前記終了コストは、前記コスト関数を利用して前記前の行程の目的地の位置で算出された前のコストを含む、
    ことを特徴とする請求項17に記載のデータ処理システム。
  19. 前記動作は、
    前記自律走行車が前記目的地の位置に到達した際に、前記現在行程の現在終了コストを算出することと、
    前記前の行程の前の終了コストと前記現在行程の現在終了コストとを比較して、前記前の終了コストと現在終了コストとの差が所定の閾値未満かを判断すること、
    前記差が前記所定の閾値を超過すると判断されたことに応答して、一連の制御命令を生成して、前記出発の位置から前記目的地の位置までの新たな行程に対する制御命令にコスト関数を適用することによりコストを算出することを、繰り返し実行することと、をさらに含む、
    ことを特徴とする請求項17に記載のデータ処理システム。
  20. 前記動作は、
    前記差が前記所定の閾値未満であると判断されたことに応答して、前記現在行程の前記第1の路面摩擦を前記出発の位置と前記目的地の位置との間の最終路面摩擦として指定することをさらに含む、
    ことを特徴とする請求項19に記載のデータ処理システム。
  21. 前記最終路面摩擦は、前記出発の位置から前記目的地の位置までの後続の行程で前記自律走行車に対する後続制御命令を決定するために適用される、ことを特徴とする請求項20に記載のデータ処理システム。
  22. 前記第1の路面摩擦を推定することは、
    前記出発の位置と前記目的地の位置との間の前記複数の時点に対応する複数の道路セグメントの複数の第1の道路セグメント摩擦を推定することと、
    前記複数の第1の道路セグメント摩擦と、前記前の行程の間における対応する時点で推定された複数の第2の道路セグメント摩擦との差を決定することであって、前記コストは前記第1の道路セグメント摩擦と前記第2の道路セグメント摩擦との差に基づいて算出されることと、を含む、
    ことを特徴とする請求項17に記載のデータ処理システム。
JP2018510415A 2017-01-13 2017-01-13 学習に基づくモデル予測制御を利用して自律走行車の路面摩擦を決定する方法及びシステム Active JP6539408B2 (ja)

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/CN2017/071108 WO2018129711A1 (en) 2017-01-13 2017-01-13 Method and system for determining road frictions of autonomous driving vehicles using learning-based model predictive control

Publications (2)

Publication Number Publication Date
JP2019512111A JP2019512111A (ja) 2019-05-09
JP6539408B2 true JP6539408B2 (ja) 2019-07-03

Family

ID=62839251

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2018510415A Active JP6539408B2 (ja) 2017-01-13 2017-01-13 学習に基づくモデル予測制御を利用して自律走行車の路面摩擦を決定する方法及びシステム

Country Status (6)

Country Link
US (1) US10407076B2 (ja)
EP (1) EP3562725B8 (ja)
JP (1) JP6539408B2 (ja)
KR (1) KR101975725B1 (ja)
CN (1) CN108684203B (ja)
WO (1) WO2018129711A1 (ja)

Families Citing this family (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2018213969A1 (en) * 2017-05-22 2018-11-29 Baidu.Com Times Technology (Beijing) Co., Ltd. Method and system for updating maps based on control feedbacks of autonomous driving vehicles
DE102017214032A1 (de) * 2017-08-11 2019-02-14 Robert Bosch Gmbh Verfahren zum Bestimmen eines Reibwerts für einen Kontakt zwischen einem Reifen eines Fahrzeugs und einer Fahrbahn und Verfahren zum Steuern einer Fahrzeugfunktion eines Fahrzeugs
US10775790B2 (en) * 2018-02-09 2020-09-15 Baidu Usa Llc Methods and systems for model predictive control of autonomous driving vehicle
US11226620B2 (en) * 2019-02-08 2022-01-18 GM Global Technology Operations LLC Automated driving systems and control logic with enhanced longitudinal control for transitional surface friction conditions
CN109871017B (zh) * 2019-02-20 2022-09-13 阿波罗智能技术(北京)有限公司 自动驾驶参考线调用方法、装置和终端
DE102019205405A1 (de) * 2019-04-15 2020-10-15 Zf Friedrichshafen Ag Ermittlung einer Eingangsgröße eines Fahrzeug-Aktuators mittels modellgestützter prädiktiver Regelung
KR20200135886A (ko) * 2019-05-10 2020-12-04 현대자동차주식회사 자율주행차량을 지원하는 시스템 및 방법
US11543343B2 (en) 2019-09-05 2023-01-03 Volvo Car Corporation Road friction estimation
KR20210065718A (ko) 2019-11-27 2021-06-04 재단법인 지능형자동차부품진흥원 인공지능을 이용한 센서융합 기반의 노면 분류 방법 및 장치
US11318947B2 (en) 2019-12-23 2022-05-03 Volvo Car Corporation Estimating surface friction coefficients using rear-wheel steering excitations
WO2021171207A1 (en) * 2020-02-24 2021-09-02 Thales Canada Inc. Controller, control system and method for vehicle control
KR20220015171A (ko) 2020-07-30 2022-02-08 현대자동차주식회사 차량 서스펜션 제어 장치 및 방법
WO2022044470A1 (ja) * 2020-08-27 2022-03-03 パナソニックIpマネジメント株式会社 移動体制御方法、移動体制御装置、および移動体
US11521394B2 (en) * 2020-10-09 2022-12-06 Motional Ad Llc Ground plane estimation using LiDAR semantic network
CN112668669B (zh) * 2021-01-27 2023-09-26 河北省交通规划设计院 一种路面摩擦系数估计方法、装置和电子设备

Family Cites Families (21)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH1141708A (ja) * 1997-07-23 1999-02-12 Nissan Motor Co Ltd ハイブリッド車両
JP3440791B2 (ja) * 1997-11-21 2003-08-25 トヨタ自動車株式会社 路面状態判定装置
US6728620B2 (en) * 2002-02-08 2004-04-27 Visteon Global Technologies, Inc. Predictive control algorithm for an anti-lock braking system for an automotive vehicle
JP2005028887A (ja) * 2003-07-07 2005-02-03 Fuji Heavy Ind Ltd 路面摩擦係数推定装置および路面摩擦係数推定方法
JP2010163131A (ja) * 2009-01-19 2010-07-29 Sumitomo Electric Ind Ltd 路面状況判別装置
JP2010179678A (ja) * 2009-02-03 2010-08-19 Honda Motor Co Ltd 路面摩擦係数推定装置
DE112010005366B4 (de) * 2010-03-08 2022-02-03 Mitsubishi Electric Corporation Routensuchvorrichtung
SE537674C2 (sv) * 2013-03-19 2015-09-29 Scania Cv Ab Reglersystem för autonoma fordon, och en metod för reglersystemet
JP6467773B2 (ja) * 2014-02-25 2019-02-13 アイシン・エィ・ダブリュ株式会社 経路探索システム、経路探索方法及びコンピュータプログラム
EP2916190B1 (en) * 2014-03-04 2019-05-08 Volvo Car Corporation Apparatus and method for prediction of time available for autonomous driving, in a vehicle having autonomous driving cap
US9707960B2 (en) * 2014-07-31 2017-07-18 Waymo Llc Traffic signal response for autonomous vehicles
CN104554251A (zh) * 2014-12-09 2015-04-29 河南理工大学 基于道路坡度信息的混合动力汽车节能预测控制方法
US9815476B2 (en) * 2014-12-22 2017-11-14 Here Global B.V. Method and apparatus for providing road surface friction data for a response action
CN104773170B (zh) * 2015-04-28 2017-03-29 吉林大学 一种车辆稳定性集成控制方法
US9821801B2 (en) * 2015-06-29 2017-11-21 Mitsubishi Electric Research Laboratories, Inc. System and method for controlling semi-autonomous vehicles
US9721472B2 (en) * 2015-09-22 2017-08-01 Ford Global Technologies, Llc Formulating lane level routing plans
CN108139221A (zh) * 2015-09-24 2018-06-08 苹果公司 用于向车辆提供导航信息的方法和相关系统
US10002471B2 (en) * 2015-09-30 2018-06-19 Ants Technology (Hk) Limited Systems and methods for autonomous vehicle navigation
CN105404729B (zh) * 2015-11-04 2019-05-03 北京联合大学 智能驾驶中基于驾驶态势图簇的改进pid速度控制方法
US10473470B2 (en) * 2016-10-20 2019-11-12 nuTonomy Inc. Identifying a stopping place for an autonomous vehicle
CN108121325A (zh) * 2017-11-17 2018-06-05 南京视莱尔汽车电子有限公司 一种自动驾驶汽车地面状态评定方法

Also Published As

Publication number Publication date
EP3562725A1 (en) 2019-11-06
KR20180116216A (ko) 2018-10-24
US20180304900A1 (en) 2018-10-25
WO2018129711A1 (en) 2018-07-19
JP2019512111A (ja) 2019-05-09
EP3562725B1 (en) 2022-01-12
EP3562725A4 (en) 2020-09-23
US10407076B2 (en) 2019-09-10
KR101975725B1 (ko) 2019-05-07
EP3562725B8 (en) 2022-02-23
CN108684203A (zh) 2018-10-19
CN108684203B (zh) 2021-05-28

Similar Documents

Publication Publication Date Title
JP6539408B2 (ja) 学習に基づくモデル予測制御を利用して自律走行車の路面摩擦を決定する方法及びシステム
JP6748244B2 (ja) 自動運転車に用いられる学習に基づく速度計画装置
JP6517891B2 (ja) 自律走行車用のグループ運転スタイル学習フレーム
JP6861239B2 (ja) 自動運転車両のためのpid埋め込みlqr
KR102042123B1 (ko) 자율 주행 차량을 위한 속력 제어 파라미터 추정 방법
JP6650028B2 (ja) 自律走行車のための横滑り補償制御方法
CN108139884B (zh) 用于操作自动驾驶车辆的方法和系统
CN111824139B (zh) 用于预测与自动驾驶车辆相关的运动对象的运动的方法
KR102033265B1 (ko) 자율 주행 차량 제어를 위한 시스템 지연 추정 방법
JP6667686B2 (ja) 自動運転車両のための走行軌跡生成方法、システム及び機械可読媒体
JP6517897B2 (ja) 自律走行車用のバネシステムに基づく車線変更方法
JP6494715B2 (ja) 自律走行車の速度制御率の動的調整方法
JP6606603B2 (ja) 自動運転車両を自動運転モードに再進入させるように制御するための経度のカスケードコントローラプリセット
JP2020009412A (ja) 自動運転車両のための計画運転感知システム
JP2019128962A (ja) 自動運転車のための経路及び速度の最適化フォールバックメカニズム[path and speed optimization fallback mechanism for autonomous vehicles]
JP2019182414A (ja) 自動運転車に対して障害物の予測軌跡を生成するための方法
KR102398256B1 (ko) 비전 기반 인식 시스템에 의한 대립적 샘플들 검출 방법
CN111380534B (zh) 用于自动驾驶车辆的基于st图学习的方法
JP6543373B2 (ja) 自動運転車両に用いられる制御型の計画と制御システム
JP7116065B2 (ja) 自律走行車に用いられるトンネルに基づく計画システム
KR20180051568A (ko) 자율 주행 차량을 위한 시스템 지연 보정 제어 방법
KR20180074676A (ko) 자율 주행 차량의 조향률의 동적 조정
JP2019189214A (ja) 自動運転車の経路計画用のドリフト補正の方法
JP6667688B2 (ja) 自動運転車両のための自己位置推定方法、システム及び機械可読媒体
CN111615476B (zh) 用于自动驾驶车辆的基于螺旋曲线的竖直停车规划系统

Legal Events

Date Code Title Description
A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20180222

A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20180222

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20190607

R150 Certificate of patent or registration of utility model

Ref document number: 6539408

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

S111 Request for change of ownership or part of ownership

Free format text: JAPANESE INTERMEDIATE CODE: R313113

R350 Written notification of registration of transfer

Free format text: JAPANESE INTERMEDIATE CODE: R350

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250