A storage location track segmentation control method and related equipment

By obtaining the trajectory information of vehicles in the driving school site and combining LQR, feedforward and Ackerman models for segmented control, the problem of trajectory curvature changes in the driving school site is solved, and the trajectory tracking accuracy and teaching effect are improved.

CN118393966BActive Publication Date: 2024-11-08WUHAN FUTURE MIRAGE TECH CO LTD
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202410814589.2
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2024-06-24
Publication Date
2024-11-08
Estimated Expiration
2044-06-24

AI Technical Summary

Technical Problem

In driving school venues, it is difficult for the prior art to achieve teaching purposes while ensuring the accuracy of trajectory tracking. Especially when there is a sudden change in trajectory curvature in subject 2 training, it is difficult to effectively control the trajectory of the vehicle.

Method used

By obtaining the current warehouse position trajectory information of the controlled vehicle in the driving school site, according to the trajectory curvature and gear type, the LQR control algorithm, the feedforward control algorithm and the Ackerman steering model are used for segmented control, and the corresponding front wheel rotation angle is calculated. Control the volume to achieve accurate control of the vehicle.

Benefits of technology

In medium and low speed scenarios, ensure accurate heading, reduce lateral errors to zero, improve trajectory tracking accuracy, and realize the angle specified in the steering wheel rotation lesson plan near the teaching point to achieve teaching purposes.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118393966B_ABST
    Figure CN118393966B_ABST
Patent Text Reader

Abstract

The present invention provides a storage location track segmentation control method and related equipment, the control method comprises: obtaining the current storage location track information of the controlled vehicle in the driving school venue, if the current track curvature approaches 0, then calculating the first front wheel angle control amount according to the LQR control algorithm, if the current track curvature does not approach 0, then judging whether the current gear is the forward gear or the reverse gear, if the current gear is the forward gear, then calculating the second front wheel angle control amount according to the feedforward control algorithm, if the current gear is the reverse gear, then calculating the third front wheel angle control amount according to the Ackerman steering model, and performing segmentation control on the controlled vehicle according to the first front wheel angle control amount, the second front wheel angle control amount and the third front wheel angle control amount corresponding to the current storage location track information. The present invention can adopt different control strategies according to the characteristics of the storage location track, thereby achieving the technical effect of achieving the teaching purpose under the premise of ensuring the control accuracy.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention belongs to the technical field of driving school training, and in particular relates to a storage location track segmentation control method and related equipment. Background Art

[0002] Driving schools are places where students are trained to master certain driving skills, thereby ensuring road safety. Driving schools are mainly used to train students in the second driving test, which includes reverse parking, parallel parking, curve driving, right-angle turns, and other subject types. The teaching trajectory lesson plan corresponding to each subject type has a sudden change in trajectory curvature, so it is difficult to achieve the purpose of teaching while ensuring tracking accuracy.

[0003] Therefore, for the teaching trajectory within the subject, how to provide a segmented control method for the storage location trajectory, adopt different control strategies according to the characteristics of the storage location trajectory, and then achieve the technical effect of achieving the teaching purpose while ensuring control accuracy is a problem that technical personnel in this field urgently need to solve. Summary of the invention

[0004] The embodiment of the present invention provides a storage location track segmentation control method and related equipment to solve at least one of the above technical problems.

[0005] In a first aspect, the present invention provides a storage location track segmentation control method, the control method comprising:

[0006] Obtaining current storage location trajectory information of the controlled vehicle in the driving school, wherein the current storage location trajectory information includes a current gear type and a current trajectory curvature;

[0007] If the curvature of the current trajectory approaches 0, a first front wheel steering angle control amount is calculated according to an LQR control algorithm, and the controlled vehicle is controlled according to the first front wheel steering angle control amount;

[0008] If the current trajectory curvature is not close to 0, it is determined whether the current gear is a forward gear or a reverse gear; if the current gear is a forward gear, a second front wheel steering angle control amount is calculated according to a feedforward control algorithm, and the controlled vehicle is controlled according to the second front wheel steering angle control amount; if the current gear is a reverse gear, a third front wheel steering angle control amount is calculated according to an Ackerman steering model, and the controlled vehicle is controlled according to the third front wheel steering angle control amount;

[0009] The controlled vehicle is controlled in sections according to the first front wheel turning angle control amount, the second front wheel turning angle control amount and the third front wheel turning angle control amount corresponding to the current storage location trajectory information.

[0010] Preferably, before calculating the first front wheel steering angle control amount according to the LQR control algorithm, the control method further includes:

[0011] The state equation of the controlled vehicle in the Frenet coordinate system is obtained, and the state equation is:

[0012] ;

[0013] in, is the state vector, is the control input vector, , , is a constant matrix, is the state vector The differential form of is the yaw angular velocity of the controlled vehicle.

[0014] Preferably, the calculating the first front wheel steering angle control amount according to the LQR control algorithm includes:

[0015] make ,

[0016] , , , , the first constraint equation of the state equation when the curvature of the current trajectory approaches 0 is obtained:

[0017] ;

[0018] in, is the lateral error between the current position of the controlled vehicle and the reference point of the current storage location trajectory, is the lateral error change rate of the controlled vehicle, is the heading angle error between the current heading angle of the controlled vehicle and the current location track reference point, is the rate of change of the heading angle error of the controlled vehicle, is the first front wheel steering angle control value of the controlled vehicle, is the front wheel cornering stiffness of the controlled vehicle, is the rear wheel cornering stiffness of the controlled vehicle, is the distance from the front axle to the center of mass of the controlled vehicle, is the distance from the rear axle to the center of mass of the controlled vehicle, is the moment of inertia of the controlled vehicle, m is the mass of the controlled vehicle, is the mass center velocity of the controlled vehicle, is the sampling time;

