Path tracking method, device, equipment and medium

CN119002501APending Publication Date: 2024-11-22MORO SMART ENERGY (SHENZHEN) CO LTD
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202411142007.7
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-08-20
Publication Date
2024-11-22

Smart Images

  • Figure CN119002501A_ABST
    Figure CN119002501A_ABST
Patent Text Reader

Abstract

The invention relates to the technical field of computers, in particular to a path tracking method and device, equipment and a medium. The method comprises the following steps: acquiring a target path corresponding to an autonomous vehicle; according to the basic moving speed and the current position point coordinate of the autonomous vehicle, determining each look-ahead point coordinate of the autonomous vehicle in each path point coordinate in the target path, and according to the path curvature and the obstacle distance corresponding to each look-ahead point coordinate, determining a target moving speed corresponding to each look-ahead point coordinate, the autonomous vehicle is controlled to move towards all the look-ahead point coordinates at the target moving speed corresponding to all the look-ahead point coordinates; and after the autonomous vehicle reaches the end point of the target path, determining that the path tracking process of the target path ends. According to the embodiment of the invention, in the moving process of the automatic driving vehicle, the moving speed of the automatic driving vehicle to the coordinates of all the look-ahead points can be automatically adjusted according to the path curvature and the obstacle distance.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the field of computer technology, and in particular to a path tracking method, device, equipment and medium. Background Art

[0002] As the functionality and performance of autonomous vehicles continue to improve, more and more companies are adopting them for operations. Autonomous vehicles can follow pre-planned paths within their work areas to complete designated tasks. To ensure that autonomous vehicles follow their planned paths, path tracking is required.

[0003] In the related art, a commonly used path tracking solution is as follows: after obtaining a pre-planned path, the vehicle controller of the autonomous vehicle selects a path point coordinate located ahead of the current position of the autonomous vehicle from among the path point coordinates included in the pre-planned path as the look-ahead point coordinate, and then controls the autonomous vehicle to move at a fixed speed toward the look-ahead point coordinate. After reaching the look-ahead point coordinate, the vehicle controller of the autonomous vehicle reselects a path point coordinate located ahead of the current position of the autonomous vehicle from among the path point coordinates included in the pre-planned path as the new look-ahead point coordinate, and then controls the autonomous vehicle to move toward the new look-ahead point coordinate at a fixed speed until it reaches the last path point coordinate included in the pre-planned path. In this way, by controlling the autonomous vehicle to continuously move toward each look-ahead point coordinate, the autonomous vehicle moves forward according to the pre-planned path.

[0004] If the path corresponding to the look-ahead point coordinates has a large curvature or the autonomous vehicle approaches an obstacle in the operating area, the autonomous vehicle needs to move toward the look-ahead point coordinates at a lower speed to improve the safety of the autonomous vehicle as it moves along the pre-planned path. Path tracking solutions in related technologies control the autonomous vehicle's movement toward each look-ahead point coordinate at a fixed speed. These solutions are unable to automatically adjust the speed of the autonomous vehicle toward each look-ahead point coordinate based on the path curvature and obstacle distance, reducing the safety of the autonomous vehicle as it moves along the pre-planned path. Summary of the Invention

[0005] The present invention provides a path tracking method, device, equipment and medium to solve the problem that the path tracking scheme in the related art controls the autonomous driving vehicle to move to the coordinates of each forward-looking point at a fixed speed, is unable to automatically adjust the speed of the autonomous driving vehicle to move to the coordinates of each forward-looking point according to the path curvature and obstacle distance, thereby reducing the safety of the autonomous driving vehicle in the process of moving forward according to a pre-planned path.

[0006] According to one aspect of the present invention, a path tracking method is provided, comprising:

[0007] Obtaining a target path corresponding to the autonomous vehicle;

[0008] determining, based on the base moving speed and current position coordinates of the autonomous driving vehicle, the coordinates of each look-ahead point of the autonomous driving vehicle in the coordinates of each path point in the target path, determining, based on the path curvature and obstacle distance corresponding to each look-ahead point coordinate, a target moving speed corresponding to each look-ahead point coordinate, and controlling the autonomous driving vehicle to move toward each look-ahead point coordinate at the target moving speed corresponding to each look-ahead point coordinate;

[0009] After the autonomous driving vehicle reaches the end point of the target path, the path tracking process of determining the target path ends.

[0010] According to another aspect of the present invention, there is provided a path tracking device, comprising:

[0011] A path acquisition module, used to obtain a target path corresponding to the autonomous driving vehicle;

[0012] a path tracking module, configured to determine the coordinates of each forward-looking point of the autonomous vehicle in the coordinates of each path point in the target path based on the base moving speed and the current position point coordinates of the autonomous vehicle, determine the target moving speed corresponding to each forward-looking point coordinate based on the path curvature and obstacle distance corresponding to each forward-looking point coordinate, and control the autonomous vehicle to move toward each forward-looking point coordinate at the target moving speed corresponding to each forward-looking point coordinate;

[0013] An ending module is used to determine that the path tracking process of the target path is ended after the autonomous driving vehicle reaches the end point of the target path.

[0014] According to another aspect of the present invention, an electronic device is provided, comprising:

[0015] at least one processor;

[0016] and a memory communicatively coupled to the at least one processor;

[0017] The memory stores a computer program executed by the at least one processor, and the computer program is executed by the at least one processor so that the at least one processor can execute the path tracking method described in any embodiment of the present invention.

[0018] According to another aspect of the present invention, a computer-readable storage medium is provided, wherein the computer-readable storage medium stores computer instructions, and the computer instructions are used to enable a processor to implement the path tracking method according to any embodiment of the present invention when executed.

[0019] The technical solution of the embodiment of the present invention obtains a target path corresponding to the autonomous driving vehicle; then, based on the basic moving speed and current position coordinates of the autonomous driving vehicle, determines the coordinates of each forward point of the autonomous driving vehicle in the coordinates of each path point in the target path, and determines the target moving speed corresponding to each forward point coordinate according to the path curvature and obstacle distance corresponding to each forward point coordinate, and controls the autonomous driving vehicle to move toward each forward point coordinate at the target moving speed corresponding to each forward point coordinate; after the autonomous driving vehicle reaches the end point of the target path, it is determined that the path tracking process of the target path is terminated, which solves the problem that the path tracking solution in the related art controls the autonomous driving vehicle to move toward each forward point coordinate at a fixed speed, and cannot automatically adjust the movement of the autonomous driving vehicle toward each forward point coordinate according to the path curvature and obstacle distance. The speed of movement is improved, which reduces the safety problem of the autonomous driving vehicle in the process of moving forward according to the pre-planned path. During the movement of the autonomous driving vehicle, the coordinates of each forward point of the autonomous driving vehicle can be automatically determined in the coordinates of each path point in the target path according to the basic moving speed of the autonomous driving vehicle and the coordinates of the current position point. The speed of the autonomous driving vehicle moving to the forward point coordinates can be automatically determined according to the path curvature and obstacle distance corresponding to each forward point coordinate, and then the autonomous driving vehicle is controlled to move to each forward point coordinate at a suitable speed. In this way, the speed of the autonomous driving vehicle moving to each forward point coordinate is automatically adjusted according to the path curvature and obstacle distance during the movement of the autonomous driving vehicle, thereby improving the safety of the autonomous driving vehicle in the process of moving forward according to the pre-planned path.

[0020] It should be understood that the content described in this section is not intended to identify the key or important features of the embodiments of the present invention, nor is it intended to limit the scope of the present invention. Other features of the present invention will become readily understood through the following description. BRIEF DESCRIPTION OF THE DRAWINGS

[0021] In order to more clearly illustrate the technical solutions in the embodiments of the present invention, the following briefly introduces the drawings required for use in the description of the embodiments. Obviously, the drawings described below are only some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without creative work.

[0022] Figure 1 This is a flow chart of a path tracking method provided in Example 1 of the present invention.

[0023] Figure 2 This is a flow chart of a path tracking method provided in the second embodiment of the present invention.

[0024] Figure 3 This is a structural diagram of a path tracking device provided in Example 3 of the present invention.

