CN107792062A - Automatic parking control system - Google Patents

Automatic parking control system Download PDF

Info

Publication number
CN107792062A
CN107792062A CN201710975324.0A CN201710975324A CN107792062A CN 107792062 A CN107792062 A CN 107792062A CN 201710975324 A CN201710975324 A CN 201710975324A CN 107792062 A CN107792062 A CN 107792062A
Authority
CN
China
Prior art keywords
msub
mrow
mtd
mtr
msup
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
CN201710975324.0A
Other languages
Chinese (zh)
Other versions
CN107792062B (en
Inventor
谭墍元
谢娜
徐春玲
郭伟伟
李颖宏
张明
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
North China University of Technology
Original Assignee
North China University of Technology
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 North China University of Technology filed Critical North China University of Technology
Priority to CN201710975324.0A priority Critical patent/CN107792062B/en
Publication of CN107792062A publication Critical patent/CN107792062A/en
Application granted granted Critical
Publication of CN107792062B publication Critical patent/CN107792062B/en
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
    • B60W30/06Automatic manoeuvring for parking
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F30/00Computer-aided design [CAD]
    • G06F30/20Design optimisation, verification or simulation
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06NCOMPUTING ARRANGEMENTS BASED ON SPECIFIC COMPUTATIONAL MODELS
    • G06N3/00Computing arrangements based on biological models
    • G06N3/02Neural networks
    • G06N3/08Learning methods

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Theoretical Computer Science (AREA)
  • General Physics & Mathematics (AREA)
  • Evolutionary Computation (AREA)
  • General Engineering & Computer Science (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Biophysics (AREA)
  • Automation & Control Theory (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Health & Medical Sciences (AREA)
  • Computer Hardware Design (AREA)
  • Artificial Intelligence (AREA)
  • Biomedical Technology (AREA)
  • Geometry (AREA)
  • Computational Linguistics (AREA)
  • Data Mining & Analysis (AREA)
  • General Health & Medical Sciences (AREA)
  • Molecular Biology (AREA)
  • Computing Systems (AREA)
  • Mathematical Physics (AREA)
  • Software Systems (AREA)
  • Steering Control In Accordance With Driving Conditions (AREA)

Abstract

The invention provides an automatic parking control system. The system divides the whole automatic parking process into an input layer, a strategy layer, a planning layer and a control layer. In the automatic parking control process, the input layer generates control instructions and parking track data sets of different types of vehicles through simulation; the strategy layer learns the simulation data by using a deep neural network algorithm and extracts the general relation between the control instruction and the parking track; the planning layer finds a proper parking strategy through training in a few steps, gives a control instruction under the parking scene and generates a planning track; and the control layer performs control feedback according to the deviation of the actual parking track and the planned track, so that the parking track is closest to the ideal track planned by the system.

Description

Automatic parking control system
Technical Field
The invention relates to the field of automatic parking, in particular to an automatic parking control system for a general scene.
Background
In-line parking is a painful experience for many drivers, and large cities have limited parking space, and it has become a necessary skill to drive cars into narrow spaces. There are few situations where the vehicle is parked without taking a turn, which can result in traffic jams, nerve fatigue, and bumper jostling. With the development of the automatic parking technology, the above problems are greatly improved. The automatic parking technology can help a driver to automatically park and also help to solve some parking and traffic problems in densely populated urban areas. Sometimes, whether to park in a narrow space is limited by the skill of the driver. The automatic parking technique can park the automobile in a small space, which is much smaller than the space in which most drivers can park themselves. This makes it easier for the owner to find the parking space, while the same number of cars takes up less space.
In the prior art, as disclosed in publication No. CN107102642A, an automatic parking system for an unmanned vehicle is provided, which focuses mainly on an automatic parking monitoring sensing system, and estimates a vehicle trajectory using detection data of a geomagnetic sensor. As disclosed in publication No. CN106427996A, there is provided a multifunctional parking control method and system by acquiring obstacle information around a vehicle; and selecting an automatic parking mode or a remote control parking mode according to the information of obstacles around the vehicle. For example, publication No. CN 106043282A provides a full-automatic parking system for a vehicle and a control method thereof, which plans a parking path according to surrounding environment information of the vehicle and running state information of the vehicle, and controls an electric power steering system, an electronic stability system, and a transmission control unit to complete full-automatic parking according to the parking path.
In the prior art, the related content of 'automatic parking' mainly focuses on the hardware structure of an automatic parking system, how each part of modules works and the communication mode among the modules, most of technical content of the automatic parking system does not relate to the consideration of parking scenes, and the automatic parking system cannot solve the parking problems of various parking scenes and different parking types.
Disclosure of Invention
In order to solve the above technical problem, the present invention provides an automatic parking control system.
The following technical scheme is adopted specifically:
the system comprises an input layer, a strategy layer, a planning layer and a control layer; the input layer is used for receiving and sensing the speed and the position of the vehicle and the position and the size of the parking space in the current state; the strategy layer gives a control operation instruction of automatic parking according to the related information of the current vehicle and the parking space; the planning layer combines a dynamic model of a specific vehicle to give a planned parking track; and the control layer carries out real-time feedback control according to the deviation of the actual parking track and the planned parking track.
Preferably, the input layer defines the vehicle type according to the size of the vehicle body, the position of the center of gravity, the front-rear wheel base and the front-rear wheel rotation inertia; and respectively generating the track of different vehicle types: dividing the whole parking process into N stages, wherein the control instruction sets of the N stages are deltaf N={δf(1),…,δf(N) }; the specific vehicle control command in each stage is from a set S of K control anglesδ={δ1,…,δkGet K available for each type of vehicleNCombining the results; the time length of each stage is TNThe total time length is T ═ T1+…+TN(ii) a The simulation step size is T, where TN=K*t;
The strategy layer obtains a control instruction combination of the vehicle through deep neural network learning according to the final position, the deflection angle and the speed of the vehicle;
the programming layer is based on a set of control instructions { δ }12,…,δtObtaining a vehicle parking track by combining the current specific vehicle dynamics model parameters;
and the control layer performs feedback control according to the deviation of the actual parking track and the planned track to generate a final parking track.
Preferably, the specific way of obtaining the parking trajectory of the vehicle by the planning layer is as follows:
1) in the forward mode, the equation is transferred according to the vehicle state
And
δf=δmax,δr=0,
to obtain
Wherein,for the last time vehicle system state variables in the forward mode,the state variable of the vehicle system at the next moment in the forward mode; deltafFor the steering angle, delta, of the front wheelsrIs the rear wheel steering angle, δmaxIs the maximum steering angle;
2) in reverse mode, according to the vehicle state transfer equation
And
δr=0,δf=δmax
to obtain
Wherein,the last moment vehicle system state variable in the reverse mode,is the vehicle system state variable at the next moment in the reverse mode.
Preferably, the control layer feedback control specifically includes the steps of:
and performing feedback control according to an included angle β between the vehicle speed and the longitudinal axis of the vehicle and the rotation angular speed r under an inertial coordinate system:
the state space vector of the original system is expressed as
The actual system of change of the system parameters is
The state space vector of the feedback system is represented as
Wherein x is [ β, r ═ r]TIs a state variable of an ideal system, x ' ═ β ', r ']TIs a state variable of the actual system; a and B are state constants; u is a vehicle corner; k is a feedback matrix;
from an objective functionAt a minimum, a state feedback controller is obtained as
u=-Kx。
Preferably, the control layer comprises the following specific steps of:
and performing feedback control according to the vehicle position and the turning angle deviation:
from an objective function
At a minimum, a state feedback controller is obtained as
u=-Kx
Wherein:
(x ', y') represents the coordinates of the actual trace points;
(x, y) represents the coordinates of the ideal trace point;
psi' represents the corner of the actual trace point;
psi denotes the corner of the ideal trace point;
k ═ K1, K2 denotes a feedback matrix.
The invention has the following beneficial effects:
(1) the automatic parking system provided by the invention is oriented to a common scene, and a parking strategy suitable for the current scene is found through algorithm learning and field training, so that the problem that the type of a parking space suitable for the current parking system is single is solved;
(2) two vehicle trajectory control modes based on control theory algorithms are provided, which are more accurate than the mode of simply giving a corrected value of speed or deflection angle in the prior art.
Drawings
Fig. 1 is a schematic diagram of an automatic parking system.
Fig. 2 is a schematic diagram of simulation trajectories of two different vehicle types.
Fig. 3 is a schematic diagram of a neural network structure.
Fig. 4 is a schematic diagram of a planned trajectory.
FIG. 5 is a schematic view of a vehicle dynamics model.
Fig. 6 is a schematic diagram of the feedback control principle of δ _ f according to β and r.
Fig. 7 is a schematic diagram illustrating the principle of feedback control of the position and rotation angle deviation.
Detailed Description
The automatic parking control system oriented to the general scene divides the whole automatic parking process into four layers: an input layer, a strategy layer, a planning layer and a control layer. As shown in fig. 1:
the input layer is used for receiving and sensing the speed and the position of the vehicle and the direction and the size of the parking space in the current state; the strategy layer gives a control operation instruction of automatic parking according to the related information of the current vehicle and the parking space; the planning layer combines a dynamic model of a specific vehicle to give a planned parking track; and the control layer carries out real-time feedback control according to the deviation of the actual parking track and the planned parking track.
Firstly, generating control instructions and parking track data sets of different types of vehicles through MATLAB simulation software and a parallel learning algorithm; secondly, learning the simulation data by using a deep neural network algorithm, and extracting a general relation between a control command and a parking track, so that when any parking scene is given, a proper parking strategy can be found through training in a few steps, and the control command under the parking scene is given; then, aiming at a specific vehicle dynamics model of the current vehicle, a parking track under a theoretical condition is given; and finally, performing control feedback according to the deviation generated in the actual parking process to enable the parking track to be closest to the ideal track planned by the system.
(1) Different vehicle types are defined: different vehicle types have different characteristic parameters, such as vehicle body size, gravity center position, front and rear wheel distance, front and rear wheel moment of inertia and the like, and two vehicle types are selected, wherein A represents a car and B represents an SUV.
TABLE 1 different vehicle type parameter examples
(2) Generating a control instruction and a parking track in a simulation mode: trajectory generation is performed separately for two different vehicle types a and B. Dividing the whole parking process into N stages, wherein the control instruction sets of the N stages are deltaf N={δf(1),…,δf(N) }; the specific vehicle control command in each stage is from a set S of K control anglesδ={δ1,…,δkThus, each type of vehicle can obtain KNCombining the results; the time length of each stage is TNThe total time length is T ═ T1+…+TN(ii) a The simulation step length is T, TNK × t. FIG. 1 is a simulated trajectory, δ, for two types of vehiclesf N={-0.6,-0.4,-0.2,0,0.2,0.4,0.6},K=7,N=4,t=0.01s,TN2401 traces are formed together for 3 s.
(3) Learning a neural network: in order to determine a combination of control commands with knowledge of the final position, the yaw angle and the speed of the vehicleTo achieve accurate parking of the vehicle at the final position, we use a deep neural network algorithm to solve this problem. Fig. 2 is a schematic of the structure of a neural network, divided into an input layer, a hidden layer, and an output layer. Inputting a position as a target state of a vehicleAnd a velocity vector v, the output being a set of required control commands { δ }12,…,δt}。
(4) Planning a track: at a given set of control instructions { δ12,…,δtAnd on the basis of the calculation, the current specific vehicle dynamics model parameters are combined to give the vehicle parking track. Fig. 3 is an example of a planned trajectory.
FIG. 4 is a simplified schematic diagram of a vehicle dynamics model, in which the following parameters are used:
● v-vehicle speed
● v _ x is the component of velocity in the horizontal direction
● v _ y being the component of velocity in the vertical direction
● β -angle between vehicle speed and longitudinal axis of vehicle
Angular velocity of rotation in inertial frame
● x is the abscissa of the center of gravity of the vehicle
● y is the vehicle center of gravity ordinate
● F is the lateral force at the center of gravity
●δfr) Front (rear) steering angle
● theta is the included angle between the front wheel of the vehicle and the long axis direction of the berth, and the critical observation angle for the vehicle direction conversion
● psi being the angle of rotation from the x axis to the long axis of the vehicle
1) Forward mode
The vehicle state transfer equation is
WhereinIn order to be the last time the system state variable,is the system state variable at the next moment.
Wherein:
Cf=μcf,Cr=μcr
coefficient of tire stiffness mgv pairs of vehicle steering angle control quantity Cf、CrThe influence coefficient of (a);
coefficient of tire stiffness mgv pairs of vehicle angular rate CflfThe influence coefficient of (a);
moment of inertia of tire IgzFor vehicle turning angle rate CflfThe influence coefficient of (a);
inertia of tire versus vehicle angular velocity CflfThe influence coefficient of (a);
influence coefficients of the front wheel stiffness coefficients on the front wheel steering angle control quantity;
influence coefficients of the rear wheel stiffness coefficients on rear wheel steering angle control quantities;
influence coefficients of the rotational inertia of the front wheel tires on the front wheel steering angle control quantity;
influence coefficients of the rotational inertia of the rear wheel tires on the rear wheel steering angle control quantity;
Cf=μcf: the rigidity coefficient of the front wheel tire when the road surface adhesion coefficient is mu;
Cr=μcr: the rigidity coefficient of the rear wheel tire when the road surface adhesion coefficient is mu;
(dry road surface μ ═ 1, wet road surface μ ═ 0.5).
While advancing, deltaf=δmax,δrWhen the value is 0, then:
namely:
2) reverse mode
If the model is not influenced by the front driving and the rear driving of the vehicle, the model for backing the vehicle can be regarded as taking the tail of the vehicle as the head of the vehicle, and the model for advancing is still used, so that the front and rear parameters of the vehicle are exchanged:
wherein:
thus:
when backing a car deltaf *=δr=0,δr *=δf=δmaxThus, therefore, it is
Then:
β and r are defined identically since they are in increments, whether advancing or backing, but ψ is an accumulated amount that, when advancing,
ψ*=ψ+r*Δt;
when backing, the tail of the vehicle is regarded as the head of the vehicle, so
ψ*=ψ+r*Δt+π;
Component of velocity
v_x*=|v|*cos(β+ψ*);
v_y*=|v|*sin(β+ψ*);
Position coordinates
x*=x+vx*Δt;
y*=y+vy*Δt;
Deflection angle
ψ*ψ + r Δ t; (Advance)
ψ*=ψ+r*Δt+π;(reversing).
(5) Feedback control: due to vehicle wear, environmental changes, etc., model parameters in the actual vehicle operating system may differ from those of the ideal planning system, resulting in a deviation between the actual parking trajectory and the planned trajectory. In order to eliminate or reduce the deviation as much as possible, a linear control algorithm is adopted to perform feedback control on the system.
In actual parking systems, due to vehicle-inherent parameters such as mg、lf(lr)、Cf(Cr) The vehicle running track may be different from the track under the ideal system. To eliminate this difference, negative feedback control is added to the system to adjust the vehicle trajectory.
The feedback control of the vehicle track regulation is divided into two types, namely, the deviation of the internal variation β and r of the system is used for deltafPerforming feedback control; second, according to the system cumulant, namely the deviation of position and angle, to deltafAnd performing feedback control.
1) According to β and r to deltafPerforming feedback control
From the vehicle dynamics model, it can be seen that changes in the system parameters cause changes in the system variables β and r, which in turn affect the vehicle trajectory.
The state space vector of the original system can be expressed as
The actual system is due to the change of system parameters
According to the LQR control method, a state feedback controller u-Kx is designedObtaining an objective functionAnd minimum. The state space vector of the feedback system can then be expressed as
Wherein x is [ β, r ═ r]T: state variables of the ideal system;
x′=[β′,r′]T: state variables of the actual system;
a and B are state constants;
u=δf: turning the vehicle;
k: the feedback matrix K ═ K1, K2], and the specific calculation method refers to the LQR control algorithm.
In the MATLAB discrete system, the simulation step number is 12000 steps, the step length is 0.001s, and the simulation step number is divided into four stages:
stage1:step1-step3000,δf=-0.4(v=-1)/δf=0.4(v=1);
stage2:step3001-step6000,δf=0;
stage3:step6001-step9000,δf=0.4(v=-1)/δf=-0.4(v=1);
stage4:step9001-step12000,δf0. In the MATLAB discrete system, the simulation step number is 12000 steps, the step length is 0.001s, and the simulation step number is divided into four stages:
stage1:step1-step3000,δf=-0.4(v=-1)/δf=0.4(v=1);
stage2:step3001-step6000,δf=0;
stage3:step6001-step9000,δf=0.4(v=-1)/δf=-0.4(v=1);
stage4:step9001-step12000,δf=0。
2) feedback control is performed based on the vehicle position and the steering angle deviation, and the feedback principle is shown in fig. 6.
On the premise of knowing the feedback of the ideal track point and the actual track point at the previous moment, a steering angle can be found, so that the next actual track of the vehicle is closest to the track of the planned path, and an objective function is enabled to be obtained
And minimum. Wherein:
(x ', y') represents the coordinates of the actual trace points;
(x, y) represents the coordinates of the ideal trace point;
psi' represents the corner of the actual trace point;
psi denotes the corner of the ideal trace point;
k ═ K1, K2 denote feedback matrices, where K1, K2 ═ 1;
taking delta according to the limitation of the maximum steering angle of the vehiclef∈[-0.70,0.70]. The feedback process is as follows:
● step 1: original system deltaf0.4, feedback system δf=0.4
● step2-step 300: original system deltaf=0.4,[-0.70,0.70]
● step301-step 600: original system deltaf0, feedback system δf=[-0.70,0.70]
● step601-step 900: original system deltaf-0.4, feedback system δf=[-0.70,0.70]
● step900-step 1200: original system deltaf0, feedback system δf=[-0.70,0.70]。