[0019] The first constraint equation is calculated according to the LQR control algorithm to obtain the first front wheel steering angle control value. , ,in is the calculated feedback matrix.

[0020] Preferably, the calculating the second front wheel steering angle control amount according to the feedforward control algorithm comprises:

[0021] make , the second constraint equation of the state equation when the curvature of the current trajectory does not approach 0 is obtained:

[0022] ;

[0023] The second constraint equation is calculated based on the feedforward control algorithm. Steering wheel compensation angle ;

[0024] According to the steering wheel compensation angle Calculate the second front wheel steering angle control value .

[0025] Preferably, the second constraint equation is calculated according to the feedforward control algorithm taking into account Steering wheel compensation angle ,include:

[0026] Transform the second constraint equation into a simplified equation: ;

[0027] Will Substituting into the abbreviated equation yields the closed-loop equation:

[0028] ;

[0029] The closed-loop equation is transformed into an algebraic equation:

[0030] ;

[0031] Using the final value theorem to solve the algebraic equation, we get:

[0032] ;

[0033] when The calculation is considered when the error is the smallest Steering wheel compensation angle :

[0034] ;

[0035] in, is the wheelbase of the controlled vehicle, is the curvature of the current trajectory, The feedback matrix The first element of The feedback matrix The third element of , , , , is the intermediate parameter.

[0036] Preferably, the calculating the third front wheel steering angle control amount according to the Ackerman steering model includes:

[0037] Calculate the current trajectory radius of the controlled vehicle according to the current trajectory curvature ;

[0038] The third front wheel steering angle control value of the controlled vehicle is obtained according to the Ackerman steering model. , the current trajectory radius and the wheelbase of the vehicle under investigation The relationship between: ;

[0039] According to the relationship The third front wheel steering angle control amount is calculated , the third front wheel steering angle control amount .

[0040] In a second aspect, the present application provides a storage location track segmentation control device, the storage location track segmentation control device comprising:

[0041] A first acquisition unit is used to acquire current storage location track information of the controlled vehicle in the driving school, wherein the current storage location track information includes a current gear type and a current track curvature;

[0042] A first calculation unit, configured to calculate a first front wheel steering angle control amount according to an LQR control algorithm when the curvature of the current track approaches 0;

[0043] a judgment unit, used for judging whether the current gear is a forward gear or a reverse gear when the curvature of the current trajectory is not close to 0;

[0044] a second calculation unit, configured to calculate a second front wheel steering angle control amount according to a feedforward control algorithm when the current gear is a forward gear;

[0045] a third calculation unit, configured to calculate a third front wheel steering angle control amount according to an Ackerman steering model when the current gear is a reverse gear;

[0046] A control unit is used to perform segmented control on the controlled vehicle according to the first front wheel turning angle control amount, the second front wheel turning angle control amount and the third front wheel turning angle control amount corresponding to the current storage location trajectory information.

[0047] Preferably, the storage location track segmentation control device further includes:

[0048] The second acquisition unit is used to acquire the state equation of the controlled vehicle in the Frenet coordinate system, and the state equation is: ;

[0049] in, is the state vector, is the control input vector, , , is a constant matrix, is the state vector The differential form of is the yaw angular velocity of the controlled vehicle.

[0050] In a third aspect, the present application also provides an electronic device comprising: a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein the processor is configured to implement a storage location trajectory segmentation control method as described in any one of the first aspects when executing the computer program stored in the memory.

[0051] In a fourth aspect, the present application further provides a computer-readable storage medium having a computer program stored thereon: when the computer program is executed by a processor, the storage location trajectory segmentation control method as described in any one of the first aspects is implemented.

[0052] Beneficial effect: The present invention proposes a storage location trajectory segmented control method, by obtaining the current storage location trajectory information of the controlled vehicle in the driving school venue, the current storage location trajectory information includes the current gear type and the current trajectory curvature, if the current trajectory curvature is close to 0, then the first front wheel turning angle control amount is calculated according to the LQR control algorithm, if the current trajectory curvature is not close to 0, it is determined whether the current gear is a forward gear or a reverse gear, if the current gear is a forward gear, then the second front wheel turning angle control amount is calculated according to the feedforward control algorithm, if the current gear is a reverse gear, then the third front wheel turning angle control amount is calculated according to the Ackerman steering model, and the controlled vehicle is segmentedly controlled according to the first front wheel turning angle control amount, the second front wheel turning angle control amount and the third front wheel turning angle control amount corresponding to the current storage location trajectory information. The present invention first segments the storage location trajectory according to the trajectory curvature and the gear position, and on this basis, combines LQR feedback with trajectory curvature feedforward, so that in medium and low speed scenarios, the lateral error can be reduced to zero while ensuring the accuracy of the heading, thereby improving the accuracy of trajectory tracking, and on this basis, introduces the Ackerman steering model to achieve the angle specified by the teaching plan near the teaching point to achieve the teaching purpose. The storage location trajectory segmentation control method proposed by the present invention can adopt different control strategies according to the characteristics of the storage location trajectory, thereby achieving the technical effect of achieving the teaching purpose while ensuring the control accuracy. BRIEF DESCRIPTION OF THE DRAWINGS

[0053] In order to more clearly illustrate the embodiments of this specification or the technical solutions in the prior art, the drawings required for use in the embodiments will be briefly introduced below. Obviously, the drawings described below are only some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying creative work.

