JP2020026188A - Vehicle behavior prediction method and vehicle behavior prediction device - Google Patents

Vehicle behavior prediction method and vehicle behavior prediction device Download PDF

Info

Publication number
JP2020026188A
JP2020026188A JP2018151344A JP2018151344A JP2020026188A JP 2020026188 A JP2020026188 A JP 2020026188A JP 2018151344 A JP2018151344 A JP 2018151344A JP 2018151344 A JP2018151344 A JP 2018151344A JP 2020026188 A JP2020026188 A JP 2020026188A
Authority
JP
Japan
Prior art keywords
vehicle
control
travel plan
vehicle behavior
plan
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
JP2018151344A
Other languages
Japanese (ja)
Other versions
JP7091926B2 (en
Inventor
ファソン ジャン
Hwaseon Jang
ファソン ジャン
玉正 忠嗣
Tadatsugu Tamamasa
忠嗣 玉正
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.)
Nissan Motor Co Ltd
Original Assignee
Nissan Motor Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Nissan Motor Co Ltd filed Critical Nissan Motor Co Ltd
Priority to JP2018151344A priority Critical patent/JP7091926B2/en
Publication of JP2020026188A publication Critical patent/JP2020026188A/en
Application granted granted Critical
Publication of JP7091926B2 publication Critical patent/JP7091926B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
  • Vehicle Body Suspensions (AREA)

Abstract

To reduce control delay of a vehicle behavior.SOLUTION: In a vehicle behavior prediction method, a future travel plan of a vehicle is determined S10, an initial value of a candidate of controlled variables at a future time is determined S12, a vehicle behavior of a vehicle is predicted by inputting determined future travel plan and candidate of controlled variables into a prediction model obtained by modeling the vehicle behavior generated in the vehicle traveling along the future travel plan S13, cost is calculated by using a prescribed evaluation function based on the predicted vehicle behavior S14, and recalculation is performed until the candidate of the controlled variables is optimized S16.SELECTED DRAWING: Figure 6

Description

本発明は、車両挙動予測方法及び車両挙動予測装置に関する。   The present invention relates to a vehicle behavior prediction method and a vehicle behavior prediction device.

特許文献1には、ファジーニューラルネットワークによって学習した制御ルールに従い、ダンパー速度、上下加速度、ピッチ加速度及びロール加速度に基づいて、緩衝装置の減衰係数を制御する車両サスペンションシステムが提案されている。   Patent Literature 1 proposes a vehicle suspension system that controls a damping coefficient of a shock absorber based on a damper speed, a vertical acceleration, a pitch acceleration, and a roll acceleration according to a control rule learned by a fuzzy neural network.

特表2005−538886号公報JP-T-2005-538886

特許文献1に記載の技術では、現在の状態量であるダンパー速度、上下加速度、ピッチ加速度及びロール加速度に基づいてサスペンションの特性を制御する。
しかしながら、車両の状態は動的に変化するため、現在の状態量に基づいて制御すると、車両の状態が変化した後に制御が始まるので制御遅れが生じる。
本発明は、車両挙動の制御遅れを軽減することを目的とする。
According to the technology described in Patent Document 1, the characteristics of the suspension are controlled based on the current state quantities such as a damper speed, a vertical acceleration, a pitch acceleration, and a roll acceleration.
However, since the state of the vehicle changes dynamically, if control is performed based on the current state amount, control starts after the state of the vehicle changes, so that a control delay occurs.
An object of the present invention is to reduce a control delay of a vehicle behavior.

本発明の一態様に係る車両挙動予測方法では、車両の走行計画を決定し、走行計画に沿って走行する車両に発生する車両挙動をモデル化した予測モデルに、決定した走行計画を入力することにより、車両の車両挙動を予測する。   In the vehicle behavior prediction method according to one aspect of the present invention, a travel plan of a vehicle is determined, and the determined travel plan is input to a prediction model that models a vehicle behavior occurring in a vehicle traveling along the travel plan. Predicts the vehicle behavior of the vehicle.

本発明の態様によれば、走行計画で予定された将来の走行シーンに応じて、これから自車両に発生する車両挙動を予測することができる。このように将来の走行シーンが車両挙動に及ぼす影響を反映させることにより、将来の車両挙動の予測精度を向上することができる。この結果、より精度の高い予測結果に基づいて制御を開始することができるので、車両挙動の制御遅れを軽減できる。   According to the aspect of the present invention, it is possible to predict a vehicle behavior that will occur in the own vehicle from now on according to a future driving scene scheduled in the driving plan. By thus reflecting the influence of the future traveling scene on the vehicle behavior, the prediction accuracy of the future vehicle behavior can be improved. As a result, control can be started based on a more accurate prediction result, so that control delay of vehicle behavior can be reduced.

本発明の実施形態の走行支援装置の一例の概略構成図である。It is a schematic structure figure of an example of a run support device of an embodiment of the present invention. 図1のアクチュエータを有する能動型サスペンションの一例の概略構成図である。FIG. 2 is a schematic configuration diagram of an example of an active suspension having the actuator of FIG. 1. 圧力制御弁における指令電流と制御圧との関係を示す特性線図である。FIG. 4 is a characteristic diagram illustrating a relationship between a command current and a control pressure in the pressure control valve. 図1のコントローラの機能構成の一例を示すブロック図である。FIG. 2 is a block diagram illustrating an example of a functional configuration of a controller in FIG. 1. 図4の状態予測器の学習処理の一例を示すフローチャートである。5 is a flowchart illustrating an example of a learning process of the state predictor in FIG. 4. 図4のコントローラによる制御処理の一例を示すフローチャートである。5 is a flowchart illustrating an example of a control process performed by the controller in FIG. 4. 平坦路から不整路へ進入した場合のバネ上加速度の時間変化を示すグラフである。It is a graph which shows the time change of the sprung acceleration when it enters into an irregular road from a flat road. 平坦路から不整路へ進入した場合のバネ上速度の時間変化を示すグラフである。It is a graph which shows a time change of the sprung speed at the time of approaching from a flat road to an irregular road. 平坦路から不整路へ進入した場合のバネ上変位の時間変化を示すグラフである。It is a graph which shows the time change of the sprung displacement when it enters an irregular road from a flat road.

以下、本発明の実施形態について、図面を参照しつつ説明する。なお、各図面は模式的なものであって、現実のものとは異なる場合がある。また、以下に示す本発明の実施形態は、本発明の技術的思想を具体化するための装置や方法を例示するものであって、本発明の技術的思想は、構成部品の構造、配置等を下記のものに特定するものではない。本発明の技術的思想は、特許請求の範囲に記載された請求項が規定する技術的範囲内において、種々の変更を加えることができる。   Hereinafter, embodiments of the present invention will be described with reference to the drawings. Note that the drawings are schematic and may differ from actual ones. The embodiments of the present invention described below exemplify an apparatus and a method for embodying the technical idea of the present invention. Is not specified as: The technical idea of the present invention can be variously modified within the technical scope defined by the claims described in the claims.

(構成)
図1を参照する。走行支援装置1は、自車両の車両挙動を予測し、予測した車両挙動に基づいて自車両に搭載されたアクチュエータを制御することにより、自車両の車両挙動を制御する。
走行支援装置1は、車外環境センサ2と、車両センサ3と、ナビゲーションシステム4と、走行制御装置5と、アクチュエータ6と、コントローラ7を備える。
(Constitution)
Please refer to FIG. The driving support device 1 controls the vehicle behavior of the host vehicle by predicting the vehicle behavior of the host vehicle and controlling an actuator mounted on the host vehicle based on the predicted vehicle behavior.
The driving support device 1 includes an external environment sensor 2, a vehicle sensor 3, a navigation system 4, a driving control device 5, an actuator 6, and a controller 7.

車外環境センサ2は、自車両の外側の車外環境を検出するセンサである。
車外環境センサ2は、例えばレーザレンジファインダ(LRF:Laser Range-Finder)やレーダなどの測距装置であってよい。測距装置は、例えば、自車両周囲に存在する物体、自車両と物体との相対位置、自車両と物体との距離を検出する。
また、測距装置は、自車両の前方の路面までの距離を検出する。自車両が前方に進行するのに伴って自車両の前方の路面を走査することにより、路面荒さを測定できる。
測距装置は、検出した測距データを走行制御装置5及びコントローラ7へ出力する。
The external environment sensor 2 is a sensor that detects an external environment outside the host vehicle.
The external environment sensor 2 may be a distance measuring device such as a laser range finder (LRF) or a radar. The distance measuring device detects, for example, an object existing around the own vehicle, a relative position between the own vehicle and the object, and a distance between the own vehicle and the object.
Further, the distance measuring device detects a distance to a road surface ahead of the own vehicle. The road surface roughness can be measured by scanning the road surface ahead of the host vehicle as the host vehicle moves forward.
The ranging device outputs the detected ranging data to the travel control device 5 and the controller 7.

車外環境センサ2は、例えばステレオカメラや単眼カメラ等のカメラであってもよい。カメラは、自車両の周囲に存在する物体や、車線境界線(例えば白線)などの道路標示、縁石やガードレール等の地物、前方の路面などを撮影した撮影データを走行制御装置5及びコントローラ7へ出力する。   The environment sensor 2 outside the vehicle may be a camera such as a stereo camera or a monocular camera. The camera captures image data of objects existing around the vehicle, road markings such as lane boundary lines (for example, white lines), features such as curbs and guardrails, and road surfaces ahead of the vehicle. Output to

