Nothing Special   »   [go: up one dir, main page]

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 PDF

Info

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
Application number
PCT/CN2021/074201
Other languages
French (fr)
Chinese (zh)
Inventor
许康熙
邓堃
徐胜亮
Original Assignee
浙江吉利控股集团有限公司
吉利汽车研究院(宁波)有限公司
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 浙江吉利控股集团有限公司, 吉利汽车研究院(宁波)有限公司 filed Critical 浙江吉利控股集团有限公司
Priority to PCT/CN2021/074201 priority Critical patent/WO2022160196A1/en
Priority to CN202180072808.9A priority patent/CN116457259A/en
Publication of WO2022160196A1 publication Critical patent/WO2022160196A1/en

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Purposes 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/18Propelling the vehicle
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Estimation 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/10Estimation 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

A vehicle driving control method, a vehicle driving control apparatus, a vehicle and a computer-readable storage medium, which belong to the technical field of vehicles. The vehicle driving control method comprises: performing path planning to acquire a tracking path; acquiring a basic preview distance according to current position information of a vehicle and the tracking path; acquiring a correction coefficient for the basic preview distance, wherein the correction coefficient comprises at least one of a speed correction coefficient, a path curvature correction coefficient and a course angle correction coefficient; acquiring a target preview distance according to the correction coefficient and the basic preview distance; and performing transverse driving control according to the target preview distance. Therefore, calculation parameters of a path following algorithm can be optimized according to the details of a driving scenario, such that the aim of optimizing a path following algorithm in a valet parking function is realized, the control accuracy during low-speed unmanned driving is improved to ensure the vehicle usage safety and the function reliability, and the usage experience of a user can thus be improved.

Description