[0054] Figure 1 A schematic diagram of the flow of the storage location trajectory segmentation control method provided in this application;

[0055] Figure 2 Schematic diagram of the error between the actual position of the vehicle and the storage location trajectory provided for this application;

[0056] Figure 3 Schematic diagram of the Ackerman steering model provided for this application;

[0057] Figure 4 A schematic diagram of the structure of the storage location track segmentation control device provided in this application;

[0058] Figure 5 A schematic diagram of the structure of an electronic device provided by this application;

[0059] Figure 6 A schematic diagram of the structure of a computer-readable storage medium provided in this application. DETAILED DESCRIPTION

[0060] The present application provides a storage location trajectory segmentation control method and related equipment, which segments the storage location trajectory by trajectory curvature and gear position, and on this basis, combines LQR feedback with trajectory curvature feedforward, so that in medium and low speed scenarios, the lateral error can be reduced to zero while ensuring the accuracy of the heading, thereby improving the accuracy of trajectory tracking. On this basis, the Ackerman steering model is introduced to achieve the rotation of the steering wheel to the angle specified in the teaching plan near the teaching point to achieve the teaching purpose.

[0061] The following will be combined with the drawings in the embodiments of the present application to clearly and completely describe the technical solutions in the embodiments of the present application. Obviously, the described embodiments are only part of the embodiments of the present application, not all of the embodiments. Based on the embodiments in the present application, all other embodiments obtained by those skilled in the art without creative work are within the scope of protection of this application.

[0062] The terms "first", "second", etc. in the specification and claims of this application and the above-mentioned drawings are used to distinguish similar objects, and are not necessarily used to describe a specific order or sequence. It should be understood that the data used in this way can be interchangeable where appropriate, so that the embodiments described here can be implemented in an order other than that illustrated or described here. In addition, the terms "including" and "having" and any of their variations are intended to cover non-exclusive inclusions, for example, a process, method, system, product or device that includes a series of steps or modules is not necessarily limited to those steps or modules clearly listed, but may include other steps or modules that are not clearly listed or inherent to these processes, methods, products or devices. The naming or numbering of steps in this application does not mean that the steps in the method flow must be executed in the time / logical sequence indicated by the naming or numbering. The process steps that have been named or numbered can change the execution order according to the technical purpose to be achieved, as long as the same or similar technical effects can be achieved.

[0063] The division of modules in this application is a logical division. There may be other division methods when it is implemented in actual applications. For example, multiple modules can be combined or integrated into another system, or some features can be ignored or not executed. In addition, the mutual coupling or direct coupling or communication connection shown or discussed can be through some interfaces, and the indirect coupling or communication connection between modules can be electrical or other similar forms, which are not limited in this application. In addition, the modules or submodules described as separate components may or may not be physically separated, may or may not be physical modules, or may be distributed in multiple circuit modules, and some or all of the modules may be selected according to actual needs to achieve the purpose of the present application.

[0064] Before introducing the storage location trajectory segmentation control method provided by this application, the background content involved in this application is first introduced.

[0065] The storage location trajectory segmentation control method provided in the present application can be applied to a processing device, and is used to obtain the current storage location trajectory information of the controlled vehicle in the driving school, so as to select different control strategies according to the current trajectory curvature and the current gear position corresponding to the current storage location trajectory information, thereby achieving the technical effect of achieving the teaching purpose while ensuring the control accuracy.

[0066] The storage location track segmentation control method mentioned in this application can be executed by a storage location track segmentation control device, or a network node, server, physical host or user equipment (UE) and other different types of processing equipment integrated with the storage location track segmentation control device. Among them, the storage location track segmentation control device can be implemented in hardware or software, and the UE can be a terminal device such as a smart phone, tablet computer, laptop computer, desktop computer or personal digital assistant (PDA), and the processing device can be set in the form of a device cluster.

[0067] It is understandable that if the present application involves a gateway product, it can be an application service configured in the form of a software service, which needs to be installed on the corresponding device in the network architecture to serve as a gateway node in the actual sense, or it can be a gateway node directly existing in the form of a device in the network architecture, which can be flexibly adjusted according to flexible deployment requirements / application requirements.

[0068] In this way, the processing equipment that executes the storage location trajectory segmentation control provided by this application can specifically be different types of equipment such as network nodes, servers, physical hosts or UEs, which can be flexibly configured according to actual needs, and this application does not make specific limitations.

[0069] like Figure 1-3As shown, this embodiment 1 provides a storage location track segmentation control method, and the control method specifically includes the following steps S110 to S160:

[0070] Step S110, obtaining current storage location trajectory information of the controlled vehicle in the driving school, wherein the current storage location trajectory information includes the current gear type and the current trajectory curvature;

[0071] Among them, the current storage location trajectory information is the trajectory for teaching the second driving test subject in the driving school. The second driving test subject includes storage location types such as reverse parking, right-angle turning, curved driving, and side parking. The above storage location types correspond to a storage location trajectory, such as reverse parking storage location trajectory, right-angle turning storage location trajectory, curved driving storage location trajectory, side parking storage location trajectory, etc. The current storage location trajectory information of the controlled vehicle can be obtained. The current storage location trajectory information includes the storage location trajectory type, the current gear type, and the current trajectory curvature, so that the storage location trajectory used for standard teaching can be divided by the gear type and the trajectory curvature, and then the controlled vehicle is tracked and controlled according to the storage location trajectory type.

