A method for correcting vehicle deviation

By traversing the path points in the tracking map, determining the nearest path points and calculating the steering angle, and adjusting the vehicle's driving trajectory using multiple parameters, the deviation problem caused by the inconsistent starting point of the intelligent connected low-speed car in autonomous driving is solved. The vehicle is accurately returned to the tracking path.

CN118182463BActive Publication Date: 2024-11-15BEIJING HEXU TECH CO LTD +1
View PDF 10 Cites 0 Cited by

Patent Information

Application Number
CN202410470902.5
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2024-04-18
Publication Date
2024-11-15
Estimated Expiration
2044-04-18

AI Technical Summary

Technical Problem

During the autonomous driving and tracking process of intelligent connected low-speed vehicles, the starting point of the vehicle does not match the created tracking map, resulting in the vehicle being unable to travel correctly on the set path and cannot take the correct steering operation when deviating.

Method used

By traversing all path points in the search map, determine the path point closest to the real-time location data of the vehicle, and switch the vehicle state based on the set deviation distance value and starting distance coefficient, calculate the vehicle steering angle to make the vehicle return to search. Trace path. The method includes a number of parameters such as a starting point steering threshold, a starting point steering coefficient, a starting point back positive threshold and a starting point back positive coefficient to adjust the driving trajectory of the vehicle.

Benefits of technology

It realizes that the vehicle can turn correctly after being offset and return to the set trace path, solves the problem of the vehicle being unable to drive correctly after deviating, and improves the accuracy and stability of autonomous driving.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118182463B_ABST
    Figure CN118182463B_ABST
Patent Text Reader

Abstract

The present invention relates to the field of automatic driving, and discloses a vehicle deviation correction method, including: traversing all path points in a tracking map to determine the path point closest to the real-time positioning data of the vehicle; determining whether the distance between the nearest path point vehicles is greater than a set tracking deviation distance value, if the distance between the nearest path point vehicles is greater than the tracking deviation distance value, switching the vehicle state to a tracking deviation state; when the vehicle state is a tracking deviation state, determining the target path point from the tracking map according to a set starting point distance coefficient; determining the angle between the vehicle and the tracking path according to the Cartesian coordinates of the target path point, the Cartesian coordinates of the nearest path point, and the Cartesian coordinates of the positioning data; and calculating the vehicle steering angle according to the angle to return the vehicle to the tracking path. Thus, it is achieved that the vehicle that has deviated from the tracking path is driven back to the set tracking path.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the field of autonomous driving, and in particular to a vehicle offset correction method. Background Art

[0002] Intelligence has been integrated into every aspect of people's lives. Intelligent networked vehicles are the future development trend of automobiles. Now related technologies have entered people's lives. The development of key technologies of intelligent networked vehicles mainly includes: Internet technology, automatic control technology, environmental perception technology, and big data technology.

[0003] The existing intelligent connected low-speed vehicles often encounter the following technical problems during the tracking process:

[0004] First, the starting point of the vehicle's automatic driving is basically not completely consistent with the created tracking map, resulting in the vehicle not driving according to the set tracking path;

[0005] Second, when the vehicle does not overlap with the driving path of the tracking map and the vehicle itself is parallel to the driving path of the tracking map, the vehicle will not take correct steering operations during the autonomous driving tracking process. Summary of the invention

[0006] The summary of the invention is used to introduce concepts in a brief form, which will be described in detail in the detailed implementation section below. The summary of the invention is not intended to identify the key features or essential features of the technical solution claimed for protection, nor is it intended to limit the scope of the technical solution claimed for protection.

[0007] The present invention proposes a vehicle offset correction method to solve one or more of the technical problems mentioned in the above background technology part.

[0008] The present invention provides a vehicle offset correction method, comprising: traversing all path points in a tracking map to determine the path point closest to the real-time positioning data of the vehicle; determining whether the distance between the nearest path point and the vehicle is greater than a set tracking deviation distance value, if the distance between the nearest path point and the vehicle is greater than the tracking deviation distance value, switching the vehicle state to a tracking deviation state; when the vehicle state is the tracking deviation state, determining the target path point from the tracking map according to the set starting point distance coefficient; determining the angle between the vehicle and the tracking path according to the Cartesian coordinates of the target path point, the Cartesian coordinates of the nearest path point, and the Cartesian coordinates of the positioning data; and calculating the vehicle steering angle according to the angle to return the vehicle to the tracking path.