[0025] Figure 4 A schematic structural diagram of an electronic device for implementing the path tracking method according to an embodiment of the present invention. DETAILED DESCRIPTION

[0026] In order to enable those skilled in the art to better understand the solutions of the present invention, the technical solutions in the embodiments of the present invention will be clearly and completely described below in conjunction with the drawings in the embodiments of the present invention. Obviously, the embodiments described are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without making creative efforts should fall within the scope of protection of the present invention.

[0027] It should be noted that the terms "target", "first", "second", etc. in the description and claims of the present invention and the above-mentioned drawings are used to distinguish similar objects and are not necessarily used to describe a specific order or sequence. It should be understood that the numbers used in this way can be interchanged where appropriate, so that the embodiments of the present invention described herein can be implemented in an order other than those illustrated or described herein. In addition, the terms "comprise", "include" and "have" and any variations thereof are intended to cover non-exclusive inclusions. For example, a process, method, system, product or device that includes a series of steps or units is not necessarily limited to those steps or units clearly listed, but may include other steps or units that are not clearly listed or inherent to these processes, methods, products or devices.

[0028] Example 1

[0029] Figure 1 This is a flow chart of a path tracking method provided in the first embodiment of the present invention. This embodiment is applicable to the case of performing path tracking on an autonomous vehicle. The method can be executed by a path tracking device, which can be implemented in the form of hardware and / or software, and can be configured in a vehicle controller of an autonomous vehicle. The vehicle controller can be a controller provided in the autonomous vehicle for controlling the autonomous vehicle. Figure 1 As shown, the method includes:

[0030] Step 101: Obtain a target path corresponding to the autonomous driving vehicle.

[0031] Optionally, the autonomous vehicle may be a vehicle capable of autonomous movement under the control of its own vehicle controller. The target path corresponding to the autonomous vehicle may be a path planned by the target user for the autonomous vehicle within the operating area. The operating area may be an area within which the autonomous vehicle is required to move. The operating area may be a designated area in an underground garage. The target user may be a technician responsible for managing the autonomous vehicle.

[0032] Optionally, the target path can be composed of multiple path point coordinates arranged in sequence. The target path can contain at least three path point coordinates. Each path point coordinate is the location coordinate of a location point that the autonomous vehicle can reach. The location coordinate of the location point can be the latitude and longitude coordinates of the location point. The starting point of the target path is the first path point coordinate in the target path. The end point of the target path is the last path point coordinate in the target path. Initially, the autonomous vehicle has reached the starting point of the target path. The vehicle controller needs to control the autonomous vehicle to start from the starting point of the target path, move forward along the pre-planned path, and finally move to the end point of the target path based on the path point coordinates in the target path.

[0033] Optionally, obtaining the target path corresponding to the autonomous vehicle includes: obtaining the target path corresponding to the autonomous vehicle sent by a target user. The target user may send the target path corresponding to the autonomous vehicle to the vehicle controller via a terminal device. The vehicle controller obtains the target path corresponding to the autonomous vehicle sent by the target user.

[0034] Step 102: Based on the basic moving speed and current position coordinates of the autonomous driving vehicle, determine the coordinates of each forward point of the autonomous driving vehicle in the coordinates of each path point in the target path, and based on the path curvature and obstacle distance corresponding to each forward point coordinate, determine the target moving speed corresponding to each forward point coordinate, and control the autonomous driving vehicle to move toward each forward point coordinate at the target moving speed corresponding to each forward point coordinate.

[0035] Optionally, after obtaining the target path corresponding to the autonomous driving vehicle, the vehicle controller starts to determine the coordinates of each forward point of the autonomous driving vehicle in the coordinates of each path point in the target path based on the basic moving speed and current position point coordinates of the autonomous driving vehicle, and determines the target moving speed corresponding to each forward point coordinate based on the path curvature and obstacle distance corresponding to each forward point coordinate, and controls the autonomous driving vehicle to move toward each forward point coordinate at the target moving speed corresponding to each forward point coordinate.

[0036] Optionally, according to the basic moving speed and current position point coordinates of the autonomous driving vehicle, the forward point coordinates of each path point coordinate in the target path are determined, and according to the path curvature and obstacle distance corresponding to each forward point coordinate, the target moving speed corresponding to each forward point coordinate is determined, and the autonomous driving vehicle is controlled to move toward each forward point coordinate at the target moving speed corresponding to each forward point coordinate, including: according to the basic moving speed and current position point coordinates of the autonomous driving vehicle, the forward point coordinates of each path point coordinate in the target path are determined; according to the path curvature and obstacle distance corresponding to the forward point coordinates, whether the path curvature corresponding to the forward point coordinates is large and whether the autonomous driving vehicle is close to an obstacle in the operating area; if the path curvature corresponding to the forward point coordinates is large or the autonomous driving vehicle is close to the operating area If there is an obstacle in the area, then according to the path curvature or the preset obstacle distance threshold, a low-speed moving speed corresponding to the basic moving speed is determined, and the low-speed moving speed is determined as the target moving speed corresponding to the look-ahead point coordinate; the autonomous driving vehicle is controlled to move toward the look-ahead point coordinate at the target moving speed corresponding to the look-ahead point coordinate; after the autonomous driving vehicle reaches the look-ahead point coordinate, it is detected whether the look-ahead point coordinate is the last path point coordinate in the target path; if the look-ahead point coordinate is the last path point coordinate in the target path, it is determined that the autonomous driving vehicle has reached the end point of the target path; if the look-ahead point coordinate is not the last path point coordinate in the target path, then the operation of determining the look-ahead point coordinate of the autonomous driving vehicle in each path point coordinate in the target path according to the basic moving speed and current position point coordinate of the autonomous driving vehicle is returned to.

[0037] Optionally, the base moving speed of the autonomous vehicle may be a preset speed at which the autonomous vehicle moves toward the look-ahead point coordinates when the path curvature corresponding to the look-ahead point coordinates is not significant and the autonomous vehicle is not near obstacles in the operating area. The current position coordinates of the autonomous vehicle may be the position coordinates of the autonomous vehicle's current position. The look-ahead point coordinates of the autonomous vehicle may be the coordinates of the path point to which the autonomous vehicle needs to move at the current moment.

[0038] Optionally, the vehicle controller stores a base moving speed of the autonomous vehicle. The autonomous vehicle is provided with a positioning component. The positioning component may be a component for determining the position coordinates of a point at which the autonomous vehicle is located. The vehicle controller may use the positioning component to determine the position coordinates of the autonomous vehicle at each moment.

[0039] Optionally, the forward point coordinates of the autonomous driving vehicle are determined in the coordinates of each path point in the target path based on the basic moving speed and current position point coordinates of the autonomous driving vehicle, including: converting the coordinates of each path point in the target path into coordinates in the vehicle coordinate system of the autonomous driving vehicle; determining the coordinates of each path point located in front of the autonomous driving vehicle at a current moment based on the coordinates in the vehicle coordinate system of the autonomous driving vehicle converted from each path point coordinate; determining the forward distance of the autonomous driving vehicle based on the basic moving speed of the autonomous driving vehicle; and determining the coordinates of the path point located in front of the autonomous driving vehicle at a current moment whose distance from the current position point coordinates of the autonomous driving vehicle is equal to the forward distance as the forward point coordinates of the autonomous driving vehicle.

[0040] Optionally, the vehicle coordinate system of the autonomous driving vehicle can be a plane rectangular coordinate system constructed based on the autonomous driving vehicle. The vehicle coordinate system of the autonomous driving vehicle takes the projection point from the center of the rear axle of the autonomous driving vehicle to the ground as the origin (point O), the front of the autonomous driving vehicle as the positive longitudinal axis (y-axis), and the right side of the autonomous driving vehicle as the positive transverse axis (x-axis). A conversion component is provided in the vehicle controller. The conversion component can be a pre-set component for converting longitude and latitude coordinates into coordinates in the vehicle coordinate system of the autonomous driving vehicle. The vehicle controller can convert the coordinates of each path point in the target path into coordinates in the vehicle coordinate system of the autonomous driving vehicle through the conversion component, and obtain the coordinates of each path point in the vehicle coordinate system of the autonomous driving vehicle. The coordinates in the vehicle coordinate system of the autonomous driving vehicle converted from each path point coordinate include horizontal and vertical coordinates.

