JP6937658B2 - 予測制御装置及び方法 - Google Patents

予測制御装置及び方法 Download PDF

Info

Publication number
JP6937658B2
JP6937658B2 JP2017200888A JP2017200888A JP6937658B2 JP 6937658 B2 JP6937658 B2 JP 6937658B2 JP 2017200888 A JP2017200888 A JP 2017200888A JP 2017200888 A JP2017200888 A JP 2017200888A JP 6937658 B2 JP6937658 B2 JP 6937658B2
Authority
JP
Japan
Prior art keywords
control device
predictive control
operation amount
unit
vehicle
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
JP2017200888A
Other languages
English (en)
Other versions
JP2019073177A (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.)
Hitachi Astemo Ltd
Original Assignee
Hitachi Astemo Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Hitachi Astemo Ltd filed Critical Hitachi Astemo Ltd
Priority to JP2017200888A priority Critical patent/JP6937658B2/ja
Priority to PCT/JP2018/036214 priority patent/WO2019077971A1/ja
Priority to US16/755,907 priority patent/US11392093B2/en
Publication of JP2019073177A publication Critical patent/JP2019073177A/ja
Application granted granted Critical
Publication of JP6937658B2 publication Critical patent/JP6937658B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • 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/048Adaptive 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 using a predictor
    • 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/0205Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric not using a model or a simulator of the controlled system
    • G05B13/026Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric not using a model or a simulator of the controlled system using a predictor
    • 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/06Improving the dynamic response of the control system, e.g. improving the speed of regulation or avoiding hunting or overshoot

Description