[0072] Step S120: if the curvature of the current track approaches 0, calculating a first front wheel steering angle control amount according to an LQR control algorithm, and controlling the controlled vehicle according to the first front wheel steering angle control amount;

[0073] It can be understood that the curvature of the current track is the inverse of the track radius. Therefore, when the curvature of the current track approaches 0, the corresponding track radius approaches infinity, which means that the current storage location track is a straight line segment track. Similarly, when the curvature of the current track does not approach 0, the current storage location track has a track radius, which means that the current storage location track is an arc segment track. When the curvature of the current track approaches 0, that is, when the current storage location track is a straight line segment track (there is no need to consider the influence of the gear position and the yaw angular velocity), the LQR control algorithm is used to calculate the first front wheel steering angle control amount, so as to control the vehicle through the first front wheel steering angle control amount to reduce the lateral error of the vehicle.

[0074] As an implementable manner, before calculating the first front wheel steering angle control amount according to the LQR control algorithm in the above step S120, the control method further includes:

[0075] The state equation of the controlled vehicle in the Frenet coordinate system is obtained, and the state equation is:

[0076] ;

[0077] in, is the state vector, is the control input vector, , , is a constant matrix, is the state vector The differential form of is the yaw angular velocity of the controlled vehicle.

[0078] Specifically, the state equation of the traditional linear two-degree-of-freedom model created based on the bicycle model is established based on the body coordinate system. The state equation established in the body coordinate system has coupling interference in longitudinal control and lateral control. Based on this, the present application converts the state equation established in the body coordinate system into the state equation of the controlled vehicle based on the Frenet coordinate system to achieve the purpose of decoupling longitudinal control and lateral control. The Frenet coordinate system is a mobile coordinate system based on the centerline of the road, which is mainly used for motion planning and control in the field of autonomous driving. The Frenet coordinate system is usually defined by three mutually perpendicular unit vectors: tangential, normal, and orthogonal. Among them, the tangential direction is along the centerline of the road, the normal direction points to the center of curvature of the road, and the vertical direction is perpendicular to the ground.

[0079] As an implementable manner, the calculation of the first front wheel steering angle control amount according to the LQR control algorithm in the above step S120 specifically includes the following sub-steps:

[0080] make ,

[0081] , , , , the first constraint equation of the state equation when the curvature of the current trajectory approaches 0 is obtained:

[0082] ;

[0083] in, is the lateral error between the current position of the controlled vehicle and the reference point of the current storage location trajectory, is the lateral error change rate of the controlled vehicle, is the heading angle error between the current heading angle of the controlled vehicle and the current location track reference point, is the rate of change of the heading angle error of the controlled vehicle, is the first front wheel steering angle control value of the controlled vehicle, is the front wheel cornering stiffness of the controlled vehicle, is the rear wheel cornering stiffness of the controlled vehicle, is the distance from the front axle to the center of mass of the controlled vehicle, is the distance from the rear axle to the center of mass of the controlled vehicle, is the moment of inertia of the controlled vehicle, m is the mass of the controlled vehicle, is the mass center velocity of the controlled vehicle, is the sampling time;

[0084] The first constraint equation is calculated according to the LQR control algorithm to obtain the first front wheel steering angle control value. , ,in is the calculated feedback matrix.

[0085] Specifically, when calculating the first constraint equation according to the LQR control algorithm, the existing technology can be used, and the corresponding feedback matrix can be calculated , thereby obtaining the first front wheel steering angle control value , where the feedback matrix is a 1x4 matrix, , is the feedback matrix calculated according to the LQR control algorithm The first element of is the feedback matrix calculated according to the LQR control algorithm The second element of is the feedback matrix calculated according to the LQR control algorithm The third element of is the feedback matrix calculated according to the LQR control algorithm The fourth element of . , P satisfies the Riccati equation, , P and These are all intermediate parameters and have no practical significance.

[0086] Step S130: If the curvature of the current trajectory is not close to 0, determine whether the current gear is a forward gear or a reverse gear;

[0087] Specifically, when the curvature of the current trajectory is not close to 0, it is determined whether the current gear is a forward gear or a reverse gear, so as to distinguish the control of the arc segment trajectory in the reverse gear and the control of the arc segment trajectory in the forward gear.

[0088] Step S140: If the current gear is a forward gear, a second front wheel steering angle control amount is calculated according to a feedforward control algorithm, and the controlled vehicle is controlled according to the second front wheel steering angle control amount;

[0089] As an implementable manner, the calculation of the second front wheel steering angle control amount according to the feedforward control algorithm in the above step S140 specifically includes the following sub-steps:

[0090] make , the second constraint equation of the state equation when the curvature of the current trajectory does not approach 0 is obtained:

[0091] ;

[0092] The second constraint equation is calculated based on the feedforward control algorithm. Steering wheel compensation angle ;

[0093] According to the steering wheel compensation angle Calculate the second front wheel steering angle control value .

[0094] It can be understood that when the current storage location track is a straight line, due to ,exist Under the action of the matrix, is stable, that is, the front wheel turning angle at this time is directly equal to When the current storage location track is not a straight line, due to existence, even though is asymptotically stable, the system state quantity It is also impossible to guarantee convergence to zero, so we consider adding feedforward control of trajectory curvature on the basis of feedback control to ensure that the error can converge to zero.

[0095] As an implementable manner, the above sub-step calculates the second constraint equation according to the feedforward control algorithm in consideration of Steering wheel compensation angle , specifically including the following:

[0096] Transform the second constraint equation into a simplified equation: ;

[0097] Will Substituting into the abbreviated equation yields the closed-loop equation:

[0098] ;

