Vehicle navigation method and device, electronic equipment and readable storage medium
By planning the navigation path in adjacent reverse lanes and changing the positioning coordinates when switching the driving direction of the autonomous driving vehicle in the industrial park, the problems of low navigation efficiency and risk are solved, and more efficient and safe navigation is achieved.
Patent Information
- Application Number
- CN202411201356.1
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-29
- Publication Date
- 2024-12-06
Smart Images

Figure CN119085675A_ABST
Abstract
Description
Technical Field
[0001] The present application relates to the field of autonomous driving technology, and in particular to a vehicle navigation method, device, electronic device and readable storage medium. Background Art
[0002] With the continuous development of autonomous driving technology, the application of autonomous driving vehicles in industrial park scenarios such as bonded areas and manufacturing plants has become an important means to promote industrial automation and intelligent transformation.
[0003] During the application of self-driving cars in industrial parks, when performing tasks such as loading and unloading, docking, and battery replacement, many special driving scenarios that are different from open roads will appear, such as dead-end roads, narrow roads, and other driving scenarios that require U-turns and lane changes. In order to meet logistics needs, the self-driving vehicles used in industrial parks are longer and have heavier loads. During the U-turn process, there is a high risk of collision and rollover. Therefore, self-driving vehicles choose to avoid U-turns and lane changes by switching the direction of travel in such driving scenarios.
[0004] Since the existing navigation method of autonomous driving vehicles is designed according to a fixed vehicle driving direction, when the driving direction of the autonomous driving vehicle switches, the navigation path cannot be planned, causing the vehicle to report an error and stop, and the navigation efficiency of the autonomous driving vehicle is low. Summary of the invention
[0005] In view of this, the embodiments of the present application at least provide a vehicle navigation method, device, electronic device and readable storage medium, which improves the navigation efficiency of the autonomous driving vehicle by planning a navigation path in the adjacent reverse lane when the driving direction is switched, and controlling the vehicle to change lanes and drive in the reverse lane.
[0006] This application mainly includes the following aspects:
[0007] In a first aspect, an embodiment of the present application provides a vehicle navigation method, which is applied to an autonomous driving vehicle, and the method includes:
[0008] In the process of controlling the target vehicle to travel along the first navigation path, if a driving direction switching instruction is received, the driving direction of the target vehicle is switched from the first driving direction to the second driving direction; the first navigation path is a navigation path determined based on preset end point coordinates and a preset first trajectory planning range threshold; the second driving direction is opposite to the first driving direction;
[0009] Determining whether the target vehicle is in a wrong-way state based on the lane direction of the lane where the target vehicle is located and the heading angle of the target vehicle;
[0010] If so, transforming the positioning coordinates of the target vehicle when the driving direction is switched to the adjacent reverse lane, and determining the transformed positioning coordinates as the starting point coordinates of the second navigation path of the target vehicle;
[0011] Based on the starting point coordinates of the second navigation path, the preset end point coordinates and the preset second trajectory planning range threshold, the second navigation path of the target vehicle is determined, and the target vehicle is controlled to travel according to the second navigation path; wherein the second trajectory planning range threshold is greater than the first trajectory planning range threshold.
[0012] In a second aspect, an embodiment of the present application further provides a vehicle navigation device, which is applied to an autonomous driving vehicle, and the vehicle navigation device includes:
[0013] an execution module, configured to switch the target vehicle's driving direction from the first driving direction to a second driving direction if a driving direction switching instruction is received during the process of controlling the target vehicle to drive along a first navigation path; the first navigation path is a navigation path determined based on preset end point coordinates and a preset first trajectory planning range threshold; the second driving direction is opposite to the first driving direction;
[0014] A judgment module, used to determine whether the target vehicle is in a wrong direction based on the lane direction of the lane where the target vehicle is located and the heading angle of the target vehicle;
[0015] A first determining module is used to transform the positioning coordinates of the target vehicle when the driving direction is switched to an adjacent reverse lane, and determine the transformed positioning coordinates as the starting point coordinates of the second navigation path of the target vehicle;
[0016] A second determination module is used to determine the second navigation path of the target vehicle based on the starting point coordinates of the second navigation path, the preset end point coordinates and a preset second trajectory planning range threshold, and control the target vehicle to travel along the second navigation path; wherein the second trajectory planning range threshold is greater than the first trajectory planning range threshold.
[0017] In a third aspect, an embodiment of the present application further provides an electronic device, comprising: 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 the machine-readable instructions are executed by the processor to execute the steps of the vehicle navigation method as described above.
[0018] In a fourth aspect, an embodiment of the present application further provides a computer-readable storage medium having a computer program stored thereon, and when the computer program is executed by a processor, the steps of the vehicle navigation method as described above are executed.
[0019] The vehicle navigation method, device, electronic device and readable storage medium provided by the embodiment of the present application, wherein the method is applied to an autonomous driving vehicle, including: in the process of controlling the target vehicle to travel according to the first navigation path, if a driving direction switching instruction is received, the driving direction of the target vehicle is switched from the first driving direction to the second driving direction; the first navigation path is a navigation path determined based on the preset end point coordinates and the preset first trajectory planning range threshold; the second driving direction is opposite to the first driving direction; based on the lane direction of the lane where the target vehicle is located and the heading angle of the target vehicle, determine whether the target vehicle is in a reverse state; if so, transform the positioning coordinates of the target vehicle when the driving direction is switched to the adjacent reverse lane, and determine the transformed positioning coordinates as the starting coordinates of the second navigation path of the target vehicle; based on the starting coordinates of the second navigation path, the preset end point coordinates and the preset second trajectory planning range threshold, determine the second navigation path of the target vehicle, and control the target vehicle to travel according to the second navigation path; wherein the second trajectory planning range threshold is greater than the first trajectory planning range threshold. In this way, when the driving direction is switched, the navigation path is planned in the adjacent reverse lane, and the vehicle is controlled to change lanes and travel in the reverse lane, thereby improving the navigation efficiency of the autonomous driving vehicle.
[0020] In order to make the above-mentioned objects, features and advantages of the present application 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
[0021] In order to more clearly illustrate the technical solutions of the embodiments of the present application, the drawings required for use in the embodiments will be briefly introduced below. It should be understood that the following drawings only show certain embodiments of the present application and therefore should not be regarded as limiting the scope. For ordinary technicians in this field, other related drawings can be obtained based on these drawings without paying creative work.
[0022] Figure 1 A flow chart of a vehicle navigation method provided by an embodiment of the present application is shown;
[0023] Figure 2 A schematic diagram showing a first navigation path in a first road scene in an embodiment of the present application is shown;
[0024] Figure 3 A schematic diagram showing a first navigation path in a second road scenario in an embodiment of the present application is shown;
[0025] Figure 4 A schematic diagram of a second navigation path in a first road scene in an embodiment of the present application is shown;
[0026] Figure 5 A schematic diagram showing a second navigation path in a second road scenario in an embodiment of the present application is shown;
[0027] Figure 6 A schematic diagram showing a method of controlling a target vehicle to travel along a second navigation path in an embodiment of the present application is shown;
[0028] Figure 7 One of the functional module diagrams of a vehicle navigation device provided by an embodiment of the present application is shown;
[0029] Figure 8 A second functional module diagram of a vehicle navigation device provided by an embodiment of the present application is shown;
[0030] Fig. 9 A schematic structural diagram of an electronic device provided in an embodiment of the present application is shown. DETAILED DESCRIPTION
[0031] In order to make the purpose, technical scheme and advantages of the embodiments of the present application clearer, the technical scheme in the embodiments of the present application will be clearly and completely described below in conjunction with the drawings in the embodiments of the present application. Obviously, the described embodiments are only a part of the embodiments of the present application, rather than all the embodiments. The components of the embodiments of the present application usually 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 application provided in the drawings is not intended to limit the scope of the application claimed for protection, but merely represents the selected embodiments of the present application. Based on the embodiments of the present application, all other embodiments obtained by those skilled in the art without making creative work belong to the scope of protection of the present application.
[0032] The following is a detailed description of a vehicle navigation method provided by an embodiment of the present application. Figure 1 , Figure 1 This is a flow chart of a vehicle navigation method provided in an embodiment of the present application, and the vehicle navigation method is applied to an autonomous driving vehicle. Figure 1 As shown, the vehicle navigation method provided by the embodiment of the present application includes the following steps:
[0033] S101, in the process of controlling a target vehicle to travel along a first navigation path, if a driving direction switching instruction is received, the driving direction of the target vehicle is switched from the first driving direction to the second driving direction; the first navigation path is a navigation path determined based on preset end point coordinates and a preset first trajectory planning range threshold; the second driving direction is opposite to the first driving direction.
[0034] In the embodiment of the present application, the autonomous driving vehicle is an autonomous driving vehicle equipped with a modular autonomous driving system, including an environmental perception module for obtaining environmental information; a decision-making and planning module for planning a navigation path; and a control execution module for controlling the autonomous driving vehicle to travel along the planned navigation path. In the application process of the autonomous driving vehicle in the industrial park, in most cases, it is necessary to strictly follow the prescribed direction of the road in the industrial park, that is, to travel along the first navigation path. Here, the first navigation path is a navigation path planned on the park map by the decision-making and planning module of the autonomous driving vehicle according to the first trajectory planning range threshold according to the preset end point coordinates. Among them, the first trajectory planning range threshold is the maximum value of the range of coordinates of the nearest trajectory point preset in the relevant algorithm for generating local trajectories in the decision-making and planning module. In the embodiment of the present application, the size of the first trajectory planning range threshold is less than half of the lane width, that is, the range of the circle composed of the target vehicle as the center and the first trajectory planning range threshold as the radius will not exceed the lane where the target vehicle is located, so as to ensure that the planned navigation path will not be planned into the adjacent reverse lane. Specifically, in the embodiment of the present application, the decision-making planning module of the autonomous driving vehicle is an autoware planning module, and the relevant algorithm for generating local trajectories is the MPT algorithm (Model Predictive Trajectory Planning). MPT is a trajectory planning method based on model prediction. It predicts changes in vehicle states and adjustments to control instructions to enable the vehicle to travel along a predetermined path and keep the vehicle's deviation within a certain range.
[0035] However, in some special road scenarios, strictly controlling the target vehicle to drive according to the first navigation path may cause various problems. For example, see Figure 2 , Figure 2 Schematic diagram of a first navigation path in a first road scene in an embodiment of the present application. Figure 2 As shown, in the process of controlling the target vehicle to drive according to the first navigation path, if the target vehicle wants to drive to the preset end point coordinates of the adjacent reverse lane, it needs to travel a long way to reach the location of the preset end point coordinates. Figure 3 , Figure 3 Schematic diagram of the first navigation path in the second road scene in the embodiment of the present application. Figure 2As shown, in the process of controlling the target vehicle to drive according to the first navigation path, the target vehicle may drive to a special road scene such as a dead-end road in order to perform tasks such as loading and unloading, docking, and battery replacement. If the target vehicle is driven according to the first navigation path, it is necessary to control the target vehicle to turn around on the spot. Since the autonomous driving vehicle used in the industrial park is long and has a heavy load, the target vehicle is very likely to collide, roll over, and other risks during the process of turning around on the spot. That is to say, the first navigation path is not applicable in the road scenes shown in the first road scene and the second road scene. Therefore, the central control system of the industrial park will send a driving direction switching instruction to the autonomous driving vehicle when the autonomous driving vehicle is in a detour or in a special road scene such as a dead-end road. Therefore, in the process of controlling the target vehicle to drive according to the first navigation path, if a driving direction switching instruction is received, the driving direction of the target vehicle is switched from the first driving direction to the second driving direction; the first driving direction is the driving direction of the target vehicle when receiving the driving direction switching instruction, and the second driving direction is opposite to the first driving direction.
[0036] S102: Determine whether the target vehicle is in a wrong-way state based on the lane direction of the lane where the target vehicle is located and the heading angle of the target vehicle.
[0037] In the embodiment of the present application, after the driving direction of the target vehicle is switched from the first driving direction to the second driving direction, it is necessary to perform a second judgment on the driving direction of the target vehicle to determine whether the second driving direction of the target vehicle is opposite to the lane direction of the lane where the target vehicle is located, that is, to determine whether the target vehicle is in a reverse state after switching the driving direction. If it is in a reverse state, the corresponding first navigation path cannot be generated based on the generation method of the first navigation path, and the generation method of the navigation path needs to be switched; if it is not in a reverse state, the target vehicle can continue to be controlled to travel according to the first navigation path.
[0038] S103: If yes, transform the positioning coordinates of the target vehicle when the driving direction is switched to the adjacent reverse lane, and determine the transformed positioning coordinates as the starting point coordinates of the second navigation path of the target vehicle.
[0039] In an embodiment of the present application, in order to allow the target vehicle to travel in the reverse lane without turning around and changing lanes, the positioning coordinates of the target vehicle when the driving direction is switched are first transformed to the adjacent reverse lane to generate a virtual positioning coordinate of the target vehicle in the adjacent reverse lane, and the transformed positioning coordinates are determined as the starting coordinates of the second navigation path of the target vehicle, so as to subsequently plan the second navigation path based on the virtual positioning coordinates of the target vehicle.
[0040] Specifically, the positioning coordinates of the target vehicle when the driving direction is switched can be transformed to the adjacent reverse lane through TF (Transform) coordinate transformation. TF coordinate transformation is a technology commonly used in the field of robotics and computer vision, which is used to transform coordinates between different coordinate systems. Specifically, the positioning coordinates of the target vehicle when the driving direction is switched can be transformed from the target vehicle's own vehicle coordinate system to the longitude and latitude coordinates of the world coordinate system through TF coordinate transformation, and then the longitude and latitude coordinates are transformed to the adjacent reverse lane to obtain the transformed positioning coordinates in the form of longitude and latitude coordinates of the world coordinate system, that is, the starting point coordinates of the second navigation path of the target vehicle.
[0041] S104, based on the starting point coordinates of the second navigation path, the preset end point coordinates and the preset second trajectory planning range threshold, determine the second navigation path of the target vehicle, and control the target vehicle to travel according to the second navigation path; wherein the second trajectory planning range threshold is greater than the first trajectory planning range threshold.
[0042] In an embodiment of the present application, in order to ensure that a navigation path can be planned in an adjacent reverse lane, when planning the second navigation path, the trajectory planning range threshold in the MPT algorithm is switched from a preset first trajectory planning range threshold to a preset second trajectory planning range threshold, wherein the second trajectory planning range threshold is greater than the first trajectory planning range threshold, so that a circle with the second trajectory planning range threshold as a radius can cover the adjacent reverse lane of the lane where the target vehicle is located. In this way, the decision-making planning module of the target vehicle can use the transformed positioning coordinates in the adjacent reverse lane as the starting coordinates of the second navigation path, and the preset end coordinates as the end coordinates of the second navigation path, to plan the second navigation path of the target vehicle. Specifically, please refer to Figure 4 and Figure 5 , Figure 4 is a schematic diagram of a second navigation path in a first road scene in an embodiment of the present application, Figure 5 Schematic diagram of the second navigation path in the second road scene in the embodiment of the present application. Figure 4 As shown, a second navigation path is planned in the reverse lane adjacent to the lane where the target vehicle is located according to the second trajectory planning range threshold, and the target vehicle is controlled to change lanes and drive to the preset end point coordinates according to the second navigation path, thereby reducing the navigation distance of the detour and improving the vehicle navigation efficiency. Figure 5 As shown, a second navigation path is planned in the reverse lane adjacent to the lane where the target vehicle is located according to the second trajectory planning range threshold, and the target vehicle is controlled to change lanes and drive to the preset end point coordinates in the reverse lane according to the second navigation path, thereby eliminating the risks of collision and rollover caused by turning around on the spot and improving the vehicle navigation efficiency.
[0043] Further, in S102, the lane direction of the lane where the target vehicle is located is obtained according to the following steps:
[0044] Step a1, determining the lane of the target vehicle in the map based on the map information obtained from the target vehicle and the positioning information of the target vehicle when the driving direction is switched.
[0045] In the embodiment of the present application, a map of the industrial park is pre-stored in the memory of the target vehicle. When determining the lane direction of the lane where the target lane is located, the map is read to obtain map information, and the positioning information of the target vehicle when the driving direction is switched is obtained through the autoware positioning module of the target vehicle. According to the map information and the positioning information, the lane where the target vehicle is located in the map is determined. Specifically, the distance and angle between the map lane and the target vehicle can be determined by determining the lane position in the map and the position of the target vehicle according to the map information and the positioning information, and determining the lane where the target vehicle is located in the map.
[0046] Step a2, determining the lane direction of the lane where the target vehicle is located in the map as the lane direction of the lane where the target vehicle is located.
[0047] In this step, the lane direction of the lane where the target vehicle is located in the map is determined as the lane direction of the lane where the target vehicle is located.
[0048] Furthermore, step S102 specifically includes:
[0049] Step b1, determining the heading angle of the target vehicle according to the second driving direction.
[0050] In this step, the heading angle of the target vehicle is determined according to the second driving direction and the starting direction determined by the GPS receiver of the target vehicle, wherein the starting direction is the geographic north direction, and the heading angle of the target vehicle is the angle between the second driving direction and the starting direction, that is, the angle between the second driving direction and the geographic north direction.
[0051] Step b2, calculating the angle difference between the heading angle of the target vehicle and the lane direction of the lane where the target vehicle is located.
[0052] In this step, the lane direction of the lane where the target vehicle is located can be expressed as the angle between the lane direction of the target vehicle's lane and the geographic north direction, and the angle difference between the heading angle of the target vehicle and the lane direction of the target vehicle's lane can be expressed as the absolute value of the difference between the angle between the second driving direction and the geographic north direction and the angle between the lane direction of the target vehicle's lane and the geographic north direction.
[0053] Step b3: If the angle difference is greater than the preset angle threshold, it is determined that the target vehicle is in a reverse state.
[0054] In this step, when the angle difference is greater than the preset angle threshold, it means that the second driving direction of the target vehicle is opposite to the lane direction of the lane where the target vehicle is located, and it is determined that the target vehicle is in a reverse state. Specifically, the preset angle threshold can be selected as 90°, 120°, 150°, etc. The larger the angle, the more accurate the judgment that the target vehicle is in a reverse state. The specific preset angle threshold is not limited here.
[0055] Step b4: If the angle difference is less than or equal to the preset angle threshold, it is determined that the target vehicle is not in a reverse state.
[0056] In this step, when the angle difference is less than or equal to the preset angle threshold, it means that the second driving direction of the target vehicle is the same as the lane direction of the lane where the target vehicle is located, and it is determined that the target vehicle is not in a reverse state.
[0057] Furthermore, step S104 specifically includes:
[0058] Step c1, based on the starting point coordinates of the second navigation path of the target vehicle, the positioning coordinates of the target vehicle when the driving direction is switched, and a preset second trajectory search range threshold, determine the target trajectory point coordinates on the second navigation path; wherein the second trajectory search range threshold is greater than the preset first trajectory search range threshold, and the first trajectory search range threshold is the maximum search range for controlling the target vehicle to search for the planned trajectory of the first navigation path when driving along the first navigation path.
[0059] In this step, see Figure 6 , Figure 6 FIG. 1 is a schematic diagram of controlling the target vehicle to travel along the second navigation path in an embodiment of the present application. Figure 6 As shown, in an embodiment of the present application, controlling the target vehicle to travel along the second navigation path includes controlling the target vehicle to change lanes from the positioning coordinate point A when the target vehicle switches its driving direction to the target trajectory point B on the second navigation path, and controlling the target vehicle to travel from the target trajectory point B to the preset end point C along the second navigation path.
[0060] First, since the starting point A' of the second navigation path is not the actual starting point of the target vehicle, but a fictitious starting point in the reverse lane of the lane where the target vehicle is located, it is first necessary to determine the coordinates of the target trajectory point on the second navigation path based on the starting point coordinates of the second navigation path, the positioning coordinates of the target vehicle in the driving direction, and the preset second trajectory search range threshold, so that the target vehicle changes lanes and gradually approaches the second navigation path, and drives to the second navigation path at the target trajectory point B. In the embodiment of the present application, the target vehicle searches for the trajectory points generated by the decision planning module through the relevant algorithm for tracking the trajectory in the control execution module. Among them, the first trajectory search range threshold is the preset maximum search range for searching the planned trajectory of the first navigation path when the target vehicle is traveling according to the first navigation path. In the embodiment of the present application, the size of the first trajectory search range threshold is less than half of the lane width, that is, the range of the circle composed of the target vehicle as the center and the first trajectory search range threshold as the radius will not exceed the lane where the target vehicle is located, so as to ensure that the searched navigation path will not track into the adjacent reverse lane. The second trajectory search range threshold is the preset maximum search range for searching the planned trajectory of the second navigation path when the target vehicle is traveling according to the second navigation path. Specifically, the second trajectory search range threshold is greater than the preset first trajectory search range threshold to ensure that the searched navigation path can be tracked into the adjacent reverse lane so that the target vehicle changes lanes in the reverse lane to approach the second navigation path. In the embodiment of the present application, the relevant algorithm for tracking the trajectory is the MPC algorithm (Model Predictive Control). The MPC algorithm is a control strategy based on a linear system model, which can periodically solve a finite-time open-loop optimization problem online based on current measurement information, and apply the front part of the control sequence of the result to the controlled object.
[0061] Step c2, controlling the target vehicle to change lanes from the positioning coordinates when the driving direction is switched to the target track point coordinates on the second navigation path.
[0062] In this step, if Figure 6 As shown, after determining the coordinates of the target track point, the target vehicle is controlled to change lanes from the positioning coordinates when the driving direction is switched to the coordinates of the target track point on the second navigation path, and point-to-point navigation is completed through the lanelet library.
[0063] Step c3, after the target vehicle reaches the target track point coordinates, the target vehicle is controlled to travel from the target track point coordinates to the preset end point coordinates according to the second navigation path.
[0064] In this step, if Figure 6As shown, the target vehicle has reached the target trajectory point coordinate position of the reverse lane, and the navigation process of changing lanes to the reverse lane ends. The target vehicle is controlled to drive from the target trajectory point coordinate to the preset end point coordinate according to the second navigation path, and point-to-point navigation is completed through the lanelet library.
[0065] Furthermore, step c2 specifically includes:
[0066] Step d1, searching for a planned trajectory of a second navigation path according to a second trajectory search range threshold.
[0067] In this step, the coordinates of each navigation point on the second navigation path starting from the starting point coordinates of the second navigation path in the reverse lane of the lane where the target vehicle is located are searched according to the second trajectory search range threshold.
[0068] Step d2, based on the positioning coordinates of the target vehicle when the driving direction is switched, the coordinates of each track point on the planned trajectory of the searched second navigation path, the target track point coordinates and the preset track correction algorithm, determine the corrected driving trajectory of the target vehicle from the positioning coordinates when the driving direction is switched to the target track point coordinates on the second navigation path.
[0069] In this step, the distance and angle from the coordinates of each trajectory point on the planned trajectory of the searched second navigation path from the starting point A′ of the second navigation path to the target trajectory point B to the positioning coordinate point A of the target vehicle when the driving direction switches are calculated, and according to the preset trajectory correction algorithm, a corrected driving trajectory from the positioning coordinate point A of the target vehicle when the driving direction switches to the target trajectory point B is planned. Specifically, the preset trajectory correction algorithm can adopt a trajectory correction algorithm such as a geometric algorithm, a Bayesian filtering algorithm, etc., which is not specifically limited here.
[0070] Step d3, controlling the target vehicle to change lanes and drive from the positioning coordinates when the driving direction is switched to the target track point coordinates on the second navigation path according to the deviation correction driving track.
[0071] In this step, after the deviation-correcting driving trajectory is determined, the target vehicle is controlled to change lanes from the positioning coordinate point A when the driving direction is switched to the target trajectory point B on the second navigation path in the adjacent reverse lane according to the deviation-correcting driving trajectory.
[0072] Furthermore, step c3 specifically includes:
[0073] The planned trajectory of the second navigation path from the target trajectory point coordinates to the preset end point coordinates is searched according to the first trajectory search range threshold, and the target vehicle is controlled to travel from the target trajectory point coordinates to the preset end point coordinates according to the second navigation path.
[0074] In this step, if Figure 6As shown, since the target vehicle has reached the target trajectory point coordinate position of the reverse lane, the navigation process of changing lanes to the reverse lane ends. In the process of driving from the target trajectory point B to the preset end point C, there is no need to change lanes to the reverse lane. Therefore, the trajectory search range threshold is switched from the second trajectory search range threshold to the first trajectory search range threshold. The planned trajectory of the second navigation path from the target trajectory point coordinates to the preset end point coordinates is searched according to the first trajectory search range threshold. The target vehicle is controlled to drive from the target trajectory point coordinates to the preset end point coordinates according to the second navigation path, so as to avoid tracking the searched navigation path into the adjacent reverse lane.
[0075] Furthermore, after step S102, the method further includes:
[0076] If not, it is determined that the target vehicle does not need to re-plan the navigation path, and the target vehicle is controlled to continue traveling along the first navigation path.
[0077] In this step, if it is determined that the target vehicle's driving direction is not in a reverse state after switching from the first driving direction to the second driving direction, it may mean that the target vehicle has failed to switch direction or is in some special lanes that can travel in both directions. It is determined that the target vehicle does not need to re-plan the navigation path, and the target vehicle is controlled to continue traveling along the first navigation path until a driving direction switching instruction is received again, or the target vehicle travels to a preset end position.
[0078] The embodiment of the present application provides a vehicle navigation method, which is applied to an autonomous driving vehicle, including: in the process of controlling a target vehicle to travel along a first navigation path, if a driving direction switching instruction is received, the driving direction of the target vehicle is switched from the first driving direction to the second driving direction; the first navigation path is a navigation path determined based on preset end point coordinates and a preset first trajectory planning range threshold; the second driving direction is opposite to the first driving direction; based on the lane direction of the lane where the target vehicle is located and the heading angle of the target vehicle, determine whether the target vehicle is in a reverse state; if so, transform the positioning coordinates of the target vehicle when the driving direction is switched to the adjacent reverse lane, and determine the transformed positioning coordinates as the starting coordinates of the second navigation path of the target vehicle; based on the starting coordinates of the second navigation path, the preset end point coordinates and the preset second trajectory planning range threshold, determine the second navigation path of the target vehicle, and control the target vehicle to travel along the second navigation path; wherein the second trajectory planning range threshold is greater than the first trajectory planning range threshold. In this way, when the driving direction is switched, the navigation path is planned in the adjacent reverse lane, and the vehicle is controlled to change lanes and travel in the reverse lane, thereby improving the navigation efficiency of the autonomous driving vehicle.
[0079] Based on the same application concept, a vehicle navigation device corresponding to the vehicle navigation method provided in the above embodiment is also provided in the embodiment of the present application. Since the principle of solving the problem by the device in the embodiment of the present application is similar to the vehicle navigation method in the above embodiment of the present application, the implementation of the device can refer to the implementation of the method, and the repeated parts will not be repeated.
[0080] See also Figure 7 , Figure 7 This is one of the functional module diagrams of a vehicle navigation device provided in an embodiment of the present application, wherein the device is applied to an autonomous driving vehicle. Figure 7 As shown, the vehicle navigation device 700 includes:
[0081] The execution module 710 is used to switch the driving direction of the target vehicle from the first driving direction to the second driving direction if a driving direction switching instruction is received during the process of controlling the target vehicle to drive according to the first navigation path; the first navigation path is a navigation path determined based on the preset end point coordinates and the preset first trajectory planning range threshold; the second driving direction is opposite to the first driving direction.
[0082] The judgment module 720 is used to determine whether the target vehicle is in a wrong-way state based on the lane direction of the lane where the target vehicle is located and the heading angle of the target vehicle.
[0083] The first determination module 730 is used to transform the positioning coordinates of the target vehicle when the driving direction is switched to the adjacent reverse lane, and determine the transformed positioning coordinates as the starting point coordinates of the second navigation path of the target vehicle.
[0084] The second determination module 740 is used to determine the second navigation path of the target vehicle based on the starting point coordinates of the second navigation path, the preset end point coordinates and the preset second trajectory planning range threshold, and control the target vehicle to travel according to the second navigation path; wherein the second trajectory planning range threshold is greater than the first trajectory planning range threshold.
[0085] Furthermore, the judgment module 720 is used to obtain the lane direction of the lane where the target vehicle is located according to the following steps:
[0086] Determine the lane of the target vehicle in the map based on the map information obtained from the target vehicle and the positioning information of the target vehicle when the driving direction is switched;
[0087] The lane direction of the lane where the target vehicle is located in the map is determined as the lane direction of the lane where the target vehicle is located.
[0088] Further, when the judgment module 720 is used to determine whether the target vehicle is in a reverse state based on the lane direction of the lane where the target vehicle is located and the heading angle of the target vehicle, the judgment module 720 is specifically used to:
[0089] Determining a heading angle of the target vehicle according to the second driving direction;
[0090] Calculate the angle difference between the heading angle of the target vehicle and the lane direction of the lane where the target vehicle is located;
[0091] If the angle difference is greater than a preset angle threshold, it is determined that the target vehicle is in a wrong direction;
[0092] If the angle difference is less than or equal to the preset angle threshold, it is determined that the target vehicle is not in a wrong direction state.
[0093] Further, when the second determination module 740 is used to control the target vehicle to travel according to the second navigation path, the second determination module 740 is specifically used to:
[0094] Based on the starting point coordinates of the second navigation path of the target vehicle, the positioning coordinates of the target vehicle when the driving direction is switched, and a preset second trajectory search range threshold, the target trajectory point coordinates on the second navigation path are determined; wherein the second trajectory search range threshold is greater than the preset first trajectory search range threshold, and the first trajectory search range threshold is the maximum search range for controlling the target vehicle to search for the planned trajectory of the first navigation path when driving along the first navigation path;
[0095] Control the target vehicle to change lanes from the positioning coordinates when the driving direction is switched to the target track point coordinates on the second navigation path;
[0096] After the target vehicle reaches the target track point coordinates, the target vehicle is controlled to travel from the target track point coordinates to the preset end point coordinates according to the second navigation path.
[0097] Further, when the second determination module 740 is used to control the target vehicle to change lanes from the positioning coordinates when the driving direction is switched to the target track point coordinates on the second navigation path, the second determination module 740 is specifically used to:
[0098] Searching for a planned trajectory of a second navigation path according to a second trajectory search range threshold;
[0099] Determine the deviation-correcting driving trajectory of the target vehicle from the positioning coordinates when the driving direction is switched to the target trajectory point coordinates on the second navigation path according to the positioning coordinates when the driving direction is switched, the coordinates of each trajectory point on the planned trajectory of the searched second navigation path, the coordinates of the target trajectory point, and a preset trajectory correction algorithm;
[0100] The target vehicle is controlled to change lanes according to the deviation-correcting driving trajectory, from the positioning coordinates when the driving direction is switched to the target trajectory point coordinates on the second navigation path.
[0101] Further, when the second determination module 740 is used to control the target vehicle to travel from the target track point coordinates to the preset end point coordinates according to the second navigation path, the second determination module 740 is specifically used to:
[0102] The planned trajectory of the second navigation path from the target trajectory point coordinates to the preset end point coordinates is searched according to the first trajectory search range threshold, and the target vehicle is controlled to travel from the target trajectory point coordinates to the preset end point coordinates according to the second navigation path.
[0103] For further information, see Figure 8 , Figure 8 This is a second functional module diagram of a vehicle navigation device provided in an embodiment of the present application, wherein the device is applied to an autonomous driving vehicle. Figure 8 As shown, the vehicle navigation device 700 also includes:
[0104] The third determination module 750 is used to control the target vehicle to continue to travel along the first navigation path if no, it is determined that the target vehicle does not need to re-plan the navigation path.
[0105] The embodiment of the present application provides a vehicle navigation device, which is applied to an autonomous driving vehicle, including: an execution module, which is used to switch the driving direction of the target vehicle from the first driving direction to the second driving direction if a driving direction switching instruction is received during the process of controlling the target vehicle to drive along the first navigation path; the first navigation path is a navigation path determined based on the preset end point coordinates and the preset first trajectory planning range threshold; the second driving direction is opposite to the first driving direction; a judgment module, which is used to determine whether the target vehicle is in a reverse state based on the lane direction of the lane where the target vehicle is located and the heading angle of the target vehicle; a first determination module, which is used to transform the positioning coordinates of the target vehicle when the driving direction is switched to the adjacent reverse lane if so, and determine the transformed positioning coordinates as the starting coordinates of the second navigation path of the target vehicle; a second determination module, which is used to determine the second navigation path of the target vehicle based on the starting coordinates of the second navigation path, the preset end point coordinates and the preset second trajectory planning range threshold, and control the target vehicle to drive along the second navigation path; wherein the second trajectory planning range threshold is greater than the first trajectory planning range threshold. In this way, when the driving direction is switched, the navigation path is planned in the adjacent reverse lane, and the vehicle is controlled to change lanes and drive in the reverse lane, thereby improving the navigation efficiency of the autonomous driving vehicle.
[0106] Based on the same application idea, please refer to Fig. 9 , Fig. 9 A schematic diagram of the structure of an electronic device provided in an embodiment of the present application is shown in FIG. Fig. 9 As shown, the electronic device 900 includes a processor 910 , a memory 920 and a bus 930 .
[0107] The memory 920 stores machine-readable instructions executable by the processor 910. When the electronic device 900 is running, the processor 910 communicates with the memory 920 via the bus 930. The machine-readable instructions are executed by the processor 910 when running to perform the steps of the vehicle navigation method provided in the above embodiment. The specific implementation method can be found in the method embodiment, which will not be repeated here.
[0108] Based on the same application concept, an embodiment of the present application further provides a computer-readable storage medium, on which a computer program is stored. When the computer program is executed by a processor, the steps of the vehicle navigation method provided in the above embodiment are executed. The specific implementation method can be found in the method embodiment, which will not be repeated here.
[0109] Those skilled in the art can clearly understand that, for the convenience and brevity of description, the specific working processes of the above-described devices and units can refer to the corresponding processes in the aforementioned method embodiments and will not be repeated here.
[0110] In the embodiments provided in the present application, it should be understood that the disclosed devices and methods can be implemented in other ways. The device embodiments described above are only 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, indirect coupling or communication connection of devices or units, which can be electrical, mechanical or other forms.
[0111] 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.
[0112] In addition, each functional unit in the embodiments provided in the present application 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.
[0113] 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 computer-readable storage medium. Based on this understanding, the technical solution of the present application, 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 methods described in each embodiment of the present application. 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.
[0114] It should be noted that similar numbers and letters represent similar items in the following figures. Therefore, once an item is defined in one figure, it does not need to be further defined and explained in subsequent figures. In addition, the terms "first", "second", "third", etc. are only used to distinguish the description and are not to be understood as indicating or implying relative importance.
[0115] Finally, it should be noted that the above-described embodiments are only specific implementation methods of the present application, which are used to illustrate the technical solutions of the present application, rather than to limit them. The protection scope of the present application is not limited thereto. Although the present application is described in detail with reference to the above-mentioned 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-mentioned embodiments within the technical scope disclosed in the present application, 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 application. They should all be included in the protection scope of the present application. Therefore, the protection scope of the present application shall be based on the protection scope of the claims.
Claims
1. A vehicle navigation method, characterized in that: Applied to an autonomous driving vehicle, the method comprises: In the process of controlling the target vehicle to travel along the first navigation path, if a driving direction switching instruction is received, the driving direction of the target vehicle is switched from the first driving direction to the second driving direction; the first navigation path is a navigation path determined based on preset end point coordinates and a preset first trajectory planning range threshold; the second driving direction is opposite to the first driving direction; Determining whether the target vehicle is in a wrong-way state based on the lane direction of the lane where the target vehicle is located and the heading angle of the target vehicle; If so, transforming the positioning coordinates of the target vehicle when the driving direction is switched to the adjacent reverse lane, and determining the transformed positioning coordinates as the starting point coordinates of the second navigation path of the target vehicle; Based on the starting point coordinates of the second navigation path, the preset end point coordinates and the preset second trajectory planning range threshold, the second navigation path of the target vehicle is determined, and the target vehicle is controlled to travel according to the second navigation path; wherein the second trajectory planning range threshold is greater than the first trajectory planning range threshold.
2. The vehicle navigation method according to claim 1, characterized in that: The controlling the target vehicle to travel according to the second navigation path includes: Determine the coordinates of the target track point on the second navigation path based on the starting point coordinates of the second navigation path of the target vehicle, the positioning coordinates of the target vehicle when the driving direction is switched, and a preset second track search range threshold; wherein the second track search range threshold is greater than the preset first track search range threshold, and the first track search range threshold is a maximum search range for controlling the target vehicle to search for a planned track of the first navigation path when traveling along the first navigation path; Control the target vehicle to change lanes from the positioning coordinates when the driving direction is switched to the target track point coordinates on the second navigation path; After the target vehicle reaches the target track point coordinates, the target vehicle is controlled to travel from the target track point coordinates to the preset end point coordinates along the second navigation path.
3. The vehicle navigation method according to claim 2, characterized in that: The controlling the target vehicle to change lanes from the positioning coordinates when the driving direction is switched to the target track point coordinates on the second navigation path includes: Searching for the planned trajectory of the second navigation path according to the second trajectory search range threshold; Determine the deviation-correcting driving trajectory of the target vehicle from the positioning coordinates when the driving direction is switched to the target trajectory point coordinates on the second navigation path according to the positioning coordinates when the driving direction is switched, the coordinates of each trajectory point on the planned trajectory of the second navigation path searched, the target trajectory point coordinates, and a preset trajectory correction algorithm; The target vehicle is controlled to change lanes and drive from the positioning coordinates when the driving direction is switched to the target track point coordinates on the second navigation path according to the deviation correction driving track.
4. The vehicle navigation method according to claim 2, characterized in that: The controlling the target vehicle to travel from the target track point coordinates to the preset end point coordinates according to the second navigation path includes: The planned trajectory of the second navigation path from the target trajectory point coordinates to the preset end point coordinates is searched according to the first trajectory search range threshold, and the target vehicle is controlled to travel from the target trajectory point coordinates to the preset end point coordinates according to the second navigation path.
5. The vehicle navigation method according to claim 1, characterized in that: The lane direction of the lane where the target vehicle is located is obtained according to the following steps: Determining the lane of the target vehicle in the map based on the map information obtained from the target vehicle and the positioning information of the target vehicle when the driving direction is switched; The lane direction of the lane where the target vehicle is located in the map is determined as the lane direction of the lane where the target vehicle is located.
6. The vehicle navigation method according to claim 4, characterized in that: The determining whether the target vehicle is in a wrong-way state based on the lane direction of the lane where the target vehicle is located and the heading angle of the target vehicle includes: Determining a heading angle of the target vehicle according to the second driving direction; Calculating an angle difference between the heading angle of the target vehicle and the lane direction of the lane where the target vehicle is located; If the angle difference is greater than a preset angle threshold, it is determined that the target vehicle is in a wrong direction state; If the angle difference is less than or equal to a preset angle threshold, it is determined that the target vehicle is not in a wrong direction state.
7. The vehicle navigation method according to claim 1, characterized in that: After determining whether the target vehicle is in a wrong-way state based on the lane direction of the lane where the target vehicle is located and the heading angle of the target vehicle, the method further includes: If not, it is determined that the target vehicle does not need to re-plan the navigation path, and the target vehicle is controlled to continue traveling along the first navigation path.
8. A vehicle navigation device, characterized in that: Applied to an autonomous driving vehicle, the vehicle navigation device comprises: an execution module, configured to switch the target vehicle's driving direction from the first driving direction to a second driving direction if a driving direction switching instruction is received during the process of controlling the target vehicle to drive along a first navigation path; the first navigation path is a navigation path determined based on preset end point coordinates and a preset first trajectory planning range threshold; the second driving direction is opposite to the first driving direction; A judgment module, used to determine whether the target vehicle is in a wrong direction based on the lane direction of the lane where the target vehicle is located and the heading angle of the target vehicle; A first determining module is used to transform the positioning coordinates of the target vehicle when the driving direction is switched to an adjacent reverse lane, and determine the transformed positioning coordinates as the starting point coordinates of the second navigation path of the target vehicle; A second determination module is used to determine the second navigation path of the target vehicle based on the starting point coordinates of the second navigation path, the preset end point coordinates and a preset second trajectory planning range threshold, and control the target vehicle to travel along the second navigation path; wherein the second trajectory planning range threshold is greater than the first trajectory planning range threshold.
9. An electronic device, 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 through the bus, and the machine-readable instructions are executed by the processor to execute the steps of the vehicle navigation method as described in any one of claims 1 to 7.
10. A computer-readable storage medium, characterized in that: The computer-readable storage medium stores a computer program, and when the computer program is executed by a processor, the steps of the vehicle navigation method according to any one of claims 1 to 7 are executed.