[0041] Optionally, under normal circumstances, when the path point coordinates are located in front of the autonomous vehicle, the ordinates of the coordinates in the vehicle coordinate system of the autonomous vehicle converted from the path point coordinates will be greater than 0. Therefore, the vehicle controller can detect whether the ordinates of the coordinates in the vehicle coordinate system of the autonomous vehicle converted from the path point coordinates are greater than 0, and determine the coordinates of the path points whose ordinates in the vehicle coordinate system of the autonomous vehicle converted from the path point coordinates are greater than 0 as the coordinates of the path points currently located in front of the autonomous vehicle.

[0042] Optionally, the forward distance of the autonomous driving vehicle may be the distance that the autonomous driving vehicle moves in the process of moving from the current position point coordinates to the forward point coordinates, estimated based on the basic moving speed of the autonomous driving vehicle.

[0043] Optionally, determining the look-ahead distance of the autonomous driving vehicle based on the basic moving speed of the autonomous driving vehicle includes: calculating the look-ahead distance of the autonomous driving vehicle according to the following preset look-ahead distance estimation formula:

[0044] lookahead_dist=|v x |×lookahead_time,

[0045] Among them, lookahead_dist is the forward distance of the autonomous driving vehicle, v x The base speed of the autonomous vehicle, and lookahead_time are preset durations. The preset duration is a pre-set duration. The vehicle controller stores the preset duration. The preset lookahead distance estimation formula may be a formula pre-set in the vehicle controller for estimating the lookahead distance of the autonomous vehicle based on the base speed of the autonomous vehicle.

[0046] Optionally, the coordinates of the path point located in front of the autonomous driving vehicle at the current moment and whose distance from the coordinates of the current position point of the autonomous driving vehicle is equal to the look-ahead distance are determined as the look-ahead point coordinates of the autonomous driving vehicle, including: determining the distance between the coordinates of each path point located in front of the autonomous driving vehicle at the current moment converted into the coordinates in the vehicle coordinate system of the autonomous driving vehicle and the coordinates of the current position point of the autonomous driving vehicle; detecting whether there is a distance that is the same as the look-ahead distance between the coordinates of each path point located in front of the autonomous driving vehicle at the current moment and the coordinates of the current position point of the autonomous driving vehicle; if there is a distance that is the same as the look-ahead distance, determining the coordinates of the path point located in front of the autonomous driving vehicle at the current moment corresponding to the distance as the look-ahead point coordinates of the autonomous driving vehicle; if there is no distance that is the same as the look-ahead distance, calculating the difference between each distance and the look-ahead distance, and determining the coordinates of the path point located in front of the autonomous driving vehicle at the current moment corresponding to the distance having the smallest absolute value of the difference with the look-ahead distance as the look-ahead point coordinates of the autonomous driving vehicle.

[0047] Optionally, determining the distance between the coordinates of each path point located in front of the autonomous vehicle at the current moment converted into the coordinates in the vehicle coordinate system of the autonomous vehicle and the coordinates of the current position point of the autonomous vehicle includes: performing the following operation for each path point coordinate located in front of the autonomous vehicle at the current moment: calculating the distance between the coordinates in the vehicle coordinate system of the autonomous vehicle converted into the coordinates of the path point and the coordinates of the current position point of the autonomous vehicle according to the following preset distance calculation formula:

[0048]

[0049] Where d is the distance between the coordinates of the autonomous vehicle's current position point in the vehicle coordinate system converted from the path point coordinates, x is the horizontal coordinate of the coordinates of the autonomous vehicle's current position point in the vehicle coordinate system converted from the path point coordinates, and y is the vertical coordinate of the coordinates of the autonomous vehicle's current position point in the vehicle coordinate system converted from the path point coordinates. The preset distance calculation formula may be a formula preset in the vehicle controller for calculating the distance between the coordinates of the autonomous vehicle's current position point in the vehicle coordinate system converted from the latitude and longitude coordinates.

[0050] Optionally, the path curvature corresponding to the look-ahead point coordinates refers to the curvature of the curve fitted by the coordinates of all path points in the target path at the look-ahead point coordinates. The obstacle distance corresponding to the look-ahead point coordinates includes the distance between the current position coordinates and each obstacle in the working area.

[0051] Optionally, based on the path curvature and obstacle distance corresponding to the forward-looking point coordinates, determining whether the path curvature corresponding to the forward-looking point coordinates is large and whether the autonomous driving vehicle is close to an obstacle in the operating area includes: determining the path curvature corresponding to the forward-looking point coordinates based on the coordinates in the vehicle coordinate system of the autonomous driving vehicle converted from the forward-looking point coordinates; determining whether the path curvature corresponding to the forward-looking point coordinates is large based on a preset value; and determining the obstacle distance corresponding to the forward-looking point coordinates; wherein the obstacle distance corresponding to the forward-looking point coordinates includes the distance between the current position point coordinates and each obstacle in the operating area; and determining whether the autonomous driving vehicle is close to an obstacle in the operating area based on the distance between the current position point coordinates and each obstacle in the operating area and a preset distance threshold.

[0052] Optionally, determining the path curvature corresponding to the look-ahead point coordinates based on the coordinates of the vehicle coordinate system of the autonomous driving vehicle converted from the look-ahead point coordinates includes: calculating the path curvature corresponding to the look-ahead point coordinates based on the following preset curvature estimation formula:

[0053]

[0054] Where k is the path curvature corresponding to the look-ahead point coordinates, y is the ordinate of the coordinates in the vehicle coordinate system of the autonomous vehicle converted from the look-ahead point coordinates, and d is the distance between the coordinates in the vehicle coordinate system of the autonomous vehicle converted from the look-ahead point coordinates and the coordinates of the autonomous vehicle's current position. The preset curvature estimation formula may be a formula preset in the vehicle controller for estimating the path curvature corresponding to the look-ahead point coordinates based on the coordinates in the vehicle coordinate system of the autonomous vehicle converted from the look-ahead point coordinates.

[0055] Optionally, based on a preset value, determining whether the path curvature corresponding to the forward-looking point coordinates is larger includes: detecting whether the path curvature corresponding to the forward-looking point coordinates is larger than a preset value; if it is detected that the path curvature is larger than the preset value, determining that the path curvature corresponding to the forward-looking point coordinates is larger; if it is detected that the path curvature is less than or equal to the preset value, determining that the path curvature corresponding to the forward-looking point coordinates is not larger.

[0056] Optionally, the preset value is a value pre-set in the vehicle controller. Generally, if the path curvature corresponding to the look-ahead point coordinates is greater than the preset value, it can be determined that the path curvature corresponding to the look-ahead point coordinates is large, and the autonomous vehicle needs to move toward the look-ahead point coordinates at a lower speed. If the path curvature corresponding to the look-ahead point coordinates is less than or equal to the preset value, it can be determined that the path curvature corresponding to the look-ahead point coordinates is not large, and the autonomous vehicle does not need to move toward the look-ahead point coordinates at a lower speed.

[0057] Optionally, the obstacle distance corresponding to the look-ahead point coordinates includes the distance between the current position point coordinates and each obstacle in the operating area. The operating area includes multiple obstacles. The position coordinates of each obstacle are stored in the vehicle controller. The position coordinates of the obstacle are the position coordinates of the position point where the obstacle is located. The distance between the current position point coordinates and the obstacle may refer to the distance between the coordinates of the obstacle in the vehicle coordinate system of the autonomous driving vehicle converted from the position coordinates of the obstacle and the coordinates of the current position point of the autonomous driving vehicle. Determining the obstacle distance corresponding to the look-ahead point coordinates includes: performing the following operations for each obstacle in the operating area: converting the position coordinates of the obstacle into coordinates in the vehicle coordinate system of the autonomous driving vehicle; and calculating the distance between the coordinates of the obstacle in the vehicle coordinate system of the autonomous driving vehicle converted from the position coordinates of the obstacle and the coordinates of the current position point of the autonomous driving vehicle according to a preset distance calculation formula, thereby obtaining the distance between the coordinates of the current position point and the obstacle.