車両センサ3は、自車両のバネ上の車体の6軸運動、及びバネ下の上下方向、左右方向及び前後方向の3軸運動を自車両の現在の状態として検出する。以下、上下方向、左右方向及び前後方向の3軸運動を「バウンス」と表記する。
例えば車両センサ3は、バネ上のバウンスの加速度と、バネ上のピッチ角速度、ロール角速度、及びヨー角速度と、バネ下のバウンスの加速度を検出してよい。
The vehicle sensor 3 detects the six-axis movement of the vehicle body on the spring of the own vehicle and the three-axis movement of the unsprung part in the vertical direction, the left-right direction, and the front-back direction as the current state of the own vehicle. Hereinafter, the three-axis movement in the up-down direction, the left-right direction, and the front-back direction is referred to as “bounce”.
For example, the vehicle sensor 3 may detect a bounce acceleration on a spring, a pitch angular velocity, a roll angular velocity, and a yaw angular velocity on a spring, and an unsprung bounce acceleration on a spring.

車両センサ3は、バウンスの加速度に代えて変位を検出してもよく速度を検出してもよい。
車両センサ3は、ピッチ角速度、ロール角速度、及びヨー角速度に代えて、ピッチ角変位、ロール角変位、及びヨー角変位を検出してもよく、ピッチ角加速度、ロール角加速度、及びヨー角加速度を検出してもよい。
The vehicle sensor 3 may detect displacement or speed instead of the bounce acceleration.
The vehicle sensor 3 may detect a pitch angular displacement, a roll angular displacement, and a yaw angular displacement instead of the pitch angular velocity, the roll angular velocity, and the yaw angular velocity, and may detect the pitch angular acceleration, the roll angular acceleration, and the yaw angular acceleration. It may be detected.

また、車両センサ3は、自車両の車輪速を検出する車輪速センサを含んでもよい。
さらに、車両センサ3は、自車両の車室内の状態として、車室内の乗員の配置、重さ及び動き、並びに車室内の荷物の配置、重さ、動きを検出するカメラや圧力センサを含んでもよい。
車両センサ3は、自車両の現在の状態を示す車両状態信号を走行制御装置5及びコントローラ7へ出力する。
Further, the vehicle sensor 3 may include a wheel speed sensor that detects a wheel speed of the own vehicle.
Further, the vehicle sensor 3 may include a camera and a pressure sensor for detecting the layout, weight, and movement of the occupant in the vehicle interior, and the arrangement, weight, and movement of the luggage in the vehicle interior, as the state of the interior of the vehicle. Good.
The vehicle sensor 3 outputs a vehicle state signal indicating the current state of the host vehicle to the travel control device 5 and the controller 7.

ナビゲーションシステム4は、自車両の現在位置と、その現在位置における道路地図情報を認識し、乗員が入力した目的地までの走行経路を設定する。
ナビゲーションシステム4は、ナビコントローラと、測位装置と、地図データベースと、通信部を備える。
ナビコントローラは、ナビゲーションシステム4の情報処理動作を制御する電子制御ユニット(ECU:Electronic Control Unit)である。
The navigation system 4 recognizes the current position of the vehicle and road map information at the current position, and sets a traveling route to the destination entered by the occupant.
The navigation system 4 includes a navigation controller, a positioning device, a map database, and a communication unit.
The navigation controller is an electronic control unit (ECU: Electronic Control Unit) that controls the information processing operation of the navigation system 4.

測位装置は、自車両の現在位置を測定する。測位装置は、例えば複数の航法衛星から電波を受信して自車両の現在位置を取得するGPS受信機や、GPS受信機以外の他の全地球型測位システム(GNSS)受信機である。測位装置は、慣性航法装置であってもよい。
地図データベースは、地図情報を記憶している。地図情報には、ノードとリンクで示される道路地図と、道路地図座標における道路種別(例えば一般道路や高速道路)、道路幅、道路形状、勾配、車線数、法定速度(制限速度)に関する情報とが少なくとも含まれている。例えば、道路地図における道路は道路ごとにリンク番号で識別されており、リンク番号ごとに道路種別、道路幅、道路形状、勾配、車線数、法定速度(制限速度)に関する情報が対応づけられている。さらに、各道路の車線ごとにリンク番号は設定されている。
The positioning device measures the current position of the host vehicle. The positioning device is, for example, a GPS receiver that receives radio waves from a plurality of navigation satellites to obtain the current position of the vehicle, or a global positioning system (GNSS) receiver other than the GPS receiver. The positioning device may be an inertial navigation device.
The map database stores map information. The map information includes a road map indicated by nodes and links, information on a road type (for example, a general road or an expressway), road width, road shape, gradient, number of lanes, legal speed (speed limit) in road map coordinates. Is included at least. For example, a road in a road map is identified by a link number for each road, and information on a road type, a road width, a road shape, a gradient, the number of lanes, and a legal speed (speed limit) is associated with each link number. . Further, a link number is set for each lane of each road.

通信部は、自車両の外部の通信装置との間で無線通信を行う。通信部による通信方式は、例えば公衆携帯電話網による無線通信や、車車間通信、路車間通信、又は衛星通信であってよい。
ナビゲーションシステム4は、通信部によって外部装置から道路地図データや、自車両の外側の車外環境の情報を取得してもよい。ナビゲーションシステム4は、例えば車外環境として、自車両の周囲の風の向きや風の強さの情報を取得してよい。
The communication unit performs wireless communication with a communication device outside the own vehicle. The communication method by the communication unit may be, for example, wireless communication using a public mobile phone network, vehicle-to-vehicle communication, road-to-vehicle communication, or satellite communication.
The navigation system 4 may acquire road map data and information on the environment outside the host vehicle from the external device by the communication unit. The navigation system 4 may acquire information on the direction and strength of the wind around the own vehicle, for example, as the environment outside the vehicle.

ナビゲーションシステム4は、自車両の現在位置から乗員が入力した目的地までの走行経路(予定の経路)を設定し、この走行経路に従って乗員に経路案内を行う。
さらにナビゲーションシステム4は、設定した走行経路の情報を、自車両の将来の走行計画として走行制御装置5及びコントローラ7へ出力する。
例えば、ナビゲーションシステム4は、設定した走行経路の地図情報を走行制御装置5及びコントローラ7へ出力する。
さらに、ナビゲーションシステム4は、通信部によって外部装置から取得した車外環境の情報をコントローラ7へ出力する。
The navigation system 4 sets a traveling route (scheduled route) from the current position of the vehicle to the destination input by the occupant, and provides route guidance to the occupant according to the traveling route.
Further, the navigation system 4 outputs the information of the set traveling route to the traveling control device 5 and the controller 7 as a future traveling plan of the own vehicle.
For example, the navigation system 4 outputs map information of the set traveling route to the traveling control device 5 and the controller 7.
Further, the navigation system 4 outputs information on the environment outside the vehicle acquired from the external device by the communication unit to the controller 7.

アクチュエータ6は、走行制御装置5又はコントローラ7からの電気的な制御信号を機械的な運動に変換して自車両の車両挙動を制御する駆動装置である。
例えば、アクチュエータ6は、自動運転時に走行制御装置5からの制御信号に応じて自車両の操舵角度、アクセル開度、制動量を変更するためのステアリングアクチュエータ、アクセル開度アクチュエータ、ブレーキ制御アクチュエータであってもよい。
The actuator 6 is a drive device that converts an electrical control signal from the travel control device 5 or the controller 7 into a mechanical motion and controls the behavior of the host vehicle.
For example, the actuator 6 is a steering actuator, an accelerator opening actuator, and a brake control actuator for changing a steering angle, an accelerator opening, and a braking amount of the own vehicle according to a control signal from the traveling control device 5 during automatic driving. You may.

また、例えばアクチュエータ6は、車体側部材と車輪側部材との間に介装された能動型サスペンション8に設けられ、コントローラ7からの制御信号に応じて作動圧が調整される油圧シリンダであってもよい。
図2を参照する。参照符号10は車体側部材を、参照符号11FL〜11RRは前左〜後右車輪をそれぞれ示す。
能動型サスペンション8は、車体側部材10と車輪11FL〜11RRの各車輪側部材14との間に各々介装されたアクチュエータとしての油圧シリンダ18FL〜18RRと、これら油圧シリンダ18FL〜18RRの作動圧を個別に調整する圧力制御弁20FL〜20RRを備える。
Also, for example, the actuator 6 is a hydraulic cylinder that is provided on an active suspension 8 interposed between a vehicle body-side member and a wheel-side member and that adjusts an operating pressure in accordance with a control signal from a controller 7. Is also good.
Please refer to FIG. Reference numeral 10 indicates a vehicle body side member, and reference numerals 11FL to 11RR indicate front left to rear right wheels, respectively.
The active suspension 8 includes hydraulic cylinders 18FL to 18RR as actuators interposed between the vehicle body-side member 10 and the wheel-side members 14 of the wheels 11FL to 11RR, and the operating pressure of the hydraulic cylinders 18FL to 18RR. The pressure control valves 20FL to 20RR which are individually adjusted are provided.