[0099] The closed-loop equation is transformed into an algebraic equation:

[0100] ;

[0101] Using the final value theorem to solve the algebraic equation, we get:

[0102] ;

[0103] when The calculation is considered when the error is the smallest Steering wheel compensation angle :

[0104] ;

[0105] in, is the wheelbase of the controlled vehicle, , is the curvature of the current trajectory, is the feedback matrix calculated according to the LQR control algorithm The first element of is the feedback matrix calculated according to the LQR control algorithm The third element of , , , , is the intermediate parameter.

[0106] Specifically, when When the error of is the smallest, there exists Make the lateral error zero, that is:

[0107]

[0108] Then according to the above formula, we can obtain Steering wheel compensation angle :

[0109] .

[0110] Step S150: If the current gear is a reverse gear, a third front wheel steering angle control amount is calculated according to an Ackerman steering model, and the controlled vehicle is controlled according to the third front wheel steering angle control amount;

[0111] As an implementable manner, the step S150 of calculating the third front wheel steering angle control amount according to the Ackerman steering model includes:

[0112] Calculate the current trajectory radius of the controlled vehicle according to the current trajectory curvature ;

[0113] The third front wheel steering angle control value of the controlled vehicle is obtained according to the Ackerman steering model. , the current trajectory radius and the wheelbase of the vehicle under investigation The relationship between: ;

[0114] According to the relationship The third front wheel steering angle control amount is calculated , the third front wheel steering angle control amount .

[0115] Specifically, the Ackerman steering model can be used when the trajectory radius is large. Approximately equal to ,at this time Approximately equal to .

[0116] During the training process for the second subject of the driving test, there are four storage location training items, including reverse parking, parallel parking, right-angle turning and curve driving. The curvature of the corresponding storage location trajectory often has a large curvature mutation, and in order to achieve the teaching purpose, the trainees are required to complete the steering wheel rotation as soon as possible after reaching the designated position, so that the front wheels of the controlled vehicle turn the corresponding angle. This makes the assumption that the reference trajectory in the LQR control algorithm is a straight line invalid. Therefore, this application introduces the concept of segmented trajectory control and combines the LQR control algorithm with trajectory curvature feedforward. For the straight segment trajectory of the forward gear or reverse gear, the LQR control algorithm can be used to calculate the front wheel angle, and then the steering wheel angle can be calculated accordingly; for the circular arc segment trajectory of the forward gear, by finding a suitable The feedback angle is compensated to make the lateral error approach zero and achieve a better tracking effect. For the arc segment trajectory of the reverse gear, the feedback angle of the LQR algorithm is ignored and the front wheel angle is calculated by the Ackerman steering model to achieve the teaching purpose.

[0117] As an implementable manner, the current storage location track information also includes the storage location track type:

[0118] When the storage location trajectory type is a right-angle turn storage location trajectory, the front wheel turning angle of the controlled vehicle is calculated according to the following formula: To perform segmented control:

[0119]

[0120] When the storage location trajectory type is a reverse parking location trajectory, the front wheel turning angle of the controlled vehicle is calculated according to the following formula: To perform segmented control:

[0121]

[0122] When the parking space trajectory type is a side parking space trajectory, the front wheel turning angle of the controlled vehicle is calculated according to the following formula: To perform segmented control:

[0123]

[0124] When the storage location trajectory type is a curved driving storage location trajectory, the front wheel turning angle of the controlled vehicle is calculated according to the following formula: Take control: ;

[0125] in, Indicates the current gear position, Indicates forward gear. Indicates reverse gear.

[0126] Specifically, when the storage location trajectory type is a right-angle turn storage location trajectory, the right-angle turn storage location trajectory is in the forward gear throughout, and there are only two teaching points, namely, the steering wheel is fully turned left / right and returned to the center, then the front wheel steering angle of the controlled vehicle under the right-angle turn storage location trajectory can be calculated according to the following formula: To perform segmented control:

[0127]

[0128] When the storage location trajectory type is a reverse entry storage location trajectory, for the entry process, depending on the different driving school teaching plans, the planned trajectory may be composed of multiple different radii to form a curve with a total angle of 90, but the exit trajectory is an arc of 90 degrees with the vehicle's minimum turning radius. In order to achieve the teaching purpose, that is, at special points, the steering wheel needs to be quickly rotated to a certain angle before driving, this application considers ignoring the LQR feedback angle when in reverse gear and there is a trajectory radius, and using the Ackerman steering model to calculate the front wheel angle using the wheelbase and turning radius. Specifically, the front wheel turning angle of the controlled vehicle under the reverse entry storage location trajectory can be calculated according to the following formula To perform segmented control:

[0129]

[0130] When the parking space trajectory type is a side parking space trajectory, the segmented control is similar to the segmented control of the reverse parking space trajectory. The front wheel turning angle of the controlled vehicle under the side parking space trajectory is calculated according to the following formula: To perform segmented control:

[0131]

[0132] When the storage location trajectory type is a curved driving storage location trajectory, since the curved driving storage location trajectory is an arc segment trajectory under the forward gear, there is no need to consider the control method of the straight segment trajectory. The front wheel turning angle of the controlled vehicle under the curved driving storage location trajectory is calculated according to the following formula: Take control:

[0133]