[0058] Optionally, determining whether the autonomous driving vehicle is close to an obstacle in the working area is based on the distance between the current position point coordinates and each obstacle in the working area and a preset distance threshold, including: detecting whether the distance between the current position point coordinates and each obstacle in the working area is less than the preset distance threshold; if it is detected that the distance between the current position point coordinates and the target obstacle in the working area is less than the preset distance threshold, determining that the autonomous driving vehicle is close to the obstacle in the working area; if it is detected that the distance between the current position point coordinates and each obstacle in the working area is greater than or equal to the preset distance threshold, determining that the autonomous driving vehicle is not close to the obstacle in the working area.

[0059] Optionally, the preset distance threshold is a distance threshold pre-set in the vehicle controller. Generally, if the distance between the coordinates of the current location point and a target obstacle in the work area is less than the preset distance threshold, the autonomous vehicle can be determined to be close to an obstacle in the work area. The target obstacle is one or more obstacles in the work area. If the distance between the coordinates of the current location point and each obstacle in the work area is greater than or equal to the preset distance threshold, the autonomous vehicle can be determined to be not close to an obstacle in the work area.

[0060] Optionally, the low-speed movement speed corresponding to the base movement speed is an estimated speed, based on path curvature or a preset obstacle distance threshold, suitable for the autonomous vehicle to move toward the look-ahead point coordinates when the path curvature corresponding to the look-ahead point coordinates is large and / or the autonomous vehicle is close to an obstacle in the operating area. The low-speed movement speed corresponding to the base movement speed is less than the base movement speed. The target movement speed corresponding to the look-ahead point coordinates is the speed at which the autonomous vehicle is moving toward the look-ahead point coordinates.

[0061] Optionally, if the path curvature corresponding to the look-ahead point coordinates is large or the autonomous driving vehicle is close to an obstacle in the operating area, then according to the path curvature or a preset obstacle distance threshold, a low-speed moving speed corresponding to the basic moving speed is determined, and the low-speed moving speed is determined as the target moving speed corresponding to the look-ahead point coordinates, including: if the path curvature corresponding to the look-ahead point coordinates is large and the autonomous driving vehicle is not close to an obstacle in the operating area, then according to the path curvature, a low-speed moving speed corresponding to the basic moving speed is determined, and the low-speed moving speed is determined as the target moving speed corresponding to the look-ahead point coordinates ; If the path curvature corresponding to the look-ahead point coordinates is not large, and the autonomous driving vehicle is close to an obstacle in the working area, then the low-speed moving speed corresponding to the basic moving speed is determined according to the preset obstacle distance threshold, and the low-speed moving speed is determined as the target moving speed corresponding to the look-ahead point coordinates; If the path curvature corresponding to the look-ahead point coordinates is large and the autonomous driving vehicle is close to an obstacle in the working area, then the low-speed moving speed corresponding to the basic moving speed is determined according to the path curvature and the preset obstacle distance threshold, and the low-speed moving speed is determined as the target moving speed corresponding to the look-ahead point coordinates.

[0062] Optionally, if the path curvature corresponding to the look-ahead point coordinates is large and the autonomous driving vehicle is not close to an obstacle in the operating area, determining a low-speed moving speed corresponding to the basic moving speed based on the path curvature, and determining the low-speed moving speed as the target moving speed corresponding to the look-ahead point coordinates, including: if the path curvature corresponding to the look-ahead point coordinates is large and the autonomous driving vehicle is not close to an obstacle in the operating area, calculating the low-speed moving speed corresponding to the basic moving speed according to the following first preset speed estimation formula:

[0063]

[0064] Among them, v t1 is the low-speed movement speed corresponding to the basic movement speed estimated based on the path curvature, v x The vehicle controller stores min_rad, which is greater than the inverse of the path curvature corresponding to each look-ahead point.

[0065] Optionally, the first preset speed estimation formula may be a formula pre-set in the vehicle controller for estimating, based on the path curvature, a suitable speed of the autonomous driving vehicle moving toward the look-ahead point coordinates when the path curvature corresponding to the look-ahead point coordinates is large. The low-speed moving speed determined to correspond to the basic moving speed is less than the basic moving speed. The low-speed moving speed is determined as the target moving speed corresponding to the look-ahead point coordinates, and then the autonomous driving vehicle is controlled to move toward the look-ahead point coordinates at the target moving speed corresponding to the look-ahead point coordinates. Thus, when the path curvature corresponding to the look-ahead point coordinates is large, the speed of the autonomous driving vehicle moving toward the look-ahead point coordinates is automatically adjusted according to the path curvature, and the autonomous driving vehicle is controlled to move toward the look-ahead point coordinates at a lower speed, thereby improving the safety of the autonomous driving vehicle in the process of moving forward along the pre-planned path.

[0066] Optionally, the preset obstacle distance threshold is a distance threshold set in the vehicle controller. During normal movement of the autonomous vehicle, the distance between the autonomous vehicle and the obstacle is greater than the preset obstacle distance threshold.

[0067] Optionally, if the path curvature corresponding to the look-ahead point coordinates is not large and the autonomous vehicle is close to an obstacle in the operation area, then according to the preset obstacle distance threshold, determine a low-speed movement speed corresponding to the basic movement speed, and determine the low-speed movement speed as the target movement speed corresponding to the look-ahead point coordinates, including: if the path curvature corresponding to the look-ahead point coordinates is not large and the autonomous vehicle is close to an obstacle in the operation area, then calculate a low-speed movement speed corresponding to the basic movement speed according to the following second preset speed estimation formula:

[0068]

[0069] where v t2 is the low-speed movement speed corresponding to the basic movement speed estimated according to the preset obstacle distance threshold, v x is the basic movement speed, min_distance_to_obstacle is the preset obstacle distance threshold, cost_scaling_gain and cost_scaling_dist are two preset coefficients, 0 < cost_scaling_gain < 1, cost_scaling_dist is greater than 0 and cost_scaling_dist is less than min_distance_to_obstacle; determine the low-speed movement speed as the target movement speed corresponding to the look-ahead point coordinates.

[0070] Optionally, the second preset speed estimation formula can be a formula pre-set in the vehicle controller for estimating a suitable speed for the autonomous vehicle to move towards the look-ahead point coordinates in the case where the autonomous vehicle is close to an obstacle in the operation area. The determined low-speed movement speed corresponding to the basic movement speed is less than the basic movement speed. Determine the low-speed movement speed as the target movement speed corresponding to the look-ahead point coordinates, and then control the autonomous vehicle to move towards the look-ahead point coordinates at the target movement speed corresponding to the look-ahead point coordinates, so that in the case where the autonomous vehicle is close to an obstacle in the operation area, automatically adjust the speed of the autonomous vehicle moving towards the look-ahead point coordinates according to the obstacle distance, control the autonomous vehicle to move towards the look-ahead point coordinates at a lower speed, and improve the safety of the autonomous vehicle during the process of moving forward along the pre-planned path.

[0071] Optionally, if the path curvature corresponding to the look-ahead point coordinates is large and the autonomous driving vehicle is close to an obstacle in the working area, a low-speed moving speed corresponding to the basic moving speed is determined based on the path curvature and a preset obstacle distance threshold, and the low-speed moving speed is determined as the target moving speed corresponding to the look-ahead point coordinates, including: if the path curvature corresponding to the look-ahead point coordinates is large and the autonomous driving vehicle is close to an obstacle in the working area, the low-speed moving speed corresponding to the basic moving speed is first determined based on the path curvature; then the low-speed moving speed corresponding to the basic moving speed is determined based on the preset obstacle distance threshold; the smaller value of the low-speed moving speed corresponding to the basic moving speed determined based on the path curvature and the low-speed moving speed corresponding to the basic moving speed determined based on the preset obstacle distance threshold is determined as the target moving speed corresponding to the look-ahead point coordinates.