また、能動型サスペンション8は、これら圧力制御弁20FL〜20RRに所定圧力の作動油を供給側配管21Sを介して供給すると共に、圧力制御弁20FL〜20RRからの戻り油を戻り側配管21Rを通じて回収する油圧源22と、この油圧源22及び圧力制御弁20FL〜20RR間の供給側配管21Sに介挿された蓄圧用のアキュムレータ24F,24Rを備える。   In addition, the active suspension 8 supplies working oil of a predetermined pressure to the pressure control valves 20FL to 20RR through the supply pipe 21S, and collects return oil from the pressure control valves 20FL to 20RR through the return pipe 21R. And a pressure accumulator 24F, 24R interposed in the supply side pipe 21S between the hydraulic source 22 and the pressure control valves 20FL to 20RR.

油圧シリンダ18FL〜18RRのそれぞれは、シリンダチューブ18aを有し、このシリンダチューブ18aには、軸方向に貫通孔を有するピストン18cにより隔設された下側の圧力室Lが形成され、ピストン18cの上下面の受圧面積差と内圧とに応じた推力を発生する。そして、シリンダチューブ18aの下端が車輪側部材14に取付けられ、ピストンロッド18bの上端が車体側部材10に取付けられている。   Each of the hydraulic cylinders 18FL to 18RR has a cylinder tube 18a, and the cylinder tube 18a is formed with a lower pressure chamber L separated by a piston 18c having a through hole in the axial direction. A thrust is generated according to the pressure receiving area difference between the upper and lower surfaces and the internal pressure. The lower end of the cylinder tube 18a is attached to the wheel side member 14, and the upper end of the piston rod 18b is attached to the vehicle body side member 10.

また、圧力室Lの各々は、油圧配管38を介して圧力制御弁20FL〜20RRの出力ポートに接続されている。また、油圧シリンダ18FL〜18RRの圧力室Lの各々は、絞り弁32を介してバネ下振動吸収用のアキュムレータ34に接続されている。また、油圧シリンダ18FL〜18RRの各々のバネ上,バネ下相当間には、比較的低いバネ定数であって車体の静荷重を支持するコイルスプリング36が配設されている。
圧力制御弁20FL〜20RRのそれぞれは、スプールを摺動自在に内装した円筒状の弁ハウジングとこれに一体的に設けられた比例ソレノイドとを有する3ポート比例電磁減圧弁で構成されている。
Each of the pressure chambers L is connected to output ports of the pressure control valves 20FL to 20RR via a hydraulic pipe 38. In addition, each of the pressure chambers L of the hydraulic cylinders 18FL to 18RR is connected to an accumulator 34 for absorbing unsprung vibration via a throttle valve 32. A coil spring 36 having a relatively low spring constant and supporting a static load of the vehicle body is disposed between the upper and lower portions of each of the hydraulic cylinders 18FL to 18RR.
Each of the pressure control valves 20FL to 20RR is constituted by a 3-port proportional electromagnetic pressure reducing valve having a cylindrical valve housing having a spool slidably mounted therein and a proportional solenoid integrally provided therewith.

比例ソレノイドの励磁コイルに供給する指令電流i(制御量)を調整することにより、弁ハウジング内に収容されたポペットの移動距離、すなわちスプールの位置が制御される。これにより、供給ポート及び出力ポート又は出力ポート及び戻りポートを介して油圧源22と油圧シリンダ18FL〜18RRとの間で流通する作動油が制御されるようになっている。   By adjusting the command current i (control amount) supplied to the exciting coil of the proportional solenoid, the moving distance of the poppet accommodated in the valve housing, that is, the position of the spool is controlled. Thereby, the working oil flowing between the hydraulic power source 22 and the hydraulic cylinders 18FL to 18RR via the supply port and the output port or the output port and the return port is controlled.

図3は、励磁コイルに加えられる指令電流i(:iFL〜iRR)と圧力制御弁20FL(〜20RR)の出力ポートから出力される制御圧Pとの関係を示す。ノイズを考慮した最小電流値iMINのときには、制御圧Pは最低制御圧PMINとなり、この状態から電流値iを増加させると、電流値iに比例して直線的に制御圧Pが増加し、最大電流値iMAXのときには、油圧源22の設定ライン圧に相当する最高制御圧PMAXとなる。参照符号iNは中立指令電流,参照符号PNは中立制御圧を示す。   FIG. 3 shows the relationship between the command current i (: iFL to iRR) applied to the exciting coil and the control pressure P output from the output port of the pressure control valve 20FL (to 20RR). At the time of the minimum current value iMIN in consideration of noise, the control pressure P becomes the minimum control pressure PMIN. When the current value i is increased from this state, the control pressure P increases linearly in proportion to the current value i, When the current value is iMAX, the maximum control pressure PMAX is equivalent to the set line pressure of the hydraulic power source 22. Reference numeral iN indicates a neutral command current, and reference numeral PN indicates a neutral control pressure.

図1を参照する。走行制御装置5は、自車の自動運転制御を行う電子制御ユニットである。この「自動運転」は、自車両の走行制御を全て自動で行う「完全自動運転」のみならず、走行制御を部分的に自動で行う「部分自動運転」や「運転支援」も含む概念である。
走行制御装置5は、自車両の自動運転時に、車外環境センサ2から入力した測距データや自車両周囲の撮影データ、車両センサ3から入力した車両状態信号に基づいて、ナビゲーションシステム4により設定された走行経路を自車に走行させる走行軌道(トラジェクトリ)を生成する。
Please refer to FIG. The traveling control device 5 is an electronic control unit that performs automatic driving control of the own vehicle. This “automatic driving” is a concept that includes not only “fully automatic driving” in which all traveling control of the own vehicle is automatically performed, but also “partially automatic driving” and “driving assistance” in which traveling control is partially automatically performed. .
The travel control device 5 is set by the navigation system 4 based on distance measurement data input from the external environment sensor 2, photographing data around the own vehicle, and a vehicle state signal input from the vehicle sensor 3 during automatic driving of the own vehicle. A traveling trajectory (trajectory) for causing the own vehicle to travel along the traveling route is generated.

走行軌道を生成する際に、走行制御装置5は、まず走行経路上を自動で自車に走行させるための運転行動計画を決定する。
運転行動計画とは、自車両を走行させるレーン(車線)と、このレーンを走行させるのに要する運転行動とを定めた、中長距離の範囲におけるレーンレベル(車線レベル)での運転行動の計画である。例えば運転行動計画は、前方に存在する交差点を右折するシーンにおいて、交差点の手前何m地点で右折レーンに車線変更するか等の運転行動を定めた計画である。
When generating the traveling trajectory, the traveling control device 5 first determines a driving action plan for automatically causing the own vehicle to travel on the traveling route.
The driving action plan is a plan of driving action at a lane level (lane level) in a medium-long distance range, which defines a lane (lane) for driving the own vehicle and a driving action required for driving the lane. It is. For example, the driving action plan is a plan that defines a driving action such as how many meters before the intersection to change lanes to a right-turn lane in a scene where a right turn is made at an intersection existing ahead.

そして、走行制御装置5は、運転行動計画に従って自車両を走行させるための軌道候補を、自車両の運動特性などに基づいて生成する。走行制御装置5は、軌道候補の各々の将来リスクを評価して、最適な軌道を選択し、自車に走行させる走行軌道として設定する。走行軌道は、目標操舵角のほか、速度計画やそのための加減速を含む。   Then, the travel control device 5 generates a track candidate for causing the own vehicle to travel according to the driving action plan based on the motion characteristics of the own vehicle. The travel control device 5 evaluates the future risk of each of the track candidates, selects an optimal track, and sets it as a travel track to be driven by the own vehicle. The traveling trajectory includes a target steering angle, a speed plan, and acceleration / deceleration for that purpose.

走行制御装置5は、選択した走行軌道に基づいてアクチュエータ6(例えば、ステアリングアクチュエータ、アクセル開度アクチュエータ、及び/又はブレーキ制御アクチュエータ)を制御する。
具体的には、走行制御装置5は、走行軌道を追従する一連の車両挙動を発生するアクチュエータ6の制御量の時系列を算出して、算出した制御量をアクチュエータ6へ逐次出力する。
以下、走行制御装置5により算出されるアクチュエータ6の制御量を「ACR制御量」と表記する。
The traveling control device 5 controls the actuator 6 (for example, a steering actuator, an accelerator opening actuator, and / or a brake control actuator) based on the selected traveling trajectory.
Specifically, the traveling control device 5 calculates a time series of the control amount of the actuator 6 that generates a series of vehicle behaviors following the traveling trajectory, and sequentially outputs the calculated control amount to the actuator 6.
Hereinafter, the control amount of the actuator 6 calculated by the traveling control device 5 is referred to as “ACR control amount”.