[0134] An embodiment of the present invention proposes a storage location trajectory segmented control method, by obtaining the current storage location trajectory information of a controlled vehicle in a driving school, the current storage location trajectory information includes the current gear type and the current trajectory curvature, if the current trajectory curvature approaches 0, then the first front wheel turning angle control amount is calculated according to the LQR control algorithm, if the current trajectory curvature does not approach 0, it is determined whether the current gear is a forward gear or a reverse gear, if the current gear is a forward gear, then the second front wheel turning angle control amount is calculated according to the feedforward control algorithm, if the current gear is a reverse gear, then the third front wheel turning angle control amount is calculated according to the Ackerman steering model, and the controlled vehicle is segmentedly controlled according to the first front wheel turning angle control amount, the second front wheel turning angle control amount and the third front wheel turning angle control amount corresponding to the current storage location trajectory information. The embodiment of the present invention first segments the storage location trajectory according to the trajectory curvature and the gear position, and on this basis, combines LQR feedback with trajectory curvature feedforward, so that in medium and low speed scenarios, the lateral error can be reduced to zero while ensuring the accuracy of the heading, thereby improving the accuracy of trajectory tracking, and on this basis, introduces the Ackerman steering model to achieve the angle specified by the teaching plan near the teaching point to achieve the teaching purpose. The storage location trajectory segmentation control method proposed in the present invention can adopt different control strategies according to the characteristics of the storage location trajectory, thereby achieving the technical effect of achieving the teaching purpose while ensuring the control accuracy.

[0135] Embodiment 2

[0136] The following describes an embodiment of a storage location track segmentation control device in an embodiment of the present invention.

[0137] See also Figure 4 , Figure 4 A schematic diagram of an embodiment of a storage location track segmentation control device in an embodiment of the present invention, the storage location track segmentation control device 400 includes:

[0138] The first acquisition unit 401 is used to acquire the current storage location track information of the controlled vehicle in the driving school, wherein the current storage location track information includes the current gear type and the current track curvature;

[0139] A first calculation unit 402, configured to calculate a first front wheel steering angle control amount according to an LQR control algorithm when the curvature of the current track approaches 0;

[0140] A judging unit 403, configured to judge whether the current gear is a forward gear or a reverse gear when the curvature of the current trajectory is not close to 0;

[0141] A second calculation unit 404, used for calculating a second front wheel steering angle control amount according to a feedforward control algorithm when the current gear is a forward gear;

[0142] A third calculation unit 405 is used to calculate a third front wheel steering angle control amount according to an Ackerman steering model when the current gear is a reverse gear;

[0143] The control unit 406 is used to perform segmented control on the controlled vehicle according to the first front wheel steering angle control amount, the second front wheel steering angle control amount and the third front wheel steering angle control amount corresponding to the current storage location trajectory information.

[0144] As an exemplary implementation, before calculating the first front wheel steering angle control amount according to the LQR control algorithm, the storage location track segmentation control device 400 in the embodiment of the present application further includes:

[0145] The second acquisition unit is used to acquire the state equation of the controlled vehicle in the Frenet coordinate system, and the state equation is: ;

[0146] in, is the state vector, is the control input vector, , , is a constant matrix, is the state vector The differential form of is the yaw angular velocity of the controlled vehicle.

[0147] As an exemplary implementation, the first computing unit 402 in the embodiment of the present application is further configured to perform the following steps:

[0148] make ,

[0149] , , , , the first constraint equation of the state equation when the curvature of the current trajectory approaches 0 is obtained:

[0150] ;

[0151] in, is the lateral error between the current position of the controlled vehicle and the reference point of the current storage location trajectory, is the lateral error change rate of the controlled vehicle, is the heading angle error between the current heading angle of the controlled vehicle and the current location track reference point, is the rate of change of the heading angle error of the controlled vehicle, is the first front wheel steering angle control value of the controlled vehicle, is the front wheel cornering stiffness of the controlled vehicle, is the rear wheel cornering stiffness of the controlled vehicle, is the distance from the front axle to the center of mass of the controlled vehicle, is the distance from the rear axle to the center of mass of the controlled vehicle, is the moment of inertia of the controlled vehicle, m is the mass of the controlled vehicle, is the mass center velocity of the controlled vehicle, is the sampling time;

[0152] The first constraint equation is calculated according to the LQR control algorithm to obtain the first front wheel steering angle control value. , ,in is the calculated feedback matrix, the feedback matrix is a 1x4 matrix, , is the feedback matrix calculated according to the LQR control algorithm The first element of is the feedback matrix calculated according to the LQR control algorithm The second element of is the feedback matrix calculated according to the LQR control algorithm The third element of is the feedback matrix calculated according to the LQR control algorithm The fourth element of .

[0153] As an exemplary implementation, the second calculation unit 404 in the embodiment of the present application is further configured to perform the following steps:

[0154] make , the second constraint equation of the state equation when the curvature of the current trajectory does not approach 0 is obtained:

[0155] ;

[0156] The second constraint equation is calculated based on the feedforward control algorithm. Steering wheel compensation angle ;

[0157] According to the steering wheel compensation angle Calculate the second front wheel steering angle control value .

[0158] As an exemplary implementation, the second calculation unit 404 in the embodiment of the present application is further configured to perform the following steps:

[0159] Transform the second constraint equation into a simplified equation: ;

[0160] Will Substituting into the abbreviated equation yields the closed-loop equation:

[0161] ;

[0162] The closed-loop equation is transformed into an algebraic equation:

[0163] ;

[0164] Using the final value theorem to solve the algebraic equation, we get:

[0165] ;

[0166] when The calculation is considered when the error is the smallest Steering wheel compensation angle :

[0167] ;

[0168] in, is the wheelbase of the controlled vehicle, , is the curvature of the current trajectory, is the feedback matrix calculated according to the LQR control algorithm The first element of is the feedback matrix calculated according to the LQR control algorithm The third element of , , , , is the intermediate parameter.