Claims (5)

1. An automatic parking control system is characterized in that,
the system comprises an input layer, a strategy layer, a planning layer and a control layer;
the input layer is used for receiving and sensing the speed and the position of the vehicle and the position and the size of the parking space in the current state;
the strategy layer gives a control operation instruction of automatic parking according to the related information of the current vehicle and the parking space;
the planning layer combines a dynamic model of a specific vehicle to give a planned parking track;
and the control layer carries out real-time feedback control according to the deviation of the actual parking track and the planned parking track.
2. The automatic parking control system according to claim 2,
the input layer defines the vehicle type according to the size of the vehicle body, the position of the gravity center, the wheelbase and the front and rear wheel rotating inertia; and respectively generating the track of different vehicle types: dividing the whole parking process into N stages, wherein the control instruction sets of the N stages are deltaf N={δf(1),…,δf(N) }; the specific vehicle control command in each stage is from a set S of K control anglesδ={δ1,…,δkGet K available for each type of vehicleNCombining the results; the time length of each stage is TNThe total time length is T ═ T1+…+TN(ii) a The simulation step size is T, where TN=K*t;
The strategy layer obtains a control instruction combination of the vehicle through deep neural network learning according to the final position, the deflection angle and the speed of the vehicle;
the programming layer is based on a set of control instructions { δ }12,…,δtObtaining a vehicle parking track by combining the current specific vehicle dynamics model parameters;
and the control layer performs feedback control according to the deviation of the actual parking track and the planned track to generate a final parking track.
3. The automatic parking control method for the general parking scene as claimed in claim 2, wherein the specific way of obtaining the parking trajectory of the vehicle by the planning layer is as follows:
1) in the forward mode, the equation is transferred according to the vehicle state
<mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mover> <mi>&amp;beta;</mi> <mo>&amp;CenterDot;</mo> </mover> </mtd> </mtr> <mtr> <mtd> <mover> <mi>r</mi> <mo>&amp;CenterDot;</mo> </mover> </mtd> </mtr> </mtable> </mfenced> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>a</mi> <mn>11</mn> </msub> </mtd> <mtd> <msub> <mi>a</mi> <mn>12</mn> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>a</mi> <mn>21</mn> </msub> </mtd> <mtd> <msub> <mi>a</mi> <mn>22</mn> </msub> </mtd> </mtr> </mtable> </mfenced> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mi>&amp;beta;</mi> </mtd> </mtr> <mtr> <mtd> <mi>r</mi> </mtd> </mtr> </mtable> </mfenced> <mo>+</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>b</mi> <mn>11</mn> </msub> </mtd> <mtd> <msub> <mi>b</mi> <mn>12</mn> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>b</mi> <mn>21</mn> </msub> </mtd> <mtd> <msub> <mi>b</mi> <mn>22</mn> </msub> </mtd> </mtr> </mtable> </mfenced> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>&amp;delta;</mi> <mi>f</mi> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>&amp;delta;</mi> <mi>r</mi> </msub> </mtd> </mtr> </mtable> </mfenced> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>a</mi> <mn>11</mn> </msub> <mo>=</mo> <mo>-</mo> <mfrac> <mrow> <msub> <mi>c</mi> <mi>f</mi> </msub> <mo>+</mo> <msub> <mi>c</mi> <mi>r</mi> </msub> </mrow> <mrow> <msub> <mi>m</mi> <mi>g</mi> </msub> <mi>v</mi> </mrow> </mfrac> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>a</mi> <mn>12</mn> </msub> <mo>=</mo> <mo>-</mo> <mn>1</mn> <mo>-</mo> <mfrac> <mrow> <msub> <mi>c</mi> <mi>f</mi> </msub> <msub> <mi>l</mi> <mi>f</mi> </msub> <mo>-</mo> <msub> <mi>c</mi> <mi>r</mi> </msub> <msub> <mi>l</mi> <mi>r</mi> </msub> </mrow> <mrow> <msub> <mi>m</mi> <mi>g</mi> </msub> <msup> <mi>v</mi> <mn>2</mn> </msup> </mrow> </mfrac> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>a</mi> <mn>21</mn> </msub> <mo>=</mo> <mo>-</mo> <mfrac> <mrow> <msub> <mi>c</mi> <mi>f</mi> </msub> <msub> <mi>l</mi> <mi>f</mi> </msub> <mo>-</mo> <msub> <mi>c</mi> <mi>r</mi> </msub> <msub> <mi>l</mi> <mi>r</mi> </msub> </mrow> <msub> <mi>I</mi> <mrow> <mi>g</mi> <mi>z</mi> </mrow> </msub> </mfrac> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>a</mi> <mn>22</mn> </msub> <mo>=</mo> <mo>-</mo> <mfrac> <mrow> <msub> <mi>c</mi> <mi>f</mi> </msub> <msup> <msub> <mi>l</mi> <mi>f</mi> </msub> <mn>2</mn> </msup> <mo>+</mo> <msub> <mi>c</mi> <mi>r</mi> </msub> <msup> <msub> <mi>l</mi> <mi>r</mi> </msub> <mn>2</mn> </msup> </mrow> <mrow> <msub> <mi>I</mi> <mrow> <mi>g</mi> <mi>z</mi> </mrow> </msub> <mi>v</mi> </mrow> </mfrac> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>b</mi> <mn>11</mn> </msub> <mo>=</mo> <mfrac> <msub> <mi>c</mi> <mi>f</mi> </msub> <mrow> <msub> <mi>m</mi> <mi>g</mi> </msub> <mi>v</mi> </mrow> </mfrac> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>b</mi> <mn>21</mn> </msub> <mo>=</mo> <mfrac> <mrow> <msub> <mi>c</mi> <mi>f</mi> </msub> <msub> <mi>l</mi> <mi>f</mi> </msub> </mrow> <msub> <mi>I</mi> <mrow> <mi>g</mi> <mi>z</mi> </mrow> </msub> </mfrac> </mrow> </mtd> </mtr> </mtable> </mfenced>
And
δf=δmax,δr=0,
to obtain
<mrow> <mover> <mi>&amp;beta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>=</mo> <msub> <mi>a</mi> <mn>11</mn> </msub> <mi>&amp;beta;</mi> <mo>+</mo> <msub> <mi>a</mi> <mn>12</mn> </msub> <mi>r</mi> <mo>+</mo> <msub> <mi>b</mi> <mn>11</mn> </msub> <msub> <mi>&amp;delta;</mi> <mrow> <mi>m</mi> <mi>a</mi> <mi>x</mi> </mrow> </msub> </mrow>
<mrow> <mover> <mi>r</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>=</mo> <msub> <mi>a</mi> <mn>21</mn> </msub> <mi>&amp;beta;</mi> <mo>+</mo> <msub> <mi>a</mi> <mn>22</mn> </msub> <mi>r</mi> <mo>+</mo> <msub> <mi>b</mi> <mn>21</mn> </msub> <msub> <mi>&amp;delta;</mi> <mrow> <mi>m</mi> <mi>a</mi> <mi>x</mi> </mrow> </msub> </mrow>
Wherein,for the last time vehicle system state variables in the forward mode,the state variable of the vehicle system at the next moment in the forward mode; deltafFor the steering angle, delta, of the front wheelsrIs the rear wheel steering angle, δmaxIs the maximum steering angle;
2) in reverse mode, according to the vehicle state transfer equation
<mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msup> <mover> <mi>&amp;beta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>*</mo> </msup> </mtd> </mtr> <mtr> <mtd> <msup> <mover> <mi>r</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>*</mo> </msup> </mtd> </mtr> </mtable> </mfenced> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>a</mi> <mn>11</mn> </msub> </mtd> <mtd> <mrow> <mo>-</mo> <mn>2</mn> <mo>-</mo> <msub> <mi>a</mi> <mn>12</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>-</mo> <msub> <mi>a</mi> <mn>21</mn> </msub> </mrow> </mtd> <mtd> <msub> <mi>a</mi> <mn>22</mn> </msub> </mtd> </mtr> </mtable> </mfenced> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msup> <mi>&amp;beta;</mi> <mo>*</mo> </msup> </mtd> </mtr> <mtr> <mtd> <msup> <mi>r</mi> <mo>*</mo> </msup> </mtd> </mtr> </mtable> </mfenced> <mo>+</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>b</mi> <mn>12</mn> </msub> </mtd> <mtd> <msub> <mi>b</mi> <mn>11</mn> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>b</mi> <mn>22</mn> </msub> </mtd> <mtd> <msub> <mi>b</mi> <mn>21</mn> </msub> </mtd> </mtr> </mtable> </mfenced> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msup> <msub> <mi>&amp;delta;</mi> <mi>f</mi> </msub> <mo>*</mo> </msup> </mtd> </mtr> <mtr> <mtd> <msup> <msub> <mi>&amp;delta;</mi> <mi>r</mi> </msub> <mo>*</mo> </msup> </mtd> </mtr> </mtable> </mfenced> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>b</mi> <mn>12</mn> </msub> <mo>=</mo> <mfrac> <msub> <mi>C</mi> <mi>r</mi> </msub> <mrow> <msub> <mi>m</mi> <mi>g</mi> </msub> <mi>v</mi> </mrow> </mfrac> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>b</mi> <mn>22</mn> </msub> <mo>=</mo> <mo>-</mo> <mfrac> <mrow> <msub> <mi>C</mi> <mi>r</mi> </msub> <msub> <mi>l</mi> <mi>r</mi> </msub> </mrow> <msub> <mi>I</mi> <mrow> <mi>g</mi> <mi>z</mi> </mrow> </msub> </mfrac> </mrow> </mtd> </mtr> </mtable> </mfenced>
And
δr=0,δf=δmax
to obtain
<mrow> <msup> <mover> <mi>&amp;beta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>*</mo> </msup> <mo>=</mo> <msub> <mi>a</mi> <mn>11</mn> </msub> <msup> <mi>&amp;beta;</mi> <mo>*</mo> </msup> <mo>+</mo> <mrow> <mo>(</mo> <mo>-</mo> <mn>2</mn> <mo>-</mo> <msub> <mi>a</mi> <mn>12</mn> </msub> <mo>)</mo> </mrow> <msup> <mi>r</mi> <mo>*</mo> </msup> <mo>+</mo> <msub> <mi>b</mi> <mn>11</mn> </msub> <msub> <mi>&amp;delta;</mi> <mrow> <mi>m</mi> <mi>a</mi> <mi>x</mi> </mrow> </msub> </mrow>
<mrow> <msup> <mover> <mi>r</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>*</mo> </msup> <mo>=</mo> <mo>-</mo> <msub> <mi>a</mi> <mn>21</mn> </msub> <msup> <mi>&amp;beta;</mi> <mo>*</mo> </msup> <mo>+</mo> <msub> <mi>a</mi> <mn>22</mn> </msub> <msup> <mi>r</mi> <mo>*</mo> </msup> <mo>+</mo> <msub> <mi>b</mi> <mn>21</mn> </msub> <msub> <mi>&amp;delta;</mi> <mrow> <mi>m</mi> <mi>a</mi> <mi>x</mi> </mrow> </msub> </mrow>
Wherein,the last moment vehicle system state variable in the reverse mode,for the next moment of the vehicle system state variable in the reverse mode, a11Is the coefficient of stiffness m of the tiregv influence coefficient on the vehicle turning angle control amount; a is12Is the coefficient of stiffness m of the tiregv pairs of vehicle angular rate CflfThe influence coefficient of (a); a is21Is the moment of inertia of the tyre IgzA coefficient of influence on a vehicle turning rate; a is22The influence coefficient of the rotational inertia of the tire on the vehicle rotation angular rate is shown; b11The influence coefficient of the rigidity coefficient of the front wheel on the steering angle control quantity of the front wheel is obtained; b12The influence coefficient of the rigidity coefficient of the rear wheel on the steering angle control quantity of the rear wheel is obtained; b21The influence coefficient of the rotational inertia of the front wheel tire on the front wheel steering angle control quantity is obtained; b22The influence coefficient of the rotational inertia of the rear wheel tire on the rear wheel steering angle control quantity is obtained; cfThe rigidity coefficient of the front wheel tire when the road adhesion coefficient is mu; crThe rigidity coefficient of the rear wheel tire is the road surface adhesion coefficient mu.
4. An automatic parking control method oriented to a general parking scene as claimed in claim 2, characterized in that said control layer feedback control comprises the specific steps of:
and performing feedback control according to an included angle β between the vehicle speed and the longitudinal axis of the vehicle and the rotation angular speed r under an inertial coordinate system:
the state space vector of the original system is expressed as
<mrow> <mover> <mi>x</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>=</mo> <mi>A</mi> <mi>x</mi> <mo>+</mo> <mi>B</mi> <mi>u</mi> </mrow>
The actual system of change of the system parameters is
<mrow> <msup> <mover> <mi>x</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>&amp;prime;</mo> </msup> <mo>=</mo> <msup> <mi>A</mi> <mo>&amp;prime;</mo> </msup> <msup> <mi>x</mi> <mo>&amp;prime;</mo> </msup> <mo>+</mo> <msup> <mi>B</mi> <mo>&amp;prime;</mo> </msup> <mi>u</mi> </mrow>
The state space vector of the feedback system is represented as
<mrow> <msup> <mi>x</mi> <mo>&amp;prime;</mo> </msup> <mo>=</mo> <msup> <mi>A</mi> <mo>&amp;prime;</mo> </msup> <msup> <mi>x</mi> <mo>&amp;prime;</mo> </msup> <mo>+</mo> <msup> <mi>B</mi> <mo>&amp;prime;</mo> </msup> <mover> <mo>&amp;lsqb;</mo> <mo>&amp;CenterDot;</mo> </mover> <mi>u</mi> <mo>-</mo> <mi>K</mi> <mrow> <mo>(</mo> <msup> <mi>x</mi> <mo>&amp;prime;</mo> </msup> <mo>-</mo> <mi>x</mi> <mo>)</mo> </mrow> <mo>&amp;rsqb;</mo> </mrow>
Wherein x is [ β, r ═ r]TIs a state variable of an ideal system, x ' ═ β ', r ']TIs a state variable of the actual system; a and B are state constants; u is a vehicle corner; k is a feedback matrix;
from an objective functionAt a minimum, a state feedback controller is obtained as
u=-Kx。
5. An automatic parking control method oriented to a general parking scene as claimed in claim 2, characterized in that said control layer control feedback comprises the following specific steps:
and performing feedback control according to the vehicle position and the turning angle deviation:
from an objective function
<mrow> <mi>d</mi> <mi>i</mi> <mi>s</mi> <mo>=</mo> <mi>k</mi> <mn>1</mn> <msqrt> <mrow> <msup> <mrow> <mo>(</mo> <msup> <mi>x</mi> <mo>&amp;prime;</mo> </msup> <mo>-</mo> <mi>x</mi> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <msup> <mi>y</mi> <mo>&amp;prime;</mo> </msup> <mo>-</mo> <mi>y</mi> <mo>)</mo> </mrow> <mn>2</mn> </msup> </mrow> </msqrt> <mo>+</mo> <mi>k</mi> <mn>2</mn> <mo>|</mo> <msup> <mi>&amp;psi;</mi> <mo>&amp;prime;</mo> </msup> <mo>-</mo> <mi>&amp;psi;</mi> <mo>|</mo> </mrow>At a minimum, a state feedback controller is obtained as
-Kx wherein:
(x ', y') represents the coordinates of the actual trace points;
(x, y) represents the coordinates of the ideal trace point;
psi' represents the corner of the actual trace point;
psi denotes the corner of the ideal trace point;
k ═ K1, K2 denotes a feedback matrix.
CN201710975324.0A 2017-10-16 2017-10-16 Automatic parking control system Expired - Fee Related CN107792062B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710975324.0A CN107792062B (en) 2017-10-16 2017-10-16 Automatic parking control system

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710975324.0A CN107792062B (en) 2017-10-16 2017-10-16 Automatic parking control system