走行制御装置5は、運転行動計画及び走行軌道を、自車両の走行計画としてコントローラ7へ出力する。
走行制御装置5は、ACR制御量の時系列を自車両の走行計画としてコントローラ7へ出力する。
さらに走行制御装置5は、走行制御装置5により行われる予定の自動運転制御の自動運転レベルを走行計画としてコントローラ7へ出力する。
The traveling control device 5 outputs the driving action plan and the traveling trajectory to the controller 7 as the traveling plan of the own vehicle.
The travel control device 5 outputs the time series of the ACR control amount to the controller 7 as a travel plan of the own vehicle.
Further, the travel control device 5 outputs the automatic operation level of the automatic operation control scheduled to be performed by the travel control device 5 to the controller 7 as a travel plan.

自動運転レベルは、例えば、運転者による走行状態の監視を要しないレベルや、運転者による走行状態の監視を要するレベルを含んでよい。また、自動運転レベルは、例えば「完全自動運転」、「部分自動運転」、「運転支援」を含んでもよい。
一例として、アメリカ国家交通安全協会(NHTSA:National Highway Traffic Safety Administration)によって制定された基準に従う自動運転レベルによれば、運転者による走行状態の監視を要しないレベルは自動運転レベル3以上であり、運転者による走行状態の監視を要するレベルは自動運転レベル2以下であり、完全自動運転は、自動運転レベル3以上であり、部分自動運転は自動運転レベル2であり、運転支援は自動運転レベル1である。
The automatic driving level may include, for example, a level that does not require the driver to monitor the traveling state and a level that requires the driver to monitor the traveling state. The automatic driving level may include, for example, “fully automatic driving”, “partial automatic driving”, and “driving assistance”.
As an example, according to the automatic driving level according to the standards established by the National Highway Traffic Safety Administration (NHTSA), the level that does not require the driver to monitor the driving state is the automatic driving level 3 or more, The level at which the driver needs to monitor the driving state is automatic driving level 2 or lower, fully automatic driving is automatic driving level 3 or higher, partial automatic driving is automatic driving level 2 and driving support is automatic driving level 1 It is.

コントローラ7は、車外環境センサ2から入力した測距データや自車両周囲の撮影データ、車両センサ3から入力した車両状態信号、ナビゲーションシステム4から入力した走行計画及び車外環境の情報、走行制御装置5から入力した走行計画に基づいてアクチュエータ6を駆動し、自車両の車両挙動を制御する電子制御ユニットである。   The controller 7 includes distance measurement data input from the external environment sensor 2 and photographing data around the own vehicle, a vehicle state signal input from the vehicle sensor 3, travel plan and external environment information input from the navigation system 4, and a travel control device 5 This is an electronic control unit that drives the actuator 6 based on the travel plan input from the vehicle and controls the behavior of the host vehicle.

コントローラ7は、CPU(Central Processing Unit)、やMPU(Micro-Processing Unit)などのプロセッサと、記憶装置等の周辺部品とを含む。
記憶装置は、半導体記憶装置、磁気記憶装置及び光学記憶装置のいずれかを備えてよい。記憶装置は、レジスタ、キャッシュメモリ、主記憶装置として使用されるROM(Read Only Memory)及びRAM(Random Access Memory)等のメモリを含んでよい。
The controller 7 includes a processor such as a CPU (Central Processing Unit) and an MPU (Micro-Processing Unit), and peripheral components such as a storage device.
The storage device may include any of a semiconductor storage device, a magnetic storage device, and an optical storage device. The storage device may include a register, a cache memory, and a memory such as a ROM (Read Only Memory) and a RAM (Random Access Memory) used as a main storage device.

プロセッサは、記憶装置に格納されるコンピュータプログラムを実行することにより、以下に説明するコントローラ7の機能を実現する。
なお、汎用の半導体集積回路中に設定される機能的な論理回路でコントローラ7を実現してもよい。例えばコントローラ7は、フィールド・プログラマブル・ゲート・アレイ(FPGA:Field-Programmable Gate Array)等のプログラマブル・ロジック・デバイス(PLD:Programmable Logic Device)等を有していてもよい。
The processor realizes functions of the controller 7 described below by executing a computer program stored in the storage device.
The controller 7 may be realized by a functional logic circuit set in a general-purpose semiconductor integrated circuit. For example, the controller 7 may include a programmable logic device (PLD: Programmable Logic Device) such as a field-programmable gate array (FPGA).

本実施形態では、コントローラ7が、自車両の車両挙動を制御するアクチュエータとして能動型サスペンション8の油圧シリンダ18FL〜18RRの作動圧を調整し、能動型サスペンション8の特性を変化させる例について説明する。
具体的には、コントローラ7は、圧力制御弁20FL〜20RRの指令電流i(制御量)を調整して油圧シリンダ18FL〜18RRが発生する推力を制御することにより、自車両の車体挙動を制御する。例えば車体の上下振動を抑制するように自車両の車体挙動を制御する。
In the present embodiment, an example will be described in which the controller 7 adjusts the operating pressure of the hydraulic cylinders 18FL to 18RR of the active suspension 8 as an actuator for controlling the vehicle behavior of the host vehicle, and changes the characteristics of the active suspension 8.
Specifically, the controller 7 controls the vehicle body behavior of the own vehicle by adjusting the command current i (control amount) of the pressure control valves 20FL to 20RR to control the thrust generated by the hydraulic cylinders 18FL to 18RR. . For example, the vehicle body behavior of the own vehicle is controlled so as to suppress the vertical vibration of the vehicle body.

図4を参照してコントローラ7の機能構成を説明する。コントローラ7は、実施形態の車両挙動予測装置40を構成する。車両挙動予測装置40は、車両情報取得部41と、車外情報取得部42と、走行計画取得部43と、モデル予測制御部44を備える。
車両情報取得部41は、車両センサ3から出力される車両状態信号に基づいて車両の状態を示す車両状態情報を取得する。
The functional configuration of the controller 7 will be described with reference to FIG. The controller 7 constitutes the vehicle behavior prediction device 40 of the embodiment. The vehicle behavior prediction device 40 includes a vehicle information acquisition unit 41, an outside-of-vehicle information acquisition unit 42, a travel plan acquisition unit 43, and a model prediction control unit 44.
The vehicle information acquisition unit 41 acquires vehicle state information indicating the state of the vehicle based on the vehicle state signal output from the vehicle sensor 3.

車両状態情報は、例えば、横方向加速度、並びにロール軸まわり及びヨー軸まわりの変位、速度及び加速度の情報を含んでよい。
車両状態信号が変位情報である場合、車両情報取得部41は、変位情報を微分することにより速度情報と加速度情報を取得できる。
車両状態信号が速度情報である場合、車両情報取得部41は、速度情報を積分することにより変位情報を取得し、速度情報を微分することにより加速度情報を取得できる。
車両状態信号が加速度情報である場合、車両情報取得部41は、加速度情報を積分することにより変位情報と速度情報を取得できる。
The vehicle state information may include, for example, lateral acceleration, and information on displacement, velocity, and acceleration around the roll axis and the yaw axis.
When the vehicle state signal is displacement information, the vehicle information acquisition unit 41 can acquire speed information and acceleration information by differentiating the displacement information.
When the vehicle state signal is speed information, the vehicle information obtaining unit 41 can obtain displacement information by integrating the speed information, and can obtain acceleration information by differentiating the speed information.
When the vehicle state signal is acceleration information, the vehicle information acquisition unit 41 can acquire displacement information and speed information by integrating the acceleration information.

また、車両情報取得部41は、ACR制御量の現在値を車両状態情報として走行制御装置5から取得してよい。
また、車両情報取得部41は、車両状態情報は、車室内の乗員の配置、重さ及び動き、並びに車室内の配置、重さ、動きなどの車室内の状態を示す車内情報を取得する。
車両情報取得部41は、取得した車両状態情報及び車内情報をモデル予測制御部44へ出力する。
Further, the vehicle information acquisition unit 41 may acquire the current value of the ACR control amount from the travel control device 5 as vehicle state information.
Further, the vehicle information acquisition unit 41 acquires, as the vehicle state information, in-vehicle information indicating the layout, weight, and movement of the occupant in the vehicle interior, and the state of the vehicle interior such as the layout, weight, and movement of the vehicle interior.
The vehicle information acquisition unit 41 outputs the acquired vehicle state information and the in-vehicle information to the model prediction control unit 44.

車外情報取得部42は、車外環境センサ2から出力される測距データや自車両周囲の撮影データ、及び車両センサ3から出力される車両状態信号に基づいて、自車両の外側の車外環境を示す車外環境情報を取得する。
車外環境情報は、例えば、自車両の前方の路面の路面荒さ、路面に発生している路面振動、自車両の前方の路面の路面摩擦係数を含んでよい。
The outside-of-vehicle information acquisition unit 42 indicates the outside environment of the host vehicle based on the distance measurement data output from the external environment sensor 2 and the photographing data around the host vehicle, and the vehicle state signal output from the vehicle sensor 3. Acquire outside environment information.
The external environment information may include, for example, the road surface roughness of the road surface ahead of the host vehicle, the road surface vibration occurring on the road surface, and the road surface friction coefficient of the road surface ahead of the host vehicle.