[0169] As an exemplary implementation, the third computing unit 405 in the embodiment of the present application is further configured to perform the following steps:

[0170] Calculate the current trajectory radius of the controlled vehicle according to the current trajectory curvature ;

[0171] The third front wheel steering angle control value of the controlled vehicle is obtained according to the Ackerman steering model. , the current trajectory radius and the wheelbase of the vehicle under investigation The relationship between: ;

[0172] According to the relationship The third front wheel steering angle control amount is calculated , the third front wheel steering angle control amount .

[0173] As an exemplary implementation, the current storage location track information also includes a storage location track type. The control unit 406 in the embodiment of the present application is further configured to perform the following steps:

[0174] If the storage location trajectory type is a right-angle turn storage location trajectory, the front wheel turning angle of the controlled vehicle is calculated according to the following formula: To perform segmented control:

[0175]

[0176] Or, if the storage location trajectory type is a reverse parking location trajectory, the front wheel turning angle of the controlled vehicle is calculated according to the following formula: To perform segmented control:

[0177]

[0178] Or, if the parking space trajectory type is a side parking space trajectory, the front wheel turning angle of the controlled vehicle is calculated according to the following formula: To perform segmented control:

[0179]

[0180] Or, if the storage location trajectory type is a curved driving storage location trajectory, the front wheel turning angle of the controlled vehicle is calculated according to the following formula: Take control: ;

[0181] in, Indicates the current gear position, Indicates forward gear. Indicates reverse gear.

[0182] The embodiment of the present invention first obtains the current storage location trajectory information of the controlled vehicle in the driving school venue through the first acquisition unit 401, and the current storage location trajectory information includes the current gear type and the current trajectory curvature. If the current trajectory curvature is close to 0, the first calculation unit 402 calculates the first front wheel angle control amount according to the LQR control algorithm. If the current trajectory curvature is not close to 0, the judgment unit 403 determines whether the current gear is a forward gear or a reverse gear. If the current gear is a forward gear, the second calculation unit 404 calculates the second front wheel angle control amount according to the feedforward control algorithm. If the current gear is a reverse gear, the third calculation unit 405 calculates the third front wheel angle control amount according to the Ackerman steering model. Finally, the control unit 406 performs segmented control on the controlled vehicle according to the first front wheel angle control amount, the second front wheel angle control amount and the third front wheel angle control amount corresponding to the current storage location trajectory information. The embodiment of the present invention first segments the storage location trajectory according to the trajectory curvature and the gear position, and on this basis, combines LQR feedback with trajectory curvature feedforward, so that in medium and low speed scenarios, the lateral error can be reduced to zero while ensuring the accuracy of the heading, thereby improving the accuracy of trajectory tracking, and on this basis, introduces the Ackerman steering model to achieve the angle specified by the teaching plan near the teaching point to achieve the teaching purpose. The storage location trajectory segmentation control method proposed in the present invention can adopt different control strategies according to the characteristics of the storage location trajectory, thereby achieving the technical effect of achieving the teaching purpose while ensuring the control accuracy.

[0183] Embodiment 3

[0184] See also Figure 5 , Figure 5 The electronic device of the present invention is a schematic diagram of an embodiment of the electronic device, including:

[0185] A memory 501, a processor 502, and a computer program 503 stored in the memory and executable on the processor, wherein the processor implements the above-mentioned storage location track segmentation control method when executing the computer program 503 stored in the memory.

[0186] For ease of explanation, only the parts related to the embodiment of the present invention are shown. For specific technical details not disclosed, please refer to the part of the pipeline material detection method of the embodiment of the present invention. The memory 501 can be used to store a computer program 503, which includes software programs, modules and data. The processor 502 executes the computer program 503 stored in the memory 501 to perform various functional applications and data processing of the electronic device.

[0187] Embodiment 4

[0188] The present invention also provides a computer-readable storage medium. Figure 6 , Figure 6 It is a schematic diagram of an embodiment of a computer-readable storage medium in an embodiment of the present invention, wherein the computer-readable storage medium may store a computer program, and when the program is executed, it includes part or all of the steps of the storage location trajectory segmentation control method recorded in the above method embodiment.

[0189] Those skilled in the art can clearly understand that, for the convenience and brevity of description, the specific working processes of the above-described devices, electronic devices, and computer-readable storage media can refer to the corresponding processes of the pipeline material detection method in the aforementioned method embodiment, and will not be repeated here.

[0190] In the several embodiments provided in the present application, it should be understood that the disclosed systems and methods can be implemented in other ways. For example, the system embodiments described above are only schematic, for example, the division of units is only a logical function division, and there may be other division methods in actual implementation, such as multiple units or components can be combined or integrated into another system, or some features can be ignored or not executed. Another point is that the mutual coupling or direct coupling or communication connection shown or discussed can be through some interfaces, indirect coupling or communication connection of systems or units, which can be electrical, mechanical or other forms.

[0191] The units described as separate components may or may not be physically separated, and the components shown as units may or may not be physical units, that is, they may be located in one place or distributed on multiple network units. Some or all of the units may be selected according to actual needs to achieve the purpose of the solution of this embodiment.

[0192] In addition, each functional unit in each embodiment of the present invention may be integrated into one processing unit, or each unit may exist physically separately, or two or more units may be integrated into one unit. The above-mentioned integrated unit may be implemented in the form of hardware or in the form of software functional units.