Publications (2)

Publication Number Publication Date
CN107792062A true CN107792062A (en) 2018-03-13
CN107792062B CN107792062B (en) 2019-11-05

Family

ID=61534130

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710975324.0A Expired - Fee Related CN107792062B (en) 2017-10-16 2017-10-16 Automatic parking control system

Country Status (1)

Country Link
CN (1) CN107792062B (en)

Cited By (16)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108407805A (en) * 2018-03-30 2018-08-17 中南大学 A kind of vehicle automatic parking method based on DQN
CN108860139A (en) * 2018-04-11 2018-11-23 浙江零跑科技有限公司 A kind of automatic parking method for planning track based on depth enhancing study
CN109823348A (en) * 2019-02-19 2019-05-31 百度在线网络技术(北京)有限公司 Unmanned vehicle reversing model control method, device, equipment and computer-readable medium
CN110525428A (en) * 2019-08-29 2019-12-03 合肥工业大学 A kind of automatic parking method based on the study of fuzzy deeply
WO2020001423A1 (en) * 2018-06-29 2020-01-02 华为技术有限公司 Method and device for determining automatic parking strategy
CN110654374A (en) * 2018-06-29 2020-01-07 比亚迪股份有限公司 Automatic parking simulation system and test method thereof
CN110654373A (en) * 2018-06-29 2020-01-07 比亚迪股份有限公司 Automatic parking method and device and vehicle
WO2020056875A1 (en) * 2018-09-20 2020-03-26 初速度(苏州)科技有限公司 Parking strategy based on deep reinforcement learning
CN111047948A (en) * 2019-11-27 2020-04-21 康忠文 Auxiliary method and system for learning to learn to train
CN111098852A (en) * 2019-12-02 2020-05-05 北京交通大学 Parking path planning method based on reinforcement learning
CN111098850A (en) * 2018-10-25 2020-05-05 北京初速度科技有限公司 Automatic parking auxiliary system and automatic parking method
CN111434550A (en) * 2019-01-15 2020-07-21 初速度(苏州)科技有限公司 Simulation-based parking strategy generation method and system
CN113110500A (en) * 2021-05-10 2021-07-13 的卢技术有限公司 Transverse control method for low-speed automatic parking of automatic-driving automobile
CN113252366A (en) * 2021-06-23 2021-08-13 奇瑞新能源汽车股份有限公司 Automatic parking evaluation method and device for vehicle, vehicle and storage medium
CN113978547A (en) * 2021-10-21 2022-01-28 江铃汽车股份有限公司 Automatic driving steering control method and system
CN115303256A (en) * 2022-08-10 2022-11-08 浙江零跑科技股份有限公司 Automatic parking path tracking control method and device and computer equipment

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104057950A (en) * 2014-05-21 2014-09-24 重庆长安汽车股份有限公司 Full-automatic parking system
CN104260722A (en) * 2014-09-23 2015-01-07 北京理工大学 Automatic parking system
CN105857306A (en) * 2016-04-14 2016-08-17 中国科学院合肥物质科学研究院 Vehicle autonomous parking path programming method used for multiple parking scenes
US20170294121A1 (en) * 2016-04-12 2017-10-12 Ford Global Technologies, Llc Detecting available parking spaces

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104057950A (en) * 2014-05-21 2014-09-24 重庆长安汽车股份有限公司 Full-automatic parking system
CN104260722A (en) * 2014-09-23 2015-01-07 北京理工大学 Automatic parking system
US20170294121A1 (en) * 2016-04-12 2017-10-12 Ford Global Technologies, Llc Detecting available parking spaces
CN105857306A (en) * 2016-04-14 2016-08-17 中国科学院合肥物质科学研究院 Vehicle autonomous parking path programming method used for multiple parking scenes

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
吴冰等: "基于RBF神经网络的自动泊车路径规划", 《合肥工业大学学报(自然科学版)》 *
张放等: "基于模糊逻辑的自动平行泊车控制方法", 《汽车工程》 *