[0072] Optionally, if the low-speed moving speed corresponding to the basic moving speed determined by the path curvature and the low-speed moving speed corresponding to the basic moving speed determined according to the preset obstacle distance threshold are the same, then any one of the low-speed moving speed corresponding to the basic moving speed determined by the path curvature and the low-speed moving speed corresponding to the basic moving speed determined according to the preset obstacle distance threshold is determined as the target moving speed corresponding to the forward-looking point coordinates.

[0073] Optionally, the determined low-speed moving speeds corresponding to the basic moving speed are all lower than the basic moving speed. The autonomous vehicle is controlled to move toward the look-ahead point coordinates at the target moving speed corresponding to the look-ahead point coordinates. Thus, when the path curvature corresponding to the look-ahead point coordinates is large and the autonomous vehicle is close to an obstacle in the operating area, the speed at which the autonomous vehicle moves toward the look-ahead point coordinates is automatically adjusted according to the path curvature and the distance to the obstacle, and the autonomous vehicle is controlled to move toward the look-ahead point coordinates at a lower speed, thereby improving the safety of the autonomous vehicle in the process of moving forward along the pre-planned path.

[0074] Optionally, the vehicle controller may control the autonomous vehicle to move toward the look-ahead point coordinates at a specified speed. After determining a target movement speed corresponding to the look-ahead point coordinates, the vehicle controller controls the autonomous vehicle to move toward the look-ahead point coordinates at the target movement speed corresponding to the look-ahead point coordinates.

[0075] Optionally, after the autonomous driving vehicle reaches the look-ahead point coordinate, the vehicle controller detects whether the look-ahead point coordinate is the last path point coordinate in the target path. Detecting whether the look-ahead point coordinate is the last path point coordinate in the target path includes: determining whether the look-ahead point coordinate is the same as the last path point coordinate in the target path; if so, determining that the look-ahead point coordinate is the last path point coordinate in the target path; if not, determining that the look-ahead point coordinate is not the last path point coordinate in the target path.

[0076] Optionally, if the forward point coordinates are the last path point coordinates in the target path, it is determined that the autonomous driving vehicle has reached the end point of the target path.

[0077] Optionally, if the forward point coordinate is not the last path point coordinate in the target path, the operation is returned to determine the forward point coordinate of the autonomous driving vehicle in each path point coordinate in the target path based on the basic moving speed and current position point coordinate of the autonomous driving vehicle, thereby determining the new forward point coordinate, and then controlling the autonomous driving vehicle to move toward the new forward point coordinate at a target moving speed corresponding to the new forward point coordinate until it reaches the end point of the target path, thereby controlling the autonomous driving vehicle to continuously move toward each forward point coordinate, so that the autonomous driving vehicle moves forward according to the target path.

[0078] Optionally, after determining whether the path curvature corresponding to the forward-point coordinates is large and whether the autonomous driving vehicle is close to an obstacle in the operating area based on the path curvature and obstacle distance corresponding to the forward-point coordinates, it also includes: if the path curvature corresponding to the forward-point coordinates is not large and the autonomous driving vehicle is not close to an obstacle in the operating area, determining the basic moving speed as the target moving speed corresponding to the forward-point coordinates; controlling the autonomous driving vehicle to move toward the forward-point coordinates at the target moving speed corresponding to the forward-point coordinates; after the autonomous driving vehicle reaches the forward-point coordinates, detecting whether the forward-point coordinates are the last path point coordinates in the target path; if the forward-point coordinates are the last path point coordinates in the target path, determining that the autonomous driving vehicle has reached the end point of the target path; if the forward-point coordinates are not the last path point coordinates in the target path, returning to execute the operation of determining the forward-point coordinates of the autonomous driving vehicle among the various path point coordinates in the target path based on the basic moving speed and current position point coordinates of the autonomous driving vehicle.

[0079] Step 103: After the autonomous driving vehicle reaches the end point of the target path, determine that the path tracking process of the target path ends.

[0080] Optionally, after the autonomous driving vehicle reaches the end point of the target path, that is, after the autonomous driving vehicle reaches the coordinates of the last path point in the target path, the vehicle controller determines that the path tracking process of the target path is ended and controls the autonomous driving vehicle to stay at the end point of the target path.

[0081] The technical solution of the embodiment of the present invention obtains a target path corresponding to the autonomous driving vehicle; then, based on the basic moving speed and current position coordinates of the autonomous driving vehicle, determines the coordinates of each forward point of the autonomous driving vehicle in the coordinates of each path point in the target path, and determines the target moving speed corresponding to each forward point coordinate according to the path curvature and obstacle distance corresponding to each forward point coordinate, and controls the autonomous driving vehicle to move toward each forward point coordinate at the target moving speed corresponding to each forward point coordinate; after the autonomous driving vehicle reaches the end point of the target path, it is determined that the path tracking process of the target path is terminated, which solves the problem that the path tracking solution in the related art controls the autonomous driving vehicle to move toward each forward point coordinate at a fixed speed, and cannot automatically adjust the movement of the autonomous driving vehicle toward each forward point coordinate according to the path curvature and obstacle distance. The speed of movement is improved, which reduces the safety problem of the autonomous driving vehicle in the process of moving forward according to the pre-planned path. During the movement of the autonomous driving vehicle, the coordinates of each forward point of the autonomous driving vehicle can be automatically determined in the coordinates of each path point in the target path according to the basic moving speed of the autonomous driving vehicle and the coordinates of the current position point. The speed of the autonomous driving vehicle moving to the forward point coordinates can be automatically determined according to the path curvature and obstacle distance corresponding to each forward point coordinate, and then the autonomous driving vehicle is controlled to move to each forward point coordinate at a suitable speed. In this way, the speed of the autonomous driving vehicle moving to each forward point coordinate is automatically adjusted according to the path curvature and obstacle distance during the movement of the autonomous driving vehicle, thereby improving the safety of the autonomous driving vehicle in the process of moving forward according to the pre-planned path.

[0082] Example 2

[0083] Figure 2 This is a flow chart of a path tracking method provided by the second embodiment of the present invention. The embodiment of the present invention can be combined with each optional solution in one or more of the above embodiments. Figure 2 As shown, the method includes:

[0084] Step 201: Obtain a target path corresponding to the autonomous driving vehicle.

[0085] Step 202: Determine the forward point coordinates of the autonomous driving vehicle in the coordinates of each path point in the target path based on the basic moving speed and current position point coordinates of the autonomous driving vehicle.

[0086] Step 203: Based on the path curvature corresponding to the look-ahead point coordinates and the obstacle distance, determine whether the path curvature corresponding to the look-ahead point coordinates is large and whether the autonomous driving vehicle is close to an obstacle in the operating area.

[0087] Step 204: If the path curvature corresponding to the look-ahead point coordinates is large or the autonomous driving vehicle is close to an obstacle in the operating area, a low moving speed corresponding to the base moving speed is determined based on the path curvature or a preset obstacle distance threshold, and the low moving speed is determined as the target moving speed corresponding to the look-ahead point coordinates.

[0088] Step 205: Control the autonomous driving vehicle to move toward the forward point coordinates at a target moving speed corresponding to the forward point coordinates.

[0089] Step 206: After the autonomous driving vehicle reaches the forward point coordinates, check whether the forward point coordinates are the last path point coordinates in the target path. If so, execute step 207; if not, return to execute step 202.

[0090] Step 207: Determine whether the autonomous driving vehicle reaches the end point of the target path.

[0091] Step 208: The path tracking process of determining the target path ends.

