Vehicle transverse control method, device and equipment and storage medium
The multi-level PID control algorithm calculates the desired lateral speed and acceleration of the vehicle and adjusts the steering wheel angle, which solves the problems of complexity and poor robustness of the vehicle lateral control algorithm in the prior art, and achieves high accuracy and real-time lane keeping.
Patent Information
- Application Number
- CN202411150265.X
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-21
- Publication Date
- 2024-11-08
AI Technical Summary
The existing vehicle lateral control technology has complex algorithms, high computing power requirements, poor accuracy and robustness, and cannot meet the performance requirements of advanced assisted driving functions for lane keeping, deviation warning and suppression.
By calculating the lateral offset distance difference between the current position of the target vehicle and the desired path, a multi-level PID control algorithm is used to calculate the expected lateral speed and acceleration, and then adjust the steering wheel angle to achieve accurate lateral control of the vehicle.
It improves the accuracy and robustness of vehicle lateral control, reduces algorithm complexity and calculation load, and enhances the real-time and accuracy of lane maintenance.
Smart Images

Figure CN118907226A_ABST
Abstract
Description
Technical Field
[0001] The present application relates to the field of vehicle control technology, and in particular to a vehicle lateral control method, device, equipment and storage medium. Background Art
[0002] In order to meet the logistics market's demand for transportation safety, timeliness, economy and comfort, commercial vehicles have put forward higher requirements for the performance of advanced driver assistance functions: lane keeping assist (LKA), lane departure warning (LDW), lane departure prevention (LDP), automatic emergency braking (AEB), and adaptive cruise control (ACC). The key function of LKA, LDW, and LDP is to control the vehicle laterally.
[0003] In the prior art, lateral control is generally achieved by constructing a vehicle dynamics model and tracking the vehicle's motion trajectory. However, the existing vehicle lateral control technology has the disadvantages of complex algorithms, high computing power requirements, and poor accuracy and robustness. Summary of the invention
[0004] The present application provides a vehicle lateral control method, device, equipment and storage medium to address the shortcomings of existing vehicle lateral control technology, such as complex algorithms, high computing power requirements, and poor accuracy and robustness.
[0005] In a first aspect, the present application provides a vehicle lateral control method, the method comprising:
[0006] Calculate a first difference between an actual lateral offset distance between a current position of a target vehicle and an expected path of the target vehicle and an expected lateral offset distance of the target vehicle;
[0007] calculating the expected lateral speed of the target vehicle according to the first difference;
[0008] Calculating an expected lateral acceleration of the target vehicle according to a second difference between the expected lateral velocity and the actual lateral velocity of the target vehicle;
[0009] Calculating a desired yaw rate of the target vehicle according to the desired lateral acceleration;
[0010] According to the expected yaw rate, an expected steering wheel angle of the target vehicle is calculated, and the steering wheel angle of the target vehicle is adjusted to the expected steering wheel angle.
[0011] In a possible design, calculating the expected steering wheel angle of the target vehicle according to the expected yaw angular velocity includes:
[0012] Calculating a steady-state yaw rate of the target vehicle according to a third difference between the desired yaw rate and an actual yaw rate of the target vehicle;
[0013] The desired steering wheel angle of the target vehicle is calculated according to the steady-state yaw rate.
[0014] In a possible design, calculating the expected yaw rate of the target vehicle according to the expected lateral acceleration includes:
[0015] According to the expected lateral acceleration, the first expected yaw rate of the target vehicle is calculated by the following formula:
[0016]
[0017] in, is the first desired yaw rate, a y_des is the desired lateral acceleration, V x is the current longitudinal speed value of the target vehicle;
[0018] A second expected yaw rate of the target vehicle is calculated according to a lateral position deviation between the preview point of the target vehicle and the expected path, and a current longitudinal speed value of the target vehicle.
[0019] In a possible design, calculating the steady-state yaw rate of the target vehicle according to a third difference between the desired yaw rate and the actual yaw rate of the target vehicle includes:
[0020] The steady-state yaw rate is calculated according to the following formula:
[0021]
[0022] in, is the steady-state yaw rate, is the first desired yaw rate, is the actual yaw rate, is the second desired yaw rate, k p is the proportionality coefficient, k I The integral coefficient, k D is the differential coefficient.
[0023] In a possible design, calculating the expected steering wheel angle of the target vehicle according to the steady-state yaw angular velocity includes:
[0024] According to the steady-state yaw rate, the expected front wheel turning angle of the target vehicle is calculated by the following formula:
[0025]
[0026] Wherein, δ is the desired front wheel turning angle, V x is the current longitudinal speed value of the target vehicle, L is the wheelbase of the target vehicle, K is the stability factor of the target vehicle, is the steady-state yaw angular velocity;
[0027] The expected steering wheel angle is calculated according to the expected front wheel angle.
[0028] In one possible design, calculating the second expected yaw rate of the target vehicle according to the lateral position deviation between the preview point of the target vehicle and the expected path, and the current longitudinal speed value of the target vehicle, includes:
[0029] In the longitudinal direction of the target vehicle, determining the spatial coordinates of the preview point according to the preview distance of the target vehicle;
[0030] Calculating a lateral position deviation between the preview point and the desired path according to the preview point spatial coordinates;
[0031] According to the lateral position deviation between the preview point and the expected path and the current longitudinal speed value of the target vehicle, the second expected yaw rate is calculated by the following formula:
[0032]
[0033] in, is the second desired yaw rate, Δy p is the lateral position deviation between the preview point and the desired path, V x is the current longitudinal speed of the target vehicle, d s is the preview distance.
[0034] In one possible design, the calculating of a first difference between an actual lateral offset distance between the current position of the target vehicle and the expected path of the target vehicle and an expected lateral offset distance of the target vehicle includes:
[0035] Calculating an actual lateral offset distance between the current position of the target vehicle and the center line of the lane of the road where the target vehicle is currently located;
[0036] The first difference between the actual lateral offset distance and the expected lateral offset distance is calculated.
[0037] In a second aspect, the present application provides a vehicle lateral control device, the device comprising:
[0038] An expected lateral speed calculation module is used to calculate a first difference between an actual lateral offset distance between a current position of a target vehicle and an expected path of the target vehicle and an expected lateral offset distance of the target vehicle;
[0039] calculating the expected lateral speed of the target vehicle according to the first difference;
[0040] An expected lateral acceleration calculation module, used to calculate an expected lateral acceleration of the target vehicle according to a second difference between the expected lateral velocity and the actual lateral velocity of the target vehicle;
[0041] An expected steering wheel angle calculation module is used to calculate an expected yaw rate of the target vehicle according to the expected lateral acceleration.
[0042] Calculating a desired steering wheel angle of the target vehicle according to the desired yaw angular velocity;
[0043] A control module is used to adjust the steering wheel angle of the target vehicle to the desired steering wheel angle.
[0044] In a third aspect, the present application provides a vehicle lateral control device, comprising: a processor, and a memory communicatively connected to the processor;
[0045] The memory stores computer-executable instructions;
[0046] The processor executes the computer-executable instructions stored in the memory to implement the method according to the first aspect.
[0047] In a fourth aspect, the present application provides a computer-readable storage medium, wherein the computer-readable storage medium stores computer-executable instructions, and when the computer-executable instructions are executed by a processor, they are used to implement the method described in the first aspect.
[0048] The vehicle lateral control method, device, equipment and storage medium provided by the present application achieve the following technical effects:
[0049] In the present application, the expected lateral speed is calculated through the PID algorithm according to the first difference between the actual lateral offset distance and the expected lateral offset distance of the target vehicle. According to the second difference between the expected lateral speed and the actual lateral speed of the target vehicle, PID control is used in multi-level calculations. Compared with the prior art in which PID control is only used in single-level calculations, the present application has the advantages of robustness and high accuracy. At the same time, the algorithm complexity of the present application is low and the real-time calculation is high. BRIEF DESCRIPTION OF THE DRAWINGS
[0050] In order to more clearly illustrate the embodiments of the present invention or the technical solutions in the prior art, the following briefly introduces the drawings required for use in the embodiments or the description of the prior art. Obviously, the drawings described below are some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying creative work.
[0051] Figure 1 The vehicle lateral control method provided in the embodiment of the present application is shown in the following figure. Figure 1 ;
[0052] Figure 2 Schematic diagram of the vehicle lateral control method provided in the embodiment of the present application Figure 2 ;
[0053] Figure 3 is a schematic diagram of calculating a second desired yaw angular velocity provided in an embodiment of the present application;
[0054] Figure 4 A flow chart of vehicle lateral control calculation provided in an embodiment of the present application;
[0055] Figure 5 A schematic diagram of the structure of a vehicle lateral control device provided in an embodiment of the present application;
[0056] Figure 6 A schematic diagram of the structure of a vehicle lateral control device provided in an embodiment of the present application. DETAILED DESCRIPTION
[0057] Exemplary embodiments will be described in detail herein, examples of which are shown in the accompanying drawings. When the following description refers to the drawings, unless otherwise indicated, the same numbers in different drawings represent the same or similar elements. The implementation methods described in the following exemplary embodiments do not represent all implementation methods consistent with the present application. On the contrary, they are merely examples of devices and methods consistent with some aspects of the present application as detailed in the attached claims, rather than all embodiments. Based on the embodiments in the present invention, all other embodiments obtained by ordinary technicians in this field without making creative work are within the scope of protection of the present invention.
[0058] First, the relevant concepts or nouns involved in this application are explained:
[0059] Yaw Rate: The angular velocity of a vehicle about its vertical axis. It describes the rotational motion of the vehicle in a plane and is usually expressed in degrees per second (such as degrees / second or radians / second). Yaw rate is a very important parameter in vehicle dynamics and control systems because it directly affects the stability and handling of the vehicle.
[0060] Preview time: Preview time refers to the length of time that the system considers future path information in advance in a path tracking or driver assistance system. The longer the preview time, the earlier the system can make adjustments, thereby improving the accuracy and stability of path tracking.
[0061] Preview point: In path tracking or driver assistance systems, a preview point is a specific point on the path that the system considers in advance. Through the preview point, the system can predict the future path and make corresponding control adjustments.
[0062] Preview distance: Preview distance refers to the length of the path that the system considers in advance in path tracking or driver assistance systems. The longer the preview distance, the earlier the system can make adjustments, thereby improving the accuracy and stability of path tracking.
[0063] The lane keeping function of a vehicle needs to face complex and changeable traffic conditions, so it places high demands on the speed of the lane keeping algorithm calculation. The lane keeping algorithm must be able to complete the calculation of lane keeping related data in the shortest possible time to return the vehicle to the correct driving path in a timely manner. In addition to being fast, the lane keeping algorithm is also required to have high accuracy and robustness. However, the existing vehicle lateral control technology has the disadvantages of complex algorithms, high computing power requirements, and poor accuracy and robustness. Especially in actual vehicle driving, it may face insufficient computing power. If the lane keeping algorithm is too complex, it may not be able to calculate the relevant parameters required for lane keeping in a timely manner. Therefore, in view of the problems of the prior art, the technical concept of the present application is: according to the difference between the actual lateral offset distance between the current position of the target vehicle and the expected path and the expected lateral offset distance, the expected lateral speed of the target vehicle is calculated by the PID control algorithm; according to the difference between the expected lateral speed and the actual lateral speed of the target vehicle, the expected lateral acceleration of the target vehicle is calculated by the PID control algorithm; according to the expected lateral acceleration, the expected yaw angular velocity of the target vehicle is calculated, according to the expected yaw angular velocity, the expected steering wheel angle is calculated, and the steering wheel angle of the target vehicle is adjusted to the expected steering wheel angle. That is, through multi-level PID control, the relevant parameters of lane keeping are calculated quickly and accurately.
[0064] The technical solution of the present application and how the technical solution of the present application solves the above-mentioned technical problems are described in detail below with specific embodiments. The following specific embodiments can be combined with each other, and the same or similar concepts or processes may not be repeated in some embodiments. The embodiments of the present application will be described below in conjunction with the accompanying drawings.
[0065] Embodiment 1
[0066] This embodiment provides a vehicle lateral control method, which can be applied to a lane keeping system of a vehicle. Figure 1 Schematic diagram of the vehicle lateral control method provided in the embodiment of the present application Figure 1 .
[0067] like Figure 1 As shown, the method includes:
[0068] S101, calculating a first difference between an actual lateral offset distance between a current position of a target vehicle and an expected path of the target vehicle and an expected lateral offset distance of the target vehicle;
[0069] The expected path can be the center line of the lane where the target vehicle is currently located, or a driving path determined by the lane keeping system. In this embodiment, when the target vehicle coordinate system is established with the longitudinal direction of the target vehicle as the x-axis and the lateral direction as the y-axis, the relevant parameters of the lane center line are obtained through the sensors on the target vehicle. The lane center line equation can be in the following form:
[0070]
[0071] in:
[0072] c 0 : At x=0, the lateral offset distance between the target vehicle and the center line of the lane;
[0073] tan -1 (c 1 ): At x=0, the direction angle θ of the lane centerline;
[0074] k r : Curvature of lane centerline;
[0075] The rate of change of curvature of the lane centerline.
[0076] In a scenario where lane keeping is required, the actual lateral offset distance between the current position of the target vehicle and the expected path of the target vehicle exceeds the preset expected lateral offset distance, so a first difference between the actual lateral offset distance and the expected lateral offset distance is calculated for subsequent lane keeping calculations.
[0077] S102, calculating the expected lateral speed of the target vehicle according to the first difference;
[0078] Specifically, in this step, the expected lateral speed is calculated according to the first difference through the PID control algorithm, and the expected lateral speed is the adjustment amount of the lateral offset distance between the target vehicle and the expected path, that is, when the target vehicle reaches the expected lateral speed, the actual lateral offset distance between the target vehicle and the expected path can be maintained at the expected lateral offset distance.
[0079] S103, calculating an expected lateral acceleration of the target vehicle according to a second difference between the expected lateral velocity and the actual lateral velocity of the target vehicle;
[0080] Since the actual lateral speed of the target vehicle is still not easy to maintain at the expected lateral speed, in this step, it is necessary to calculate the adjustment amount of the lateral speed, that is, the expected lateral acceleration, through the PID algorithm. It can be seen that this embodiment uses two layers of PID control, that is, the actual lateral offset distance and the expected lateral offset distance are output through PID control to obtain the expected lateral speed of the lateral offset distance adjustment amount, and then the expected lateral speed and the actual lateral speed of the target vehicle are controlled by PID to output the lateral speed adjustment amount of the expected lateral acceleration. Through two layers of PID control, the accuracy of the algorithm in lane keeping can be greatly improved, and by calculating the optimal expected lateral acceleration, the target vehicle can be well maintained on the expected path. At the same time, the PID control algorithm is simple to calculate, has low computing power requirements, and is also highly robust.
[0081] S104, calculating the expected yaw rate of the target vehicle according to the expected lateral acceleration;
[0082] In this step, the expected yaw rate may be calculated according to the expected lateral acceleration and the actual vehicle speed of the target vehicle.
[0083] S105. Calculate an expected steering wheel angle of the target vehicle according to the expected yaw angular velocity, and adjust the steering wheel angle of the target vehicle to the expected steering wheel angle.
[0084] The expected yaw rate is a parameter related to vehicle steering. Based on this parameter, the expected front wheel angle can be calculated through relevant parameters of the target vehicle, such as the actual vehicle speed and wheelbase of the target vehicle. Since the expected steering wheel angle usually has a proportional relationship with the steering wheel angle, the expected steering wheel angle can be calculated through the proportional relationship, and the steering mechanism of the target vehicle can be controlled to adjust the steering wheel angle of the target vehicle to the expected steering wheel angle.
[0085] The method provided in this embodiment achieves the following technical effects:
[0086] According to the actual lateral offset distance, the first difference between the expected lateral offset distance of the target vehicle is used to calculate the expected lateral speed through the PID algorithm. According to the second difference between the expected lateral speed and the actual lateral speed of the target vehicle, PID control is used in multi-level calculations. Compared with the prior art in which PID control is only used in single-level calculations, this method has the advantages of robustness and high accuracy. At the same time, the algorithm of the present application has low complexity and high real-time calculation performance.
[0087] The vehicle lateral control method of the present application is described in detail using a specific embodiment below.
[0088] Embodiment 2
[0089] Figure 2 Schematic diagram of the vehicle lateral control method provided in the embodiment of the present application Figure 2 .like Figure 2 As shown, the method includes:
[0090] S201, calculating a first difference between an actual lateral offset distance between a current position of a target vehicle and an expected path of the target vehicle and an expected lateral offset distance of the target vehicle;
[0091] This step can refer to the first embodiment of the present application, and will not be described in detail here. In this embodiment, the expected path is the center line of the lane where the target vehicle is currently located.
[0092] S202, calculating the expected lateral speed of the target vehicle according to the first difference;
[0093] Specifically, the desired lateral speed is calculated by the PID control algorithm:
[0094]
[0095] Among them, v y_des is the desired lateral velocity, c des is the expected lateral offset distance, c 0 is the actual lateral offset distance, k p , k I , k D are proportional coefficient, integral coefficient, and differential coefficient respectively. des The specific value can be set according to actual needs, for example, 0m or 0.1m.
[0096] S203, calculating an expected lateral acceleration of the target vehicle according to a second difference between the expected lateral velocity and the actual lateral velocity of the target vehicle;
[0097]
[0098] Among them, a y_des is the expected lateral acceleration, v y_des is the desired lateral velocity, v y_real is the actual lateral acceleration, k p , k I , k D They are proportional coefficient, integral coefficient and differential coefficient respectively.
[0099] S204, calculating a first expected yaw rate of the target vehicle according to the expected lateral acceleration and the current longitudinal speed value of the target vehicle;
[0100]
[0101] in, is the first desired yaw rate, a y_des is the expected lateral acceleration, V x is the current longitudinal speed value of the target vehicle. In this step, the first expected yaw rate is calculated by the kinematic model, which has low computational complexity and certain accuracy, and can meet the high real-time requirements of vehicle driving.
[0102] S205, calculating a second expected yaw rate of the target vehicle according to a lateral position deviation between the target vehicle preview point and the expected path, and a current longitudinal speed value of the target vehicle;
[0103] Specifically, the second desired yaw rate is calculated by the following steps:
[0104] In the longitudinal direction of the target vehicle, the spatial coordinates of the preview point are determined according to the preview distance of the target vehicle;
[0105] According to the spatial coordinates of the preview point, the lateral position deviation between the preview point and the expected path is calculated;
[0106] According to the lateral position deviation between the preview point and the expected path and the current longitudinal speed of the target vehicle, the second expected yaw rate is calculated by the following formula:
[0107]
[0108] in, is the second desired yaw rate, Δy p is the lateral position deviation between the preview point and the expected path, V x is the current longitudinal speed of the target vehicle, d s The preview distance.
[0109] Figure 3 is a schematic diagram of calculating the second desired yaw rate provided in an embodiment of the present application, such as Figure 3 As shown, in the positive direction of the x-axis of the target vehicle's ego coordinate system, that is, the driving direction of the target vehicle, a preview point is determined at a preview distance from the origin of the target vehicle's ego coordinate system, and then the lateral position deviation between the preview point and the lane centerline is determined. The preview distance can be determined by multiplying the preset preview time with the current longitudinal speed value of the target vehicle.
[0110] S206, calculating a steady-state yaw rate of the target vehicle according to a third difference between the desired yaw rate and the actual yaw rate of the target vehicle;
[0111] The steady-state yaw rate is calculated according to the following formula:
[0112]
[0113] in, is the steady-state yaw rate, is the first desired yaw rate, is the actual yaw angular velocity, is the second desired yaw rate, k p is the proportionality coefficient, k I The integral coefficient, k D is the differential coefficient.
[0114] It should be noted that steps S201 to S204 calculate the first yaw rate based on the lateral offset distance between the target vehicle and the lane centerline at the current moment, and it takes a certain amount of time to adjust the target vehicle to the vicinity of the lane centerline, during which the target vehicle is constantly moving. The preview algorithm simulates the control method of human drivers turning the steering wheel in advance when facing a turn. Therefore, it is not only necessary to consider the current state of the target vehicle, but also the lateral position deviation between the target vehicle and the lane centerline at the preview point, and comprehensively consider the deviation of the target vehicle from the expected path at present and in the future.
[0115] The first expected yaw rate reflects the yaw rate required by the target vehicle according to the current state of the target vehicle. In this step, a third difference between the first expected yaw rate of the target vehicle at the current moment and the actual yaw rate of the target vehicle at the current moment is calculated, and an adjustment amount is output according to the third difference through the PID control algorithm. The adjustment amount reflects the yaw rate adjustment amount required for the current state of the target vehicle. On this basis, the second expected yaw rate reflecting the future state of the target vehicle is added, so as to achieve the purpose of comprehensively considering the current and future states of the target vehicle, and improve the accuracy of the lateral control of the target vehicle.
[0116] S207: Calculate a desired steering wheel angle of the target vehicle according to the steady-state yaw angular velocity, and adjust the steering wheel angle of the target vehicle to the desired steering wheel angle.
[0117] In this step, the expected front wheel turning angle of the target vehicle can be calculated according to the steady-state yaw rate using the following formula:
[0118]
[0119] Among them, V x is the current longitudinal speed of the target vehicle, L is the wheelbase of the target vehicle, K is the stability factor of the target vehicle, and δ is the expected front wheel turning angle;
[0120] Through the steady-state yaw rate, the current longitudinal speed value of the target vehicle and the relevant parameters of the target vehicle, a reliable expected front wheel steering angle can be output.
[0121] According to the expected front wheel angle, the expected steering wheel angle is calculated, which can be specifically:
[0122] δ steer_wheel = kδ
[0123] Among them, δ steer_wheel is the desired steering wheel angle, and k is the conversion ratio coefficient between the target vehicle steering wheel angle and the front wheel angle.
[0124] Figure 4 The vehicle lateral control calculation flow chart provided in the embodiment of the present application is as follows: Figure 4 As shown, the first difference between the expected lateral offset distance and the actual lateral offset distance is used to output the expected lateral velocity through the first-layer PID controller, and the second difference between the expected lateral velocity and the actual lateral velocity is used to output the expected lateral acceleration through the second-layer PID controller. The yaw rate estimator 1 calculates the first expected yaw rate according to the expected lateral acceleration. Since the current actual yaw rate of the target vehicle is still different from the first expected yaw rate, it is necessary to calculate the yaw rate adjustment amount. Therefore, the third difference between the first expected yaw rate and the actual yaw rate is used to output the adjustment amount through the third-layer PID controller. The sum of the adjustment amount and the second expected yaw rate output by the yaw rate estimator 2 is the steady-state yaw rate, and the yaw rate estimator 2 calculates the second expected yaw rate through the aforementioned preview algorithm.
[0125] The desired steering wheel angle is calculated by the steady-state yaw angular velocity, and the desired steering wheel angle signal is filtered through a low-pass filter to reach the steering mechanism of the target vehicle, and the steering wheel angle of the target vehicle is adjusted to the desired steering wheel angle. The embodiment of the present application calculates the desired steering wheel angle through three-level PID control. Compared with the single-level PID control in the prior art, the lateral offset distance between the target vehicle and the desired path can be maintained at the desired lateral offset distance more accurately.
[0126] The embodiment of the present invention can divide the electronic device or the main control device into functional modules according to the above method example. For example, each functional module can be divided according to each function, or two or more functions can be integrated into one processing unit. The above integrated unit can be implemented in the form of hardware or in the form of software functional modules. It should be noted that the division of modules in the embodiment of the present invention is schematic and is only a logical function division. There may be other division methods in actual implementation.
[0127] Figure 5 This is a schematic diagram of the structure of the vehicle lateral control device provided in the embodiment of the present application. Figure 5 As shown, the device 50 comprises:
[0128] The expected lateral speed calculation module 501 is used to calculate a first difference between an actual lateral offset distance between a current position of the target vehicle and an expected path of the target vehicle and an expected lateral offset distance of the target vehicle;
[0129] Calculating a desired lateral velocity of the target vehicle based on the first difference;
[0130] The expected lateral acceleration calculation module 502 is used to calculate the expected lateral acceleration of the target vehicle according to the second difference between the expected lateral velocity and the actual lateral velocity of the target vehicle;
[0131] Expected steering wheel angle calculation module 503: Calculates the expected yaw rate of the target vehicle according to the expected lateral acceleration;
[0132] Calculate the desired steering wheel angle of the target vehicle according to the desired yaw rate;
[0133] The control module 504 is configured to adjust the steering wheel angle of the target vehicle to a desired steering wheel angle.
[0134] The vehicle lateral control device provided in this embodiment can execute the vehicle lateral control method of the above embodiment, and its implementation principle and technical effect are similar, which will not be described in detail in this embodiment.
[0135] In the specific implementation of the aforementioned vehicle lateral control device, each module may be implemented as a processor, and the processor may execute computer-executable instructions stored in the memory, so that the processor executes the aforementioned vehicle lateral control method.
[0136] Figure 6 This is a schematic diagram of the structure of the vehicle lateral control device provided in the embodiment of the present application. Figure 6 As shown, the electronic device 60 includes: at least one processor 601 and a memory 602. The electronic device 60 also includes a communication component 603. The processor 601, the memory 602 and the communication component 603 are connected via a bus 604.
[0137] In a specific implementation process, at least one processor 601 executes the computer-executable instructions stored in the memory 602, so that at least one processor 601 executes the vehicle lateral control method executed by the electronic device side as above.
[0138] The specific implementation process of the processor 601 can be found in the above method embodiment, and its implementation principle and technical effect are similar, so this embodiment will not be repeated here.
[0139] In the above embodiments, it should be understood that the processor may be a central processing unit (CPU), or other general-purpose processors, digital signal processors (DSP), application-specific integrated circuits (ASIC), etc. A general-purpose processor may be a microprocessor or any conventional processor. The steps of the method disclosed in the invention may be directly implemented as being executed by a hardware processor, or may be executed by a combination of hardware and software modules in the processor.
[0140] The memory may include a high-speed RAM memory, and may also include a non-volatile storage NVM, such as at least one disk storage.
[0141] The bus may be an Industry Standard Architecture (ISA) bus, a Peripheral Component Interconnect (PCI) bus, or an Extended Industry Standard Architecture (EISA) bus, etc. The bus may be divided into an address bus, a data bus, a control bus, etc. For ease of representation, the bus in the drawings of the present application is not limited to only one bus or one type of bus.
[0142] The above-mentioned functions implemented by the electronic device and the main control device introduce the scheme provided by the embodiment of the present invention. It can be understood that in order to implement the above-mentioned functions, the electronic device or the main control device includes a hardware structure and / or software module corresponding to the execution of each function. In combination with the units and algorithm steps of each example described in the embodiment disclosed in the embodiment of the present invention, the embodiment of the present invention can be implemented in the form of hardware or a combination of hardware and computer software. Whether a function is executed in the form of hardware or computer software driving hardware depends on the specific application and design constraints of the technical solution. Those skilled in the art can use different methods to implement the described functions for each specific application, but such implementation should not be considered to exceed the scope of the technical solution of the embodiment of the present invention.
[0143] The present application also provides a computer-readable storage medium, in which computer-executable instructions are stored. When a processor executes the computer-executable instructions, the above vehicle lateral control method is implemented.
[0144] The computer-readable storage medium mentioned above can be implemented by any type of volatile or non-volatile storage device or a combination thereof, such as static random access memory (SRAM), electrically erasable programmable read-only memory (EEPROM), erasable programmable read-only memory (EPROM), programmable read-only memory (PROM), read-only memory (ROM), magnetic memory, flash memory, magnetic disk or optical disk. The readable storage medium can be any available medium that can be accessed by a general or special-purpose computer.
[0145] An exemplary readable storage medium is coupled to a processor so that the processor can read information from the readable storage medium and write information to the readable storage medium. Of course, the readable storage medium can also be a component of the processor. The processor and the readable storage medium can be located in an application specific integrated circuit (Application Specific Integrated Circuits, referred to as: ASIC). Of course, the processor and the readable storage medium can also exist as discrete components in an electronic device or a main control device.
[0146] The present application also provides a computer program product, which includes: a computer program, which is stored in a readable storage medium. At least one processor of an electronic device can read the computer program from the readable storage medium, and at least one processor executes the computer program so that the electronic device executes the solution provided by any of the above embodiments.
[0147] Those skilled in the art can understand that all or part of the steps of implementing the above-mentioned method embodiments can be completed by hardware related to program instructions. The aforementioned program can be stored in a computer-readable storage medium. When the program is executed, the steps of the above-mentioned method embodiments are executed; and the aforementioned storage medium includes: ROM, RAM, disk or optical disk and other media that can store program codes.
[0148] Finally, it should be noted that the above embodiments are only used to illustrate the technical solutions of the present invention, rather than to limit it. Although the present invention has been described in detail with reference to the aforementioned embodiments, those skilled in the art should understand that they can still modify the technical solutions described in the aforementioned embodiments, or replace some or all of the technical features therein with equivalents. However, these modifications or replacements do not cause the essence of the corresponding technical solutions to deviate from the scope of the technical solutions of the embodiments of the present invention.
Claims
1. A vehicle lateral control method, characterized in that: The method comprises: Calculate a first difference between an actual lateral offset distance between a current position of a target vehicle and an expected path of the target vehicle and an expected lateral offset distance of the target vehicle; Calculating the expected lateral speed of the target vehicle according to the first difference; Calculating an expected lateral acceleration of the target vehicle according to a second difference between the expected lateral velocity and the actual lateral velocity of the target vehicle; Calculating a desired yaw rate of the target vehicle according to the desired lateral acceleration; According to the expected yaw rate, an expected steering wheel angle of the target vehicle is calculated, and the steering wheel angle of the target vehicle is adjusted to the expected steering wheel angle.
2. The method according to claim 1, characterized in that: The step of calculating the expected steering wheel angle of the target vehicle according to the expected yaw angular velocity comprises: Calculating a steady-state yaw rate of the target vehicle according to a third difference between the desired yaw rate and an actual yaw rate of the target vehicle; The desired steering wheel angle of the target vehicle is calculated according to the steady-state yaw rate.
3. The method according to claim 2, characterized in that Calculating the expected yaw rate of the target vehicle according to the expected lateral acceleration includes: According to the expected lateral acceleration, the first expected yaw rate of the target vehicle is calculated by the following formula: in, is the first desired yaw rate, a y_des is the desired lateral acceleration, V x is the current longitudinal speed value of the target vehicle; A second expected yaw rate of the target vehicle is calculated according to a lateral position deviation between the preview point of the target vehicle and the expected path, and a current longitudinal speed value of the target vehicle.
4. The method according to claim 3, characterized in that The calculating the steady-state yaw rate of the target vehicle according to a third difference between the desired yaw rate and the actual yaw rate of the target vehicle comprises: The steady-state yaw rate is calculated according to the following formula: in, is the steady-state yaw rate, is the first desired yaw rate, is the actual yaw rate, is the second desired yaw rate, k p is the proportionality coefficient, k I The integral coefficient, k D is the differential coefficient.
5. The method according to claim 2, characterized in that: The step of calculating the expected steering wheel angle of the target vehicle according to the steady-state yaw angular velocity comprises: According to the steady-state yaw rate, the expected front wheel turning angle of the target vehicle is calculated by the following formula: Wherein, δ is the desired front wheel turning angle, V x is the current longitudinal speed value of the target vehicle, L is the wheelbase of the target vehicle, K is the stability factor of the target vehicle, is the steady-state yaw angular velocity; The expected steering wheel angle is calculated according to the expected front wheel angle.
6. The method according to claim 3, characterized in that: The step of calculating a second expected yaw rate of the target vehicle according to a lateral position deviation between the preview point of the target vehicle and the expected path and a current longitudinal speed value of the target vehicle comprises: In the longitudinal direction of the target vehicle, determining the spatial coordinates of the preview point according to the preview distance of the target vehicle; Calculating a lateral position deviation between the preview point and the desired path according to the preview point spatial coordinates; According to the lateral position deviation between the preview point and the expected path and the current longitudinal speed value of the target vehicle, the second expected yaw rate is calculated by the following formula: in, is the second desired yaw rate, Δy p is the lateral position deviation between the preview point and the desired path, V x is the current longitudinal speed of the target vehicle, d s is the preview distance.
7. The method according to any one of claims 1 to 6, characterized in that: The calculating of a first difference between an actual lateral offset distance between the current position of the target vehicle and the expected path of the target vehicle and an expected lateral offset distance of the target vehicle comprises: Calculating an actual lateral offset distance between the current position of the target vehicle and the center line of the lane of the road where the target vehicle is currently located; The first difference between the actual lateral offset distance and the expected lateral offset distance is calculated.
8. A vehicle lateral control device, characterized in that: The device comprises: An expected lateral speed calculation module is used to calculate a first difference between an actual lateral offset distance between a current position of a target vehicle and an expected path of the target vehicle and an expected lateral offset distance of the target vehicle; Calculating the expected lateral speed of the target vehicle according to the first difference; An expected lateral acceleration calculation module, used to calculate an expected lateral acceleration of the target vehicle according to a second difference between the expected lateral velocity and the actual lateral velocity of the target vehicle; An expected steering wheel angle calculation module is used to calculate an expected yaw rate of the target vehicle according to the expected lateral acceleration. Calculating a desired steering wheel angle of the target vehicle according to the desired yaw angular velocity; A control module is used to adjust the steering wheel angle of the target vehicle to the desired steering wheel angle.
9. A vehicle lateral control device, characterized in that: include: A processor, and a memory communicatively connected to the processor; The memory stores computer-executable instructions; The processor executes the computer-executable instructions stored in the memory to implement the method according to any one of claims 1 to 7.
10. A computer-readable storage medium, characterized in that: The computer-readable storage medium stores computer-executable instructions, which are used to implement the method according to any one of claims 1 to 7 when executed by a processor.
Citation Information
Cited By
Feedback control system and steering gear box for final steering control of an autonomous vehicle
US12485958B2
Feedback control system and steering gear box for final steering control of an autonomous vehicle
US20250091640A1