車外情報取得部42は、車外環境センサ2から出力される測距データや自車両周囲の撮影データに基づいて、自車両の前方の路面の路面荒さ及び路面に発生している路面振動を取得する。
車外情報取得部42は、自車両の車輪速から自車両の加速度とタイヤのスリップ率を演算し、加速度とスリップ率の回帰係数に基づいて路面摩擦係数を取得する。
The outside-of-vehicle information acquisition unit 42 acquires the road surface roughness of the road surface ahead of the host vehicle and the road surface vibration occurring on the road surface based on the distance measurement data output from the external environment sensor 2 and the photographing data around the host vehicle. .
The external information acquisition unit 42 calculates the acceleration of the vehicle and the slip ratio of the tire from the wheel speed of the vehicle, and acquires the road surface friction coefficient based on the regression coefficient of the acceleration and the slip ratio.

また、車外情報取得部42は、ナビゲーションシステム4の通信部によって外部装置から車外環境情報を取得してよい。例えば、車外情報取得部42は、自車両の周囲の風の向きや風の強さを示す車外環境情報を外部装置から取得してよい。
車外情報取得部42は、取得した車外環境情報をモデル予測制御部44へ出力する。
In addition, the outside-of-vehicle information acquisition unit 42 may acquire outside-of-vehicle environment information from an external device by the communication unit of the navigation system 4. For example, the outside-of-vehicle information acquiring unit 42 may acquire outside-of-vehicle environment information indicating the direction and strength of wind around the own vehicle from an external device.
The outside-of-vehicle information acquisition unit 42 outputs the acquired outside-of-vehicle environment information to the model prediction control unit 44.

走行計画取得部43は、ナビゲーションシステム4により設定された設定経路、及びその地図情報を走行計画として取得する。
また、走行計画取得部43は、走行制御装置5が決定した運転行動計画、及び走行軌道を走行計画として取得する。
The travel plan acquisition unit 43 acquires the set route set by the navigation system 4 and its map information as a travel plan.
Further, the traveling plan acquisition unit 43 acquires the driving action plan determined by the traveling control device 5 and the traveling trajectory as the traveling plan.

また、走行計画取得部43は、走行制御装置5が算出したACR制御量の時系列を、走行計画として取得する。
また、走行計画取得部43は、走行制御装置5により行われる予定の自動運転制御の自動運転レベルを走行計画として取得する。
Further, the travel plan acquisition unit 43 acquires a time series of the ACR control amount calculated by the travel control device 5 as a travel plan.
In addition, the travel plan obtaining unit 43 obtains, as the travel plan, the automatic driving level of the automatic driving control scheduled to be performed by the driving control device 5.

さらに、走行計画取得部43は、走行制御装置5が決定した走行軌道上を自車両が走行した時に発生すると予測される横方向加速度の予測値を走行計画として算出する。
走行計画取得部43は、取得した走行計画をモデル予測制御部44へ出力する。
Further, the travel plan acquisition unit 43 calculates, as the travel plan, a predicted value of the lateral acceleration that is predicted to occur when the host vehicle travels on the travel track determined by the travel control device 5.
The travel plan acquisition unit 43 outputs the acquired travel plan to the model prediction control unit 44.

モデル予測制御部44は、上記の車両状態情報、車内情報、車外環境情報及び走行計画に基づくモデル予測制御を行い、能動型サスペンション8の圧力制御弁20FL〜20RRの制御量を制御する。以下、モデル予測制御部44により制御される圧力制御弁20FL〜20RRの制御量を単に「制御量」と表記する。   The model prediction control unit 44 performs model prediction control based on the vehicle state information, the in-vehicle information, the out-of-vehicle environment information, and the travel plan, and controls the control amounts of the pressure control valves 20FL to 20RR of the active suspension 8. Hereinafter, the control amount of the pressure control valves 20FL to 20RR controlled by the model prediction control unit 44 will be simply referred to as “control amount”.

モデル予測制御では、現時刻から未来の有限区間(予測区間)にわたる制御対象の状態を予測する。
具体的には、予測区間の長さをTpとして、現時刻t0から時刻Tp先の区間の時刻t0、t0+1、…、t0+Tpにおける制御対象への入力に基づいて、時刻t0+1、t0+2、…、t0+Tp+1における制御対象の状態を予測する。
そして、予測した時刻t0+1、t0+2、…、t0+Tp+1における状態に基づいて、予測区間における制御性能を示す評価関数を算出し、この評価関数を最小にする制御量を、最適化問題等を用いて探索する。
In the model predictive control, the state of the control target over a finite section (prediction section) from the current time to the future is predicted.
Specifically, assuming that the length of the prediction section is Tp, based on the input to the control target at times t0, t0 + 1,. The state of the control target in is predicted.
Then, based on the predicted states at times t0 + 1, t0 + 2,..., T0 + Tp + 1, an evaluation function indicating the control performance in the prediction section is calculated, and a control amount that minimizes the evaluation function is searched for using an optimization problem or the like. I do.

モデル予測制御部44は、状態予測器50と、評価部51と、最適化部52と、を備える。
状態予測器50は、現時刻t0の自車両の状態及び自車両の周囲の車外環境と、時刻t0、t0+1、…、t0+Tpにおける自車両の走行計画及び制御量の候補を入力して、時刻t0+1、t0+2、…、t0+Tp+1における自車両の状態を車両挙動として予測する。
このため、状態予測器50は、自車両が走行する予定の走行計画(将来の走行計画)と、制御量と、現時刻の自車両の状態及び車外環境に応じて発生する自車両の車両挙動がモデル化された予測モデルを有する。
The model prediction control unit 44 includes a state predictor 50, an evaluation unit 51, and an optimization unit 52.
The state predictor 50 inputs the state of the own vehicle at the current time t0 and the outside environment around the own vehicle, and the candidates of the travel plan and the control amount of the own vehicle at times t0, t0 + 1,..., T0 + Tp, and inputs the time t0 + 1. , T0 + 2,..., T0 + Tp + 1 are predicted as the vehicle behavior.
For this reason, the state predictor 50 calculates the vehicle behavior of the own vehicle generated according to the travel plan (future travel plan) in which the own vehicle is to be run, the control amount, the current state of the own vehicle, and the environment outside the vehicle. Has a modeled prediction model.

予測モデルは、例えば、自車両が走行する予定の走行計画と、制御量と、現時刻の自車両の状態及び車外環境に応じて発生する自車両の車両挙動が、微分方程式によって表現されたモデルであってよい。
また、予測モデルは、例えば、実際に走行計画に沿って自車両を走行させることにより、自車両が走行する予定の走行計画と、制御量と、現時刻の自車両の状態及び車外環境に応じて自車両に発生した車両挙動を学習した深層ニューラルネットワーク(DNN:Deep Neural Network)であってもよい。
The prediction model is, for example, a driving plan in which the host vehicle is scheduled to run, a control amount, and a vehicle behavior of the host vehicle generated according to the state of the host vehicle and the environment outside the vehicle at the current time, and a model in which a differential equation is expressed. It may be.
Further, the prediction model is based on, for example, actually driving the own vehicle in accordance with the running plan, according to the running plan in which the own vehicle is to run, the control amount, the state of the own vehicle at the current time, and the environment outside the vehicle. It may be a deep neural network (DNN: Deep Neural Network) that learns the behavior of the vehicle that has occurred in the own vehicle.

状態予測器50は、車両情報取得部41から現時刻t0の車両状態情報及び車内情報を入力する。状態予測器50は、車外情報取得部42から現時刻t0の車外環境情報を入力する。
さらに状態予測器50は、走行計画取得部43から、時刻t0、t0+1、…、t0+Tpにおける自車両の走行計画を入力する。
自車両の走行計画は、例えば、自車両の速度計画、自車両の予定加減速度、走行軌道に沿って走行する自車両に生じる予定の横方向加速度、ACR制御量の時系列、自車両が走行する予定経路、及び予定自動運転レベルのいずれかを含む。
The state predictor 50 inputs the vehicle state information and the in-vehicle information at the current time t0 from the vehicle information acquisition unit 41. The state predictor 50 inputs the outside environment information at the current time t0 from the outside information acquisition unit 42.
Further, the state predictor 50 inputs the travel plan of the own vehicle at times t0, t0 + 1,..., T0 + Tp from the travel plan acquisition unit 43.
The travel plan of the own vehicle includes, for example, a speed plan of the own vehicle, a scheduled acceleration / deceleration of the own vehicle, a planned lateral acceleration generated in the own vehicle traveling along the traveling track, a time series of the ACR control amount, and a travel of the own vehicle. The planned route to be performed, and the planned automatic driving level.

例えば自車両の速度計画及び予定加減速度は、走行制御装置5が決定した走行軌道により定まる、時刻t0、t0+1、…、t0+Tpにおけるそれぞれの速度及び加減速度である。
例えば自車両に生じる予定の横方向加速度は、走行制御装置5が決定した走行軌道を走行する自車両に、時刻t0、t0+1、…、t0+Tpで発生すると予測されるそれぞれの横方向加速度である。
For example, the speed plan and the scheduled acceleration / deceleration of the own vehicle are respective speeds and acceleration / deceleration at times t0, t0 + 1,..., T0 + Tp determined by the traveling trajectory determined by the traveling control device 5.
For example, the lateral acceleration scheduled to occur in the own vehicle is each lateral acceleration predicted to occur at time t0, t0 + 1,..., T0 + Tp in the own vehicle traveling on the traveling trajectory determined by the traveling control device 5.