[0092] The technical solution of the embodiments of the present invention can, after determining the look-ahead point coordinates of the autonomous vehicle, automatically determine whether the path curvature corresponding to the look-ahead point coordinates is large and whether the autonomous vehicle is close to an obstacle in the operation area based on the path curvature and obstacle distance corresponding to the look-ahead point coordinates. When it is determined that the path curvature corresponding to the look-ahead point coordinates is large or the autonomous vehicle is close to an obstacle in the operation area, the appropriate speed of the autonomous vehicle moving toward the look-ahead point coordinates can be automatically determined based on the path curvature or a preset obstacle distance threshold, and then the autonomous vehicle can be controlled to move toward each look-ahead point coordinate at an appropriate speed. When the path curvature corresponding to the look-ahead point coordinates is large or the autonomous vehicle is close to an obstacle in the operation area, the speed of the autonomous vehicle moving toward the look-ahead point coordinates can be automatically adjusted based on the path curvature or obstacle distance, controlling the autonomous vehicle to move toward the look-ahead point coordinates at a lower speed. This achieves automatic adjustment of the autonomous vehicle's moving speed toward each look-ahead point coordinate based on the path curvature and obstacle distance during the movement of the autonomous vehicle, thereby improving the safety of the autonomous vehicle as it moves forward along a pre-planned path.

[0093] Example 3

[0094] Figure 3 This is a schematic diagram of the structure of a path tracking device provided by the third embodiment of the present invention. The device can be configured in an electronic device. Figure 3 As shown, the device includes: a path acquisition module 301, a path tracking module 302 and an ending module 303.

[0095] Among them, the path acquisition module 301 is used to obtain the target path corresponding to the autonomous driving vehicle; the path tracking module 302 is used to determine the coordinates of each forward point of the autonomous driving vehicle in the coordinates of each path point in the target path according to the basic moving speed and current position point coordinates of the autonomous driving vehicle, and determine the target moving speed corresponding to each forward point coordinate according to the path curvature and obstacle distance corresponding to each forward point coordinate, and control the autonomous driving vehicle to move toward each forward point coordinate at the target moving speed corresponding to each forward point coordinate; the ending module 303 is used to determine that the path tracking process of the target path is ended after the autonomous driving vehicle reaches the end point of the target path.

[0096] The technical solution of the embodiment of the present invention obtains a target path corresponding to the autonomous driving vehicle; then, based on the basic moving speed and current position coordinates of the autonomous driving vehicle, determines the coordinates of each forward point of the autonomous driving vehicle in the coordinates of each path point in the target path, and determines the target moving speed corresponding to each forward point coordinate according to the path curvature and obstacle distance corresponding to each forward point coordinate, and controls the autonomous driving vehicle to move toward each forward point coordinate at the target moving speed corresponding to each forward point coordinate; after the autonomous driving vehicle reaches the end point of the target path, it is determined that the path tracking process of the target path is terminated, which solves the problem that the path tracking solution in the related art controls the autonomous driving vehicle to move toward each forward point coordinate at a fixed speed, and cannot automatically adjust the movement of the autonomous driving vehicle toward each forward point coordinate according to the path curvature and obstacle distance. The speed of movement is improved, which reduces the safety problem of the autonomous driving vehicle in the process of moving forward according to the pre-planned path. During the movement of the autonomous driving vehicle, the coordinates of each forward point of the autonomous driving vehicle can be automatically determined in the coordinates of each path point in the target path according to the basic moving speed of the autonomous driving vehicle and the coordinates of the current position point. The speed of the autonomous driving vehicle moving to the forward point coordinates can be automatically determined according to the path curvature and obstacle distance corresponding to each forward point coordinate, and then the autonomous driving vehicle is controlled to move to each forward point coordinate at a suitable speed. In this way, the speed of the autonomous driving vehicle moving to each forward point coordinate is automatically adjusted according to the path curvature and obstacle distance during the movement of the autonomous driving vehicle, thereby improving the safety of the autonomous driving vehicle in the process of moving forward according to the pre-planned path.

[0097] In an optional implementation of an embodiment of the present invention, optionally, the path tracking module 302 is specifically used to: determine the forward point coordinates of the autonomous driving vehicle in the coordinates of each path point in the target path according to the basic moving speed and the current position point coordinates of the autonomous driving vehicle; determine whether the path curvature corresponding to the forward point coordinates is large and whether the autonomous driving vehicle is close to an obstacle in the operating area according to the path curvature and obstacle distance corresponding to the forward point coordinates; if the path curvature corresponding to the forward point coordinates is large or the autonomous driving vehicle is close to an obstacle in the operating area, then determine the low-speed moving speed corresponding to the basic moving speed according to the path curvature or the preset obstacle distance threshold, and confirm the low-speed moving speed The target moving speed corresponding to the forward point coordinate is set; the autonomous driving vehicle is controlled to move toward the forward point coordinate at the target moving speed corresponding to the forward point coordinate; after the autonomous driving vehicle reaches the forward point coordinate, the forward point coordinate is detected to see whether it is the last path point coordinate in the target path; if the forward point coordinate is the last path point coordinate in the target path, it is determined that the autonomous driving vehicle has reached the end point of the target path; if the forward point coordinate is not the last path point coordinate in the target path, the operation of determining the forward point coordinate of the autonomous driving vehicle in each path point coordinate in the target path according to the basic moving speed and current position point coordinate of the autonomous driving vehicle is returned to be executed.

[0098] In an optional implementation of an embodiment of the present invention, optionally, when the path tracking module 302 performs the operation of determining the forward-looking point coordinates of the autonomous driving vehicle in the coordinates of each path point in the target path according to the basic moving speed and current position point coordinates of the autonomous driving vehicle, it is specifically used to: convert the coordinates of each path point in the target path into coordinates in the vehicle coordinate system of the autonomous driving vehicle; determine the coordinates of each path point located in front of the autonomous driving vehicle at a current moment according to the coordinates in the vehicle coordinate system of the autonomous driving vehicle converted from each path point coordinate; determine the forward-looking distance of the autonomous driving vehicle according to the basic moving speed of the autonomous driving vehicle; and determine the coordinates of the path point located in front of the autonomous driving vehicle at a current moment whose distance from the current position point coordinates of the autonomous driving vehicle is equal to the forward-looking distance as the forward-looking point coordinates of the autonomous driving vehicle.

[0099] In an optional implementation of an embodiment of the present invention, optionally, when the path tracking module 302 performs the operation of determining whether the path curvature corresponding to the forward-looking point coordinates is large and whether the autonomous driving vehicle is close to an obstacle in the working area based on the path curvature and obstacle distance corresponding to the forward-looking point coordinates, it is specifically used to: determine the path curvature corresponding to the forward-looking point coordinates based on the coordinates in the vehicle coordinate system of the autonomous driving vehicle converted from the forward-looking point coordinates; determine whether the path curvature corresponding to the forward-looking point coordinates is large based on a preset value; determine the obstacle distance corresponding to the forward-looking point coordinates; wherein the obstacle distance corresponding to the forward-looking point coordinates includes the distance between the current position point coordinates and each obstacle in the working area; determine whether the autonomous driving vehicle is close to an obstacle in the working area based on the distance between the current position point coordinates and each obstacle in the working area and a preset distance threshold.

[0100] In an optional implementation manner of an embodiment of the present invention, optionally, when the path tracking module 302 performs an operation of determining whether the path curvature corresponding to the forward-looking point coordinates is larger according to a preset value, it is specifically used to: detect whether the path curvature corresponding to the forward-looking point coordinates is larger than a preset value; if it is detected that the path curvature is larger than the preset value, it is determined that the path curvature corresponding to the forward-looking point coordinates is larger; if it is detected that the path curvature is less than or equal to the preset value, it is determined that the path curvature corresponding to the forward-looking point coordinates is not larger.

[0101] In an optional implementation of an embodiment of the present invention, optionally, when the path tracking module 302 performs the operation of determining whether the autonomous driving vehicle is close to an obstacle in the working area based on the distance between the current position point coordinates and each obstacle in the working area and a preset distance threshold, it is specifically used to: detect whether the distance between the current position point coordinates and each obstacle in the working area is less than the preset distance threshold; if it is detected that the distance between the current position point coordinates and the target obstacle in the working area is less than the preset distance threshold, it is determined that the autonomous driving vehicle is close to the obstacle in the working area; if it is detected that the distance between the current position point coordinates and each obstacle in the working area is greater than or equal to the preset distance threshold, it is determined that the autonomous driving vehicle is not close to the obstacle in the working area.