Cited By (22)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108407805A (en) * 2018-03-30 2018-08-17 中南大学 A kind of vehicle automatic parking method based on DQN
CN108860139A (en) * 2018-04-11 2018-11-23 浙江零跑科技有限公司 A kind of automatic parking method for planning track based on depth enhancing study
CN108860139B (en) * 2018-04-11 2019-11-29 浙江零跑科技有限公司 A kind of automatic parking method for planning track based on depth enhancing study
CN110654374B (en) * 2018-06-29 2022-03-18 比亚迪股份有限公司 Automatic parking simulation system and test method thereof
US11897454B2 (en) 2018-06-29 2024-02-13 Huawei Technologies Co., Ltd. Method and apparatus for determining automatic parking strategy
WO2020001423A1 (en) * 2018-06-29 2020-01-02 华为技术有限公司 Method and device for determining automatic parking strategy
CN110654374A (en) * 2018-06-29 2020-01-07 比亚迪股份有限公司 Automatic parking simulation system and test method thereof
CN110654373A (en) * 2018-06-29 2020-01-07 比亚迪股份有限公司 Automatic parking method and device and vehicle
WO2020056875A1 (en) * 2018-09-20 2020-03-26 初速度(苏州)科技有限公司 Parking strategy based on deep reinforcement learning
CN111098850A (en) * 2018-10-25 2020-05-05 北京初速度科技有限公司 Automatic parking auxiliary system and automatic parking method
CN111434550A (en) * 2019-01-15 2020-07-21 初速度(苏州)科技有限公司 Simulation-based parking strategy generation method and system
CN111434550B (en) * 2019-01-15 2021-12-31 魔门塔(苏州)科技有限公司 Simulation-based parking strategy generation method and system
CN109823348A (en) * 2019-02-19 2019-05-31 百度在线网络技术(北京)有限公司 Unmanned vehicle reversing model control method, device, equipment and computer-readable medium
CN110525428B (en) * 2019-08-29 2020-09-04 合肥工业大学 Automatic parking method based on fuzzy depth reinforcement learning
CN110525428A (en) * 2019-08-29 2019-12-03 合肥工业大学 A kind of automatic parking method based on the study of fuzzy deeply
CN111047948A (en) * 2019-11-27 2020-04-21 康忠文 Auxiliary method and system for learning to learn to train
CN111098852A (en) * 2019-12-02 2020-05-05 北京交通大学 Parking path planning method based on reinforcement learning
CN113110500A (en) * 2021-05-10 2021-07-13 的卢技术有限公司 Transverse control method for low-speed automatic parking of automatic-driving automobile
CN113252366A (en) * 2021-06-23 2021-08-13 奇瑞新能源汽车股份有限公司 Automatic parking evaluation method and device for vehicle, vehicle and storage medium
CN113978547A (en) * 2021-10-21 2022-01-28 江铃汽车股份有限公司 Automatic driving steering control method and system
CN113978547B (en) * 2021-10-21 2022-08-02 江铃汽车股份有限公司 Automatic driving steering control method and system
CN115303256A (en) * 2022-08-10 2022-11-08 浙江零跑科技股份有限公司 Automatic parking path tracking control method and device and computer equipment

