Method and device for controlling vehicle driving, program product and storage medium
By calculating the vehicle's driving error state quantity and control quantity state matrix and calculating the target front wheel angle of the traction component, the problem of low control accuracy of trailer tractors in autonomous driving is solved, and more accurate vehicle driving control is achieved.
Patent Information
- Application Number
- CN202411432703.1
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-10-14
- Publication Date
- 2024-11-29
AI Technical Summary
In the existing autonomous driving technology, the kinematic model control accuracy of trailer tractors is low, making it difficult to accurately control the vehicle.
By obtaining vehicle parameter information and driving status information of the target vehicle, the driving error status amount and control amount status matrix are calculated, and the target front wheel angle of the traction component is calculated to control the vehicle's driving.
It improves the accuracy of vehicle driving control and solves the problem of vehicle driving control accuracy in autonomous driving.
Smart Images

Figure CN119037477A_ABST
Abstract
Description
Technical Field
[0001] The embodiments of the present application relate to the field of vehicle control technology, and more specifically, to a method and device for controlling vehicle driving, a program product, and a storage medium. Background Art
[0002] With the rapid development of autonomous driving technology, especially in the field of unmanned trunk logistics transportation, the autonomous driving control of tractor-trailer vehicles faces unique challenges. Due to the significant differences in design and use between trucks and passenger cars, the weight of trucks varies greatly, and the control difficulty increases accordingly. The combination of tractors and trailers increases the complexity of the system, especially for articulated trailers, whose dynamic characteristics belong to under-actuated systems. The dynamic model of the vehicle is the basis for achieving precise control. However, in the current autonomous driving technology, the kinematic model used by trailer tractors has the problem of low control accuracy. Summary of the invention
[0003] The embodiments of the present application provide a method and device for controlling vehicle driving, a program product, and a storage medium to at least solve the problem in the related art that the vehicle driving cannot be accurately controlled.
[0004] According to an embodiment of the present application, a method for controlling vehicle driving is provided, comprising: obtaining vehicle parameter information and first driving state information of a target vehicle at a current moment, and expected driving information in a future time period, wherein the target vehicle is composed of a traction component and a towed component connected by a connecting component, the first driving state information is used to describe a first driving state of the traction component at the current moment, and a second driving state of the towed component at the current moment, and the expected driving information is used to describe driving information of an expected driving trajectory of the target vehicle in the future time period; using the first driving state information and the expected driving information, calculating the target vehicle at the current moment and the future time period. the driving error state quantity between the above-mentioned future moments, wherein the above-mentioned future moments are moments in the above-mentioned future period; based on the above-mentioned vehicle parameter information and the above-mentioned first driving state information, the error state quantity state matrix and the control quantity state matrix of the above-mentioned target vehicle are calculated, wherein the above-mentioned error state quantity state matrix is a matrix describing the above-mentioned driving error state quantity, and the above-mentioned control quantity state matrix is a matrix describing the control quantity for controlling the driving of the above-mentioned target vehicle; using the above-mentioned driving error state quantity, the above-mentioned error state quantity state matrix and the above-mentioned control quantity state matrix, the target front wheel steering angle of the above-mentioned traction component is calculated; based on the above-mentioned target front wheel steering angle, the driving of the above-mentioned traction component at the above-mentioned future moment is controlled to control the driving of the above-mentioned target vehicle at the above-mentioned future moment.
[0005] In an exemplary embodiment, obtaining vehicle parameter information and first driving state information of a target vehicle at a current moment, as well as expected driving information in a future time period, includes: sending an acquisition instruction to a driving information component deployed in the target vehicle, and obtaining the vehicle parameter information, the first driving state information and the expected driving information sent by the driving information component in response to the acquisition instruction; wherein the vehicle parameter information includes: first mass information of the traction component and second mass information of the towed component, first moment of inertia of the traction component and second moment of inertia of the towed component, first distance between the traction component and the connecting component and second distance between the towed component and the connecting component, first lateral stiffness information of the traction component and second lateral stiffness information of the towed component; the first driving state information includes: the position of the target vehicle at the current moment, The heading angle of the traction component at the current moment, the heading angular velocity of the traction component at the current moment, the speed information of the traction component at the current moment, the acceleration of the traction component at the current moment, the articulation angle between the traction component and the towed component at the current moment, and the articulation angular velocity between the traction component and the towed component at the current moment; the expected driving information includes: the expected position set of the target vehicle in the future time period, the expected heading angle set of the traction component in the future time period, the expected heading angular velocity set of the traction component in the future time period, the speed information set of the traction component in the future time period, the expected acceleration set of the traction component in the future time period, the expected articulation angle set of the traction component and the towed component in the future time period, and the expected articulation angular velocity set of the traction component and the towed component in the future time period.
[0006] In an exemplary embodiment, the first driving state information and the expected driving information are used to calculate the driving error state of the target vehicle between the current moment and the future moment, including: calculating the distance between the expected position in the expected position set and the position of the target vehicle at the current moment, and obtaining the target expected position in the expected trajectory that is closest to the position at the current moment, wherein the target expected position is a position in the expected position set; based on the target expected position, determining the target expected heading angle, target expected heading angular velocity, target expected velocity, target expected acceleration, target expected articulation angle and target expected articulation angular velocity of the target vehicle at the future moment from the expected driving information; calculating the difference between the target expected articulation angular velocity and the articulation angular velocity at the current moment, and obtaining the articulation angle error change rate between the traction component and the towed component; calculating the difference between the target expected articulation angle and the articulation angle at the current moment, and obtaining the articulation angle error between the traction component and the towed component; calculating the difference between the target expected heading angular velocity and the heading angular velocity at the current moment, and obtaining the heading of the traction component.
[0007] Error change rate; calculate the difference between the target expected heading angle and the heading angle at the current moment to obtain the heading error of the traction component; calculate the difference between the first product and the second product to obtain the lateral error change rate of the traction component, wherein the first product is the product of the target expected speed and the sine value of the target expected heading angle, and the second product is the product of the speed at the current moment and the sine value of the heading angle at the current moment; calculate the difference between the third product and the fourth product to obtain the lateral error of the traction component, wherein the third product is the difference between the first target expected position in the target expected position and the first position in the position at the current moment, and the cosine value of the target expected heading angle, and the fourth product is the difference between the second target expected position in the target expected position and the second position in the position at the current moment, and the sine value of the target expected heading angle.
[0008] In an exemplary embodiment, the first driving state information and the expected driving information are used to calculate the driving error state quantity of the target vehicle between the current moment and the future moment, including: based on the lateral error of the traction component, the lateral error change rate of the traction component, the heading error of the traction component, the lateral error change rate of the traction component, the articulation angle error between the traction component and the towed component, and the articulation angle error change rate between the traction component and the towed component, calculating the driving error state quantity of the target vehicle between the current moment and the future moment.
[0009] In an exemplary embodiment, based on the vehicle parameter information and the first driving state information, calculating the error state quantity state matrix and the control quantity state matrix of the target vehicle includes: calculating the error state quantity state matrix and the control quantity state matrix based on the following formula: A=M e -1 P e , B=M e -1 W e , where A is used to represent the error state quantity state matrix, B is used to represent the control quantity state matrix,
[0010]
[0011]
[0012]
[0013]
[0014]
[0015] W e =[0-k10-(a1+c1)k100] T ,
[0016] The k1 is used to represent the cornering stiffness of the front wheel of the traction component in the first cornering stiffness information, the k2 is used to represent the cornering stiffness of the rear wheel of the traction component in the first cornering stiffness information, the k3 is used to represent the cornering stiffness of the rear wheel of the towed component in the second cornering stiffness information, the a1 is used to represent the distance between the center of mass of the traction component and the front axle in the first distance, the b1 is used to represent the distance between the center of mass of the traction component and the rear axle in the first distance, the c1 is used to represent the distance between the center of mass of the traction component and the hinge point in the first distance, the a2 is used to represent the distance between the center of mass of the towed component and the front axle in the second distance, the b2 is used to represent the distance between the center of mass of the towed component and the rear axle in the second distance, the m1 is used to represent the first mass information, the m2 is used to represent the second mass information, and the v x1 It is used to indicate the longitudinal speed of the traction component in the speed information at the current moment. z1 It is used to represent the first moment of inertia. z2 Used to represent the second moment of inertia mentioned above.
[0017] In an exemplary embodiment, the target front wheel turning angle of the traction assembly is calculated by using the driving error state quantity, the error state quantity state matrix and the control quantity state matrix, including: performing discrete operations on the error state quantity state matrix and the control quantity state matrix to obtain a target error state quantity matrix and a target control quantity state matrix; performing iterative operations on the target error state quantity matrix, the target control quantity state matrix and the driving error state quantity simultaneously based on the following formula until the cost function is minimized to obtain a state output feedback matrix: K = -(B d T PB d +R) - 1 B d T PA d , where K is used to represent the state output feedback matrix, and B is used to represent the state output feedback matrix. d It is used to represent the state matrix of the target control quantity. d is used to represent the target error state quantity matrix, the above P is used to represent the iteration matrix, and the initial value of the above P is used to represent the weight matrix of the above driving error state quantity; the product between the above state output feedback matrix and the above driving error state quantity is calculated to obtain the above target front wheel steering angle.
[0018] According to one embodiment of the present application, a device for controlling vehicle driving is provided, comprising: a first acquisition module, used to acquire vehicle parameter information and first driving state information of a target vehicle at a current moment, and expected driving information in a future time period, wherein the target vehicle is composed of a traction component and a towed component connected by a connecting component, the first driving state information is used to describe the first driving state of the traction component at the current moment, and the second driving state of the towed component at the current moment, and the expected driving information is used to describe driving information of an expected driving trajectory of the target vehicle in the future time period; a first calculation module, used to calculate the driving trajectory of the target vehicle between the current moment and the future moment using the first driving state information and the expected driving information. driving error state quantity, wherein the above-mentioned future moment is a moment in the above-mentioned future time period; a second calculation module, used to calculate the error state quantity state matrix and the control quantity state matrix of the above-mentioned target vehicle based on the above-mentioned vehicle parameter information and the above-mentioned first driving state information, wherein the above-mentioned error state quantity state matrix is a matrix describing the above-mentioned driving error state quantity, and the above-mentioned control quantity state matrix is a matrix describing the control quantity for controlling the driving of the above-mentioned target vehicle; a third calculation module, used to calculate the target front wheel steering angle of the above-mentioned traction component by using the above-mentioned driving error state quantity, the above-mentioned error state quantity state matrix and the above-mentioned control quantity state matrix; a first control module, used to control the driving of the above-mentioned traction component at the above-mentioned future moment based on the above-mentioned target front wheel steering angle, so as to control the driving of the above-mentioned target vehicle at the above-mentioned future moment.
[0019] In an exemplary embodiment, the first acquisition module includes: a first sending submodule, which is used to send an acquisition instruction to the driving information component deployed in the target vehicle, and obtain the vehicle parameter information, the first driving state information and the expected driving information sent by the driving information component in response to the acquisition instruction; wherein the vehicle parameter information includes: the first mass information of the traction component and the second mass information of the towed component, the first moment of inertia of the traction component and the second moment of inertia of the towed component, the first distance between the traction component and the connecting component and the second distance between the towed component and the connecting component, the first lateral stiffness information of the traction component and the second lateral stiffness information of the towed component; the first driving state information includes: the position of the target vehicle at the current moment, the position of the traction component at the current moment The heading angle, the heading angular velocity of the traction component at the current moment, the speed information of the traction component at the current moment, the acceleration of the traction component at the current moment, the articulation angle between the traction component and the towed component at the current moment, and the articulation angular velocity between the traction component and the towed component at the current moment; the expected driving information includes: the expected position set of the target vehicle in the future time period, the expected heading angle set of the traction component in the future time period, the expected heading angular velocity set of the traction component in the future time period, the speed information set of the traction component in the future time period, the expected acceleration set of the traction component in the future time period, the expected articulation angle set of the traction component and the towed component in the future time period, and the expected articulation angular velocity set of the traction component and the towed component in the future time period.
[0020] In an exemplary embodiment, the first calculation module includes: a first calculation submodule, which is used to calculate the distance between the expected position in the expected position set and the position of the target vehicle at the current moment, and obtain the target expected position in the expected trajectory that is closest to the position at the current moment, wherein the target expected position is a position in the expected position set; a first determination submodule, which is used to determine the target expected heading angle, target expected heading angular velocity, target expected velocity, target expected acceleration, target expected articulation angle and target expected articulation angular velocity of the target vehicle at the future moment from the expected driving information based on the target expected position; a second calculation submodule, which is used to calculate the difference between the target expected articulation angular velocity and the articulation angular velocity at the current moment, and obtain the articulation angle error change rate between the traction component and the towed component; a third calculation submodule, which is used to calculate the difference between the target expected articulation angle and the articulation angle at the current moment, and obtain the articulation angle error between the traction component and the towed component; a fourth calculation submodule, which is used to calculate the target expected heading angular velocity and the heading angular velocity at the current moment, to obtain the heading error change rate of the traction component; a fifth calculation submodule, used to calculate the difference between the target expected heading angle and the heading angle at the current moment, to obtain the heading error of the traction component; a sixth calculation submodule, used to calculate the difference between the first product and the second product, to obtain the lateral error change rate of the traction component, wherein the first product is the product of the target expected speed and the sine value of the target expected heading angle, and the second product is the product of the speed at the current moment and the sine value of the heading angle at the current moment; a seventh calculation submodule, used to calculate the difference between the third product and the fourth product, to obtain the lateral error of the traction component, wherein the third product is the difference between the first target expected position in the target expected position and the first position in the position at the current moment, and the cosine value of the target expected heading angle, and the fourth product is the difference between the second target expected position in the target expected position and the second position in the position at the current moment, and the sine value of the target expected heading angle.
[0021] In an exemplary embodiment, the first calculation module includes: an eighth calculation submodule, which is used to calculate the driving error state quantity of the target vehicle between the current moment and the future moment based on the lateral error of the traction component, the lateral error change rate of the traction component, the heading error of the traction component, the lateral error change rate of the traction component, the articulation angle error between the traction component and the towed component, and the articulation angle error change rate between the traction component and the towed component.
[0022] In an exemplary embodiment, the second calculation module includes: a ninth calculation submodule, which is used to calculate the error state quantity state matrix and the control quantity state matrix based on the following formula: A=M e -1 P e , B=M e -1 W e , where A is used to represent the error state quantity state matrix, B is used to represent the control quantity state matrix,
[0023]
[0024]
[0025]
[0026]
[0027]
[0028] W e =[0-k10-(a1+c1)k100] T ,
[0029] The k1 is used to represent the cornering stiffness of the front wheel of the traction component in the first cornering stiffness information, the k2 is used to represent the cornering stiffness of the rear wheel of the traction component in the first cornering stiffness information, the k3 is used to represent the cornering stiffness of the rear wheel of the towed component in the second cornering stiffness information, the a1 is used to represent the distance between the center of mass of the traction component and the front axle in the first distance, the b1 is used to represent the distance between the center of mass of the traction component and the rear axle in the first distance, the c1 is used to represent the distance between the center of mass of the traction component and the hinge point in the first distance, the a2 is used to represent the distance between the center of mass of the towed component and the front axle in the second distance, the b2 is used to represent the distance between the center of mass of the towed component and the rear axle in the second distance, the m1 is used to represent the first mass information, the m2 is used to represent the second mass information, and the v x1 It is used to indicate the longitudinal speed of the traction component in the speed information at the current moment. z1 It is used to represent the first moment of inertia. z2 Used to represent the second moment of inertia mentioned above.
[0030] In an exemplary embodiment, the third calculation module includes: a first execution submodule, which is used to perform discrete operations on the error state quantity state matrix and the control quantity state matrix to obtain a target error state quantity matrix and a target control quantity state matrix; a second execution submodule, which is used to perform iterative operations on the target error state quantity matrix, the target control quantity state matrix and the driving error state quantity simultaneously based on the following formula until the cost function is minimized to obtain a state output feedback matrix: K = -(B d T PB d +R) -1 B d T PA d , where K is used to represent the state output feedback matrix, and B is used to represent the state output feedback matrix. d It is used to represent the state matrix of the target control quantity. d is used to represent the target error state quantity matrix, the above P is used to represent the iteration matrix, and the initial value of the above P is used to represent the weight matrix of the above driving error state quantity; the product between the above state output feedback matrix and the above driving error state quantity is calculated to obtain the above target front wheel steering angle.
[0031] According to another embodiment of the present application, a target vehicle is also provided, comprising the above-mentioned device for controlling vehicle driving.
[0032] According to another embodiment of the present application, a computer program product is provided, including a computer program, wherein the computer program is configured for a processor to execute the steps of any of the above method embodiments.
[0033] According to another embodiment of the present application, a computer-readable storage medium is provided, in which a computer program is stored, wherein the computer program is configured to enable a processor to execute the steps in any of the above method embodiments.
[0034] According to another embodiment of the present application, an electronic device is provided, comprising a memory, a processor, and a computer program stored on the memory and executable on the processor, wherein the processor is configured to execute the computer program to perform the steps in any one of the method embodiments.
[0035] Through the present application, based on the first driving state information of the target vehicle at the current moment and the expected driving information in the future time period, the driving error state quantity of the target vehicle between the current moment and the future moment is calculated, and based on the vehicle parameter information and the first driving state information, the error state quantity state matrix and the control quantity state matrix of the target vehicle are calculated; the target front wheel turning angle of the traction component is calculated using the driving error state quantity, the error state quantity state matrix and the control quantity state matrix. Since the present application calculates the matrix describing the driving error state quantity and the matrix describing the control quantity for controlling the driving of the target vehicle, and calculates the target front wheel turning angle of the traction component based on the driving error state quantity, the error state quantity state matrix and the control quantity state matrix to control the driving of the target vehicle at the future moment, the problem that the vehicle driving cannot be accurately controlled in the related technology is solved, and the effect of improving the vehicle driving control accuracy is achieved. BRIEF DESCRIPTION OF THE DRAWINGS
[0036] Figure 1 This is a hardware structure block diagram of a mobile terminal of a method for controlling vehicle driving according to an embodiment of the present application;
[0037] Figure 2 is a flow chart of a method for controlling vehicle driving according to an embodiment of the present application;
[0038] Figure 3 is a schematic diagram of a method for controlling vehicle travel according to a specific embodiment of the present application;
[0039] Figure 4 is a flow chart of a method for controlling vehicle driving according to a specific embodiment of the present application;
[0040] Figure 5 It is a structural block diagram of a device for controlling vehicle driving according to an embodiment of the present application. DETAILED DESCRIPTION
[0041] The embodiments of the present application will be described in detail below with reference to the accompanying drawings and in combination with the embodiments.
[0042] It should be noted that 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.
[0043] The method embodiments provided in the embodiments of the present application can be executed in a mobile terminal, a computer terminal or a similar computing device. Taking running on a mobile terminal as an example, Figure 1 1 is a hardware structure block diagram of a mobile terminal of a method for controlling vehicle driving according to an embodiment of the present application. Figure 1 As shown, the mobile terminal may include one or more ( Figure 1Only one is shown in the figure) a processor 102 (the processor 102 may include but is not limited to a processing device such as a microprocessor MCU or a programmable logic device FPGA) and a memory 104 for storing data, wherein the mobile terminal may also include a transmission device 106 and an input / output device 108 for communication functions. It can be understood by those skilled in the art that Figure 1 The structure shown is only for illustration and does not limit the structure of the mobile terminal. Figure 1 More or fewer components as shown, or with Figure 1 Different configurations shown.
[0044] The memory 104 can be used to store computer programs, for example, software programs and modules of application software, such as a computer program corresponding to a method for controlling vehicle driving in an embodiment of the present application. The processor 102 executes various functional applications and data processing by running the computer program stored in the memory 104, that is, to implement the above method. The memory 104 may include a high-speed random access memory, and may also include a non-volatile memory, such as one or more magnetic storage devices, flash memory, or other non-volatile solid-state memory. In some examples, the memory 104 may further include a memory remotely arranged relative to the processor 102, and these remote memories may be connected to the mobile terminal via a network. Examples of the above-mentioned network include, but are not limited to, the Internet, an intranet, a local area network, a mobile communication network, and combinations thereof.
[0045] The transmission device 106 is used to receive or send data via a network. The specific example of the above network may include a wireless network provided by a communication provider of the mobile terminal. In one example, the transmission device 106 includes a network adapter (Network Interface Controller, referred to as NIC), which can be connected to other network devices through a base station so as to communicate with the Internet. In one example, the transmission device 106 can be a radio frequency (RF) module, which is used to communicate with the Internet wirelessly.
[0046] In this embodiment, a method for controlling vehicle driving is provided. Figure 2 is a flow chart of a method for controlling vehicle driving according to an embodiment of the present application. Figure 2 As shown, the process includes the following steps:
[0047] Step S202, obtaining vehicle parameter information and first driving state information of the target vehicle at the current moment, and expected driving information in a future time period, wherein the target vehicle is composed of a traction component and a traction component connected by a connection component, the first driving state information is used to describe a first driving state of the traction component at the current moment, and a second driving state of the traction component at the current moment, and the expected driving information is used to describe driving information of an expected driving trajectory of the target vehicle in a future time period;
[0048] Optionally, the traction component includes but is not limited to a tractor, and the towed component includes but is not limited to a trailer and an articulated trailer. The connection component includes but is not limited to a fifth wheel and a hitch, a traction hook and a hitch ring, electrical and pneumatic connections, a steering system, and a suspension system.
[0049] Optionally, the vehicle parameter information is used to describe mass information, moment of inertia information, distance information and cornering stiffness information of the target vehicle.
[0050] Optionally, the first driving state information includes, but is not limited to, the position information of the target vehicle at the current moment, the driving information of the traction component at the current moment, and the driving information of the towed component at the current moment.
[0051] Optionally, the expected driving information includes, but is not limited to, the position information of the target vehicle in a future period, the driving information of the traction component in a future period, and the driving information of the towed component in a future period.
[0052] Step S204, using the first driving state information and the expected driving information, calculating the driving error state quantity of the target vehicle between the current time and the future time, wherein the future time is a time in the future period;
[0053] Optionally, the driving error state quantity is used to describe the driving error of the target vehicle between the current moment and the future moment, and is specifically calculated based on a three-degree-of-freedom model of lateral motion of the traction component, yaw motion of the traction component and yaw motion of the target vehicle using the first driving state information and expected driving information.
[0054] Step S206, based on the vehicle parameter information and the first driving state information, calculating the error state quantity state matrix and the control quantity state matrix of the target vehicle, wherein the error state quantity state matrix is a matrix describing the driving error state quantity, and the control quantity state matrix is a matrix describing the control quantity of controlling the driving of the target vehicle;
[0055] Optionally, the control quantity includes but is not limited to controlling the throttle opening of the target vehicle's engine, throttle control that affects target acceleration and deceleration, controlling the braking force of the target vehicle, braking control for deceleration or parking, controlling the steering angle of the target vehicle, steering control that affects the target vehicle's driving direction, gear shifting control, and traction control.
[0056] Optionally, the error state quantity state matrix and the control quantity state matrix are specifically calculated based on a three-degree-of-freedom model of lateral motion of the traction component, yaw motion of the traction component and yaw motion of the target vehicle using vehicle parameter information and the first driving state information.
[0057] Step S208, calculating the target front wheel turning angle of the traction assembly by using the driving error state quantity, the error state quantity state matrix and the control quantity state matrix;
[0058] Step S210, controlling the driving of the towed component at a future time based on the target front wheel steering angle, so as to control the driving of the target vehicle at a future time.
[0059] Optionally, the construction process of the three-degree-of-freedom model is as follows: To simplify the three-degree-of-freedom model, the following assumptions are made for the three-degree-of-freedom model: the front wheel angle is directly used as the input of the constructed vehicle system, and the influence of the steering system is ignored; the difference in the characteristics of the left and right vehicles during the vehicle's movement is ignored, and the influence of load changes and the return torque on the tire characteristics is ignored; the yaw motion of the vehicle does not consider the difference in the longitudinal and lateral forces of the left and right wheels. Based on the above assumptions, the vehicle model can be simplified to a single-track dual-center-of-mass model, such as Figure 3 shown.
[0060] The dynamic equations established according to Newton's second law are as follows:
[0061]
[0062]
[0063]
[0064]
[0065] in,
[0066]
[0067]
[0068] γ=φ1-φ2,
[0069] Where m1 is the mass of the tractor, v y1 is the lateral speed of the tractor, is the lateral acceleration of the tractor, φ1 is the heading angle of the tractor, is the yaw rate of the tractor, is the yaw angular acceleration of the tractor, v x1 is the longitudinal speed of the tractor, I z1 is the moment of inertia of the tractor, a1 is the distance from the center of mass of the tractor to the front axle, b1 is the distance from the center of mass of the tractor to the rear axle, c1 is the distance from the center of mass of the tractor to the hinge point, F yf is the lateral force of the front wheel of the tractor, F yr is the lateral force of the tractor's rear wheels, F py is the lateral force at the articulation point, m2 is the mass of the trailer, v y2 is the lateral speed of the trailer, is the lateral acceleration of the trailer, v x2 is the longitudinal velocity of the trailer, φ2 is the heading angle of the trailer, is the trailer's yaw rate, The trailer's sway is called acceleration, I z2 is the moment of inertia of the trailer, a2 is the distance from the center of mass of the trailer to the front axle, b2 is the distance from the center of mass of the trailer to the rear axle, F yt is the lateral force on the rear wheels of the trailer, and γ is the heading angle deviation between the tractor and the trailer.
[0070] Alternatively, assuming that γ is very small, cosγ = 1, the above equation can be transformed into:
[0071]
[0072]
[0073]
[0074]
[0075]
[0076] Among them, tire force:
[0077]
[0078]
[0079]
[0080] Among them, k1 is the cornering stiffness of the front wheel of the tractor, δ is the turning angle of the front wheel of the tractor, k2 is the cornering stiffness of the rear wheel of the tractor, and k3 is the cornering stiffness of the rear wheel of the trailer.
[0081] After simplifying the dynamic equations, we can get the dynamic state space equation:
[0082]
[0083]
[0084]
[0085] W=[-k1-(a1+c1)k100] T ,
[0086]
[0087] Among them, X is the state quantity, is the derivative of the state quantity, is the rate of change of the heading angle deviation of the tractor and trailer, M, P, W are all state matrices.
[0088] Optionally, let e y is the lateral error of the tractor, is the lateral error change rate of the tractor, e φ1 is the heading error of the tractor, is the tractor heading error change rate, e γ is the hinge angle error, is the change rate of the articulation angle error,
[0089]
[0090] but,
[0091] We can get:
[0092] Among them, a y1 is the lateral acceleration of the tractor, a ydes is the desired lateral acceleration of the tractor, is the desired yaw rate of the tractor.
[0093] Substituting into the dynamic model and simplifying it, we can get the error state space equation:
[0094]
[0095] in,
[0096]
[0097]
[0098]
[0099]
[0100]
[0101] W e =[0-k10-(a1+c1)k100] T ,
[0102]
[0103] It can be written as:
[0104] A=M e -1 P e , B=M e -1 W e ,
[0105] Among them, Xe is the driving error state quantity, is the derivative of the driving error state quantity, the rest Me, Pe, We are the calculation process state matrices, A is the error state quantity state matrix, B is the control quantity state matrix, and u is the control quantity.
[0106] In this embodiment, the execution subject of the above steps can be a terminal, a server, a specific processor set in the terminal or server, or a processor or processing device set relatively independently from the terminal or server, but is not limited thereto.
[0107] Through the above steps, based on the first driving state information of the target vehicle at the current moment and the expected driving information in the future time period, the driving error state quantity of the target vehicle between the current moment and the future moment is calculated, and based on the vehicle parameter information and the first driving state information, the error state quantity state matrix and the control quantity state matrix of the target vehicle are calculated; the target front wheel turning angle of the traction component is calculated using the driving error state quantity, the error state quantity state matrix and the control quantity state matrix. Since the present application calculates the matrix describing the driving error state quantity and the matrix describing the control quantity for controlling the driving of the target vehicle, and calculates the target front wheel turning angle of the traction component based on the driving error state quantity, the error state quantity state matrix and the control quantity state matrix to control the driving of the target vehicle at the future moment, the problem that the vehicle driving cannot be accurately controlled in the related art is solved, and the effect of improving the vehicle driving control accuracy is achieved.
[0108] In an exemplary embodiment, obtaining vehicle parameter information and first driving state information of a target vehicle at a current moment, as well as expected driving information in a future time period, includes: sending an acquisition instruction to a driving information component deployed in the target vehicle, and obtaining the vehicle parameter information, the first driving state information and the expected driving information sent by the driving information component in response to the acquisition instruction; wherein the vehicle parameter information includes: first mass information of the traction component and second mass information of the towed component, first moment of inertia of the traction component and second moment of inertia of the towed component, first distance between the traction component and the connecting component and second distance between the towed component and the connecting component, first lateral stiffness information of the traction component and second lateral stiffness information of the towed component; the first driving state information includes: the position of the target vehicle at the current moment, The heading angle of the traction component at the current moment, the heading angular velocity of the traction component at the current moment, the speed information of the traction component at the current moment, the acceleration of the traction component at the current moment, the articulation angle between the traction component and the towed component at the current moment, and the articulation angular velocity between the traction component and the towed component at the current moment; the expected driving information includes: the expected position set of the target vehicle in the future time period, the expected heading angle set of the traction component in the future time period, the expected heading angular velocity set of the traction component in the future time period, the speed information set of the traction component in the future time period, the expected acceleration set of the traction component in the future time period, the expected articulation angle set of the traction component and the towed component in the future time period, and the expected articulation angular velocity set of the traction component and the towed component in the future time period.
[0109] Optionally, the driving information components include, but are not limited to, sensors for sensing the vehicle's surroundings and the vehicle's own status, an on-board computing platform responsible for processing sensor data, executing control algorithms, and making driving decisions, and communication components for the vehicle to communicate with other vehicles, infrastructure, pedestrians, etc. For example, cameras, radars, lidars, inertial measurement units, etc.
[0110] Optionally, the first mass information of the traction component (tractor): For example, the mass of the tractor may be between 3000 and 5000 kg, and the specific value depends on the model and design. The second mass information of the towed component (trailer): The mass of the trailer may be larger, ranging from 5000 to 15000 kg, and the specific value depends on the size of the trailer and the intended use. The first moment of inertia of the traction component: The moment of inertia of the tractor may be between 500 and 2000 kg·m2, and the specific value depends on the design of the wheels and axles. The second moment of inertia of the towed component: The moment of inertia of the trailer may be higher, and may be between 2000 and 10000 kg·m2, and the specific value depends on the size of the trailer and the mass distribution. The first distance between the traction component and the connecting component includes the distance from the center of mass of the traction component to the front axle, the distance from the center of mass of the traction component to the rear axle, and the distance from the center of mass of the traction component to the hinge point. The second distance between the towed component and the connecting component includes the distance from the center of mass of the traction component to the front axle, and the distance from the center of mass of the traction component to the rear axle. The first lateral stiffness information of the traction component includes the lateral stiffness of the front wheel of the traction component and the lateral stiffness of the rear wheel of the traction component, and the lateral stiffness affects the stability of the vehicle when turning. The second lateral stiffness information of the towed component includes the lateral stiffness of the rear wheel of the towed component.
[0111] Optionally, the position of the target vehicle at the current moment is used to describe the coordinate information of the traction component in a specific coordinate system. Assume that x 1t is the x coordinate point of the tractor at the current moment, y 1t It is the y-coordinate point of the tractor at the current moment. The heading angle of the tractor component at the current moment: The heading angle is the angle between the target vehicle's forward direction and the reference direction. For example, the tractor may be facing due north, and its heading angle is 0°. The heading angular velocity of the tractor component at the current moment: The heading angular velocity is the rate of change of the heading angle over time. For example, the heading angular velocity of the tractor may be close to 0° / s when it is driving steadily, but it may reach 2° / s when turning. The speed information of the tractor component at the current moment includes the speed of the tractor component at the current moment and the longitudinal speed of the tractor component at the current moment. The acceleration of the tractor component at the current moment: The acceleration is the rate of change of speed over time. For example, the tractor may have a 0.5m / s when accelerating. 2 Acceleration. The articulation angle of the tractor and the towed component at the current moment: The articulation angle is the angle between the tractor and the trailer. For example, the articulation angle may be 0° when driving in a straight line, but there may be an articulation angle of 5° when driving in a curve. The articulation angular velocity of the tractor and the towed component at the current moment: The articulation angular velocity is the rate of change of the articulation angle over time. For example, the articulation angular velocity may be 0° / s when driving smoothly, but there may be an articulation angular velocity of 1° / s when performing lane changes or obstacle avoidance operations.
[0112] Optionally, the expected driving information is key data used by the autonomous driving system in path planning and driving decisions. This information is usually obtained based on the current state of the target vehicle and the expected driving trajectory. The following is an example of the numerical value of the expected driving information of the traction component in the future period: The expected position set of the target vehicle in the future period: For example, the target vehicle may plan to travel along the path from the current position of the tractor (x:100m,y:200m) through (x:110m,y:210m), (x:130m,y:200m) to the new position of the tractor (x:150m,y:250m) in the next 30 seconds. Then the expected position set includes: (x:110m,y:210m), (x:130m,y:200m), (x:150m,y:250m). The expected heading angle set of the traction component in the future period: Assuming that the target vehicle plans to travel along the expected driving trajectory in the next few periods, its expected heading angle set may be [0°,5°,10°], indicating that the vehicle will gradually turn. The expected heading angular velocity set of the traction component in the future time period: The corresponding expected heading angular velocity set may be [0.2° / s, 0.1° / s, 0.05° / s], indicating the smoothness of the target steering. The speed information set of the traction component in the future time period: The target vehicle may plan to travel at different speeds in different time periods, for example, the speed information set may be [60km / h, 65km / h, 70km / h]. The expected acceleration set of the traction component in the future time period: The acceleration set of the tractor may be [0m / s 2 ,0.2m / s 2 ,-0.1m / s 2 ], indicating that the target vehicle first travels at a constant speed, then accelerates slightly, and finally decelerates slightly. The expected articulation angle set of the traction component and the towed component in the future period: The articulation angle set may be [0°, 2°, -1°], indicating the change of the articulation angle of the target vehicle during the turning process. The expected articulation angular velocity set of the traction component and the towed component in the future period: The articulation angular velocity set may be [0° / s, 0.2° / s, -0.1° / s], indicating the change of the articulation angular velocity of the target vehicle during the turning process. These expected driving information are usually generated by the high-level planning modules of the autonomous driving system, such as behavior planning and motion planning. Behavior planning determines the macroscopic behavior of the vehicle (such as lane keeping, lane changing, overtaking, etc.), while motion planning is responsible for generating specific trajectories and speed curves to achieve these behaviors. In actual applications, the expected driving information will be continuously updated and adjusted according to the real-time status of the vehicle and the perceived environmental information to ensure that the vehicle can reach its destination safely and efficiently.
[0113] This embodiment sends an acquisition instruction to the driving information component deployed on the target vehicle to comprehensively collect the current state of the vehicle and the expected information for future driving, thereby achieving the purpose of more precise vehicle control.
[0114] In an exemplary embodiment, the first driving state information and the expected driving information are used to calculate the driving error state of the target vehicle between the current moment and the future moment, including: calculating the distance between the expected position in the expected position set and the position of the target vehicle at the current moment, and obtaining the target expected position in the expected trajectory that is closest to the position at the current moment, wherein the target expected position is a position in the expected position set; based on the target expected position, determining the target expected heading angle, target expected heading angular velocity, target expected velocity, target expected acceleration, target expected articulation angle and target expected articulation angular velocity of the target vehicle at the future moment from the expected driving information; calculating the difference between the target expected articulation angular velocity and the articulation angular velocity at the current moment, and obtaining the articulation angle error change rate between the traction component and the towed component; calculating the difference between the target expected articulation angle and the articulation angle at the current moment, and obtaining the articulation angle error between the traction component and the towed component; calculating Calculate the difference between the target expected heading angular velocity and the heading angular velocity at the current moment to obtain the heading error change rate of the traction component; calculate the difference between the target expected heading angle and the heading angle at the current moment to obtain the heading error of the traction component; calculate the difference between the first product and the second product to obtain the lateral error change rate of the traction component, wherein the first product is the product of the target expected speed and the sine value of the target expected heading angle, and the second product is the product of the speed at the current moment and the sine value of the heading angle at the current moment; calculate the difference between the third product and the fourth product to obtain the lateral error of the traction component, wherein the third product is the difference between the first target expected position in the target expected position and the first position in the position at the current moment, and the cosine value of the target expected heading angle, and the fourth product is the difference between the second target expected position in the target expected position and the second position in the position at the current moment, and the sine value of the target expected heading angle.
[0115] In an exemplary embodiment, the first driving state information and the expected driving information are used to calculate the driving error state quantity of the target vehicle between the current moment and the future moment, including: based on the lateral error of the traction component, the lateral error change rate of the traction component, the heading error of the traction component, the lateral error change rate of the traction component, the articulation angle error between the traction component and the towed component, and the articulation angle error change rate between the traction component and the towed component, calculating the driving error state quantity of the target vehicle between the current moment and the future moment.
[0116] Optionally, assuming that the expected driving information is Among them, x 1r is the set of x-coordinate points expected by the tractor in the future, y 1r is the set of expected y coordinate points of the tractor in the future period, φ 1r is the set of expected heading angles of the tractor in the future period, v 1r is the set of expected speeds of the tractor in the future period, is the set of expected heading angular velocities of the tractor in the future period, is the set of expected accelerations of the tractor in the future period, γ r is the set of expected articulation angles of the tractor and trailer in the future period, is the set of expected articulation angular velocities of the tractor and trailer in the future period. Assume that the first driving state information is Among them, x 1t is the x coordinate point of the tractor at the current moment, y 1t is the y coordinate of the tractor at the current moment, φ 1t is the heading angle of the tractor at the current moment, v 1t is the current speed of the tractor, is the angular velocity of the tractor at the current moment, is the acceleration of the tractor at the current moment, γ t is the articulation angle between the tractor and trailer at the current moment, Available through γ t The time derivative is obtained. Calculate the distance between the expected position in the expected position set and the position of the target vehicle at the current moment, and find the nearest matching point from the expected driving trajectory as the tracking target. Assume that the final matching point is: in, are the x- and y-coordinates of the matching points, and the others are the expected positions of the targets The corresponding target vehicle's expected heading angle at the future moment Target expected heading angular velocity Target expected speed Target expected acceleration Target desired articulation angle and the target desired articulation angular velocity
[0117] Then the driving error state quantity can be obtained Each error state quantity in: Articulation angle error change rate Articulation angle error Heading error rate of change Heading Error Lateral error change rate Lateral error
[0118] This embodiment achieves the purpose of improving the lateral control accuracy of the target vehicle by calculating the lateral error, lateral error change rate, heading error, heading error change rate, articulation angle error, and articulation angle error change rate of the towing component.
[0119] In an exemplary embodiment, based on the vehicle parameter information and the first driving state information, calculating the error state quantity state matrix and the control quantity state matrix of the target vehicle includes: calculating the error state quantity state matrix and the control quantity state matrix based on the following formula: A=M e -1 P e , B=M e -1 W e , where A is used to represent the error state quantity state matrix, B is used to represent the control quantity state matrix,
[0120]
[0121]
[0122]
[0123]
[0124]
[0125] W e =[0 -k1 0 -(a1+c1)k1 0 0] T ,
[0126] The k1 is used to represent the cornering stiffness of the front wheel of the traction component in the first cornering stiffness information, the k2 is used to represent the cornering stiffness of the rear wheel of the traction component in the first cornering stiffness information, the k3 is used to represent the cornering stiffness of the rear wheel of the towed component in the second cornering stiffness information, the a1 is used to represent the distance between the center of mass of the traction component and the front axle in the first distance, the b1 is used to represent the distance between the center of mass of the traction component and the rear axle in the first distance, the c1 is used to represent the distance between the center of mass of the traction component and the hinge point in the first distance, the a2 is used to represent the distance between the center of mass of the towed component and the front axle in the second distance, the b2 is used to represent the distance between the center of mass of the towed component and the rear axle in the second distance, the m1 is used to represent the first mass information, the m2 is used to represent the second mass information, and the v x1It is used to indicate the longitudinal speed of the traction component in the speed information at the current moment. z1 It is used to represent the first moment of inertia. z2 Used to represent the second moment of inertia mentioned above.
[0127] Optionally, the vehicle parameter information and the first driving state information of the target vehicle at the current moment obtained through the driving information component are input into the error state space equation in the constructed three-degree-of-freedom model:
[0128]
[0129]
[0130]
[0131]
[0132]
[0133] A=M e -1 P e , B=M e -1 W e The error state quantity state matrix and control quantity state matrix of the target vehicle can be obtained.
[0134] This embodiment calculates the error state quantity state matrix and the control quantity state matrix of the target vehicle based on the vehicle parameter information and the first driving state information of the target vehicle at the current moment, thereby achieving the purpose of accurately representing the driving error state quantity and the control quantity state.
[0135] In an exemplary embodiment, the target front wheel turning angle of the traction assembly is calculated by using the driving error state quantity, the error state quantity state matrix and the control quantity state matrix, including: performing discrete operations on the error state quantity state matrix and the control quantity state matrix to obtain a target error state quantity matrix and a target control quantity state matrix; performing iterative operations on the target error state quantity matrix, the target control quantity state matrix and the driving error state quantity simultaneously based on the following formula until the cost function is minimized to obtain a state output feedback matrix: K = -(B d T PB d +R) - 1 B d T PA d , where K is used to represent the state output feedback matrix, and B is used to represent the state output feedback matrix. dIt is used to represent the state matrix of the target control quantity. d is used to represent the target error state quantity matrix, the above P is used to represent the iteration matrix, and the initial value of the above P is used to represent the weight matrix of the above driving error state quantity; the product between the above state output feedback matrix and the above driving error state quantity is calculated to obtain the above target front wheel steering angle.
[0136] Optionally, the state matrix A and the control state matrix B calculated above are discretized to obtain the target error state matrix A d And the target control state matrix B d , the discretization process is as follows, for the continuous system:
[0137]
[0138] Let the sampling period be T, t0=kT, t=(k+1)T, that is, considering the state response of the target vehicle from time k to k+1, we have:
[0139]
[0140] Substituting variables in the integral above, let t = (k+1)T-τ, we have
[0141]
[0142] Combine the above equation with the state equation of the steady-state discrete linear system:
[0143] x((k+1)T)=G(T)x(kT)+H(T)u(kT),
[0144] By comparison, we can see that in order to make the two equations valid for any x(kT) and u(kT), we have:
[0145]
[0146]
[0147] In order to facilitate subsequent calculations, the exact discretization needs to be further approximated, because: Perform Taylor expansion on both the numerator and denominator of the above equation and take the first two terms to get:
[0148]
[0149] According to the target error state matrix A d And the target control state matrix B d , and the driving error state quantity X e Perform iterative optimization and calculate the state output feedback matrix K to minimize the following cost function: Assume there is a feedback control law: u=K*X e , bring the calculated Xe and the above-assumed feedback control law into the cost function, and according to the Riccati equation, the state output feedback matrix K that minimizes the cost function is: K = -(B d T PB d +R) -1 B d T PA d , where P is used to represent the iteration matrix, the initial value of P is used to represent the weight matrix of the driving error state quantity, R is the weight matrix of the control quantity u, and Q and R are calibrated in actual applications. Calculate the product between the state output feedback matrix and the driving error state quantity to obtain the target front wheel steering angle δ: δ=u=K*X e .
[0150] The present invention will be described below in conjunction with specific embodiments:
[0151] Figure 4 It is a flowchart of a method for controlling vehicle driving according to a specific embodiment of the present application, including a dynamic model building module, a discretization module, a lateral control deviation calculation module, an iteration module, a target front wheel angle calculation module, and a vehicle steering execution module. Figure 4 As shown, the following steps are included:
[0152] S402, the construction process of the three-degree-of-freedom model is as follows: To simplify the three-degree-of-freedom model, the following assumptions are made for the three-degree-of-freedom model: the front wheel angle is directly used as the input of the constructed vehicle system, and the influence of the steering system is ignored; the difference in the characteristics of the left and right vehicles during the vehicle's movement is ignored, and the influence of load changes and the return torque on the tire characteristics is ignored; the yaw motion of the vehicle does not consider the difference in the longitudinal and lateral forces of the left and right wheels. Based on the above assumptions, the whole vehicle model can be simplified to a single-track dual-center-of-mass model, such as Figure 3 shown.
[0153] The dynamic equations established according to Newton's second law are as follows:
[0154]
[0155]
[0156]
[0157]
[0158] in,
[0159]
[0160]
[0161] γ=φ1-φ2,
[0162] Where m1 is the mass of the tractor, v y1 is the lateral speed of the tractor, is the lateral acceleration of the tractor, φ1 is the heading angle of the tractor, is the yaw rate of the tractor, is the yaw angular acceleration of the tractor, v x1 is the longitudinal speed of the tractor, I z1 is the moment of inertia of the tractor, a1 is the distance from the center of mass of the tractor to the front axle, b1 is the distance from the center of mass of the tractor to the rear axle, c1 is the distance from the center of mass of the tractor to the hinge point, F yf is the lateral force of the front wheel of the tractor, F yr is the lateral force of the tractor's rear wheels, F py is the lateral force at the articulation point, m2 is the mass of the trailer, v y2 is the lateral speed of the trailer, is the lateral acceleration of the trailer, v x2 is the longitudinal velocity of the trailer, φ2 is the heading angle of the trailer, is the trailer's yaw rate, The trailer's sway is called acceleration, I z2 is the moment of inertia of the trailer, a2 is the distance from the center of mass of the trailer to the front axle, b2 is the distance from the center of mass of the trailer to the rear axle, F yt is the lateral force on the rear wheels of the trailer, and γ is the heading angle deviation between the tractor and the trailer.
[0163] Alternatively, assuming that γ is very small, cosγ = 1, the above equation can be transformed into:
[0164]
[0165]
[0166]
[0167]
[0168]
[0169] Among them, tire force:
[0170]
[0171]
[0172]
[0173] Among them, k1 is the cornering stiffness of the front wheel of the tractor, δ is the turning angle of the front wheel of the tractor, k2 is the cornering stiffness of the rear wheel of the tractor, and k3 is the cornering stiffness of the rear wheel of the trailer.
[0174] After simplifying the dynamic equations, we can get the dynamic state space equation:
[0175]
[0176]
[0177]
[0178] W=[-k1 -(a1+c1)k1 0 0] T ,
[0179]
[0180] Among them, X is the state quantity, is the derivative of the state quantity, is the rate of change of the heading angle deviation of the tractor and trailer, M, P, W are all state matrices.
[0181] Optionally, let e y is the lateral error of the tractor, is the lateral error change rate of the tractor, e φ1 is the heading error of the tractor, is the tractor heading error change rate, e γ is the hinge angle error, is the change rate of the articulation angle error,
[0182]
[0183] but,
[0184] We can get:
[0185] Among them, a y1 is the lateral acceleration of the tractor, a ydes is the desired lateral acceleration of the tractor, is the desired yaw rate of the tractor.
[0186] Substituting into the dynamic model and simplifying it, we can get the error state space equation:
[0187]
[0188] in,
[0189]
[0190]
[0191]
[0192]
[0193]
[0194] W e =[0 -k1 0 -(a1+c1)k1 0 0] T ,
[0195]
[0196] It can be written as:
[0197] A=M e -1 P e , B=M e -1 W e ,
[0198] Among them, Xe is the driving error state quantity, is the derivative of the driving error state quantity, the rest Me, Pe, We are the calculated process state matrices, A is the error state quantity state matrix, B is the control quantity state matrix, and u is the control quantity;
[0199] The vehicle parameter information and the first driving state information of the target vehicle at the current moment obtained through the driving information component are input into the error state space equation in the constructed three-degree-of-freedom model, and the error state quantity state matrix A and the control quantity state matrix B of the target vehicle can be obtained.
[0200] S404, the discretization module discretizes the error state quantity state matrix A and the control quantity state matrix B obtained by the above calculation to obtain the target error state quantity matrix A d And the target control state matrix B d , the discretization process is as follows, for the continuous system:
[0201]
[0202] Let the sampling period be T, t0=kT, t=(k+1)T, that is, considering the state response of the target vehicle from time k to k+1, we have:
[0203]
[0204] Substituting variables in the integral above, let t = (k+1)T-τ, we have
[0205]
[0206] Combine the above equation with the state equation of the steady-state discrete linear system:
[0207] x((k+1)T)=G(T)x(kT)+H(T)u(kT),
[0208] By comparison, we can see that in order to make the two equations valid for any x(kT) and u(kT), we have:
[0209]
[0210]
[0211] In order to facilitate subsequent calculations, the exact discretization needs to be further approximated, because: Perform Taylor expansion on both the numerator and denominator of the above equation and take the first two terms to get:
[0212]
[0213] S406, the lateral control deviation calculation module calculates the driving error state quantity of the target vehicle between the current moment and the future moment based on the first driving state information of the target vehicle and the expected driving information obtained by the driving information component.
[0214] Assume that the expected driving information is Among them, x 1r is the set of x-coordinate points expected by the tractor in the future, y 1r is the set of expected y coordinate points of the tractor in the future period, φ 1r is the set of expected heading angles of the tractor in the future period, v 1r is the set of expected speeds of the tractor in the future period, is the set of expected heading angular velocities of the tractor in the future period, is the set of expected accelerations of the tractor in the future period, γ r is the set of expected articulation angles of the tractor and trailer in the future period, It is the set of expected articulation angular velocities of the tractor and trailer in the future period.
[0215] Assume that the first driving state information is Among them, x 1t is the x coordinate point of the tractor at the current moment, y 1t is the y coordinate of the tractor at the current moment, φ 1t is the heading angle of the tractor at the current moment, v 1t is the current speed of the tractor, is the angular velocity of the tractor at the current moment, is the acceleration of the tractor at the current moment, γt is the articulation angle between the tractor and trailer at the current moment, Available through γ t Taking the derivative with respect to time we get .
[0216] Calculate the distance between the expected position in the expected position set and the position of the target vehicle at the current moment, and find the nearest matching point from the expected driving trajectory as the tracking target. Assume that the final matching point is: in, are the x- and y-coordinates of the matching points, and the others are the expected positions of the targets The corresponding target vehicle's expected heading angle at the future moment Target expected heading angular velocity Target expected speed Target expected acceleration Target desired articulation angle and the target desired articulation angular velocity Then the driving error state quantity can be obtained Each error state quantity in: Articulation angle error change rate Articulation angle error Heading error rate of change Heading Error Lateral error change rate Lateral error
[0217] S408, the iteration module calculates the target error state matrix A d And the target control state matrix B d , and the driving error state quantity X e Perform iterative optimization and calculate the state output feedback matrix K to minimize the following cost function: Assume there is a feedback control law: u=K*X e , bring the calculated Xe and the above-assumed feedback control law into the cost function, and according to the Riccati equation, the state output feedback matrix K that minimizes the cost function is: K = -(B d T PB d +R) -1 B d T PA d , where P is used to represent the iteration matrix, the initial value of P is used to represent the weight matrix of the driving error state quantity, R is the weight matrix of the control quantity u, and Q and R are calibrated in actual applications;
[0218] S410, the front wheel steering angle calculation module is expected to output the feedback matrix K according to the calculation result state of the iteration module and the result driving error state quantity X of the lateral control deviation calculation module. e Calculate the target front wheel turning angle δ: δ=u=K*X e ;
[0219] S412, finally sending the target front wheel turning angle δ to the vehicle steering execution module to achieve lateral control of the target vehicle.
[0220] In this embodiment, a complete three-degree-of-freedom model is established and applied to the lateral control of the target vehicle, which solves the problem of low lateral control accuracy of the target vehicle and achieves the purpose of improving the control accuracy and safety of the autonomous driving target vehicle.
[0221] Through the description of the above implementation methods, those skilled in the art can clearly understand that the method according to the above embodiment can be implemented by means of software plus a necessary general hardware platform, and of course by hardware, but in many cases the former is a better implementation method. Based on such an understanding, the technical solution of the present application, or the part that contributes to the prior art, can be embodied in the form of a software product, which is stored in a storage medium (such as ROM / RAM, magnetic disk, optical disk), and includes a number of instructions for a terminal device (which can be a mobile phone, computer, server, or network device, etc.) to execute the methods of each embodiment of the present application.
[0222] In this embodiment, a device for controlling vehicle travel is also provided, which is used to implement the above-mentioned embodiments and preferred implementation modes, and the descriptions that have been made will not be repeated. As used below, the term "module" can implement a combination of software and / or hardware of a predetermined function. Although the devices described in the following embodiments are preferably implemented in software, the implementation of hardware, or a combination of software and hardware, is also possible and conceivable.
[0223] Figure 5 is a structural block diagram of a device for controlling vehicle travel according to an embodiment of the present application, such as Figure 5 As shown, the device comprises:
[0224] The first acquisition module 502 is used to acquire vehicle parameter information and first driving state information of the target vehicle at the current moment, and expected driving information in a future time period, wherein the target vehicle is composed of a traction component and a towed component connected by a connection component, the first driving state information is used to describe the first driving state of the traction component at the current moment, and the second driving state of the towed component at the current moment, and the expected driving information is used to describe the driving information of the expected driving trajectory of the target vehicle in the future time period;
[0225] A first calculation module 504 is used to calculate the driving error state quantity of the target vehicle between the current moment and a future moment by using the first driving state information and the expected driving information, wherein the future moment is a moment in the future period;
[0226] A second calculation module 506 is used to calculate the error state quantity state matrix and the control quantity state matrix of the target vehicle based on the vehicle parameter information and the first driving state information, wherein the error state quantity state matrix is a matrix describing the driving error state quantity, and the control quantity state matrix is a matrix describing the control quantity for controlling the driving of the target vehicle;
[0227] A third calculation module 508, used to calculate the target front wheel turning angle of the traction assembly by using the driving error state quantity, the error state quantity state matrix and the control quantity state matrix;
[0228] The first control module 510 is used to control the driving of the towed component at the future time based on the target front wheel steering angle, so as to control the driving of the target vehicle at the future time.
[0229] In an exemplary embodiment, the first acquisition module includes: a first sending submodule, which is used to send an acquisition instruction to the driving information component deployed in the target vehicle, and obtain the vehicle parameter information, the first driving state information and the expected driving information sent by the driving information component in response to the acquisition instruction; wherein the vehicle parameter information includes: the first mass information of the traction component and the second mass information of the towed component, the first moment of inertia of the traction component and the second moment of inertia of the towed component, the first distance between the traction component and the connecting component and the second distance between the towed component and the connecting component, the first lateral stiffness information of the traction component and the second lateral stiffness information of the towed component; the first driving state information includes: the position of the target vehicle at the current moment, the position of the traction component at the current moment The heading angle, the heading angular velocity of the traction component at the current moment, the speed information of the traction component at the current moment, the acceleration of the traction component at the current moment, the articulation angle between the traction component and the towed component at the current moment, and the articulation angular velocity between the traction component and the towed component at the current moment; the expected driving information includes: the expected position set of the target vehicle in the future time period, the expected heading angle set of the traction component in the future time period, the expected heading angular velocity set of the traction component in the future time period, the speed information set of the traction component in the future time period, the expected acceleration set of the traction component in the future time period, the expected articulation angle set of the traction component and the towed component in the future time period, and the expected articulation angular velocity set of the traction component and the towed component in the future time period.
[0230] In an exemplary embodiment, the first calculation module includes: a first calculation submodule, which is used to calculate the distance between the expected position in the expected position set and the position of the target vehicle at the current moment, and obtain the target expected position in the expected trajectory that is closest to the position at the current moment, wherein the target expected position is a position in the expected position set; a first determination submodule, which is used to determine the target expected heading angle, target expected heading angular velocity, target expected velocity, target expected acceleration, target expected articulation angle and target expected articulation angular velocity of the target vehicle at the future moment from the expected driving information based on the target expected position; a second calculation submodule, which is used to calculate the difference between the target expected articulation angular velocity and the articulation angular velocity at the current moment, and obtain the articulation angle error change rate between the traction component and the towed component; a third calculation submodule, which is used to calculate the difference between the target expected articulation angle and the articulation angle at the current moment, and obtain the articulation angle error between the traction component and the towed component; a fourth calculation submodule, which is used to calculate the target expected heading angular velocity and the heading angular velocity at the current moment, to obtain the heading error change rate of the traction component; a fifth calculation submodule, used to calculate the difference between the target expected heading angle and the heading angle at the current moment, to obtain the heading error of the traction component; a sixth calculation submodule, used to calculate the difference between the first product and the second product, to obtain the lateral error change rate of the traction component, wherein the first product is the product of the target expected speed and the sine value of the target expected heading angle, and the second product is the product of the speed at the current moment and the sine value of the heading angle at the current moment; a seventh calculation submodule, used to calculate the difference between the third product and the fourth product, to obtain the lateral error of the traction component, wherein the third product is the difference between the first target expected position in the target expected position and the first position in the position at the current moment, and the cosine value of the target expected heading angle, and the fourth product is the difference between the second target expected position in the target expected position and the second position in the position at the current moment, and the sine value of the target expected heading angle.
[0231] In an exemplary embodiment, the first calculation module includes: an eighth calculation submodule, which is used to calculate the driving error state quantity of the target vehicle between the current moment and the future moment based on the lateral error of the traction component, the lateral error change rate of the traction component, the heading error of the traction component, the lateral error change rate of the traction component, the articulation angle error between the traction component and the towed component, and the articulation angle error change rate between the traction component and the towed component.
[0232] In an exemplary embodiment, the second calculation module includes: a ninth calculation submodule, which is used to calculate the error state quantity state matrix and the control quantity state matrix based on the following formula: A=M e -1 P e , B=M e -1 W e , where A is used to represent the error state quantity state matrix, B is used to represent the control quantity state matrix,
[0233]
[0234]
[0235]
[0236]
[0237]
[0238] W e =[0 -k1 0 -(a1+c1)k1 0 0] T ,
[0239] The k1 is used to represent the cornering stiffness of the front wheel of the traction component in the first cornering stiffness information, the k2 is used to represent the cornering stiffness of the rear wheel of the traction component in the first cornering stiffness information, the k3 is used to represent the cornering stiffness of the rear wheel of the towed component in the second cornering stiffness information, the a1 is used to represent the distance between the center of mass of the traction component and the front axle in the first distance, the b1 is used to represent the distance between the center of mass of the traction component and the rear axle in the first distance, the c1 is used to represent the distance between the center of mass of the traction component and the hinge point in the first distance, the a2 is used to represent the distance between the center of mass of the towed component and the front axle in the second distance, the b2 is used to represent the distance between the center of mass of the towed component and the rear axle in the second distance, the m1 is used to represent the first mass information, the m2 is used to represent the second mass information, and the v x1 It is used to indicate the longitudinal speed of the traction component in the speed information at the current moment. z1 It is used to represent the first moment of inertia. z2 Used to represent the second moment of inertia mentioned above.
[0240] In an exemplary embodiment, the third calculation module includes: a first execution submodule, which is used to perform discrete operations on the error state quantity state matrix and the control quantity state matrix to obtain a target error state quantity matrix and a target control quantity state matrix; a second execution submodule, which is used to perform iterative operations on the target error state quantity matrix, the target control quantity state matrix and the driving error state quantity simultaneously based on the following formula until the cost function is minimized to obtain a state output feedback matrix: K = -(B d T PB d +R) -1 B d T PA d , where K is used to represent the state output feedback matrix, and B is used to represent the state output feedback matrix. d It is used to represent the state matrix of the target control quantity. d is used to represent the target error state quantity matrix, the above P is used to represent the iteration matrix, and the initial value of the above P is used to represent the weight matrix of the above driving error state quantity; the product between the above state output feedback matrix and the above driving error state quantity is calculated to obtain the above target front wheel steering angle.
[0241] According to another embodiment of the present application, a target vehicle is also provided, comprising the above-mentioned device for controlling vehicle driving.
[0242] An embodiment of the present application provides a computer program product, including a computer program, and when the computer program is executed by a processor, the steps in any one of the above method embodiments are implemented.
[0243] An embodiment of the present application further provides a computer-readable storage medium, in which a computer program is stored, wherein the computer program is configured to execute the steps of any of the above method embodiments when running.
[0244] In an exemplary embodiment, the computer-readable storage medium may include, but is not limited to, various media that can store computer programs, such as a USB flash drive, a read-only memory (ROM), a random access memory (RAM), a mobile hard disk, a magnetic disk or an optical disk.
[0245] An embodiment of the present application further provides an electronic device, including a memory and a processor, wherein a computer program is stored in the memory, and the processor is configured to run the computer program to execute the steps in any one of the above method embodiments.
[0246] In an exemplary embodiment, the electronic device may further include a transmission device and an input / output device, wherein the transmission device is connected to the processor, and the input / output device is connected to the processor.
[0247] For specific examples in this embodiment, reference may be made to the examples described in the above embodiments and exemplary implementation modes, and this embodiment will not be described in detail herein.
[0248] Obviously, those skilled in the art should understand that the above modules or steps of the present application can be implemented by a general computing device, they can be concentrated on a single computing device, or distributed on a network composed of multiple computing devices, they can be implemented by a program code executable by a computing device, so that they can be stored in a storage device and executed by the computing device, and in some cases, the steps shown or described can be executed in a different order from that herein, or they can be made into individual integrated circuit modules, or multiple modules or steps therein can be made into a single integrated circuit module for implementation. Thus, the present application is not limited to any specific combination of hardware and software.
[0249] The above are only preferred embodiments of the present application and are not intended to limit the present application. For those skilled in the art, the present application may have various modifications and variations. Any modification, equivalent replacement, improvement, etc. made within the principles of the present application shall be included in the protection scope of the present application.
Claims
1. A method for controlling vehicle travel, characterized in that: include: Acquire vehicle parameter information and first driving state information of a target vehicle at a current moment, and expected driving information in a future time period, wherein the target vehicle is composed of a traction component and a towed component connected by a connecting component, the first driving state information is used to describe a first driving state of the traction component at the current moment, and a second driving state of the towed component at the current moment, and the expected driving information is used to describe driving information of an expected driving trajectory of the target vehicle in the future time period; Calculating a driving error state quantity of the target vehicle between the current moment and a future moment using the first driving state information and the expected driving information, wherein the future moment is a moment in the future period; Based on the vehicle parameter information and the first driving state information, an error state quantity state matrix and a control quantity state matrix of the target vehicle are calculated, wherein the error state quantity state matrix is a matrix describing the driving error state quantity, and the control quantity state matrix is a matrix describing the control quantity for controlling the driving of the target vehicle; Calculating a target front wheel turning angle of the traction assembly by using the driving error state quantity, the error state quantity state matrix and the control quantity state matrix; The driving of the towed component at the future time is controlled based on the target front wheel turning angle, so as to control the driving of the target vehicle at the future time.
2. The method according to claim 1, characterized in that Obtaining vehicle parameter information and first driving state information of the target vehicle at the current moment, as well as expected driving information in a future period, including: Sending an acquisition instruction to a driving information component deployed in the target vehicle, and acquiring the vehicle parameter information, the first driving state information, and the expected driving information sent by the driving information component in response to the acquisition instruction; The vehicle parameter information includes: first mass information of the traction component and second mass information of the towed component, first moment of inertia of the traction component and second moment of inertia of the towed component, first distance between the traction component and the connecting component and second distance between the towed component and the connecting component, first lateral stiffness information of the traction component and second lateral stiffness information of the towed component; The first driving state information includes: the position of the target vehicle at the current moment, the heading angle of the traction component at the current moment, the heading angular velocity of the traction component at the current moment, the speed information of the traction component at the current moment, the acceleration of the traction component at the current moment, the articulation angle between the traction component and the towed component at the current moment, and the articulation angular velocity between the traction component and the towed component at the current moment; The expected driving information includes: an expected position set of the target vehicle in the future time period, an expected heading angle set of the traction component in the future time period, an expected heading angular velocity set of the traction component in the future time period, a speed information set of the traction component in the future time period, an expected acceleration set of the traction component in the future time period, an expected articulation angle set of the traction component and the towed component in the future time period, and an expected articulation angular velocity set of the traction component and the towed component in the future time period.
3. The method according to claim 2, characterized in that Calculating the driving error state quantity of the target vehicle between the current moment and the future moment using the first driving state information and the expected driving information includes: Calculating the distance between the expected position in the expected position set and the position of the target vehicle at the current moment, and obtaining the target expected position in the expected trajectory line that is closest to the position at the current moment, wherein the target expected position is a position in the expected position set; Based on the target expected position, determining a target expected heading angle, a target expected heading angular velocity, a target expected velocity, a target expected acceleration, a target expected articulation angle, and a target expected articulation angular velocity of the target vehicle at the future time from the expected driving information; Calculating the difference between the target expected articulation angular velocity and the articulation angular velocity at the current moment to obtain an articulation angle error change rate between the traction component and the towed component; Calculating the difference between the target expected articulation angle and the articulation angle at the current moment to obtain an articulation angle error between the traction component and the towed component; Calculating the difference between the target expected heading angular velocity and the heading angular velocity at the current moment to obtain the heading error change rate of the traction assembly; Calculating the difference between the target desired heading angle and the heading angle at the current moment to obtain the heading error of the traction assembly; Calculating a difference between a first product and a second product to obtain a lateral error change rate of the traction assembly, wherein the first product is a product of the target expected speed and the sine value of the target expected heading angle, and the second product is a product of the speed at the current moment and the sine value of the heading angle at the current moment; Calculate the difference between the third product and the fourth product to obtain the lateral error of the traction assembly, wherein the third product is the product of the difference between the first target expected position among the target expected positions and the first position among the positions at the current moment and the cosine value of the target expected heading angle, and the fourth product is the product of the difference between the second target expected position among the target expected positions and the second position among the positions at the current moment and the sine value of the target expected heading angle.
4. The method according to claim 2, characterized in that: Calculating the driving error state quantity of the target vehicle between the current moment and the future moment using the first driving state information and the expected driving information includes: Based on the lateral error of the traction component, the lateral error change rate of the traction component, the heading error of the traction component, the lateral error change rate of the traction component, the articulation angle error between the traction component and the towed component, and the articulation angle error change rate between the traction component and the towed component, the driving error state quantity of the target vehicle between the current moment and the future moment is calculated.
5. The method according to claim 2, characterized in that: Calculating an error state quantity state matrix and a control quantity state matrix of the target vehicle based on the vehicle parameter information and the first driving state information, including: The error state quantity state matrix and the control quantity state matrix are calculated based on the following formula: A=M e -1 P e , B=M e - 1 W e , wherein A is used to represent the error state quantity state matrix, B is used to represent the control quantity state matrix, P e =In e =[0 -k1 0 -(a1+c1)k1 0 0] T , The k1 is used to represent the cornering stiffness of the front wheel of the traction component in the first cornering stiffness information, the k2 is used to represent the cornering stiffness of the rear wheel of the traction component in the first cornering stiffness information, the k3 is used to represent the cornering stiffness of the rear wheel of the towed component in the second cornering stiffness information, the a1 is used to represent the distance between the center of mass of the traction component and the front axle in the first distance, the b1 is used to represent the distance between the center of mass of the traction component and the rear axle in the first distance, the c1 is used to represent the distance between the center of mass of the traction component and the hinge point in the first distance, the a2 is used to represent the distance between the center of mass of the towed component and the front axle in the second distance, the b2 is used to represent the distance between the center of mass of the towed component and the rear axle in the second distance, the m1 is used to represent the first mass information, the m2 is used to represent the second mass information, and the v x1 It is used to represent the longitudinal speed of the traction component in the speed information at the current moment, and the I z1 is used to represent the first moment of inertia, the I z2 Used to represent the second moment of inertia.
6. The method according to claim 1, characterized in that Calculating the target front wheel turning angle of the traction assembly by using the driving error state quantity, the error state quantity state matrix and the control quantity state matrix, including: Performing discrete operations on the error state quantity matrix and the control quantity state matrix to obtain a target error state quantity matrix and a target control quantity state matrix; Based on the following formula, the target error state quantity matrix, the target control quantity state matrix and the driving error state quantity are iterated at the same time until the cost function is minimized to obtain the state output feedback matrix: K = -(B d T PB d +R) - 1 B d T PA d , where K is used to represent the state output feedback matrix, and B d It is used to represent the target control state matrix, the A d is used to represent the target error state quantity matrix, the P is used to represent the iteration matrix, and the initial value of P is used to represent the weight matrix of the driving error state quantity; The product between the state output feedback matrix and the driving error state quantity is calculated to obtain the target front wheel steering angle.
7. A device for controlling vehicle travel, characterized in that: include: A first acquisition module is used to acquire vehicle parameter information and first driving state information of a target vehicle at a current moment, and expected driving information in a future time period, wherein the target vehicle is composed of a traction component and a towed component connected by a connection component, the first driving state information is used to describe a first driving state of the traction component at the current moment, and a second driving state of the towed component at the current moment, and the expected driving information is used to describe driving information of an expected driving trajectory of the target vehicle in the future time period; A first calculation module is used to calculate the driving error state quantity of the target vehicle between the current moment and a future moment by using the first driving state information and the expected driving information, wherein the future moment is a moment in the future period; A second calculation module is used to calculate the error state quantity state matrix and the control quantity state matrix of the target vehicle based on the vehicle parameter information and the first driving state information, wherein the error state quantity state matrix is a matrix describing the driving error state quantity, and the control quantity state matrix is a matrix describing the control quantity for controlling the driving of the target vehicle; A third calculation module, used to calculate the target front wheel turning angle of the traction assembly by using the driving error state quantity, the error state quantity state matrix and the control quantity state matrix; The first control module is used to control the driving of the towed component at the future time based on the target front wheel steering angle, so as to control the driving of the target vehicle at the future time.
8. A target vehicle, characterized in that: Includes the device for controlling vehicle travel as described in claim 7.
9. A computer-readable storage medium, characterized in that: The computer-readable storage medium stores a computer program, wherein the computer program implements the steps of the method described in any one of claims 1 to 6 when executed by a processor.
10. An electronic device comprising a memory, a processor, and a computer program stored in the memory and executable on the processor, characterized in that: When the processor executes the computer program, the steps of the method described in any one of claims 1 to 6 are implemented.