[0102] In an optional implementation of an embodiment of the present invention, optionally, when the path tracking module 302 performs the operation of determining a low-speed moving speed corresponding to the basic moving speed according to the path curvature or a preset obstacle distance threshold if the path curvature corresponding to the look-ahead point coordinates is large or the autonomous driving vehicle is close to an obstacle in the operating area, and determining the low-speed moving speed as the target moving speed corresponding to the look-ahead point coordinates, the operation is specifically used to: if the path curvature corresponding to the look-ahead point coordinates is large and the autonomous driving vehicle is not close to an obstacle in the operating area, determining a low-speed moving speed corresponding to the basic moving speed according to the path curvature, and determining the low-speed moving speed as the target moving speed is the target moving speed corresponding to the look-ahead point coordinates; if the path curvature corresponding to the look-ahead point coordinates is not large, and the autonomous driving vehicle is close to an obstacle in the operating area, then according to the preset obstacle distance threshold, a low-speed moving speed corresponding to the basic moving speed is determined, and the low-speed moving speed is determined as the target moving speed corresponding to the look-ahead point coordinates; if the path curvature corresponding to the look-ahead point coordinates is large and the autonomous driving vehicle is close to an obstacle in the operating area, then according to the path curvature and the preset obstacle distance threshold, a low-speed moving speed corresponding to the basic moving speed is determined, and the low-speed moving speed is determined as the target moving speed corresponding to the look-ahead point coordinates.

[0103] Regarding the apparatus in the above embodiment, the specific manner in which each module performs operations has been described in detail in the embodiment of the method, and will not be elaborated here.

[0104] The above-mentioned path tracking device can execute the path tracking method provided by any embodiment of the present invention, and has corresponding functional modules and beneficial effects for executing the path tracking method.

[0105] Example 4

[0106] Figure 4 FIG2 is a block diagram of an electronic device 10 that can be used to implement the path tracking method according to an embodiment of the present invention. The components, their connections and relationships, and their functions shown herein are merely examples and are not intended to limit the implementation of the present invention described and / or claimed herein.

[0107] like Figure 4As shown, the electronic device 10 includes at least one processor 11 and a memory, such as a read-only memory (ROM) 12, a random access memory (RAM) 13, etc., which is communicatively connected to the at least one processor 11. The memory stores a computer program executed by the at least one processor, and the processor 11 can perform various appropriate actions and processes according to the computer program stored in the read-only memory (ROM) 12 or the computer program built from the storage unit 18 into the random access memory (RAM) 13. Various programs and data required for the operation of the electronic device 10 can also be stored in the random access memory (RAM) 13. The processor 11, the read-only memory (ROM) 12, and the random access memory (RAM) 13 are connected to each other via a bus 14. An input / output (I / O) interface 15 is also connected to the bus 14.

[0108] Various components in the electronic device 10 are connected to an input / output (I / O) interface 15, including an input unit 16, such as a keyboard, a mouse, etc.; an output unit 17, such as various types of displays, speakers, etc.; a storage unit 18, such as a magnetic disk, an optical disk, etc.; and a communication unit 19, such as a network card, a modem, a wireless communication transceiver, etc. The communication unit 19 allows the electronic device 10 to exchange information / data with other devices via a computer network such as the Internet and / or various telecommunication networks.

[0109] The processor 11 may be any general-purpose and / or specialized processing component with processing and computing capabilities. Examples of the processor 11 include, but are not limited to, a central processing unit (CPU), a graphics processing unit (GPU), various specialized artificial intelligence (AI) computing chips, various processors for running machine learning model algorithms, a digital signal processor (DSP), and any suitable processor, controller, microcontroller, etc. The processor 11 executes the various methods and processes described above, such as the path tracking method.

[0110] In some embodiments, the path tracking method can be implemented as a computer program that is tangibly contained in a computer-readable storage medium, such as storage unit 18. In some embodiments, part or all of the computer program can be loaded and / or installed on electronic device 10 via read-only memory (ROM) 12 and / or communication unit 19. When the computer program is loaded into random access memory (RAM) 13 and executed by processor 11, one or more steps of the path tracking method described above can be performed. Alternatively, in other embodiments, processor 11 can be configured to perform the path tracking method in any other suitable manner (e.g., by means of firmware).

[0111] Various embodiments of the systems and techniques described herein can be implemented in digital electronic circuit systems, integrated circuit systems, field programmable gate arrays (FPGAs), application specific integrated circuits (ASICs), application specific standard products (ASSPs), system-on-chip systems (SOCs), programmable logic devices (CPLDs), computer hardware, firmware, software, and / or combinations thereof. These various embodiments can include being implemented in one or more computer programs that are executable and / or interpreted on a programmable system that includes at least one programmable processor, which can be a special purpose or general purpose programmable processor that can receive data and instructions from a storage system, at least one input device, and at least one output device, and transmit data and instructions to the storage system, the at least one input device, and the at least one output device.

[0112] Computer programs for implementing the path tracing method of the present invention can be written in any combination of one or more programming languages. These computer programs can be provided to a processor of a general-purpose computer, a special-purpose computer, or other programmable data processing device, such that when executed by the processor, the functions / operations specified in the flowcharts and / or block diagrams are implemented. The computer programs can be executed entirely on the machine, partially on the machine, as a stand-alone software package, partially on the machine and partially on a remote machine, or entirely on a remote machine or server.

[0113] In the context of the present invention, computer-readable storage medium can be a tangible medium that can contain or store a computer program for use by an instruction execution system, device or equipment or used in combination with an instruction execution system, device or equipment. Computer-readable storage medium can include but is not limited to electronic, magnetic, optical, electromagnetic, infrared or semiconductor systems, devices or equipment, or any suitable combination of the foregoing. Alternatively, computer-readable storage medium can be a machine-readable signal medium. A more specific example of a machine-readable storage medium can include an electrical connection based on one or more lines, a portable computer disk, a hard disk, a random access memory (RAM), a read-only memory (ROM), an erasable programmable read-only memory (EPROM or flash memory), an optical fiber, a portable compact disk read-only memory (CD-ROM), an optical storage device, a magnetic storage device, or any suitable combination of the foregoing.

[0114] To provide interaction with a user, the systems and techniques described herein can be implemented on an electronic device having: a display device (e.g., a CRT (cathode ray tube) or LCD (liquid crystal display) monitor) for displaying information to the user; and a keyboard and pointing device (e.g., a mouse or trackball) through which the user can provide input to the electronic device. Other types of devices can also be used to provide interaction with the user; for example, the feedback provided to the user can be any form of sensory feedback (e.g., visual feedback, auditory feedback, or tactile feedback); and the input from the user can be received in any form (including acoustic input, voice input, or tactile input).

[0115] The systems and techniques described herein can be implemented in a computing system that includes back-end components (e.g., as a data server), or a computing system that includes middleware components (e.g., an application server), or a computing system that includes front-end components (e.g., a user computer with a graphical user interface or web browser through which a user can interact with implementations of the systems and techniques described herein), or a computing system that includes any combination of such back-end components, middleware components, or front-end components. The components of the system can be interconnected by any form or medium of digital data communication (e.g., a communication network). Examples of communication networks include: a local area network (LAN), a wide area network (WAN), a blockchain network, and the Internet.

[0116] A computing system may include clients and servers. The clients and servers are typically remote from each other and typically interact via a communication network. This client-server relationship arises through computer programs running on the respective computers, creating a client-server relationship. The server may be a cloud server, also known as a cloud computing server or cloud host. This server is a hosting product within the cloud computing service ecosystem that addresses the management difficulties and limited scalability of traditional physical hosting and VPS services.

[0117] It should be understood that the various forms of the processes shown above can be used to reorder, add, or delete steps. For example, the steps described in the present invention can be performed in parallel, sequentially, or in a different order, as long as the desired results of the technical solution of the present invention can be achieved. This is not limited herein.

[0118] Optionally, the present invention further provides a computer program product, comprising a computer program, wherein the computer program implements the path tracking method described in any embodiment of the present invention when executed by a processor.

