A navigation method and device for unmanned vehicle and unmanned vehicle
By obtaining the speed and distance of the vehicle ahead and combining road conditions information, optimizing the navigation strategy of unmanned vehicles, the problem of not considering the speed of obstacles in the existing technology is solved, and efficient driving on multi-lane roads is achieved.
Patent Information
- Application Number
- CN202110317757.3
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2021-03-24
- Publication Date
- 2024-12-06
- Estimated Expiration
- 2041-03-24
AI Technical Summary
The existing unmanned vehicle navigation strategies do not take into account the speed of obstacles in complex traffic environments, resulting in reduced driving efficiency on multi-lane roads.
By obtaining the speed and distance of our vehicle and the vehicle ahead, combining the minimum turning radius and minimum turning angular speed, calculate the turning time, and determine whether the lane change conditions are met, select a suitable lane to change lanes, adjust the speed to adapt to road conditions, and optimize driving path.
It effectively improves the driving efficiency of unmanned vehicles on multi-lane roads, shortens driving time, and avoids the influence of vehicles ahead by dynamically adjusting lanes and speed.
Smart Images

Figure CN113074746B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of unmanned driving technology, and in particular to a navigation method and device for an unmanned vehicle and an unmanned vehicle. Background Art
[0002] At present, the application of unmanned driving technology in ground vehicles has gradually matured. Unmanned driving technology is efficient, safe, and can increase the service life of vehicles. Vehicle navigation is an important part of unmanned driving technology.
[0003] During the driving process, the unmanned vehicle will encounter various obstacles, such as pedestrians, cars, bicycles, and barriers. The unmanned vehicle needs to make different navigation strategies according to the road conditions and the type and distance of obstacles.
[0004] In the process of implementing the embodiments of the present invention, the inventors found that the related technology has at least the following problems: facing the complex traffic environment, the existing unmanned vehicle navigation strategy does not take the speed of obstacles into consideration, which reduces the driving efficiency of the unmanned vehicle on multi-lane roads. Summary of the invention
[0005] The embodiments of the present invention aim to provide a navigation method and device for an unmanned vehicle, and an unmanned vehicle, mainly to solve the technical problem that in the face of complex traffic environments, the existing unmanned vehicle navigation strategy does not take the speed of obstacles into consideration, thereby reducing the driving efficiency of the unmanned vehicle on multi-lane roads.
[0006] To achieve the above object, according to one aspect of the present invention, a navigation method for an unmanned vehicle is provided, which is applied to the unmanned vehicle and comprises:
[0007] Obtaining a first speed of the own vehicle, a distance between the own vehicle and a front vehicle, and a second speed of the front vehicle;
[0008] determining that the second speed is less than a preset threshold;
[0009] Calculating a turning duration according to the minimum turning radius and the minimum turning angular velocity;
[0010] Make sure there are no other vehicles in the left lane of the said vehicle;
[0011] Determine whether lane change conditions are met;
[0012] If the conditions are met, the lane change is executed from the current lane to the left lane;
[0013] If not, determine whether there are other vehicles driving in the right lane of the vehicle;
[0014] If not, executing a lane change from the current lane to the right lane, and adjusting the first speed to the speed limit range of the right lane;
[0015] If so, the first speed is adjusted to be equal to the second speed.
[0016] Optionally, the turning duration is:
[0017]
[0018] Among them, t is the turning time, R is the minimum turning radius, W is the preset road width, and the minimum turning angular velocity is ω.
[0019] Optionally, the lane change condition is:
[0020] d≥(v 1 -v 2 )*t,
[0021] Where, t is the turning time, d is the distance between our vehicle and the vehicle in front, and v 1 is the first speed, v 2 The second speed.
[0022] Optionally, the step of determining that there is no other vehicle traveling in the left lane of the vehicle includes:
[0023] Determining that there is a left lane to the left of the own vehicle;
[0024] Determine whether there are other vehicles in the left lane of the own vehicle;
[0025] If not, it is determined that there are no other vehicles driving in the lane to the left of our vehicle.
[0026] Optionally, the step of determining that there is no other vehicle traveling in the lane to the right of the vehicle includes:
[0027] Determining that there is a right lane to the right of the said own vehicle;
[0028] Determine whether there are other vehicles in the right lane of the own vehicle;
[0029] If not, it is determined that there are no other vehicles driving in the lane to the right of our vehicle.
[0030] According to another aspect of the present invention, a navigation device for an unmanned vehicle is provided, which is applied to the unmanned vehicle and includes:
[0031] An acquisition module, used for acquiring a first speed of the own vehicle, a distance between the own vehicle and a front vehicle, and a second speed of the front vehicle;
[0032] A first determining module, configured to determine that the second speed is less than a preset threshold;
[0033] A calculation module, used for calculating the turning time according to the minimum turning radius and the minimum turning angular velocity;
[0034] The second determination module is used to determine that there are no other vehicles in the left lane of the own vehicle;
[0035] A first judgment module is used to judge whether the current road condition meets the lane change condition;
[0036] A first execution module, used for executing a lane change from a current lane to a left lane;
[0037] The second judgment module is used to judge whether there are other vehicles driving in the right lane of the vehicle;
[0038] A second execution module, used for executing a lane change from the current lane to the right lane, and adjusting the first speed to a speed limit range of the right lane;
[0039] The adjustment module is used to adjust the first speed to be equal to the second speed.
[0040] Optionally, the second determination module specifically includes a first determination unit, a first judgment unit and a second determination unit. The first determination unit is used to determine whether there is a left lane on the left side of our vehicle; the first judgment unit is used to determine whether there are other vehicles in the left lane of our vehicle; the second determination unit is used to determine whether there are no other vehicles driving in the left lane of our vehicle.
[0041] Optionally, the second judgment module specifically includes a third determination unit, a second judgment unit and a fourth determination unit, the third determination unit is used to determine whether there is a right lane to the right of our vehicle; the second judgment unit is used to determine whether there are other vehicles in the right lane of our vehicle; the fourth determination unit is used to determine whether there are no other vehicles driving in the right lane of our vehicle.
[0042] According to another aspect of the present invention, there is provided an unmanned vehicle, comprising:
[0043] at least one processor;
[0044] a memory communicatively coupled to the at least one processor;
[0045] Among them, the memory stores instructions that can be executed by the at least one processor, and the instructions are executed by the at least one processor so that the at least one processor can execute any one of the above-mentioned unmanned vehicle navigation methods.
[0046] Compared with the prior art, the unmanned vehicle navigation method provided by the embodiment of the present invention, during driving on a multi-lane road, obtains the driving speed of the vehicle in front and the distance between our vehicle and the vehicle in front, and combines the road condition information of the left and right lanes to select the optimal driving path suitable for our vehicle to complete the work task, and then changes lanes according to the road condition information to complete the corresponding driving task more effectively. BRIEF DESCRIPTION OF THE DRAWINGS
[0047] One or more embodiments are exemplarily described by pictures in the corresponding drawings, and these exemplified descriptions do not constitute limitations on the embodiments. Elements with the same reference numerals in the drawings represent similar elements, and unless otherwise stated, the figures in the drawings do not constitute proportional limitations.
[0048] Figure 1 A flowchart of a navigation method provided by an embodiment of the present invention;
[0049] Figure 2 This is a schematic diagram of an unmanned vehicle changing lanes to the left lane;
[0050] Figure 3 yes Figure 1 Schematic diagram of the process of S40;
[0051] Figure 4 for Figure 1 Schematic diagram of the process flow of S70;
[0052] Figure 5 An example diagram of a navigation device in an embodiment of the present invention;
[0053] Figure 6 A structural block diagram of an unmanned vehicle provided in another embodiment of the present invention. DETAILED DESCRIPTION
[0054] In order to make the purpose, technical solution and advantages of the present invention more clearly understood, the present invention is further described in detail below in conjunction with the accompanying drawings and embodiments. It should be understood that the specific embodiments described herein are only used to explain the present invention and are not used to limit the present invention.
[0055] It should be noted that, if there is no conflict, the various features in the embodiments of the present invention can be combined with each other, and all are within the protection scope of the present invention. In addition, although the functional modules are divided in the device schematic diagram and the logical order is shown in the flow chart, in some cases, the steps shown or described can be performed in a different order from the module division in the device schematic diagram or the order in the flow chart.
[0056] In addition, the technical features involved in different embodiments of the present invention described below can be combined with each other as long as they do not conflict with each other.
[0057] An embodiment of the present invention provides a navigation method for an unmanned vehicle. When the unmanned vehicle is traveling on a multi-lane road, if the driving speed of the vehicle in front is low, the method obtains information such as the speed of our vehicle, the distance between our vehicle and the vehicle in front, and the speed of the vehicle in front; our vehicle selects the optimal driving path suitable for our vehicle to complete the work task based on the road condition information and preset lane changing conditions, and then changes lanes based on the road condition information to more effectively complete the corresponding driving task.
[0058] The target vehicle of the disclosed embodiment may be any unmanned vehicle, such as a cleaning vehicle, a logistics vehicle, a shuttle vehicle, and the like.
[0059] See also Figure 1 , an embodiment of the present invention provides a navigation method for an unmanned vehicle, the method can be executed by the unmanned vehicle, and includes the following steps:
[0060] S10. Obtain a first speed of the own vehicle, a distance between the own vehicle and a front vehicle, and a second speed of the front vehicle.
[0061] Specifically, the first speed is obtained by a wheel speed meter installed on the vehicle of the party, and the first speed is v 1 The laser radar installed on our vehicle obtains the relative position of the vehicle in front and our vehicle, and obtains the distance between our vehicle and the vehicle in front according to the relative position, which is recorded as d. The laser radar installed on our vehicle obtains the displacement of the vehicle in front within a preset time interval, and obtains the second speed, which is v 2 .
[0062] S20, determining that the second speed is less than a preset threshold;
[0063] When the speed of the vehicle in front, that is, the second speed, is less than the preset threshold, it indicates that the vehicle in front is traveling at a low speed or is stopped. In order to maintain driving efficiency and avoid being affected by the vehicle in front, our vehicle needs to select a new driving path and avoid the vehicle in front by changing lanes to other lanes.
[0064] S30: Calculate turning duration according to the minimum turning radius and the minimum turning angular velocity.
[0065] like Figure 2 As shown, the turning time is:
[0066]
[0067] Among them, t is the turning time, R is the minimum turning radius, W is the preset road width, and the minimum turning angular velocity is ω.
[0068] The minimum turning radius refers to the radius of the track circle that the center of the outer steering wheel rolls on the supporting plane when the steering wheel is turned to the extreme position and the car is turning at the lowest stable speed. The minimum turning radius is R. The minimum turning angular velocity is ω.
[0069] When our vehicle is traveling in the middle lane and the vehicle ahead is traveling at a lower speed or has stopped, our vehicle needs to change lanes to avoid it. During the avoidance process, the minimum turning time t can be calculated by dividing the turning angle θ by the minimum turning angular velocity ω.
[0070] The turning angle
[0071] It should be noted that: since the parameter used to calculate the turning angle is the preset road width rather than the vehicle width, and the road width is obviously much larger than the vehicle width, a larger gap is reserved during this turning process to prevent collision between the front and rear vehicles.
[0072] S40: Determine that there is no other vehicle traveling in the lane to the left of the vehicle.
[0073] When our vehicle needs to change lanes to overtake the vehicle ahead, we will give priority to changing lanes to the left lane. Because the left lane is a high-speed lane, its upper limit of allowed speed is greater than that of the middle lane. When our vehicle is traveling at a high speed, we can change lanes to the left lane without slowing down again or judging whether to slow down.
[0074] Specifically, Figure 3 As shown, it shows a sub-process of S40, and S40 further includes:
[0075] S41: Determine that there is a left lane on the left side of the own vehicle;
[0076] S42: Determine whether there is another vehicle in the left lane of the own vehicle;
[0077] S43: If not, it is determined that there is no other vehicle driving in the left lane of our vehicle.
[0078] S50: Determine whether a lane change condition is met.
[0079] The lane change conditions are:
[0080] d≥(v 1 -v 2 )*t,
[0081] Where, t is the turning time, d is the distance between our vehicle and the vehicle in front, and v 1 is the first speed, v 2 The second speed.
[0082] t is the turning time, the difference between the first speed and the second speed is the speed difference between the own vehicle and the vehicle in front, and the product of the turning time and the speed difference is the safe distance required for lane change. When the distance d between the own vehicle and the vehicle in front is greater than the safe distance, the own vehicle can change lanes without changing the speed.
[0083] S60: If the conditions are met, change lane from the current lane to the left lane.
[0084] S70: If not satisfied, determine whether there are other vehicles traveling in the lane on the right side of the vehicle.
[0085] Specifically, Figure 4 As shown, it shows a sub-process of S70, and S70 further includes:
[0086] S71: Determine that there is a right lane on the right side of the own vehicle;
[0087] S72: Determine whether there is another vehicle in the right lane of the own vehicle;
[0088] S73: If not, determine that no other vehicle is traveling in the lane to the right of our vehicle.
[0089] S80: If not, change lanes from the current lane to the right lane, and adjust the first speed to the speed limit range of the right lane.
[0090] S90: If yes, adjust the first speed to be equal to the second speed.
[0091] Compared with the prior art, the unmanned vehicle navigation method provided by the embodiment of the present invention, during driving on a multi-lane road, obtains the driving speed of the vehicle in front and the distance between our vehicle and the vehicle in front, and combines the road condition information of the left and right lanes to select the optimal driving path suitable for our vehicle to complete the work task, and then changes lanes according to the road condition information to complete the corresponding driving task more effectively.
[0092] When the vehicle ahead is driving at a low speed or stopped, our vehicle must first determine whether there are other vehicles in the right lane near our vehicle. If not, we will prioritize changing lanes to the right lane. If there are other vehicles, we will reduce our speed to the same speed as the vehicle ahead. Through the above decision-making method, unmanned vehicles can drive faster and more efficiently on multi-lane roads, shortening driving time.
[0093] It should be noted that in the above method embodiments, there is not necessarily a certain order between the above steps. A person skilled in the art can understand, based on the description of the embodiments of the present invention, that in different embodiments, the above steps may have different execution orders, that is, they may be executed in parallel, or may be executed interchangeably, etc.
[0094] See also Figure 5 As another aspect of the embodiment of the present invention, the embodiment of the present invention provides a navigation device 10 for an unmanned vehicle, which is applied to an unmanned vehicle. The navigation device 10 for the unmanned vehicle includes:
[0095] The acquisition module 11 is used to acquire a first speed of the own vehicle, a distance between the own vehicle and a front vehicle, and a second speed of the front vehicle.
[0096] The first determining module 12 is configured to determine whether the second speed is less than a preset threshold.
[0097] The calculation module 13 is used to calculate the turning duration according to the minimum turning radius and the minimum turning angular velocity.
[0098] The second determining module 14 is used to determine that there is no other vehicle in the left lane of the own vehicle.
[0099] Optionally, the second determination module 14 specifically includes a first determination unit, a first judgment unit and a second determination unit. The first determination unit is used to determine whether there is a left lane on the left side of our vehicle; the first judgment unit is used to determine whether there are other vehicles in the left lane of our vehicle; the second determination unit is used to determine whether there are no other vehicles driving in the left lane of our vehicle.
[0100] The first judgment module 15 is used to judge whether the lane change condition is met. The lane change condition is:
[0101] d≥(v 1 -v 2 )*t,
[0102] Where, t is the turning time, d is the distance between our vehicle and the vehicle in front, and v 1 is the first speed, v 2 The second speed.
[0103] The first execution module 16 is used for executing lane change from the current lane to the left lane.
[0104] The second judging module 17 is used to judge whether there are other vehicles driving in the right lane of the own vehicle.
[0105] Optionally, the second judgment module 17 specifically includes a third determination unit, a second judgment unit and a fourth determination unit, the third determination unit is used to determine whether there is a right lane to the right of our vehicle; the second judgment unit is used to determine whether there are other vehicles in the right lane of our vehicle; the fourth determination unit is used to determine whether there are no other vehicles driving in the right lane of our vehicle.
[0106] The second execution module 18 is used to execute a lane change from the current lane to the right lane and adjust the first speed to a speed limit range of the right lane.
[0107] The adjustment module 19 is used to adjust the first speed to be equal to the second speed.
[0108] See also Figure 6 An embodiment of the present invention provides an unmanned vehicle 20, comprising: at least one processor 21, a memory 22 communicatively connected to the at least one processor 21, and a communication module 23 for establishing a communication connection.
[0109] The memory 22 stores instructions that can be executed by the at least one processor 21, and the instructions are executed by the at least one processor 21 so that the at least one processor can execute any one of the methods in the above method embodiments, for example, execute the method steps S10, S20, S30, etc. described above, to achieve Figure 5 The functions of modules 11, 12, and 13 in .
[0110] The processor 21, the memory 22 and the communication module 23 establish a communication connection between any two of them through a bus.
[0111] The processor 21 may be any type of control chip with one or more processing cores, which can perform single-thread or multi-thread operations, and is used to parse instructions to perform operations such as acquiring data, performing logical operations, and issuing operation results.
[0112] The memory 22 is a non-transient computer-readable storage medium that can be used to store non-transient software programs, non-transient computer executable programs and modules, such as program instructions / modules corresponding to the navigation method in the embodiment of the present invention. The processor 21 runs the non-transient software programs, instructions and modules stored in the memory 22, thereby implementing various functional applications and data processing of the navigation device 10, that is, realizing the navigation method in any of the above method embodiments.
[0113] The memory 22 may include a program storage area and a data storage area, wherein the program storage area may store an operating system, an application required for at least one function; the data storage area may store data created according to the use of the navigation device 10 of the unmanned vehicle, etc. In addition, the memory 22 may include a high-speed random access memory, and may also include a non-volatile memory, such as at least one disk storage device, a flash memory device, or other non-volatile solid-state storage device. In some embodiments, the memory 22 may optionally include a memory remotely arranged relative to the processor 21, and these remote memories may be connected to the unmanned vehicle 20 via a network. Examples of the above-mentioned network include, but are not limited to, the Internet, an intranet, a local area network, a mobile communication network, and combinations thereof.
[0114] For other components of the unmanned vehicle, reference may be made to the unmanned vehicle in the prior art in the art.
[0115] Finally, it should be noted that the above embodiments are only used to illustrate the technical solutions of the present invention, rather than to limit them. Under the concept of the present invention, the technical features in the above embodiments or different embodiments may also be combined, the steps may be implemented in any order, and there are many other changes in different aspects of the present invention as described above, which are not provided in detail for the sake of simplicity. Although the present invention has been described in detail with reference to the aforementioned embodiments, those skilled in the art should understand that they may still modify the technical solutions described in the aforementioned embodiments, or make equivalent replacements for some of the technical features therein. However, these modifications or replacements do not deviate the essence of the corresponding technical solutions from the scope of the technical solutions of the embodiments of the present invention.
Claims
1. A navigation method for an unmanned vehicle, applied to an unmanned vehicle, characterized in that: include: Obtaining a first speed of the own vehicle, a distance between the own vehicle and a front vehicle, and a second speed of the front vehicle; determining that the second speed is less than a preset threshold; Calculate the turning time based on the minimum turning radius and minimum turning angular velocity; Make sure there are no other vehicles in the left lane of the said vehicle; Determine whether lane change conditions are met; If the conditions are met, the lane change is executed from the current lane to the left lane; If not, determine whether there are other vehicles driving in the right lane of the vehicle; If not, executing a lane change from the current lane to the right lane, and adjusting the first speed to the speed limit range of the right lane; If so, adjusting the first speed to be equal to the second speed; The turning time is: , in, is the turning time, is the minimum turning radius, is the preset road width, and the minimum turning angular velocity is ; The lane change condition is: , in, is the turning time, is the distance between the own vehicle and the vehicle in front, is the first speed, The second speed.
2. The navigation method according to claim 1, characterized in that: The step of determining that there is no other vehicle driving in the left lane of our vehicle includes: Determining that there is a left lane to the left of the own vehicle; Determine whether there are other vehicles in the left lane of the own vehicle; If not, it is determined that there are no other vehicles driving in the lane to the left of our vehicle.
3. The navigation method according to claim 1, characterized in that: The step of determining that there is no other vehicle driving in the right lane of our vehicle includes: Determining that there is a right lane to the right of the said own vehicle; Determine whether there are other vehicles in the right lane of the own vehicle; If not, it is determined that there are no other vehicles driving in the lane to the right of our vehicle.
4. A navigation device for an unmanned vehicle, applied to an unmanned vehicle, characterized in that: include: An acquisition module, used for acquiring a first speed of the own vehicle, a distance between the own vehicle and a front vehicle, and a second speed of the front vehicle; A first determining module, configured to determine that the second speed is less than a preset threshold; A calculation module, used for calculating the turning time according to the minimum turning radius and the minimum turning angular velocity; The second determination module is used to determine that there are no other vehicles in the left lane of the own vehicle; A first judgment module, used to judge whether a lane change condition is met; A first execution module, used for executing a lane change from a current lane to a left lane; The second judgment module is used to judge whether there are other vehicles driving in the right lane of the vehicle; A second execution module, used for executing a lane change from the current lane to the right lane, and adjusting the first speed to a speed limit range of the right lane; An adjustment module for adjusting the first speed to be equal to the second speed; Determine whether lane change conditions are met; If the conditions are met, the lane change is executed from the current lane to the left lane; If not, determine whether there are other vehicles driving in the right lane of the vehicle; If not, executing a lane change from the current lane to the right lane, and adjusting the first speed to the speed limit range of the right lane; If so, adjusting the first speed to be equal to the second speed; The turning time is: , in, is the turning time, is the minimum turning radius, is the preset road width, and the minimum turning angular velocity is ; The lane change condition is: , in, is the turning time, is the distance between the own vehicle and the vehicle in front, is the first speed, The second speed.
5. The navigation device according to claim 4, characterized in that: The second determination module specifically includes a first determination unit, a first judgment unit, and a second determination unit, wherein the first determination unit is used to determine whether there is a left lane on the left side of the own vehicle; the first judgment unit is used to determine whether there are other vehicles in the left lane of the own vehicle; The second determining unit is used to determine that there is no other vehicle driving in the left lane of the own vehicle.
6. The navigation device according to claim 5, characterized in that: The second judgment module specifically includes a third determination unit, a second determination unit and a fourth determination unit. The third determination unit is used to determine whether there is a right lane to the right of our vehicle; the second judgment unit is used to determine whether there are other vehicles in the right lane of our vehicle; and the fourth determination unit is used to determine whether there are no other vehicles driving in the right lane of our vehicle.
7. An unmanned vehicle, characterized in that: include: at least one processor; a memory communicatively coupled to the at least one processor; The memory stores instructions that can be executed by the at least one processor, and the instructions are executed by the at least one processor so that the at least one processor can execute the method according to any one of claims 1 to 3.
