Vehicle automatic driving path planning method and device and electronic equipment
By setting heading and trajectory supplementary points in the autonomous driving path planning and using Gaussian kernel function fitting, the problem of strict restrictions on user set points in the existing technology is solved, and the flexibility and smoothness of path generation are improved. Adapt to changes in complex environments.
Patent Information
- Application Number
- CN202411099142.8
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-12
- Publication Date
- 2024-11-19
AI Technical Summary
The existing autonomous driving path planning methods have many restrictions on users' setting track points when generating smooth paths, and are poor in flexibility, making it difficult to meet the needs of complex roads and environmental changes.
By obtaining the user-configured driving trajectory point group and the vehicle's target heading, setting heading supplement points and trajectory supplement points, and using Gaussian kernel function fit to generate smooth paths, reducing the limitations on the user's set points and increasing the flexibility of trajectory generation.
While generating smooth vehicle autonomous driving paths, it realizes that while reducing the restrictions on users' setting trajectory points, improving the flexibility of path generation, and adapting to changes in complex environments.
Smart Images

Figure CN118980385A_ABST
Abstract
Description
Technical Field
[0001] The present disclosure relates to the field of autonomous driving technology, and in particular to a method, device and electronic device for vehicle autonomous driving path planning. Background Art
[0002] In autonomous driving and intelligent transportation systems, path planning and vehicle control are key technologies. The goal of these technologies is to enable vehicles to travel safely and smoothly along a predetermined trajectory. In practical applications, path planning and vehicle control face many challenges due to complex roads, changing environments, and the physical limitations of the vehicle itself. Since the design and planning of trajectories have strict requirements and are difficult to draw manually, the path planning process usually only requires users to mark some points on the map in order to draw a rough trajectory of the vehicle so that the vehicle can travel along the desired route.
[0003] In the existing path planning method, a simple method is usually used to connect the path points set by the user to obtain a broken line segment. However, this method will cause the vehicle to have an instantaneous sudden change in speed and heading angle at the breaking point. For this reason, researchers have developed a fitting method to fit the points set by the user into a polynomial curve, allowing the vehicle to travel along the curve as a path. Although this method can make the vehicle run smoother, there are many restrictions on the user's trajectory point settings, such as limiting the number of set points, limiting the spacing between set points, etc., and the flexibility is poor. Summary of the invention
[0004] The embodiments of the present disclosure at least provide a method, device and electronic device for vehicle autonomous driving path planning, which can reduce restrictions on user-set trajectory points while generating a smooth vehicle autonomous driving path, thereby increasing the flexibility of trajectory generation.
[0005] The present disclosure provides a method for automatic driving vehicle path planning, including:
[0006] Get the user-configured driving trajectory point group and the vehicle's current target heading;
[0007] Setting a heading supplement point on the target heading, and adding the heading supplement point as a driving track point to the driving track point group;
[0008] For each two adjacent driving trajectory points in the driving trajectory point group, trajectory supplementary points are set at the same interval according to the preset trajectory point density requirement;
[0009] The target vehicle driving path is fitted according to the driving trajectory point group and the trajectory supplementary points.
[0010] In an optional implementation, obtaining the driving trajectory point group set by the user and the current target heading of the vehicle specifically includes:
[0011] Providing a preset track point configuration interface, and acquiring the driving track point in response to a track point configuration operation performed by a user in the preset track point configuration interface;
[0012] Obtaining the current target posture of the vehicle, and determining the current position of the vehicle and the target heading according to the target posture;
[0013] The driving trajectory points and the current position of the vehicle are determined as the driving trajectory point group.
[0014] In an optional implementation manner, a heading supplement point is set on the target heading, specifically including:
[0015] The heading supplement point is set on the target heading at a preset distance from the current position of the vehicle.
[0016] In an optional implementation, for each two adjacent driving trajectory points in the driving trajectory point group, trajectory supplementary points are set at the same interval according to a preset trajectory point density requirement, specifically including:
[0017] Determine the trajectory point distance between every two adjacent driving trajectory points;
[0018] Determining the interval distance of the supplementary points according to the preset track point density requirement and the track point distance;
[0019] For every two adjacent driving trajectory points, according to the configuration order of the adjacent driving trajectory points, one trajectory supplementary point is sequentially set between the adjacent driving trajectory points at each supplementary point interval distance, until the target distance between the trajectory supplementary point and the adjacent driving trajectory point is less than the supplementary point interval distance.
[0020] In an optional implementation, after sequentially setting one track supplementary point at each supplementary point interval between the adjacent driving track points according to the configuration order of the adjacent driving track points, the method further includes:
[0021] Determine the magnitude relationship between the target distance and a preset interval distance threshold;
[0022] If the distance is less than a preset interval distance threshold, the trajectory supplement point is deleted;
[0023] If the distance is greater than the preset interval distance threshold, the trajectory supplement point is retained.
[0024] In an optional implementation, fitting the target vehicle driving path according to the driving trajectory point group and the trajectory supplementary points specifically includes:
[0025] Determine a discrete point sequence according to the total number of set points corresponding to the driving trajectory point group and the trajectory supplementary point and the preset number of discrete trajectory points;
[0026] Determining a corresponding Gaussian kernel function value for each discrete trajectory point in the discrete point sequence, and each set point in the driving trajectory point group and the trajectory supplementary point;
[0027] Determining a weight coefficient corresponding to each of the discrete trajectory points according to the Gaussian kernel function value;
[0028] Determining the trajectory point coordinates corresponding to each of the discrete trajectory points according to the setting point and the weight coefficient;
[0029] The target vehicle driving path is generated by fitting the trajectory point coordinates.
[0030] In an optional implementation, after fitting the target vehicle driving path according to the driving trajectory point group and the trajectory supplementary points, the method further includes:
[0031] Controlling the vehicle to travel at a preset speed in each control frame along the target vehicle's travel path;
[0032] In each of the control frames, determining the corresponding travel distance and the end point coordinates of the vehicle according to the preset speed;
[0033] Accumulating the distances between the discrete track points, and determining a target track point pair whose end point coordinates are between two of the discrete track points according to the driving distance;
[0034] The coordinates of the middle point of the target track point pair are determined by linear interpolation, and the movement of the vehicle is controlled by taking the coordinates of the middle point as the end point coordinates.
[0035] The present disclosure also provides a vehicle automatic driving path planning device, including:
[0036] The track point configuration module is used to obtain the user-configured driving track point group and the vehicle's current target heading;
[0037] A heading point supplement module, used for setting a heading supplement point on the target heading, and adding the heading supplement point as a driving track point to the driving track point group;
[0038] A track point supplement module, for setting track supplement points at the same interval according to a preset track point density requirement between every two adjacent driving track points in the driving track point group;
[0039] The path fitting module is used to fit the target vehicle's driving path according to the driving trajectory point group and the trajectory supplementary points.
[0040] An embodiment of the present disclosure also provides an electronic device, including: a processor, a memory and a bus, wherein the memory stores machine-readable instructions executable by the processor, and when the electronic device is running, the processor and the memory communicate through the bus, and when the machine-readable instructions are executed by the processor, the above-mentioned vehicle autonomous driving path planning method, or steps in any possible implementation of the above-mentioned vehicle autonomous driving path planning method.
[0041] An embodiment of the present disclosure also provides a computer-readable storage medium having a computer program stored thereon. When the computer program is executed by a processor, the computer program executes the above-mentioned vehicle autonomous driving path planning method, or the steps in any possible implementation of the above-mentioned vehicle autonomous driving path planning method.
[0042] The embodiments of the present disclosure also provide a computer program product, including a computer program / instructions, which, when executed by a processor, implement the above-mentioned vehicle autonomous driving path planning method, or the steps in any possible implementation of the above-mentioned vehicle autonomous driving path planning method.
[0043] The disclosed embodiments provide a vehicle automatic driving path planning method, device and electronic device, which obtain a user-configured driving trajectory point group and the vehicle's current target heading; set a heading supplement point on the target heading, and add the heading supplement point to the driving trajectory point group as a driving trajectory point; set trajectory supplement points at the same interval according to preset trajectory point density requirements between every two adjacent driving trajectory points in the driving trajectory point group; fit the target vehicle driving path according to the driving trajectory point group and the trajectory supplement points. While generating a smooth vehicle automatic driving path, it can reduce restrictions on user-set trajectory points and increase the flexibility of trajectory generation.
[0044] In order to make the above-mentioned objectives, features and advantages of the present disclosure more obvious and easy to understand, preferred embodiments are specifically cited below and described in detail with reference to the attached drawings. BRIEF DESCRIPTION OF THE DRAWINGS
[0045] In order to more clearly illustrate the technical solutions of the embodiments of the present disclosure, the following is a brief introduction to the drawings required for use in the embodiments. The drawings herein are incorporated into the specification and constitute a part of the specification. These drawings illustrate embodiments consistent with the present disclosure and are used together with the specification to illustrate the technical solutions of the present disclosure. It should be understood that the following drawings only illustrate certain embodiments of the present disclosure and should not be regarded as limiting the scope. For ordinary technicians in this field, other relevant drawings can also be obtained based on these drawings without creative work.
[0046] Figure 1 A flow chart of a method for automatic driving path planning for a vehicle provided by an embodiment of the present disclosure is shown;
[0047] Figure 2 A flow chart showing another method for automatic driving path planning of a vehicle provided by an embodiment of the present disclosure;
[0048] Figure 3 A schematic diagram of a vehicle automatic driving path planning device provided by an embodiment of the present disclosure is shown;
[0049] Figure 4 A schematic diagram of an electronic device provided by an embodiment of the present disclosure is shown. DETAILED DESCRIPTION
[0050] In order to make the purpose, technical scheme and advantages of the embodiments of the present disclosure clearer, the technical scheme in the embodiments of the present disclosure will be clearly and completely described below in conjunction with the drawings in the embodiments of the present disclosure. Obviously, the described embodiments are only part of the embodiments of the present disclosure, rather than all of the embodiments. The components of the embodiments of the present disclosure generally described and shown in the drawings here can be arranged and designed in various different configurations. Therefore, the following detailed description of the embodiments of the present disclosure provided in the drawings is not intended to limit the scope of the present disclosure for protection, but merely represents the selected embodiments of the present disclosure. Based on the embodiments of the present disclosure, all other embodiments obtained by those skilled in the art without making creative work belong to the scope of protection of the present disclosure.
[0051] It should be noted that similar reference numerals and letters denote similar items in the following drawings, and therefore, once an item is defined in one drawing, further definition and explanation thereof is not required in subsequent drawings.
[0052] The term "and / or" herein only describes an association relationship, indicating that three relationships may exist. For example, A and / or B may represent the following three situations: A exists alone, A and B exist at the same time, and B exists alone. In addition, the term "at least one" herein represents any combination of at least two of any one or more of a plurality of. For example, including at least one of A, B, and C may represent including any one or more elements selected from the set consisting of A, B, and C.
[0053] Research has found that in the existing path planning methods, a simple method is usually used to connect the path points set by the user to obtain a broken line segment. However, this method will cause the vehicle to have an instantaneous sudden change in speed and heading angle at the inflection point. For this reason, researchers have developed a fitting method to fit the points set by the user into a polynomial curve, allowing the vehicle to travel along the curve as a path. Although this method can make the vehicle run smoother, there are many restrictions on the user's trajectory point settings, such as limiting the number of set points, limiting the spacing between set points, etc., and the flexibility is poor.
[0054] Based on the above research, the present disclosure provides a vehicle automatic driving path planning method, device and electronic device, which obtains the driving trajectory point group configured by the user and the current target heading of the vehicle; sets a heading supplement point on the target heading, and adds the heading supplement point to the driving trajectory point group as a driving trajectory point; sets trajectory supplement points at the same interval according to the preset trajectory point density requirements between every two adjacent driving trajectory points in the driving trajectory point group; fits the target vehicle driving path according to the driving trajectory point group and the trajectory supplement points. While generating a smooth vehicle automatic driving path, it can reduce the restrictions on the user-set trajectory points and increase the flexibility of trajectory generation.
[0055] To facilitate understanding of this embodiment, a vehicle automatic driving path planning method disclosed in the embodiment of the present disclosure is first introduced in detail. The execution subject of the vehicle automatic driving path planning method provided in the embodiment of the present disclosure is generally a computer device with certain computing capabilities, and the computer device includes, for example: a terminal device or a server or other processing device, and the terminal device can be a user equipment (User Equipment, UE), a mobile device, a user terminal, a terminal, a cellular phone, a cordless phone, a personal digital assistant (Personal Digital Assistant, PDA), a handheld device, a computing device, a vehicle-mounted device, a wearable device, etc. In some possible implementations, the vehicle automatic driving path planning method can be implemented by a processor calling a computer-readable instruction stored in a memory.
[0056] See also Figure 1FIG. 1 is a flow chart of a method for automatic driving path planning of a vehicle provided in an embodiment of the present disclosure, wherein the method comprises steps S101 to S104, wherein:
[0057] S101, obtaining a driving trajectory point group configured by a user and a current target heading of a vehicle.
[0058] In a specific implementation, firstly, a driving trajectory point group consisting of a plurality of driving trajectory points that the vehicle configured by the user needs to reach during driving and a target heading corresponding to the driving direction of the vehicle's current position are obtained.
[0059] Here, the driving trajectory point group and the target heading can be obtained through the following steps 1 to 3:
[0060] Step 1: provide a preset track point configuration interface, and obtain the driving track point in response to a track point configuration operation performed by a user in the preset track point configuration interface.
[0061] Step 2: Obtain the current target position of the vehicle, and determine the current position of the vehicle and the target heading according to the target position.
[0062] Step 3: Determine the driving trajectory point and the current position of the vehicle as the driving trajectory point group.
[0063] Specifically, a human-computer interaction interface is provided for customers to configure driving trajectory points, namely, a preset trajectory point configuration interface. Users can perform trajectory point configuration operations by clicking in the trajectory point configuration interface. Driving trajectory points can be obtained according to the user's trajectory point configuration operations, and all driving trajectory points constitute a driving trajectory point group.
[0064] Here, after obtaining the driving trajectory points configured by the user, the current posture of the vehicle is determined, and the posture includes the current position of the vehicle and the current target heading of the vehicle, and then the current position of the vehicle is added to the driving trajectory point group.
[0065] S102: Setting a heading supplement point on the target heading, and adding the heading supplement point as a driving track point to the driving track point group.
[0066] In a specific implementation, the heading supplement point is set at a preset distance from the current position of the vehicle along the target heading at the position of the vehicle to avoid sudden changes in the vehicle's heading.
[0067] Here, in order to ensure that the vehicle follows the trajectory set by the user during driving, it is necessary to obtain the vehicle's target heading during path planning, set a heading supplement point at a preset distance from the vehicle on the heading, and add the navigation supplement point to the driving trajectory point group.
[0068] It should be noted that the preset distance between the heading supplement point and the current position of the vehicle can be set according to actual needs, and is not specifically limited here. Preferably, it can be 2 meters.
[0069] S103: For every two adjacent driving trajectory points in the driving trajectory point group, trajectory supplementary points are set at the same interval according to a preset trajectory point density requirement.
[0070] In a specific implementation, since the driving trajectory points set by the user may be unevenly spaced, with dense parts and sparse parts, this will make it difficult to fix the kernel function. Therefore, in an embodiment of the present application, a trajectory supplement point is set at the same distance on the line between adjacent driving trajectory points according to the setting order of the driving trajectory points.
[0071] Specifically, the setting method of the trajectory supplementary point can be achieved through the following steps 1 to 3:
[0072] Step 1: Determine the trajectory point distance between every two adjacent driving trajectory points.
[0073] Step 2: Determine the interval distance between supplementary points according to the preset track point density requirement and the track point distance.
[0074] Step 3: for every two adjacent driving trajectory points, according to the configuration order of the adjacent driving trajectory points, one trajectory supplementary point is sequentially set between the adjacent driving trajectory points at each supplementary point interval distance, until the target distance between the trajectory supplementary point and the adjacent driving trajectory point is less than the supplementary point interval distance.
[0075] In a specific implementation, after connecting adjacent driving trajectory points, the distance between adjacent driving trajectory points is determined, and the supplementary point interval distance between the trajectory supplementary points is determined according to the user's actual trajectory point density requirement.
[0076] It should be noted that the trajectory point density requirement can be set according to actual needs, and no specific restrictions are made here. The requirement reflects how many trajectory supplement points need to be supplemented between adjacent driving trajectory points. For example, for adjacent driving trajectory points 100 meters apart, if the trajectory point density requirement can be 50, then the corresponding supplement point interval distance can be 2 meters.
[0077] Afterwards, according to the configuration order of the driving trajectory points, a trajectory supplementary point is set at each supplementary point interval distance between adjacent driving trajectory points.
[0078] As a possible implementation method, in the process of setting the trajectory supplement point, it is also necessary to determine the size relationship between the target distance and the preset interval distance threshold; if the distance is less than the preset interval distance threshold, the trajectory supplement point is deleted; if the distance is greater than the preset interval distance threshold, the trajectory supplement point is retained.
[0079] Here, since the interval distance between adjacent driving trajectory points may not be an integer multiple of the interval distance between the supplementary points, it is necessary to display that the distance between the last trajectory supplementary point and the adjacent driving trajectory point is greater than the preset interval distance threshold.
[0080] Among them, the preset interval distance threshold can be set according to actual needs, and no specific limitation is made here. Preferably, the preset interval distance threshold can be 1 meter, that is, the distance between the last trajectory supplement point and the driving trajectory point between two driving trajectory points is limited to greater than 1 meter.
[0081] S104: Fitting a target vehicle driving path according to the driving trajectory point group and the trajectory supplementary points.
[0082] In a specific implementation, after determining the driving trajectory point group set by the user and the supplementary trajectory points, a Gaussian kernel function may be used for fitting to fit denser discrete trajectory points, thereby generating a smooth target vehicle driving path.
[0083] Specifically, the fitting method of the target vehicle's driving path can be implemented through the following steps 1 to 5:
[0084] Step 1: Determine a discrete point sequence according to the total number of set points corresponding to the driving trajectory point group and the trajectory supplementary points and the preset number of discrete trajectory points.
[0085] Step 2: for each discrete trajectory point in the discrete point sequence, and each set point in the driving trajectory point group and the trajectory supplementary point, determine the corresponding Gaussian kernel function value.
[0086] Step 3: Determine the weight coefficient corresponding to each discrete trajectory point according to the Gaussian kernel function value.
[0087] Step 4: Determine the trajectory point coordinates corresponding to each of the discrete trajectory points according to the setting points and the weight coefficients.
[0088] Step 5: Generate the target vehicle's driving path based on the trajectory point coordinates.
[0089] In a specific implementation, kernel function fitting is a technique for smoothing curves. Different weights are assigned to each discrete point so that the curve transitions smoothly at these points. In the embodiment of the present application, a Gaussian kernel function is used to implement this process.
[0090] Here, we first define the Gaussian kernel function as:
[0091]
[0092] Among them, t represents the position of a discrete trajectory point on the target vehicle's driving path; i represents the position of the set point in the driving trajectory point group and the trajectory supplement point; h represents the bandwidth parameter, which is used to control the smoothness of the Gaussian function. The larger the bandwidth, the smoother the curve; K(t,i) represents the degree to which t is affected by the set point i.
[0093] Here, the closer the discrete trajectory point t is to a certain set point i, the greater the influence weight of the coordinates corresponding to the set point i on the coordinates of t, which can be calculated by the following formula:
[0094]
[0095] Wherein, n represents the total number of set points; j represents the index of the discrete trajectory point; M represents the number of discrete trajectory points, and preferably the specific value of M can be determined according to the interval of 50 discrete trajectory points per 1 meter, and the calculation formula is:
[0096]
[0097] Among them, x i Represents the i-th set point in the driving trajectory point group and the trajectory supplementary point.
[0098] Furthermore, in order to calculate the final coordinates at the discrete trajectory point t, it is necessary to calculate the weight coefficient at each discrete trajectory point. The weight coefficient identifies the degree of influence of the setting point on the discrete trajectory point. The calculation formula of the weight coefficient is:
[0099]
[0100] Among them, f(t,i) represents the weight coefficient; K(t,l) represents the normalization of the influence weights of all setting points to ensure that the sum of all weight coefficients is 1.
[0101] Specifically, for n set points x1, x2, ..., x n First, according to the selection of the number of discrete trajectory points, the sequence of discrete trajectory points t is calculated. For each discrete trajectory point t and the setting point i, the Gaussian kernel function value K(t,i) is calculated; for each discrete trajectory point t, the corresponding weight coefficient f(t,i) is calculated, and each setting point and its corresponding weight coefficient are weighted summed to obtain the trajectory point coordinates at the discrete trajectory point to obtain a smooth trajectory.
[0102] The disclosed embodiment provides a vehicle automatic driving path planning method, which obtains a user-configured driving trajectory point group and the vehicle's current target heading; sets a heading supplement point on the target heading, and adds the heading supplement point to the driving trajectory point group as a driving trajectory point; sets trajectory supplement points at the same interval according to preset trajectory point density requirements between every two adjacent driving trajectory points in the driving trajectory point group; and fits the target vehicle driving path according to the driving trajectory point group and the trajectory supplement points. While generating a smooth vehicle automatic driving path, it can reduce restrictions on user-set trajectory points and increase the flexibility of trajectory generation.
[0103] Furthermore, after obtaining the target vehicle driving path, it is necessary to control the vehicle so that the vehicle drives along the target vehicle driving path. The control process can be seen in Figure 2 FIG. 2 is a flow chart of another method for automatic driving path planning of a vehicle provided by an embodiment of the present disclosure, wherein the method includes steps S201 to S204, wherein:
[0104] S201, controlling the vehicle to travel along the target vehicle's travel path at a preset speed in each control frame.
[0105] S202: In each control frame, determine the corresponding travel distance and end point coordinates of the vehicle according to the preset speed.
[0106] S203: Accumulate the distances between the discrete trajectory points, and determine a target trajectory point pair whose end point coordinates are between two discrete trajectory points according to the driving distance.
[0107] S204, determining the coordinates of the middle point of the target trajectory point pair by linear interpolation, and controlling the movement of the vehicle by using the coordinates of the middle point as the end point coordinates.
[0108] In a specific implementation, in order to make the vehicle drive smoothly along the trajectory, it is necessary to calculate the coordinates that the vehicle should reach in each frame. The vehicle can be controlled to drive at a constant preset speed, and the corresponding position of the vehicle on the trajectory can be calculated based on the distance traveled by the vehicle within the time interval of each control frame.
[0109] Here, since the trajectory points on the target vehicle's driving path are discrete, the vehicle's driving distance in each control frame may fall between two discrete trajectory points, so it is necessary to calculate the corresponding intermediate point coordinates through interpolation.
[0110] Specifically, the distances between discrete trajectory points on the target vehicle's driving path are accumulated, and after finding the corresponding driving distance of the vehicle within the time interval of the control frame, the target trajectory point pair whose end point coordinates fall between the coordinates of two discrete trajectory points is found. The interpolation coefficients and corresponding interpolation coordinates between the target trajectory point pairs are calculated, and then the coordinates of the middle point of the target trajectory point pair are determined. The interpolated coordinates are used as the end point coordinates to which the vehicle should move within the current control frame, and then the necessary speed and steering angle are calculated according to the vehicle's dynamic model to ensure that the vehicle smoothly transitions to the target position.
[0111] The disclosed embodiment provides a method for automatic driving vehicle path planning, which controls the vehicle to travel at a preset speed in each control frame along the target vehicle driving path; in each control frame, according to the preset speed, determines the corresponding driving distance and terminal coordinates of the vehicle; accumulates the distance between the discrete trajectory points, and determines the target trajectory point pair whose terminal coordinates are between two discrete trajectory points according to the driving distance; determines the coordinates of the middle point of the target trajectory point pair by linear interpolation, and controls the movement of the vehicle with the coordinates of the middle point as the terminal coordinates. It can realize the precise control and real-time response capability of the vehicle in a complex environment.
[0112] Those skilled in the art will appreciate that, in the above method of specific implementation, the order in which the steps are written does not imply a strict execution order and does not constitute any limitation on the implementation process. The specific execution order of the steps should be determined by their functions and possible internal logic.
[0113] Based on the same inventive concept, a vehicle autonomous driving path planning device corresponding to the vehicle autonomous driving path planning method is also provided in the embodiments of the present disclosure. Since the principle of solving the problem by the device in the embodiments of the present disclosure is similar to the above-mentioned vehicle autonomous driving path planning method in the embodiments of the present disclosure, the implementation of the device can refer to the implementation of the method, and the repeated parts will not be repeated.
[0114] See also Figure 3 , Figure 3 Schematic diagram of a vehicle automatic driving path planning device provided by an embodiment of the present disclosure. Figure 3 As shown in the figure, the vehicle automatic driving path planning device 300 provided in the embodiment of the present disclosure includes:
[0115] The track point configuration module 310 is used to obtain the driving track point group configured by the user and the current target heading of the vehicle.
[0116] The heading point supplementing module 320 is used to set a heading supplementing point on the target heading, and add the heading supplementing point to the driving track point group as a driving track point.
[0117] The track point supplement module 330 is used to set track supplement points at the same interval between every two adjacent driving track points in the driving track point group according to a preset track point density requirement.
[0118] The path fitting module 340 is used to fit the target vehicle's driving path according to the driving trajectory point group and the trajectory supplementary points.
[0119] For descriptions of the processing flow of each module in the device and the interaction flow between each module, reference may be made to the relevant descriptions in the above method embodiment, which will not be described in detail here.
[0120] The disclosed embodiment provides a vehicle automatic driving path planning device, which obtains a user-configured driving trajectory point group and the current target heading of the vehicle; sets a heading supplement point on the target heading, and adds the heading supplement point to the driving trajectory point group as a driving trajectory point; sets trajectory supplement points at the same interval according to preset trajectory point density requirements between every two adjacent driving trajectory points in the driving trajectory point group; and fits the target vehicle driving path according to the driving trajectory point group and the trajectory supplement points. While generating a smooth vehicle automatic driving path, it can reduce restrictions on user-set trajectory points and increase the flexibility of trajectory generation.
[0121] Corresponds to Figure 1 and Figure 2 The vehicle automatic driving path planning method in the present disclosure also provides an electronic device 400, such as Figure 4 FIG. 4 is a schematic diagram of the structure of an electronic device 400 provided in an embodiment of the present disclosure, including:
[0122] Processor 41, memory 42, and bus 43; memory 42 is used to store execution instructions, including memory 421 and external memory 422; memory 421 here is also called internal memory, which is used to temporarily store operation data in processor 41 and data exchanged with external memory 422 such as hard disk. Processor 41 exchanges data with external memory 422 through memory 421. When the electronic device 400 is running, the processor 41 communicates with the memory 42 through bus 43, so that the processor 41 executes Figure 1 and Figure 2 The steps of the vehicle autonomous driving path planning method.
[0123] The present disclosure also provides a computer-readable storage medium, on which a computer program is stored, and when the computer program is executed by a processor, the steps of the vehicle automatic driving path planning method described in the above method embodiment are executed. The storage medium can be a volatile or non-volatile computer-readable storage medium.
[0124] The embodiments of the present disclosure also provide a computer program product, which includes computer instructions. When the computer instructions are executed by a processor, the steps of the vehicle automatic driving path planning method described in the above method embodiment can be executed. For details, please refer to the above method embodiment, which will not be repeated here.
[0125] The computer program product may be implemented in hardware, software or a combination thereof. In one optional embodiment, the computer program product is implemented as a computer storage medium. In another optional embodiment, the computer program product is implemented as a software product, such as a software development kit (SDK).
[0126] Those skilled in the art can clearly understand that, for the convenience and simplicity of description, the specific working process of the device described above can refer to the corresponding process in the aforementioned method embodiment, and will not be repeated here. In the several embodiments provided in the present disclosure, it should be understood that the disclosed device and method can be implemented in other ways. The device embodiments described above are merely schematic. For example, the division of the units is only a logical function division. There may be other division methods in actual implementation. For example, multiple units or components can be combined or integrated into another system, or some features can be ignored or not executed. Another point is that the mutual coupling or direct coupling or communication connection shown or discussed can be through some communication interfaces, and the indirect coupling or communication connection of the device or unit can be electrical, mechanical or other forms.
[0127] The units described as separate components may or may not be physically separated, and the components shown as units may or may not be physical units, that is, they may be located in one place or distributed on multiple network units. Some or all of the units may be selected according to actual needs to achieve the purpose of the solution of this embodiment.
[0128] In addition, each functional unit in each embodiment of the present disclosure may be integrated into one processing unit, or each unit may exist physically separately, or two or more units may be integrated into one unit.
[0129] If the functions are implemented in the form of software functional units and sold or used as independent products, they can be stored in a non-volatile computer-readable storage medium that is executable by a processor. Based on this understanding, the technical solution of the present disclosure, or the part that contributes to the prior art or the part of the technical solution, can be embodied in the form of a software product, which is stored in a storage medium and includes several instructions for a computer device (which can be a personal computer, a server, or a network device, etc.) to perform all or part of the steps of the method described in each embodiment of the present disclosure. The aforementioned storage medium includes: various media that can store program codes, such as a USB flash drive, a mobile hard disk, a read-only memory (ROM), a random access memory (RAM), a magnetic disk or an optical disk.
[0130] Finally, it should be noted that the above-described embodiments are only specific implementation methods of the present disclosure, which are used to illustrate the technical solutions of the present disclosure, rather than to limit them. The protection scope of the present disclosure is not limited thereto. Although the present disclosure is described in detail with reference to the above-described embodiments, ordinary technicians in the field should understand that any technician familiar with the technical field can still modify the technical solutions recorded in the above-described embodiments within the technical scope disclosed in the present disclosure, or can easily think of changes, or make equivalent replacements for some of the technical features therein; and these modifications, changes or replacements do not make the essence of the corresponding technical solutions deviate from the spirit and scope of the technical solutions of the embodiments of the present disclosure, and should be included in the protection scope of the present disclosure. Therefore, the protection scope of the present disclosure should be based on the protection scope of the claims.
Claims
1. A method for vehicle automatic driving path planning, It is characterized in that include: Get the user-configured driving trajectory point group and the vehicle's current target heading; Setting a heading supplement point on the target heading, and adding the heading supplement point as a driving track point to the driving track point group; For each two adjacent driving trajectory points in the driving trajectory point group, trajectory supplementary points are set at the same interval according to the preset trajectory point density requirement; The target vehicle driving path is fitted according to the driving trajectory point group and the trajectory supplementary points.
2. The method according to claim 1, It is characterized in that Get the driving trajectory point group set by the user and the current target heading of the vehicle, including: Providing a preset track point configuration interface, and acquiring the driving track point in response to a track point configuration operation performed by a user in the preset track point configuration interface; Obtaining the current target posture of the vehicle, and determining the current position of the vehicle and the target heading according to the target posture; The driving trajectory points and the current position of the vehicle are determined as the driving trajectory point group.
3. The method according to claim 2, It is characterized in that A heading supplement point is set on the target heading, specifically including: The heading supplement point is set on the target heading at a preset distance from the current position of the vehicle.
4. The method according to claim 1, It is characterized in that For every two adjacent driving trajectory points in the driving trajectory point group, trajectory supplementary points are set at the same interval according to the preset trajectory point density requirement, specifically including: Determine the trajectory point distance between every two adjacent driving trajectory points; Determining the interval distance of the supplementary points according to the preset track point density requirement and the track point distance; For every two adjacent driving trajectory points, according to the configuration order of the adjacent driving trajectory points, one trajectory supplementary point is sequentially set between the adjacent driving trajectory points at each supplementary point interval distance, until the target distance between the trajectory supplementary point and the adjacent driving trajectory point is less than the supplementary point interval distance.
5. The method according to claim 4, It is characterized in that After sequentially setting one track supplementary point at each supplementary point interval between the adjacent driving track points according to the configuration order of the adjacent driving track points, the method further includes: Determine the magnitude relationship between the target distance and a preset interval distance threshold; If the distance is less than a preset interval distance threshold, the trajectory supplement point is deleted; If the distance is greater than the preset interval distance threshold, the trajectory supplement point is retained.
6. The method according to claim 1, It is characterized in that Fitting the target vehicle driving path according to the driving trajectory point group and the trajectory supplementary points specifically includes: Determine a discrete point sequence according to the total number of set points corresponding to the driving trajectory point group and the trajectory supplementary point and the preset number of discrete trajectory points; Determining a corresponding Gaussian kernel function value for each discrete trajectory point in the discrete point sequence, and each set point in the driving trajectory point group and the trajectory supplementary point; Determining a weight coefficient corresponding to each of the discrete trajectory points according to the Gaussian kernel function value; Determining the trajectory point coordinates corresponding to each of the discrete trajectory points according to the setting point and the weight coefficient; The target vehicle driving path is generated by fitting the trajectory point coordinates.
7. The method according to claim 6, It is characterized in that After fitting the target vehicle driving path according to the driving trajectory point group and the trajectory supplementary points, the method further includes: Controlling the vehicle to travel at a preset speed in each control frame along the target vehicle's travel path; In each of the control frames, determining the corresponding travel distance and the end point coordinates of the vehicle according to the preset speed; Accumulating the distances between the discrete track points, and determining a target track point pair whose end point coordinates are between two of the discrete track points according to the driving distance; The coordinates of the middle point of the target track point pair are determined by linear interpolation, and the movement of the vehicle is controlled by taking the coordinates of the middle point as the end point coordinates.
8. A vehicle automatic driving path planning device, It is characterized in that include: The track point configuration module is used to obtain the user-configured driving track point group and the vehicle's current target heading; A heading point supplement module, used for setting a heading supplement point on the target heading, and adding the heading supplement point as a driving track point to the driving track point group; A track point supplement module, for setting track supplement points at the same interval according to a preset track point density requirement between every two adjacent driving track points in the driving track point group; The path fitting module is used to fit the target vehicle's driving path according to the driving trajectory point group and the trajectory supplementary points.
9. An electronic device, It is characterized in that include: A processor, a memory and a bus, wherein the memory stores machine-readable instructions executable by the processor, and when the electronic device is running, the processor and the memory communicate via the bus, and when the machine-readable instructions are executed by the processor, the steps of the vehicle automatic driving path planning method as described in any one of claims 1 to 7 are performed.
10. A computer-readable storage medium, It is characterized in that The computer-readable storage medium stores a computer program, which, when executed by a processor, executes the steps of the vehicle automatic driving path planning method as described in any one of claims 1 to 7.
Citation Information
Cited By
Method for acquiring vehicle driving track, electronic equipment and storage medium
CN119502919A