[0009] Optionally, the target path point is determined by multiplying the tracking deviation distance value by the starting point distance coefficient.

[0010] Optionally, the vehicle offset correction method further includes:

[0011] The driving trajectory of the vehicle returning to the tracking path is set through multiple parameters, and the multiple parameters include: a starting point steering threshold, a starting point steering coefficient, a starting point return threshold, and a starting point return coefficient.

[0012] Optionally, the vehicle offset correction method further includes:

[0013] If the distance between the nearest path point vehicles is less than the tracking deviation distance value, the vehicle state is switched to normal driving state.

[0014] Optionally, in the vehicle offset correction method, the starting steering threshold is the critical value of the distance from the vehicle's real-time positioning data to the target path point; when the distance from the vehicle's real-time positioning data to the target path point is less than the starting steering threshold, the vehicle continues to perform wire-controlled steering operations; when the distance from the vehicle's real-time positioning data to the target path point is greater than or equal to the starting steering threshold, the vehicle does not perform any wire-controlled steering operations.

[0015] Optionally, in the vehicle offset correction method, the starting point steering coefficient represents the magnitude of the vehicle control wire steering after the vehicle deviates from the tracking path.

[0016] Optionally, in a vehicle offset correction method, a starting point return threshold is a critical value of the distance from the real-time positioning data to the target path point; when the distance from the vehicle's real-time positioning data to the target path point is less than the starting point return threshold, the vehicle performs a wire-controlled reverse steering operation; when the distance from the vehicle's real-time positioning data to the target path point is less than or equal to the starting point return threshold, the vehicle turns the steering wheel in the opposite direction so that after the vehicle returns to the tracking path, the vehicle's heading angle is consistent with the heading angle of the target path point.

[0017] Optionally, the vehicle offset correction method, the starting point self-centering coefficient is the size of the vehicle control wire steering when the vehicle approaches the tracking path.

[0018] Optionally, the vehicle offset correction method, the multiple parameters also include: expected straight-line speed, expected turning speed, braking threshold, and emergency braking travel value.

[0019] Optionally, the vehicle offset correction method, before determining whether the distance between the nearest path point vehicles is greater than a set tracking deviation distance value, the method further includes:

[0020] Set the path point closest to the vehicle's real-time positioning data as the origin;

[0021] Determine whether the origin coincides with the position corresponding to the real-time positioning data of the vehicle; and

[0022] Determine whether the distance between the nearest waypoint vehicles is greater than the set tracking deviation distance value, including:

[0023] If the origin does not coincide with the position corresponding to the real-time positioning data of the vehicle, determine whether the distance between the nearest path point and the vehicle is greater than the set tracking deviation distance.

[0024] The present invention has the following beneficial effects: the present invention determines the path point closest to the real-time positioning data of the vehicle by traversing all the path points in the tracking map; determines whether the distance between the vehicles at the nearest path point is greater than the set tracking deviation distance value, and if the distance between the vehicles at the nearest path point is greater than the tracking deviation distance value, switches the vehicle state to the tracking deviation state; when the vehicle state is the tracking deviation state, determines the target path point from the tracking map according to the set starting point distance coefficient; determines the angle between the vehicle and the tracking path according to the Cartesian coordinates of the target path point, the Cartesian coordinates of the nearest path point, and the Cartesian coordinates of the positioning data; and calculates the vehicle steering angle according to the angle. This enables the vehicle that has deviated from the tracking path to perform the correct steering operation and drive back to the set tracking path. BRIEF DESCRIPTION OF THE DRAWINGS

[0025] The above and other features, advantages and aspects of the embodiments of the present invention will become more apparent with reference to the following detailed description in conjunction with the accompanying drawings. Throughout the accompanying drawings, the same or similar reference numerals represent the same or similar elements. It should be understood that the drawings are schematic and that components and elements are not necessarily drawn to scale.

[0026] Figure 1 is a flow chart of a vehicle offset correction method of the present invention;

[0027] Figure 2 It is an illustration of the vehicle driving parameter configuration of the present invention. DETAILED DESCRIPTION

[0028] The present invention will be described in more detail below with reference to the accompanying drawings. Although certain embodiments of the present invention are shown in the accompanying drawings, it should be understood that the present invention can be implemented in various forms and should not be construed as being limited to the embodiments set forth herein. On the contrary, these embodiments are provided to provide a more thorough and complete understanding of the present invention. It should be understood that the drawings and embodiments of the present invention are only for exemplary purposes and are not intended to limit the scope of protection of the present invention.