例えばACR制御量の時系列は、時刻t0、t0+1、…、t0+Tpにアクチュエータ6へ出力される予定のACR制御量である。
例えば自車両が走行する予定経路は、ナビゲーションシステム4が設定した設定経路上を走行する自車両が、時刻t0、t0+1、…、t0+Tpにそれぞれ到達する位置やその地図情報である。
例えば予定自動運転レベルは、時刻t0、t0+1、…、t0+Tpにおいて走行制御装置5により行われる予定のそれぞれの自動運転レベルである。
For example, the time series of the ACR control amount is an ACR control amount to be output to the actuator 6 at times t0, t0 + 1,..., T0 + Tp.
For example, the scheduled route on which the host vehicle travels is a position at which the host vehicle traveling on the set route set by the navigation system 4 reaches times t0, t0 + 1,..., T0 + Tp, and map information thereof.
For example, the scheduled automatic operation levels are the respective automatic operation levels scheduled to be performed by the travel control device 5 at times t0, t0 + 1,..., T0 + Tp.

また、状態予測器50は、時刻t0、t0+1、…、t0+Tpにおけるそれぞれの制御量の候補を最適化部52から入力する。
状態予測器50は、現時刻t0の車両状態情報、車内情報及び車外環境情報と、時刻t0、t0+1、…、t0+Tpにおける自車両の走行計画及び制御量の候補に基づいて、時刻t0+1、t0+2、…、t0+Tp+1における車体の状態量をそれぞれ予測する。例えば、状態予測器50は、バネ上のバウンスの変位、速度及び加速度、並びにピッチ軸、ロール軸及びヨー軸まわりの変位、速度及び加速度、バネ下のバウンスの変位、速度及び加速度を予測してよい。
状態予測器50は、予測した時刻t0+1、t0+2、…、t0+Tp+1における車体の状態量を評価部51へ出力する。
Further, the state predictor 50 inputs the respective control amount candidates at the times t0, t0 + 1,..., T0 + Tp from the optimization unit 52.
Based on the vehicle state information, the in-vehicle information, and the out-of-vehicle environment information at the current time t0, and the candidates for the travel plan and the control amount of the own vehicle at the times t0, t0 + 1,. , And the state quantities of the vehicle body at t0 + Tp + 1 are predicted. For example, the state predictor 50 predicts the displacement, speed and acceleration of the bounce on the spring, and the displacement, speed and acceleration around the pitch axis, the roll axis and the yaw axis, and the displacement, speed and acceleration of the bounce under the spring. Good.
The state predictor 50 outputs to the evaluator 51 the state quantities of the vehicle body at the predicted times t0 + 1, t0 + 2,..., T0 + Tp + 1.

評価部51は、状態予測器50が予測した状態量に基づいて所定の評価関数を用いてコストを算出することにより、各時刻t0、t0+1、…、t0+Tpの制御量の候補の制御性能を評価する。ここで例えば、車体挙動を抑制するためバネ上の加速度やバネ上の速度を評価関数(コスト)として算出してよい。評価部51は、算出したコストを最適化部52へ出力する。   The evaluator 51 evaluates the control performance of the control amount candidates at each time t0, t0 + 1,..., T0 + Tp by calculating a cost using a predetermined evaluation function based on the state quantity predicted by the state predictor 50. I do. Here, for example, acceleration on a spring or speed on a spring may be calculated as an evaluation function (cost) in order to suppress the vehicle body behavior. The evaluation unit 51 outputs the calculated cost to the optimization unit 52.

最適化部52は、評価部51が算出したコストを最小化するように、時刻t0、t0+1、…、t0+Tpにおけるそれぞれの制御量の候補を最適化する。
最適化部52は、例えば、評価関数の微分値を用いる反復手法に基づいて制御量の候補を最適化してよい。
また例えば、最適化部52は、試行錯誤的に最適解を直接探索する発見的手法に基づいて制御量の候補を最適化してもよい。発見的手法として、例えば遺伝的アルゴリズム、粒子群最適化、人工蜂コロニーアルゴリズムを使用してよい。
最適化部52は、探索によって最適化された時刻t0、t0+1、…、t0+Tpの制御量のうち時刻t0の制御量を、能動型サスペンション8の圧力制御弁20FL〜20RRへ出力する。
The optimization unit 52 optimizes each control amount candidate at time t0, t0 + 1,..., T0 + Tp so as to minimize the cost calculated by the evaluation unit 51.
The optimization unit 52 may optimize the control amount candidate based on, for example, an iterative method using a differential value of the evaluation function.
Further, for example, the optimization unit 52 may optimize the control amount candidate based on a heuristic method of directly searching for an optimal solution by trial and error. As a heuristic, for example, a genetic algorithm, particle swarm optimization, artificial bee colony algorithm may be used.
The optimization unit 52 outputs the control amount at time t0 among the control amounts at times t0, t0 + 1,..., T0 + Tp optimized by the search to the pressure control valves 20FL to 20RR of the active suspension 8.

(動作)
図5及び図6を参照して、実施形態の走行支援装置の動作を説明する。図5は、図4の状態予測器50の学習処理の一例を示すフローチャートである。
ステップS1では、自車両の走行計画を決定する。走行計画は、例えばナビゲーションシステム4及び走行制御装置5を用いて決定してもよく、オフラインで決定してもよい。
ステップS2では、車両センサ3及び車外環境センサ2によって、走行計画に沿って実際に走行した際の自車両の状態、及び自車両の外側の車外環境を検出する。
(motion)
With reference to FIGS. 5 and 6, an operation of the driving support device according to the embodiment will be described. FIG. 5 is a flowchart illustrating an example of a learning process of the state predictor 50 in FIG.
In step S1, a travel plan of the host vehicle is determined. The travel plan may be determined using, for example, the navigation system 4 and the travel control device 5, or may be determined offline.
In step S2, the vehicle sensor 3 and the outside environment sensor 2 detect the state of the own vehicle when the vehicle actually travels according to the travel plan and the outside environment outside the own vehicle.

ステップS3では、走行計画に沿って走行した際に、能動型サスペンション8の圧力制御弁20FL〜20RRに対して実際に行った制御の制御量を検出する。
ステップS4において、ステップS1で決定した走行計画、ステップS2で検出した自車両の状態、及び自車両の外側の車外環境、及びステップS3で検出した制御量の各データを保存する。
In step S3, the control amount of control actually performed on the pressure control valves 20FL to 20RR of the active suspension 8 when traveling according to the traveling plan is detected.
In step S4, each data of the travel plan determined in step S1, the state of the own vehicle detected in step S2, the environment outside the own vehicle, and the control amount detected in step S3 is stored.

ステップS5では、ステップS4で保存した各データに基づいて、状態予測器50が備える予測モデルを学習する。
例えば、走行計画に沿って走行した期間内のそれぞれの時刻tiについて、時刻tiの自車両の状態及び自車両の周囲の車外環境と、時刻ti、ti+1、…、ti+Tpにおける自車両の走行計画及び制御量を予測モデルに入力し、時刻ti+1、ti+2、…、ti+Tp+1における自車両の状態を予測する。そして、予測結果と実際に検出した自車両の状態(教師データ)との誤差関数が最小となる解を探索して、予測モデルを学習させる。
In step S5, a prediction model provided in the state predictor 50 is learned based on each data stored in step S4.
For example, for each time ti within a period of traveling in accordance with the travel plan, the state of the own vehicle at time ti and the environment outside the own vehicle, the travel plan of the own vehicle at times ti, ti + 1,. The control amount is input to the prediction model, and the state of the host vehicle at times ti + 1, ti + 2,..., Ti + Tp + 1 is predicted. Then, a solution that minimizes the error function between the prediction result and the actually detected state (teacher data) of the own vehicle is searched for, and the prediction model is learned.

図6は、図4のコントローラ7により行う能動型サスペンション8の制御処理の一例を示すフローチャートである。
ステップS10においてナビゲーションシステム4及び走行制御装置5は、自車両の走行計画を決定する。
ステップS11において車両センサ3及び車外環境センサ2は、自車両の状態、及び自車両の外側の車外環境を検出する。
FIG. 6 is a flowchart illustrating an example of a control process of the active suspension 8 performed by the controller 7 of FIG.
In step S10, the navigation system 4 and the travel control device 5 determine a travel plan of the own vehicle.
In step S11, the vehicle sensor 3 and the outside environment sensor 2 detect the state of the own vehicle and the outside environment outside the own vehicle.

ステップS12において最適化部52は、時刻t0、t0+1、…、t0+Tpにおける制御量の候補の初期値を決定する。
ステップS13において状態予測器50は、現時刻t0の車両状態情報、車内情報及び車外環境情報と、時刻t0、t0+1、…、t0+Tpにおける自車両の走行計画及び制御量の候補に基づいて、時刻t0+1、t0+2、…、t0+Tp+1における車体の状態量をそれぞれ予測する。
In step S12, the optimization unit 52 determines the initial values of the control amount candidates at times t0, t0 + 1,..., T0 + Tp.
In step S13, the state predictor 50 determines the time t0 + 1 based on the vehicle state information, the in-vehicle information, and the outside environment information at the current time t0, and the candidate for the travel plan and the control amount of the own vehicle at the times t0, t0 + 1,. , T0 + 2,..., T0 + Tp + 1, respectively.