本発明は、車両の自動運転に適用する予測制御装置及び方法に関する。
近年、車両の自動運転が実用化の方向にあり、この場合に自動運転の軌道生成等でモデル予測制御の適用が広がりつつある。
車両の自動運転における予測制御技術としては、特許文献1および特許文献2に記載のような装置が開示されている。
特許文献1では、チャタリングの発生を防止し、且つ、応答性を向上することのできる予測制御装置及び推奨操作提示装置として、乗り心地を確保するため、システムへの入力操作量が急激に変化する場合には、操作量の変化がしきい値を超えないように操作量を修正する手段を有する例が示されている。
特許文献2では、周囲車両の将来の位置との関係を考慮した上で、横方向も含めた自車両の挙動を適切に制御することが可能な車両用制御装置として、乗り心地を確保するため、前回と今回の進行方向の変化量や前回と今回の加減速度の変化量をモデル予測制御の評価関数に含める例が示されている。
特開2004−118723号公報 特開2017−084110号公報
特許文献1,2では、主として乗り心地を重視した予測制御を行っているが、その反面緊急時の迅速な動作が求められる場合もある。
自動運転の軌道生成等でモデル予測制御を適用する場合に、ハンドル操作、アクセル操作、ブレーキ操作などの状態量を計算で求めることになるが、時間軸上で不連続な操作が生じる場合が有る。
そのため、人の運転に即した、通常走行時の乗り心地と緊急時の迅速な動作を両立することができるモデル予測制御を行えることが望ましい。
以上のことから本発明においては、人が運転するように、通常走行時の乗り心地と緊急時の迅速な動作を両立することができる予測制御装置及び方法を提供することを目的とする。
以上のことから本発明においては、「車両の自動運転のためにアクチュエータに与える操作量を定める予測制御装置であって、アクチュエータに対する操作量と、予測値としての操作量候補を生成する操作指令値生成部と、車両の動作モデルを数式で表した状態方程式を用いて、アクチュエータ出力に相当する予測値としての制御量候補を出力する出力予測部と、車両の自動運転に必要な制約条件を複数の関数で表し、制約条件についての各関数の出力の総和を得る評価関数演算部と、走行中の自車車両の周囲状況から、乗り心地を優先するか危険回避を優先するかの尺度となる状況度を求める状況度検出部と、状況度検出部からの状況度から次の操作量候補を求める応答性調整部を備え、操作指令値生成部は、評価関数演算部から出力される評価関数の出力に応じてアクチュエータに対する操作量を生成するとともに、応答性調整部は、状況度に応じて評価関数の出力を調整することを特徴とする予測制御装置。」としたものである。
また本発明においては、「車両の自動運転のためにアクチュエータに与える操作量を定める予測制御方法であって、アクチュエータに対する操作量と、予測値としての操作量候補を生成し、車両の動作モデルを数式で表した状態方程式を用いて、アクチュエータ出力に相当する予測値としての制御量候補を求め、車両の自動運転に必要な制約条件を複数の関数で表し、制約条件についての各関数の出力の総和を得、走行中の自車車両の周囲状況から、乗り心地を優先するか危険回避を優先するかの尺度となる状況度を求め、状況度から次の操作量候補を求め、評価関数の出力に応じてアクチュエータに対する操作量を生成するとともに、状況度に応じて前記評価関数の出力を調整することを特徴とする予測制御方法。」としたものである。
また本発明においては、「車両の自動運転のためにアクチュエータに与える操作量を定める予測制御装置であって、周囲情報と車両情報とから状況度を検出する手段と、周囲情報と車両情報から単位時間毎に操作量を生成しアクチュエータに出力する手段と、状況度の値に応じて現時点の操作量と次の時点の操作量との差を調整する手段とで構成されることを特徴とする予測制御装置。」としたものである。
また本発明においては、「車両の自動運転のためにアクチュエータに与える操作量を定める予測制御方法であって、周囲情報と車両情報とから状況度を検出し、周囲情報と車両情報から単位時間毎に操作量を生成しアクチュエータに出力するとともに、前記状況度の値に応じて現時点の操作量と次の時点の操作量との差を調整することを特徴とする予測制御方法。」としたものである。
本発明によれば、人が運転するように、通常走行時の乗り心地と緊急時の迅速な動作を両立する予測制御装置を提供することができる。
本発明の実施例に係る車両の自動運転制御システムのブロック構成例を示す図。 モデル予測制御部101内の操作指令値生成部104のブロック構成例を示す図。 モデル予測制御部101内の出力予測部105のブロック構成例を示す図。 モデル予測制御部101内の評価関数演算部106のブロック構成例を示す図。 過去の実制御量と将来の予測制御量の移動平均値を用いる応答性調整手段107の構成例を示す図。 過去の実制御量と将来の予測制御量の加重平均値を用いる応答性調整手段107の構成例を示す図。 操作量uとuを用いる応答性調整手段107の構成例を示す図。 状況度検出部103のブロック構成例を示す図。 モデル予測制御による自動運転の一動作例を示す図。 図7のように走行するときの本発明の課題を具体的に説明するための図。 応答性調整部107の動作として、乗り心地優先の観点から図4の状況度Wpを「1」に近い値とした場合を具体的に説明するための図。 応答性調整部107の動作として、危険回避優先の観点から図4の状況度Wpを「0」に近い値とした場合を具体的に説明するための図。
以下、本発明の実施例について図面を用いて説明する。
図1は本発明の実施例に係る車両の自動運転制御システムのブロック構成例を示す図である。
図1において、モデル予測制御部101は、自車の周囲の情報を基に例えば数ミリ秒毎に将来の数秒間の自車の速度や進む方向を予測しながら、次の数ミリ秒後の操作量を求める処理を行っている。この入力の一部は周囲情報であり、その出力の一部はハンドル操作、アクセル操作、ブレーキ操作などのアクチュエータ102に対する操作量uである。またモデル予測制御部101は、アクチュエータ102の出力である制御量xと、状況度検出部103から状況度の情報Wpを入力し、通知部108に対して応答性調節情報を与えている。
モデル予測制御部101は、操作指令値生成部104と、出力予測部105と、評価関数演算部106と、応答性調整部107により構成されている。
このうち、操作指令値生成部104は、例えば現在の操作量uと、次の操作量uから数ミリ秒毎に将来のn秒間分の予測値としての操作量候補(u〜u)を生成する手段である。操作指令値生成部104について、図2を用いて後述する。
出力予測部105は、例えば操作量候補(u〜u)と周囲情報および現時点の自車の制御量xを車両の動作モデルを数式で表した状態方程式に入力し、それに対応する制御量(速度、位置、方向等)を、予測値としての制御量候補(x〜x)として出力する手段である。出力予測部105について、図3を用いて後述する。
評価関数演算部106は、自動運転に必要な制約条件を複数の関数で表し、操作量候補(u〜u)および制御量候補(x〜x)を入力し、制約条件についての各関数出力の総和Fを出力する手段である。評価関数演算部106について、図4を用いて後述する。
状況度検出部103は、走行中の自車の周囲状況から、乗り心地を優先するか危険回避を優先するかの尺度となる状況度Wpを出力する手段である。状況度検出部103について、図6を用いて後述する。
応答性調整部107は、現在の操作量uと状況度検出部103から入力する状況度Wpから次の操作量候補uを求める手段である。応答性調整部107について、図5a、図5b、図5cを用いて後述する。
なお通知部108は、応答性調整部107からの出力(状況度Wpや次の操作量候補)を外部に通知する手段である。例えばディスプレイやスピーカにて乗員へ緊急動作を行う旨の通知や、無線ネットワークにより周辺の他車へ注意喚起等の通知を行う。
以上の構成によるモデル予測制御部101では、操作指令値生成部104から評価関数演算部106のループ処理を例えば数ミリ秒間に複数回繰り返し、評価関数の総和Fが最小となる操作量候補(u〜u)を選び、次の時点の操作量uをアクチュエータ102に出力する。アクチュエータ102は操作量uを制御量xに変換しブレーキ、アクセルおよびハンドル操作等を実行する。
図7はモデル予測制御による自動運転の一動作例である。高速道路の走行車線を走行中の自動運転による車両701が、同じ走行車線を走行中の車両702を追い越し、追い越し車線上で先行する車両703に追いつく前に再度走行車線に戻る一連の追い越し動作を想定している。
図7の(a)は、高速道路上で自車701が他車702および他車703の後方を走行している図である。このとき自車701は効率の良い運転を行うため、複数の制御量xの候補(点線で示す)の中から太い実線の矢印で示す時系列的な制御量x〜xを選択し、次の時点の制御量としてxを決定する。
図7の(b)〜(d)は自車701が他車702を追い越す過程を示しており、それぞれの地点でモデル予測制御により複数の制御量の候補の中から太線の矢印で示す時系列的な制御量x〜xを選択し、次の時点の制御量としてxを決定する。
図8により、図7のように走行するときの本発明の課題を具体的に説明する。図1に示すモデル予測制御部101では、一処理時間単位に評価関数Fの出力が最小となる操作量uを求めている。図8の(c)は、横軸に操作量u,縦軸に評価関数Fを示す図であり、処理周期の一処理時間単位で求めた評価関数Fの出力について、今回の評価関数Fの出力が最小となる入力uが、前回の評価関数Fの出力が最小となる入力uと大きく異なると、求まる操作量uの値(しいては制御量xの値)も大きく異なることになる。
その結果、図8の(a)に示すように、実際の自動運転時にハンドル操作やアクセル、ブレーキ操作にガタツキを生じ乗り心地を悪くすることになる。したがって図8の(b)に示すように滑らかな自動運転を実現し乗り心地を良くする事が本発明の課題である。
以下、滑らかな自動運転を実現し乗り心地を良くするための、図1に示す予測制御装置の各部詳細構成について説明する。
図2は、モデル予測制御部101内の操作指令値生成部104のブロック構成例を示す図である。操作指令値生成部104では、評価関数Fを入力し、操作量候補(u〜u)を与える。
操作指令値生成部104内の比較部202では、評価関数演算部106から出力される演算結果(評価関数Fの出力)を最小値保存部203に格納された値と比較する。入力された値が最小値保存部203に格納された値より小さければ最小値保存部203に対し保存指令信号を出力する。最小値保存部203は、比較部202からの保存指令信号に応じて評価関数の演算結果を記憶する。ここまでの一連の処理は、図8の(c)における評価関数Fが最小となる位置を求めたことを意味している。
操作量生成部201は、次の時点の操作量候補uから将来のn時点の操作量候補uまでの操作量候補(u〜u)を生成する手段である。一例としては初期値として乱数発生により操作量候補値を生成し、その後、その値を少しずつ変化させていく演算を繰り返すことで収束解を求める。具体的な方法として粒子群最適化、蟻コロニー最適化、人工蜂コロニーアルゴリズムなどがある。
操作量保存部204は、最小値保存部203に保存された評価関数値に対応する操作指令値候補(u〜u)を保存し、現在時点の操作量uをブレーキ、アクセル、前輪の操舵角等のアクチュエータ102へ出力する。また操作量候補(u〜u)を、図3に示す出力予測部105に与えている。
なお現在時点の操作量uは、例えば前回処理周期で求めた次の時点の操作量候補uを用いて算出することができる。図2の操作指令値生成部104によれば、評価関数Fが最小となる時系列的な操作量である、操作量候補(u〜u)を得ることができる。これは、図7の(a)に実線で示した軌道を求めたことを意味している。
図3はモデル予測制御部101内の出力予測部105のブロック構成例を示す図である。ここで状態方程式演算部301は、車両の動作モデルを数式で表した手段である。例えば、加速度や進行方向の角度を入力して、自車の位置座標、速度、方角などの物理量に変換する。保存部302は状態方程式の出力を一時保存し、次の時点の予測処理に利用するための手段である。例えば現時点の位置座標と速度を保存することで次の時点の位置座標の予測値を計算で求めることができる。
図3の例では、車両の動作モデルを数式で表すために操作指令値生成部104内からの時系列的な予測操作量(u〜u)と周囲情報を入力としている。また出力として、アクチュエータ102の出力に対応する制御量を、時系列的な予測制御量(x〜x)として算出し、評価関数演算部106での演算に使用している。なお、図3では、基準位置を定めるために保存部302を使用しているが、これは図1に示すように、アクチュエータ102が示す現在位置を基準として定めるものであってもよい。
図4はモデル予測制御部101内の評価関数演算部106のブロック構成例を示す図である。評価関数演算部106では、自動運転に必要な制約条件を関数で表した複数の制約条件関数(401から405)を用いて、操作指令値生成部104に与える評価関数Fの値を生成する。図4の例では、リスク度と、出力予測部105で求めた時系列的な予測制御量(x〜x)についての制約条件関数を備えている。またそのうえで、予測操作量(u〜u)についての制約条件関数を応答性調整部107に備え、応答性調整部107では状況度検出部103で求めた状況度Wpに応じて制約条件関数の出力を調整している。
評価関数演算部106は、複数の制約条件関数演算部(401から404)と、応答性調整部107と、加算部405,406により構成されている。本発明では、評価関数Fを複数の制約条件関数(401から404)と、応答性調整部107により定めている。
複数の制約条件関数は、リスク度演算部401で求めるリスク度についての関数f1、速度誤差演算部402で求める速度誤差についての関数f2、加速度演算部403で求める加速度についての関数f3、加速度演算部404で求める加々速度についての関数f4である。評価関数Fは、これらにさらに応答性調整部107で求める応答性についての関数f5を加味した5つの要素で構成された関数である。これら5つの要素で定まる数値が最小のものを求めていく。
以下、複数の制約条件関数演算部(401から404)のそれぞれについて説明する。まずリスク度演算部401は、周囲情報と自車の相対位置情報から、次の時点(k=1)から将来のn時点(k=n)までの各時点でのリスク度R(k)を、例えば状況度検出部103から入手し、リスク度R(k)と重み係数Wの乗算結果を計算し、それらの値の総和を求めるリスク度についての制約条件関数f1である。
速度誤差演算部402は、自車の加速度情報を積分して速度を求め、次の時点(k=1)から将来のn時点(k=n)までの各時点での目標速度Vrefの差の2乗と重み係数Wの乗算結果を計算し、それらの値の総和を求める速度についての制約条件関数f2である。
加速度演算部403は、自車の加速度情報から、次の時点(k=1)から将来のn時点(k=n)までの各時点での加速度の2乗と重み係数Wの乗算結果を計算し、それらの値の総和を求める加速度についての制約条件関数f3である。
加々速度演算404は、自車の加速度情報を微分して加々速度を求め、次の時点(k=1)から将来のn時点(k=n)までの各時点での加々速度の2乗と重み係数Wの乗算結果を計算し、それらの値の総和を求める加々速度についての制約条件関数f4である。加算部405は上記制約条件関数演算部(401から404)の各制約条件関数の出力結果を加算する。
応答性調整部107は、現在の操作量uと次の操作量uとの差分の2乗と、状況度検出部103から入力する状況度Wpの乗算結果を求める応答性についての制約条件関数f5である。
評価関数演算部106は、上記のように構成されているが、先にも述べたように予測制御装置は、評価関数Fの出力を最小とする時の操作量uにより車両制御している。然るに、評価関数Fの出力を定める5つの制約条件関数のうち、リスク度の制約条件関数f1、速度誤差の制約条件関数f2、加速度の制約条件関数f3、加々速度の制約条件関数f4は、その時々の運転状態を反映しており、これが概ね一定値を出力していると仮定すると、評価関数Fの出力は、応答性の制約条件関数f5により定まり、これを決定するのは状況度Wpである。つまり、状況度Wp次第で、評価関数Fの出力を任意に定めることができるというのが、図4の評価関数演算部106の構成の考え方である。
本発明においては、乗り心地優先の時に状況度Wpを「1」に近い値にし、危険回避優先の時に状況度Wpを「0」に近い値にするように調整する。図9a、図9bを用いて、応答性調整部107の動作を具体的に説明する。
図9aは、乗り心地優先の観点から図4の状況度Wpを「1」に近い値とした場合、図9bは、危険回避優先の観点から図4の状況度Wpを「0」に近い値とした場合を示している。図9aに示すように、状況度Wpが1に近い値(乗り心地優先)のとき、応答性調整部107の応答性の関数において、Wp・(u−uの値を0に近くするためには、uがuに近い値を取る必要がある。その結果、現操作量uに対し、小さな変化量が次の操作量uとして選ばれるため、変化の少ない運転動作を確保できる。
また、図9bに示すように、状況度Wpが0に近い値(危険回避優先)のとき、応答性調整部107の応答性の関数において、Wp・(u−uの値を0に近くするためには、uがuから離れた値でも良い。その結果、現操作値uに対し、大きな変化量が次の操作値uとして選ばれるため、機敏な運転動作を確保できる。
なお、図4に示す応答性調整部107の処理では、現在の操作量uと次の操作量uとの差分を用いているが、ノイズによる影響を減らすために現在の操作量uに代わり、複数の過去の実績値および将来の予測値を用いても良い。また制御量は、図3の状態方程式演算部301により操作量の関数出力であるから、次の制御量xと現在の制御量xの差分を用いても良い。
次に、応答性調整部107の別の実施例を示す。図5aは、現操作値uに代わり過去の実操作量と将来の予測操作量の移動平均値を用いる例である。図5bは、現操作値uに代わり過去の実操作量と将来の予測操作量の加重平均値を用いる例である。図5cは、操作量uとuの代わりに制御量xとxを用いる例である。
図6は状況度検出部103のブロック構成例を示す図である。状況度検出部103は、複数の個別状況度検出部601と、加算部605と、正規化部606により構成されている。 個別状況度検出601は、自車の周囲の1つの障害物との間の衝突可能性を検出する手段である。複数の個別状況度検出部601を備えることにより、自車の周囲の別個の障害物との間の衝突可能性を検出している。
個別状況度検出601は、種別係数設定部602と、余裕度算出部603と、乗算部604と、加算部605と、正規化部606により構成されている。このうち種別係数設定部602は、入力される障害物の種類に応じて異なる係数Wkを選択する手段である。例えば、歩行者<自転車<車の順で係数の値は大きくなる。余裕度算出部603は、自車と障害物との距離と相対速度を入力し、両者間の余裕度を数値で出力する。この例では、相対距離が大きく、また相対速度が大きいほど余裕度として大きな値を出力する。乗算部604は種類係数と余裕度を乗算する手段である。乗算結果は、同じ余裕度であっても車の場合より歩行者の場合のほうが小さくなる。これは歩行者に対する安全を優先するためである。加算部605は複数の個別状況度検出手段601の出力を加算し、総合の状況度を算出する手段である。正規化部606は、状況度Wpを0〜1の間の値に正規化して出力する手段である。状況度Wpが1に近いほど乗り心地がよく、また状況度Wpが0に近いほど緊急度が高いものとされる。
上記の本発明による予測制御装置は、現時点の操作量と次の時点の操作量との差を調整する手段を含んでいる。この機能は、評価関数演算部106と操作指令値生成部104により主として構成されている。ここでは図4に例示されるように状況度を重み係数とし、現在の操作量と次の操作量の差分に重み係数を乗じた値を評価関数に含む。あるいは、状況度を重み係数とし、過去の実操作量および将来の予測操作量の移動平均値に対する次の操作量の差分に重み係数を乗じた値を評価関数に含む。あるいは、状況度を重み係数とし、過去の実操作量および将来の予測操作量の荷重平均値に対する次の制御量の差分に重み係数を乗じた値を評価関数に含む。あるいは、状況度を重み係数とし、現在の制御量と次の制御量の差分に重み係数を乗じた値を評価関数に含む。
また本発明装置をさらに簡便に述べるならば、これは「車両の自動運転のためにアクチュエータに与える操作量を定める予測制御装置であって、周囲情報と車両情報とから状況度を検出する手段と、周囲情報と車両情報から単位時間毎に操作量を生成しアクチュエータに出力する手段と、前記状況度の値に応じて現時点の操作量と次の時点の操作量との差を調整する手段とで構成されることを特徴とする予測制御装置。ということができる。
以上に示した本発明装置によれば、人が運転するように、通常走行時の乗り心地と緊急時の迅速な動作を両立することができる。
101:モデル予測制御部
102:アクチュエータ
103:状況度検出部
部104:操作指令値生成部
105:出力予測部
106:評価関数演算部
107:応答性調整部
108:通知部
201:操作量生成部
202:比較部
203:最小値保存
204:操作量保存部
301:状態方程式演算部
302:保存部
401:リスク度演算部
402:速度誤差演算部
403:加速度演算部
404:加々速度演算部
405:加算部
406:加算部
601:個別状況度検出部
602:種別係数設定部
603:余裕度算出部
604:乗算部
605:加算部
606:正規化部
701:自車
702:他車
703:他車

Claims (17)

  1. 車両の自動運転のためにアクチュエータに与える操作量を定める予測制御装置であって、
    前記アクチュエータに対する操作量と、予測値としての操作量候補を生成する操作指令値生成部と、車両の動作モデルを数式で表した状態方程式を用いて、前記アクチュエータ出力に相当する予測値としての制御量候補を出力する出力予測部と、車両の自動運転に必要な制約条件を複数の関数で表し、前記制約条件についての各関数の出力の総和を得る評価関数演算部と、走行中の自車車両の周囲状況から、乗り心地を優先するか危険回避を優先するかの尺度となる状況度を求める状況度検出部と、前記状況度検出部からの状況度から次の操作量候補を求める応答性調整部を備え、
    前記操作指令値生成部は、前記評価関数演算部からの出力に応じて前記アクチュエータに対する操作量を生成するとともに、前記応答性調整部は、前記予測値としての操作量候補または前記予測値としての制御量候補と現在値の差分と状況度に応じて評価関数演算部からの出力を調整することを特徴とする予測制御装置。
  2. 請求項1に記載の予測制御装置であって、
    前記操作指令値生成部は、前記評価関数演算部の出力が最小となる値に応じて前記アクチュエータに対する操作量を定めていることを特徴とする予測制御装置。
  3. 請求項1または請求項2に記載の予測制御装置であって、
    前記出力予測部は、車両の動作モデルを数式で表した状態方程式に、走行中の自車車両の周囲状況と前記操作指令値生成部からの予測値としての操作量候補を適用して、前記アクチュエータ出力に相当する予測値としての制御量候補を求めていることを特徴とする予測制御装置。
  4. 請求項1から請求項3のいずれか1項に記載の予測制御装置であって、
    前記評価関数演算部における、車両の自動運転に必要な制約条件を複数の関数で表した前記制約条件は、周囲情報と自車の相対位置情報から求めたリスク度についての制約条件を含むことを特徴とする予測制御装置。
  5. 請求項1から請求項4のいずれか1項に記載の予測制御装置であって、
    前記評価関数演算部における、車両の自動運転に必要な制約条件を複数の関数で表した前記制約条件は、前記出力予測部で求めた予測値としての制御量候補についての制約条件を含むことを特徴とする予測制御装置。
  6. 請求項5に記載の予測制御装置であって、
    前記出力予測部で求めた予測値としての制御量候補についての制約条件は、車両の速度、加速度、加々速度についての制約条件の少なくとも1つ以上を含むことを特徴とする予測制御装置。
  7. 請求項1から請求項6のいずれか1項に記載の予測制御装置であって、
    前記応答性調整部は、前記操作指令値生成部からの予測値としての操作量候補からの現在の操作量と次の操作量との差分、及び前記状況度検出部から入力する状況度を用いた応答性についての制約条件関数を含むことを特徴とする予測制御装置。
  8. 請求項1から請求項6のいずれか1項に記載の予測制御装置であって、
    前記応答性調整部は、前記操作指令値生成部からの予測値としての操作量候補と、実操作量との差分、及び前記状況度検出部から入力する状況度を用いた応答性についての制約条件関数を含むことを特徴とする予測制御装置。
  9. 請求項1から請求項6のいずれか1項に記載の予測制御装置であって、
    前記応答性調整部は、前記出力予測部で求めた予測値としての制御量候補と、実制御量との差分、及び前記状況度検出部から入力する状況度を用いた応答性についての制約条件関数を含むことを特徴とする予測制御装置。
  10. 請求項1から請求項9のいずれか1項に記載の予測制御装置であって、
    前記状況度検出部は、障害物の種類、自車と障害物との間の距離および相対速度から状況度を求めることを特徴とする予測制御装置。
  11. 請求項1から請求項10のいずれか1項に記載の予測制御装置であって、
    予測制御装置は、現時点の操作量と次の時点の操作量との差を調整する手段を含むことを特徴とする予測制御装置。
  12. 請求項11に記載の予測制御装置であって、
    現時点の操作量と次の時点の操作量との差を調整する手段は、前記状況度を重み係数とし、現在の操作量と次の操作量の差分に重み係数を乗じた値を評価関数に含むことを特徴とする予測制御装置。
  13. 請求項11または請求項12に記載の予測制御装置であって、
    現時点の操作量と次の時点の操作量との差を調整する手段は、調整内容を通知手段を介して外部装置に出力することを特徴とする予測制御装置。
  14. 請求項11から請求項13のいずれか1項に記載の予測制御装置であって、
    現時点の操作量と次の時点の操作量との差を調整する手段は、前記状況度を重み係数とし、過去の実操作量および将来の予測操作量の移動平均値に対する次の操作量の差分に重み係数を乗じた値を評価関数に含むことを特徴とする予測制御装置。
  15. 請求項11から請求項14のいずれか1項に記載の予測制御装置であって、
    現時点の操作量と次の時点の操作量との差を調整する手段は、前記状況度を重み係数とし、過去の実操作量および将来の予測操作量の加重平均値に対する次の制御量の差分に重み係数を乗じた値を評価関数に含むことを特徴とする予測制御装置。
  16. 請求項11から請求項15のいずれか1項に記載の予測制御装置であって、
    現時点の操作量と次の時点の操作量との差を調整する手段は、前記状況度を重み係数とし、現在の制御量と次の制御量の差分に重み係数を乗じた値を評価関数に含むことを特徴とする予測制御装置。
  17. 車両の自動運転のためにアクチュエータに与える操作量を定める予測制御方法であって、
    前記アクチュエータに対する操作量と、予測値としての操作量候補を生成し、車両の動作モデルを数式で表した状態方程式を用いて、前記アクチュエータ出力に相当する予測値としての制御量候補を求め、車両の自動運転に必要な制約条件を複数の関数で表し、前記制約条件についての各関数の出力の総和を得、走行中の自車車両の周囲状況から、乗り心地を優先するか危険回避を優先するかの尺度となる状況度を求め、前記状況度から次の操作量候補を求め、前記各関数の出力の総和に応じて前記アクチュエータに対する操作量を生成するとともに、状況度に応じて前記各関数の出力の総和を調整するとともに、
    前記アクチュエータに対する操作量は、前記制約条件についての各関数の出力の総和に応じて、前回の操作量と今回の操作量の差が少なくなるようにされるとともに、前記状況度が危険回避を優先するものであるとき、前回の操作量と今回の操作量の差が大きくなることを許容することを特徴とする予測制御方法。
JP2017200888A 2017-10-17 2017-10-17 予測制御装置及び方法 Active JP6937658B2 (ja)

Priority Applications (3)

Application Number Priority Date Filing Date Title
JP2017200888A JP6937658B2 (ja) 2017-10-17 2017-10-17 予測制御装置及び方法
PCT/JP2018/036214 WO2019077971A1 (ja) 2017-10-17 2018-09-28 予測制御装置及び方法
US16/755,907 US11392093B2 (en) 2017-10-17 2018-09-28 Prediction control device and method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2017200888A JP6937658B2 (ja) 2017-10-17 2017-10-17 予測制御装置及び方法

Publications (2)

Publication Number Publication Date
JP2019073177A JP2019073177A (ja) 2019-05-16
JP6937658B2 true JP6937658B2 (ja) 2021-09-22

Family

ID=66173686

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2017200888A Active JP6937658B2 (ja) 2017-10-17 2017-10-17 予測制御装置及び方法

Country Status (3)

Country Link
US (1) US11392093B2 (ja)
JP (1) JP6937658B2 (ja)
WO (1) WO2019077971A1 (ja)

Families Citing this family (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US10739768B2 (en) * 2018-08-08 2020-08-11 Toyota Motor Engineering & Manufacturing North America, Inc. Smoothed and regularized Fischer-Burmeister solver for embedded real-time constrained optimal control problems in autonomous systems
JP2020125595A (ja) * 2019-02-01 2020-08-20 株式会社小松製作所 建設機械の制御システム、建設機械、及び建設機械の制御方法
CN110362084B (zh) * 2019-07-22 2022-08-26 东南大学 一种基于蚁群算法的车辆路径追踪控制方法
JP7074118B2 (ja) * 2019-11-08 2022-05-24 トヨタ自動車株式会社 制御装置、方法、プログラム、及び車両
US20210370941A1 (en) * 2020-05-27 2021-12-02 Baidu Usa Llc Precautionary slowdown speed planning
JP2022028390A (ja) * 2020-08-03 2022-02-16 株式会社東芝 最適値探索制御装置、最適値探索制御方法、コンピュータプログラム、および、最適値探索制御システム
DE112020007805T5 (de) * 2020-11-27 2023-11-02 Mitsubishi Electric Corporation Arithmetische steuerungseinrichtung
CN113781785B (zh) * 2021-11-10 2022-02-08 禾多科技(北京)有限公司 用于仿真测试的随机交通流控制方法
EP4311736A1 (en) 2022-07-29 2024-01-31 Hitachi, Ltd. Method for controlling a vehicle

Family Cites Families (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3832403B2 (ja) * 2002-08-23 2006-10-11 日産自動車株式会社 運転操作補助装置
US6873911B2 (en) 2002-02-01 2005-03-29 Nissan Motor Co., Ltd. Method and system for vehicle operator assistance improvement
JP2004118723A (ja) 2002-09-27 2004-04-15 Nissan Motor Co Ltd 予測制御装置及び推奨操作提示装置
JP4614050B2 (ja) * 2004-04-27 2011-01-19 アイシン精機株式会社 車両の乗員保護装置
JP4586795B2 (ja) * 2006-12-07 2010-11-24 トヨタ自動車株式会社 車両用制御装置
JP5239947B2 (ja) * 2009-03-05 2013-07-17 日産自動車株式会社 運転操作支援装置及び運転操作支援方法
CN104969274B (zh) * 2013-02-01 2017-03-08 日立汽车系统株式会社 行驶控制装置和行驶控制系统
JP6569470B2 (ja) 2015-10-28 2019-09-04 株式会社デンソーアイティーラボラトリ 車両用制御装置
US10046762B2 (en) * 2016-08-18 2018-08-14 GM Global Technology Operations LLC Trajectory integrity co-pilot for autonomous vehicle
JP6764312B2 (ja) * 2016-10-19 2020-09-30 日立オートモティブシステムズ株式会社 車両運動制御装置、車両運動制御方法、車両運動制御プログラム
JP6834858B2 (ja) * 2017-09-04 2021-02-24 トヨタ自動車株式会社 操舵支援装置
JP7053213B2 (ja) * 2017-10-13 2022-04-12 株式会社デンソー 運転データ解析装置

Also Published As

Publication number Publication date
US11392093B2 (en) 2022-07-19
WO2019077971A1 (ja) 2019-04-25
US20200301374A1 (en) 2020-09-24
JP2019073177A (ja) 2019-05-16

Similar Documents

Publication Publication Date Title
JP6937658B2 (ja) 予測制御装置及び方法
JP7143250B2 (ja) 自車両の将来挙動および関連する軌道を決定することにより、自車両の操作者が当該自車両を制御するのを支援する方法およびシステム
CN112292717B (zh) 预测控制装置
US9463806B2 (en) Consistent behavior generation of a predictive advanced driver assistant system
US9878710B2 (en) Method for improving performance of a method for computationally predicting a future state of a target object, driver assistance system, vehicle including such driver assistance system and respective program storage medium and program
JP2020119517A (ja) 運転者を支援する方法、運転者支援システム、およびこのような運転者支援システムを備えた車両
JP6845529B2 (ja) 行動決定システム及び自動運転制御装置
CN108349494B (zh) 运行车辆的距离和速度调整功能的方法和执行该方法的驾驶员辅助系统
US11584393B2 (en) Method and system for planning the motion of a vehicle
KR101922240B1 (ko) 차량의 충돌 회피 제어 장치 및 방법
US11590968B2 (en) Methods and apparatus to mitigate hard-braking events
US11780466B1 (en) Vehicle fleet remote ride comfort tuning management system
US9776509B2 (en) Method and apparatus for adaptive cruise control in a road vehicle
US20220402491A1 (en) Adaptive cruise control
KR102376615B1 (ko) 주행 로봇의 제어 방법 및 그 장치
JP6702089B2 (ja) 車両の運動制御方法及び車両の運動制御装置
CN116653957A (zh) 一种变速变道方法、装置、设备及存储介质
Li et al. A novel cost function for decision-making strategies in automotive collision avoidance systems
JP6599817B2 (ja) 演算装置、演算方法およびプログラム
US11897506B1 (en) Vehicle ride dynamics active comfort tuning system
CN116805445B (zh) 车辆换道行驶控制方法及系统
US20220348194A1 (en) Evaluation apparatus for evaluating a trajectory hypothesis for a vehicle
US20240051573A1 (en) Systems and methods for controlled deceleration
JP2024047442A (ja) 自動運転装置
JP6809045B2 (ja) 車両の運動制御方法及び車両の運動制御装置

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20200706

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20210518

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20210705

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20210810

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20210831

R150 Certificate of patent or registration of utility model

Ref document number: 6937658

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150