[0029] It should also be noted that, for ease of description, only the parts related to the invention are shown in the drawings. In the absence of conflict, the embodiments of the present invention and the features in the embodiments can be combined with each other.

[0030] It should be noted that the concepts such as "first" and "second" mentioned in the present invention are only used to distinguish different devices, modules or units, and are not used to limit the order or interdependence of the functions performed by these devices, modules or units.

[0031] It should be noted that the modifications of "one" and "plurality" mentioned in the present invention are illustrative rather than restrictive, and those skilled in the art should understand that, unless otherwise clearly indicated in the context, it should be understood as "one or more".

[0032] The names of the messages or information exchanged between multiple devices of the present invention are only for illustrative purposes, and are not used to limit the scope of these messages or information.

[0033] The present invention will be described in detail below with reference to the accompanying drawings and in conjunction with embodiments.

[0034] like Figure 1 FIG. 1 is a flow chart of a vehicle offset correction method according to the present invention, which specifically includes the following steps:

[0035] Step 101, traverse all path points in the tracking map to determine the path point closest to the real-time positioning data of the vehicle;

[0036] Among them, the executor of the vehicle offset correction method is a vehicle, which may include an intelligent connected low-speed teaching vehicle.

[0037] In some embodiments, the tracking map is constructed based on multiple pre-collected path points and pre-configured map parameters, wherein the pre-collected path points include longitude, latitude, and heading angle; the map parameters include a preset turning coefficient, a preset heading angle positioning coefficient, a preset longitude and latitude scaling ratio, the number of target tracking points corresponding to different path types, a path filtering coefficient, a coordinate conversion mode, etc. A tracking map is obtained after multiple pre-collected path points are arranged according to the pre-configured map parameters.

[0038] In some embodiments, the nearest waypoint in the tracking map is found based on the real-time positioning data of the vehicle.

[0039] Step 102, determining whether the distance between the vehicles at the nearest path point is greater than a set tracking deviation distance value, if the distance between the vehicles at the nearest path point is greater than the tracking deviation distance value, switching the vehicle state to a tracking deviation state;

[0040] In some embodiments, optionally, before determining whether the distance between the nearest waypoint vehicles is greater than a set tracking deviation distance value, the method further includes:

[0041] Set the path point closest to the vehicle's real-time positioning data as the origin;

[0042] Determine whether the origin coincides with the position corresponding to the real-time positioning data of the vehicle; and

[0043] Determine whether the distance between the nearest waypoint vehicles is greater than the set tracking deviation distance value, including:

[0044] If the origin does not coincide with the position corresponding to the real-time positioning data of the vehicle, determine whether the distance between the nearest path point and the vehicle is greater than the set tracking deviation distance.

[0045] In some embodiments, optionally, the vehicle offset correction method further includes: if the distance between the nearest path points of the vehicles is less than the tracking deviation distance value, switching the vehicle state to a normal driving state.

[0046] In some embodiments, after finding the nearest path, it is set as the origin, and then it is determined whether the nearest path point coincides with the vehicle position. If not, it is necessary to determine the distance between the horizontal coordinate in the real-time positioning data of the vehicle and the nearest path point. When the distance between the nearest path point and the vehicle is greater than the set tracking deviation distance value, the vehicle will be determined to be far from the set tracking path, and the vehicle state needs to be switched to the tracking deviation state; otherwise, the vehicle switches to the normal driving state.

[0047] Step 103, when the vehicle state is a tracking deviation state, determining the target path point from the tracking map according to the set starting point distance coefficient;

[0048] Optionally, the target path point is determined by multiplying the tracking deviation distance value by the starting point distance coefficient;

[0049] In some embodiments, when the vehicle is in a tracking deviation state, a path point will be selected from the path points recorded in the tracking map as the target path point for the vehicle to travel according to the size of the starting point distance coefficient. The target path point for the vehicle to travel is determined by multiplying the tracking deviation distance value by the starting point distance coefficient. If the product contains a decimal, it will be rounded up to an integer.

[0050] Step 104, determining the angle between the vehicle and the tracking path according to the Cartesian coordinates of the target path point, the Cartesian coordinates of the nearest path point, and the Cartesian coordinates of the positioning data;

[0051] In some embodiments, Cartesian coordinates are a general term for rectangular coordinates and oblique coordinates.

