JP2021142889A - Automatic steering control apparatus, automatic steering control method, and automatic steering program - Google Patents
Automatic steering control apparatus, automatic steering control method, and automatic steering program Download PDFInfo
- Publication number
- JP2021142889A JP2021142889A JP2020043064A JP2020043064A JP2021142889A JP 2021142889 A JP2021142889 A JP 2021142889A JP 2020043064 A JP2020043064 A JP 2020043064A JP 2020043064 A JP2020043064 A JP 2020043064A JP 2021142889 A JP2021142889 A JP 2021142889A
- Authority
- JP
- Japan
- Prior art keywords
- vehicle
- control amount
- amount
- azimuth
- deviation
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 36
- 238000005259 measurement Methods 0.000 claims abstract description 32
- 230000005484 gravity Effects 0.000 claims abstract description 18
- 238000006073 displacement reaction Methods 0.000 claims description 6
- 230000000694 effects Effects 0.000 claims description 5
- 238000004364 calculation method Methods 0.000 description 31
- 238000010586 diagram Methods 0.000 description 8
- 230000010354 integration Effects 0.000 description 8
- 230000000740 bleeding effect Effects 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000002265 prevention Effects 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 239000000725 suspension Substances 0.000 description 1
Images
Landscapes
- Steering Control In Accordance With Driving Conditions (AREA)
Abstract
Description
本開示は、車両の操舵を自動で行うことができる自動操舵制御装置、自動操舵制御方法、および自動操舵プログラムに関する。 The present disclosure relates to an automatic steering control device, an automatic steering control method, and an automatic steering program capable of automatically steering a vehicle.
目標軌道に沿って車両を自動走行させる技術が開発されている。車両を道路または車線から外れないように自動走行させるためには、道路または車線に合わせて操舵角を設定する必要がある。 Technology has been developed to automatically drive the vehicle along the target trajectory. In order to automatically drive the vehicle so that it does not deviate from the road or lane, it is necessary to set the steering angle according to the road or lane.
自動走行のための自動操舵制御において、フィードフォワード制御と、フィードバック制御とを併用することが一般に行われている。フィードフォワード制御は、道路曲率や横断勾配(道路の路線直角方向の勾配)等に基づいて、あらかじめ(自動追従走行が行われる前に)車両が進行方向からずれないように操舵角を設定する制御である。フィードバック制御は、自動追従走行の開始後、車両が目標軌道から現在ずれている量を計測し、このずれを解消するように操舵角を設定する制御である。 In automatic steering control for automatic driving, it is common practice to use feedforward control and feedback control together. Feedforward control is a control that sets the steering angle in advance (before automatic follow-up driving is performed) so that the vehicle does not deviate from the traveling direction based on the road curvature, the cross slope (the slope in the direction perpendicular to the road route), and the like. Is. The feedback control is a control that measures the amount of the vehicle currently deviating from the target trajectory after the start of the automatic follow-up running, and sets the steering angle so as to eliminate this deviation.
例えば特許文献1には、目標コースの車線曲率等の車線形状、目標コースと自車進行路の車幅方向のズレ量、目標コースに対する自車進行路のヨー角偏差等を検出し、これらの値を基に、フィードフォワード制御、およびフィードバック制御を行って、設定した目標コースに沿って走行するレーンキープ制御、および車線からの逸脱を防止する逸脱防止制御を行う技術が開示されている。
For example, in
車両を好適に自動走行させるためには、車線中心または目標軌道から車両中心までの距離、道路の曲率、曲率の変化量、車速、横断勾配(道路の路線方向に直角な方向の傾き)等、種々のパラメータを用いて操舵角を随時算出する必要がある。 In order to drive the vehicle appropriately and automatically, the distance from the center of the lane or the target track to the center of the vehicle, the curvature of the road, the amount of change in curvature, the vehicle speed, the cross slope (inclination in the direction perpendicular to the route direction of the road), etc. It is necessary to calculate the steering angle at any time using various parameters.
操舵制御のために用いられる各パラメータは、例えばカメラが撮像した画像やセンサ等によって得られるが、パラメータの取得時に誤差が生じることがある。このようにパラメータに誤差が含まれる場合、誤差を含むパラメータに基づいて算出された操舵角は、車両を目標軌道に沿って好適に走行させる操舵角ではない場合がある。このため、パラメータに誤差が含まれている場合でも、目標軌道に対する追従性能を高めることが要望されている。 Each parameter used for steering control is obtained by, for example, an image captured by a camera, a sensor, or the like, but an error may occur when the parameter is acquired. When the parameters include an error in this way, the steering angle calculated based on the parameters including the error may not be the steering angle for driving the vehicle along the target trajectory. Therefore, even if the parameters include an error, it is required to improve the follow-up performance with respect to the target trajectory.
このような事情に鑑みて、本開示は、目標軌道に対する追従性をより高めることができる自動操舵制御装置、自動操舵制御方法、および自動操舵プログラムを提供することを目的とする。 In view of such circumstances, it is an object of the present disclosure to provide an automatic steering control device, an automatic steering control method, and an automatic steering program capable of further improving the followability to a target trajectory.
本開示の一態様に係る自動操舵制御装置は、車両が目標軌道を追従するように前記車両の操舵角の自動制御を行う自動操舵制御装置であって、前記車両の方位角の計測値である方位角計測値と、前記目標軌道を走行するための方位角目標値とに基づいて、前記方位角計測値と前記方位角目標値との偏差を補正する操舵角であるフィードバック制御量を算出するフィードバック制御部と、前記車両の重心が前記目標軌道を通るように走行した場合の運動モデルを用いて前記フィードバック制御量の偏差を補正するためのフィードフォワード制御量を算出し、算出した前記フィードフォワード制御量を用いて、前記車両の前記目標軌道からの横方向のずれ量による影響を補償した補償済みフィードフォワード制御量を算出するフィードフォワード制御部と、前記フィードバック制御量および前記補償済みフィードフォワード制御量に基づいて操舵制御を行う操舵制御部と、を備える。 The automatic steering control device according to one aspect of the present disclosure is an automatic steering control device that automatically controls the steering angle of the vehicle so that the vehicle follows a target trajectory, and is a measured value of the azimuth angle of the vehicle. Based on the azimuth angle measurement value and the azimuth angle target value for traveling on the target trajectory, the feedback control amount which is the steering angle for correcting the deviation between the azimuth angle measurement value and the azimuth angle target value is calculated. The feedforward control amount for correcting the deviation of the feedback control amount is calculated by using the feedback control unit and the motion model when the center of gravity of the vehicle travels along the target track, and the calculated feedforward is calculated. A feedforward control unit that calculates a compensated feedforward control amount that compensates for the influence of the lateral deviation amount of the vehicle from the target track using the control amount, and the feedback control amount and the compensated feedforward control. It includes a steering control unit that performs steering control based on the amount.
本開示の一態様に係る自動操舵制御方法は、車両が目標軌道を追従するように前記車両の操舵角の自動制御を行う自動操舵制御方法であって、前記車両の方位角の計測値である方位角計測値と、前記目標軌道を走行するための方位角目標値とに基づいて、前記方位角計測値と前記方位角目標値との偏差を補正する操舵角であるフィードバック制御量を算出し、前記車両の重心が前記目標軌道を通るように走行した場合の運動モデルを用いて前記フィードバック制御量の偏差を補正するためのフィードフォワード制御量を算出し、算出した前記フィードフォワード制御量を用いて、前記車両の前記目標軌道からの横方向のずれ量による影響を補償した補償済みフィードフォワード制御量を算出し、前記フィードバック制御量および前記補償済みフィードフォワード制御量に基づいて操舵制御を行う。 The automatic steering control method according to one aspect of the present disclosure is an automatic steering control method that automatically controls the steering angle of the vehicle so that the vehicle follows a target trajectory, and is a measured value of the azimuth angle of the vehicle. Based on the azimuth angle measurement value and the azimuth angle target value for traveling on the target trajectory, the feedback control amount which is the steering angle for correcting the deviation between the azimuth angle measurement value and the azimuth angle target value is calculated. , The feedforward control amount for correcting the deviation of the feedback control amount is calculated by using the motion model when the center of gravity of the vehicle travels along the target track, and the calculated feedforward control amount is used. Therefore, a compensated feedforward control amount that compensates for the influence of the lateral deviation amount of the vehicle from the target track is calculated, and steering control is performed based on the feedback control amount and the compensated feedforward control amount.
本開示の一態様に係る自動操舵制御プログラムは、車両が目標軌道を追従するように前記車両の操舵角の自動制御を行う自動操舵制御プログラムであって、前記車両の方位角の計測値である方位角計測値と、前記目標軌道を走行するための方位角目標値とに基づいて、前記方位角計測値と前記方位角目標値との偏差を補正する操舵角であるフィードバック制御量を算出する手順と、前記車両の重心が前記目標軌道を通るように走行した場合の運動モデルを用いて前記フィードバック制御量の偏差を補正するためのフィードフォワード制御量を算出する手順と、算出した前記フィードフォワード制御量を用いて、前記車両の前記目標軌道からの横方向のずれ量による影響を補償した補償済みフィードフォワード制御量を算出する手順と、前記フィードバック制御量および前記補償済みフィードフォワード制御量に基づいて操舵制御を行う手順と、を前記車両のプロセッサに実行させる。 The automatic steering control program according to one aspect of the present disclosure is an automatic steering control program that automatically controls the steering angle of the vehicle so that the vehicle follows a target trajectory, and is a measured value of the azimuth angle of the vehicle. Based on the azimuth angle measurement value and the azimuth angle target value for traveling on the target trajectory, the feedback control amount which is the steering angle for correcting the deviation between the azimuth angle measurement value and the azimuth angle target value is calculated. The procedure, the procedure for calculating the feedforward control amount for correcting the deviation of the feedback control amount using the motion model when the center of gravity of the vehicle travels along the target trajectory, and the calculated feedforward. Based on the procedure for calculating the compensated feedforward control amount that compensates for the influence of the lateral deviation amount of the vehicle from the target track using the control amount, and the feedback control amount and the compensated feedforward control amount. The procedure for performing steering control and the procedure for performing steering control are performed by the processor of the vehicle.
本開示によれば、目標軌道に対する追従性をより高めた自動操舵制御を行うことができる。 According to the present disclosure, it is possible to perform automatic steering control with higher followability to a target trajectory.
以下、本開示の実施形態について、図面を参照して詳細に説明する。なお、以下に説明する実施形態は一例であり、本開示はこの実施形態により限定されるものではない。 Hereinafter, embodiments of the present disclosure will be described in detail with reference to the drawings. The embodiments described below are examples, and the present disclosure is not limited to these embodiments.
図1は、本開示の実施の形態の自動操舵制御装置200が搭載される車両100について説明するための図である。本開示の実施の形態において、図1に示すように、車両100はトラック等の商用車である。
FIG. 1 is a diagram for explaining a
車両100は、キャブ101と、荷台102と、前輪103と、後輪104と、を有する。キャブ101には、後述するカメラ105が設けられている。カメラ105は、車両100のほぼ前端部であって、車両100の前方を見渡すことができる位置に設けられている。より詳細には、カメラ105は、キャブ101内の運転席における、フロントガラスとダッシュボードとの間、または、フロントガラスとルームミラーとの間等に設けられている。
The
前輪103は、所定の舵角を向くように構成されている。前輪103の舵角(実舵角)は、後述する自動操舵制御装置200が動作している間、車両100が走行する道路や車線の形状に合わせて自動的に制御されるようになっている。これにより、車両100は、自動的に、道路や車線に対する自動追従走行を行うことができる。
The
図2は、自動操舵制御装置200の機能ブロック図である。図2に示すように、自動操舵制御装置200は、横位置情報生成部201と、方位角計測値情報生成部202と、道路形状情報生成部203と、車速センサ204と、操舵量算出部205と、操舵制御部208と、を有する。操舵量算出部205は、フィードバック制御部206と、フィードフォワード制御部207と、を有する。
FIG. 2 is a functional block diagram of the automatic
横位置情報生成部201は、カメラ105が撮影した、車両100の前方の画像(以下、前方画像と記載する)に基づいて、車両100の横位置に関する横位置情報を生成する。車両100の前方の画像とは、カメラ105から見た、車両の前方に存在する道路、車線、他の車両等が写る画像である。横位置情報とは、道路および車両100の横方向(幅方向)における、目標軌道から見た、車両100の中心の位置を示す情報である。なお、目標軌道とは、車両100が自動追従走行により走行する際に、目標となる軌道である。目標軌道は、例えば車両前方の道路形状、地図情報、および目的地に関する情報等に基づいて、随時設定される。車両100が道路に沿って自動追従走行する場合、目標軌道は、例えば道路の中心に沿った線である。また、車両100が例えば車線変更する場合には、目標軌道は、例えば車線の中心同士をなだらかに結ぶ線である。
The lateral position
方位角計測値情報生成部202は、前方画像に基づいて、カメラ105から見た車両100の方位角の計測値を示す方位角計測値情報を生成する。なお、方位角とは、車両100を上から見た場合に、車両100の向きと、目標軌道の接線方向とのなす角であり、カメラ105の位置を頂点とした角度である。方位角の計測値とは、前方画像に基づいて計測された値を意味する。方位角の計測値は、車両100を上から見た場合の車両100の前端部に位置するカメラ105から見た方位角の実測値である。
The azimuth measurement value
道路形状情報生成部203は、前方画像に基づいて、道路形状に関する種々の道路形状情報を生成する。本実施の形態では、道路形状情報には、曲率情報、曲率変化量情報、または横断勾配情報の少なくとも1つが含まれる。曲率情報は、車両100の前方の目標軌道の曲率に関する情報である。曲率変化量情報は、目標軌道における曲率の変化量に関する情報である。横断勾配情報は、道路の横方向の勾配である横断勾配に関する情報である。道路形状情報生成部203が、前方画像から、曲率情報、曲率変化量情報、または横断勾配情報を生成する方法については、本開示では特に限定しない。
The road shape
車速センサ204は、車両100の走行速度(以下、車速と記載する)を検出するセンサであり、車速に関する車速情報を生成する。
The
操舵量算出部205は、道路形状情報および車速情報に基づいて、車両100を目標軌道に沿って自動追従走行させるための操舵量を算出する。操舵量算出部205は、プロセッサとプログラムを格納した記憶部とを有し、プロセッサが記憶部からプログラムを展開して実行することで、操舵量算出部205の動作が実行される。
The steering
図2および図3に示すように、操舵量算出部205は、フィードバック制御部206と、フィードフォワード制御部207と、を有する。フィードバック制御部206およびフィードフォワード制御部207の詳細については、後述する。
As shown in FIGS. 2 and 3, the steering
操舵量算出部205は、フィードバック制御部206で算出された、ある時点T1におけるフィードバック制御量δFBと、時点T1におけるフィードフォワード制御部207で算出されたフィードフォワード制御量δFF_Cとに基づいて、時点T1における操舵量を決定する。
The steering
操舵制御部208は、上記説明したように算出した操舵量に基づいて、前輪103の自動操舵制御を行う。このような自動操舵制御装置200による処理が微少時間で繰り返されることにより、車両100は、目標軌道に対して自動追従走行を行うことができる。
The
<フィードバック制御部206>
以下では、操舵量算出部205が有するフィードバック制御部206について説明する。フィードバック制御部206は、ある時点T1における車両100の横位置および方位角計測値の、横位置目標値および方位角目標値からの偏差を解消する(補正する)ための操舵角を、フィードバック制御により算出する。本開示において、フィードバック制御部206により算出される操舵角を、フィードバック制御量δFBと記載する。
<
Hereinafter, the
図3は、操舵量算出部205の処理の流れの一例について説明するためのブロック図である。
FIG. 3 is a block diagram for explaining an example of the processing flow of the steering
図3に示すように、フィードバック制御のためのパラメータとして、横位置情報、方位角計測値情報、およびそれぞれの目標値が入力されると、フィードバック制御部206は、前方注視モデルにより横位置および方位角計測値のそれぞれの目標値からの偏差を解消するためのフィードバック制御量δFBを算出する。横位置および方位角の目標値は、例えば前方画像に基づいて適宜設定される。
As shown in FIG. 3, when the lateral position information, the azimuth measurement value information, and the respective target values are input as the parameters for the feedback control, the
前方注視モデルとは、ドライバーが距離Lだけ前方を注視していると仮定した場合の、距離Lだけ前方における偏差を解消するような操舵角を算出するためのモデルである。 The forward gaze model is a model for calculating a steering angle that eliminates the deviation in the front by the distance L when it is assumed that the driver is gaze forward by the distance L.
フィードバック制御に用いられる比例ゲインKpおよび微分ゲイン(微分時間)Kdは、あらかじめシミュレーション等により一定の値に設定されていてもよいし、例えば車速等に応じて適宜変化する変数に設定されてもよい。 The proportional gain K p and the differential gain (differential time) K d used for feedback control may be set to constant values in advance by simulation or the like, or are set to variables that appropriately change according to, for example, vehicle speed. May be good.
<フィードフォワード制御部207>
次に、操舵量算出部205が有するフィードフォワード制御部207について説明する。フィードフォワード制御部207は、車両100の重心が目標軌道を通るように走行した場合の車両100のすべり角(スリップ角)を想定した運動モデルを用いて、車両100が走行する道路の形状による操舵角への影響を補正する第1操舵角成分を算出する。車両100のすべり角とは、車両100の重心位置を頂点とした、現在車両が向いている方向と目標軌道の接線方向とのなす角である。
<
Next, the
また、フィードフォワード制御部207は、方位角計測値とすべり角との偏差による操舵角への影響を補正する第2操舵角成分を算出する。方位角計測値とすべり角との偏差による操舵角への影響とは、詳細は後述するが、方位角計測値とすべり角との偏差に起因して生じる、フィードバック制御部206が算出したフィードバック制御量δFBの、正しいフィードバック制御量からの偏差である。以下の説明において、フィードバック制御部206が算出したフィードバック制御量δFBの、正しいフィードバック制御量からの偏差を、フィードバック偏差と記載する。そして、フィードフォワード制御部207は、第1操舵角成分および第2操舵角成分に基づいて、フィードフォワード制御量を算出する。
Further, the
図3に示すように、フィードフォワード制御部207には、曲率情報、曲率の目標値、曲率変化情報、横断勾配情報、車速情報、横位置情報、および、フィードバック制御部206にて用いられる比例ゲイン(Kp)が入力される。フィードフォワード制御部207は、入力されたパラメータを、一般的な車両の運動モデルである二輪モデルに適用することで、道路形状の影響を補正する第1操舵角成分と、フィードバック偏差を補正する第2操舵角成分と、を算出する。道路の曲率、曲率変化、横断勾配、車速、等のパラメータは、二輪モデルにおいて車両の運動を記述するために用いられるパラメータである。
As shown in FIG. 3, the
図4は、二輪モデルについて説明するための図である。図4において、TyreFy_fは前輪に掛かる外力(タイヤ横力)、TyreFy_rは後輪に掛かる外力(タイヤ横力)、角度βは車両の重心位置におけるすべり角、lfは前輪軸と重心位置との距離、lrは後輪軸と重心位置との距離、δは前輪の操舵角、Vは車速である。また、Grav.Fy_fは道路の横断勾配によって前輪に掛かる横力、Grav.Fy_rは道路の横断勾配によって後輪に掛かる横力である。 FIG. 4 is a diagram for explaining a two-wheeled model. In FIG. 4, TyreF y_f is an external force applied to the front wheels (tire lateral force), TyreF y_r is an external force applied to the rear wheels (tire lateral force), angle β is the sliding angle at the center of gravity of the vehicle, and l f is the front wheel axle and the center of gravity position. , L r is the distance between the rear wheel axle and the position of the center of gravity, δ is the steering angle of the front wheels, and V is the vehicle speed. In addition, Grav. Phy_f is the lateral force applied to the front wheels due to the cross slope of the road, Grav. Phy_r is the lateral force applied to the rear wheels due to the cross slope of the road.
このような二輪モデルから、以下の式(1)および(2)を立式することができる。
式(1)および(2)において、mは車両重量、γはヨー角速度、δFFはフィードフォワード制御量、Kfは前輪軸のコーナリングパワー、Krは後輪軸のコーナリングパワー、Lは前方注視距離である。また、lcはカメラと重心位置との距離、ρは曲率、Iは慣性モーメント、lはホイールベース、nはステアリングギアレシオである。式(1)および(2)における項(−KpL/n(β+lcρ))は、フィードバック偏差を補正するための項である。 In the formula (1) and (2), m is the vehicle weight, gamma yaw angular velocity, [delta] FF is a feed forward control amount, K f is the cornering power of the front wheel shaft, K r is the cornering power of the rear wheel shaft, L is the forward gaze The distance. Further, l c is the distance between the camera and the position of the center of gravity, ρ is the curvature, I is the moment of inertia, l is the wheelbase, and n is the steering gear ratio. The term (−K p L / n (β + l c ρ)) in the equations (1) and (2) is a term for correcting the feedback deviation.
横断勾配により前輪および後輪に掛かる横力Grav.Fy_fおよびGrav.Fy_rは、以下の式(3)および(4)で表される。なお、θfは前輪103の位置における横断勾配、θrは後輪104の位置における横断勾配を示す。
式(1)から式(4)を用いてすべり角βを消し、以下の式(5)および(6)を導入すると、フィードフォワード制御量δFFは、式(7)で表すことができる。
図5は、式(7)の各項の有する性質を説明するための図である。図5に示すように、式(7)の第1項から第3項までは道路形状に起因する3つのパラメータ、すなわち、曲率、横断勾配、および曲率変化の影響を補正するための第1操舵角成分である。式(7)の第4項は、フィードバック偏差を補正するための第2操舵角成分である。 FIG. 5 is a diagram for explaining the properties of each term of the formula (7). As shown in FIG. 5, the first to third terms of the equation (7) are the three parameters due to the road shape, that is, the first steering for correcting the influence of the curvature, the cross slope, and the change in curvature. It is a horn component. The fourth term of the equation (7) is a second steering angle component for correcting the feedback deviation.
また、フィードフォワード制御部207は、二輪モデルを用いて式(7)により算出されるフィードフォワード制御量δFFの各項に対して、パラメータの誤差等に基づいて算出した補償値をフィードバックする誤差補償処理を行う。この誤差補償処理は、図3においては、横位置情報が積分器(1/s)に入力されて算出された補償値Kiが、二輪モデルを用いて算出されるフィードフォワード制御量δFFに対して、積算される箇所に相当する。
Further, the
自動操舵制御により走行する車両100において、目標軌道からの横位置のずれ(偏差)が生じる原因としては、例えば以下のようなものがある。車両100の車輪(前輪103および後輪104)のいずれかが経年劣化している場合、または道路の摩擦係数が低い場合には、上記の式(1)および式(2)で用いられるコーナリングパワーに誤差が生じうる。また、車両100のサスペンションの空気抜けや、車高センサの計測誤差等があった場合、上記の式(1)および式(2)で用いられる重心位置に誤差が生じうる。
In the
また、カメラ105が撮影した車両100の前方画像において、例えば道路に引かれた白線が正確に認識できない場合には、道路の中心位置が正確に分からないため、前方画像に基づいて導出される横位置情報に誤差が生じうる。また、画像に基づいて生成されるパラメータである横断勾配情報についても、前方画像から道路を正確に認識できない場合には、誤差が生じうる。
Further, in the front image of the
このように、自動操舵制御に使用されるパラメータに誤差がある場合、操舵角算出部205が算出する操舵量は誤差を含む値となるため、当該操舵量に従って走行する車両100の横位置に目標軌道からのずれが生じうる。
As described above, when there is an error in the parameters used for the automatic steering control, the steering amount calculated by the steering
また、車両100のステアリングに必要以上の遊びがある場合、車両100の実際の操舵角が、操舵量算出部205によって算出された操舵角と異なってしまうことがある。このような場合にも、車両100の横位置にずれが生じうる。
Further, when the steering of the
フィードフォワード制御部207による誤差補償処理は、このような横位置のずれに基づいて算出した補償値Kiにより、横位置のずれによるフィードフォワード制御量への影響δFFを補償する処理である。以下、誤差補償処理について詳細に説明する。
Error compensation processing by the
式(8)は、上記した式(7)を、横断勾配θが車両100の前後で一様であると仮定して、前輪の横断勾配θfと後輪の横断勾配θrを車両100全体で1つの値に簡略化した上で、曲率ρ、横断勾配θ、曲率変化dρ/dxの3つのパラメータ毎に項分けするように変形した式である。
In the equation (8), assuming that the transverse gradient θ is uniform in the front and rear of the
式(8)において、第1項は曲率ρに関する項であり、第2項は横断勾配θに関する項であり、第3項は曲率変化dρ/dxに関する項である。式(8)では、式(7)における第4項(フィードバック偏差を補正するための第2操舵角成分)は、第1項から第3項のいずれかに振り分けられている。 In the equation (8), the first term is a term relating to the curvature ρ, the second term is a term relating to the cross slope θ, and the third term is a term relating to the curvature change dρ / dx. In the formula (8), the fourth term (second steering angle component for correcting the feedback deviation) in the formula (7) is assigned to any of the first to third terms.
誤差補償処理によって算出される、補償済みのフィードフォワード制御量δFF_Cは、式(8)の第1項、第2項、および第3項に、補償値Ki1,Ki2,およびKi3をそれぞれ積算したものを、加算した値である。式(9)は、補償済みのフィードフォワード制御量δFF_Cを算出する式である。なお、本明細書では、補償値Ki1,Ki2,およびKi3を総称して、単に補償値Kiと記載することがある。 Is calculated by the error compensation process, compensated feedforward control amount [delta] FF_C the first term of equation (8), the second term, and the third term, the compensation value K i1, K i2, and K i3 It is the value obtained by adding the totals of each. Equation (9) is an equation for calculating the compensated feedforward control amount δ FF_C. In this specification, the compensation value K i1, K i2, and are collectively K i3, sometimes simply referred to as a compensation value K i.
式(9)において、補償値Ki1は、曲率ρに関する誤差の影響を補正するための値であり、補償値Ki2は、横断勾配θに関する誤差の影響を補正するための値であり、補償値Ki3は、曲率変化dρ/dxに関する誤差の影響を補正するための値である。このように、誤差補償処理は、フィードフォワード制御量δFFの算出に大きく寄与する、曲率ρ、横断勾配θ、および曲率変化dρ/dxの3つのパラメータのそれぞれに対して、パラメータ毎に算出された補償値を積算することで行われる。 In the equation (9), the compensation value Ki 1 is a value for correcting the influence of the error on the curvature ρ, and the compensation value Ki 2 is a value for correcting the influence of the error on the cross slope θ, and is compensated. the value K i3 is a value for correcting the influence of an error related to the curvature change dp / dx. In this way, the error compensation processing is calculated for each of the three parameters of the curvature ρ, the transverse gradient θ, and the curvature change dρ / dx, which greatly contribute to the calculation of the feedforward control amount δ FF. It is done by accumulating the compensation values.
各補償値Ki1,Ki2,Ki3は、初期値が1.0に設定されており、積分器によって横位置偏差が積分されることにより、所定範囲(例えば0.5〜1.5の範囲)で変動するようになっている。各補償値Ki1,Ki2,Ki3は、例えば以下のようにして算出される。 The initial values of the compensation values K i1 , Ki 2 , and Ki 3 are set to 1.0, and the lateral position deviation is integrated by the integrator to obtain a predetermined range (for example, 0.5 to 1.5). Range). The compensation values K i1 , Ki 2 , and Ki 3 are calculated as follows, for example.
図6A、図6B、および図6Cは、補償値Ki1,Ki2,Ki3の算出処理を示すフローチャートである。図6Aから図6Cに示す処理は、所定の微少時間毎に繰り返されている。 6A, 6B, and 6C are flowcharts showing the calculation processing of the compensation values Ki1 , Ki2 , and Ki3. The processes shown in FIGS. 6A to 6C are repeated at predetermined minute time intervals.
図6Aに示すように、曲率ρに関する誤差の影響を補正する補償値Ki1の算出処理において、その時点T1における曲率ρ、曲率変化dρ/dx、および横位置のずれ量Lat.errorの大きさが条件を満たす場合のみ、横位置のずれの積分が行われ、条件を満たさない場合には、積分が行われない。なお、図6Aから図6Cにおいて、閾値th1〜th4は、予め設定された所定の閾値である。また、図6Aから図6Cに示す処理において、積分が行われない場合の補償値Kiとしては、微少時間前に算出された、従前の補償値Kiがそのまま使用される。 As shown in FIG. 6A, in the calculation process of the compensation values K i1 to correct the influence of the error for the curvature [rho, the curvature [rho at that time T1, the curvature change dp / dx, and lateral position of the displacement amount Lat. Only when the magnitude of error satisfies the condition, the integration of the lateral position deviation is performed, and when the condition is not satisfied, the integration is not performed. In addition, in FIGS. 6A to 6C, the threshold values th1 to th4 are predetermined threshold values set in advance. Further, in the processing shown in FIG. 6C from FIG. 6A, as the compensation values K i of when the integration is not performed, which is calculated before a minute time, the previous compensation values K i are used as it is.
図6Aに示すように、曲率ρに関する誤差の影響を補正する補償値Ki1の算出処理では、曲率ρが閾値th1以上であり、曲率変化dρ/dxが閾値th2以下であり、かつ、横位置のずれ量Lat.errorが閾値th3以上である場合のみ、積分が行われる。すなわち、曲率ρがフィードフォワード制御量δFFの算出に寄与する割合が、他のパラメータと比較して比較的大きい場合、換言すれば横位置のずれの原因として、曲率ρの影響が大きい場合のみ、補償値Ki1が横位置のずれ量を積分した値に設定されることを意味している。反対に言えば、曲率ρがフィードフォワード制御量δFFの算出に寄与する割合が、他のパラメータと比較して比較的小さい場合、換言すれば横位置のずれの原因として、曲率ρの影響が小さい場合には、補償値Ki1が横位置のずれ量を積分した値には設定されず、初期値1.0に近い値に設定されることを意味している。このような処理によって、曲率ρの誤差がフィードフォワード制御量δFFに与える影響が、好適に補償されうる。 As shown in FIG. 6A, in the calculation process of the compensation values K i1 to correct the influence of the error for the curvature [rho, and the curvature [rho threshold th1 or more and curvature change dp / dx is the threshold th2 or less, and the lateral position Amount of deviation Lat. Integral is performed only when the error is equal to or higher than the threshold value th3. That is, when the ratio of the curvature ρ contributing to the calculation of the feedforward control amount δ FF is relatively large compared to other parameters, in other words, only when the influence of the curvature ρ is large as the cause of the lateral position deviation. , It means that the compensation value Ki1 is set to the value obtained by integrating the amount of deviation of the lateral position. Conversely, if the ratio of the curvature ρ contributing to the calculation of the feedforward control amount δ FF is relatively small compared to other parameters, in other words, the influence of the curvature ρ is the cause of the lateral displacement. If it is small, it means that the compensation value Ki1 is not set to the value obtained by integrating the amount of deviation of the lateral position, but is set to a value close to the initial value of 1.0. By such a process, the influence of the error of the curvature ρ on the feedforward control amount δ FF can be preferably compensated.
また、図6Bに示すように、横断勾配θに関する誤差の影響を補正する補償値Ki2の算出処理において、その時点T1における横断勾配θ、曲率変化dρ/dx、および横位置のずれ量Lat.errorの大きさが条件を満たす場合のみ、横位置のずれの積分が行われ、条件を満たさない場合には、積分が行われない。 Further, as shown in FIG. 6B, in the process of calculating the compensation values K i2 to correct the influence of errors regarding cross slope theta, cross slope theta at that time T1, the curvature change dp / dx, and lateral position of the displacement amount Lat. Only when the magnitude of error satisfies the condition, the integration of the lateral position deviation is performed, and when the condition is not satisfied, the integration is not performed.
図6Bに示すように、横断勾配θに関する誤差の影響を補正する補償値Ki2の算出処理では、横断勾配θが閾値th4以上であり、曲率変化dρ/dxが閾値th2以下であり、かつ、横位置のずれ量Lat.errorが閾値th3以上である場合のみ、積分が行われる。すなわち、横断勾配θがフィードフォワード制御量δFFの算出に寄与する割合が、他のパラメータと比較して比較的大きい場合、換言すれば横位置のずれの原因として、横断勾配θの影響が大きい場合のみ、補償値Ki2が横位置のずれ量を積分した値に設定されることを意味している。反対に言えば、横断勾配θがフィードフォワード制御量δFFの算出に寄与する割合が、他のパラメータと比較して比較的小さい場合、換言すれば横位置のずれの原因として、横断勾配θの影響が小さい場合には、補償値Ki2が横位置のずれ量を積分した値には設定されず、初期値1.0に近い値に設定されることを意味している。このような処理によって、横断勾配θの誤差がフィードフォワード制御量δFFに与える影響が、好適に補償されうる。 As shown in FIG. 6B, in calculation of the compensation value K i2 to correct the influence of errors regarding cross slope θ is the cross slope θ is a threshold value th4 or more, the curvature change dp / dx is the threshold th2 or less, Horizontal position deviation amount Lat. Integral is performed only when the error is equal to or higher than the threshold value th3. That is, when the ratio of the cross slope θ contributing to the calculation of the feedforward control amount δ FF is relatively large as compared with other parameters, in other words, the influence of the cross slope θ is large as a cause of the lateral position deviation. Only in the case, it means that the compensation value Ki2 is set to the value obtained by integrating the amount of deviation of the lateral position. Conversely, if the ratio of the cross slope θ contributing to the calculation of the feedforward control amount δ FF is relatively small compared to other parameters, in other words, the cause of the lateral position shift is the cross slope θ. When the influence is small, it means that the compensation value Ki2 is not set to the value obtained by integrating the amount of deviation of the lateral position, but is set to a value close to the initial value of 1.0. By such a process, the influence of the error of the cross gradient θ on the feedforward control amount δ FF can be preferably compensated.
さらに、図6Cに示すように、曲率変化dρ/dxに関する誤差の影響を補正する補償値Ki3の算出処理において、その時点T1における曲率ρ、曲率変化dρ/dx、および横位置のずれ量Lat.errorの大きさが条件を満たす場合のみ、横位置のずれの積分が行われ、条件を満たさない場合には、積分が行われない。 Furthermore, as shown in FIG. 6C, the process of calculating the compensation values K i3 to correct the influence of errors related to curvature change dp / dx, the curvature ρ at the time T1, the curvature change dp / dx, and the lateral positional deviation amount Lat .. Only when the magnitude of error satisfies the condition, the integration of the lateral position deviation is performed, and when the condition is not satisfied, the integration is not performed.
図6Cに示すように、曲率変化dρ/dxに関する誤差の影響を補正する補償値Ki3の算出処理では、曲率ρが閾値th1以上であり、曲率変化dρ/dxが閾値th2より大きく、かつ、横位置のずれ量Lat.errorが閾値th3以上である場合のみ、積分が行われる。すなわち、曲率変化dρ/dxがフィードフォワード制御量δFFの算出に寄与する割合が、他のパラメータと比較して比較的大きい場合、換言すれば横位置のずれの原因として、曲率変化dρ/dxの影響が大きい場合のみ、補償値Ki3が横位置のずれ量を積分した値に設定されることを意味している。反対に言えば、曲率変化dρ/dxがフィードフォワード制御量δFFの算出に寄与する割合が、他のパラメータと比較して比較的小さい場合、換言すれば横位置のずれの原因として、曲率変化dρ/dxの影響が小さい場合には、補償値Ki3が横位置のずれ量を積分した値には設定されず、初期値1.0に近い値に設定されることを意味している。このような処理によって、曲率変化dρ/dxの誤差がフィードフォワード制御量δFFに与える影響が、好適に補償されうる。 As shown in FIG. 6C, with calculation of the compensation value K i3 to correct the influence of the error is related to the curvature change dp / dx, and the curvature ρ is the threshold value th1 or more and is greater than the threshold value th2 curvature change dp / dx, and, Horizontal position deviation amount Lat. Integral is performed only when the error is equal to or higher than the threshold value th3. That is, when the ratio of the curvature change dρ / dx contributing to the calculation of the feedforward control amount δ FF is relatively large as compared with other parameters, in other words, the curvature change dρ / dx is the cause of the lateral position deviation. It means that the compensation value Ki3 is set to the value obtained by integrating the amount of deviation of the lateral position only when the influence of is large. Conversely, if the ratio of the curvature change dρ / dx contributing to the calculation of the feedforward control amount δ FF is relatively small compared to other parameters, in other words, the curvature change is the cause of the lateral position shift. If the influence of dp / dx is small, the compensation value K i3 is not is set to a value obtained by integrating the deviation amount in the lateral position, which means that it is set to a value close to the initial value 1.0. By such processing, the influence of the error of the curvature change dρ / dx on the feedforward control amount δ FF can be preferably compensated.
このように、フィードフォワード制御部207は、曲率ρ、横断勾配θ、曲率変化dρ/dxの3つのパラメータ毎に、各パラメータの大きさに基づいて補償値Ki1,Ki2,Ki3を算出し、当該補償値を用いて補償済みのフィードフォワード制御量δFF_Cを算出する。このような誤差補償処理により、パラメータの誤差等に起因する、車両100の目標軌道からの横位置のずれを、好適に抑えることができる。
Thus, the feed-
なお、上記説明した誤差補償処理において、曲率ρ、横断勾配θ、曲率変化dρ/dxの3つのパラメータ毎に、各パラメータの大きさの条件に基づいて積分するか否かの判断を行っていたが、例えば以下のような判断を追加してもよい。例えば、曲率ρ、横断勾配θ、曲率変化dρ/dx等のパラメータを算出するために用いられる車両100の前方画像の信頼度が所定の閾値より小さい場合には、全ての補償値Ki1,Ki2,Ki3の算出処理において積分を行わないようにしてもよい。なお、前方画像の信頼度とは、カメラ105の撮像した前方画像の画質や、画像に写る対象物(道路形状や白線等)の明瞭度合い等に基づいて算出される値であり、カメラ105または図示しない信頼度算出部によって算出されうる。このような判断の追加により、画像の信頼度が低く、誤差の補償が好適に行われないことが見込まれる場合には、操舵量に対する誤差補償処理の影響を低下させることができる。
In the error compensation process described above, it was determined whether or not to integrate each of the three parameters of curvature ρ, cross slope θ, and curvature change dρ / dx based on the condition of the magnitude of each parameter. However, for example, the following judgment may be added. For example, when the reliability of the front image of the
<作用、効果>
本開示の実施の形態に係る自動操舵制御装置200は、車両100が目標軌道を追従するように車両100の操舵角の自動制御を行う自動操舵制御装置200であって、車両100の方位角の計測値である方位角計測値と、目標軌道を走行するための方位角目標値とに基づいて、方位角計測値と方位角目標値との偏差を補正する操舵角であるフィードバック制御量δFBを算出するフィードバック制御部206と、車両100の重心が目標軌道を通るように走行した場合の運動モデルを用いて、フィードバック制御量δFBの偏差を補正するためのフィードフォワード制御量δFFを算出し、算出した前記フィードフォワード制御量δFFを用いて、車両100の目標軌道からの横方向のずれ量による影響を補償した補償済みフィードフォワード制御量δFF_Cを算出するフィードフォワード制御部207と、フィードバック制御量およびフィードフォワード制御量に基づいて操舵制御を行う操舵制御部208と、を備える。
<Action, effect>
The automatic
このような構成により、例えばパラメータの誤差等に起因して生じる、車両100の目標軌道からの横方向のずれ量による影響を補償した補償済みフィードフォワード制御量δFF_Cに基づく自動操舵制御を行うことができる。このため、自動操舵制御における、目標軌道への追従性能を向上させることができるようになる。
With such a configuration, automatic steering control based on the compensated feedforward control amount δ FF_C that compensates for the influence of the lateral deviation amount of the
また、本開示の実施の形態に係る自動操舵制御装置200によれば、フィードフォワード制御部207は、二輪モデルにおいて車両100の運動を記述するための複数のパラメータのうち、少なくとも道路の曲率、曲率の変化量、または道路の横断勾配の3つのパラメータ毎に算出された成分を有するフィードフォワード制御量を算出し、これら3つのパラメータ毎に算出された、車両100の目標軌道からの横方向のずれ量による影響を補償するための補償値Kを、3つのパラメータ毎に算出された成分に積算することで補償済みフィードフォワード制御量δFF_Cを算出する。なお、補償値は、車両の横方向のずれ量をパラメータ毎に積分して算出される。
Further, according to the automatic
このような構成により、道路の曲率、曲率の変化量、または道路の横断勾配といった、誤差が生じた場合にフィードフォワード制御量に対する影響が大きいパラメータに対して、好適に補償を行うことができるようになる。 With such a configuration, it is possible to suitably compensate for parameters such as the curvature of the road, the amount of change in curvature, or the cross slope of the road, which have a large effect on the feedforward control amount when an error occurs. become.
(変形例)
以上、本開示の実施形態について説明したが、本開示は、上述の実施形態に限定されるものではなく、本開示の趣旨を逸脱しない範囲で、適宜変形して実施することが可能である。
(Modification example)
Although the embodiments of the present disclosure have been described above, the present disclosure is not limited to the above-described embodiments, and can be appropriately modified and implemented without departing from the spirit of the present disclosure.
上記説明した実施の形態では、車両100を運転者が操縦することについては想定していなかったが、本開示の自動操舵制御装置による自動操舵走行と、ドライバーの操縦による走行とを、任意に切り替えることができるようにしてもよい。
In the embodiment described above, it is not assumed that the driver controls the
本開示は、車線や道路に対して自動的に追従する操舵制御を行う自動操舵制御装置に適用することができる。 The present disclosure can be applied to an automatic steering control device that performs steering control that automatically follows a lane or a road.
100 車両
101 キャブ
102 荷台
103 前輪
104 後輪
105 カメラ
200 自動操舵制御装置
201 横位置情報生成部
202 方位角計測値情報生成部
203 道路形状情報生成部
204 車速センサ
205 操舵量算出部
206 フィードバック制御部
207 フィードフォワード制御部
208 操舵制御部
100
Claims (10)
前記車両の方位角の計測値である方位角計測値と、前記目標軌道を走行するための方位角目標値とに基づいて、前記方位角計測値と前記方位角目標値との偏差を補正する操舵角であるフィードバック制御量を算出するフィードバック制御部と、
前記車両の重心が前記目標軌道を通るように走行した場合の運動モデルを用いて前記フィードバック制御量の偏差を補正するためのフィードフォワード制御量を算出し、算出した前記フィードフォワード制御量を用いて、前記車両の前記目標軌道からの横方向のずれ量による影響を補償した補償済みフィードフォワード制御量を算出するフィードフォワード制御部と、
前記フィードバック制御量および前記補償済みフィードフォワード制御量に基づいて操舵制御を行う操舵制御部と、
を備える、自動操舵制御装置。 An automatic steering control device that automatically controls the steering angle of the vehicle so that the vehicle follows the target trajectory.
The deviation between the azimuth measurement value and the azimuth target value is corrected based on the azimuth measurement value which is the measurement value of the azimuth angle of the vehicle and the azimuth target value for traveling on the target track. A feedback control unit that calculates the feedback control amount, which is the steering angle,
The feedforward control amount for correcting the deviation of the feedback control amount is calculated by using the motion model when the center of gravity of the vehicle travels along the target trajectory, and the calculated feedforward control amount is used. , A feedforward control unit that calculates a compensated feedforward control amount that compensates for the influence of the lateral deviation amount of the vehicle from the target track.
A steering control unit that performs steering control based on the feedback control amount and the compensated feedforward control amount, and
An automatic steering control device.
前記運動モデルにおいて前記車両の運動を記述するための複数のパラメータのうち、少なくともいずれかのパラメータ毎に算出された成分を有する前記フィードフォワード制御量を算出し、
前記パラメータ毎に算出された、前記車両の前記目標軌道からの横方向のずれ量による影響を補償するための補償値を、前記パラメータ毎に算出された前記成分に積算することで前記補償済みフィードフォワード制御量を算出する、
請求項1に記載の自動操舵制御装置。 The feedforward control unit
Among the plurality of parameters for describing the motion of the vehicle in the motion model, the feedforward control amount having a component calculated for at least one of the parameters is calculated.
The compensated feed is calculated by integrating the compensation value calculated for each parameter for compensating for the influence of the lateral deviation amount of the vehicle from the target track into the component calculated for each parameter. Calculate the forward control amount,
The automatic steering control device according to claim 1.
請求項2に記載の自動操舵制御装置。 The plurality of parameters include at least one of the curvature of the road, the amount of change in the curvature, or the cross slope of the road.
The automatic steering control device according to claim 2.
請求項2または3に記載の自動操舵制御装置。 The compensation value is a value obtained by integrating the lateral displacement amount of the vehicle for each of the parameters.
The automatic steering control device according to claim 2 or 3.
請求項1から4のいずれか一項に記載の自動操舵制御装置。 The effect on the steering angle is caused by the deviation between the measured azimuth angle and the slip angle of the vehicle when the center of gravity of the vehicle travels along the target trajectory, and the feedback control amount is correct. Deviation from feedback control amount,
The automatic steering control device according to any one of claims 1 to 4.
請求項1から5のいずれか一項に記載の自動操舵制御装置。 The feedforward control unit calculates the feedforward control amount based on the distance between the apex position of the azimuth angle and the position of the center of gravity.
The automatic steering control device according to any one of claims 1 to 5.
前記フィードフォワード制御部は、前記フィードフォワード制御量を、前記方位角計測値の頂点位置と前記重心の位置との距離、および、前記比例制御の比例ゲインに基づいて算出する、
請求項1から6のいずれか一項に記載の自動操舵制御装置。 The feedback control unit corrects the deviation between the azimuth measurement value and the azimuth target value by using proportional control.
The feedforward control unit calculates the feedforward control amount based on the distance between the apex position of the azimuth angle measurement value and the position of the center of gravity, and the proportional gain of the proportional control.
The automatic steering control device according to any one of claims 1 to 6.
前記フィードフォワード制御部は、前記フィードフォワード制御量を、前記方位角計測値の頂点位置と前記重心の位置との距離、前記比例制御の比例ゲイン、および、前記前方注視モデルにおける前方注視距離に基づいて算出する、
請求項7に記載の自動操舵制御装置。 The feedback control unit calculates the feedback control amount using the forward gaze model, and obtains the feedback control amount.
The feedforward control unit uses the feedforward control amount based on the distance between the apex position of the azimuth measurement value and the position of the center of gravity, the proportional gain of the proportional control, and the forward gaze distance in the forward gaze model. To calculate,
The automatic steering control device according to claim 7.
前記車両の方位角の計測値である方位角計測値と、前記目標軌道を走行するための方位角目標値とに基づいて、前記方位角計測値と前記方位角目標値との偏差を補正する操舵角であるフィードバック制御量を算出し、
前記車両の重心が前記目標軌道を通るように走行した場合の運動モデルを用いて前記フィードバック制御量の偏差を補正するためのフィードフォワード制御量を算出し、
算出した前記フィードフォワード制御量を用いて、前記車両の前記目標軌道からの横方向のずれ量による影響を補償した補償済みフィードフォワード制御量を算出し、
前記フィードバック制御量および前記補償済みフィードフォワード制御量に基づいて操舵制御を行う、
自動操舵制御方法。 It is an automatic steering control method that automatically controls the steering angle of the vehicle so that the vehicle follows the target trajectory.
The deviation between the azimuth measurement value and the azimuth target value is corrected based on the azimuth measurement value which is the measurement value of the azimuth angle of the vehicle and the azimuth target value for traveling on the target track. Calculate the feedback control amount, which is the steering angle,
The feedforward control amount for correcting the deviation of the feedback control amount is calculated by using the motion model when the center of gravity of the vehicle travels along the target trajectory.
Using the calculated feedforward control amount, a compensated feedforward control amount that compensates for the influence of the lateral deviation amount of the vehicle from the target track is calculated.
Steering control is performed based on the feedback control amount and the compensated feedforward control amount.
Automatic steering control method.
前記車両の方位角の計測値である方位角計測値と、前記目標軌道を走行するための方位角目標値とに基づいて、前記方位角計測値と前記方位角目標値との偏差を補正する操舵角であるフィードバック制御量を算出する手順と、
前記車両の重心が前記目標軌道を通るように走行した場合の運動モデルを用いて前記フィードバック制御量の偏差を補正するためのフィードフォワード制御量を算出する手順と、
算出した前記フィードフォワード制御量を用いて、前記車両の前記目標軌道からの横方向のずれ量による影響を補償した補償済みフィードフォワード制御量を算出する手順と、
前記フィードバック制御量および前記補償済みフィードフォワード制御量に基づいて操舵制御を行う手順と、
を前記車両のプロセッサに実行させる、自動操舵制御プログラム。 An automatic steering control program that automatically controls the steering angle of the vehicle so that the vehicle follows the target trajectory.
The deviation between the azimuth measurement value and the azimuth target value is corrected based on the azimuth measurement value which is the measurement value of the azimuth angle of the vehicle and the azimuth target value for traveling on the target track. The procedure for calculating the feedback control amount, which is the steering angle, and
A procedure for calculating a feedforward control amount for correcting a deviation of the feedback control amount using a motion model when the center of gravity of the vehicle travels along the target trajectory, and a procedure for calculating the feedforward control amount.
Using the calculated feedforward control amount, a procedure for calculating a compensated feedforward control amount that compensates for the influence of the lateral deviation amount of the vehicle from the target trajectory, and a procedure for calculating the compensated feedforward control amount.
A procedure for performing steering control based on the feedback control amount and the compensated feedforward control amount, and
An automatic steering control program that causes the processor of the vehicle to execute.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2020043064A JP7327223B2 (en) | 2020-03-12 | 2020-03-12 | Automatic steering control device, automatic steering control method, and automatic steering program |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2020043064A JP7327223B2 (en) | 2020-03-12 | 2020-03-12 | Automatic steering control device, automatic steering control method, and automatic steering program |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2021142889A true JP2021142889A (en) | 2021-09-24 |
JP7327223B2 JP7327223B2 (en) | 2023-08-16 |
Family
ID=77765815
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2020043064A Active JP7327223B2 (en) | 2020-03-12 | 2020-03-12 | Automatic steering control device, automatic steering control method, and automatic steering program |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP7327223B2 (en) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113954831A (en) * | 2021-11-26 | 2022-01-21 | 阿波罗智能技术(北京)有限公司 | Vehicle transverse control method and device and automatic driving vehicle |
JP7388523B1 (en) * | 2022-12-06 | 2023-11-29 | いすゞ自動車株式会社 | Yaw rate control device, yaw rate control method and program |
JP7388522B1 (en) * | 2022-12-06 | 2023-11-29 | いすゞ自動車株式会社 | Yaw rate control device, yaw rate control method and program |
JP7414169B1 (en) | 2023-03-08 | 2024-01-16 | いすゞ自動車株式会社 | Parameter adjustment device and parameter adjustment method |
WO2024045373A1 (en) * | 2022-09-01 | 2024-03-07 | 广州文远知行科技有限公司 | Steering wheel rotation angle calculation method, apparatus and device, and readable storage medium |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH07110712A (en) * | 1993-10-13 | 1995-04-25 | Toyota Central Res & Dev Lab Inc | Steering angle controller |
JPH08159787A (en) * | 1994-11-30 | 1996-06-21 | Honda Motor Co Ltd | Steering controller for vehicle |
JP2017035982A (en) * | 2015-08-10 | 2017-02-16 | 三菱電機株式会社 | Vehicular steering device and vehicle steering control method |
JP2018047828A (en) * | 2016-09-23 | 2018-03-29 | 日立オートモティブシステムズ株式会社 | Vehicle motion control device |
JP2018167731A (en) * | 2017-03-30 | 2018-11-01 | 株式会社Subaru | Vehicle travelling control device |
JP2019038421A (en) * | 2017-08-25 | 2019-03-14 | 本田技研工業株式会社 | Drive assist device, drive assist method, and program |
-
2020
- 2020-03-12 JP JP2020043064A patent/JP7327223B2/en active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH07110712A (en) * | 1993-10-13 | 1995-04-25 | Toyota Central Res & Dev Lab Inc | Steering angle controller |
JPH08159787A (en) * | 1994-11-30 | 1996-06-21 | Honda Motor Co Ltd | Steering controller for vehicle |
JP2017035982A (en) * | 2015-08-10 | 2017-02-16 | 三菱電機株式会社 | Vehicular steering device and vehicle steering control method |
JP2018047828A (en) * | 2016-09-23 | 2018-03-29 | 日立オートモティブシステムズ株式会社 | Vehicle motion control device |
JP2018167731A (en) * | 2017-03-30 | 2018-11-01 | 株式会社Subaru | Vehicle travelling control device |
JP2019038421A (en) * | 2017-08-25 | 2019-03-14 | 本田技研工業株式会社 | Drive assist device, drive assist method, and program |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113954831A (en) * | 2021-11-26 | 2022-01-21 | 阿波罗智能技术(北京)有限公司 | Vehicle transverse control method and device and automatic driving vehicle |
CN113954831B (en) * | 2021-11-26 | 2023-09-19 | 阿波罗智能技术(北京)有限公司 | Vehicle transverse control method and device and automatic driving vehicle |
WO2024045373A1 (en) * | 2022-09-01 | 2024-03-07 | 广州文远知行科技有限公司 | Steering wheel rotation angle calculation method, apparatus and device, and readable storage medium |
JP7388523B1 (en) * | 2022-12-06 | 2023-11-29 | いすゞ自動車株式会社 | Yaw rate control device, yaw rate control method and program |
JP7388522B1 (en) * | 2022-12-06 | 2023-11-29 | いすゞ自動車株式会社 | Yaw rate control device, yaw rate control method and program |
JP7414169B1 (en) | 2023-03-08 | 2024-01-16 | いすゞ自動車株式会社 | Parameter adjustment device and parameter adjustment method |
Also Published As
Publication number | Publication date |
---|---|
JP7327223B2 (en) | 2023-08-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP2021142889A (en) | Automatic steering control apparatus, automatic steering control method, and automatic steering program | |
JP4161923B2 (en) | Vehicle stabilization control system | |
US10144446B2 (en) | Vehicle and method for controlling vehicle | |
US10077072B2 (en) | Vehicle steering device and vehicle steering control method with reduced lateral speed | |
US6865461B2 (en) | Method and device for controlling driving dynamics | |
US11731623B2 (en) | Anticipating module, associated device and method for controlling path in real time | |
US20040015284A1 (en) | Method for controlling yaw and transversal dynamics in a road vehicle | |
JP2005014901A (en) | Vehicle dynamics control system with active normal force regulating system and its adjustment method | |
US20080015754A1 (en) | System for estimating and compensating for lateral disturbances using controlled steering and braking | |
JPH11314566A (en) | Stability maintaining control device for vehicle | |
KR102164606B1 (en) | Lateral control parameter correction apparatus and method for autonomous vehicle | |
EP3527453B1 (en) | Autonomous method and device for determining a global inclination of a motor vehicle | |
WO2019138617A1 (en) | Vehicle, vehicle motion status estimation device and vehicle motion status estimation method | |
US9180880B2 (en) | Driving force control system for vehicle | |
JP7167882B2 (en) | Automatic steering control device, automatic steering control method, automatic steering program, and vehicle | |
US20170101087A1 (en) | Driving force control device for a vehicle | |
WO2019138851A1 (en) | Driving assistance device, driving assistance method, and driving assistance system | |
US6560524B2 (en) | Integration of rear wheel steering with vehicle stability enhancement system | |
US10196057B2 (en) | Vehicle stability control device | |
JP2012126293A (en) | Steering controlling system of vehicle | |
US10625777B2 (en) | Attitude control system | |
CN115257703A (en) | Offset control method and offset control system for distributed drive vehicle | |
JP2009149246A (en) | Vehicle controller | |
JP2009185672A (en) | Driving force controller for vehicle | |
JP2009275560A (en) | Driving force control device of vehicle |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20220330 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20230131 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20230207 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20230410 |
|
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: 20230704 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20230717 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 7327223 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |