WO2022160196A1 - Vehicle driving control method and apparatus, and vehicle and storage medium - Google Patents
Vehicle driving control method and apparatus, and vehicle and storage medium Download PDFInfo
- Publication number
- WO2022160196A1 WO2022160196A1 PCT/CN2021/074201 CN2021074201W WO2022160196A1 WO 2022160196 A1 WO2022160196 A1 WO 2022160196A1 CN 2021074201 W CN2021074201 W CN 2021074201W WO 2022160196 A1 WO2022160196 A1 WO 2022160196A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- correction coefficient
- vehicle
- preview distance
- path
- preview
- Prior art date
Links
- 238000000034 method Methods 0.000 title claims abstract description 52
- 238000012937 correction Methods 0.000 claims abstract description 206
- 238000004364 calculation method Methods 0.000 claims abstract description 29
- 238000004422 calculation algorithm Methods 0.000 claims abstract description 28
- 230000015654 memory Effects 0.000 claims description 37
- 238000004590 computer program Methods 0.000 claims description 14
- 238000005457 optimization Methods 0.000 claims description 11
- 238000010586 diagram Methods 0.000 description 35
- 238000004088 simulation Methods 0.000 description 29
- 230000006870 function Effects 0.000 description 22
- 238000012795 verification Methods 0.000 description 12
- 230000000694 effects Effects 0.000 description 9
- 230000008859 change Effects 0.000 description 8
- 230000001360 synchronised effect Effects 0.000 description 8
- 238000005516 engineering process Methods 0.000 description 5
- 238000002474 experimental method Methods 0.000 description 5
- 230000000087 stabilizing effect Effects 0.000 description 5
- 230000001965 increasing effect Effects 0.000 description 4
- 230000005291 magnetic effect Effects 0.000 description 4
- 238000005259 measurement Methods 0.000 description 4
- 230000008569 process Effects 0.000 description 4
- 238000012545 processing Methods 0.000 description 4
- 230000003068 static effect Effects 0.000 description 4
- 241001417527 Pempheridae Species 0.000 description 2
- 230000001133 acceleration Effects 0.000 description 2
- 238000004891 communication Methods 0.000 description 2
- 230000002708 enhancing effect Effects 0.000 description 2
- 238000000691 measurement method Methods 0.000 description 2
- 230000004044 response Effects 0.000 description 2
- 101100070541 Podospora anserina (strain S / ATCC MYA-4624 / DSM 980 / FGSC 10383) het-S gene Proteins 0.000 description 1
- 238000000429 assembly Methods 0.000 description 1
- 230000000712 assembly Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000005294 ferromagnetic effect Effects 0.000 description 1
- 230000004927 fusion Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
- B60W30/18—Propelling the vehicle
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/10—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to vehicle motion
Definitions
- the present application relates to the technical field of vehicles, and in particular, to a vehicle driving control method, a vehicle driving control device, a vehicle, and a computer-readable storage medium.
- Valet parking may be the first driverless function to be applied to mass-produced passenger cars. Valet parking is mainly to search for parking spaces autonomously in the parking lot and park the car. into the parking space.
- the stability of the traditional valet parking function during use is poor (for example, stable).
- the traditional valet parking function provides the path following algorithm with The calculation parameters (such as the preview distance) do not consider the detailed driving scene and cannot be adjusted according to the detailed driving scene, resulting in that the accuracy of the path following algorithm in the traditional valet parking function is not enough. Therefore, the traditional valet parking The path following algorithm in the car function has yet to be optimized.
- the technical problem to be solved by the present application is to provide a vehicle driving control method, a vehicle driving control device, a vehicle and a computer-readable storage medium in view of the above-mentioned defects of the prior art, so as to realize the optimization of the path following algorithm according to the details of the driving scene.
- Calculate the parameters so as to achieve the purpose of optimizing the path following algorithm in the valet parking function, improve the control accuracy of low-speed unmanned driving to ensure the safety of the vehicle and the reliability of the function, and then improve the user experience.
- the present application provides a vehicle driving control method, including: performing path planning to obtain a tracking path; obtaining a basic preview distance according to the current position information of the vehicle and the tracking path; obtaining a correction coefficient for the basic preview distance, where the correction coefficient includes a speed correction coefficient , at least one of path curvature correction coefficient and heading angle correction coefficient; obtain the target preview distance according to the correction coefficient and the basic preview distance; perform lateral driving control according to the target preview distance.
- the steps include: obtaining a tracking position point corresponding to the current position information of the vehicle on the tracking path; obtaining a lateral position according to the current position information of the vehicle and the tracking position point.
- Deviation value obtain the basic preview distance corresponding to the lateral position deviation value from the preview distance correspondence information, wherein the preview distance correspondence information includes the correspondence between at least one lateral position deviation value and the basic preview distance.
- the step of obtaining the correction coefficient for the basic preview distance includes: obtaining the current vehicle speed, and obtaining the speed correction coefficient corresponding to the current vehicle speed from the speed correction coefficient correspondence information, wherein the speed correction coefficient correspondence information indicates that The corresponding relationship between the vehicle speed and the speed correction coefficient;
- the step of obtaining the target preview distance according to the correction coefficient and the basic preview distance includes: obtaining the first target preview distance according to the speed correction coefficient and the basic preview distance, wherein the speed correction coefficient It is proportional to the basic preview distance.
- the steps include: determining an initial preview point on the tracking path according to the basic preview distance; obtaining a heading deviation according to the heading of the vehicle and the heading corresponding to the initial preview point. angle; obtain the heading angle correction coefficient corresponding to the heading deviation angle and the lateral position deviation value from the heading angle correction coefficient correspondence information, wherein the heading angle correction coefficient correspondence information indicates the lateral position deviation value, heading deviation angle and heading angle correction
- the corresponding relationship between the coefficients; the step of obtaining the target preview distance according to the correction coefficient and the basic preview distance includes: obtaining the first target preview distance according to the heading angle correction coefficient and the basic preview distance, wherein the heading angle correction coefficient and the basic preview distance are obtained.
- the preview distance is proportional.
- the steps include: acquiring the mean path curvature of the tracking path; acquiring the curvature correction coefficient corresponding to the mean path curvature and the lateral position deviation value from the curvature correction coefficient correspondence information.
- the corresponding relationship information of the curvature correction coefficient indicates the corresponding relationship between the lateral position deviation value, the mean value of the path curvature and the curvature correction coefficient;
- the step of obtaining the target preview distance according to the correction coefficient and the basic preview distance includes: according to the path curvature correction coefficient and The basic preview distance obtains the first target preview distance, wherein the path curvature correction coefficient is proportional to the basic preview distance.
- the steps include: determining an initial preview point on the tracking path according to the basic preview distance; The mean path curvature between the point and the initial preview point.
- the step of obtaining the target preview distance according to the correction coefficient and the basic preview distance includes: obtaining the target preview distance according to the first target preview distance and the optimization correction coefficient, wherein the first target preview distance and the optimized target preview distance are obtained.
- the correction coefficient is in a proportional relationship; wherein, the optimized correction coefficient is a correction coefficient other than the correction coefficient corresponding to the first target preview distance.
- the step of performing lateral driving control according to the target preview distance includes: determining the preview point on the tracking path according to the target preview distance; The preview point obtains the vehicle preview angle; substitute the target preview distance and the vehicle preview angle into the turning radius calculation formula to calculate the vehicle turning radius; calculate the steering wheel angle according to the vehicle turning radius and the steering wheel angle calculation formula corresponding to the vehicle; controlled by the turning system.
- the target preview distance is within a limited distance range, and the limited distance range is 1 meter to 3.6 meters.
- the present application also provides a vehicle driving control device, comprising a memory and a processor; the processor is configured to execute a computer program stored in the memory to implement the steps of the vehicle driving control method described above.
- the present application also provides a computer-readable storage medium on which a computer program is stored, and when the computer program is executed by a processor, implements the steps of the vehicle driving control method described above.
- the present application also provides a vehicle comprising the vehicle driving control device as described above.
- the vehicle driving control method, vehicle driving control device, vehicle, and computer-readable storage medium provided by the present application wherein the vehicle driving control method includes: performing path planning to obtain a tracking path; Aiming distance; obtain a correction coefficient for the basic preview distance, the correction coefficient includes at least one of a speed correction coefficient, a path curvature correction coefficient, and a heading angle correction coefficient; obtain the target preview distance according to the correction coefficient and the basic preview distance;
- the target preview distance is used for lateral driving control. Therefore, the present application can optimize the calculation parameters of the path following algorithm according to the details of the driving scene (for example, the vehicle speed, the path curvature of the tracked path, the heading angle deviation angle, etc.), thereby realizing the optimization of the path following algorithm in the valet parking function.
- the purpose is to improve the control accuracy of low-speed unmanned driving to ensure the safety of the vehicle and the reliability of its functions, thereby improving the user experience.
- the present application can optimize the path following algorithm, and achieve a good calculation effect with a small amount of calculation, so that the steady-state lateral deviation can be controlled to a small value in the environment of parking or fixed-point parking in low-speed automatic driving. range (for example, within ⁇ 5cm), and control the steady-state heading angle deviation within a small range (for example, within ⁇ 3°), and even when the vehicle starting position deviates greatly from the tracking path, it can be very It is good to adjust the vehicle to the tracking path, with fast convergence and small overshoot.
- the application can also adaptively adjust the preview distance according to the vehicle speed, the path curvature of the tracking path, the heading angle deviation angle and the lateral deviation, so that the vehicle can quickly converge at different starting positions and angles, and can adapt to different road curvature, and meet a certain control accuracy, especially when the vehicle starting deviation is large, it has a good control effect.
- Some disadvantages of distance in lateral control such as easy overshoot, slow convergence, large steady-state error, etc.
- the application can be adapted to different roads, such as: straight lines, right-angle bends, small S bends, large S bends, arcs with different curvatures, special-shaped bends, etc., even the path opened by the driver can be stably followed, and the steady state The deviation is small, and in the case of a large deviation, the application can quickly converge and the overshoot is small.
- This application can not only meet the functions of parking (valet parking, fully automatic parking, semi-automatic parking), but also meet the functions related to low-speed unmanned driving (such as autonomous wireless charging, unmanned park shuttle, unmanned park) sweeper).
- the present application can obtain a more accurate relationship by calibrating the relationship between the steering wheel angle and the turning radius of the vehicle, so that a more accurate relationship can be obtained.
- the application has small code size, high operating efficiency, can be well embedded, and has low hardware requirements.
- FIG. 1 is a schematic flowchart of a vehicle driving control method provided by a first embodiment of the present application.
- FIG. 2 is a first schematic diagram of the bicycle model provided by the first embodiment of the present application.
- FIG. 3 is a corresponding relationship diagram of the basic preview distance provided by the first embodiment of the present application.
- FIG. 4 is a second schematic diagram of the bicycle model provided by the first embodiment of the present application.
- FIG. 5A is a first simulation result diagram of position comparison provided by the first embodiment of the present application.
- FIG. 5B is a simulation result diagram of the first variation of the lateral error provided by the first embodiment of the present application.
- FIG. 6A is a second simulation result diagram of position comparison provided by the first embodiment of the present application.
- FIG. 6B is a simulation result diagram of the second variation of the lateral error provided by the first embodiment of the present application.
- FIG. 7A is a third simulation result diagram of position comparison provided by the first embodiment of the present application.
- FIG. 7B is a simulation result diagram of the third variation of the lateral error provided by the first embodiment of the present application.
- FIG. 8 is a corresponding relationship diagram of the speed correction coefficient provided by the first embodiment of the present application.
- FIG. 9 is a corresponding relationship diagram of curvature correction coefficients provided by the first embodiment of the present application.
- FIG. 10A is a simulation result diagram of path tracking before curvature correction provided by the first embodiment of the present application.
- FIG. 10B is a simulation result diagram of the lateral deviation change before the curvature correction provided by the first embodiment of the present application.
- Fig. 11A is a simulation result diagram of path tracking after curvature correction provided by the first embodiment of the present application.
- FIG. 11B is a simulation result diagram of the lateral deviation change after curvature correction provided by the first embodiment of the present application.
- FIG. 12 is a corresponding relationship diagram of the heading angle correction coefficient provided by the first embodiment of the present application.
- FIG. 13A is a simulation result diagram of a curve scene before heading angle correction provided by the first embodiment of the present application.
- FIG. 13B is a simulation result diagram of lateral deviation change before heading angle correction provided by the first embodiment of the present application.
- FIG. 14A is a simulation result diagram of a curve scene after the heading angle correction provided by the first embodiment of the present application.
- FIG. 14B is a simulation result diagram of the lateral deviation change after the heading angle correction provided by the first embodiment of the present application.
- FIG. 15A is a simulation result diagram of a scene of a small S-curve provided by the first embodiment of the present application.
- FIG. 15B is a simulation result diagram of the lateral deviation change of the small S-curve scene provided by the first embodiment of the present application.
- FIG. 16A is a simulation result diagram of a right-angle curve scene provided by the first embodiment of the present application.
- FIG. 16B is a simulation result diagram of a lateral deviation change of a right-angle curve scene provided by the first embodiment of the present application.
- FIG. 17 is a comprehensive verification result diagram of a straight road scene provided by the first embodiment of the present application.
- Fig. 18 is a comprehensive verification result diagram of the large S-curve scene provided by the first embodiment of the present application.
- FIG. 19 is a comprehensive verification result diagram of the small S-curve scene provided by the first embodiment of the present application.
- FIG. 20 is a comprehensive verification result diagram of a right-angle curve scenario provided by the first embodiment of the present application.
- FIG. 21 is a comprehensive verification result diagram of the special-shaped curve scene provided by the first embodiment of the present application.
- FIG. 22 is a schematic diagram of a lateral control module provided by the first embodiment of the present application.
- FIG. 23 is a schematic structural diagram of a vehicle driving control device provided by the second embodiment of the present application.
- FIG. 24 is a schematic diagram of a vehicle provided by the second embodiment of the present application.
- Preview Point preview point
- PathCurvature The road curvature refers to the mean path curvature from the current point (Current Point) to the preview point (Preview Point);
- Lateral Deviation (or Lateral Deviation Error): lateral position deviation (the distance from the center of the rear axle of the vehicle to the vertical line on the tracked path);
- Target Position the target path tracked by the vehicle
- Real Position It is the actual position in the process of vehicle path tracking
- the lateral position deviation refers to the vertical distance from the center of the rear axle of the vehicle to the tracked path, see e y in Figure 2 for details;
- Velocity the speed of the vehicle
- Location Comparison location comparison
- S11 Perform path planning to obtain a tracking path.
- step S11 performing path planning to acquire the tracking path, it may include: acquiring the current position information of the vehicle through the positioning module, and performing path planning to acquire the tracking path.
- the positioning module may use RTK differential positioning technology and/or IMU to perform dead reckoning to provide vehicle current position information (or real-time vehicle position information) and/or track paths, and it may provide vehicle The horizontal and vertical coordinates of .
- RTK differential positioning technology also known as carrier phase differential technology
- RTK is a new and commonly used GPS measurement method.
- the previous static, fast static and dynamic measurements need to be solved after the fact. It can obtain centimeter-level accuracy
- RTK is a measurement method that can obtain centimeter-level positioning accuracy in real time in the field. It can provide the three-dimensional coordinates of the observation point in real time and achieve centimeter-level high precision; the same as the principle of pseudorange difference, it is determined by the reference station.
- the carrier observation value and the station coordinate information are transmitted to the user station in real time through the data link; the user station receives the carrier phase of the GPS satellite and the carrier phase from the base station, and forms the phase difference observation value for real-time processing, which can give centimeters in real time.
- the former is the same as the pseudorange difference.
- the base station sends the carrier phase correction amount to the user station to correct its carrier phase, and then solves the problem.
- Coordinates the latter sends the carrier phase collected by the base station to the subscriber station for difference calculation of coordinates.
- the former is the quasi-RTK technology, and the latter is the real RTK technology.
- IMU the full name is inner measurement unit, that is, inertial measurement unit, usually composed of gyroscope, accelerometer and algorithm processing unit, through the measurement of acceleration and rotation angle to obtain its own motion trajectory, which is very important in navigation.
- inner measurement unit that is, inertial measurement unit, usually composed of gyroscope, accelerometer and algorithm processing unit, through the measurement of acceleration and rotation angle to obtain its own motion trajectory, which is very important in navigation.
- GPS/IMU sensing system can help autonomous driving to complete positioning through global positioning and inertial update data up to 100Hz frequency.
- GPS is a relatively accurate positioning sensor, but its update frequency is too low, only 10Hz, which is not enough to provide enough real-time position updates.
- the IMU has the real-time performance that GPS lacks, and the update frequency of the IMU can reach 100Hz or higher.
- GPS and IMU By integrating GPS and IMU, we can provide both accurate and sufficiently real-time position updates for vehicle positioning.
- the combination of GPS and IMU is to integrate the heading velocity, angular velocity and acceleration information of IMU to improve the accuracy and anti-interference ability of GPS.
- IMU can not only provide some information, but also provide supplementary navigation information, because GPS itself only provides location information, IMU can also provide heading and attitude information, which is also encountered in vehicle control and even the most basic vehicle control. to the information. Because the IMU will provide different angles, we can monitor the changes in the vehicle attitude very keenly in real time, and can more accurately identify some more complex road conditions.
- the relative and absolute position deduction of the IMU does not depend on any external equipment and is a complete system like a black box in an aircraft. Since the IMU does not require any external signal, it can be installed in a concealed location such as the chassis of a car, thus avoiding electronic or mechanical attack.
- step S12 obtaining the basic preview distance according to the current position information of the vehicle and the tracking path, may include: obtaining the tracking position point corresponding to the current position information of the vehicle on the tracking path; and the tracking position point to obtain the lateral position deviation value; match the basic preview distance corresponding to the lateral position deviation value.
- the step of obtaining the lateral position deviation value according to the current position information of the vehicle and the tracking position point may include: based on the basic principle of the pure tracking algorithm, establishing a coordinate system according to the current position information of the vehicle, the origin of the coordinate system. Corresponding to the center of the rear axle of the vehicle, the positive X-axis of the coordinate system is the forward direction of the vehicle, and the Y-axis of the coordinate system is the lateral direction of the vehicle; and/or the lateral position deviation value is obtained according to the coordinate system and the tracking position point.
- the basic principle of the pure tracking algorithm in this embodiment can refer to the article Myungwook Park, Sangwoo Lee, and Wooyong Han. Development of Steering Control System for Autonomous Vehicle Using Geometry-Based Path Tracking Algorithm [J] . Rationale in ETRI Journal, 2015, 37(3):617-625.
- the coordinate system is established according to the current position information of the vehicle, and the lateral position deviation value is obtained according to the coordinate system and the tracking position point. (or the center of the rear wheel axle) to establish a coordinate system, the forward direction is the positive X axis, the lateral direction is the Y axis, and the vehicle is simplified as a bicycle model, where T1 is the simplification of the two rear wheels, and T2 is the simplification of the two front wheels;
- the positioning module such as the coordinates of the left side of the entire parking lot or the current position of the vehicle in the parking lot, not shown in the figure
- the relative position of the tracking path Path is obtained, thereby obtaining the tracking path Path
- the tracking position point Current Point corresponding to the center of the rear axle of the vehicle can be obtained, and the distance e y (that is, the lateral position deviation value) from the center of the rear axle of the vehicle to the tracking position point Current Point can
- the step of matching the basic preview distance corresponding to the lateral position deviation value may include: acquiring the basic preview distance corresponding to the lateral position deviation value from the preview distance correspondence information.
- the preview distance correspondence information includes the correspondence between at least one lateral position deviation value and the basic preview distance, and the preview distance correspondence information may be preset and stored by the user or the system according to actual needs. The use of the preview distance correspondence information provided in this embodiment can ensure that the vehicle has no overshoot phenomenon as much as possible when the vehicle converges from a large lateral position deviation value to the tracking path, and improves the stability of the vehicle tracking to the tracking path. .
- the corresponding relationship information of the preview distance is as shown in Figure 3, wherein, the minimum lateral position deviation value (Lateral Deviation, or e y for short) is 0 to 0.1 meters, corresponding to the shortest basic preview distance (Preview Distance) is 1 meter, and the lateral position deviation value exceeds 0.5 meters, which corresponds to the longest basic preview distance of about 2.7 meters.
- the initial preview point P1 may be determined according to the basic preview distance, and the included angle of the heading corresponding to the initial preview point P1 according to the forward direction of the vehicle is determined. (ie the heading deviation angle ⁇ ⁇ ), to determine the included angle between the forward direction of the vehicle and the heading corresponding to the tracking position point (ie the initial heading deviation angle ⁇ c ).
- the setting principle of the preview distance correspondence information is that since the preview distance plays a decisive role in the control effect of the pure tracking algorithm, in the case of a large lateral position deviation of the vehicle, if a smaller value is used.
- the preview distance can quickly pull the vehicle back to the tracked path, it is easy to overshoot. If the preview distance is too large, it is not easy to overshoot, but the steady-state error after stabilizing to the tracking path is relatively low. Therefore, it is necessary to match the appropriate preview distance according to the lateral position deviation, so as to avoid the problems of overshoot and large steady-state error after stabilizing to the tracking path.
- the preview distance can not only reduce the vehicle overshoot, but also reduce the steady-state error after stabilizing to the tracking path.
- the initial lateral position deviation value e y is set to 1 m
- the initial heading deviation angle ⁇ c is set to 10 °
- the selected initial preview distance is 2.7m.
- step S13 obtaining the correction system for the basic preview distance, it may include: obtaining the current vehicle speed, and obtaining the speed correction coefficient corresponding to the current vehicle speed from the speed correction coefficient correspondence information (wherein, The corresponding relationship information of the speed correction coefficient indicates the corresponding relationship between the vehicle speed and the speed correction coefficient); and/or, the mean value of the path curvature of the tracked path is obtained, and the mean value of the path curvature and the obtained lateral position deviation value are obtained from the information on the corresponding relationship of the curvature correction coefficients.
- the heading angle correction coefficient correspondence information indicates that the horizontal Corresponding relationship between position deviation value, heading deviation angle and heading angle correction coefficient).
- the setting principle of the corresponding relationship information of the speed correction coefficient may be, due to the delay of the steering system, when the vehicle speed increases, the preview distance should be correspondingly increased, so it needs to be based on the basic preview distance.
- Increase the speed correction coefficient ⁇ v The corresponding relationship between the vehicle speed and the speed correction coefficient ⁇ v in the corresponding relationship information of the speed correction coefficient can refer to Figure 8.
- the speed correction coefficient ⁇ v is set to 1; when the vehicle speed is greater than 2.5Km /h, the correction needs to be performed at the beginning, and the speed correction coefficient ⁇ v greater than 1 is selected for correction at this time.
- the path curvature mean value of the tracking path is obtained, and in the step of obtaining the curvature correction coefficient corresponding to the path curvature mean value and the obtained lateral position deviation value from the curvature correction coefficient correspondence information, the curvature correction coefficient correspondence
- the setting principle of the curvature correction coefficient correspondence information may be, in order to allow the vehicle to quickly converge to the tracking path at the starting vehicle position with a larger lateral position deviation value without excessive
- the preview distance should be shorter, so that the vehicle can return to the path as soon as possible.
- the preview distance should be longer to prevent overshoot in some cases, so it is necessary to increase the curvature correction coefficient ⁇ C on the basis of the above. Since the vehicle does not need to have a certain relationship with the path curvature after stable tracking, Therefore, the curvature correction coefficient ⁇ C should be set to 1 after the vehicle is tracked stably. According to the above characteristics, the relationship between the path curvature C, the lateral position deviation value e y and the coefficient ⁇ C can be obtained, as shown in Figure 9.
- the path curvature mean value of the tracking path is obtained
- the step of obtaining the curvature correction coefficient corresponding to the path curvature mean value and the obtained lateral position deviation value from the curvature correction coefficient correspondence information may include: The preview distance determines the initial preview point on the tracking path; according to the tracking position point on the tracking path and the initial preview point, the mean value of the path curvature from the tracking position point to the initial preview point is calculated.
- the step of calculating the mean value of the path curvature between the tracking position point and the initial preview point may include: acquiring the mean value of the path curvature on the tracking path. The number of position points between the tracking position point and the initial preview point and the curvature of each position point; the average curvature of the path is calculated according to the number of position points and the curvature of each position point through the curvature mean calculation formula (that is, the path The curvature can be the mean path curvature from the tracked position point to the initial preview point).
- the formula for calculating the mean value of path curvature includes: Wherein, C 1 , C 2 . . . C n all represent the curvature of a certain position point on the path, and n represents the number of position points between the tracking position point and the initial preview point.
- the convergence distance before and after the curvature correction is compared, for example, the vehicle lateral control is performed with the same initial lateral position deviation value of the vehicle and the same vehicle speed, According to the simulation results of the path tracking before the curvature correction in Figure 10A and the simulation results of the path tracking after the curvature correction Figure 11A, it can be seen that the curvature correction shows a faster convergence speed, and the simulation results according to the lateral deviation change before the curvature correction are shown in Figure 11A.
- the initial preview point is determined according to the basic preview distance
- the heading deviation angle is obtained according to the heading direction of the vehicle and the heading corresponding to the initial preview point
- the heading deviation is obtained from the corresponding relationship information of the heading angle correction coefficient.
- the principle of setting the corresponding relationship information of the heading angle correction coefficient may be that, since the starting position of the vehicle is sometimes at a curve, at this time, when the heading angle of the vehicle deviates from the heading angle of the preview point on the path, When ⁇ ⁇ is too large, overshoot is easy to occur, so it is necessary to set the heading angle correction coefficient for debugging to avoid overshoot when the heading angle deviation ⁇ ⁇ is too large.
- the lateral position deviation is (13, 1)
- the initial heading deviation angle ⁇ c is [10, -10, 5, -5, 0] degrees respectively.
- the heading angle correction coefficient ⁇ a should be set to 1 at this time. Based on the above characteristics, ⁇ p , e y , ⁇ a relationship in Figure 12.
- the positive or negative of the heading deviation angle ⁇ p corresponding to the initial preview point depends on whether the vehicle is on the inside of the curve or on the outside of the curve, and the positive or negative of the included angle between the vehicle heading angle and the heading angle of the preview point.
- step S14 obtaining the target preview distance according to the correction coefficient and the basic preview distance, it may include: obtaining the first target preview according to the speed correction coefficient and the basic preview distance distance, wherein the speed correction coefficient is proportional to the basic preview distance.
- step S14 obtaining the target preview distance according to the correction coefficient and the basic preview distance, it may include: obtaining the first target preview distance according to the heading angle correction coefficient and the basic preview distance, wherein , the heading angle correction coefficient is proportional to the basic preview distance.
- step S14 obtaining the target preview distance according to the correction coefficient and the basic preview distance, it may include: obtaining the first target preview distance according to the path curvature correction coefficient and the basic preview distance The aiming distance, wherein the path curvature correction coefficient is proportional to the basic preview distance.
- step S14 obtaining the target preview distance according to the correction coefficient and the basic preview distance, it may include: obtaining the target preview distance according to the first target preview distance and the optimization correction coefficient, wherein the first target preview distance is obtained.
- a target preview distance is proportional to the optimization correction coefficient; wherein, the optimization correction coefficient is a correction coefficient other than the correction coefficient corresponding to the first target preview distance.
- the target preview distance obtained by the preview distance correction formula is within a limited distance range, and the limited distance range is 1 meter to 3.6 meters.
- the target preview distance obtained by the preview distance correction formula is within the limited distance range, which enables the vehicle to stably track to the tracking path when performing lateral control, and has almost no overshoot when converging to the tracking path.
- step S15 performing the lateral driving control according to the target preview distance, it may include: performing the operation according to the first target preview distance or the target preview distance obtained by optimizing the first target preview distance. Lateral driving controls.
- step S15 performing lateral driving control according to the target preview distance, it may include: determining a preview point on the tracking path according to the target preview distance;
- the vehicle preview angle is obtained from the coordinate system and the preview point on the tracking path (for example, the vehicle preview angle is obtained according to the origin of the coordinate system and the preview point on the positive X-axis tracking path); the target preview distance and the vehicle preview angle are obtained.
- the aiming angle is substituted into the turning radius calculation formula to calculate the vehicle turning radius; the steering wheel angle is calculated according to the vehicle turning radius and the steering wheel angle calculation formula corresponding to the vehicle; the turning system of the vehicle is controlled according to the steering wheel angle.
- Formula coefficients with the model of the vehicle for example, model X, ⁇ 1 is 38102.13 , ⁇ 2 is 813.06 , ⁇ 3 is -10202.81 , ⁇ 4 is -39.63 , ⁇ 5 is 2472.84 , and ⁇ 6 is -0.29.
- the vehicle driving control method provided in this embodiment is applied to a vehicle, referring to FIG. 15A and FIG. 15B , when the tracking path is a small S curve path, the vehicle has different starting position deviations, different The initial heading deviation angle and different road curvatures can be stably converged, and there is almost no overshoot, achieving the desired goal of the industry that the steady-state lateral deviation is controlled within ⁇ 5cm and the steady-state heading angle deviation is controlled within ⁇ 3°. Control requirements. Referring to Fig. 16A and Fig.
- the vehicle when the tracking path is a right-angle curve path, the vehicle can stably converge at different starting position deviations, different starting heading deviation angles, and different road curvatures, and there is almost no overshoot.
- the steady-state lateral deviation is controlled within ⁇ 5cm, and the steady-state heading angle deviation is controlled within ⁇ 3°.
- the vehicle driving control method provided in this embodiment may be applied to a lateral control module in a vehicle, and optionally, the lateral control module may execute steps S12 to S15.
- the lateral control module obtains information such as the tracking path, the current position of the vehicle, and the speed of the vehicle, and then performs lateral position deviation calculation, curvature calculation, and vehicle heading angle calculation, and matches the basic preview distance and its correction coefficient according to the aforementioned calculation results, and Obtain the target preview distance to realize the self-response preview distance, transmit the obtained target preview distance to the pure tracking unit in the lateral control module, and calculate the control parameters (such as steering wheel angle information) through the pure tracking unit and send it to the vehicle for execution
- the device realizes lateral driving control.
- the vehicle driving control method provided by the first embodiment of the present application includes: S11: Perform path planning to obtain a tracking path.
- S15 Perform lateral driving control according to the target preview distance.
- the vehicle driving control method provided by the first embodiment of the application can optimize the calculation parameters of the path following algorithm according to the details of the driving scene (such as the vehicle speed, the path curvature of the tracked path, the heading angle deviation angle, etc.), thereby realizing the optimization of the valet.
- the purpose of the path following algorithm in the parking function is to improve the control accuracy of low-speed unmanned driving to ensure vehicle safety and functional reliability, thereby enhancing the user experience.
- the vehicle driving control method provided in the first embodiment of the application can optimize the path following algorithm and achieve a good calculation effect with a small amount of calculation, so that in the environment of low-speed automatic driving for parking or fixed-point parking, the Steady-state lateral deviation is controlled within a small range (for example, within ⁇ 5cm), and steady-state heading angle deviation is controlled within a small range (for example, within ⁇ 3°), and even if the vehicle starting position and tracking When the path has a large deviation, the vehicle can be well adjusted to the tracking path, and the convergence speed is fast and the overshoot is small.
- a small range for example, within ⁇ 5cm
- steady-state heading angle deviation is controlled within a small range (for example, within ⁇ 3°)
- the vehicle driving control method provided in the first embodiment of the application can also adaptively adjust the preview distance according to the vehicle speed, the path curvature of the tracked path, the heading angle deviation angle, and the lateral deviation, so that the vehicle starts at different positions and starts at different angles. It can quickly converge in different situations, and can adapt to different road curvatures, and meet a certain control accuracy, especially when the vehicle initial deviation is large, it has a good control effect, and solves the problem of fixed preview when the vehicle initial deviation is large.
- Some disadvantages of the distance or the preview distance adjusted only according to the vehicle speed in the lateral control such as easy overshoot, slow convergence speed, large steady-state error, etc.
- the vehicle driving control method provided by the first embodiment of the application can be adapted to different roads, such as: straight lines, right-angle bends, small S bends, large S bends, arcs with different curvatures, special-shaped bends, etc., even if the driver arbitrarily drives
- the path can also be followed stably, and the steady-state deviation is small, and the vehicle driving control method provided by the first embodiment of the application can quickly converge with a small overshoot in the case of a large deviation.
- the vehicle driving control method provided by the first embodiment of the application can not only meet the functions of parking (valet parking, fully automatic parking, semi-automatic parking) but also meet the functions related to low-speed unmanned driving (such as autonomous wireless charging, Park shuttle bus, unmanned park sweeper).
- the vehicle driving control method provided by the first embodiment of the application can be obtained by calibrating the relationship between the steering wheel angle and the vehicle turning radius. A more accurate relationship, so that a better steady-state following effect can be achieved.
- the vehicle driving control method provided by the first embodiment of the application is executed by a computer, the amount of code is small, the operation efficiency is high, it can be well embedded, and the hardware requirements are low.
- FIG. 23 is a schematic structural diagram of a vehicle driving control device provided by the second embodiment of the present application.
- vehicle driving control device 1 provided by the second embodiment of the present application, please refer to FIG. 23 .
- the vehicle driving control device 1 provided in the second embodiment of the present application includes: a processor A101 and a memory A201, wherein the processor A101 is configured to execute the computer program A6 stored in the memory A201 to realize the vehicle as described in the first embodiment The steps of the driving control method.
- the vehicle driving control device 1 provided in this embodiment may include at least one processor A101 and at least one memory A201.
- at least one processor A101 may be referred to as a processing unit A1
- at least one memory A201 may be referred to as a storage unit A2.
- the storage unit A2 stores a computer program A6.
- the vehicle driving control device 1 provided in this embodiment realizes the steps of the vehicle driving control method described in the first embodiment. , for example, S11 shown in Fig.
- S12 carry out path planning to obtain the tracking path
- S12 obtain the basic preview distance according to the current position information of the vehicle and the tracking path
- S13 obtain the correction coefficient for the basic preview distance, and the correction coefficient includes At least one of the speed correction coefficient, the path curvature correction coefficient, and the heading angle correction coefficient
- S14 Obtain the target preview distance according to the correction coefficient and the basic preview distance
- S15 Perform lateral driving control according to the target preview distance.
- the vehicle driving control device 1 provided in this embodiment may include a plurality of memories A201 (referred to as storage units A2 for short).
- the storage unit A2 may be a volatile memory or a non-volatile memory, and may also include both volatile and non-volatile memories.
- the non-volatile memory can be a read-only memory (ROM, Read Only Memory), a programmable read-only memory (PROM, Programmable Read-Only Memory), an erasable programmable read-only memory (EPROM, Erasable Programmable Read-only memory) Only Memory), Electrically Erasable Programmable Read-Only Memory (EEPROM, Electrically Erasable Programmable Read-Only Memory), Magnetic Random Access Memory (FRAM, ferromagnetic random access memory), Flash Memory (Flash Memory), Magnetic Surface Memory , CD-ROM, or CD-ROM (Compact Disc Read-Only Memory); magnetic surface memory can be disk memory or tape memory.
- RAM Random Access Memory
- SRAM Static Random Access Memory
- SSRAM Synchronous Static Random Access Memory
- DRAM Dynamic Random Access Memory
- SDRAM Synchronous Dynamic Random Access Memory
- DDRSDRAM Double Data Rate Synchronous Dynamic Random Access Memory
- ESDRAM Double Data Rate Synchronous Dynamic Random Access Memory
- ESDRAM Enhanced Type Synchronous Dynamic Random Access Memory
- SLDRAM Synchronous Link Dynamic Random Access Memory
- DRRAM Direct Rambus Random Access Memory
- DRRAM Direct Rambus Random Access Memory
- the storage unit A2 described in the embodiments of the present application is intended to include but not limited to these and any other suitable types of memories.
- the vehicle driving control device 1 also includes a bus connecting different components (eg, the processor A101 and the memory A201, etc.).
- the vehicle driving control device 1 in this embodiment may further include a communication interface (eg, I/O interface A3), which may be used to communicate with external devices.
- a communication interface eg, I/O interface A3
- the terminal 1 provided in this embodiment may further include a communication apparatus A5.
- the vehicle driving control device 1 provided by the second embodiment of the present application includes a memory A101 and a processor A201, and the processor A101 is configured to execute the computer program A6 stored in the memory A201 to realize the vehicle driving control described in the first embodiment Therefore, the vehicle driving control device 1 provided in this embodiment can optimize the calculation parameters of the path following algorithm according to the details of the driving scene, so as to achieve the purpose of optimizing the path following algorithm in the valet parking function, and improve low-speed
- the control accuracy of the human driver ensures the safety of the vehicle and the reliability of the function, which in turn can improve the user experience.
- the second embodiment of the present application further provides a computer-readable storage medium, where the computer-readable storage medium stores a computer program A6, and when the computer program A6 is executed by the processor A101, implements the vehicle driving control as in the first embodiment
- the steps of the method are, for example, steps S11 to S15 shown in FIG. 1 .
- the computer-readable storage medium provided by this embodiment may include any entity or device capable of carrying computer program code, a recording medium, such as ROM, RAM, magnetic disk, optical disk, flash memory, and the like.
- the calculation parameters of the path following algorithm can be optimized according to the details of the driving scene, thereby realizing the optimization of the valet parking function.
- the purpose of the path following algorithm is to improve the control accuracy of low-speed unmanned driving to ensure vehicle safety and functional reliability, thereby enhancing the user experience.
- the second embodiment of the present application also provides a vehicle, see FIG. 24 , the vehicle includes the vehicle classroom control device or the lateral control module as described above, so that the vehicle provided by the second embodiment of the present application can be based on the details of the driving scene.
- Optimize the calculation parameters of the path following algorithm so as to achieve the purpose of optimizing the path following algorithm in the valet parking function, improve the control accuracy of low-speed unmanned driving to ensure the safety of the vehicle and the reliability of the function, thereby improving the user's experience. Use experience.
- first, second, third, etc. may be used herein to describe various information, such information should not be limited by these terms. These terms are only used to distinguish the same type of information from each other.
- first information may also be referred to as second information, and similarly, second information may also be referred to as first information, without departing from the scope of this document.
- the word “if” as used herein can be interpreted as “at the time of” or “when” or “in response to determining”, depending on the context.
- the singular forms "a,” “an,” and “the” are intended to include the plural forms as well, unless the context dictates otherwise.
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
- Traffic Control Systems (AREA)
Abstract
Description
Claims (13)
- 一种车辆驾驶控制方法,其特征在于,包括:A vehicle driving control method, comprising:进行路径规划以获取跟踪路径;Perform path planning to obtain tracking paths;根据车辆当前位置信息和所述跟踪路径获取基本预瞄距离;Obtain the basic preview distance according to the current position information of the vehicle and the tracking path;获取针对所述基本预瞄距离的修正系数,所述修正系数包括速度修正系数、路径曲率修正系数、航向角修正系数中的至少一项;obtaining a correction coefficient for the basic preview distance, where the correction coefficient includes at least one of a speed correction coefficient, a path curvature correction coefficient, and a heading angle correction coefficient;根据所述修正系数和所述基本预瞄距离获取目标预瞄距离;Obtain the target preview distance according to the correction coefficient and the basic preview distance;根据所述目标预瞄距离进行横向驾驶控制。The lateral driving control is performed according to the target preview distance.
- 如权利要求1所述的车辆驾驶控制方法,其特征在于,所述根据车辆当前位置信息和所述跟踪路径获取基本预瞄距离的步骤中,包括:The vehicle driving control method according to claim 1, wherein the step of obtaining the basic preview distance according to the current position information of the vehicle and the tracking path comprises:获取所述跟踪路径上与所述车辆当前位置信息对应的跟踪位置点;obtaining a tracking position point corresponding to the current position information of the vehicle on the tracking path;根据所述车辆当前位置信息和所述跟踪位置点获取横向位置偏差值;Obtain a lateral position deviation value according to the current position information of the vehicle and the tracking position point;从预瞄距离对应关系信息中获取与所述横向位置偏差值对应的所述基本预瞄距离,其中,所述预瞄距离对应关系信息中包括至少一个横向位置偏差值与基本预瞄距离的对应关系。The basic preview distance corresponding to the lateral position deviation value is obtained from the preview distance corresponding relationship information, wherein the preview distance corresponding relationship information includes the correspondence between at least one lateral position deviation value and the basic preview distance relation.
- 如权利要求2所述的车辆驾驶控制方法,其特征在于,所述获取针对所述基本预瞄距离的修正系数的步骤中,包括:The vehicle driving control method according to claim 2, wherein the step of acquiring the correction coefficient for the basic preview distance comprises:获取当前车速,从速度修正系数对应关系信息中获取与所述当前 车速对应的速度修正系数,其中,所述速度修正系数对应关系信息指示车速与速度修正系数的对应关系;Obtaining the current vehicle speed, and obtaining the speed correction coefficient corresponding to the current vehicle speed from the speed correction coefficient correspondence information, wherein the speed correction coefficient correspondence information indicates the corresponding relationship between the vehicle speed and the speed correction coefficient;所述根据所述修正系数和所述基本预瞄距离获取目标预瞄距离的步骤中,包括:The step of obtaining the target preview distance according to the correction coefficient and the basic preview distance includes:根据所述速度修正系数和所述基本预瞄距离获取第一目标预瞄距离,其中,所述速度修正系数和所述基本预瞄距离成正比关系。The first target preview distance is obtained according to the speed correction coefficient and the basic preview distance, wherein the speed correction coefficient and the basic preview distance are in a proportional relationship.
- 如权利要求2所述的车辆驾驶控制方法,其特征在于,所述获取针对所述基本预瞄距离的修正系数的步骤中,包括:The vehicle driving control method according to claim 2, wherein the step of acquiring the correction coefficient for the basic preview distance comprises:根据所述基本预瞄距离确定所述跟踪路径上的初始预瞄点;determining an initial preview point on the tracking path according to the basic preview distance;根据所述车辆的前进方向和所述初始预瞄点对应的航向获取航向偏差角度;Obtain the heading deviation angle according to the heading direction of the vehicle and the heading corresponding to the initial preview point;从航向角修正系数对应关系信息中获取与所述航向偏差角度和所述横向位置偏差值对应的所述航向角修正系数,其中,所述航向角修正系数对应关系信息指示横向位置偏差值、航向偏差角度及航向角修正系数的对应关系;The heading angle correction coefficient corresponding to the heading deviation angle and the lateral position deviation value is obtained from the heading angle correction coefficient correspondence information, wherein the heading angle correction coefficient correspondence information indicates the lateral position deviation value, the heading Corresponding relationship between deviation angle and heading angle correction coefficient;所述根据所述修正系数和所述基本预瞄距离获取目标预瞄距离的步骤中,包括:The step of obtaining the target preview distance according to the correction coefficient and the basic preview distance includes:根据所述航向角修正系数和所述基本预瞄距离获取第一目标预瞄距离,其中,所述航向角修正系数和所述基本预瞄距离成正比关系。The first target preview distance is obtained according to the heading angle correction coefficient and the basic preview distance, wherein the heading angle correction coefficient and the basic preview distance are in a proportional relationship.
- 如权利要求2所述的车辆驾驶控制方法,其特征在于,所述获取针对所述基本预瞄距离的修正系数的步骤中,包括:The vehicle driving control method according to claim 2, wherein the step of acquiring the correction coefficient for the basic preview distance comprises:获取所述跟踪路径的路径曲率均值;obtaining the mean path curvature of the tracking path;从曲率修正系数对应关系信息中获取与所述路径曲率均值和所述横向位置偏差值对应的所述曲率修正系数,其中,所述曲率修正系数对应关系信息指示横向位置偏差值、路径曲率均值及曲率修正系数的对应关系;The curvature correction coefficient corresponding to the path curvature mean value and the lateral position deviation value is obtained from the curvature correction coefficient correspondence information, wherein the curvature correction coefficient correspondence information indicates the lateral position deviation value, the path curvature mean value and the Corresponding relationship of curvature correction coefficient;所述根据所述修正系数和所述基本预瞄距离获取目标预瞄距离的步骤中,包括:The step of obtaining the target preview distance according to the correction coefficient and the basic preview distance includes:根据所述路径曲率修正系数和所述基本预瞄距离获取第一目标预瞄距离,其中,所述路径曲率修正系数和所述基本预瞄距离成正比关系。The first target preview distance is obtained according to the path curvature correction coefficient and the basic preview distance, wherein the path curvature correction coefficient and the basic preview distance are in a proportional relationship.
- 如权利要求5所述的车辆驾驶控制方法,其特征在于,所述获取所述跟踪路径的路径曲率均值的步骤中,包括:The vehicle driving control method according to claim 5, wherein the step of acquiring the mean value of the path curvature of the tracking path comprises:根据所述基本预瞄距离确定所述跟踪路径上的初始预瞄点;determining an initial preview point on the tracking path according to the basic preview distance;根据所述跟踪路径上的所述跟踪位置点和初始预瞄点,计算从所述跟踪位置点到所述初始预瞄点之间的所述路径曲率均值。According to the tracking position point and the initial preview point on the tracking path, the mean value of the path curvature from the tracking position point to the initial preview point is calculated.
- 如权利要求3至6中任一项所述的车辆驾驶控制方法,其特征在于,所述根据所述修正系数和所述基本预瞄距离获取目标预瞄距离的步骤中,包括:The vehicle driving control method according to any one of claims 3 to 6, wherein the step of obtaining the target preview distance according to the correction coefficient and the basic preview distance includes:根据所述第一目标预瞄距离和优化修正系数获取所述目标预瞄距离,其中,所述第一目标预瞄距离和所述优化修正系数成正比关系;Obtain the target preview distance according to the first target preview distance and the optimization correction coefficient, wherein the first target preview distance and the optimization correction coefficient are in a proportional relationship;其中,所述优化修正系数为除所述第一目标预瞄距离对应的修正系数以外的修正系数。Wherein, the optimization correction coefficient is a correction coefficient other than the correction coefficient corresponding to the first target preview distance.
- 如权利要求1所述的车辆驾驶控制方法,其特征在于,所述根 据所述目标预瞄距离进行横向驾驶控制的步骤中,包括:The vehicle driving control method according to claim 1, wherein the step of performing lateral driving control according to the target preview distance comprises:根据所述目标预瞄距离确定所述跟踪路径上的预瞄点;determining a preview point on the tracking path according to the target preview distance;根据基于纯跟踪算法的基本原理建立的坐标系及所述跟踪路径上的所述预瞄点获取车辆预瞄角度;Obtain the vehicle preview angle according to the coordinate system established based on the basic principle of the pure tracking algorithm and the preview point on the tracking path;将所述目标预瞄距离和所述车辆预瞄角度代入转弯半径计算公式计算车辆转弯半径;Substitute the target preview distance and the vehicle preview angle into the turning radius calculation formula to calculate the vehicle turning radius;根据所述车辆转弯半径和所述车辆对应的方向盘转角计算公式计算方向盘转角;Calculate the steering wheel angle according to the vehicle turning radius and the steering wheel angle calculation formula corresponding to the vehicle;根据所述方向盘转角对所述车辆的转弯系统进行控制。The steering system of the vehicle is controlled according to the steering wheel angle.
- 如权利要求8所述的车辆驾驶控制方法,其特征在于,所述转弯半径计算公式包括: The vehicle driving control method according to claim 8, wherein the calculation formula of the turning radius comprises:其中,R表示所述车辆转弯半径,L d表示所述目标预瞄距离,α表示所述车辆预瞄角度; Wherein, R represents the turning radius of the vehicle, L d represents the target preview distance, and α represents the vehicle preview angle;所述方向盘转角计算公式包括:The steering wheel angle calculation formula includes:StA=α 1ρ 5+α 2ρ 4+α 3ρ 3+α 4ρ 2+α 5ρ 1+α 6; StA=α 1 ρ 5 +α 2 ρ 4 +α 3 ρ 3 +α 4 ρ 2 +α 5 ρ 1 +α 6 ;其中,StA表示所述方向盘转角,ρ表示转弯曲率,α 1、α 2、α 3、α 4、α 5、α 6均为公式系数,所述公式系数与所述车辆的车型相对应。 Wherein, StA represents the steering wheel angle, ρ represents the turning curvature, α 1 , α 2 , α 3 , α 4 , α 5 , and α 6 are formula coefficients, and the formula coefficients correspond to the vehicle type.
- 如权利要求1所述的车辆驾驶控制方法,其特征在于,所述 目标预瞄距离在限定距离范围内,所述限定距离范围为1米至3.6米。The vehicle driving control method according to claim 1, wherein the target preview distance is within a limited distance range, and the limited distance range is 1 meter to 3.6 meters.
- 一种车辆驾驶控制装置,其特征在于,包括存储器和处理器;A vehicle driving control device, characterized in that it includes a memory and a processor;所述处理器用于执行所述存储器中存储的计算机程序以实现如权利要求1至10中任一项所述的车辆驾驶控制方法的步骤。The processor is configured to execute the computer program stored in the memory to implement the steps of the vehicle driving control method as claimed in any one of claims 1 to 10.
- 一种计算机可读存储介质,其特征在于,所述计算机可读存储介质上存储有计算机程序,所述计算机程序被处理器执行时实现如权利要求1至10中任一项所述的车辆驾驶控制方法的步骤。A computer-readable storage medium, characterized in that a computer program is stored on the computer-readable storage medium, and when the computer program is executed by a processor, the vehicle driving according to any one of claims 1 to 10 is implemented The steps of the control method.
- 一种车辆,其特征在于,所述车辆包括如权利要求11所述的车辆驾驶控制装置。A vehicle, characterized in that the vehicle includes the vehicle driving control device of claim 11 .
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/CN2021/074201 WO2022160196A1 (en) | 2021-01-28 | 2021-01-28 | Vehicle driving control method and apparatus, and vehicle and storage medium |
CN202180072808.9A CN116457259A (en) | 2021-01-28 | 2021-01-28 | Vehicle driving control method and device, vehicle and storage medium |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/CN2021/074201 WO2022160196A1 (en) | 2021-01-28 | 2021-01-28 | Vehicle driving control method and apparatus, and vehicle and storage medium |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2022160196A1 true WO2022160196A1 (en) | 2022-08-04 |
Family
ID=82652867
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/CN2021/074201 WO2022160196A1 (en) | 2021-01-28 | 2021-01-28 | Vehicle driving control method and apparatus, and vehicle and storage medium |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN116457259A (en) |
WO (1) | WO2022160196A1 (en) |
Cited By (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115179935A (en) * | 2022-09-13 | 2022-10-14 | 毫末智行科技有限公司 | Path tracking method and device, electronic equipment and storage medium |
CN115476881A (en) * | 2022-10-20 | 2022-12-16 | 重庆长安汽车股份有限公司 | Vehicle trajectory tracking control method, device, equipment and medium |
CN115480579A (en) * | 2022-10-13 | 2022-12-16 | 华侨大学 | Crawler-type mobile machine, and method, device and medium for tracking and controlling established track thereof |
CN116118751A (en) * | 2023-04-19 | 2023-05-16 | 深圳佑驾创新科技有限公司 | Control method and device for vehicle, vehicle and storage medium |
CN116101326B (en) * | 2023-04-12 | 2023-07-14 | 北京理工大学深圳汽车研究院(电动车辆国家工程实验室深圳研究院) | Transverse control method, device and system for automatic driving vehicle and storage medium |
CN116572972A (en) * | 2023-07-03 | 2023-08-11 | 中国第一汽车股份有限公司 | Transverse control method and device of vehicle, electronic equipment and storage medium |
CN116659481A (en) * | 2023-07-27 | 2023-08-29 | 山东曼大智能科技有限公司 | Outdoor robot course angle calibration method, system and medium based on RTK and odometer |
CN116749950A (en) * | 2023-07-25 | 2023-09-15 | 云创智行科技(苏州)有限公司 | Adaptive steering judging method and device |
CN117311153A (en) * | 2023-10-24 | 2023-12-29 | 酷哇科技有限公司 | Adaptive model prediction nonlinear control extended sweeping control tracking method and system |
CN117724504A (en) * | 2024-02-07 | 2024-03-19 | 北京科技大学 | Unmanned vehicle path tracking control method and device based on projection area |
CN118131768A (en) * | 2024-03-05 | 2024-06-04 | 无锡中鼎集成技术有限公司 | AGV curve path correction and tracking control method |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117953460B (en) * | 2024-03-26 | 2024-07-09 | 江西众加利高科技股份有限公司 | Vehicle wheel axle identification method and device based on deep learning |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20130131925A1 (en) * | 2011-11-18 | 2013-05-23 | Denso Corporation | Vehicle behavior control apparatus |
CN110001637A (en) * | 2019-04-10 | 2019-07-12 | 吉林大学 | A kind of pilotless automobile path following control device and control method based on multiple spot tracking |
CN110316193A (en) * | 2019-07-02 | 2019-10-11 | 华人运通(上海)自动驾驶科技有限公司 | Setting method, device, equipment and the computer readable storage medium of preview distance |
CN111731381A (en) * | 2020-06-30 | 2020-10-02 | 三一专用汽车有限责任公司 | Vehicle transverse self-adaptive control method and device and vehicle |
-
2021
- 2021-01-28 CN CN202180072808.9A patent/CN116457259A/en active Pending
- 2021-01-28 WO PCT/CN2021/074201 patent/WO2022160196A1/en active Application Filing
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20130131925A1 (en) * | 2011-11-18 | 2013-05-23 | Denso Corporation | Vehicle behavior control apparatus |
CN110001637A (en) * | 2019-04-10 | 2019-07-12 | 吉林大学 | A kind of pilotless automobile path following control device and control method based on multiple spot tracking |
CN110316193A (en) * | 2019-07-02 | 2019-10-11 | 华人运通(上海)自动驾驶科技有限公司 | Setting method, device, equipment and the computer readable storage medium of preview distance |
CN111731381A (en) * | 2020-06-30 | 2020-10-02 | 三一专用汽车有限责任公司 | Vehicle transverse self-adaptive control method and device and vehicle |
Cited By (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115179935A (en) * | 2022-09-13 | 2022-10-14 | 毫末智行科技有限公司 | Path tracking method and device, electronic equipment and storage medium |
CN115480579A (en) * | 2022-10-13 | 2022-12-16 | 华侨大学 | Crawler-type mobile machine, and method, device and medium for tracking and controlling established track thereof |
CN115476881B (en) * | 2022-10-20 | 2024-06-04 | 重庆长安汽车股份有限公司 | Vehicle track tracking control method, device, equipment and medium |
CN115476881A (en) * | 2022-10-20 | 2022-12-16 | 重庆长安汽车股份有限公司 | Vehicle trajectory tracking control method, device, equipment and medium |
CN116101326B (en) * | 2023-04-12 | 2023-07-14 | 北京理工大学深圳汽车研究院(电动车辆国家工程实验室深圳研究院) | Transverse control method, device and system for automatic driving vehicle and storage medium |
CN116118751A (en) * | 2023-04-19 | 2023-05-16 | 深圳佑驾创新科技有限公司 | Control method and device for vehicle, vehicle and storage medium |
CN116118751B (en) * | 2023-04-19 | 2023-08-29 | 深圳佑驾创新科技有限公司 | Control method and device for vehicle, vehicle and storage medium |
CN116572972A (en) * | 2023-07-03 | 2023-08-11 | 中国第一汽车股份有限公司 | Transverse control method and device of vehicle, electronic equipment and storage medium |
CN116572972B (en) * | 2023-07-03 | 2024-06-14 | 中国第一汽车股份有限公司 | Transverse control method and device of vehicle, electronic equipment and storage medium |
CN116749950A (en) * | 2023-07-25 | 2023-09-15 | 云创智行科技(苏州)有限公司 | Adaptive steering judging method and device |
CN116749950B (en) * | 2023-07-25 | 2024-01-26 | 云创智行科技(苏州)有限公司 | Adaptive steering judging method and device |
CN116659481B (en) * | 2023-07-27 | 2023-11-03 | 山东曼大智能科技有限公司 | Outdoor robot course angle calibration method, system and medium based on RTK and odometer |
CN116659481A (en) * | 2023-07-27 | 2023-08-29 | 山东曼大智能科技有限公司 | Outdoor robot course angle calibration method, system and medium based on RTK and odometer |
CN117311153A (en) * | 2023-10-24 | 2023-12-29 | 酷哇科技有限公司 | Adaptive model prediction nonlinear control extended sweeping control tracking method and system |
CN117724504A (en) * | 2024-02-07 | 2024-03-19 | 北京科技大学 | Unmanned vehicle path tracking control method and device based on projection area |
CN117724504B (en) * | 2024-02-07 | 2024-04-16 | 北京科技大学 | Unmanned vehicle path tracking control method and device based on projection area |
CN118131768A (en) * | 2024-03-05 | 2024-06-04 | 无锡中鼎集成技术有限公司 | AGV curve path correction and tracking control method |
Also Published As
Publication number | Publication date |
---|---|
CN116457259A (en) | 2023-07-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
WO2022160196A1 (en) | Vehicle driving control method and apparatus, and vehicle and storage medium | |
US11531110B2 (en) | LiDAR localization using 3D CNN network for solution inference in autonomous driving vehicles | |
EP3423787B1 (en) | Method and system for updating maps based on control feedbacks of autonomous driving vehicles | |
US8090491B2 (en) | Guidance, navigation, and control system for a vehicle | |
CN109799828B (en) | Transverse and longitudinal coordination control method for automatic driving vehicle | |
US20210365712A1 (en) | Deep learning-based feature extraction for lidar localization of autonomous driving vehicles | |
US9618938B2 (en) | Field-based torque steering control | |
CN111578957B (en) | Intelligent pure vehicle tracking method based on three-dimensional point cloud map positioning | |
CN111301425B (en) | Efficient optimal control using dynamic models for autonomous vehicles | |
US20210354718A1 (en) | Lidar localization using rnn and lstm for temporal smoothness in autonomous driving vehicles | |
CN110341688B (en) | Front wheel steering angle compensation method and device, vehicle-mounted equipment and storage medium | |
CN111208814B (en) | Memory-based optimal motion planning for an automatic vehicle using dynamic models | |
CN111795692B (en) | Method and apparatus for parallel tracking and positioning via a multi-mode SLAM fusion process | |
CN111797780A (en) | Vehicle following track planning method, device, server and storage medium | |
CN113515038B (en) | Vehicle lane changing method, device, equipment and readable storage medium | |
CN112339747A (en) | Automatic parking track generation method and device, electronic equipment and storage medium | |
US20180297606A1 (en) | Automatic steering control reference adaption to resolve understeering of autonomous driving vehicles | |
CN112433531A (en) | Trajectory tracking method and device for automatic driving vehicle and computer equipment | |
JPWO2020065745A1 (en) | Travel route generator and vehicle control device | |
CN112099378B (en) | Front vehicle lateral motion state real-time estimation method considering random measurement time lag | |
CN117203108A (en) | Lane change based solely on local information | |
CN112965373A (en) | Path tracking control method for agricultural and mining articulated vehicle | |
CN112710301A (en) | High-precision positioning method and system for automatic driving vehicle | |
CN115617051A (en) | Vehicle control method, device, equipment and computer readable medium | |
CN106646569A (en) | Navigation and positioning method and device |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
121 | Ep: the epo has been informed by wipo that ep was designated in this application |
Ref document number: 21921807 Country of ref document: EP Kind code of ref document: A1 |
|
WWE | Wipo information: entry into national phase |
Ref document number: 202180072808.9 Country of ref document: CN |
|
NENP | Non-entry into the national phase |
Ref country code: DE |
|
122 | Ep: pct application non-entry in european phase |
Ref document number: 21921807 Country of ref document: EP Kind code of ref document: A1 |
|
122 | Ep: pct application non-entry in european phase |
Ref document number: 21921807 Country of ref document: EP Kind code of ref document: A1 |
|
32PN | Ep: public notification in the ep bulletin as address of the adressee cannot be established |
Free format text: NOTING OF LOSS OF RIGHTS PURSUANT TO RULE 112(1) EPC (EPO FORM 1205N DATED 19/09/2023) |