Vehicle trajectory tracking method and device, electronic equipment and storage medium
By obtaining the vehicle posture and motion parameters, determining the positions and angles of multiple pre-sighting points, and comprehensively calculating the target angle, the problem of poor vehicle trajectory tracking effect in the prior art is solved, and the trajectory tracking accuracy and the safety of the autonomous driving system are improved. .
Patent Information
- Application Number
- CN202310540453.2
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2023-05-12
- Publication Date
- 2024-11-19
AI Technical Summary
In the prior art, the vehicle trajectory tracking effect is poor based on pure tracking algorithms, resulting in low trajectory tracking accuracy, affecting the performance and safety of the autonomous driving system.
By obtaining the vehicle's posture information and motion parameters, determine the positions and front wheel angles of multiple pre-sighting points, comprehensively calculate the target angle, control the vehicle to track the trajectory according to the target angle, and use multi-point pre-sighting and weighted averaging techniques to improve trajectory tracking Accuracy.
It improves the accuracy and anthropomorphism of vehicle trajectory tracking, and enhances the performance and safety of autonomous driving systems.
Smart Images

Figure CN118981204A_ABST
Abstract
Description
Technical Field
[0001] The present application relates to the field of autonomous driving technology, and in particular to a vehicle trajectory tracking method, device, electronic device and storage medium. Background Art
[0002] During the process of autonomous driving, the accuracy of trajectory tracking directly affects the vehicle's driving trajectory, and then affects the overall performance and driving safety of the autonomous driving system. In the prior art, vehicle trajectory tracking is usually achieved based on a pure tracking algorithm, and its tracking effect is poor. Therefore, how to improve the accuracy of vehicle trajectory tracking has become an urgent problem to be solved. Summary of the invention
[0003] The present application provides a vehicle trajectory tracking method, device, electronic device and storage medium to solve the problem in the prior art that vehicle trajectory tracking is achieved based on a pure tracking algorithm, and the tracking effect is poor.
[0004] In a first aspect, an embodiment of the present application provides a vehicle trajectory tracking method, the method comprising:
[0005] Obtain the vehicle's current position information and motion parameters;
[0006] According to the motion parameters, positions corresponding to N preview points are determined from the target trajectory, where N is an integer greater than or equal to 2;
[0007] Calculate the front wheel turning angles corresponding to the N preview points according to the posture information and the positions corresponding to the N preview points;
[0008] Determining the target turning angle of the vehicle at the current moment according to the front wheel turning angles corresponding to the N preview points;
[0009] The vehicle is controlled to track the target trajectory according to the target turning angle.
[0010] Optionally, the motion parameters include driving speed and acceleration;
[0011] Determining positions corresponding to N preview points from the target trajectory according to the motion parameters includes:
[0012] Get N preview times within a single time period;
[0013] According to the vehicle speed interval corresponding to the driving speed, a weight parameter corresponding to the driving speed is determined from a preset corresponding relationship, wherein the preset corresponding relationship is used to characterize the corresponding relationship between the vehicle speed interval and the weight parameter;
[0014] Calculate the trajectory lengths of the N preview points according to the driving speed, the acceleration, the N preview times and the weight parameter, wherein the trajectory lengths of the N preview points are used to represent the trajectory lengths from the trajectory point closest to the vehicle position to the N preview points;
[0015] According to the track lengths of the N preview points, positions corresponding to the N preview points are determined.
[0016] Optionally, the N preview times cover the entire time period of the single time cycle, and K preset times among the N preview times are concentrated in the early time period of the single time cycle, where K is an integer greater than or equal to N / 2 and less than N.
[0017] Optionally, the calculation formula of the trajectory length of the N preview points is as follows:
[0018]
[0019] Among them, Pass t represents the trajectory length of the target preview point, t represents the target preview time, v represents the driving speed, a represents the acceleration, P0 and P1 represent weight parameters, L dfset represents a preset compensation value, the target preview point is a preview point among the N preview points corresponding to the target preview time, and the target preview time is any preview time among the N preview times.
[0020] Optionally, the position information includes vehicle position and vehicle attitude;
[0021] The calculating the front wheel turning angles corresponding to the N preview points according to the posture information and the positions corresponding to the N preview points includes:
[0022] Determine N preview distances according to the vehicle position and the positions corresponding to the N preview points, wherein the N preview distances are used to represent the Euclidean distances from the center point of the rear axle of the vehicle to the N preview points;
[0023] Determine N heading deviations according to the vehicle posture, the vehicle position and the positions corresponding to the N preview points, wherein the N heading deviations are used to characterize the deviations between the vehicle heading and the directions where the N preview points are located;
[0024] The front wheel turning angles corresponding to the N preview points are calculated according to the N preview distances and the N heading deviations.
[0025] Optionally, the calculation formula of the front wheel turning angle corresponding to the N preview points is as follows:
[0026]
[0027] Among them, δ i represents the front wheel turning angle corresponding to the i-th preview point, L i represents the preview distance corresponding to the i-th preview point, α i represents the heading deviation corresponding to the i-th preview point, l d represents the vehicle wheelbase, i∈1,…,N.
[0028] Optionally, determining the target turning angle of the vehicle at the current moment according to the front wheel turning angles corresponding to the N preview points includes:
[0029] Obtaining N weight coefficients of the front wheel turning angles corresponding to the N preview points;
[0030] According to the N weight coefficients, a weighted average calculation is performed on the front wheel turning angles corresponding to the N preview points to obtain a calculation result, and the calculation result is determined as the target turning angle.
[0031] In a second aspect, an embodiment of the present application further provides a vehicle trajectory tracking device, the device comprising:
[0032] The acquisition module is used to obtain the vehicle's position information and motion parameters at the current moment;
[0033] A first determination module, used to determine positions corresponding to N preview points from the target trajectory according to the motion parameters, where N is an integer greater than or equal to 2;
[0034] A calculation module, used for calculating the front wheel turning angles corresponding to the N preview points according to the posture information and the positions corresponding to the N preview points;
[0035] A second determination module is used to determine the target turning angle of the vehicle at the current moment according to the front wheel turning angles corresponding to the N preview points;
[0036] The tracking module is used to control the vehicle to track the target trajectory according to the target turning angle.
[0037] In a third aspect, an embodiment of the present application further provides an electronic device, including a processor, a communication interface, a memory, and a communication bus, wherein the processor, the communication interface, and the memory communicate with each other via the communication bus;
[0038] Memory, used to store computer programs;
[0039] The processor is used to implement the steps of the vehicle trajectory tracking method described in any embodiment of the first aspect when executing the program stored in the memory.
[0040] In a fourth aspect, an embodiment of the present application further provides a computer-readable storage medium having a computer program stored thereon, and when the computer program is executed by a processor, the steps of the vehicle trajectory tracking method described in any embodiment of the first aspect are implemented.
[0041] In a fifth aspect, an embodiment of the present application further provides a mobile tool, comprising the electronic device described in the third aspect.
[0042] In an embodiment of the present application, the vehicle's position information and motion parameters at the current moment are obtained; based on the motion parameters, the positions corresponding to N preview points are determined from the target trajectory, where N is an integer greater than or equal to 2; based on the position information and the positions corresponding to the N preview points, the front wheel turning angles corresponding to the N preview points are calculated; based on the front wheel turning angles corresponding to the N preview points, the target turning angle of the vehicle at the current moment is determined; and the vehicle is controlled to track the target trajectory according to the target turning angle. In the above manner, the front wheel turning angles corresponding to the N preview points can be obtained based on the vehicle's position information and motion parameters at the current moment, and the target turning angle of the vehicle at the current moment can be obtained by combining the front wheel turning angles corresponding to the N preview points, so that the target turning angle can be integrated with the trajectory changes of multiple preview points, thereby improving the accuracy of trajectory tracking. BRIEF DESCRIPTION OF THE DRAWINGS
[0043] The accompanying drawings, which are incorporated in and constitute a part of this specification, illustrate embodiments consistent with the invention and, together with the description, serve to explain the principles of the invention.
[0044] In order to more clearly illustrate the embodiments of the present invention or the technical solutions in the prior art, the drawings required for use in the embodiments or the description of the prior art will be briefly introduced below. Obviously, for ordinary technicians in this field, other drawings can be obtained based on these drawings without paying any creative labor.
[0045] Figure 1 A schematic diagram of a vehicle trajectory tracking method provided in an embodiment of the present application;
[0046] Figure 2 A schematic diagram of a geometric model of a pure tracking controller provided in an embodiment of the present application;
[0047] Figure 3 A schematic diagram of the structure of a vehicle trajectory tracking device provided in an embodiment of the present application;
[0048] Figure 4 A schematic diagram of the structure of an electronic device provided in an embodiment of the present application. DETAILED DESCRIPTION
[0049] In order to make the purpose, technical solution and advantages of the embodiments of the present application clearer, the technical solution in the embodiments of the present application will be clearly and completely described below in conjunction with the drawings in the embodiments of the present application. Obviously, the described embodiments are part of the embodiments of the present application, not all of the embodiments. Based on the embodiments in the present application, all other embodiments obtained by ordinary technicians in this field without making creative work are within the scope of protection of this application.
[0050] See also Figure 1 , Figure 1 A flow chart of a vehicle trajectory tracking method provided in an embodiment of the present application. Figure 1 As shown, the vehicle trajectory tracking method may include the following steps:
[0051] Step 101: Obtain the vehicle's position information and motion parameters at the current moment.
[0052] Specifically, the above-mentioned position information may include but is not limited to information such as vehicle position and vehicle posture, and the above-mentioned motion parameters may include but are not limited to parameters such as driving speed and acceleration.
[0053] When obtaining posture information and motion parameters, they can be obtained from various sensors, navigation systems, inertial navigation systems, etc. on the vehicle.
[0054] Step 102: According to the motion parameters, positions corresponding to N preview points are determined from the target trajectory, where N is an integer greater than or equal to 2.
[0055] Specifically, the target trajectory refers to a preset expected driving trajectory, and the N value of the N preview points can be set according to actual needs, for example, 3, 4, 5, 7, etc.
[0056] In this step, multiple preview points and their corresponding positions can be determined from the target trajectory according to the motion parameters, so as to obtain the trajectory changes of the multiple preview points. In this way, even when the target trajectory is more complex, the tracking accuracy and anthropomorphism level can be guaranteed.
[0057] Step 103: Calculate the front wheel turning angles corresponding to the N preview points based on the posture information and the positions corresponding to the N preview points.
[0058] In this step, the front wheel turning angle corresponding to each preview point can be calculated based on the vehicle's current posture information and the positions corresponding to the N preview points obtained. Specifically, a pure tracking algorithm can be used to calculate the front wheel turning angle corresponding to each preview point, or other algorithms can be used to calculate the front wheel turning angle corresponding to each preview point, which is not specifically limited in the embodiments of the present application.
[0059] Step 104: Determine the target turning angle of the vehicle at the current moment according to the front wheel turning angles corresponding to the N preview points.
[0060] In this step, the front wheel turning angles corresponding to the N preview points may be averaged or weighted averaged to determine the target turning angle of the vehicle at the current moment, that is, the front wheel turning angle finally determined by the vehicle at the current moment.
[0061] It should be noted that the front wheel turning angle corresponding to each preview point represents the turning angle required by the front wheel when the vehicle travels from the current position to each preview point. Therefore, the target turning angle combines the front wheel turning angles corresponding to N preview points, which can realize precise anthropomorphic tracking control of the vehicle.
[0062] Step 105: Control the vehicle to track the target trajectory according to the target turning angle.
[0063] After the target turning angle is acquired, the vehicle may be controlled to track the target trajectory according to the target turning angle, and in the subsequent tracking process, the above steps 101 to 105 may be repeatedly executed until the entire target trajectory tracking process is completed.
[0064] In this embodiment, the front wheel turning angles corresponding to N preview points can be obtained based on the vehicle's current posture information and motion parameters, and the front wheel turning angles corresponding to the N preview points can be combined to obtain the target turning angle of the vehicle at the current moment, so that the target turning angle can be integrated with the trajectory changes of multiple preview points, thereby improving the accuracy of trajectory tracking.
[0065] Further, the motion parameters include travel speed and acceleration;
[0066] The above step 102, determining the positions corresponding to the N preview points from the target trajectory according to the motion parameters, may specifically include:
[0067] Get N preview times within a single time period;
[0068] According to the vehicle speed interval corresponding to the driving speed, a weight parameter corresponding to the driving speed is determined from a preset corresponding relationship, wherein the preset corresponding relationship is used to characterize the corresponding relationship between the vehicle speed interval and the weight parameter;
[0069] The trajectory length of the N preview points is calculated according to the driving speed, acceleration, N preview times and weight parameters, wherein the trajectory length of the N preview points is used to represent the trajectory length from the trajectory point closest to the vehicle position to the N preview points;
[0070] According to the trajectory lengths of the N preview points, the positions corresponding to the N preview points are determined.
[0071] Specifically, the time length of the above-mentioned single time period can be set according to actual needs, and this application does not make specific limitations. The above-mentioned N preview times are N preview times pre-set in a single time period. For example, for the application scenario of an unmanned sweeper, 5 seconds can be selected as the time period, and 7 preview points can be selected in a single time period. The preview times corresponding to the 7 preview points are t=0.5, t=1.0, t=1.5, t=2.0, t=3.0, t=4.0, and t=5.0. Of course, for other application scenarios of unmanned vehicles, the time period, the number of preview points, and each preview time can be flexibly set according to product needs.
[0072] The above preset correspondence is used to characterize the correspondence between the vehicle speed range and the weight parameter. In this way, different weight parameters can be pre-set according to different vehicle speed ranges to achieve hierarchical selection of N preview points based on speed. For example, for the application scenario of an unmanned sweeper, the preset correspondence shown in the following table can be set:
[0073] Vehicle speed (m / s) <![CDATA[Weight parameter P0]]> <![CDATA[Weight parameter P1 <!-- 4 -->]]> 0<v≤0.5 0.5 0.5 0.5<v≤1.0 0.9 0.9 1.0<v≤1.5 1.1 1.1 1.5<v≤2.0 1.3 1.3 2.0<v≤2.5 1.5 1.5 2.5<v≤3.0 2.0 2.0
[0074] It should be noted that when the target trajectory is a sharp turn, the vehicle speed is usually low, and the corresponding weight parameter is also small. The calculated positions of the N preview points are also close to the current position of the vehicle, which is more conducive to obtaining the trajectory of multiple preview points on the sharp turn, and can avoid taking shortcuts on the curve during tracking. When the target trajectory is a straight line, the vehicle speed is usually high, and the corresponding weight parameter is also large. The calculated positions of the N preview points are also far from the current position of the vehicle, which is more conducive to obtaining the trajectory of the farther position ahead.
[0075] In one embodiment, N preview times within a single time period can be obtained, and according to the vehicle speed interval corresponding to the driving speed, the weight parameter corresponding to the driving speed is determined from the preset corresponding relationship, and then the trajectory length of the N preview points is calculated according to the driving speed, acceleration, N preview times and weight parameters, and finally the positions corresponding to the N preview points are determined according to the trajectory length of the N preview points. In the above manner, the positions corresponding to multiple preview points can be determined from the target trajectory, which facilitates the subsequent determination of the target turning angle based on the positions corresponding to the multiple preview points, thereby improving the trajectory tracking accuracy.
[0076] Furthermore, the N preview times cover the entire time period of a single time cycle, and K preset times among the N preview times are concentrated in the early time period of the single time cycle, where K is an integer greater than or equal to N / 2 and less than N.
[0077] In one embodiment, when obtaining N preview times within a single time period, K preview times may be obtained from the earlier time period within the single time period, and NK preview times may be obtained from the later time period within the single time period. For example, assuming that the single time period is 5 seconds and the value of N is 7, the preview times corresponding to the 7 preview points may be t=0.5, t=1.0, t=1.5, t=2.0, t=3.0, t=4.0, and t=5.0, respectively, that is, a total of 4 preview points are set within 2 seconds, so that the trajectory situation within the next 2 seconds can be better obtained, while taking into account the trajectory situation outside 2 seconds, especially when the target trajectory is a more complex trajectory such as a sharp turn, the tracking effect is more obvious.
[0078] Furthermore, the calculation formula for the trajectory length of N preview points is as follows:
[0079]
[0080] Among them, Pass t represents the trajectory length of the target preview point, t represents the target preview time, v represents the driving speed, a represents the acceleration, P0 and P1 represent the weight parameters, and L dfset It represents a preset compensation value, the target preview point is a preview point among the N preview points corresponding to the target preview time, and the target preview time is any preview time among the N preview times.
[0081] In one embodiment, the above formula can be used to calculate the trajectory lengths of N preview points corresponding to N preview times. dfset , weight parameters P0 and P1 are preset in advance, driving speed v and acceleration a can be obtained in real time, and the preset compensation value L dfset It can be used as the minimum trajectory length. Since the above formula comprehensively considers the influence of driving speed v and acceleration a on the trajectory length of the target preview point, different preview points can be selected based on different driving speeds v and accelerations a in actual applications to meet the needs of different application scenarios.
[0082] Of course, as another implementation, the trajectory length of each preview point can be calculated only by the driving speed v or the acceleration a, such as using the formula: Pass t =P0*v*t+L dfset ,or or Or other formulas obtained by deformation, etc., are not specifically limited in the embodiments of the present application.
[0083] Furthermore, the posture information includes vehicle position and vehicle posture;
[0084] The above step 103, calculating the front wheel turning angles corresponding to the N preview points according to the posture information and the positions corresponding to the N preview points, specifically includes:
[0085] Determine N preview distances according to the vehicle position and the positions corresponding to the N preview points, wherein the N preview distances are used to represent the Euclidean distances from the center point of the rear axle of the vehicle to the N preview points;
[0086] Determine N heading deviations according to the vehicle posture, the vehicle position and the positions corresponding to the N preview points, wherein the N heading deviations are used to represent the deviations between the vehicle heading and the directions of the N preview points;
[0087] According to N preview distances and N heading deviations, the front wheel turning angles corresponding to the N preview points are calculated.
[0088] In one embodiment, after obtaining the positions corresponding to the N preview points, the Euclidean distances from the center point of the rear axle of the vehicle to the N preview points can be calculated to obtain N preview distances, and then the N heading deviations, i.e., the deviations between the vehicle heading and the directions of the N preview points, can be determined according to the vehicle posture, the vehicle position, and the positions corresponding to the N preview points; and the front wheel turning angles corresponding to the N preview points can be calculated according to the N preview distances and the N heading deviations. In this way, the front wheel turning angle corresponding to each preview point can be accurately calculated.
[0089] Furthermore, the calculation formula of the front wheel turning angle corresponding to the N preview points is as follows:
[0090]
[0091] Among them, δ i represents the front wheel turning angle corresponding to the i-th preview point, L i represents the preview distance corresponding to the i-th preview point, α i represents the heading deviation corresponding to the i-th preview point, l d represents the vehicle wheelbase, i∈1,…,N.
[0092] In one embodiment, the above formula can be used to calculate the front wheel turning angle corresponding to each preview point. The principle is derived by using the geometric model of the pure tracking controller. The geometric model of the pure tracking controller is as follows: Figure 2 As shown, the front wheel turning angle corresponding to each preview point is calculated by obtaining the preview distance and heading deviation corresponding to each preview point.
[0093] Furthermore, the above step 104, determining the target turning angle of the vehicle at the current moment according to the front wheel turning angles corresponding to the N preview points, includes:
[0094] Obtain N weight coefficients of the front wheel turning angles corresponding to the N preview points;
[0095] According to N weight coefficients, the front wheel turning angles corresponding to the N preview points are weighted and averaged to obtain a calculation result, which is determined as the target turning angle.
[0096] In one embodiment, N weight coefficients of the front wheel turning angles corresponding to the N preview points may be obtained first, and then the front wheel turning angles corresponding to the N preview points may be weighted averaged according to the N weight coefficients to obtain a calculation result. Specifically, the calculation may be performed using the following formula:
[0097]
[0098] Among them, δ f represents the target rotation angle, δ i represents the front wheel turning angle corresponding to the i-th preview point, k i Represents the weight coefficient corresponding to the i-th preview point, i∈1,…,N.
[0099] It should be noted that the N weight coefficients can be adaptively adjusted according to the actual application field, and the default setting can be We can also use different k i Assign different values to increase or decrease the weight applied to a specific preview time.
[0100] In the embodiments of the present application, an optimization is performed on the traditional geometric tracking control model, and the concept of multi-point preview is proposed. The technical defects caused by single-point preview are solved by selecting multiple preview points based on speed stratification and weighted averaging of multiple preview angles, thereby improving the tracking accuracy and anthropomorphism level of the control algorithm for complex trajectories.
[0101] See also Figure 3 , Figure 3 A schematic diagram of the structure of a vehicle trajectory tracking device provided in an embodiment of the present application. Figure 3 As shown, the vehicle trajectory tracking device 300 may include:
[0102] The acquisition module 301 is used to obtain the position information and motion parameters of the vehicle at the current moment;
[0103] A first determination module 302 is used to determine positions corresponding to N preview points from the target trajectory according to the motion parameters, where N is an integer greater than or equal to 2;
[0104] A calculation module 303 is used to calculate the front wheel turning angles corresponding to the N preview points according to the posture information and the positions corresponding to the N preview points;
[0105] The second determination module 304 is used to determine the target turning angle of the vehicle at the current moment according to the front wheel turning angles corresponding to the N preview points;
[0106] The tracking module 305 is used to control the vehicle to track the target trajectory according to the target turning angle.
[0107] Further, the motion parameters include travel speed and acceleration;
[0108] The first determination module 302 includes:
[0109] The first acquisition submodule is used to acquire N preview times within a single time period;
[0110] A first determination submodule is used to determine a weight parameter corresponding to the driving speed from a preset corresponding relationship according to the vehicle speed interval corresponding to the driving speed, wherein the preset corresponding relationship is used to characterize the corresponding relationship between the vehicle speed interval and the weight parameter;
[0111] A first calculation submodule is used to calculate the trajectory length of N preview points according to the driving speed, acceleration, N preview times and weight parameters, wherein the trajectory length of the N preview points is used to represent the trajectory length from the trajectory point closest to the vehicle position to the N preview points;
[0112] The second determination submodule is used to determine the positions corresponding to the N preview points according to the trajectory lengths of the N preview points.
[0113] Furthermore, the N preview times cover the entire time period of a single time cycle, and K preset times among the N preview times are concentrated in the early time period of the single time cycle, where K is an integer greater than or equal to N / 2 and less than N.
[0114] Furthermore, the calculation formula for the trajectory length of N preview points is as follows:
[0115]
[0116] Among them, Pass t represents the trajectory length of the target preview point, t represents the target preview time, v represents the driving speed, a represents the acceleration, P0 and P1 represent the weight parameters, and L dfset It represents a preset compensation value, the target preview point is a preview point among the N preview points corresponding to the target preview time, and the target preview time is any preview time among the N preview times.
[0117] Furthermore, the posture information includes vehicle position and vehicle posture;
[0118] The calculation module 303 includes:
[0119] A third determination submodule is used to determine N preview distances according to the vehicle position and the positions corresponding to the N preview points, wherein the N preview distances are used to represent the Euclidean distances from the center point of the rear axle of the vehicle to the N preview points;
[0120] The fourth determination submodule is used to determine N heading deviations according to the vehicle posture, the vehicle position and the positions corresponding to the N preview points, wherein the N heading deviations are used to represent the deviations between the vehicle heading and the directions of the N preview points;
[0121] The second calculation submodule is used to calculate the front wheel turning angles corresponding to the N preview points according to the N preview distances and the N heading deviations.
[0122] Furthermore, the calculation formula of the front wheel turning angle corresponding to the N preview points is as follows:
[0123]
[0124] Among them, δ i represents the front wheel turning angle corresponding to the i-th preview point, L i represents the preview distance corresponding to the i-th preview point, α i represents the heading deviation corresponding to the i-th preview point, l d represents the vehicle wheelbase, i∈1,…,N.
[0125] Further, the second determining module 304 includes:
[0126] The second acquisition submodule is used to obtain N weight coefficients of the front wheel turning angles corresponding to the N preview points;
[0127] The third calculation submodule is used to perform weighted average calculation on the front wheel turning angles corresponding to the N preview points according to the N weight coefficients to obtain a calculation result, and determine the calculation result as the target turning angle.
[0128] It should be noted that the vehicle trajectory tracking device 300 can implement the steps of the vehicle trajectory tracking method provided by any of the aforementioned method embodiments and can achieve the same technical effects, which will not be described in detail here.
[0129] like Figure 4 As shown, the embodiment of the present application further provides an electronic device, including a processor 411, a communication interface 412, a memory 413 and a communication bus 414, wherein the processor 411, the communication interface 412, and the memory 413 communicate with each other through the communication bus 414.
[0130] Memory 413, used for storing computer programs;
[0131] In one embodiment of the present application, the processor 411 is used to execute the program stored in the memory 413 to implement the vehicle trajectory tracking method provided by any of the above method embodiments, including:
[0132] Obtain the vehicle's current position information and motion parameters;
[0133] According to the motion parameters, positions corresponding to N preview points are determined from the target trajectory, where N is an integer greater than or equal to 2;
[0134] According to the posture information and the positions corresponding to the N preview points, the front wheel turning angles corresponding to the N preview points are calculated;
[0135] According to the front wheel turning angles corresponding to the N preview points, the target turning angle of the vehicle at the current moment is determined;
[0136] Control the vehicle to track the target trajectory according to the target turning angle.
[0137] An embodiment of the present application also provides a computer-readable storage medium on which a computer program is stored. When the computer program is executed by a processor, the steps of the vehicle trajectory tracking method provided in any of the aforementioned method embodiments are implemented.
[0138] An embodiment of the present application also provides a computer program product, which includes a computer program stored on a non-volatile computer-readable storage medium, and the computer program includes program instructions. When the program instructions are executed by a computer, the computer implements the steps of the vehicle trajectory tracking method provided by any of the aforementioned method embodiments.
[0139] The present application also provides a mobile tool, which includes Figure 4 The electronic device shown in the figure can realize the above-mentioned Figure 4 The functions of the electronic devices shown in the figure can achieve the same technical effects, and they will not be described in detail here.
[0140] In some specific embodiments, the mobile tool may be equipped with various sensors for sensing environmental information and the mobile tool's own information (including but not limited to lidar, camera, millimeter-wave radar, ultrasonic radar, inertial measurement unit, wheel speed meter, etc.). The electronic device provided in the embodiment of the present application may be an autonomous driving domain controller mounted on the mobile tool. When the mobile tool is in working state, the autonomous driving domain controller communicates with the various sensors mounted on the mobile tool, and plans a path for the mobile tool based on the environmental information collected by these sensors and the mobile tool's own information, so as to achieve the purpose of controlling the automatic driving of the mobile tool.
[0141] The mobile tool provided in the embodiments of the present application can be any device with mobile capabilities, including vehicles with automatic driving or intelligent driving (including vehicles with passenger functions (such as cars, buses, large buses, minibuses, etc.), vehicles with cargo functions (such as ordinary trucks, vans, trailers, closed trucks, tank trucks, flatbed trucks, container trucks, dump trucks, special structure trucks), special vehicles (such as logistics distribution vehicles, automatic guided transport vehicles AGV, patrol cars, cranes, cranes, excavators, bulldozers, forklifts, rollers, loaders, off-road engineering vehicles, armored engineering vehicles, sewage treatment vehicles, sanitation vehicles, vacuum trucks, floor washing vehicles, sprinkler trucks, sweeping robots, food delivery robots, shopping guide robots, lawn mowers, golf carts, etc.), vehicles with entertainment functions (such as entertainment vehicles, amusement park automatic driving devices, balance cars, etc.), rescue vehicles (such as fire trucks, ambulances, power repair vehicles, engineering rescue vehicles, etc.)) and robots (such as sweeping robots, food delivery robots, etc.), etc.
[0142] It should be noted that, in this article, relational terms such as "first" and "second" are only used to distinguish one entity or operation from another entity or operation, and do not necessarily require or imply any such actual relationship or order between these entities or operations. Moreover, the terms "include", "comprise" or any other variants thereof are intended to cover non-exclusive inclusion, so that a process, method, article or device including a series of elements includes not only those elements, but also other elements not explicitly listed, or also includes elements inherent to such process, method, article or device. In the absence of further restrictions, the elements defined by the sentence "comprise a ..." do not exclude the existence of other identical elements in the process, method, article or device including the elements.
[0143] The foregoing is merely a specific embodiment of the present invention, which enables those skilled in the art to understand or implement the present invention. Various modifications to these embodiments will be apparent to those skilled in the art, and the general principles defined herein may be implemented in other embodiments without departing from the spirit or scope of the present invention. Therefore, the present invention will not be limited to the embodiments shown herein, but rather to the widest scope consistent with the principles and novel features claimed herein.
Claims
1. A vehicle trajectory tracking method, It is characterized in that The method comprises: Obtain the vehicle's current position information and motion parameters; According to the motion parameters, positions corresponding to N preview points are determined from the target trajectory, where N is an integer greater than or equal to 2; Calculate the front wheel turning angles corresponding to the N preview points according to the posture information and the positions corresponding to the N preview points; Determining the target turning angle of the vehicle at the current moment according to the front wheel turning angles corresponding to the N preview points; The vehicle is controlled to track the target trajectory according to the target turning angle.
2. The method according to claim 1, It is characterized in that The motion parameters include driving speed and acceleration; Determining positions corresponding to N preview points from the target trajectory according to the motion parameters includes: Get N preview times within a single time period; According to the vehicle speed interval corresponding to the driving speed, a weight parameter corresponding to the driving speed is determined from a preset corresponding relationship, wherein the preset corresponding relationship is used to characterize the corresponding relationship between the vehicle speed interval and the weight parameter; Calculate the trajectory lengths of the N preview points according to the driving speed, the acceleration, the N preview times and the weight parameter, wherein the trajectory lengths of the N preview points are used to represent the trajectory lengths from the trajectory point closest to the vehicle position to the N preview points; According to the track lengths of the N preview points, positions corresponding to the N preview points are determined.
3. The method according to claim 2, It is characterized in that The N preview times cover the entire time period of the single time cycle, and K preset times among the N preview times are concentrated in the front time period of the single time cycle, where K is an integer greater than or equal to N / 2 and less than N.
4. The method according to claim 2, It is characterized in that The calculation formula of the trajectory length of the N preview points is as follows: Among them, Pass t represents the trajectory length of the target preview point, t represents the target preview time, v represents the driving speed, a represents the acceleration, P 0 and P 1 represents the weight parameter, L dfset represents a preset compensation value, the target preview point is a preview point among the N preview points corresponding to the target preview time, and the target preview time is any preview time among the N preview times.
5. The method according to claim 1, It is characterized in that The position information includes vehicle position and vehicle attitude; The calculating the front wheel turning angles corresponding to the N preview points according to the posture information and the positions corresponding to the N preview points includes: Determine N preview distances according to the vehicle position and the positions corresponding to the N preview points, wherein the N preview distances are used to represent the Euclidean distances from the center point of the rear axle of the vehicle to the N preview points; Determine N heading deviations according to the vehicle posture, the vehicle position and the positions corresponding to the N preview points, wherein the N heading deviations are used to characterize the deviations between the vehicle heading and the directions where the N preview points are located; The front wheel turning angles corresponding to the N preview points are calculated according to the N preview distances and the N heading deviations.
6. The method according to claim 5, It is characterized in that The calculation formula of the front wheel turning angle corresponding to the N preview points is as follows: Among them, δ i represents the front wheel turning angle corresponding to the i-th preview point, L i represents the preview distance corresponding to the i-th preview point, α i represents the heading deviation corresponding to the i-th preview point, l d represents the vehicle wheelbase, i∈1,…,N.
7. The method according to claim 1, It is characterized in that Determining the target turning angle of the vehicle at the current moment according to the front wheel turning angles corresponding to the N preview points includes: Obtaining N weight coefficients of the front wheel turning angles corresponding to the N preview points; According to the N weight coefficients, a weighted average calculation is performed on the front wheel turning angles corresponding to the N preview points to obtain a calculation result, and the calculation result is determined as the target turning angle.
8. A vehicle trajectory tracking device, It is characterized in that The device comprises: The acquisition module is used to obtain the vehicle's position information and motion parameters at the current moment; A first determination module, used to determine positions corresponding to N preview points from the target trajectory according to the motion parameters, where N is an integer greater than or equal to 2; A calculation module, used for calculating the front wheel turning angles corresponding to the N preview points according to the posture information and the positions corresponding to the N preview points; A second determination module is used to determine the target turning angle of the vehicle at the current moment according to the front wheel turning angles corresponding to the N preview points; The tracking module is used to control the vehicle to track the target trajectory according to the target turning angle.
9. An electronic device, It is characterized in that It includes a processor, a communication interface, a memory and a communication bus, wherein the processor, the communication interface and the memory communicate with each other through the communication bus; Memory, used to store computer programs; The processor is used to implement the steps of the vehicle trajectory tracking method described in any one of claims 1 to 7 when executing the program stored in the memory.
10. A computer-readable storage medium having a computer program stored thereon, It is characterized in that When the computer program is executed by a processor, the steps of the vehicle trajectory tracking method according to any one of claims 1 to 7 are implemented.
11. A mobile tool, It is characterized in that An electronic device comprising the electronic device described in claim 9.
Citation Information
Cited By
Path tracking method and device and storage medium
CN119882726A
Automatic driving multi-target lateral trajectory tracking optimization control method and device
CN120817098A