车辆驾驶控制方法、装置、车辆及存储介质Vehicle driving control method, device, vehicle and storage medium 技术领域technical field
本申请涉及车辆技术领域,特别是涉及一种车辆驾驶控制方法、车辆驾驶控制装置、车辆及计算机可读存储介质。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.
背景技术Background technique
未来无人驾驶将逐步走进人们的生活,代客泊车可能是最先应用在量产乘用车上的无人驾驶功能,代客泊车主要是在停车场自主搜索车位并将车停入车位。In the future, unmanned driving will gradually enter people's lives. 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.
但是,在停车场地形不理想的场景下(例如部分停车场通道较窄,并且停车位也有可能会有较窄的场景),传统的代客泊车功能的使用过程中稳定性差(例如,稳态横向偏差大、稳态航向角偏差大等等),而导致传统的代客泊车功能的使用过程中稳定性差的原因之一在于,传统的代客泊车功能中提供给路径跟随算法的计算参数(例如预瞄距离)未考虑细致的驾驶场景,不能够根据细致的驾驶场景进行调整,从而导致传统的代客泊车功能中的路径跟随算法精度还不够,因此,传统的代客泊车功能中的路径跟随算法还有待优化。However, in scenarios where the terrain of the parking lot is not ideal (for example, some parking lots have narrow passageways, and the parking space may also have a narrow scene), the stability of the traditional valet parking function during use is poor (for example, stable One of the reasons for the poor stability during the use of the traditional valet parking function is that 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 preceding statements are intended to provide general background information and may not constitute prior art.
技术问题technical problem
如何优化代客泊车功能中的路径跟随算法是本领域技术人员亟需解决的问题。How to optimize the path following algorithm in the valet parking function is an urgent problem to be solved by those skilled in the art.
技术解决方案technical solutions
本申请要解决的技术问题在于,针对上述现有技术的缺陷,提供了车辆驾驶控制方法、车辆驾驶控制装置、车辆及计算机可读存储介质,以实现根据驾驶场景的细节情况优化路径跟随算法的计算参数,从而实现优化代客泊车功能中的路径跟随算法的目的,提升低速无人驾驶时的控制精度来保障用车安全性和功能的可靠性,进而能够提升用户的使用体验感。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.
可选地,根据车辆当前位置信息和跟踪路径获取基本预瞄距离的步骤中,包括:获取跟踪路径上与车辆当前位置信息对应的跟踪位置点;根据车辆当前位置信息和跟踪位置点获取横向位置偏差值;从预瞄距离对应关系信息中获取与横向位置偏差值对应的基本预瞄距离,其中,预瞄距离对应关系信息中包括至少一个横向位置偏差值与基本预瞄距离的对应关系。Optionally, in the step of obtaining the basic preview distance according to the current position information of the vehicle and the tracking path, 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.
可选地,获取针对基本预瞄距离的修正系数的步骤中,包括:获取当前车速,从速度修正系数对应关系信息中获取与当前车速对应的速度修正系数,其中,速度修正系数对应关系信息指示车速与速度修 正系数的对应关系;根据修正系数和基本预瞄距离获取目标预瞄距离的步骤中,包括:根据速度修正系数和基本预瞄距离获取第一目标预瞄距离,其中,速度修正系数和基本预瞄距离成正比关系。Optionally, 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.
可选地,获取针对基本预瞄距离的修正系数的步骤中,包括:根据基本预瞄距离确定跟踪路径上的初始预瞄点;根据车辆的前进方向和初始预瞄点对应的航向获取航向偏差角度;从航向角修正系数对应关系信息中获取与航向偏差角度和横向位置偏差值对应的航向角修正系数,其中,航向角修正系数对应关系信息指示横向位置偏差值、航向偏差角度及航向角修正系数的对应关系;根据修正系数和基本预瞄距离获取目标预瞄距离的步骤中,包括:根据航向角修正系数和基本预瞄距离获取第一目标预瞄距离,其中,航向角修正系数和基本预瞄距离成正比关系。Optionally, in the step of obtaining the correction coefficient for 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.
可选地,获取针对基本预瞄距离的修正系数的步骤中,包括:获取跟踪路径的路径曲率均值;从曲率修正系数对应关系信息中获取与路径曲率均值和横向位置偏差值对应的曲率修正系数,其中曲率修正系数对应关系信息指示横向位置偏差值、路径曲率均值及曲率修正系数的对应关系;根据修正系数和基本预瞄距离获取目标预瞄距离的步骤中,包括:根据路径曲率修正系数和基本预瞄距离获取第一目标预瞄距离,其中,路径曲率修正系数和基本预瞄距离成正比关系。Optionally, in the step of acquiring the correction coefficient for the basic preview distance, 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. , wherein 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.
可选地,获取跟踪路径的路径曲率均值的步骤中,包括:根据基本预瞄距离确定跟踪路径上的初始预瞄点;根据跟踪路径上的跟踪位置点和初始预瞄点,计算从跟踪位置点到初始预瞄点之间的路径曲率 均值。Optionally, in the step of obtaining the mean value of the path curvature of the tracking path, 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.
可选地,根据修正系数和基本预瞄距离获取目标预瞄距离的步骤中,包括:根据第一目标预瞄距离和优化修正系数获取目标预瞄距离,其中,第一目标预瞄距离和优化修正系数成正比关系;其中,优化修正系数为除第一目标预瞄距离对应的修正系数以外的修正系数。Optionally, 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.
可选地,根据目标预瞄距离进行横向驾驶控制的步骤中,包括:根据目标预瞄距离确定跟踪路径上的预瞄点;根据基于纯跟踪算法的基本原理建立的坐标系及跟踪路径上的预瞄点获取车辆预瞄角度;将目标预瞄距离和车辆预瞄角度代入转弯半径计算公式计算车辆转弯半径;根据车辆转弯半径和车辆对应的方向盘转角计算公式计算方向盘转角;根据方向盘转角对车辆的转弯系统进行控制。Optionally, in the step of performing lateral driving control according to the target preview distance, it 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.
可选地,转弯半径计算公式包括:
Figure PCTCN2021074201-appb-000001
其中,R表示车辆转弯半径,L d表示目标预瞄距离,α表示车辆预瞄角度;方向盘转角计算公式包括:StA=α 1ρ 52ρ 43ρ 34ρ 25ρ 16;其中,
Figure PCTCN2021074201-appb-000002
其中,StA表示方向盘转角,ρ表示转弯曲率,α 1、α 2、α 3、α 4、α 5、α 6均为公式系数,公式系数与车辆的车型相对应。
Optionally, the turning radius calculation formula includes:
Figure PCTCN2021074201-appb-000001
Among them, R represents the turning radius of the vehicle, L d represents the target preview distance, and α represents the vehicle preview angle; the calculation formula of the steering wheel angle includes: StA=α 1 ρ 52 ρ 43 ρ 34 ρ 25 ρ 16 ; where,
Figure PCTCN2021074201-appb-000002
Among them, 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米至3.6米。Optionally, 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.
有益效果beneficial effect
本申请提供的车辆驾驶控制方法、车辆驾驶控制装置、车辆及计算机可读存储介质,其中,车辆驾驶控制方法,包括:进行路径规划以获取跟踪路径;根据车辆当前位置信息和跟踪路径获取基本预瞄距离;获取针对基本预瞄距离的修正系数,修正系数包括速度修正系数、路径曲率修正系数、航向角修正系数中的至少一项;根据修正系数和基本预瞄距离获取目标预瞄距离;根据目标预瞄距离进行横向驾驶控制。因此,本申请能够根据驾驶场景的细节情况(例如车速、跟踪路径的路径曲率、航向角偏差角度等等)优化路径跟随算法的计算参数,从而实现优化代客泊车功能中的路径跟随算法的目的,提升低速无人驾驶时的控制精度来保障用车安全性和功能的可靠性,进而能够提升用户的使用体验感。此外,本申请能够优化路径跟随算法,以很少的计算量来达到很好的计算效果,从而在低速自动驾驶的进行泊车或者定点停车的环境下,将稳态横向偏差控制在很小的范围内(例如,±5cm以内),以及将稳态航向角偏差控制在很小的范围内(例如,±3° 以内),且即便车辆起始位置与跟踪路径有较大偏差时也可以很好的将车辆调整至跟踪路径上,收敛速度快且超调量小。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. In addition, 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.
此外,本申请还能够根据车速、跟踪路径的路径曲率、航向角偏差角度以及横向偏差来自适应调节预瞄距离,使得车辆在不同位置起始位置、不同角度的情况下快速收敛,并能够适应不同的道路曲率,且满足一定的控制精度,尤其在车辆起始偏差大的情况下有很好的控制效果,解决了在车辆起始偏差大的时候固定预瞄距离或者只根据车速调节的预瞄距离在横向控制中的一些缺点,比如容易超调、收敛速度慢、稳态误差大等。本申请可以适应不同的道路,比如:直线、直角弯、小S弯、大S弯、不同曲率的圆弧、异形弯等,即便是驾驶员随意开出的路径也可以稳定跟随,且稳态偏差较小,本申请在大偏差的情况下可以快速收敛且超调量较小。本申请不仅可以满足泊车类功能(代客泊车、全自动泊车、半自动泊车)也可以满足低速无人驾驶相关的功能(如自主无线充电、无人园区接驳车、无人园区清扫车)。由于方向盘转角与前轮转角存在非线性关系,且不同车型方向盘转角与前轮转角的非线性关系不同,本申请通过标定方向盘转角与车辆转弯半径的关系可以得到更准确的关系,这样可以取得更好的稳态跟随效果。本申请代码量小,运行效率高,可以很好的嵌入式化,对硬件要求低。In addition, 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). Since there is a nonlinear relationship between the steering wheel angle and the front wheel angle, and the nonlinear relationship between the steering wheel angle and the front wheel angle is different for different models, 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. Good steady state following effect. The application has small code size, high operating efficiency, can be well embedded, and has low hardware requirements.
为让本发明的上述和其他目的、特征和优点能更明显易懂,下文特举较佳实施例,并配合所附图式,作详细说明如下。In order to make the above-mentioned and other objects, features and advantages of the present invention more obvious and easy to understand, the preferred embodiments are exemplified below, and are described in detail as follows in conjunction with the accompanying drawings.
附图说明Description of drawings
图1是本申请第一实施例提供的车辆驾驶控制方法的流程示意图。FIG. 1 is a schematic flowchart of a vehicle driving control method provided by a first embodiment of the present application.
图2是本申请第一实施例提供的自行车模型的的第一示意图。FIG. 2 is a first schematic diagram of the bicycle model provided by the first embodiment of the present application.
图3是本申请第一实施例提供的基本预瞄距离的对应关系图。FIG. 3 is a corresponding relationship diagram of the basic preview distance provided by the first embodiment of the present application.
图4是本申请第一实施例提供的自行车模型的的第二示意图。FIG. 4 is a second schematic diagram of the bicycle model provided by the first embodiment of the present application.
图5A是本申请第一实施例提供的位置比对的第一仿真结果图。FIG. 5A is a first simulation result diagram of position comparison provided by the first embodiment of the present application.
图5B是本申请第一实施例提供的横向误差的第一变化仿真结果图。FIG. 5B is a simulation result diagram of the first variation of the lateral error provided by the first embodiment of the present application.
图6A是本申请第一实施例提供的位置比对的第二仿真结果图。FIG. 6A is a second simulation result diagram of position comparison provided by the first embodiment of the present application.
图6B是本申请第一实施例提供的横向误差的第二变化仿真结果图。FIG. 6B is a simulation result diagram of the second variation of the lateral error provided by the first embodiment of the present application.
图7A是本申请第一实施例提供的位置比对的第三仿真结果图。FIG. 7A is a third simulation result diagram of position comparison provided by the first embodiment of the present application.
图7B是本申请第一实施例提供的横向误差的第三变化仿真结果图。FIG. 7B is a simulation result diagram of the third variation of the lateral error provided by the first embodiment of the present application.
图8是本申请第一实施例提供的速度修正系数的对应关系图。FIG. 8 is a corresponding relationship diagram of the speed correction coefficient provided by the first embodiment of the present application.
图9是本申请第一实施例提供的曲率修正系数的对应关系图。FIG. 9 is a corresponding relationship diagram of curvature correction coefficients provided by the first embodiment of the present application.
图10A是本申请第一实施例提供的曲率修正前的路径跟踪的仿真结果图。FIG. 10A is a simulation result diagram of path tracking before curvature correction provided by the first embodiment of the present application.
图10B是本申请第一实施例提供的曲率修正前的横向偏差变化的仿真结果图。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.
图11A是本申请第一实施例提供的曲率修正后的路径跟踪的仿 真结果图。Fig. 11A is a simulation result diagram of path tracking after curvature correction provided by the first embodiment of the present application.
图11B是本申请第一实施例提供的曲率修正后的横向偏差变化的仿真结果图。FIG. 11B is a simulation result diagram of the lateral deviation change after curvature correction provided by the first embodiment of the present application.
图12是本申请第一实施例提供的航向角修正系数的对应关系图。FIG. 12 is a corresponding relationship diagram of the heading angle correction coefficient provided by the first embodiment of the present application.
图13A是本申请第一实施例提供的航向角修正前的弯道场景的仿真结果图。FIG. 13A is a simulation result diagram of a curve scene before heading angle correction provided by the first embodiment of the present application.
图13B是本申请第一实施例提供的航向角修正前的横向偏差变化的仿真结果图。FIG. 13B is a simulation result diagram of lateral deviation change before heading angle correction provided by the first embodiment of the present application.
图14A是本申请第一实施例提供的航向角修正后的弯道场景的仿真结果图。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.
图14B是本申请第一实施例提供的航向角修正后的横向偏差变化的仿真结果图。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.
图15A是本申请第一实施例提供的小S弯道场景的仿真结果图。FIG. 15A is a simulation result diagram of a scene of a small S-curve provided by the first embodiment of the present application.
图15B是本申请第一实施例提供的小S弯道场景的横向偏差变化的仿真结果图。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.
图16A是本申请第一实施例提供的直角弯道场景的仿真结果图。FIG. 16A is a simulation result diagram of a right-angle curve scene provided by the first embodiment of the present application.
图16B是本申请第一实施例提供的直角弯道场景的横向偏差变化的仿真结果图。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.
图17是本申请第一实施例提供的直行道路场景的综合验证结果图。FIG. 17 is a comprehensive verification result diagram of a straight road scene provided by the first embodiment of the present application.
图18是本申请第一实施例提供的大S弯道场景的综合验证结果 图。Fig. 18 is a comprehensive verification result diagram of the large S-curve scene provided by the first embodiment of the present application.
图19是本申请第一实施例提供的小S弯道场景的综合验证结果图。FIG. 19 is a comprehensive verification result diagram of the small S-curve scene provided by the first embodiment of the present application.
图20是本申请第一实施例提供的直角弯道场景的综合验证结果图。FIG. 20 is a comprehensive verification result diagram of a right-angle curve scenario provided by the first embodiment of the present application.
图21是本申请第一实施例提供的异形弯道场景的综合验证结果图。FIG. 21 is a comprehensive verification result diagram of the special-shaped curve scene provided by the first embodiment of the present application.
图22是本申请第一实施例提供的横向控制模块的示意图。FIG. 22 is a schematic diagram of a lateral control module provided by the first embodiment of the present application.
图23是本申请第二实施例提供的车辆驾驶控制装置的结构示意图。FIG. 23 is a schematic structural diagram of a vehicle driving control device provided by the second embodiment of the present application.
图24是本申请第二实施例提供的车辆的示意图。FIG. 24 is a schematic diagram of a vehicle provided by the second embodiment of the present application.
附图词汇解析:Glossary of attached drawings:
Current Point:与车辆后轴中心对应的跟踪位置点;Current Point: The tracking position point corresponding to the center of the rear axle of the vehicle;
Preview Point:预瞄点;Preview Point: preview point;
Preview Distance:预瞄距离;Preview Distance: Preview distance;
Path:跟踪路径;Path: trace path;
PathCurvature:道路曲率是指从当前点(Current 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(或Lateral Deviation Error):横向位置偏差(车辆后轴中心向所跟踪的路径上垂线距离);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:为车辆跟踪的目标路径;Target Position: the target path tracked by the vehicle;
Real Position:为车辆路径跟踪过程中的实际位置;Real Position: It is the actual position in the process of vehicle path tracking;
Distance error:横向位置偏差是指车辆后轴中心向所跟踪的路径上垂线距离,详见图2中的e yDistance error: 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:车辆的速度;Velocity: the speed of the vehicle;
Y Error:横向位置偏差;Y Error: lateral position deviation;
Odemetry:移动距离;Odemetry: moving distance;
Location Comparison:位置比较;Location Comparison: location comparison;
Yaw Comparison:航向角比较;Yaw Comparison: heading angle comparison;
Yaw Error:航向角偏差。Yaw Error: Heading angle deviation.
本发明的实施方式Embodiments of the present invention
为了使本申请的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本申请进行进一步详细说明。应当理解,所描述的实施例仅仅是本申请一部分实施例,而不是全部的实施例。基于本申请中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本申请保护的范围。In order to make the purpose, technical solutions and advantages of the present application more clearly understood, the present application will be described in further detail below with reference to the accompanying drawings and embodiments. It should be understood that the described embodiments are only a part of the embodiments of the present application, but not all of the embodiments. Based on the embodiments in the present application, all other embodiments obtained by those of ordinary skill in the art without creative efforts shall fall within the protection scope of the present application.
下面结合附图对本申请实施例做进一步详述。The embodiments of the present application will be described in further detail below with reference to the accompanying drawings.
第一实施例:First embodiment:
为了清楚的描述本申请第一实施例提供的车辆驾驶控制方法,请参见图1至图22。For a clear description of the vehicle driving control method provided by the first embodiment of the present application, please refer to FIG. 1 to FIG. 22 .
本申请第一实施例提供的车辆驾驶控制方法,包括:The vehicle driving control method provided by the first embodiment of the present application includes:
S11:进行路径规划以获取跟踪路径。S11: Perform path planning to obtain a tracking path.
在一可选实施方式中,在步骤S11:进行路径规划以获取跟踪路径中,可以包括:通过定位模块获取车辆当前位置信息,以及进行路径规划以获取跟踪路径。In an optional implementation manner, in 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.
在一可选实施方式中,定位模块可以是利用RTK差分定位技术和/或IMU进行航迹推算以提供车辆当前位置信息(或称车辆实时位置信息)和/或跟踪路径,并且其可以提供车辆的横纵向坐标。In an optional embodiment, 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差分定位技术(Real-time kinematic,RTK)又称为载波相位差分技术,这是一种新的常用的GPS测量方法,以前的静态、快速静态、动态测量都需要事后进行解算才能获得厘米级的精度,而RTK是能够在野外实时得到厘米级定位精度的测量方法,它能实时提供观测点的三维坐标,并达到厘米级的高精度;与伪距差分原理相同,由基准站通过数据链实时将其载波观测量及站坐标信息一同传送给用户站;用户站接收GPS卫星的载波相位与来自基准站的载波相位,并组成相位差分观测值进行实时处理,能实时给出厘米级的定位结果;实现载波相位差分GPS的方法分为两类:修正法和差分法,前者与伪距差分相同,基准站将载波相位修正量发送给用户站,以改正其载波相位,然后求解坐标,后者将基准站采集的载波相位发送给用户台进行求差解算坐标。前者为准RTK技术,后者为真正的RTK技术。Among them, RTK differential positioning technology (Real-time kinematic, RTK), also known as carrier phase differential technology, 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, and 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. There are two types of methods for realizing carrier phase differential GPS: the correction method and the differential method. 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,全称是inertial measurement unit,即惯性测量单元,通常由陀螺仪、加速剂和算法处理单元组成,通过对加速度和旋转角度的测量得出自体的运动轨迹,在导航中有着很重要的应用价值;我 们把传统的IMU与车身、GPS等信息融合的算法组合在一起的系统称为广义的、针对自动驾驶的IMU。GPS/IMU传感系统通过高达100Hz频率的全球定位和惯性更新数据,可以帮助自动驾驶完成定位。GPS是一个相对准确的定位用传感器,但是它的更新频率过低,仅有10Hz,不足以提供足够实时的位置更新。IMU的有着GPS所欠缺的实时性,IMU的更新频率可以达到100Hz或者更高。通过整合GPS与IMU,我们可以为车辆定位提供既准确又足够实时的位置更新。GPS和IMU组合,就是为了融合IMU的航向速度、角速度和加速度信息,来提高GPS的精度和抗干扰能力。IMU相对GPS来说,不仅能提供一些信息,还能提供补全导航信息,因为GPS本身只提供位置信息,IMU还可以提供航向姿态信息,这个在车辆控制甚至最基本的车辆控制里也会遇到的信息。因为IMU会提供不同的角度,我们可以非常敏锐实时的监测到车辆姿态的变化,可以更精准的识别一些比较复杂的路况信息。IMU的相对和绝对位置推演不依赖任何外部设备,是像飞机里的黑匣子一样的完备系统。由于IMU不需要任何外部信号,它可以被安装在汽车底盘等隐蔽位置,这样就可以避免电子或机械的攻击。Among them, 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. Application value: We call the system that combines the traditional IMU with the algorithm of information fusion such as body and GPS as a generalized IMU for autonomous driving. 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. 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. Compared with 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.
S12:根据车辆当前位置信息和跟踪路径获取基本预瞄距离。S12: Obtain the basic preview distance according to the current position information of the vehicle and the tracking path.
在一可选实施方式中,在步骤S12:根据车辆当前位置信息和跟踪路径获取基本预瞄距离中,可以包括:获取跟踪路径上与车辆当前位置信息对应的跟踪位置点;根据车辆当前位置信息和跟踪位置点获取横向位置偏差值;匹配与横向位置偏差值对应的基本预瞄距离。In an optional embodiment, in 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.
在一可选实施方式中,根据车辆当前位置信息和跟踪位置点获取横向位置偏差值的步骤中,可以包括:基于纯跟踪算法的基本原理,根据车辆当前位置信息建立坐标系,坐标系的原点对应车辆的后轴中心,坐标系的正向X轴为车辆的前进方向,坐标系的Y轴为车辆的横向方向;和/或根据坐标系和跟踪位置点获取横向位置偏差值。In an optional embodiment, in the step of obtaining the lateral position deviation value according to the current position information of the vehicle and the tracking position point, it 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.
在一可选实施方式中,本实施例中的纯跟踪算法的基本原理可以参考文章Myungwook Park,Sangwoo Lee,and Wooyong Han.Development of Steering Control System for Autonomous Vehicle Using Geometry-Based Path Tracking Algorithm[J].ETRI Journal,2015,37(3):617-625.中的基本原理。In an optional implementation, 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.
在一实施方式中,基于纯跟踪算法的基本原理,根据车辆当前位置信息建立坐标系,并根据坐标系和跟踪位置点获取横向位置偏差值的情况,例如,参加图2,以车辆后轴中心(或称后轮轴中心)建立坐标系,前进方向为正向X轴,横向方向为Y轴,将车辆简化为自行车模型,其中,T1为两后轮的简化,T2为两前轮的简化;根据定位模块提供的全局坐标系(例如整个停车场的左边或者停车场中车辆当前位置处的坐标,图中未示出)和上述坐标系得到与跟踪路径Path的相对位置,从而获取跟踪路径Path上与车辆后轴中心对应的跟踪位置点Current Point,并且能够得到车辆后轴中心至跟踪位置点Current Point的距离e y(即横向位置偏差值)。 In one embodiment, based on the basic principle of pure tracking algorithm, 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; According to the global coordinate system provided by 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) and the above coordinate system, 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 be obtained.
在一可选实施方式中,匹配与横向位置偏差值对应的基本预瞄距离的步骤中,可以包括:从预瞄距离对应关系信息中获取与横向位置 偏差值对应的基本预瞄距离。其中,预瞄距离对应关系信息中包括至少一个横向位置偏差值与基本预瞄距离的对应关系,且预瞄距离对应关系信息可以是用户或者系统根据实际需求预先设置并存储的。本实施例提供的预瞄距离对应关系信息的使用能够使得车辆从较大的横向位置偏差值收敛到跟踪路径上时,尽可能保障车辆没有超调现象,并且提升车辆跟踪至跟踪路径的稳定性。In an optional embodiment, 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. .
在一可选实施方式中,其中,预瞄距离对应关系信息中包括横向位置偏差值与基本预瞄距离的对应关系,可用公式l=f(e y)表示(其中,l表示基本预瞄距离,e y表示横向位置偏差值)。预瞄距离对应关系信息例如图3所示的对应关系,其中,最小的横向位置偏差值(Lateral Deviation,或简称e y)为0至0.1米则对应最短的基本预瞄距离(Preview Distance)为1米,横向位置偏差值超过0.5米则均对应最长的基本预瞄距离2.7米左右。 In an optional embodiment, wherein, the correspondence relationship information of the preview distance includes the corresponding relationship between the lateral position deviation value and the basic preview distance, which can be represented by the formula l=f(e y ) (wherein, l represents the basic preview distance. , e y represents the lateral position deviation value). For example, 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.
在一可选实施方式中,参见图4,得到基本预瞄距离后,可以根据基本预瞄距离确定初始预瞄点P1,确定根据车辆的前进方向与初始预瞄点P1对应的航向的夹角(即航向偏差角β μ),确定车辆的前进方向与跟踪位置点对应的航向的夹角(即初始航向偏差角β c)。 In an optional embodiment, referring to FIG. 4 , after obtaining the basic preview distance, 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 ).
在一可选实施方式中,预瞄距离对应关系信息的设置原理是,由于预瞄距离对纯跟踪算法的控制效果起着决定性作用,在车辆横向位置偏差值大的情况下,如果使用较小的预瞄距离虽然可以快速将车辆 拉回到其跟踪的路径上,但是容易超调,如果使用过大的预瞄距离时,虽然不容易超调,但是稳定到跟踪路径后的稳态误差较大,因此需要根据横向位置偏差的情况匹配合适的预瞄距离,避免发生超调以及稳定到跟踪路径后的稳态误差较大的问题。In an optional embodiment, 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. Although 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.
实验证明,初始横向位置偏差值e y=1m,初始航向偏差角β c=0°时(参见图4中的初始航向偏差角,为车辆的前进方向与跟踪位置点对应的航向的夹角),此种偏差情况下,选用预瞄距离为1m时,参见Carsim仿真结果图5A可以发现出现了超调的情况(车辆横向偏差值超调量约0.3m),因此,证明在初始横向位置偏差值e y=1m时,选用的预瞄距离(1m)不够,导致出现了超调现象,但是参见Matlab仿真结果图5B则发现上述情况下稳定到跟踪路径后的稳态误差较小(在±5cm以内)。在后续实验中,在该种偏差情况下,逐步增加预瞄距离,实验发现超调现象得到了改善,但是当该种情况下,预瞄距离增加到一定值后,则出现了稳定到跟踪路径后的稳态误差开始增大,例如,在同种偏差情况下,增加预瞄距离至2m后,参见Carsim仿真结果图6A可以看出车辆超调量虽然较小,但是参见Matlab仿真结果图6B则能够看出稳定到跟踪路径后的稳态误差较大(例如在图6A中的跟踪路径存在连续弯道路况的时候稳态误差比较大)。 Experiments have proved that when the initial lateral position deviation value e y =1m and the initial heading deviation angle β c =0° (refer to the initial heading deviation angle in Figure 4, it is the angle between the forward direction of the vehicle and the heading corresponding to the tracking position point) , under this kind of deviation, when the preview distance is 1m, see the Carsim simulation results in Figure 5A, it can be found that there is an overshoot (the overshoot of the vehicle lateral deviation value is about 0.3m). Therefore, it is proved that the initial lateral position deviation When the value of e y = 1m, the selected preview distance (1m) is not enough, resulting in overshoot phenomenon, but referring to the Matlab simulation results in Figure 5B, it is found that the steady-state error after stabilizing to the tracking path in the above situation is small (at ± within 5cm). In the follow-up experiments, in the case of this deviation, the preview distance was gradually increased, and the experiment found that the overshoot phenomenon was improved, but in this case, when the preview distance increased to a certain value, a stable to tracking path appeared. After that, the steady-state error begins to increase. For example, in the case of the same deviation, after increasing the preview distance to 2m, referring to the Carsim simulation results in Figure 6A, it can be seen that although the vehicle overshoot is small, refer to the Matlab simulation results in Figure 6B. It can be seen that the steady-state error after stabilizing to the tracking path is relatively large (for example, when the tracking path in FIG. 6A has a continuous curve condition, the steady-state error is relatively large).
通过大量的实验证明预瞄距离对横向跟踪误差的影响情况后,发现将横向位置偏差值大的时候对应一个相对较远的预瞄距离,而横向位置偏差值小的时候对应一个相对较近的预瞄距离,既能够实现减小 车辆超调量,又能够实现减小稳定到跟踪路径后的稳态误差的目的。After proving the influence of the preview distance on the lateral tracking error through a large number of experiments, it is found that when the lateral position deviation value is large, it corresponds to a relatively long preview distance, and when the lateral position deviation value is small, it corresponds to a relatively short distance. The preview distance can not only reduce the vehicle overshoot, but also reduce the steady-state error after stabilizing to the tracking path.
在一可选实施方式中,例如,使用图3所对应的的预瞄距离对应关系信息进行实验,将初始横向位置偏差值e y设置为1m,初始航向偏差角β c设置为10°,此种偏差情况下,选用的初始预瞄距离为2.7m,参见Carsim仿真结果图7A可以看出没有出现超调的情况,并且参见Matlab仿真结果图7B则能够看出稳定到跟踪路径后的稳态误差非常小。因此,通过实验数据证明本实施例提供的预瞄距离对应关系信息的使用能够使得车辆从较大的横向位置偏差值收敛到跟踪路径上时,尽可能保障车辆没有超调现象,同时大大减小了稳定到跟踪路径后的稳态误差。 In an optional embodiment, for example, using the preview distance correspondence information corresponding to FIG. 3 to conduct an experiment, the initial lateral position deviation value e y is set to 1 m, and the initial heading deviation angle β c is set to 10 °, this In the case of this deviation, the selected initial preview distance is 2.7m. Refer to the Carsim simulation results in Figure 7A to see that there is no overshoot, and refer to the Matlab simulation results in Figure 7B to see the steady state after the tracking path is stabilized. The error is very small. Therefore, it is proved by experimental data that the use of the preview distance correspondence information provided in this embodiment can make the vehicle converge from a large lateral position deviation value to the tracking path, as much as possible to ensure that the vehicle does not have an overshoot phenomenon, and at the same time greatly reduce the The steady-state error after settling to the tracking path.
S13:获取针对基本预瞄距离的修正系数,修正系数包括速度修正系数、路径曲率修正系数、航向角修正系数中的至少一项。S13: Obtain 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.
在一可选实施方式中,在步骤S13:获取针对基本预瞄距离的修正系中,可以包括:获取当前车速,从速度修正系数对应关系信息中获取与当前车速对应的速度修正系数(其中,速度修正系数对应关系信息指示车速与速度修正系数的对应关系);和/或,获取跟踪路径的路径曲率均值,从曲率修正系数对应关系信息中获取与路径曲率均值和获取的横向位置偏差值对应的曲率修正系数(其中,横向位置偏差值、路径曲率均值及曲率修正系数的对应关系);和/或,根据基本预瞄距离确定跟踪路径上的初始预瞄点,根据车辆的前进方向和初始预瞄点对应的航向获取航向偏差角度,从航向角修正系数对应关系信息中获 取与航向偏差角度和获取的横向位置偏差值对应的航向角修正系数(其中,航向角修正系数对应关系信息指示横向位置偏差值、航向偏差角度及航向角修正系数的对应关系)。In an optional embodiment, in 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. and/or, determine the initial preview point on the tracking path according to the basic preview distance, and determine the initial preview point on the tracking path according to the forward direction of the vehicle and the initial The heading corresponding to the preview point is obtained to obtain the heading deviation angle, and the heading angle correction coefficient corresponding to the heading deviation angle and the obtained lateral position deviation value is obtained from the heading angle correction coefficient correspondence information (wherein, 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).
在一可选实施方式中,获取当前车速,从速度修正系数对应关系信息中获取与当前车速对应的速度修正系数的步骤中,速度修正系数对应关系信息包括车速度与速度修正系数的对应关系,可以用关系公式ψ v=f(v)表示(ψ v表示速度修正系数,v表示车度)。 In an optional embodiment, the current vehicle speed is obtained, and in the step of obtaining the speed correction coefficient corresponding to the current vehicle speed from the speed correction coefficient correspondence information, the speed correction coefficient correspondence information includes the corresponding relationship between the vehicle speed and the speed correction coefficient, It can be expressed by the relational formula ψ v =f(v) (ψ v represents the speed correction coefficient, and v represents the vehicle degree).
在一可选实施方式中,速度修正系数对应关系信息的设置原理可以是,由于转向系统的延迟,在车速升高时,预瞄距离应相应的增大,故需要在基本预瞄距离的基础上增加速度修正系数ψ v。速度修正系数对应关系信息中车速与速度修正系数ψ v的对应关系可以参考图8,在车速小于2.5Km/h,无需进行修正,此时速度修正系数ψ v设置为1;在车速大于2.5Km/h,则开始需要进行修正,此时选取大于1的速度修正系数ψ v进行修正。 In an optional embodiment, 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. When the vehicle speed is less than 2.5Km/h, no correction is required. At this time, 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.
在一可选实施方式中,获取跟踪路径的路径曲率均值,从曲率修正系数对应关系信息中获取与路径曲率均值和获取的横向位置偏差值对应的曲率修正系数的步骤中,曲率修正系数对应关系信息包括横向位置偏差值、路径曲率均值及曲率修正系数的对应关系,可以用关系公式ψ c=f(C a,e y)表示(C a表示路径曲率均值,e y表示横向位置 偏差值,ψ c表示曲率修正系数)。 In an optional embodiment, 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 information includes the corresponding relationship between the lateral position deviation value, the path curvature mean value and the curvature correction coefficient, which can be expressed by the relational formula ψ c =f(C a , e y ) (C a means the path curvature mean value, e y means the lateral position deviation value, ψ c represents the curvature correction coefficient).
在一可选实施方式中,曲率修正系数对应关系信息的设置原理可以是,为了让车辆在横向位置偏差值较大的起始车辆位置能够快速的收敛到跟踪路径上,且不会发生过大的超调,预瞄距离还应根据跟踪路径上的曲率和横向位置偏差值进行调整,在跟踪路径曲率小的时候让预瞄距离短一些,使车辆尽快的回归到路径上,当跟踪路径曲率较大的时候预瞄距离应长一些防止在某些情况下发生超调,故需要在以上的基础上增加曲率修正系数ψ C,由于车辆稳定跟踪后不需要再跟路径曲率存在一定的关系,所以在车辆稳定跟踪后应将曲率修正系数ψ C置为1,根据以上特性可得路径曲率C、横向位置偏差值e y与系数ψ C关系,见图9。 In an optional embodiment, 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 When the tracking path curvature is small, the preview distance should be shorter, so that the vehicle can return to the path as soon as possible. When it is larger, 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.
在一可选实施方式中,获取跟踪路径的路径曲率均值,从曲率修正系数对应关系信息中获取与路径曲率均值和获取的横向位置偏差值对应的曲率修正系数的步骤中,可以包括:根据基本预瞄距离确定跟踪路径上的初始预瞄点;根据跟踪路径上的跟踪位置点和初始预瞄点,计算从所述跟踪位置点到所述初始预瞄点之间的所述路径曲率均值。In an optional embodiment, the path curvature mean value of the tracking path is obtained, and 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.
在一可选实施方式中,根据跟踪路径上的跟踪位置点和初始预瞄点,计算从跟踪位置点到初始预瞄点之间的路径曲率均值的步骤中,可以包括:获取跟踪路径上的跟踪位置点到初始预瞄点之间的位置点 的个数以及每个位置点的曲率;通过曲率均值计算公式根据位置点的个数及每个位置点的曲率计算路径曲率均值(即该路径曲率可以为从跟踪位置点到初始预瞄点之间的路径曲率均值)。In an optional implementation manner, according to the tracking position point and the initial preview point on the tracking path, in the step of calculating the mean value of the path curvature between the tracking position point and the initial preview point, it 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).
在一可选实施方式中,路径曲率均值计算公式包括:
Figure PCTCN2021074201-appb-000003
其中,C 1、C 2...C n均表示路径上某个位置点的曲率,n表示跟踪位置点到初始预瞄点之间的位置点的个数。
In an optional embodiment, the formula for calculating the mean value of path curvature includes:
Figure PCTCN2021074201-appb-000003
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.
在一可选实施方式中,以车辆所跟踪的直角弯路径为例,比较曲率修正前与修正后的收敛距离,例如,以相同的车辆起始横向位置偏差值、相同车速进行车辆横向控制,根据曲率修正前的路径跟踪的仿真结果图10A和曲率修正后的路径跟踪的仿真结果图11A可以看出曲率修正后表现出更快的收敛速度,根据曲率修正前的横向偏差变化的仿真结果图10B和曲率修正前的横向偏差变化的仿真结果图11B可以看出,曲率修正前在里程为7.5m左右的时候全部达到稳定,曲率修正后在里程为5.5m左右全部达到稳定,曲率修正后要比曲率修正前到达稳定的距离缩短了2m左右,因此曲率修正后实现稳定的路径跟踪的速度更快。In an optional embodiment, taking the right-angle curved path tracked by the vehicle as an example, 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. 10B and the simulation results of the lateral deviation change before the curvature correction, it can be seen from Figure 11B that before the curvature correction, the mileage is about 7.5m, and the mileage is about 5.5m after the curvature correction. It is about 2m shorter than the distance to stability before curvature correction, so it is faster to achieve stable path tracking after curvature correction.
在一可选实施方式中,根据基本预瞄距离确定初始预瞄点,根据车辆的前进方向和初始预瞄点对应的航向获取航向偏差角度,从航向角修正系数对应关系信息中获取与航向偏差角度和获取的横向位置偏差值对应的航向角修正系数的步骤中,航向角修正系数对应关系信息包括横向位置偏差值、航向偏差角度及航向角修正系数的对应关 系,可以用关系公式ψ a=f(β p,e y)表示(其中,e y表示横向位置偏差值,β p表示航向偏差角度,ψ a表示航向角修正系数)。航向角修正系数对应关系信息对应的关系图,可以参考图12。 In an optional embodiment, 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, and the heading deviation is obtained from the corresponding relationship information of the heading angle correction coefficient. In the step of the angle and the heading angle correction coefficient corresponding to the obtained lateral position deviation value, the corresponding relationship information of the heading angle correction coefficient includes the corresponding relationship between the lateral position deviation value, the heading deviation angle and the heading angle correction coefficient, and the relational formula ψ a = f(β p , e y ) represents (where e y represents the lateral position deviation value, β p represents the heading deviation angle, and ψ a represents the heading angle correction coefficient). For the relationship diagram corresponding to the corresponding relationship information of the heading angle correction coefficient, please refer to FIG. 12 .
在一可选实施方式中,航向角修正系数对应关系信息设置原理可以是,由于车辆的起始位置有时候会在弯道处,此时当车辆航向角与路径上预瞄点的航向角偏差β μ过大时容易发生超调,因此需要设置航向角修正系数进行调试,以避免航向角偏差β μ过大时发生超调。以直角弯为例,参见弯道仿真结果图13A,横向位置偏差为(13,1),初始航向偏差角度β c分别为[10,-10,5,-5,0]度的仿真结果,从横向位置偏差变化图13B,这些工况均出现了超调现象。这些工况主要是因为车辆的前进方向与初始预瞄点对应的航向形成的航向偏差角度β p过大导致,因此,为了能够让车辆在不同的起始偏差(不同的起始横向位置偏差、不同的初始航向偏差角)以及在所跟踪路径临近点的不同曲率均能够稳定收敛且不超调,增加了航向角修正系数ψ a,此航向角修正系数ψ a不仅与初始预瞄点对应的航向偏差角β p相关,还与车辆是否在弯道内侧还是弯道外侧有关,在弯道内侧时初始预瞄点对应的航向偏差角β p越大,车辆预瞄距离也应越大,使得车辆提前转弯不至 于超调,在弯道外侧时初始预瞄点对应的航向偏差角β μ越大,车辆预瞄距离应越小,使得车辆尽快收敛到所跟踪路径上。由于车辆在稳定跟踪后不需要再根据初始预瞄点对应的航向偏差角β p进行预瞄距离的调节,此时航向角修正系数ψ a应置为1,基于以上特性得出β p、e y、ψ a关系图12。其中,初始预瞄点对应的航向偏差角β p的正负取决于车辆在弯道内侧还是在弯道外侧,以及车辆航向角与预瞄点航向角夹角的正负。 In an optional embodiment, 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. Taking a right-angle bend as an example, see Fig. 13A of the curve simulation results, the lateral position deviation is (13, 1), and the initial heading deviation angle β c is [10, -10, 5, -5, 0] degrees respectively. From the variation of the lateral position deviation in Figure 13B, the overshoot phenomenon appears in these working conditions. These working conditions are mainly caused by the excessively large heading deviation angle β p formed by the heading of the vehicle and the heading corresponding to the initial preview point. Different initial heading deviation angles) and different curvatures at the adjacent points of the tracked path can be stably converged without overshoot, and the heading angle correction coefficient ψ a is added. This heading angle correction coefficient ψ a not only corresponds to the initial preview point. The heading deviation angle β p is related, and it is also related to whether the vehicle is on the inside of the curve or the outside of the curve. When the initial preview point is on the inside of the curve, the larger the heading deviation angle β p is, the larger the vehicle preview distance should be, so that The vehicle turns in advance without overshooting. The larger the heading deviation angle β μ corresponding to the initial preview point on the outside of the curve, the smaller the vehicle preview distance should be, so that the vehicle can converge to the tracked path as soon as possible. Since the vehicle does not need to adjust the preview distance according to the heading deviation angle β p corresponding to the initial preview point after stable tracking, 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. Among them, 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.
修正前的车辆控制效果图参见图13A和图13B,修正后的车辆控制效果参见图14A和图15B,从图中可以看出,修正前超调量最高超过了10cm但低于20cm,修正后超调量均在5cm以下,能够满足将稳态横向偏差控制在±5cm以内的行业渴望实现的控制要求。See Figure 13A and Figure 13B for the vehicle control effect diagram before correction, and Figure 14A and Figure 15B for the vehicle control effect after correction. It can be seen from the figure that the overshoot amount before correction is more than 10cm but less than 20cm. The overshoot is all below 5cm, which can meet the control requirements that the industry desires to control the steady-state lateral deviation within ±5cm.
S14:根据修正系数和基本预瞄距离获取目标预瞄距离。S14: Obtain the target preview distance according to the correction coefficient and the basic preview distance.
在第一可选实施方式中,在步骤S14:根据修正系数和基本预瞄距离获取目标预瞄距离中,可以包括:根据所述速度修正系数和所述基本预瞄距离获取第一目标预瞄距离,其中,所述速度修正系数和所述基本预瞄距离成正比关系。其中,第一目标预瞄距离获取公式例如:L d′=ψ vl;其中,L d′表示第一目标预瞄距离,ψ v表示速度修正系数,l表示基本预瞄距离。 In a first optional embodiment, in 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. The formula for obtaining the first target preview distance is for example: L d ′=ψ v l; wherein, L d ′ represents the first target preview distance, ψ v represents the speed correction coefficient, and l represents the basic preview distance.
在第二可选实施方式中,在步骤S14:根据修正系数和基本预瞄距 离获取目标预瞄距离中,可以包括:根据航向角修正系数和基本预瞄距离获取第一目标预瞄距离,其中,航向角修正系数和基本预瞄距离成正比关系。其中,第一目标预瞄距离获取公式例如:L d′=ψ al;其中,L d′表示第一目标预瞄距离,ψ a表示航向角修正系数,l表示基本预瞄距离。 In a second optional embodiment, in 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. The formula for obtaining the first target preview distance is for example: L d ′=ψ a l; wherein, L d ′ represents the first target preview distance, ψ a represents the heading angle correction coefficient, and l represents the basic preview distance.
在第三可选实施方式中,在步骤S14:根据修正系数和基本预瞄距离获取目标预瞄距离中,可以包括:根据所述路径曲率修正系数和所述基本预瞄距离获取第一目标预瞄距离,其中,所述路径曲率修正系数和所述基本预瞄距离成正比关系。其中,第一目标预瞄距离获取公式例如:L d′=ψ Cl;其中,L d′表示第一目标预瞄距离,ψ C表示路径曲率修正系数,l表示基本预瞄距离。 In a third optional embodiment, in 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. The formula for obtaining the first target preview distance is for example: L d ′=ψ C l; wherein, L d ′ represents the first target preview distance, ψ C represents the path curvature correction coefficient, and l represents the basic preview distance.
在一可选实施方式中,在步骤S14:根据修正系数和基本预瞄距离获取目标预瞄距离中,可以包括:根据第一目标预瞄距离和优化修正系数获取目标预瞄距离,其中,第一目标预瞄距离和优化修正系数成正比关系;其中,优化修正系数为除第一目标预瞄距离对应的修正系数以外的修正系数。例如,第一目标预瞄距离获取公式为L d′=ψ vl,其中,ψ v为修正系数,优化修正系数可以包括ψ C、ψ a中的至少一种,因此,预瞄距离修正公式包括:L d=ψ CL d′,或者L d=ψ aL d′,或者 L d=ψ cψ aL d′。 In an optional embodiment, in 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. For example, the first target preview distance acquisition formula is L d ′=ψ v l, where ψ v is a correction coefficient, and the optimized correction coefficient may include at least one of ψ C and ψ a . Therefore, the preview distance correction formula Including: L dC L d ', or L da L d ', or L dc ψ a L d '.
在第四可选实施方式中,在步骤S14:根据修正系数和基本预瞄距离获取目标预瞄距离中,可以包括:将速度修正系数、路径曲率修正系数、航向角修正系数及基本预瞄距离代入预瞄距离修正公式以获取目标预瞄距离;预瞄距离修正公式包括:L d=ψ vψ Cψ al;其中,L d表示目标预瞄距离,ψ v表示速度修正系数,ψ C表示路径曲率修正系数,ψ a表示航向角修正系数,l表示基本预瞄距离。 In the fourth optional embodiment, in step S14: obtaining the target preview distance according to the correction coefficient and the basic preview distance, it may include: combining the speed correction coefficient, the path curvature correction coefficient, the heading angle correction coefficient and the basic preview distance Substitute into the preview distance correction formula to obtain the target preview distance; the preview distance correction formula includes: L dv ψ C ψ a l; Wherein, L d represents the target preview distance, ψ v represents the speed correction coefficient, ψ C Represents the path curvature correction coefficient, ψ a represents the heading angle correction coefficient, and l represents the basic preview distance.
在一可选实施方式中,通过预瞄距离修正公式得到的目标预瞄距离在限定距离范围内,限定距离范围为1米至3.6米。通过预瞄距离修正公式得到的目标预瞄距离在限定距离范围内,能够使得车辆进行横向控制时能够稳定跟踪至跟踪路径,并且在收敛到跟踪路径时几乎无超调现象。In an optional embodiment, 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.
S15:根据目标预瞄距离进行横向驾驶控制。S15: Perform lateral driving control according to the target preview distance.
在一可选实施方式中,在步骤S15:根据目标预瞄距离进行横向驾驶控制中,可以包括:根据第一目标预瞄距离或者对第一目标预瞄距离进行优化得到的目标预瞄距离进行横向驾驶控制。In an optional embodiment, in 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.
在一可选实施方式中,在步骤S15:根据目标预瞄距离进行横向驾驶控制中,可以包括:根据目标预瞄距离确定跟踪路径上的预瞄点;根据基于纯跟踪算法的基本原理建立的坐标系及跟踪路径上的预瞄点获取车辆预瞄角度(例如,根据坐标系的原点、正向X轴跟踪路 径上的预瞄点获取车辆预瞄角度);将目标预瞄距离和车辆预瞄角度代入转弯半径计算公式计算车辆转弯半径;根据车辆转弯半径和车辆对应的方向盘转角计算公式计算方向盘转角;根据方向盘转角对车辆的转弯系统进行控制。In an optional embodiment, in 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.
在一可选实施方式中,转弯半径计算公式包括:
Figure PCTCN2021074201-appb-000004
其中,R表示车辆转弯半径,L d表示目标预瞄距离,α表示车辆预瞄角度;方向盘转角计算公式包括:StA=α 1ρ 52ρ 43ρ 34ρ 25ρ 16;其中,
Figure PCTCN2021074201-appb-000005
其中,StA表示方向盘转角,ρ表示转弯曲率,α 1、α 2、α 3、α 4、α 5、α 6均为公式系数,公式系数与车辆的车型相对应。与车辆的车型的公式系数,例如,X车型,α 1为38102.13、α 2为813.06、α 3为-10202.81、α 4为-39.63、α 5为2472.84、α 6为-0.29。
In an optional embodiment, the calculation formula of the turning radius includes:
Figure PCTCN2021074201-appb-000004
Among them, R represents the turning radius of the vehicle, L d represents the target preview distance, and α represents the vehicle preview angle; the calculation formula of the steering wheel angle includes: StA=α 1 ρ 52 ρ 43 ρ 34 ρ 25 ρ 16 ; where,
Figure PCTCN2021074201-appb-000005
Among them, 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. 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.
在一可选实施方式中,将本实施例提供的车辆驾驶控制方法应用于车辆后,参见图15A和图15B,在跟踪路径为小S弯道路径时,车辆在不同起始位置偏差、不同的起始航向偏差角、不同的道路曲率均能够稳定收敛,且几乎无超调,达到将稳态横向偏差控制在±5cm以内,稳态航向角偏差控制在±3°以内的行业渴望达到的控制要求。参见图16A和图16B,在跟踪路径为直角弯道路径时,车辆在不同起始位置偏差、不同的起始航向偏差角、不同的道路曲率均能够稳定收 敛,且几乎无超调,达到将稳态横向偏差控制在±5cm以内,稳态航向角偏差控制在±3°以内的行业渴望达到的控制要求。In an optional implementation manner, after 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. 16B, 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°.
本实施例提供的车辆驾驶控制方法应用于车辆后,对直行道路、大S弯道、小S弯道、直角弯道以及异形弯道进行实车验证。对于直行道路的实车验证结果可以参考图17、对于大S弯道的实车验证结果可以参考图18、对于小S弯道的实车验证结果可以参考图19、对于直角弯道的实车验证结果可以参考图20、对于异形弯道的实车验证结果可以参考图21,根据图17至图21可知,在直行道路、大S弯道、小S弯道、直角弯道或异形弯道上,不同的起始偏差,稳定跟踪后横向位置误差均小于±5cm,航向角偏差也在±3°以内。因此,本实施例本实施例提供的车辆驾驶控制方法应用于车辆后,能够适应不同道路以及不同的起始偏差,保证稳定跟踪后横向位置误差均小于±5cm,航向角偏差也在±3°以内,达到行业渴望达到的控制要求。After the vehicle driving control method provided in this embodiment is applied to a vehicle, real-vehicle verification is performed on straight roads, large S curves, small S curves, right-angle curves, and special-shaped curves. For the real vehicle verification results of the straight road, please refer to Figure 17, for the real vehicle verification results of the big S curve, please refer to Figure 18, for the real vehicle verification results of the small S curve, please refer to Figure 19, for the real vehicle verification results of the right angle curve For the verification results, please refer to Figure 20. For the real vehicle verification results of special-shaped curves, please refer to Figure 21. According to Figures 17 to 21, it can be seen that on straight roads, large S curves, small S curves, right-angle curves or special-shaped curves , Different starting deviations, the lateral position error after stable tracking is less than ±5cm, and the heading angle deviation is also within ±3°. Therefore, after the vehicle driving control method provided in this embodiment is applied to a vehicle, it can adapt to different roads and different starting deviations, and ensure that the lateral position errors after stable tracking are all less than ±5cm, and the heading angle deviation is also ±3° To meet the control requirements that the industry aspires to achieve.
在一可选实施方式中,本实施例提供的车辆驾驶控制方法可以应用于车辆中的横向控制模块,可选地,横向控制模块可以执行步骤S12至步骤S15。参见图22,横向控制模块获取跟踪路径、车辆当前位置信息以及车速等信息,然后进行横向位置偏差计算、曲率计算、车辆航向角计算,根据前述计算结果匹配基本预瞄距离及其修正系数,并得到目标预瞄距离以实现自行应预瞄距离,将得到的目标预瞄距离传输至横向控制模块中的纯跟踪单元,通过纯跟踪单元计算出控制参数(例如方向盘转角信息)发送给车辆的执行器实现横向驾驶控制。In an optional implementation manner, 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. Referring to Figure 22, 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.
本申请第一实施例提供的车辆驾驶控制方法,包括:S11:进行路径规划以获取跟踪路径。S12:根据车辆当前位置信息和跟踪路径获取基本预瞄距离。S13:获取针对基本预瞄距离的修正系数,修正系数包括速度修正系数、路径曲率修正系数、航向角修正系数中的至少一项。S14:根据修正系数和基本预瞄距离获取目标预瞄距离。S15:根据目标预瞄距离进行横向驾驶控制。因此,申请第一实施例提供的车辆驾驶控制方法能够根据驾驶场景的细节情况(例如车速、跟踪路径的路径曲率、航向角偏差角度等等)优化路径跟随算法的计算参数,从而实现优化代客泊车功能中的路径跟随算法的目的,提升低速无人驾驶时的控制精度来保障用车安全性和功能的可靠性,进而能够提升用户的使用体验感。此外,申请第一实施例提供的车辆驾驶控制方法能够优化路径跟随算法,以很少的计算量来达到很好的计算效果,从而在低速自动驾驶的进行泊车或者定点停车的环境下,将稳态横向偏差控制在很小的范围内(例如,±5cm以内),以及将稳态航向角偏差控制在很小的范围内(例如,±3°以内),且即便车辆起始位置与跟踪路径有较大偏差时也可以很好的将车辆调整至跟踪路径上,收敛速度快且超调量小。The vehicle driving control method provided by the first embodiment of the present application includes: S11: Perform path planning to obtain a tracking path. S12: Obtain the basic preview distance according to the current position information of the vehicle and the tracking path. S13: Obtain 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. 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. Therefore, 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. In addition, 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.
此外,申请第一实施例提供的车辆驾驶控制方法还能够根据车速、跟踪路径的路径曲率、航向角偏差角度以及横向偏差来自适应调节预瞄距离,使得车辆在不同位置起始位置、不同角度的情况下快速收敛,并能够适应不同的道路曲率,且满足一定的控制精度,尤其在车辆起始偏差大的情况下有很好的控制效果,解决了在车辆起始偏差 大的时候固定预瞄距离或者只根据车速调节的预瞄距离在横向控制中的一些缺点,比如容易超调、收敛速度慢、稳态误差大等。申请第一实施例提供的车辆驾驶控制方法可以适应不同的道路,比如:直线、直角弯、小S弯、大S弯、不同曲率的圆弧、异形弯等,即便是驾驶员随意开出的路径也可以稳定跟随,且稳态偏差较小,申请第一实施例提供的车辆驾驶控制方法在大偏差的情况下可以快速收敛且超调量较小。申请第一实施例提供的车辆驾驶控制方法不仅可以满足泊车类功能(代客泊车、全自动泊车、半自动泊车)也可以满足低速无人驾驶相关的功能(如自主无线充电、无人园区接驳车、无人园区清扫车)。由于方向盘转角与前轮转角存在非线性关系,且不同车型方向盘转角与前轮转角的非线性关系不同,申请第一实施例提供的车辆驾驶控制方法通过标定方向盘转角与车辆转弯半径的关系可以得到更准确的关系,这样可以取得更好的稳态跟随效果。申请第一实施例提供的车辆驾驶控制方法被计算机执行时代码量小,运行效率高,可以很好的嵌入式化,对硬件要求低。In addition, 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). Since there is a nonlinear relationship between the steering wheel angle and the front wheel angle, and the nonlinear relationship between the steering wheel angle and the front wheel angle is different for different vehicle models, 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. When 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.
第二实施例:Second embodiment:
图23是本申请第二实施例提供的车辆驾驶控制装置的结构示意图。为了清楚的描述本申请第二实施例提供的车辆驾驶控制装置1,请参见图23。FIG. 23 is a schematic structural diagram of a vehicle driving control device provided by the second embodiment of the present application. For a clear description of the vehicle driving control device 1 provided by the second embodiment of the present application, please refer to FIG. 23 .
本申请第二实施例提供的车辆驾驶控制装置1,包括:处理器A101及存储器A201,其中,处理器A101用于执行存储器A201中存储的计算机程序A6以实现如第一实施例所描述的车辆驾驶控制方 法的步骤。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.
在一实施方式中,本实施例提供的车辆驾驶控制装置1可以包括至少一个处理器A101,以及至少一个存储器A201。其中,至少一个处理器A101可以称为处理单元A1,至少一个存储器A201可以称为存储单元A2。具体地,存储单元A2存储有计算机程序A6,当该计算机程序A6被处理单元A1执行时,使得本实施例提供的车辆驾驶控制装置1实现如第一实施例所描述的车辆驾驶控制方法的步骤,例如,图1中所示的S11:进行路径规划以获取跟踪路径;S12:根据车辆当前位置信息和跟踪路径获取基本预瞄距离;S13:获取针对基本预瞄距离的修正系数,修正系数包括速度修正系数、路径曲率修正系数、航向角修正系数中的至少一项;S14:根据修正系数和基本预瞄距离获取目标预瞄距离;S15:根据目标预瞄距离进行横向驾驶控制。In one embodiment, the vehicle driving control device 1 provided in this embodiment may include at least one processor A101 and at least one memory A201. Wherein, at least one processor A101 may be referred to as a processing unit A1, and at least one memory A201 may be referred to as a storage unit A2. Specifically, the storage unit A2 stores a computer program A6. When the computer program A6 is executed by the processing unit A1, 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. 1: 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.
在一实施方式中,本实施例中的提供的车辆驾驶控制装置1可以包括多个存储器A201(简称为存储单元A2)。In one embodiment, 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).
其中,存储单元A2可以是易失性存储器或非易失性存储器,也可包括易失性和非易失性存储器两者。其中,非易失性存储器可以是只读存储器(ROM,Read Only Memory)、可编程只读存储器(PROM,Programmable Read-Only Memory)、可擦除可编程只读存储器(EPROM,Erasable Programmable Read-Only Memory)、电可擦除可编程只读存储器(EEPROM,Electrically Erasable Programmable Read-Only Memory)、磁性随机存取存储器(FRAM,ferromagnetic random access memory)、快闪存储器(Flash Memory)、磁表面存储 器、光盘、或只读光盘(CD-ROM,Compact Disc Read-Only Memory);磁表面存储器可以是磁盘存储器或磁带存储器。易失性存储器可以是随机存取存储器(RAM,Random Access Memory),其用作外部高速缓存。通过示例性但不是限制性说明,许多形式的RAM可用,例如静态随机存取存储器(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,Enhanced Synchronous Dynamic Random Access Memory)、同步连接动态随机存取存储器(SLDRAM,SyncLink Dynamic Random Access Memory)、直接内存总线随机存取存储器(DRRAM,Direct Rambus Random Access Memory)。本申请实施例描述的存储单元A2旨在包括但不限于这些和任意其它适合类型的存储器。The storage unit A2 may be a volatile memory or a non-volatile memory, and may also include both volatile and non-volatile memories. Among them, 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. Volatile memory may be Random Access Memory (RAM), which acts as an external cache. By way of example and not limitation, many forms of RAM are available, such as Static Random Access Memory (SRAM), Synchronous Static Random Access Memory (SSRAM), Dynamic Random Access Memory Memory (DRAM, Dynamic Random Access Memory), Synchronous Dynamic Random Access Memory (SDRAM, Synchronous Dynamic Random Access Memory), Double Data Rate Synchronous Dynamic Random Access Memory (DDRSDRAM, Double Data Rate Synchronous Dynamic Random Access Memory), Enhanced Type Synchronous Dynamic Random Access Memory (ESDRAM, Enhanced Synchronous Dynamic Random Access Memory), Synchronous Link Dynamic Random Access Memory (SLDRAM, SyncLink Dynamic Random Access Memory), Direct Memory Bus 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.
在一实施方式中,车辆驾驶控制装置1还包括连接不同组件(例如处理器A101和存储器A201等等)的总线。In one embodiment, the vehicle driving control device 1 also includes a bus connecting different components (eg, the processor A101 and the memory A201, etc.).
在一实施方式中,本实施例中的车辆驾驶控制装置1还可以包括通信接口(例如I/O接口A3),该通信接口可以用于与外部设备进行通信。In one embodiment, 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.
在一实施方式中,本实施例提供的终端1还可以包括通信装置 A5。In an embodiment, the terminal 1 provided in this embodiment may further include a communication apparatus A5.
本申请第二实施例提供的车辆驾驶控制装置1,包括存储器A101和处理器A201,且处理器A101用于执行存储器A201中存储的计算机程序A6以实现如第一实施例所描述的车辆驾驶控制方法的步骤,因此,本实施例提供的车辆驾驶控制装置1能够根据驾驶场景的细节情况优化路径跟随算法的计算参数,从而实现优化代客泊车功能中的路径跟随算法的目的,提升低速无人驾驶时的控制精度来保障用车安全性和功能的可靠性,进而能够提升用户的使用体验感。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.
本申请第二实施例还提供了一种计算机可读存储介质,该计算机可读存储介质存储有计算机程序A6,该计算机程序A6被处理器A101执行时实现如第一实施例中的车辆驾驶控制方法的步骤,例如图1所示的步骤S11至步骤S15。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 .
在一实施方式中,本实施例提供能的计算机可读存储介质可以包括能够携带计算机程序代码的任何实体或装置、记录介质,例如,ROM、RAM、磁盘、光盘、闪存等。In one embodiment, 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.
本申请第二实施例提供的计算机可读存储介质中存储的计算机程序A6被处理器A101执行时能够根据驾驶场景的细节情况优化路径跟随算法的计算参数,从而实现优化代客泊车功能中的路径跟随算法的目的,提升低速无人驾驶时的控制精度来保障用车安全性和功能的可靠性,进而能够提升用户的使用体验感。When the computer program A6 stored in the computer-readable storage medium provided by the second embodiment of the present application is executed by the processor A101, 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.
本申请第二实施例还提供了一种车辆,参见图24,该车辆包括如上所描述的车辆教室控制装置或者横向控制模块,从而本申请第二 实施例提供的车辆能够根据驾驶场景的细节情况优化路径跟随算法的计算参数,从而实现优化代客泊车功能中的路径跟随算法的目的,提升低速无人驾驶时的控制精度来保障用车安全性和功能的可靠性,进而能够提升用户的使用体验感。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.
以上所述实施例的各技术特征可以进行任意的组合,为使描述简洁,未对上述实施例中的各个技术特征所有可能的组合都进行描述,然而,只要这些技术特征的组合不存在矛盾,都应当认为是本说明书记载的范围。The technical features of the above-described embodiments can be combined arbitrarily. For the sake of brevity, all possible combinations of the technical features in the above-described embodiments are not described. However, as long as there is no contradiction between the combinations of these technical features, All should be regarded as the scope described in this specification.
需要说明的是,在本文中,术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含,从而使得包括一系列要素的过程、方法、物品或者装置不仅包括那些要素,而且还包括没有明确列出的其他要素,或者是还包括为这种过程、方法、物品或者装置所固有的要素。在没有更多限制的情况下,由语句“包括一个……”限定的要素,并不排除在包括该要素的过程、方法、物品或者装置中还存在另外的相同要素,此外,本申请不同实施例中具有同样命名的部件、特征、要素可能具有相同含义,也可能具有不同含义,其具体含义需以其在该具体实施例中的解释或者进一步结合该具体实施例中上下文进行确定。It should be noted that, herein, the terms "comprising", "comprising" or any other variation thereof are intended to encompass non-exclusive inclusion, such that a process, method, article or device comprising a series of elements includes not only those elements, It also includes other elements not expressly listed or inherent to such a process, method, article or apparatus. Without further limitation, an element defined by the phrase "comprises a..." does not preclude the presence of additional identical elements in the process, method, article, or device that includes the element, and further, different implementations of the present application Components, features and elements with the same names in the examples may have the same meaning or may have different meanings, and their specific meanings need to be determined by their explanations in this specific embodiment or further combined with the context in this specific embodiment.
应当理解,尽管在本文可能采用术语第一、第二、第三等来描述各种信息,但这些信息不应限于这些术语。这些术语仅用来将同一类型的信息彼此区分开。例如,在不脱离本文范围的情况下,第一信息也可以被称为第二信息,类似地,第二信息也可以被称为第一信息。 取决于语境,如在此所使用的词语"如果"可以被解释成为"在……时"或"当……时"或"响应于确定"。再者,如同在本文中所使用的,单数形式“一”、“一个”和“该”旨在也包括复数形式,除非上下文中有相反的指示。应当进一步理解,术语“包含”、“包括”表明存在所述的特征、步骤、操作、元件、组件、项目、种类、和/或组,但不排除一个或多个其他特征、步骤、操作、元件、组件、项目、种类、和/或组的存在、出现或添加。此处使用的术语“或”和“和/或”被解释为包括性的,或意味着任一个或任何组合。因此,“A、B或C”或者“A、B和/或C”意味着“以下任一个:A;B;C;A和B;A和C;B和C;A、B和C”。仅当元件、功能、步骤或操作的组合在某些方式下内在地互相排斥时,才会出现该定义的例外。It should be understood that although the terms 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. For example, 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. Also, as used herein, the singular forms "a," "an," and "the" are intended to include the plural forms as well, unless the context dictates otherwise. It should be further understood that the terms "comprising", "comprising" indicate the presence of stated features, steps, operations, elements, components, items, kinds, and/or groups, but do not exclude one or more other features, steps, operations, The existence, appearance or addition of elements, assemblies, items, categories, and/or groups. The terms "or" and "and/or" as used herein are to be construed to be inclusive or to mean any one or any combination. Thus, "A, B or C" or "A, B and/or C" means "any of the following: A; B; C; A and B; A and C; B and C; A, B and C" . Exceptions to this definition arise only when combinations of elements, functions, steps, or operations are inherently mutually exclusive in some way.
应该理解的是,虽然本申请实施例中的流程图中的各个步骤按照箭头的指示依次显示,但是这些步骤并不是必然按照箭头指示的顺序依次执行。除非本文中有明确的说明,这些步骤的执行并没有严格的顺序限制,其可以以其他的顺序执行。而且,图中的至少一部分步骤可以包括多个子步骤或者多个阶段,这些子步骤或者阶段并不必然是在同一时刻执行完成,而是可以在不同的时刻执行,其执行顺序也不必然是依次进行,而是可以与其他步骤或者其他步骤的子步骤或者阶段的至少一部分轮流或者交替地执行。It should be understood that, although the steps in the flowcharts in the embodiments of the present application are displayed in sequence according to the arrows, these steps are not necessarily executed in the sequence indicated by the arrows. Unless explicitly stated herein, the execution of these steps is not strictly limited to the order and may be performed in other orders. Moreover, at least a part of the steps in the figure may include multiple sub-steps or multiple stages. These sub-steps or stages are not necessarily executed at the same time, but may be executed at different times, and the execution order is not necessarily sequential. Instead, it may be performed in turn or alternately with other steps or at least a portion of sub-steps or stages of other steps.
以上仅为本申请的较佳实施例而已,并不用以限制本申请,凡在本申请的精神和原则之内所作的任何修改、等同替换或改进等,均应包含在本申请的保护范围之内。The above are only preferred embodiments of the present application and are not intended to limit the present application. Any modifications, equivalent replacements or improvements made within the spirit and principles of the present application shall be included in the protection scope of the present application. Inside.