[0119] The above specific embodiments do not limit the scope of protection of the present invention. Those skilled in the art will appreciate that various modifications, combinations, sub-combinations, and substitutions may be made based on design requirements and other factors. Any modifications, equivalent substitutions, and improvements made within the spirit and principles of the present invention are intended to be included within the scope of protection of the present invention.

Claims

1. A path tracking method, characterized in that: include: Obtaining a target path corresponding to the autonomous vehicle; Determine each forward-looking point coordinate of the autonomous driving vehicle in each path point coordinate in the target path according to the basic moving speed and the current position point coordinate of the autonomous driving vehicle, determine the target moving speed corresponding to each forward-looking point coordinate according to the path curvature and obstacle distance corresponding to each forward-looking point coordinate, and control the autonomous driving vehicle to move toward each forward-looking point coordinate at the target moving speed corresponding to each forward-looking point coordinate; After the autonomous driving vehicle reaches the end point of the target path, the path tracking process of determining the target path ends.

2. The path tracking method according to claim 1, characterized in that: According to the basic moving speed and the current position point coordinates of the autonomous driving vehicle, the coordinates of each forward-looking point of the autonomous driving vehicle are determined in the coordinates of each path point in the target path, and according to the path curvature and obstacle distance corresponding to each forward-looking point coordinate, the target moving speed corresponding to each forward-looking point coordinate is determined, and the autonomous driving vehicle is controlled to move toward each forward-looking point coordinate at the target moving speed corresponding to each forward-looking point coordinate, including: Determining the forward point coordinates of the autonomous driving vehicle in the coordinates of each path point in the target path according to the basic moving speed and the current position point coordinates of the autonomous driving vehicle; Determining, based on the path curvature corresponding to the look-ahead point coordinates and the obstacle distance, whether the path curvature corresponding to the look-ahead point coordinates is large and whether the autonomous driving vehicle is close to an obstacle in the operating area; If the path curvature corresponding to the look-ahead point coordinates is large or the autonomous driving vehicle is close to an obstacle in the operation area, a low moving speed corresponding to the basic moving speed is determined according to the path curvature or a preset obstacle distance threshold, and the low moving speed is determined as the target moving speed corresponding to the look-ahead point coordinates; Controlling the autonomous driving vehicle to move toward the forward-looking point coordinates at a target moving speed corresponding to the forward-looking point coordinates; After the autonomous driving vehicle reaches the forward-looking point coordinate, detecting whether the forward-looking point coordinate is the last path point coordinate in the target path; If the forward-looking point coordinates are the last path point coordinates in the target path, determining that the autonomous driving vehicle has reached the end point of the target path; If the forward-looking point coordinates are not the last path point coordinates in the target path, the operation of determining the forward-looking point coordinates of the autonomous driving vehicle among the path point coordinates in the target path based on the basic moving speed and current position point coordinates of the autonomous driving vehicle is returned.

3. The path tracking method according to claim 2, characterized in that: Determining the forward point coordinates of the autonomous driving vehicle in the coordinates of each path point in the target path according to the basic moving speed and the current position point coordinates of the autonomous driving vehicle includes: Converting the coordinates of each path point in the target path into coordinates in the vehicle coordinate system of the autonomous driving vehicle; Determine the coordinates of each path point currently located in front of the autonomous driving vehicle according to the coordinates of each path point converted into the vehicle coordinate system of the autonomous driving vehicle; Determining a look-ahead distance of the autonomous driving vehicle according to a basic moving speed of the autonomous driving vehicle; The coordinates of the path point located in front of the autonomous driving vehicle at the current moment and whose distance from the current position point coordinates of the autonomous driving vehicle is equal to the forward-looking distance are determined as the forward-looking point coordinates of the autonomous driving vehicle.

4. The path tracking method according to claim 2, characterized in that: Determining whether the path curvature corresponding to the look-ahead point coordinates is large and whether the autonomous driving vehicle is close to an obstacle in an operating area according to the path curvature corresponding to the look-ahead point coordinates and the obstacle distance includes: Determine the path curvature corresponding to the look-ahead point coordinates according to the coordinates of the vehicle coordinate system of the autonomous driving vehicle converted from the look-ahead point coordinates; Determining whether the path curvature corresponding to the forward-looking point coordinates is large according to a preset value; Determine the obstacle distance corresponding to the forward-looking point coordinates; wherein the obstacle distance corresponding to the forward-looking point coordinates includes the distance between the current position point coordinates and each obstacle in the working area; Whether the autonomous driving vehicle is close to an obstacle in the working area is determined based on the distance between the coordinates of the current position point and each obstacle in the working area and a preset distance threshold.

5. The path tracking method according to claim 4, characterized in that: Determining whether the path curvature corresponding to the forward-looking point coordinates is large according to a preset value includes: Detecting whether the path curvature corresponding to the forward-looking point coordinates is greater than a preset value; If it is detected that the path curvature is greater than the preset value, it is determined that the path curvature corresponding to the forward-looking point coordinates is greater; If it is detected that the path curvature is less than or equal to the preset value, it is determined that the path curvature corresponding to the forward-looking point coordinates is not larger.

6. The path tracking method according to claim 4, characterized in that: Determining whether the autonomous driving vehicle is close to an obstacle in the operating area according to the distance between the coordinates of the current position point and each obstacle in the operating area and a preset distance threshold includes: Detecting whether the distance between the coordinates of the current position point and each obstacle in the working area is less than a preset distance threshold; If it is detected that the distance between the coordinates of the current position point and the target obstacle in the working area is less than the preset distance threshold, it is determined that the autonomous driving vehicle is close to the obstacle in the working area; If it is detected that the distances between the coordinates of the current position point and each obstacle in the working area are greater than or equal to the preset distance threshold, it is determined that the autonomous driving vehicle is not close to the obstacles in the working area.

7. The path tracking method according to claim 2, characterized in that: If the path curvature corresponding to the look-ahead point coordinates is large or the autonomous driving vehicle is close to an obstacle in the operating area, a low moving speed corresponding to the basic moving speed is determined according to the path curvature or a preset obstacle distance threshold, and the low moving speed is determined as the target moving speed corresponding to the look-ahead point coordinates, including: If the path curvature corresponding to the look-ahead point coordinates is large and the autonomous driving vehicle is not close to an obstacle in the operation area, a low moving speed corresponding to the basic moving speed is determined according to the path curvature, and the low moving speed is determined as a target moving speed corresponding to the look-ahead point coordinates; If the path curvature corresponding to the look-ahead point coordinates is not large and the autonomous driving vehicle is close to an obstacle in the operation area, a low moving speed corresponding to the basic moving speed is determined according to the preset obstacle distance threshold, and the low moving speed is determined as the target moving speed corresponding to the look-ahead point coordinates; If the path curvature corresponding to the look-ahead point coordinates is large and the autonomous driving vehicle is close to an obstacle in the operating area, a low moving speed corresponding to the basic moving speed is determined based on the path curvature and a preset obstacle distance threshold, and the low moving speed is determined as the target moving speed corresponding to the look-ahead point coordinates.

8. A path tracking device, characterized in that: include: A path acquisition module, used to acquire a target path corresponding to the autonomous driving vehicle; a path tracking module, configured to determine each forward-looking point coordinate of the autonomous driving vehicle in each path point coordinate in the target path according to the basic moving speed and the current position point coordinate of the autonomous driving vehicle, determine the target moving speed corresponding to each forward-looking point coordinate according to the path curvature and obstacle distance corresponding to each forward-looking point coordinate, and control the autonomous driving vehicle to move toward each forward-looking point coordinate at the target moving speed corresponding to each forward-looking point coordinate; An end module is used to determine that the path tracking process of the target path is ended after the autonomous driving vehicle reaches the end point of the target path.

9. An electronic device, characterized in that: The electronic device comprises: at least one processor; and a memory communicatively coupled to the at least one processor; The memory stores a computer program executed by the at least one processor, and the computer program is executed by the at least one processor so that the at least one processor can execute the path tracking method according to any one of claims 1 to 7.

10. A computer-readable storage medium, characterized in that: The computer-readable storage medium stores computer instructions, and the computer instructions are used to enable a processor to implement the path tracking method according to any one of claims 1 to 7 when executed.