ステップS14において評価部51は、状態予測器50が予測した状態量に基づいて所定の評価関数を用いてコストを算出することにより、時刻t0、t0+1、…、t0+Tpの制御量の候補の制御性能を評価する。
ステップS15において最適化部52は、評価部51が算出したコストに基づいて、時刻t0、t0+1、…、t0+Tpの制御量の候補が最適化されたか否かを判定する。例えば最適化部52は、コストが閾値以下になった場合やコストが最小値になった場合に制御量の候補が最適化されたと判定してよい。
In step S14, the evaluation unit 51 calculates a cost using a predetermined evaluation function based on the state quantity predicted by the state predictor 50, thereby controlling the control performance of the control amount candidate at time t0, t0 + 1,..., T0 + Tp. To evaluate.
In step S15, the optimization unit 52 determines whether or not the control amount candidates at the times t0, t0 + 1,..., T0 + Tp have been optimized based on the cost calculated by the evaluation unit 51. For example, the optimization unit 52 may determine that the candidate for the control amount has been optimized when the cost has become equal to or less than the threshold value or when the cost has reached the minimum value.

制御量の候補が最適化されない場合(ステップS15:N)に処理はステップS16へ進む。
ステップS16において最適化部52は、所定の最適化アルゴリズムにしたがって制御量の候補を再計算する。その後に処理はステップS13に戻る。
制御量の候補が最適化された場合(ステップS15:Y)に、最適化部52は、時刻t0の制御量を能動型サスペンション8の圧力制御弁20FL〜20RRへ出力する。その後に処理は終了する。
When the control amount candidate is not optimized (step S15: N), the process proceeds to step S16.
In step S16, the optimization unit 52 recalculates the control amount candidates according to a predetermined optimization algorithm. Thereafter, the process returns to step S13.
When the candidate for the control amount is optimized (step S15: Y), the optimization unit 52 outputs the control amount at time t0 to the pressure control valves 20FL to 20RR of the active suspension 8. Thereafter, the process ends.

(実施形態の効果)
(1)ナビゲーションシステム4及び走行制御装置5は、自車両の将来の走行計画を決定する。モデル予測制御部44は、将来の走行計画に沿って走行する前記車両に発生する車両挙動をモデル化した予測モデルを有する状態予測器50に、ナビゲーションシステム4及び走行制御装置5が決定した将来の走行計画を入力することにより、自車両の車両挙動を予測する。
(Effects of the embodiment)
(1) The navigation system 4 and the travel control device 5 determine a future travel plan of the vehicle. The model prediction control unit 44 sends a future prediction determined by the navigation system 4 and the travel control device 5 to the state predictor 50 having a prediction model that models a vehicle behavior occurring in the vehicle traveling along the future travel plan. By inputting a travel plan, the vehicle behavior of the own vehicle is predicted.

自車両がこれから走行する将来の走行計画を用いることにより、走行計画で予定された将来の走行シーンに応じて自車両に発生する車両挙動を予測することができる。
将来の走行シーンが車両挙動に及ぼす影響を反映させることにより、将来の車両挙動の予測精度を向上することができる。この結果、より精度の高い予測結果に基づいて制御を開始することができるので、車両挙動の制御遅れを軽減できる。
このため、走行計画に合わせた最適な車両挙動を実現できる。例えば、能動型サスペンション8の油圧シリンダ18FL〜18RRを制御する場合、走行計画に合わせた最適なサスペンション特性を得ることができる。
By using a future traveling plan in which the own vehicle will travel, a vehicle behavior occurring in the own vehicle can be predicted according to a future traveling scene scheduled in the traveling plan.
By reflecting the influence of the future running scene on the vehicle behavior, the prediction accuracy of the future vehicle behavior can be improved. As a result, control can be started based on a more accurate prediction result, so that control delay of vehicle behavior can be reduced.
For this reason, the optimal vehicle behavior according to the travel plan can be realized. For example, when controlling the hydraulic cylinders 18 FL to 18 RR of the active suspension 8, it is possible to obtain optimal suspension characteristics according to the traveling plan.

図7A〜図7Cは、交差点を曲がって平坦路から不整路へ進入した場合のバネ上加速度、バネ上速度、バネ上変位の時間変化を示すグラフである。
破線は、走行計画を用いないで能動型サスペンションを制御した場合の波形を示す。
路面荒さを測定する車外環境センサ2は、自車両の位置から所定の予見距離だけ前方の位置の路面変位を検出する。したがって、交差点を曲がって不整路へ進入すると、自車両が予見距離だけ進むまでの期間(T1〜T2)は、路面荒さの情報が使用できない。このため、能動型サスペンションの制御に遅れが生じてバネ上の運動が大きくなる。
7A to 7C are graphs showing sprung acceleration, sprung speed, and sprung displacement over time when the vehicle turns at an intersection and enters an irregular road from a flat road.
The broken line shows a waveform when the active suspension is controlled without using the travel plan.
The external environment sensor 2 for measuring the road surface roughness detects a road surface displacement at a position ahead of the own vehicle position by a predetermined foreseeable distance. Therefore, when the vehicle turns at an intersection and enters an irregular road, information on the road surface roughness cannot be used during a period (T1 to T2) until the vehicle travels for the foreseeable distance. For this reason, the control of the active suspension is delayed, and the motion on the spring increases.

実線は、走行計画を入力とする予測モデルを用いて能動型サスペンションを制御した場合の波形を示す。
この場合、不整路へ進入することが走行計画で予定されており、不整路を走行した自車両に生じる車両挙動は学習されているので、遅くとも不整路への進入時刻T1には、不整路を走行する自車両の車両挙動を予測することができる。このため、不整路への進入直後の時刻T1から能動型サスペンションの制御の誤差を低減して、バネ上の運動を抑えることができる。
The solid line shows a waveform when the active suspension is controlled using a prediction model that receives a travel plan as an input.
In this case, entry into the irregular road is scheduled in the traveling plan, and the vehicle behavior that occurs in the own vehicle that has traveled on the irregular road has been learned. It is possible to predict the behavior of the own vehicle traveling. For this reason, the error of the control of the active suspension can be reduced from time T1 immediately after entering the irregular road, and the movement on the sprung can be suppressed.

(2)状態予測器50に入力される走行計画は、自車両を走行させる予定の経路を含んでよい。これにより、自車両がこれから走行する経路に合わせて車両挙動を制御できる。   (2) The travel plan input to the state predictor 50 may include a route on which the host vehicle is to travel. As a result, the vehicle behavior can be controlled in accordance with the route on which the host vehicle will travel.

(3)状態予測器50に入力される走行計画は、自車両の速度計画を含んでよい。これにより、自車両の車速計画に合わせて車両挙動を制御できる。   (3) The travel plan input to the state predictor 50 may include a speed plan of the own vehicle. Thereby, the vehicle behavior can be controlled in accordance with the vehicle speed plan of the own vehicle.

(変形例)
(1)上記実施形態では、コントローラ7は、自車両の車両挙動を制御するアクチュエータとして能動型サスペンション8の油圧シリンダ18FL〜18RRの作動圧を調整した。
これに代えて、コントローラ7は、ステアリングアクチュエータ、アクセル開度アクチュエータ、ブレーキ制御アクチュエータのいずれかの制御量を制御してもよい。この場合、コントローラ7は、走行制御装置5に代わってこれらのアクチュエータの制御量を制御してよい。
(Modification)
(1) In the above embodiment, the controller 7 adjusts the operating pressure of the hydraulic cylinders 18FL to 18RR of the active suspension 8 as an actuator for controlling the vehicle behavior of the host vehicle.
Instead, the controller 7 may control any of the control amounts of the steering actuator, the accelerator opening actuator, and the brake control actuator. In this case, the controller 7 may control the control amounts of these actuators instead of the travel control device 5.

(2)モデル予測制御部44による自車両の状態予測に使用される、車両状態情報、車外環境情報と、走行計画のデータはそれぞれ異なる優先度を有していてもよい。
例えば、車両状態情報の優先度を最も高く設定し、走行計画の優先度を二番目に高く設定し、車外環境情報の優先度を最も低く設定してもよい。
(2) The vehicle state information, the outside-of-vehicle environment information, and the data of the travel plan used for the prediction of the state of the own vehicle by the model prediction control unit 44 may have different priorities.
For example, the priority of the vehicle state information may be set to the highest, the priority of the travel plan may be set to the second highest, and the priority of the environment information outside the vehicle may be set to the lowest.

状態予測器50は、優先度が低いデータの影響よりも優先度が高いデータの影響を予測結果により強く反映させてよい。例えば、状態予測器50が深層ニューラルネットワークを用いた予測モデルを有する場合には、優先度が低いデータが入力されるノードと中間層との結合係数よりも、優先度が高いデータが入力されるノードと中間層との結合係数よりを大きくしてよい。   The state predictor 50 may more strongly reflect the influence of data having a higher priority on the prediction result than the influence of data having a lower priority. For example, when the state predictor 50 has a prediction model using a deep neural network, data having higher priority than a coupling coefficient between a node to which low priority data is input and an intermediate layer is input. The coupling coefficient between the node and the intermediate layer may be made larger.