[0052] In some embodiments, the Cartesian coordinates of the target path point are the coordinates of the target path point where the vehicle is currently traveling; the Cartesian coordinates of the nearest path point are the coordinates of the path point with the closest straight-line distance to the vehicle on the tracking path; and the Cartesian coordinates of the positioning data are converted from the created tracking map and the real-time positioning data of the vehicle.

[0053] In some embodiments, the angle between the vehicle and the tracking path can be calculated according to the control cycle time based on the triangle formed by the Cartesian coordinates of the target path point, the Cartesian coordinates of the nearest path point, and the Cartesian coordinates of the positioning data.

[0054] Step 105, calculating the vehicle steering angle according to the included angle to make the vehicle return to the tracking path.

[0055] In some embodiments, optionally, a driving trajectory for the vehicle to return to the tracking path is set using multiple parameters, and the multiple parameters include: a starting point turning threshold, a starting point turning coefficient, a starting point return threshold, and a starting point return coefficient.

[0056] In some embodiments, optionally, in the vehicle offset correction method, the starting point steering threshold is a critical value of the distance from the vehicle's real-time positioning data to the target path point; when the distance from the vehicle's real-time positioning data to the target path point is less than the starting point steering threshold, the vehicle continues to perform wire-controlled steering operations; when the distance from the vehicle's real-time positioning data to the target path point is greater than or equal to the starting point steering threshold, the vehicle does not perform any wire-controlled steering operations.

[0057] In some embodiments, optionally, the starting point steering coefficient represents the magnitude of the vehicle's controlled wire steering after the vehicle deviates from the tracking path.

[0058] In some embodiments, optionally, the starting point return-to-alignment threshold is a critical value of the distance from the real-time positioning data to the target path point; when the distance from the vehicle's real-time positioning data to the target path point is less than the starting point return-to-alignment threshold, the vehicle performs a wire-controlled reverse steering operation; when the distance from the vehicle's real-time positioning data to the target path point is less than or equal to the starting point return-to-alignment threshold, the vehicle turns the steering wheel in the opposite direction so that after the vehicle returns to the tracking path, the vehicle's heading angle is consistent with the heading angle of the target path point.

[0059] In some embodiments, optionally, the starting point self-centering coefficient is the size of the vehicle's controlled wire steering when the vehicle approaches the tracking path.

[0060] In some embodiments, the starting point steering threshold is a critical value of the straight-line distance from the current actual positioning position of the vehicle to the target path point, in meters. When the straight-line distance between the current actual positioning position of the vehicle and the target path point is less than the distance of this set threshold, the vehicle will continue to perform the steering operation of the wire control. When the straight-line distance between the current actual positioning position of the vehicle and the target path point is greater than or equal to the distance of this set threshold, the vehicle will turn the steering wheel back and no longer perform any steering operation of the wire control; the starting point steering coefficient is the size of the vehicle control wire steering after the vehicle and the tracking path are offset. Set the nearest path point of the vehicle as the origin, connect the current vehicle with the origin to form a straight line, and then connect the target path point of the vehicle with the origin to form another straight line, and multiply the angle between the two straight lines by this coefficient, which is the angle value of the vehicle's final steering. When the vehicle is traveling at a high speed, this coefficient also needs to be larger; otherwise, it is smaller; the starting point return threshold is also a critical value of the straight-line distance from the current actual positioning position of the vehicle to the target path point, in meters. When the straight-line distance between the vehicle's current actual positioning position and the target path point is less than the set threshold, the vehicle will continue to perform the reverse steering operation of the wire control. When the straight-line distance between the vehicle's current actual positioning position and the target path point is less than or equal to the set threshold, the vehicle will turn the steering wheel in the opposite direction so that the vehicle's heading angle is consistent with the heading angle of the target path point after the vehicle returns to the set path; the starting point return coefficient is the size of the vehicle's control-by-wire steering when the vehicle approaches the set path. The difference between the vehicle's current heading angle and the heading angle recorded in the target path point is multiplied by this coefficient to obtain the angle value at which the vehicle finally performs the steering. When the vehicle is traveling at a higher speed, this coefficient also needs to be larger; otherwise, it should be smaller.

[0061] In some embodiments, optionally, the multiple parameters also include: expected straight-line speed, expected turning speed, braking threshold, and emergency braking travel value.