Claims (13)

  1. 一种车辆驾驶控制方法,其特征在于,包括: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.
  2. 如权利要求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.
  3. 如权利要求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.
  4. 如权利要求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.
  5. 如权利要求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.
  6. 如权利要求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.
  7. 如权利要求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.
  8. 如权利要求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.
  9. 如权利要求8所述的车辆驾驶控制方法,其特征在于,所述转弯半径计算公式包括:
    Figure PCTCN2021074201-appb-100001
    The vehicle driving control method according to claim 8, wherein the calculation formula of the turning radius comprises:
    Figure PCTCN2021074201-appb-100001
    其中,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ρ 52ρ 43ρ 34ρ 25ρ 16StA=α 1 ρ 52 ρ 43 ρ 34 ρ 25 ρ 16 ;
    其中,
    Figure PCTCN2021074201-appb-100002
    in,
    Figure PCTCN2021074201-appb-100002
    其中,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.
  10. 如权利要求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.
  11. 一种车辆驾驶控制装置,其特征在于,包括存储器和处理器;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.
  12. 一种计算机可读存储介质,其特征在于,所述计算机可读存储介质上存储有计算机程序,所述计算机程序被处理器执行时实现如权利要求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.
  13. 一种车辆,其特征在于,所述车辆包括如权利要求11所述的车辆驾驶控制装置。A vehicle, characterized in that the vehicle includes the vehicle driving control device of claim 11 .
PCT/CN2021/074201 2021-01-28 2021-01-28 Vehicle driving control method and apparatus, and vehicle and storage medium WO2022160196A1 (en)

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)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
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

Patent Citations (4)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
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)