CN113009829A - Longitudinal and transverse coupling control method for intelligent internet motorcade - Google Patents
Longitudinal and transverse coupling control method for intelligent internet motorcade Download PDFInfo
- Publication number
- CN113009829A CN113009829A CN202110214816.4A CN202110214816A CN113009829A CN 113009829 A CN113009829 A CN 113009829A CN 202110214816 A CN202110214816 A CN 202110214816A CN 113009829 A CN113009829 A CN 113009829A
- Authority
- CN
- China
- Prior art keywords
- vehicle
- longitudinal
- transverse
- control
- parameter
- 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
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
Landscapes
- Engineering & Computer Science (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Abstract
The application discloses a longitudinal and transverse coupling control method for an intelligent networked fleet, which is suitable for member vehicles in the intelligent networked fleet and comprises the following steps: step 1, constructing a longitudinal and transverse coupling dynamic model of a member vehicle, and defining virtual control quantity according to the longitudinal and transverse coupling dynamic model; step 2, constructing a driving error model of the member vehicle according to the self-vehicle state information, the front-vehicle information and the rear-vehicle information of the member vehicle and the longitudinal-transverse kinematic relationship of the queue; step 3, calculating a control parameter group of the member vehicle by combining a longitudinal and transverse coupling dynamic model and a driving error model according to the self-vehicle state information and the front and rear vehicle information of the member vehicle; and 4, calculating the steering angle of the tire and the longitudinal control force of the vehicle according to the control parameter set and the defined virtual control quantity. Through the technical scheme in the application, the reliable following of the vehicle to the equation constraint of the designed vehicle state is ensured, the control target of the longitudinal and transverse directions of the queue is indirectly realized, and the more accurate longitudinal and transverse control of the queue is realized.
Description
Technical Field
The application relates to the technical field of automatic driving, in particular to a longitudinal and transverse coupling control method for an intelligent internet motorcade.
Background
The intelligent networked vehicle formation can greatly improve the fuel economy and the driving safety of the system, wherein reliable longitudinal and transverse automatic control is the basis of safe operation of a motorcade, and extensive research in the industrial and academic fields is obtained.
The current mainstream solution is to decouple the longitudinal control and the transverse control of the fleet, and design a longitudinal cooperative controller and a transverse path tracking (or lane keeping) controller separately. The longitudinal cooperative controller realizes the adjustment of the inter-vehicle distance in the motorcade, and ensures the stability of the inter-vehicle distance error and the non-amplification of the inter-vehicle distance error in the process of spreading the inter-vehicle distance error to the tail of the motorcade (queue stability); the latter lateral controller enables reliable following of a given path by the vehicle.
However, the longitudinal and lateral dynamics of the vehicle are mutually influenced, namely, the lateral steering operation influences the longitudinal acceleration of the train, and the longitudinal acceleration and deceleration operation also influences the lateral acceleration and the yaw acceleration. The mutual influence is more obvious on a low-attachment road surface or a vehicle rapid acceleration and deceleration working condition.
Therefore, in the prior art, the longitudinal and lateral decoupling control scheme cannot take the longitudinal and lateral dynamic coupling relationship of the vehicle into consideration, and particularly on some curved lanes, the decoupling control scheme inevitably limits the improvement of the precision of the longitudinal and lateral control of the fleet, and even brings the phenomenon of system buffeting.
Disclosure of Invention
The purpose of this application lies in: according to the kinematic relationship, a target of the longitudinal and transverse control of the queue is modeled into equality constraint on the vehicle state, and then the reliable following of the vehicle to the design equality constraint is ensured through the design constraint tracking controller, so that the longitudinal and transverse control target of the queue is indirectly realized, and the more accurate longitudinal and transverse control of the queue is realized.
The technical scheme of the application is as follows: the method is suitable for member vehicles in the intelligent networked fleet and comprises the following steps: step 1, constructing a longitudinal and transverse coupling dynamic model of a member vehicle, and defining virtual control quantity according to the longitudinal and transverse coupling dynamic model; step 2, according to the self-vehicle state information and the front-and-back vehicle information of the member vehicles and the longitudinal and transverse directions of the queueConstructing a driving error model of the member vehicle according to the kinematic relationship, wherein the driving error model at least comprises a longitudinal driving error model and a transverse driving error model; step 3, calculating a control parameter group of the member vehicle by combining a longitudinal and transverse coupling dynamic model and a driving error model according to the self-vehicle state information and the front and rear vehicle information of the member vehicle; step 4, calculating the steering angle delta of the tire according to the control parameter set and the defined virtual control quantityf,iAnd a vehicle longitudinal control force Fx,i。
In any one of the above technical solutions, further, the queue longitudinal-lateral kinematic relationship at least includes a queue longitudinal-lateral kinematic relationship and a vehicle lateral-kinematic relationship step 2, which specifically includes: step 21, constructing a longitudinal driving error model according to the own vehicle state information, the information of the front and rear vehicles and the longitudinal kinematic relationship of the queue of the member vehicle, wherein the longitudinal driving error model at least comprises a vehicle spacing error and a derivative of the vehicle spacing error; and step 22, constructing a transverse driving error model according to the self-vehicle state information and the expected path information of the member vehicle and the transverse kinematic relationship of the vehicle.
In any one of the above technical solutions, further, the control parameter set at least includes a first parameter set and a second parameter set, and step 3 specifically includes:
step 31, converting the longitudinal and transverse coupling dynamic model into a second-order linear model, wherein the calculation formula of the second-order linear model is as follows:
in the formulaIs a system state vector, Ui=[u1,i,u2,i]TTo control the vector, xi,yiAndrespectively, longitudinal displacement, transverse displacement and yaw angle, u1,iAnd u2,iRespectively, a first and a second virtual control quantity, Mi∈R3 ×3,Hi∈R3,Bi∈R3×2Respectively an inertia matrix, a parameter matrix and an input matrix;
step 32, calculating a first parameter set by combining a second-order linear model according to the self-vehicle state information of the member vehicle;
step 33, establishing a vehicle state equality constraint according to the driving error model, wherein when the vehicle state equality constraint is strictly established, a control target of the intelligent internet fleet is realized, and a first order form and a second order form of the vehicle state equality constraint are respectively as follows:
in the formula, ciAs an intermediate parameter, AiIs a first parameter matrix, biIs a second parameter matrix;
and step 34, calculating a second parameter set according to the driving error model, the own vehicle state information and the front and rear vehicle information by combining the vehicle state equation constraint.
In any of the above technical solutions, further, the second parameter set at least includes: first parameter matrix AiA second parameter matrix biConstrained following error betaiWherein the first parameter matrix AiA second parameter matrix biConstrained following error betaiThe calculation formula of (2) is as follows:
in the formula, ciIs an intermediate parameter, qi、ηi、ωiIs a constant parameter and takes a value greater than 0, ey,iIs a transverse position error,Error of orientation angle, ep,iFor lateral position error at the preview point, cR,iIs the curvature of the path at the closest point on the path, Δ yiIs the increase in lateral position error at the pre-aim point, L, caused by path changesiIs the pre-aiming distance.
In any one of the above technical solutions, further, the first parameter set at least includes: an inertia matrix, a parameter matrix, an input matrix, wherein the inertia matrix MiParameter matrix HiInput matrix BiThe calculation formula of (2) is as follows in sequence:
in the formula, miRepresenting the vehicle mass; i isz,iRepresenting the moment of inertia of the vehicle about an axis perpendicular to the ground at its center of mass,is the vehicle lateral velocity;is the vehicle longitudinal speed; c. Cx,iRepresenting a wind resistance coefficient, and g representing a gravity acceleration; f. ofR,iDenotes the coefficient of rolling resistance,/f,iIs the distance of the center of mass of the vehicle from its front axle,/r,iThe distance of the vehicle's center of mass from its rear axle; cf,iFront wheel cornering stiffness; cr,iIn order to the rear wheel side cornering stiffness,is the yaw rate.
In any one of the above technical solutions, further, step 4 specifically includes:
step 41, according to the control parameter set, to the expected virtual control quantityA calculation is performed in which, among other things,andare respectively the first virtual control quantity u1,iAnd a second virtual control amount u2,iThe calculation formula of the desired virtual controlled variable is:
in the formula, κi> 0 is a control parameter, Pi∈R2×2For a given positive definite parameter matrix, p1,iFor feedforward control of quantity, p2,iIs a feedback control quantity;
and step 42, combining the defined virtual control quantity, and calculating the tire steering angle delta according to the calculated expected virtual control quantityf,iAnd a vehicle longitudinal control force Fx,i,
Wherein, when Fx,iWhen the longitudinal control force F is more than or equal to 0x,iAs a driving force, when Fx,i< 0, vehicle longitudinal control force Fx,iIs the braking force.
The beneficial effect of this application is:
(1) according to the technical scheme, the coupling relation between the longitudinal dynamics and the transverse dynamics of the vehicles is considered, and the coupled longitudinal controller and the coupled transverse controller are established, so that member vehicles in the intelligent internet fleet can be on a curved lane, and more accurate queue longitudinal and transverse control is realized.
(2) The decoupling method and the decoupling device realize the decoupling of the vehicle dynamic model and the motion control task, and further do not need to establish a complex error dynamic model. Under this framework, the coupled longitudinal and transverse vehicle coupling dynamics model is established, which can be time-varying and highly nonlinear, and the vehicle kinematics model for the equality constraint design can be nonlinear. Therefore, the vehicle dynamics model involved in the application is more accurate, and better vehicle following control performance can be certainly realized based on the more accurate model.
Drawings
The advantages of the above and/or additional aspects of the present application will become apparent and readily appreciated from the following description of the embodiments, taken in conjunction with the accompanying drawings of which:
FIG. 1 is a schematic flow diagram of a method for intelligent networked fleet longitudinal and lateral coupling control according to one embodiment of the present application;
FIG. 2 is a fleet schematic according to one embodiment of the present application;
FIG. 3 is a schematic view of an ith member vehicle path tracking kinematics according to one embodiment of the present application.
Detailed Description
In order that the above objects, features and advantages of the present application can be more clearly understood, the present application will be described in further detail with reference to the accompanying drawings and detailed description. It should be noted that the embodiments and features of the embodiments of the present application may be combined with each other without conflict.
In the following description, numerous specific details are set forth in order to provide a thorough understanding of the present application, however, the present application may be practiced in other ways than those described herein, and therefore the scope of the present application is not limited by the specific embodiments disclosed below.
As shown in fig. 1, the embodiment provides a method for controlling longitudinal and lateral coupling of an intelligent internet fleet, which is suitable for member vehicles in the intelligent internet fleet and is not suitable for pilot vehicles. The member cars are numbered 1, 2, 1, i, N in sequence. The control method in the embodiment mainly comprises the following steps: and establishing the vehicle state equality constraint capable of directly ensuring the control target according to the longitudinal and transverse kinematic relationship of the queue. And establishing a vehicle longitudinal and transverse coupling dynamic model, and designing a constraint following controller by combining the established vehicle state equation constraint, wherein a corresponding control method is operated on the constraint following controller so as to control the vehicle. The designed constraint following controller strictly ensures that the vehicle state meets the constructed vehicle state equality constraint, and indirectly ensures the control target of the queue.
It is equipped with on-vehicle sensing equipment and car communication equipment to set for all member's cars in the motorcade, and wherein, on-vehicle sensing equipment can measure from car status information, includes: vehicle lateral velocity vy,iLongitudinal speed v of the vehiclex,iLongitudinal acceleration of vehicleYaw ratePath curvature c at the nearest point of the desired pathR,iThe distance d between the vehicle and the front vehiclei(ii) a The vehicle-to-vehicle communication device can acquire front and rear vehicle information, including: longitudinal speed v of the front vehiclex,i-1Longitudinal direction of front vehicleAcceleration in direction of directionMeasured vehicle-to-vehicle distance error e from the rear vehicle to the front vehiclei+1Calculated by the rear carTo be received
Now, taking the ith member vehicle in the vehicle fleet as an example, a method for controlling the longitudinal and transverse coupling of the intelligent internet fleet in the embodiment is described, which specifically includes:
the setting can be through modes such as experiment or reading vehicle design file, obtains the parameter information of self of vehicle, includes at least: vehicle mass mjMoment of inertia I of the vehicle about an axis perpendicular to the ground at its centre of massz,iWind resistance coefficient cx,iAcceleration of gravity g, rolling resistance coefficient fR,iDistance l between the center of mass of the vehicle and the front axle thereoff,iDistance l of the vehicle's center of mass from its rear axler,iFront wheel side cornering stiffness Cf,iRear wheel side cornering stiffness Cr,i。
By the transverse displacement y of the ith vehicleiAngle of orientationAnd a longitudinal displacement xiThe tire steering angle delta of the front wheel steering system as the system statef,iAnd vehicle longitudinal driving or braking force Fx,iAnd (vehicle longitudinal control force) is input as a control quantity, and a longitudinal and transverse coupling dynamic model of the ith vehicle is established. To characterize the mapping between the system state quantity change and the control quantity input.
When F is presentx,iWhen the force is more than or equal to 0, the longitudinal stress F of the vehiclex,iAs a driving force, when Fx,iWhen less than 0, the vehicle is longitudinally stressed Fx,iIs the braking force.
The calculation formula of the longitudinal and transverse coupling dynamic model of the ith member vehicle is as follows:
wherein, the subscript i represents the ith member vehicle in the queue; m isiRepresenting a vehicle mass of an ith member vehicle; i isz,iRepresenting the moment of inertia of the vehicle about an axis perpendicular to the ground at its center of mass;is the vehicle lateral velocity;is the vehicle longitudinal speed; c. Cx,iRepresenting a wind resistance coefficient; g represents the gravitational acceleration; f. ofR,iRepresents a rolling resistance coefficient; lf,iThe distance of the center of mass of the vehicle from the front wheel axle of the vehicle; lr,iThe distance of the vehicle's center of mass from its rear axle; cf,iFront wheel cornering stiffness; cr,iIs rear wheel cornering stiffness.
The virtual control quantity in the embodiment is set according to a calculation formula of a longitudinal-transverse coupling dynamic model of the ith member vehicle, and the corresponding definition formula is as follows:
wherein u is1,iAnd u2,iThe purpose of defining the virtual control quantities for the first and second virtual control quantities is to reduce the design difficulty of the controller, and when designing the subsequent controller, the expected values of the two virtual control quantities are firstly obtained, and then the control quantity actually applied to the vehicle is reversely obtained according to the definition formula of the virtual control quantities, and the method comprises the following steps: tire steering angle δ of front wheel steering systemf,iAnd vehicle longitudinal driving or braking force, i.e. vehicle longitudinal control force Fx,i。
And 2, constructing a driving error model of the member vehicle according to the self-vehicle state information, the front-vehicle information and the rear-vehicle information of the member vehicle and the queue longitudinal and transverse kinematic relationship, wherein the driving error model at least comprises a longitudinal driving error model and a transverse driving error model. Step 2, specifically comprising:
and step 21, the queue longitudinal and transverse kinematic relationship at least comprises a queue longitudinal kinematic relationship and a vehicle transverse kinematic relationship. According to the self-vehicle state information, the front-vehicle information and the rear-vehicle information of the member vehicles and the longitudinal kinematic relationship of the queue, constructing a longitudinal driving error model, specifically, calculating the inter-vehicle distance error and the derivative of the inter-vehicle distance error;
as shown in FIG. 2, set xiIs the longitudinal displacement of the i-th member vehicle, diIs the inter-vehicle distance between the ith member vehicle and the vehicle in front of the member vehicle, li-1Is the length of the i-1 st member vehicle, and V2V is the vehicle-to-vehicle communication.
Acquiring front vehicle information through vehicle-to-vehicle communication equipment: longitudinal speed v of the front vehiclex,i-1Longitudinal acceleration of the front vehicleThus, the actual inter-vehicle distance of the ith vehicle from its preceding vehicle can be expressed as:
di=xi-1-xi-li-1,
wherein li-1For the body length of the i-1 st vehicle, the desired inter-vehicle distance is a fixed value d0,iThen the inter-vehicle distance error and its first and second derivatives can be expressed as:
ei=xi-1-xi-li-1-d0,i
by using the vehicle-vehicle communication equipment, the calculated inter-vehicle distance error e of the rear vehicle can be obtainedi+1And its first derivativeSecond derivative of
And step 22, constructing a transverse driving error model according to the self-vehicle state information and the expected path information of the member vehicle and the transverse kinematic relationship of the vehicle. The model at least comprises: lateral position error, orientation angle error, lateral position error at the home position, and the corresponding derivatives of these errors.
Specifically, as shown in FIG. 3, xi-0-yiCoordinates with the center of gravity as the origin for the ith member vehicle,error of orientation angle for i-th member vehicle, ey,iError in lateral position of the i-th member vehicle, LiIs the pre-range of the ith member vehicle, ep,iFor the transverse position error at the preview point, Δ y, of the ith member vehicleiThe position error increment of the ith member vehicle at the preview point is caused by the path change.
The self-vehicle state information of the member vehicle at least comprises: vehicle lateral velocity vy,iLongitudinal speed v of the vehiclex,iLongitudinal acceleration of vehicleYaw rateThe transverse driving error at least comprises: lateral position error ey,iError of orientation angleLateral position error e at the preview pointp,i,
Lateral position error ey,iThe formula for calculating the derivative of (c) is:
in the formula (I), the compound is shown in the specification,as a lateral position error ey,iThe first derivative of (a) is,the second derivative of the lateral position error.
wherein the content of the first and second substances,is the desired orientation angle, determined by the angle of the closest point tangent to the path.
Wherein, cR,iIs the curvature of the path at the closest point on the path.
in the formula (I), the compound is shown in the specification,as an error of the orientation angleThe first derivative of (a) is,as an error of the orientation angleThe second derivative of (a).
According to the transverse kinematic relation of the vehicle, the transverse position error e at the pre-aiming pointp,iCan be expressed as:
wherein, Δ yiIs the lateral position at the point of preview caused by the path changeError increment; l isiIs the pre-aiming distance.
It should be noted that, in actual control, the desired path is usually represented by a series of coordinate points, ep,iUsually directly calculated by coordinates, and delta y is not involved in the actual control processiThe measurement of (2).
Therefore, the lateral position error e at the preview pointp,iThe formula for calculating the derivative of (c) is:
in the formula (I), the compound is shown in the specification,as a lateral position error e at the preview pointp,iThe first derivative of (a) is,as a lateral position error e at the preview pointp,iThe second derivative of (a).
And 3, calculating a control parameter group of the member vehicle by combining a longitudinal and transverse coupling dynamic model and a driving error model according to the self-vehicle state information and the front and rear vehicle information of the member vehicle, wherein the control parameter group at least comprises a first parameter group and a second parameter group. The step 3 specifically includes:
step 31, converting the longitudinal and transverse coupling dynamic model into a second-order linear model;
specifically, a system state vector is defined asControl vector is Ui=[u1,i,u2,i]T,u1,iAnd u2,iThe first and second virtual control quantities are provided.
Therefore, the above dynamic model can be organized into the following second order linear model:
in the formula Mi∈R3×3,Hi∈R3,Bi∈R3×2Respectively an inertia matrix, a parameter matrix and an input matrix.
And 32, calculating a first parameter set by combining a second-order linear model according to the self-vehicle state information of the member vehicle, wherein the first parameter set at least comprises: an inertia matrix, a parameter matrix, an input matrix, wherein the inertia matrix MiParameter matrix HiInput matrix BiThe calculation formula of (2) is as follows in sequence:
in the formula, MiIs an inertia matrix, HiAs a parameter matrix, BiFor the input matrix, miRepresenting the vehicle mass; i isz,iRepresenting the moment of inertia of the vehicle about an axis perpendicular to the ground at its center of mass;is the vehicle lateral velocity;is the vehicle longitudinal speed; c. Cx,iRepresenting a wind resistance coefficient; g represents the gravitational acceleration; f. ofR,iRepresents a rolling resistance coefficient; lf,iThe distance of the center of mass of the vehicle from the front wheel axle of the vehicle; lr,iThe distance of the vehicle's center of mass from its rear axle; cf,iFront wheel cornering stiffness; cr,iIs a rear partThe wheel-side cornering stiffness of the vehicle,is the yaw rate.
And step 33, establishing vehicle state equality constraint according to the driving error model, wherein when the vehicle state equality constraint is strictly established, the control target of the intelligent internet fleet is realized.
In this embodiment, taking a conventional control target as an example, the following of the member vehicle is controlled, and the conventional control target is set as:
(1) path tracking stability: the lateral path tracking error can converge to 0 for all vehicles in the fleet, i.e.
Wherein e isp,iIs the lateral position error of the ith member vehicle at the preview point.
(2) Stability in the queue: for all vehicles in the queue, the inter-vehicle distance error can converge to 0, limt→∞ei(t) ═ 0, i ═ 1, 2.., N, where e isiAnd (4) the error between the actual inter-vehicle distance of the ith member vehicle and the expected inter-vehicle distance of the ith member vehicle.
(3) Queue stability: the vehicle distance error is attenuated (gradually reduced) in the process of transmitting to the tail of the team, namely | eN(t)|<|eN-1(t)|<…<|e1(t)|=0。
Transfer function of error
For any i 2, 3, when N is established, queue stability is guaranteed, wherein E is equal toi(s) is the inter-vehicle distance error ei(t) Laplace transform.
And establishing vehicle state equality constraint capable of ensuring the control target for the vehicle state according to the driving error model, and converting the path following control task into a servo constraint control task of the vehicle. Furthermore, the control targets of the queue can be ensured by controlling the vehicle to reliably follow the equality constraints of the vehicle states.
The following vehicle state equation constraints are established for the vehicles in the fleet, with the vehicle state equation constraints for the 1 st, 2., N-1 st vehicles being:
wherein, i is 1, 2., N-1,
the vehicle state equation for the nth vehicle (i.e., when i equals N) is constrained as:
wherein e isiIn order to be the error of the distance between the vehicles,is its first derivative, ep,iThe lateral position error at the preview point for the ith member vehicle,for their corresponding first derivatives, qi>0,ηi>0,ωi> 0 are constant parameters.
The following conclusions are reached:
conclusion 1: if the vehicle state equation constraint is strictly met, the queue path tracking stability is ensured, and the stability in the queue is ensured.
Conclusion 2: if the above equation is constrained, the parameter selection satisfies 0 < qi<1,ηi=ηi+1If 1, 2, N-1 is true for any i, queue stability is guaranteed.
Therefore, in conjunction with the driving error model in step 2, the above-mentioned vehicle state equation constraints can be converted into:
in the formula, ciIs an intermediate parameter. Derivation of the above transformed equation with respect to time yields a second order form of the vehicle state equation constraint:
in the formula, biIs a second parameter matrix.
And step 34, calculating a second parameter set by combining the vehicle state equation constraint according to the driving error model, the vehicle state information and the front and rear vehicle information, wherein the second parameter set at least comprises: first parameter matrix AiA second parameter matrix biConstrained following error betaiFirst parameter matrix AiA second parameter matrix biConstrained following error betaiThe calculation formula of (2) is as follows in sequence:
in the formula (I), the compound is shown in the specification,in order to orient the angular error,for the first derivative thereof,as its second derivative, LiFor a pre-aiming distance, cR,iCurvature of the path as the closest point on the path, vx,iVehicle longitudinal speed of i-th vehicle, eiIn order to be the error of the distance between the vehicles,for the first derivative thereof,as its second derivative, Δ yiTo account for the incremental position error of the ith member vehicle at the home point caused by the path change, ep,iFor the lateral position error of the ith member vehicle at the preview point,for the first derivative thereof,for the purpose of its second derivative, the first derivative,is the longitudinal acceleration of the front vehicle, vy,iAs the lateral speed of the vehicle,as the yaw rate,for longitudinal acceleration of the vehicle, XiIs a vector of the states of the system,is its first derivative, t is a time parameter, ciIs an intermediate parameter, qi、ηi、ωiIs a constant parameter and takes a value greater than 0.
step 41, according to the control parameter set, to the expected virtual control quantityA calculation is performed in which, among other things,andare respectively the first virtual control quantity u1,iAnd a second virtual control amount u2,iThe specific calculation formula of the first and second expected values of (1) is as follows:
in the formula, κi> 0 is a control parameter, Pi∈R2×2For a given positive definite parameter matrix, p1,iFor feedforward control of quantities and p2,iIs a feedback control amount. p is a radical of1,iVirtual control quantity required for satisfying vehicle state equality constraint for member vehicles; p is a radical of2,iCan further control the constraint following error betaiApproaching 0. Based on the Lyapunov stability theory, the method can prove that: in the virtual control quantity UiUnder the action of the controller, the member vehicles can strictly follow the equation constraint of the designed vehicle state, and the control target of the queue is indirectly realized.
And step 42, combining the defined virtual control quantity, and calculating the tire steering angle delta according to the expected virtual control quantity obtained by calculationf,iAnd a vehicle longitudinal control force (driving force or braking force) Fx,iThe specific calculation formula is as follows:
in the formula, alpha1,i、α2,i、α3,iIs an intermediate variable.
By the above calculation, the tire steering angle δ of the front wheel steering system is calculatedf,iInput steer-by-wire system, if Fx,iGreater than 0, and driving force is the longitudinal driving force F of the vehiclex,iAn input drive-by-wire system; if Fx,i< 0, and braking force F in the longitudinal direction of the vehicle as braking forcex,iInput brake-by-wire system.
With the vehicle-to-vehicle communication device, the state of the current member vehicle can be transmitted to the neighboring vehicle so that it completes the follow-up control. If the ith member vehicle is in the state vx,i、Packaging and sending to the (i + 1) th member vehicle; calculating the vehicle distance error and the first and second derivatives e thereofi、Andand packaging and sending the data to the i-1 st member vehicle.
For the vehicle N at the tail of the queue, only e obtained by calculation is neededN、Andand packaging and sending the data to the vehicle N-1.
The technical scheme of the application is described in detail in the above with reference to the accompanying drawings, and the application provides a longitudinal and transverse coupling control method for an intelligent networked fleet, which is suitable for member vehicles in the intelligent networked fleet, and comprises the following steps: step 1, constructing a longitudinal and transverse coupling dynamic model of a member vehicle, and defining virtual control quantity according to the longitudinal and transverse coupling dynamic model; step 2, constructing a driving error model of the member vehicle according to the self-vehicle state information, the front-vehicle information and the rear-vehicle information of the member vehicle and the longitudinal-transverse kinematic relationship of the queue; step 3, calculating a control parameter group of the member vehicle by combining a longitudinal and transverse coupling dynamic model and a driving error model according to the self-vehicle state information and the front and rear vehicle information of the member vehicle; and 4, calculating the steering angle of the tire and the longitudinal control force of the vehicle according to the control parameter set and the defined virtual control quantity. Through the technical scheme in the application, the reliable following of the vehicle to the equation constraint of the designed vehicle state is ensured, the control target of the longitudinal and transverse directions of the queue is indirectly realized, and the more accurate longitudinal and transverse control of the queue is realized.
The steps in the present application may be sequentially adjusted, combined, and subtracted according to actual requirements.
The units in the device can be merged, divided and deleted according to actual requirements.
Although the present application has been disclosed in detail with reference to the accompanying drawings, it is to be understood that such description is merely illustrative and not restrictive of the application of the present application. The scope of the present application is defined by the appended claims and may include various modifications, adaptations, and equivalents of the invention without departing from the scope and spirit of the application.
Claims (6)
1. A method for controlling longitudinal and transverse coupling of an intelligent networked fleet is suitable for member vehicles in the intelligent networked fleet, and comprises the following steps:
step 1, constructing a longitudinal and transverse coupling dynamic model of the member vehicle, and defining a virtual control quantity according to the longitudinal and transverse coupling dynamic model;
step 2, constructing a driving error model of the member vehicle according to the self-vehicle state information, the front-vehicle information and the rear-vehicle information of the member vehicle and the queue longitudinal and transverse kinematic relationship, wherein the driving error model at least comprises a longitudinal driving error model and a transverse driving error model;
step 3, calculating a control parameter group of the member vehicle by combining the longitudinal and transverse coupling dynamic model and the driving error model according to the self-vehicle state information and the front and rear vehicle information of the member vehicle;
step 4, calculating the steering angle delta of the tire according to the control parameter set and the defined virtual control quantityf,iAnd a vehicle longitudinal control force Fx,i。
2. The method according to claim 1, wherein the queue longitudinal-lateral kinematic relationship at least comprises a queue longitudinal-lateral kinematic relationship and a vehicle lateral kinematic relationship, and the step 2 specifically comprises:
step 21, constructing the longitudinal driving error model according to the own vehicle state information, the information of the front and rear vehicles of the member vehicle and the longitudinal kinematic relationship of the queue, wherein the longitudinal driving error model at least comprises a vehicle distance error and a derivative of the vehicle distance error;
and step 22, constructing the transverse driving error model according to the self-vehicle state information and the expected path information of the member vehicle and the transverse kinematic relationship of the vehicle.
3. The method according to claim 1, wherein the control parameter sets at least include a first parameter set and a second parameter set, and the step 3 specifically includes:
step 31, converting the longitudinal and transverse coupling dynamic model into a second-order linear model, wherein a calculation formula of the second-order linear model is as follows:
in the formulaIs a system state vector, Ui=[u1,i,u2,i]TTo control the vector, xi,yiAndrespectively, longitudinal displacement, transverse displacement and yaw angle, u1,iAnd u2,iRespectively, a first and a second virtual control quantity, Mi∈R3×3,Hi∈R3,Bi∈R3×2Respectively an inertia matrix, a parameter matrix and an input matrix;
step 32, calculating the first parameter set by combining the second-order linear model according to the self-vehicle state information of the member vehicle;
step 33, establishing a vehicle state equality constraint according to the driving error model, wherein when the vehicle state equality constraint is strictly established, a control target of the intelligent internet fleet is realized, and a first order form and a second order form of the vehicle state equality constraint are respectively:
in the formula, ciAs an intermediate parameter, AiIs a first parameter matrix, biIs a second parameter matrix;
and step 34, calculating the second parameter set according to the driving error model, the own vehicle state information and the front and rear vehicle information by combining the vehicle state equation constraint.
4. The method of claim 3, wherein the second set of parameters comprises at least: the first parameter matrix AiThe second parameter matrix biConstrained following error betaiWherein the first parameter matrix AiThe second parameter matrix biThe constraint following error betaiThe calculation formula of (2) is as follows:
in the formula, ciIs an intermediate parameter, qi、ηi、ωiIs a constant parameter and takes a value greater than 0, ey,iIs a transverse position error,Error of orientation angle, ep,iIs the transverse position at the preview pointError, cR,iIs the curvature of the path at the closest point on the path, Δ yiIs the increase in lateral position error at the pre-aim point, L, caused by path changesiIs the pre-aiming distance.
5. The method of claim 3, wherein the first set of parameters comprises at least: an inertia matrix, a parameter matrix, an input matrix, wherein the inertia matrix MiThe parameter matrix HiThe input matrix BiThe calculation formula of (2) is as follows in sequence:
in the formula, miRepresenting the vehicle mass; i isz,iRepresenting the moment of inertia of the vehicle about an axis perpendicular to the ground at its center of mass,is the vehicle lateral velocity;is the vehicle longitudinal speed; c. Cx,iRepresenting a wind resistance coefficient, and g representing a gravity acceleration; f. ofR,iDenotes the coefficient of rolling resistance,/f,iIs the distance of the center of mass of the vehicle from its front axle,/r,iThe distance of the vehicle's center of mass from its rear axle; cf,iFront wheel cornering stiffness; cr,iIn order to the rear wheel side cornering stiffness,is the yaw rate.
6. The method for controlling the tandem intelligent vehicle fleet longitudinal and transverse coupling according to any one of claims 1 to 5, wherein the step 4 specifically comprises:
step 41, according to the control parameter set, aiming at the expected virtual control quantityA calculation is performed in which, among other things,andare respectively the first virtual control quantity u1,iAnd the second virtual control amount u2,iThe calculation formula of the desired virtual control amount is:
in the formula, κi>0 is a control parameter, Pi∈R2×2For a given positive definite parameter matrix, p1,iFor feedforward control of quantity, p2,iIs a feedback control quantity;
and 42, combining the defined virtual control quantity, and calculating the tire steering angle delta according to the calculated expected virtual control quantityf,iAnd said vehicle longitudinal control force Fx,i,
Wherein, when Fx,iWhen the longitudinal control force F is more than or equal to 0x,iAs a driving force, the driving force is,when F is presentx,i<At 0, the vehicle longitudinal control force Fx,iIs the braking force.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110214816.4A CN113009829B (en) | 2021-02-25 | 2021-02-25 | Longitudinal and transverse coupling control method for intelligent internet motorcade |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110214816.4A CN113009829B (en) | 2021-02-25 | 2021-02-25 | Longitudinal and transverse coupling control method for intelligent internet motorcade |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113009829A true CN113009829A (en) | 2021-06-22 |
CN113009829B CN113009829B (en) | 2022-04-26 |
Family
ID=76386126
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110214816.4A Active CN113009829B (en) | 2021-02-25 | 2021-02-25 | Longitudinal and transverse coupling control method for intelligent internet motorcade |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113009829B (en) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113848942A (en) * | 2021-10-18 | 2021-12-28 | 青岛德智汽车科技有限公司 | Constraint-oriented intelligent network-connected automobile robust lane-changing confluence control method |
CN114137831A (en) * | 2021-10-13 | 2022-03-04 | 清华大学 | Longitudinal control method and device in intelligent networked automobile queue system |
CN114475596A (en) * | 2022-02-22 | 2022-05-13 | 青岛德智汽车科技有限公司 | Intelligent networking queue robust control method for ensuring safety in lane changing scene |
Citations (25)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20080228329A1 (en) * | 2007-03-13 | 2008-09-18 | Honeywell International Inc. | Methods and systems for friction detection and slippage control |
US20120209489A1 (en) * | 2009-10-23 | 2012-08-16 | Hitachi Automotive Systems, Ltd. | Vehicle Movement Controller |
CN102880053A (en) * | 2012-09-29 | 2013-01-16 | 西北工业大学 | Prediction model based hypersonic aircraft sliding-mode control method |
CN103926837A (en) * | 2014-04-22 | 2014-07-16 | 西北工业大学 | Comprehensive decoupling method for aircraft under action of multiple kinds of coupling |
CN104022742A (en) * | 2014-06-19 | 2014-09-03 | 金陵科技学院 | Aircraft posture robust inversion fault tolerant control method based on neural network observer |
CN104252134A (en) * | 2014-09-17 | 2014-12-31 | 南京理工大学 | Method for controlling position of self-adaptive robust of motor servo system based on extended state observer |
CN104406598A (en) * | 2014-12-11 | 2015-03-11 | 南京航空航天大学 | Non-cooperative spacecraft attitude estimation method based on virtual sliding mode control |
CN104554255A (en) * | 2013-10-22 | 2015-04-29 | 沈阳工业大学 | Dynamic decoupling method for active safety integrated control system of four-wheel drive electric automobile chassis |
CN104881030A (en) * | 2015-05-27 | 2015-09-02 | 西安交通大学 | Unmanned vehicle-side longitudinal coupling tracking control method based on rapid terminal sliding mode principle |
CN105814499A (en) * | 2013-06-14 | 2016-07-27 | 华莱士·E·拉里莫尔 | A method and system of dynamic model identification for monitoring and control of dynamic machines with variable structure or variable operation conditions |
US20170043769A1 (en) * | 2014-05-08 | 2017-02-16 | Volvo Car Corporation | Method for providing an object prediction representation |
CN106671982A (en) * | 2017-01-09 | 2017-05-17 | 厦门大学 | Multi-intelligent agent based unmanned electric car automatic overtaking system and method |
US20180029603A1 (en) * | 2016-07-29 | 2018-02-01 | GM Global Technology Operations LLC | Corner-Based Longitudinal Speed Estimation |
EP3431355A1 (en) * | 2017-07-19 | 2019-01-23 | Volkswagen Aktiengesellschaft | Method for detecting and characterising a driving behaviour of an autopilot or a driver in a motor vehicle, control unit and motor vehicle |
CN109683477A (en) * | 2018-12-12 | 2019-04-26 | 中国地质大学(武汉) | A kind of design method and system of random multi-agent system finite-time control device |
CN109799828A (en) * | 2019-02-28 | 2019-05-24 | 北京智行者科技有限公司 | Automatic driving vehicle transverse and longitudinal control method for coordinating |
CN109976159A (en) * | 2019-04-09 | 2019-07-05 | 台州学院 | Intelligent vehicle crosswise joint method based on safely controllable domain |
CN110175428A (en) * | 2019-06-03 | 2019-08-27 | 北京理工大学 | Vehicle movement characteristic Simulation method and system based on vehicle dynamic model |
CN110244747A (en) * | 2019-08-02 | 2019-09-17 | 大连海事大学 | Heterogeneous fleet fault-tolerant control method based on actuator fault and saturation |
CN111007722A (en) * | 2019-12-18 | 2020-04-14 | 厦门大学 | Transverse robust fault-tolerant control system and method for four-wheel steering automatic driving automobile |
CN111267834A (en) * | 2020-02-17 | 2020-06-12 | 北京理工大学 | Vehicle yaw stability prediction control method and system |
CN111694366A (en) * | 2020-07-08 | 2020-09-22 | 东北大学秦皇岛分校 | Motorcade cooperative braking control method based on sliding mode control theory |
CN111750866A (en) * | 2020-07-07 | 2020-10-09 | 吉林大学 | Intelligent automobile transverse and longitudinal coupling path planning method based on regional virtual force field |
CN111780981A (en) * | 2020-05-21 | 2020-10-16 | 东南大学 | Intelligent vehicle formation lane change performance evaluation method |
CN112068598A (en) * | 2020-09-28 | 2020-12-11 | 西北工业大学 | Unmanned aerial vehicle formation flying method and control system |
-
2021
- 2021-02-25 CN CN202110214816.4A patent/CN113009829B/en active Active
Patent Citations (25)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20080228329A1 (en) * | 2007-03-13 | 2008-09-18 | Honeywell International Inc. | Methods and systems for friction detection and slippage control |
US20120209489A1 (en) * | 2009-10-23 | 2012-08-16 | Hitachi Automotive Systems, Ltd. | Vehicle Movement Controller |
CN102880053A (en) * | 2012-09-29 | 2013-01-16 | 西北工业大学 | Prediction model based hypersonic aircraft sliding-mode control method |
CN105814499A (en) * | 2013-06-14 | 2016-07-27 | 华莱士·E·拉里莫尔 | A method and system of dynamic model identification for monitoring and control of dynamic machines with variable structure or variable operation conditions |
CN104554255A (en) * | 2013-10-22 | 2015-04-29 | 沈阳工业大学 | Dynamic decoupling method for active safety integrated control system of four-wheel drive electric automobile chassis |
CN103926837A (en) * | 2014-04-22 | 2014-07-16 | 西北工业大学 | Comprehensive decoupling method for aircraft under action of multiple kinds of coupling |
US20170043769A1 (en) * | 2014-05-08 | 2017-02-16 | Volvo Car Corporation | Method for providing an object prediction representation |
CN104022742A (en) * | 2014-06-19 | 2014-09-03 | 金陵科技学院 | Aircraft posture robust inversion fault tolerant control method based on neural network observer |
CN104252134A (en) * | 2014-09-17 | 2014-12-31 | 南京理工大学 | Method for controlling position of self-adaptive robust of motor servo system based on extended state observer |
CN104406598A (en) * | 2014-12-11 | 2015-03-11 | 南京航空航天大学 | Non-cooperative spacecraft attitude estimation method based on virtual sliding mode control |
CN104881030A (en) * | 2015-05-27 | 2015-09-02 | 西安交通大学 | Unmanned vehicle-side longitudinal coupling tracking control method based on rapid terminal sliding mode principle |
US20180029603A1 (en) * | 2016-07-29 | 2018-02-01 | GM Global Technology Operations LLC | Corner-Based Longitudinal Speed Estimation |
CN106671982A (en) * | 2017-01-09 | 2017-05-17 | 厦门大学 | Multi-intelligent agent based unmanned electric car automatic overtaking system and method |
EP3431355A1 (en) * | 2017-07-19 | 2019-01-23 | Volkswagen Aktiengesellschaft | Method for detecting and characterising a driving behaviour of an autopilot or a driver in a motor vehicle, control unit and motor vehicle |
CN109683477A (en) * | 2018-12-12 | 2019-04-26 | 中国地质大学(武汉) | A kind of design method and system of random multi-agent system finite-time control device |
CN109799828A (en) * | 2019-02-28 | 2019-05-24 | 北京智行者科技有限公司 | Automatic driving vehicle transverse and longitudinal control method for coordinating |
CN109976159A (en) * | 2019-04-09 | 2019-07-05 | 台州学院 | Intelligent vehicle crosswise joint method based on safely controllable domain |
CN110175428A (en) * | 2019-06-03 | 2019-08-27 | 北京理工大学 | Vehicle movement characteristic Simulation method and system based on vehicle dynamic model |
CN110244747A (en) * | 2019-08-02 | 2019-09-17 | 大连海事大学 | Heterogeneous fleet fault-tolerant control method based on actuator fault and saturation |
CN111007722A (en) * | 2019-12-18 | 2020-04-14 | 厦门大学 | Transverse robust fault-tolerant control system and method for four-wheel steering automatic driving automobile |
CN111267834A (en) * | 2020-02-17 | 2020-06-12 | 北京理工大学 | Vehicle yaw stability prediction control method and system |
CN111780981A (en) * | 2020-05-21 | 2020-10-16 | 东南大学 | Intelligent vehicle formation lane change performance evaluation method |
CN111750866A (en) * | 2020-07-07 | 2020-10-09 | 吉林大学 | Intelligent automobile transverse and longitudinal coupling path planning method based on regional virtual force field |
CN111694366A (en) * | 2020-07-08 | 2020-09-22 | 东北大学秦皇岛分校 | Motorcade cooperative braking control method based on sliding mode control theory |
CN112068598A (en) * | 2020-09-28 | 2020-12-11 | 西北工业大学 | Unmanned aerial vehicle formation flying method and control system |
Non-Patent Citations (5)
Title |
---|
JINGHUA GUO等: "Adaptive fuzzy sliding mode control for coordinated longitudinal and lateral motions of multiple autonomous vehicles in a platoon", 《SCIENCE CHINA TECHNOLOGICAL SCIENCES》 * |
SACHINDRA DAHAL等: "Infrastructure Enhancements for CAV Navigation", 《CENTER FOR CONNECTED AND AUTOMATED TRANSPORTATION》 * |
ZHANYI HU等: "Safety guaranteed longitudinal motion control for connected and autonomous vehicles in a lane-changing scenario", 《IET INTELLIGENT TRANSPORT SYSTEMS》 * |
杨泽宇等: "严格避撞的车辆队列分布式鲁棒控制", 《汽车工程》 * |
覃频频等: "考虑道路几何设计的智能网联车队横纵向协同控制", 《科学技术与工程》 * |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114137831A (en) * | 2021-10-13 | 2022-03-04 | 清华大学 | Longitudinal control method and device in intelligent networked automobile queue system |
CN114137831B (en) * | 2021-10-13 | 2022-06-14 | 清华大学 | Longitudinal control method and device in intelligent network automobile queue system |
CN113848942A (en) * | 2021-10-18 | 2021-12-28 | 青岛德智汽车科技有限公司 | Constraint-oriented intelligent network-connected automobile robust lane-changing confluence control method |
CN113848942B (en) * | 2021-10-18 | 2023-06-02 | 青岛德智汽车科技有限公司 | Constraint-oriented intelligent network-connected automobile robust lane-changing and flow-converging control method |
CN114475596A (en) * | 2022-02-22 | 2022-05-13 | 青岛德智汽车科技有限公司 | Intelligent networking queue robust control method for ensuring safety in lane changing scene |
CN114475596B (en) * | 2022-02-22 | 2023-06-20 | 青岛德智汽车科技有限公司 | Intelligent network link queue robust control method for ensuring safety under channel changing scene |
Also Published As
Publication number | Publication date |
---|---|
CN113009829B (en) | 2022-04-26 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113009829B (en) | Longitudinal and transverse coupling control method for intelligent internet motorcade | |
CN107380161B (en) | A kind of active steering control device for aiding in driver to realize desired ride track | |
CN109144076B (en) | Multi-vehicle transverse and longitudinal coupling cooperative control system and control method | |
CN103057436B (en) | Yawing moment control method of individual driven electromobile based on multi-agent | |
Xu et al. | Model predictive control for lane keeping system in autonomous vehicle | |
CN108791301A (en) | Intelligent automobile driving procedure transverse direction dynamic control method based on driver characteristics | |
CN111176302A (en) | Input saturation automatic driving automobile path tracking control method | |
CN110962849A (en) | Curve self-adaptive cruise method | |
CN112578672B (en) | Unmanned vehicle trajectory control system based on chassis nonlinearity and trajectory control method thereof | |
CN112141101A (en) | Method and system for pre-aiming safety path based on CNN and LSTM | |
WO2022266824A1 (en) | Steering control method and apparatus | |
CN113050651B (en) | Time lag control method and system for tracking autonomous driving path of intelligent vehicle | |
CN111959500A (en) | Automobile path tracking performance improving method based on tire force distribution | |
CN113581201B (en) | Potential field model-based collision avoidance control method and system for unmanned vehicle | |
Németh et al. | Nonlinear analysis and control of a variable-geometry suspension system | |
CN113183950A (en) | Self-adaptive control method for steering of active front wheel of electric automobile | |
CN110217227A (en) | A kind of braking in a turn joint collision avoidance control method suitable for ice-snow road operating condition | |
CN107585207A (en) | A kind of vehicle line traffic control four-wheel steering system and its control method | |
CN114637292A (en) | Vehicle track tracking robust control method and system considering obstacle avoidance | |
CN113848942B (en) | Constraint-oriented intelligent network-connected automobile robust lane-changing and flow-converging control method | |
CN109849898B (en) | Vehicle yaw stability control method based on genetic algorithm hybrid optimization GPC | |
CN110162045B (en) | Truck formation driving following control method based on self-adaptive three-step method | |
CN113602278B (en) | Four-wheel independent drive electric vehicle distributed model prediction path tracking control method | |
CN114834263A (en) | Coordination control method and device for steering and torque vector of active front wheel of electric automobile | |
CN114523962A (en) | Vehicle control method, device, equipment and medium |
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 |