[0062] In some embodiments, the vehicle's driving trajectory is adjusted by adjusting four parameters: starting point steering threshold, starting point steering coefficient, starting point return threshold, and starting point return coefficient. After the vehicle has traveled a certain distance, it is necessary to perform a reverse steering operation to return the vehicle to the driving trajectory setting on the tracking path. The specific parameter adjustment interface is as follows: Figure 2 shown.

[0063] The above descriptions are only some preferred embodiments of the present invention and the explanation of the technical principles used. Those skilled in the art should understand that the scope of the invention involved in the present invention is not limited to the technical solutions formed by the specific combination of the above technical features, but also should cover other technical solutions formed by any combination of the above technical features or their equivalent features without departing from the above inventive concept. For example, the above features are replaced with the technical features with similar functions disclosed in the present invention (but not limited to) to form a technical solution.

Claims

1. A vehicle offset correction method, characterized in that: include: Traverse all the path points in the tracking map to determine the path point closest to the vehicle's real-time positioning data; Determine whether the distance between the nearest path point and the vehicle is greater than a set tracking deviation distance value, and if the distance between the nearest path point and the vehicle is greater than the tracking deviation distance value, switch the vehicle state to a tracking deviation state; When the vehicle state is the tracking deviation state, determining the target path point from the tracking map according to the set starting point distance coefficient; Determine the angle between the vehicle and the tracking path according to the Cartesian coordinates of the target path point, the Cartesian coordinates of the nearest path point, and the Cartesian coordinates of the positioning data; Calculating a vehicle steering angle according to the included angle so as to return the vehicle to the tracking path; The driving trajectory of the vehicle returning to the tracking path is set by using multiple parameters, wherein the multiple parameters include: a starting point turning threshold, a starting point turning coefficient, a starting point return threshold, and a starting point return coefficient; When the distance from the vehicle's real-time positioning data to the target path point is less than the starting point steering threshold, the vehicle continues to perform wire-controlled steering operations; when the distance from the vehicle's real-time positioning data to the target path point is greater than or equal to the starting point steering threshold, the vehicle does not perform any wire-controlled steering operations.

2. The vehicle deviation correction method according to claim 1, characterized in that: The target path point is determined by multiplying the tracking deviation distance value by the starting point distance coefficient.

3. The vehicle deviation correction method according to claim 1, characterized in that: Also includes: If the distance between the vehicles at the nearest path point is less than the tracking deviation distance value, the vehicle state is switched to a normal driving state.

4. The vehicle deviation correction method according to claim 1, characterized in that: The starting point steering coefficient represents the magnitude of the vehicle's controlled wire steering after the vehicle deviates from the tracking path.

5. The vehicle deviation correction method according to claim 1, characterized in that: The starting point return threshold is the critical value of the distance from the real-time positioning data to the target path point; when the distance from the vehicle's real-time positioning data to the target path point is less than the starting point return threshold, the vehicle performs a reverse steering operation of the wire control; when the distance from the vehicle's real-time positioning data to the target path point is less than or equal to the starting point return threshold, the vehicle turns the steering wheel in the opposite direction so that after the vehicle returns to the tracking path, the vehicle's heading angle is consistent with the heading angle of the target path point.

6. The vehicle deviation correction method according to claim 1, characterized in that: The starting point self-centering coefficient is the magnitude of the vehicle's controlled wire steering when the vehicle approaches the tracking path.

7. The vehicle deviation correction method according to claim 1, characterized in that: The multiple parameters also include: expected straight-line vehicle speed, expected turning vehicle speed, braking threshold value, and emergency braking travel value.

8. The vehicle deviation correction method according to claim 1, characterized in that: Before determining whether the distance between the nearest path point and the vehicle is greater than a set tracking deviation distance value, the method further includes: The path point closest to the real-time positioning data of the vehicle is set as the origin; Determining whether the origin coincides with a position corresponding to the real-time positioning data of the vehicle; and The determining whether the distance between the nearest path point and the vehicle is greater than a set tracking deviation distance value includes: If the origin does not coincide with the position corresponding to the real-time positioning data of the vehicle, it is determined whether the distance between the nearest path point and the vehicle is greater than a set tracking deviation distance value.

Citation Information

Patent Citations

  • Positioning and tracing method for unmanned mine car

    CN108594821A

  • Adaptive control method and system in a terrestrial vehicle for tracking a route, particularly in an autonomous driving scenario

    CN110036353A

  • Vehicle control method and device

    CN110673593A

  • Bidirectional positioning parking control method and device for mining vehicle

    CN112896147A

  • Automatic tracking control method and system

    CN114384902A