これにより、自車両の状態予測に使用されるデータが予測結果に与える影響に優劣を設けることができる。
例えば、尤度が高いデータの優先度を尤度の低いデータの優先度よりも高く設定することによって、予測結果の精度を向上させることができる。
また、例えば、車外環境情報どうしの間に尤度の差がある場合には、尤度の高い車外環境情報の優先度を尤度の低い車外環境情報の優先度よりも高く設定してよい。これにより、車外環境を検出するセンサの尤度に差がある場合や、センサの尤度が変動する場合に、センサ信号が予測結果に与える影響を尤度に応じて調整することができる。
This makes it possible to provide superiority or inferiority in the influence of data used for the state prediction of the own vehicle on the prediction result.
For example, by setting the priority of data with high likelihood higher than the priority of data with low likelihood, the accuracy of the prediction result can be improved.
Further, for example, when there is a likelihood difference between the outside environment information, the priority of the outside environment information having a high likelihood may be set higher than the priority of the outside environment information having a low likelihood. Thus, when there is a difference in the likelihood of the sensor detecting the environment outside the vehicle or when the likelihood of the sensor fluctuates, it is possible to adjust the influence of the sensor signal on the prediction result according to the likelihood.

(3)上記実施形態では、状態予測器50は、自動運転に使用される走行計画を用いて自車両の状態を予測した。これに代えて、状態予測器50は手動運転時に運転者へのルート案内に使用される走行計画を用いて自車両の状態を予測してもよい。   (3) In the above embodiment, the state predictor 50 predicts the state of the own vehicle using the travel plan used for automatic driving. Alternatively, the state predictor 50 may predict the state of the host vehicle using a travel plan used for route guidance to the driver during manual driving.

1…走行支援装置、2…車外環境センサ、3…車両センサ、4…ナビゲーションシステム、5…走行制御装置、6…能動型サスペンション、7…コントローラ、8…能動型サスペンション、10…車体側部材、11FL…車輪、11RR…車輪、14…車輪側部材、18a…シリンダチューブ、18b…ピストンロッド、18c…ピストン、18FL…油圧シリンダ、18RR…油圧シリンダ、20FL…圧力制御弁、20RR…圧力制御弁、21R…側配管、21S…供給側配管、22…油圧源、24F…アキュムレータ、24R…アキュムレータ、32…弁、34…アキュムレータ、36…コイルスプリング、38…油圧配管、40…車両挙動予測装置、41…車両情報取得部、42…車外情報取得部、43…走行計画取得部43、44…モデル予測制御部、50…状態予測器、51…評価部、52…最適化部   DESCRIPTION OF SYMBOLS 1 ... Driving assistance device, 2 ... Outside environment sensor, 3 ... Vehicle sensor, 4 ... Navigation system, 5 ... Driving control device, 6 ... Active suspension, 7 ... Controller, 8 ... Active suspension, 10 ... Body side member, 11FL: Wheel, 11RR: Wheel, 14: Wheel side member, 18a: Cylinder tube, 18b: Piston rod, 18c: Piston, 18FL: Hydraulic cylinder, 18RR: Hydraulic cylinder, 20FL: Pressure control valve, 20RR: Pressure control valve, 21R: Side pipe, 21S: Supply side pipe, 22: Hydraulic source, 24F: Accumulator, 24R: Accumulator, 32: Valve, 34: Accumulator, 36: Coil spring, 38: Hydraulic pipe, 40: Vehicle behavior prediction device, 41 ... Vehicle information acquisition unit, 42 ... Outside vehicle information acquisition unit, 43 ... Driving plan acquisition units 43, 44 Model predictive control unit, 50 ... state predictor, 51 ... evaluation unit, 52 ... optimization section

Claims (4)

車両の将来の走行計画を決定し、
前記将来の走行計画に沿って走行する前記車両に発生する車両挙動をモデル化した予測モデルに、決定した前記将来の走行計画を入力することにより、前記車両の車両挙動を予測する、
ことを特徴とする車両挙動予測方法。
Determine the future driving plan of the vehicle,
Predict the vehicle behavior of the vehicle by inputting the determined future travel plan to a prediction model that models the vehicle behavior occurring in the vehicle traveling along the future travel plan,
A vehicle behavior prediction method characterized by the above-mentioned.
前記走行計画は、前記車両を走行させる予定の経路であることを特徴とする請求項1に記載の車両挙動予測方法。   The vehicle behavior prediction method according to claim 1, wherein the travel plan is a route on which the vehicle is to travel. 前記走行計画は、前記車両の速度計画であることを特徴とする請求項1に記載の車両挙動予測方法。   The method according to claim 1, wherein the travel plan is a speed plan of the vehicle. 車両の将来の走行計画を決定し、前記将来の走行計画に沿って走行する前記車両に発生する車両挙動をモデル化した予測モデルに、決定した前記将来の走行計画を入力することにより、前記車両の車両挙動を予測する、コントローラを備えることを特徴とする車両挙動予測装置。   By determining the future travel plan of the vehicle and inputting the determined future travel plan to a prediction model that models a vehicle behavior occurring in the vehicle traveling along the future travel plan, the vehicle A vehicle behavior prediction device comprising a controller for predicting a vehicle behavior of the vehicle.
JP2018151344A 2018-08-10 2018-08-10 Vehicle behavior prediction method and vehicle behavior prediction device Active JP7091926B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2018151344A JP7091926B2 (en) 2018-08-10 2018-08-10 Vehicle behavior prediction method and vehicle behavior prediction device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2018151344A JP7091926B2 (en) 2018-08-10 2018-08-10 Vehicle behavior prediction method and vehicle behavior prediction device

Publications (2)

Publication Number Publication Date
JP2020026188A true JP2020026188A (en) 2020-02-20
JP7091926B2 JP7091926B2 (en) 2022-06-28

Family

ID=69621824

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2018151344A Active JP7091926B2 (en) 2018-08-10 2018-08-10 Vehicle behavior prediction method and vehicle behavior prediction device

Country Status (1)

Country Link
JP (1) JP7091926B2 (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR102616457B1 (en) * 2023-06-16 2023-12-21 에이디어스 주식회사 Air Suspension Operation Planning Generation Device for Autonomous Vehicles

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2011016382A (en) * 2009-07-07 2011-01-27 Toyota Motor Corp Damping force control device of vehicle
JP2017084110A (en) * 2015-10-28 2017-05-18 株式会社デンソーアイティーラボラトリ Vehicle control apparatus

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2011016382A (en) * 2009-07-07 2011-01-27 Toyota Motor Corp Damping force control device of vehicle
JP2017084110A (en) * 2015-10-28 2017-05-18 株式会社デンソーアイティーラボラトリ Vehicle control apparatus

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR102616457B1 (en) * 2023-06-16 2023-12-21 에이디어스 주식회사 Air Suspension Operation Planning Generation Device for Autonomous Vehicles

Also Published As

Publication number Publication date
JP7091926B2 (en) 2022-06-28

Similar Documents

Publication Publication Date Title
JP7119742B2 (en) Driving support method and driving support device
US11126185B2 (en) Systems and methods for predicting vehicle trajectory
US10828953B2 (en) Self-driving vehicle with integrated active suspension
US11447129B2 (en) System and method for predicting the movement of pedestrians
US11361599B2 (en) Vehicle damage detection
US11897302B2 (en) Preview damping control apparatus and method for a vehicle
US10928827B2 (en) Systems and methods for generating a path for a vehicle
US20190035275A1 (en) Autonomous operation capability configuration for a vehicle
CN110874642B (en) Learning device, learning method, and storage medium
US11945273B2 (en) Preview damping control apparatus and method for a vehicle
JP7044010B2 (en) Suspension characteristic adjustment method and suspension characteristic adjustment device
US20200189591A1 (en) Steering Command Limiting For Safe Autonomous Automobile Operation
EP3971526B1 (en) Path planning in autonomous driving environments
JP2023042576A (en) Determination of lane change based on downstream traffic state
EP4242998A1 (en) Traffic stream information determination method and apparatus, electronic device and storage medium
JP2007302204A (en) Travel control device
CN110617829A (en) Method and device for predicting a possible driving route of a vehicle
JP7091926B2 (en) Vehicle behavior prediction method and vehicle behavior prediction device
US11157756B2 (en) System and method for detecting errors and improving reliability of perception systems using logical scaffolds
CN111599166B (en) Method and system for interpreting traffic signals and negotiating signalized intersections
WO2023067879A1 (en) Vehicle control device, vehicle control method, and vehicle control system
US11904855B2 (en) Cooperative driving system and method
EP4264496A1 (en) Allocating processing resources to concurrently-executing neural networks
JP7033473B2 (en) Control device, transmission device, control method, transmission method, program, and storage medium
US20240140486A1 (en) Methods and apparatuses for closed-loop evaluation for autonomous vehicles

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20210301

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20220124

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20220201

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20220317

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20220530

R151 Written notification of patent or utility model registration

Ref document number: 7091926

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R151