[0193] If the integrated unit is implemented in the form of a software functional unit and sold or used as an independent product, it can be stored in a computer-readable storage medium. Based on this understanding, the technical solution of the present invention, in essence, or the part that contributes to the prior art, or all or part of the technical solution can be embodied in the form of a software product. The computer software product is stored in a storage medium, including several instructions for a computer device (which can be a personal computer, server, or network device, etc.) to execute all or part of the steps of the storage location track segmentation control method of each embodiment of the present invention. The aforementioned storage medium includes: U disk, mobile hard disk, read-only memory (ROM, Read-Only Memory), random access memory (RAM, Random Access Memory), disk or optical disk and other media that can store program codes.

[0194] As described above, the above embodiments are only used to illustrate the technical solutions of the present invention, rather than to limit the same. Although the present invention has been described in detail with reference to the aforementioned embodiments, those skilled in the art should understand that the technical solutions described in the aforementioned embodiments may still be modified, or some of the technical features thereof may be replaced by equivalents. However, these modifications or replacements do not deviate the essence of the corresponding technical solutions from the spirit and scope of the technical solutions of the embodiments of the present invention.

Claims

1. A storage location track segmentation control method, characterized in that: The control method comprises: Obtaining current storage location trajectory information of the controlled vehicle in the driving school, wherein the current storage location trajectory information includes a current gear type and a current trajectory curvature; If the curvature of the current trajectory approaches 0, a first front wheel steering angle control amount is calculated according to an LQR control algorithm, and the controlled vehicle is controlled according to the first front wheel steering angle control amount; If the current trajectory curvature is not close to 0, it is determined whether the current gear is a forward gear or a reverse gear; if the current gear is a forward gear, a second front wheel steering angle control amount is calculated according to a feedforward control algorithm, and the controlled vehicle is controlled according to the second front wheel steering angle control amount; if the current gear is a reverse gear, a third front wheel steering angle control amount is calculated according to an Ackerman steering model, and the controlled vehicle is controlled according to the third front wheel steering angle control amount; Before calculating the first front wheel steering angle control amount according to the LQR control algorithm, the control method further includes: The state equation of the controlled vehicle in the Frenet coordinate system is obtained, and the state equation is: Among them, x is the state vector, u is the control input vector, A, B1, B2 are constant matrices, is the differential form of the state vector x, is the yaw angular velocity of the controlled vehicle; The calculating the first front wheel steering angle control amount according to the LQR control algorithm includes: make u=δ1, The first constraint equation of the state equation when the curvature of the current trajectory approaches 0 is obtained: Wherein, e1 is the lateral error between the current position of the controlled vehicle and the reference point of the current storage location trajectory, is the lateral error change rate of the controlled vehicle, e2 is the heading angle error between the current heading angle of the controlled vehicle and the current location track reference point, is the heading angle error change rate of the controlled vehicle, δ1 is the first front wheel steering angle control value of the controlled vehicle, C f is the front wheel cornering stiffness of the controlled vehicle, C r is the rear wheel cornering stiffness of the controlled vehicle, is the distance from the front axle to the center of mass of the controlled vehicle, is the distance from the rear axle to the center of mass of the controlled vehicle, is the moment of inertia of the controlled vehicle, m is the mass of the controlled vehicle, v is the velocity of the center of mass of the controlled vehicle, and dt is the sampling time; The first constraint equation is calculated according to the LQR control algorithm to obtain a first front wheel steering angle control value δ1, wherein δ1=-Kx, where K is a feedback matrix calculated according to the LQR control algorithm; The calculating the second front wheel steering angle control amount according to the feedforward control algorithm comprises: make The second constraint equation of the state equation when the curvature of the current trajectory does not approach 0 is obtained: The second constraint equation is calculated based on the feedforward control algorithm. Steering wheel compensation angle δ ff ; According to the steering wheel compensation angle δ ff The second front wheel steering angle control amount δ2 is calculated; The second constraint equation is calculated according to the feedforward control algorithm taking into account Steering wheel compensation angle δ ff ,include: Transform the second constraint equation into a simplified equation: δ2=-Kx+δ ff Substituting into the abbreviated equation yields the closed-loop equation: The closed-loop equation is transformed into an algebraic equation: Using the final value theorem to solve the algebraic equation, we get: When x ss The calculation is considered when the error is the smallest Steering wheel compensation angle δ ff : Wherein, L is the wheelbase of the controlled vehicle, k v is the curvature of the current trajectory, k1 is the first element of the feedback matrix K, k3 is the third element of the feedback matrix K, X(s), sI, L(δ ff ), x ss is the intermediate parameter.

2. The storage location track segmentation control method according to claim 1 is characterized in that: The calculating the third front wheel steering angle control amount according to the Ackerman steering model includes: Calculating the current trajectory radius R of the controlled vehicle according to the current trajectory curvature; According to the Ackerman steering model, the relationship between the third front wheel steering angle control amount δ3 of the controlled vehicle, the current trajectory radius R and the wheelbase L of the controlled vehicle is obtained: tanδ3=L / R; The third front wheel turning angle control amount δ3 is calculated according to the relationship tanδ3=L / R, and the third front wheel turning angle control amount δ3=arc tanL / R.

3. An electronic device, comprising: A memory, a processor, and a computer program stored in the memory and executable on the processor, wherein the processor is used to implement the storage location track segmentation control method as described in any one of claims 1 to 2 when executing the computer program stored in the memory.

4. A computer-readable storage medium having a computer program stored thereon, characterized in that: When the computer program is executed by a processor, the storage location track segmentation control method according to any one of claims 1 to 2 is implemented.