Also Published As

Publication number Publication date
CN107792062B (en) 2019-11-05

Similar Documents

Publication Publication Date Title
CN107792062B (en) Automatic parking control system
CN107697065B (en) Automatic parking control method for general parking scene
Pérez et al. Cascade architecture for lateral control in autonomous vehicles
Li et al. A potential field approach-based trajectory control for autonomous electric vehicles with in-wheel motors
CN106515722B (en) A kind of method for planning track of vertically parking
CN107380161B (en) A kind of active steering control device for aiding in driver to realize desired ride track
CN104742959B (en) The track of vehicle keeps control device
CN108216231B (en) One kind can open up united deviation auxiliary control method based on steering and braking
CN106681327B (en) A kind of the intelligent driving transverse and longitudinal decoupling control method and system of big inertial electrodynamic car
Chen et al. Dynamic drifting control for general path tracking of autonomous vehicles
Zhang et al. A novel steering system for a space-saving 4WS4WD electric vehicle: design, modeling, and road tests
CN103057436B (en) Yawing moment control method of individual driven electromobile based on multi-agent
CN106915385A (en) A kind of line traffic control differential steering system and method for distributed-driving electric automobile
CN107618504A (en) It is a kind of applied to the crawl speed control method and device automatically parked
CN106515716A (en) Coordination control device and method for chassis integrated control system of wheel driving electric vehicle
WO2019170346A1 (en) Method for calculating a trajectory limitation, and method for regulating a drive dynamic
Lin et al. Coordinated control architecture for motion management in ADAS systems
Mashadi et al. Integrated AFS/DYC sliding mode controller for a hybrid electric vehicle
CN105966263A (en) Differential turning road sense control method of motor-wheel vehicle driven by hub motors
Guo et al. Regional path moving horizon tracking controller design for autonomous ground vehicles
US20240075981A1 (en) Model predictive brake-to-steer control for automated vehicles
Chang et al. Combined longitudinal and lateral control of vehicle platoons
CN115268464A (en) Automatic driving automobile track tracking control method and device based on hierarchical constraint
Chen et al. Ribbon model based path tracking method for autonomous ground vehicles
Kim et al. Experimental verification of the power slide driving technique for control strategy of autonomous race cars

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20191105

CF01 Termination of patent right due to non-payment of annual fee