A path planning method, device and storage medium
By automatically determining the minimum turning and passing parameters of the vehicle, and determining the transportation path of the ultra-long towed vehicle, the problems of low efficiency and poor accuracy in the prior art are solved, and more efficient and safer transportation path planning is achieved.
Patent Information
- Application Number
- CN202110989329.5
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2021-08-26
- Publication Date
- 2024-11-15
- Estimated Expiration
- 2041-08-26
AI Technical Summary
In the prior art, the long-distance transportation route planning of ultra-long tow vehicles relies on manual experience, has low efficiency and poor accuracy, making it difficult to ensure the reliability and safety of transportation.
By determining the minimum turning radius and minimum passing width of the vehicle, as well as the minimum turning radius and road width of the path to be planned at the maximum turning point, it is automatically judged whether the vehicle can pass the path, thereby determining the target path.
It improves the efficiency and accuracy of path planning, ensures vehicle passability, and completes path planning in a timely and accurate manner, improving transportation reliability and safety.
Smart Images

Figure CN113776549B_ABST
Abstract
Description
Technical Field
[0001] The present application belongs to the field of intelligent transportation technology, and in particular, relates to a path planning method, device and storage medium. Background Art
[0002] With the rapid development and increasing construction efforts of my country's power, energy, chemical, building materials and other industries, the number of large-scale equipment that needs to be transported in related large-scale projects has also increased. These large-scale equipment are mainly transported by road, and the transportation distance is generally long. At present, large flatbed trailers or trailers are basically used, and even bridge trailers are used to separate two sets of flatbed trailers front and back to meet the transportation needs of large equipment.
[0003] However, such trailer vehicles are extremely high, long and heavy, making steering extremely inconvenient. In this case, in order to ensure the reliability and safety of such trailer vehicles in long-distance transportation, it is necessary to judge the road passability of the vehicle in advance when planning the transportation route.
[0004] In the prior art, when planning long-distance transport routes for extra-long trailer vehicles, most of the routes are planned, surveyed and mapped based on manual experience. However, this method is inefficient in route planning, time-consuming and labor-intensive, and has low accuracy. Summary of the invention
[0005] The present application provides a path planning method, device and storage medium for solving the problem of poor path planning effect.
[0006] In order to achieve the above objectives, this application adopts the following technical solutions:
[0007] In a first aspect, a path planning method is provided, including: determining a first turning radius and a first passing width, and determining a second turning radius and a second passing width. Since the first turning radius is the minimum turning radius of the vehicle, the first passing width is the minimum passing width of the vehicle, the second turning radius is the minimum turning radius of the path to be planned at the maximum turning point, and the second passing width is the road width of the path to be planned at the maximum turning point, therefore, when the first turning radius is less than or equal to the second turning radius, and the first passing width is less than or equal to the second passing width, the path to be planned can be determined to be the target path.
[0008] Optionally, the method for determining the first turning radius and the first passing width specifically includes:
[0009] Obtain the wheelbase and maximum front wheel deflection angle of the vehicle; determine the first turning radius according to the wheelbase of the vehicle and the maximum front wheel deflection angle of the vehicle; the wheelbase of the vehicle, the maximum front wheel deflection angle of the vehicle and the first turning radius satisfy the first formula; the first formula is:
[0010]
[0011] Wherein, r1 is the first turning radius, l is the wheelbase of the vehicle, and θ is the maximum deflection angle of the front wheels of the vehicle; the body width, wheelbase and front overhang length of the vehicle are obtained; the first passing width is determined according to the wheelbase of the vehicle, the maximum deflection angle of the front wheels of the vehicle, the first turning radius, the body width of the vehicle, the wheelbase of the vehicle and the front overhang length of the vehicle; the body width of the vehicle, the wheelbase of the vehicle, the front overhang length of the vehicle, the wheelbase of the vehicle, the maximum deflection angle of the front wheels of the vehicle, the first turning radius and the first passing width satisfy the second formula; the second formula is:
[0012]
[0013] Among them, b is the body width of the vehicle, m is the wheelbase of the vehicle, d is the front overhang length of the vehicle, and w1 is the first passing width.
[0014] Optionally, a specific method for determining the second turning radius and the second passing width includes:
[0015] Acquire multiple road curvatures at multiple turning points of the path to be planned; multiple turning points correspond to multiple road curvatures one by one; determine the turning point with the largest curvature among the multiple road curvatures as the maximum turning point; determine the second turning radius according to the road curvature of the maximum turning point; the road curvature of the maximum turning point and the second turning radius satisfy the third formula; the third formula is:
[0016]
[0017] Wherein, r2 is the second turning radius, K is the road curvature of the maximum turning point; the road width at the maximum turning point is obtained, and the obtained road width at the maximum turning point is used as the second passing width.
[0018] Optionally, when the vehicle is a trailer, the trailer includes a tractor and a trailer; the specific method for determining the first turning radius and the first passing width includes:
[0019] The wheelbase of the tractor and the maximum deflection angle of the front wheels of the tractor are obtained; according to the wheelbase of the tractor and the maximum deflection angle of the front wheels of the tractor, the minimum turning radius of the tractor is determined as the first turning radius; the body width of the tractor, the wheelbase of the tractor, the front overhang length of the tractor and the wheelbase of the trailer are obtained; the path steering angle of the trailer at the maximum turning point, the initial forward direction angle of the tractor, the initial forward direction angle of the trailer and the driving speed of the trailer are determined; according to the wheelbase of the tractor, the maximum deflection angle of the front wheels of the tractor, the body width of the tractor, the wheelbase of the tractor, the front overhang length of the tractor, the wheelbase of the trailer, the initial forward direction angle of the tractor, the initial forward direction angle of the trailer and the driving speed of the trailer, the minimum passing width at multiple turning angles of the trailer is determined; from the minimum passing widths of the trailer at multiple turning angles, the minimum passing width corresponding to the path steering angle is selected and determined as the first passing width.
[0020] Optionally, the specific method for determining the path steering angle of the trailer at the maximum turning point, the initial forward direction angle of the tractor, the initial forward direction angle of the trailer, and the driving speed of the trailer includes:
[0021] At least one road curvature on the path entering the maximum turning point is obtained; at least one road curvature on the path entering the maximum turning point corresponds to at least one entry point in one-to-one correspondence; at least one road curvature on the path exiting the maximum turning point corresponds to at least one exit point in one-to-one correspondence; when the road curvature of a target entry point among at least one entry point is less than or equal to a preset curvature, and the road curvature of a target exit point among at least one exit point is less than or equal to a preset curvature, the heading of the target entry point and the heading of the target exit point are obtained; according to the heading of the target entry point and the heading of the target exit point, the path steering angle of the trailer at the maximum turning point is determined; the heading of the target entry point, the heading of the target exit point and the path steering angle satisfy a fourth formula; the fourth formula is:
[0022] β=|∠A-∠B|;
[0023] Among them, β is the path steering angle of the trailer at the maximum turning point, ∠A is the heading of the target entry point, and ∠B is the heading of the target exit point; the heading of the target entry point is determined as the initial forward direction angle of the tractor and the initial forward direction angle of the trailer; the preset driving speed is obtained, and the obtained preset driving speed is used as the driving speed of the trailer.
[0024] Optionally, a specific method for determining a minimum pass width set at multiple heading angles of the trailer according to the wheelbase of the tractor, the maximum deflection angle of the front wheels of the tractor, the body width of the tractor, the wheelbase of the tractor, the front overhang length of the tractor, the wheelbase of the trailer, the initial heading angle of the tractor, the initial heading angle of the trailer, and the driving speed of the trailer includes:
[0025] A first operation is performed for each of the multiple steering angles to obtain a minimum passing width at the multiple steering angles of the trailer; the first operation is: based on the wheelbase of the tractor, the maximum deflection angle of the front wheels of the tractor, the body width of the tractor, the wheelbase of the tractor, the front overhang length of the tractor, the wheelbase of the trailer, the initial forward direction angle of the tractor, the initial forward direction angle of the trailer and the driving speed of the trailer, a minimum passing width set at the multiple forward direction angles of the trailer is determined, and the minimum passing width with the largest value is selected from the minimum passing width set to determine it as the minimum passing width of the trailer at the target steering angle; the minimum forward direction angle of the multiple forward direction angles of the trailer is the initial forward direction angle of the tractor; the difference between the maximum forward direction angle of the multiple forward direction angles of the trailer and the initial forward direction angle of the tractor is equal to the target steering angle; the target steering angle is any one of the multiple steering angles.
[0026] Optionally, based on the wheelbase of the tractor, the maximum deflection angle of the front wheels of the tractor, the body width of the tractor, the wheelbase of the tractor, the front overhang length of the tractor, the wheelbase of the trailer, the initial forward direction angle of the tractor, the initial forward direction angle of the trailer, and the driving speed of the trailer, a specific method for determining the minimum pass width set at multiple forward direction angles of the trailer includes:
[0027] Based on the wheelbase of the tractor, the maximum deflection angle of the front wheels of the tractor, the wheelbase of the trailer, the driving speed of the towing vehicle, the current heading angle of the tractor and the current heading angle of the trailer, determine the difference between the current heading angle of the tractor and the current heading angle of the trailer, and determine the difference as the current heading angle difference corresponding to the current heading angle of the towing vehicle; determine the next heading angle of the tractor adjacent to the current heading angle of the tractor, and the next heading angle of the trailer adjacent to the current heading angle of the trailer, until multiple current heading angle differences corresponding to multiple heading angles of the towing vehicle are determined; the current heading angle of the towing vehicle is the same as the current heading angle of the tractor; The initial forward direction angle of the current forward direction angle of the tractor is the initial forward direction angle of the tractor; the initial forward direction angle of the current forward direction angle of the trailer is the initial forward direction angle of the trailer; a second operation is performed on multiple current forward direction angle differences, the wheelbase of the tractor, the maximum deflection angle of the front wheels of the tractor, the body width of the tractor, the wheelbase of the tractor, the front overhang length of the tractor and the wheelbase of the trailer to obtain a minimum passing width set; the second operation includes: determining the minimum passing width under the current forward direction angle of the trailer according to the current forward direction angle difference, the wheelbase of the tractor, the maximum deflection angle of the front wheels of the tractor, the body width of the tractor, the wheelbase of the tractor, the front overhang length of the tractor and the wheelbase of the trailer.
[0028] Optionally, the current forward direction angle of the tractor, the current forward direction angle of the trailer, and the difference between the current forward direction angles satisfy a fifth formula; the fifth formula is:
[0029] γ=θ1-θ0;
[0030] Among them, γ is the current forward direction angle difference, θ0 is the current forward direction angle of the tractor, and θ1 is the current forward direction angle of the trailer;
[0031] The wheelbase of the tractor, the maximum deflection angle of the front wheels of the tractor, the driving speed of the trailer, the current forward direction angle of the tractor and the next forward direction angle of the tractor satisfy the sixth formula; the sixth formula is:
[0032]
[0033] Among them, l1 is the wheelbase of the tractor, α is the maximum deflection angle of the front wheel of the tractor, v is the speed of the trailer, and θ 0+t is the next forward direction angle of the tractor;
[0034] The wheelbase of the trailer, the speed of the towing vehicle, the current forward direction angle of the tractor, the current forward direction angle of the trailer and the next forward direction angle of the trailer satisfy the seventh formula; the seventh formula is:
[0035]
[0036] Where l2 is the wheelbase of the trailer, θ 1+t is the next forward direction angle of the trailer, θ1 is the current forward direction angle of the trailer;
[0037] The current forward direction angle difference, the wheelbase of the tractor, the maximum deflection angle of the front wheels of the tractor, the body width of the tractor, the wheelbase of the tractor, the front overhang length of the tractor, the wheelbase of the trailer, and the minimum passing width at the current forward direction angle of the trailer satisfy the eighth formula; the eighth formula is:
[0038]
[0039] Among them, b1 is the body width of the tractor, m1 is the wheelbase of the tractor, d1 is the front overhang length of the tractor, and w2 is the minimum passing width under the current forward direction angle of the trailer.
[0040] Optionally, when there are multiple paths to be planned, a specific method for determining the path to be planned as the target path includes:
[0041] Acquire multiple road data corresponding to multiple paths to be planned; determine multiple travel costs corresponding to multiple paths to be planned based on the multiple road data and the weights corresponding to each road data; select the path to be planned corresponding to the travel cost that meets the preset conditions from the multiple travel costs, and determine the selected path to be planned as the target path.
[0042] In a second aspect, a path planning device is provided, including: a processing unit; the processing unit is used to determine a first turning radius and a first passing width; the first turning radius is the minimum turning radius of the vehicle; the first passing width is the minimum passing width of the vehicle; and is also used to determine a second turning radius and a second passing width; the second turning radius is the minimum turning radius of the path to be planned at the maximum turning point; the second passing width is the road width of the path to be planned at the maximum turning point; and is also used to determine that the path to be planned is the target path when the first turning radius is less than or equal to the second turning radius and the first passing width is less than or equal to the second passing width.
[0043] Optionally, the processing unit is specifically used to: obtain the wheelbase and maximum deflection angle of the front wheels of the vehicle; determine the first turning radius according to the wheelbase of the vehicle and the maximum deflection angle of the front wheels of the vehicle; the wheelbase of the vehicle, the maximum deflection angle of the front wheels of the vehicle and the first turning radius satisfy a first formula; the first formula is:
[0044]
[0045] Wherein, r1 is the first turning radius, l is the wheelbase of the vehicle, and θ is the maximum deflection angle of the front wheels of the vehicle; the body width, wheelbase and front overhang length of the vehicle are obtained; the first passing width is determined according to the wheelbase of the vehicle, the maximum deflection angle of the front wheels of the vehicle, the first turning radius, the body width of the vehicle, the wheelbase of the vehicle and the front overhang length of the vehicle; the body width of the vehicle, the wheelbase of the vehicle, the front overhang length of the vehicle, the wheelbase of the vehicle, the maximum deflection angle of the front wheels of the vehicle, the first turning radius and the first passing width satisfy the second formula; the second formula is:
[0046]
[0047] Among them, b is the body width of the vehicle, m is the wheelbase of the vehicle, d is the front overhang length of the vehicle, and w1 is the first passing width.
[0048] Optionally, the processing unit is specifically used to: obtain multiple road curvatures at multiple turning points of the path to be planned; the multiple turning points correspond to the multiple road curvatures one by one; determine the turning point with the largest curvature among the multiple road curvatures as the maximum turning point; determine the second turning radius according to the road curvature of the maximum turning point; the road curvature of the maximum turning point and the second turning radius satisfy a third formula; the third formula is:
[0049]
[0050] Wherein, r2 is the second turning radius, K is the road curvature of the maximum turning point; the road width at the maximum turning point is obtained, and the obtained road width at the maximum turning point is used as the second passing width.
[0051] Optionally, the processing unit is specifically used to: obtain the wheelbase of the tractor and the maximum deflection angle of the front wheels of the tractor; determine the minimum turning radius of the tractor as the first turning radius based on the wheelbase of the tractor and the maximum deflection angle of the front wheels of the tractor; obtain the body width of the tractor, the wheelbase of the tractor, the front overhang length of the tractor and the wheelbase of the trailer; determine the path steering angle of the trailer at the maximum turning point, the initial forward direction angle of the tractor, the initial forward direction angle of the trailer and the driving speed of the trailer; determine the minimum passing width at multiple turning angles of the trailer based on the wheelbase of the tractor, the maximum deflection angle of the front wheels of the tractor, the body width of the tractor, the wheelbase of the tractor, the front overhang length of the tractor, the wheelbase of the trailer, the initial forward direction angle of the tractor, the initial forward direction angle of the trailer and the driving speed of the trailer; select the minimum passing width corresponding to the path steering angle from the minimum passing widths of the trailer at multiple steering angles, and determine it as the first passing width.
[0052] Optionally, the processing unit is specifically used to: obtain at least one road curvature on the path entering the maximum turning point; at least one road curvature on the path entering the maximum turning point corresponds to at least one entry point; obtain at least one road curvature on the path exiting the maximum turning point; at least one road curvature on the path exiting the maximum turning point corresponds to at least one exit point; when the road curvature of the target entry point among the at least one entry point is less than or equal to the preset curvature, and the road curvature of the target exit point among the at least one exit point is less than or equal to the preset curvature, obtain the heading of the target entry point and the heading of the target exit point; determine the path steering angle of the trailer at the maximum turning point according to the heading of the target entry point and the heading of the target exit point; the heading of the target entry point, the heading of the target exit point and the path steering angle satisfy the fourth formula; the fourth formula is:
[0053] β=|∠A-∠B|;
[0054] Among them, β is the path steering angle of the trailer at the maximum turning point, ∠A is the heading of the target entry point, and ∠B is the heading of the target exit point; the heading of the target entry point is determined as the initial forward direction angle of the tractor and the initial forward direction angle of the trailer; the preset driving speed is obtained, and the obtained preset driving speed is used as the driving speed of the trailer.
[0055] Optionally, the processing unit is specifically used to: perform a first operation on each of the multiple steering angles to obtain the minimum passing width at the multiple steering angles of the trailer; the first operation is: based on the wheelbase of the tractor, the maximum deflection angle of the front wheels of the tractor, the body width of the tractor, the wheelbase of the tractor, the front overhang length of the tractor, the wheelbase of the trailer, the initial forward direction angle of the tractor, the initial forward direction angle of the trailer and the driving speed of the trailer, determine the minimum passing width set at the multiple forward direction angles of the trailer, and select the minimum passing width with the largest value from the minimum passing width set to determine it as the minimum passing width of the trailer at the target steering angle; the minimum forward direction angle of the multiple forward direction angles of the trailer is the initial forward direction angle of the tractor; the difference between the maximum forward direction angle of the multiple forward direction angles of the trailer and the initial forward direction angle of the tractor is equal to the target steering angle; the target steering angle is any one of the multiple steering angles.
[0056] Optionally, the processing unit is specifically used to: determine the difference between the current heading angle of the tractor and the current heading angle of the trailer based on the wheelbase of the tractor, the maximum deflection angle of the front wheels of the tractor, the wheelbase of the trailer, the driving speed of the towed vehicle, the current heading angle of the tractor and the current heading angle of the trailer, and determine the difference as the current heading angle difference corresponding to the current heading angle of the towed vehicle; determine the next heading angle of the tractor adjacent to the current heading angle of the tractor, and the next heading angle of the trailer adjacent to the current heading angle of the trailer, until multiple current heading angle differences corresponding to multiple heading angles of the towed vehicle are determined; determine the current heading angle of the trailer and the current heading angle of the tractor. The forward direction angles are the same; the initial forward direction angle of the current forward direction angle of the tractor is the initial forward direction angle of the tractor; the initial forward direction angle of the current forward direction angle of the trailer is the initial forward direction angle of the trailer; a second operation is performed on multiple current forward direction angle differences, the wheelbase of the tractor, the maximum deflection angle of the front wheels of the tractor, the body width of the tractor, the wheelbase of the tractor, the front overhang length of the tractor and the wheelbase of the trailer to obtain a minimum passing width set; the second operation includes: determining the minimum passing width under the current forward direction angle of the trailer according to the current forward direction angle difference, the wheelbase of the tractor, the maximum deflection angle of the front wheels of the tractor, the body width of the tractor, the wheelbase of the tractor, the front overhang length of the tractor and the wheelbase of the trailer.
[0057] Optionally, the current forward direction angle of the tractor, the current forward direction angle of the trailer, and the difference between the current forward direction angles satisfy a fifth formula; the fifth formula is:
[0058] γ=θ1-θ0;
[0059] Among them, γ is the current forward direction angle difference, θ0 is the current forward direction angle of the tractor, and θ1 is the current forward direction angle of the trailer;
[0060] The wheelbase of the tractor, the maximum deflection angle of the front wheels of the tractor, the driving speed of the trailer, the current forward direction angle of the tractor and the next forward direction angle of the tractor satisfy the sixth formula; the sixth formula is:
[0061]
[0062] Among them, l1 is the wheelbase of the tractor, α is the maximum deflection angle of the front wheel of the tractor, v is the speed of the trailer, and θ 0+t is the next forward direction angle of the tractor;
[0063] The wheelbase of the trailer, the speed of the towing vehicle, the current forward direction angle of the tractor, the current forward direction angle of the trailer and the next forward direction angle of the trailer satisfy the seventh formula; the seventh formula is:
[0064]
[0065] Where l2 is the wheelbase of the trailer, θ 1+t is the next forward direction angle of the trailer, θ1 is the current forward direction angle of the trailer;
[0066] The current forward direction angle difference, the wheelbase of the tractor, the maximum deflection angle of the front wheels of the tractor, the body width of the tractor, the wheelbase of the tractor, the front overhang length of the tractor, the wheelbase of the trailer, and the minimum passing width at the current forward direction angle of the trailer satisfy the eighth formula; the eighth formula is:
[0067]
[0068] Among them, b1 is the body width of the tractor, m1 is the wheelbase of the tractor, d1 is the front overhang length of the tractor, and w2 is the minimum passing width under the current forward direction angle of the trailer.
[0069] Optionally, the processing unit is specifically used to: obtain multiple road data corresponding one-to-one to multiple paths to be planned; determine multiple travel costs corresponding one-to-one to the multiple paths to be planned based on the multiple road data and the weights corresponding to each road data; select the path to be planned corresponding to the travel cost that meets preset conditions from the multiple travel costs, and determine the selected path to be planned as the target path.
[0070] In a third aspect, a path planning device is provided, comprising a memory and a processor; the memory is used to store computer execution instructions, and the processor is connected to the memory through a bus; when the path planning device is running, the processor executes the computer execution instructions stored in the memory, so that the path planning device executes any one of the optional path planning methods in the first aspect.
[0071] In a fourth aspect, a computer-readable storage medium is provided, the computer-readable storage medium comprising computer execution instructions, and when the computer execution instructions are executed on a computer, the computer executes any one of the optional path planning methods in the first aspect.
[0072] It should be noted that the above computer instructions may be stored in whole or in part on a first computer-readable storage medium, wherein the first computer-readable storage medium may be packaged together with the processor of the path planning device, or may be packaged separately from the processor of the path planning device, which is not limited in this application.
[0073] In this application, the name of the above-mentioned path planning device does not limit the device or functional module itself. In actual implementation, these devices or functional modules may appear with other names. As long as the functions of each device or functional module are similar to those of this application, they fall within the scope of the claims of this application and their equivalent technologies.
[0074] These and other aspects of the present application will become more apparent from the following description.
[0075] The technical solution provided by this application brings at least the following beneficial effects:
[0076] Based on any of the above aspects, in the present application, the path planning device can determine the minimum turning radius and minimum passing width of the vehicle, as well as the minimum turning radius and road width of the path to be planned at the maximum turning point. Therefore, when the minimum turning radius of the vehicle is less than or equal to the minimum turning radius of the path to be planned at the maximum turning point, and the minimum passing width of the vehicle is less than or equal to the minimum passing width of the path to be planned at the maximum turning point, the path to be planned can be determined as the target path, thereby ensuring the vehicle's passability while completing the path planning in a timely and accurate manner, thereby improving the effect of path planning. BRIEF DESCRIPTION OF THE DRAWINGS
[0077] Figure 1 A schematic diagram of the structure of a path planning system provided in an embodiment of the present application;
[0078] Figure 2A A schematic diagram of a hardware structure of a communication device provided in an embodiment of the present application;
[0079] Figure 2B A schematic diagram of another hardware structure of a communication device provided in an embodiment of the present application;
[0080] Figure 3 A schematic diagram of a path planning method provided in an embodiment of the present application Figure 1 ;
[0081] Figure 4A A second flowchart of a path planning method provided in an embodiment of the present application;
[0082] Figure 4B A schematic diagram of a path planning method provided in an embodiment of the present application Figure 1 ;
[0083] Figure 5 A schematic diagram of a path planning method provided in an embodiment of the present application Figure 3 ;
[0084] Fig. 6A Schematic diagram 4 of a flow chart of a path planning method provided in an embodiment of the present application;
[0085] Figure 6B A second schematic diagram of the principle of a path planning method provided in an embodiment of the present application;
[0086] Figure 6CA schematic diagram of a path planning method provided in an embodiment of the present application Figure 3 ;
[0087] Fig. 7A A schematic diagram of a path planning method provided in an embodiment of the present application Figure 5 ;
[0088] Figure 7B A fourth schematic diagram of the principle of a path planning method provided in an embodiment of the present application;
[0089] Figure 8 Schematic diagram 6 of a flow chart of a path planning method provided in an embodiment of the present application;
[0090] Fig. 9A Schematic diagram 7 of a path planning method provided in an embodiment of the present application;
[0091] Fig. 9B A schematic diagram of a path planning method provided in an embodiment of the present application Figure 5 ;
[0092] Fig.10 A schematic diagram of a path planning method provided in an embodiment of the present application Figure 8 ;
[0093] Fig.11 A schematic diagram of a process flow of a path planning device provided in an embodiment of the present application. DETAILED DESCRIPTION
[0094] The following will be combined with the drawings in the embodiments of the present application to clearly and completely describe the technical solutions in the embodiments of the present application. Obviously, the described embodiments are only part of the embodiments of the present application, not all of the embodiments. Based on the embodiments in the present application, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of this application.
[0095] It should be noted that, in the embodiments of the present application, words such as "exemplary" or "for example" are used to indicate examples, illustrations or descriptions. Any embodiment or design described as "exemplary" or "for example" in the embodiments of the present application should not be interpreted as being more preferred or more advantageous than other embodiments or designs. Specifically, the use of words such as "exemplary" or "for example" is intended to present related concepts in a specific way.
[0096] In order to facilitate a clear description of the technical solutions of the embodiments of the present application, in the embodiments of the present application, words such as "first" and "second" are used to distinguish between identical or similar items with substantially the same functions and effects. Those skilled in the art can understand that words such as "first" and "second" do not limit the quantity and order of execution.
[0097] In addition, the terms "including" and "having" in the embodiments, claims and drawings of the present application are not exclusive. For example, a process, method, system, product or device including a series of steps or modules is not limited to the listed steps or modules, and may also include steps or modules that are not listed.
[0098] As described in the background technology, currently, when planning navigation routes for large transport vehicles, especially long-distance navigation routes, the method of planning navigation routes based on manual experience cannot meet the needs. For the road transport industry, there is an urgent need for technology that can timely and accurately plan navigation routes for such vehicles to ensure the efficiency and safety of such vehicles in transporting goods.
[0099] In response to the above problems, an embodiment of the present application provides a path planning method, in which a path planning device can first determine the minimum turning radius and minimum passing width of the vehicle, and then determine the minimum turning radius and road width of the path to be planned at the maximum turning point. Therefore, when the minimum turning radius of the vehicle is less than or equal to the minimum turning radius of the path to be planned at the maximum turning point, and the minimum passing width of the vehicle is less than or equal to the minimum passing width of the path to be planned at the maximum turning point, the path to be planned can be determined as the target path, thereby ensuring the vehicle's passability while completing the path planning in a timely and accurate manner, thereby improving the effect of path planning.
[0100] The path planning method is suitable for a path planning system. Figure 1 FIG. 1 shows a structure of the path planning system 100. Figure 1 As shown, the path planning system 100 includes: a path planning device 101 and a server 102. The path planning device 101 and the server 102 are connected in communication.
[0101] Optional, Figure 1 The path planning device 101 in the present invention may be an on-board electronic device installed in the vehicle, or may be an electronic device independently provided with the vehicle and used for performing path planning for the vehicle.
[0102] Optionally, when the path planning device 101 is an electronic device that is independently set up with the vehicle and is used to plan the path for the vehicle, the electronic device can be a terminal. The terminal is a device that provides voice and / or data connectivity to the user, a handheld device with a wireless connection function, or other processing devices connected to a wireless modem. The wireless terminal can communicate with one or more core networks via a radio access network (RAN). The wireless terminal can be a mobile terminal, such as a mobile phone (or a "cellular" phone) and a computer with a mobile terminal, or a portable, pocket-sized, handheld, computer-built-in or vehicle-mounted mobile device that exchanges language and / or data with a wireless access network, such as a mobile phone, a tablet computer, a laptop computer, a netbook, a personal digital assistant (PDA). The embodiments of the present application do not impose any restrictions on this.
[0103] Optionally, when the path planning device 101 is an electronic device that is independently provided with the vehicle and is used to perform path planning for the vehicle, the electronic device may also be a server. When the electronic device is a server, the electronic device may be a functional module for performing path planning inside the server 102, or may be an independent server that is independently provided with the server 102, and this application does not specifically limit this.
[0104] For ease of understanding, this application is mainly described by taking the example of the path planning device 101 and the server 102 being independently configured.
[0105] It is easy to understand that when the path planning device 101 is a functional module inside the server 102, the communication method between the path planning device 101 and the server 102 is the communication between the internal modules of the server. In this case, the communication process between the two is the same as "the communication process between the path planning device 101 and the server 102 when they are independent of each other".
[0106] The server 102 is a server for providing path data to the path planning device 101 .
[0107] Optionally, the server 102 may be a single server, or may be a server cluster composed of multiple servers. In some implementations, the server cluster may also be a distributed cluster. The present application embodiment does not impose any limitation on this.
[0108] The basic hardware structures of the path planning device 101 and the server 102 in the path planning system 100 are similar, both of which include Figure 2A or Figure 2B The components included in the communication device shown are described below. Figure 2A and Figure 2B Taking the communication device shown as an example, the hardware structure of the path planning device 101 and the server 102 is introduced.
[0109] like Figure 2A , which is a schematic diagram of a hardware structure of a communication device provided in an embodiment of the present application. The communication device includes a processor 21, a memory 22, a communication interface 23, and a bus 24. The processor 21, the memory 22, and the communication interface 23 can be connected via a bus 24.
[0110] The processor 21 is the control center of the communication device, which can be a processor or a general term for multiple processing elements. For example, the processor 21 can be a general-purpose central processing unit (CPU) or other general-purpose processors. Among them, the general-purpose processor can be a microprocessor or any conventional processor.
[0111] As an embodiment, the processor 21 may include one or more CPUs, such as Figure 2A CPU0 and CPU1 are shown in the figure.
[0112] The memory 22 can be a read-only memory (ROM) or other type of static storage device that can store static information and instructions, a random access memory (RAM) or other type of dynamic storage device that can store information and instructions, or an electrically erasable programmable read-only memory (EEPROM), a disk storage medium or other magnetic storage device, or any other medium that can be used to carry or store desired program code in the form of instructions or data structures and can be accessed by a computer, but is not limited to these.
[0113] In a possible implementation, the memory 22 may exist independently of the processor 21, and the memory 22 may be connected to the processor 21 via a bus 24 to store instructions or program codes. When the processor 21 calls and executes the instructions or program codes stored in the memory 22, the path planning method provided in the following embodiments of the present application can be implemented.
[0114] In the embodiment of the present application, the software programs stored in the memory 22 of the path planning device 101 and the server 102 are different, so the functions implemented by the path planning device 101 and the server 102 are different. The functions performed by each device will be described in conjunction with the following flowchart.
[0115] In another possible implementation, the memory 22 may also be integrated with the processor 21 .
[0116] The communication interface 23 is used for the communication device to connect with other devices through a communication network, and the communication network may be Ethernet, wireless access network, wireless local area network (WLAN), etc. The communication interface 23 may include a receiving unit for receiving data and a scheduling unit for sending data.
[0117] The bus 24 may be an industrial standard architecture (ISA) bus, a peripheral component interconnect (PCI) bus, or an extended industrial standard architecture (EISA) bus. The bus may be divided into an address bus, a data bus, a control bus, etc. For ease of representation, Figure 2A Only one thick line is used in the diagram, but this does not mean that there is only one bus or only one type of bus.
[0118] It should be pointed out that Figure 2A The structure shown in the figure does not constitute a limitation on the communication device. Figure 2A In addition to the components shown, the communication device may include more or fewer components than shown, or combine certain components, or arrange the components differently.
[0119] Figure 2B FIG. 2 shows another hardware structure of the communication device in the embodiment of the present application. Figure 2B As shown, the communication device may include a processor 31 and a communication interface 32. The processor 31 is coupled to the communication interface 32.
[0120] The functions of the processor 31 may refer to the description of the processor 21. In addition, the processor 31 also has a storage function and can function as the memory 22 described above.
[0121] The communication interface 32 is used to provide data to the processor 31. The communication interface 32 may be an internal interface of the communication device, or an external interface of the communication device (equivalent to the communication interface 23).
[0122] It should be pointed out that Figure 2A (or Figure 2B ) does not constitute a limitation on the communication device, except Figure 2A (or Figure 2B) In addition to the components shown in the figure, the communication device may include more or fewer components than shown in the figure, or combine certain components, or arrange the components differently.
[0123] like Figure 3 The figure is a flow chart of a path planning method provided by an embodiment of the present application. The path planning method is applied to a path planning device, and the path planning device belongs to a path planning system composed of a path planning device and a server. Figure 1 The path planning system shown. The path planning method includes: S301-S303.
[0124] S301. A path planning device determines a first turning radius and a first passing width.
[0125] Specifically, the path planning device may obtain dimension parameters of the vehicle, and determine a first turning radius and a first passing width of the vehicle according to the obtained dimension parameters of the vehicle.
[0126] Among them, the first turning radius is the minimum turning radius of the vehicle, and the first passing width is the minimum passing width of the vehicle.
[0127] Optionally, the server may pre-store the size parameters of the vehicle. When acquiring the size parameters of the vehicle, the path planning device may send a data request for acquiring the size parameters of the vehicle to the server. After receiving the data request, the server reads the size parameters of the vehicle from the database and sends the size parameters of the vehicle to the path planning device. Accordingly, the path planning device receives the size parameters of the vehicle sent by the server.
[0128] Optionally, the user may also input the size parameters of the vehicle in real time in the path planning device. Accordingly, the path planning device obtains the size parameters of the vehicle in response to the user's input operation.
[0129] In actual applications, when a vehicle is turning without sideslip, the front and rear wheels follow the Ackerman steering principle, that is, the intersection of the extension line of the rear wheel axle of the vehicle and the extension line of the front wheel axle is the turning center of the vehicle.
[0130] When the front wheels of the vehicle rotate to the maximum deflection angle and make a turn without skidding, the path planning device can determine the radius of the circular curve trajectory of the front wheels outside the vehicle's rotation direction as the vehicle's minimum turning radius, and determine the difference between the maximum distance between the vehicle body and the turning center and the minimum distance between the vehicle body and the turning center as the vehicle's minimum passing width.
[0131] Exemplarily, the maximum deflection angle of the front wheels of vehicle A is preset to 30°. Vehicle A turns when the front wheels are rotated to the maximum deflection angle and there is no sideslip. At this time, the radius of the circular curve trajectory of the outer front wheels in the rotation direction of vehicle A is 10m, and the maximum distance between the vehicle body and the turning center is 11m, and the minimum distance between the vehicle body and the turning center is 8m. Then, the first turning radius is 10m, and the first passing width is 3m (i.e., the difference between the maximum distance 11m and the minimum distance 8m).
[0132] Optionally, the trigger condition for the path planning device to determine the first turning radius and the first passing width may be after the user initiates a navigation request, or may be pre-calculated after the user inputs the size parameters of the vehicle and directly called when the user initiates a navigation request.
[0133] Optionally, the vehicle's dimensional parameters include at least one of body length, body width, track width, wheelbase, maximum front wheel deflection angle and front overhang length.
[0134] S302: The path planning device determines a second turning radius and a second passing width.
[0135] Specifically, the path planning device can also obtain the curvature value and road width of the path to be planned at the maximum turning point, determine the second turning radius according to the curvature value of the maximum turning point, and determine the obtained road width of the maximum turning point as the second passing width.
[0136] Optionally, the method for the path planning device to obtain the curvature value and road width of the path to be planned at the maximum turning point can refer to the method for the path planning device to obtain the size parameters of the vehicle in S301, which will not be repeated here.
[0137] The second turning radius is the minimum turning radius of the path to be planned at the maximum turning point, and the second passing width is the road width of the path to be planned at the maximum turning point.
[0138] It should be noted that the order of S301 and S302 is not limited.
[0139] Optionally, S301 may be executed first and then S302; S302 may be executed first and then S301; S301 and S302 may also be executed simultaneously.
[0140] S303: When the first turning radius is smaller than or equal to the second turning radius, and the first passing width is smaller than or equal to the second passing width, the path planning device determines that the path to be planned is the target path.
[0141] Specifically, when the first turning radius is less than or equal to the second turning radius, and the first passing width is less than or equal to the second passing width, the path planning device determines that the vehicle can pass through the path to be planned. In this case, the path planning device determines that the path to be planned is the target path.
[0142] For example, the first turning radius is preset to be 5m and the first passing width is preset to be 4m, and the second turning radius is preset to be 6m and the second passing width is preset to be 5m. At this time, the first turning radius is smaller than the second turning radius, and the first passing width is smaller than the second passing width. The path planning device determines that the vehicle can pass through the path to be planned, and determines that the path to be planned is the target path.
[0143] Optionally, when the first turning radius is greater than the second turning radius, or when the first turning radius is less than or equal to the second turning radius and the first passing width is greater than the second passing width, the path planning device determines that the vehicle cannot pass through the path to be planned, and outputs a prompt message. The prompt message may include the specific address of the maximum turning point, physical information such as the road width, and the reason for the inability to pass (for example, the turning point width is not enough), so that the user knows that the vehicle cannot pass through the path to be planned.
[0144] In one achievable approach, combining Figure 3 ,like Figure 4A As shown, in the above S301, the method for the path planning device to determine the first turning radius and the first passing width may include: S401-S404
[0145] S401. The path planning device obtains the wheelbase and the maximum deflection angle of the front wheels of the vehicle.
[0146] Specifically, the path planning device obtains the wheelbase of the vehicle and the maximum deflection angle of the front wheels.
[0147] Optionally, the method for the path planning device to obtain the wheelbase and maximum front wheel deflection angle of the vehicle can refer to the method for the path planning device to obtain the size parameters of the vehicle in S301, which will not be repeated here.
[0148] S402: The path planning device determines a first turning radius according to the wheelbase of the vehicle and the maximum deflection angle of the front wheels of the vehicle.
[0149] Specifically, after obtaining the wheelbase of the vehicle and the maximum deflection angle of the front wheels of the vehicle, the path planning device determines the first turning radius according to the wheelbase of the vehicle and the maximum deflection angle of the front wheels of the vehicle.
[0150] The wheelbase of the vehicle, the maximum deflection angle of the front wheels of the vehicle and the first turning radius satisfy the first formula. The first formula is:
[0151]
[0152] Wherein, r1 is the first turning radius, l is the wheelbase of the vehicle, and θ is the maximum deflection angle of the front wheel of the vehicle.
[0153] For example, Figure 4B As shown, point O is the turning center of the vehicle, point A is the center point of the outer front wheel axle in the direction of rotation of the vehicle, and point B is the center point of the outer rear wheel axle in the direction of rotation of the vehicle. When the vehicle rotates to the maximum front wheel deflection angle θ, in △OAB, the minimum turning radius r1 of the vehicle and the wheelbase l of the vehicle satisfy the first formula.
[0154] Exemplarily, the wheelbase of vehicle A is preset to be 4 m, and the maximum deflection angle of the front wheels of vehicle A is 30°. Then, according to the first formula, the first turning radius is 8 m.
[0155] S403: The path planning device obtains the body width, wheelbase and front overhang length of the vehicle.
[0156] Specifically, the path planning device obtains the body width, wheelbase and front overhang length of the vehicle.
[0157] Optionally, the method for the path planning device to obtain the body width, wheelbase and front overhang length of the vehicle can refer to the method for the path planning device to obtain the size parameters of the vehicle in S301, which will not be repeated here.
[0158] It should be noted that the order of S402 and S403 is not limited.
[0159] Optionally, S402 may be executed first and then S403; S403 may be executed first and then S402; S402 and S403 may also be executed simultaneously.
[0160] S404, the path planning device determines a first passing width according to the wheelbase of the vehicle, the maximum deflection angle of the front wheels of the vehicle, the first turning radius, the body width of the vehicle, the wheelbase of the vehicle and the front overhang length of the vehicle.
[0161] Specifically, after obtaining the vehicle's body width, wheelbase and front overhang length, the path planning device determines the first passing width based on the vehicle's wheelbase, the vehicle's maximum front wheel deflection angle, the first turning radius, the vehicle's body width, the vehicle's wheelbase and the vehicle's front overhang length.
[0162] The vehicle body width, the vehicle wheelbase, the vehicle front overhang length, the vehicle wheelbase, the vehicle front wheel maximum deflection angle, the first turning radius and the first passing width satisfy the second formula. The second formula is:
[0163]
[0164] Among them, b is the body width of the vehicle, m is the wheelbase of the vehicle, d is the front overhang length of the vehicle, and w1 is the first passing width.
[0165] For example, Figure 4B As shown, b is the body width of the vehicle, m is the wheelbase of the vehicle, d is the front overhang length of the vehicle, w1 is the first passing width, point O is the turning center of the vehicle, point A is the center point of the outer front wheel axle in the direction of rotation of the vehicle, point B is the center point of the outer rear wheel axle in the direction of rotation of the vehicle, point C is the intersection of the extension line of the outer rear wheel axle in the direction of rotation of the vehicle and the outer body in the direction of rotation, r is the closest distance between the vehicle and the turning center O, R is the farthest distance between the vehicle and the turning center O, point D is the farthest point of the vehicle from the turning center O, θ is the maximum deflection angle of the front wheel of the vehicle, r1 is the minimum turning radius of the vehicle, and l is the wheelbase of the vehicle. When the vehicle rotates to the maximum deflection angle θ of the front wheel, in △OAB, the path planning device calculates r1 based on the known θ and l, and further obtains r based on r1, b and m. In △OCD, the path planning device calculates R based on the known θ, b, m, d and l, as well as r. Finally, subtracting r from R can obtain the minimum passing width w1.
[0166] In one achievable approach, combining Figure 3 ,like Figure 5 As shown, in the above S302, the method for the path planning device to determine the second turning radius and the second passing width includes: S501-S504.
[0167] S501. The path planning device obtains multiple road curvatures at multiple turning points of the path to be planned.
[0168] Specifically, the path planning device obtains a plurality of road curvatures at a plurality of turning points of the path to be planned, wherein the plurality of turning points correspond one to one with the plurality of road curvatures.
[0169] Optionally, the method for the path planning device to obtain multiple road curvatures at multiple turning points of the path to be planned can refer to the method for the path planning device to obtain the size parameters of the vehicle in S301, which will not be repeated here.
[0170] Optionally, the path planning device may first obtain a preset starting point and end point, and plan a navigation path from the starting point to the end point according to the path planning algorithm in "Bidirectional Heuristic Shortest Path Algorithm Based on Turning Restrictions and Delays". "Bidirectional Heuristic Shortest Path Algorithm Based on Turning Restrictions and Delays" is specifically found in "Journal of Wuhan University: Information Science Edition", Issue 3, 2006, Pages 256 to 259, and the authors are Zheng Nianbo, Li Qingquan, Xu Jinghai, and Song Ying.
[0171] Optionally, after determining the path to be planned, the path planning device obtains road network data about the path to be planned from the national road network data. The road network data may include road curvature, heading and road width information, and may also include road slope and road topological relationship information.
[0172] Optionally, the method by which the path planning device obtains the preset starting point and end point and the road network data about the path to be planned in the national road network data can refer to the method by which the path planning device obtains the size parameters of the vehicle in S301, which will not be repeated here.
[0173] S502: The path planning device determines a turning point with the largest curvature among multiple road curvatures as a maximum turning point.
[0174] Specifically, after obtaining multiple road curvatures at multiple turning points of the path to be planned, the path planning device determines the turning point with the largest curvature among the multiple road curvatures as the maximum turning point.
[0175] The road curvature corresponding to each turning point is the maximum local curvature of the turning point.
[0176] Optionally, when there are multiple maximum turning points with the same road curvature in the path to be planned, the path planning device obtains multiple road widths corresponding to the multiple maximum turning points with the same curvature, and takes the turning point with the smallest road width value as the maximum turning point.
[0177] S503: The path planning device determines a second turning radius according to the road curvature at the maximum turning point.
[0178] Specifically, after determining the maximum turning point, the path planning device determines the second turning radius according to the road curvature of the maximum turning point.
[0179] Among them, the road curvature of the maximum turning point and the second turning radius satisfy the third formula. The third formula is:
[0180]
[0181] Wherein, r2 is the second turning radius, and K is the road curvature at the maximum turning point.
[0182] Exemplarily, the road curvature of the preset maximum turning point A is 5m^-1, and the second turning radius can be determined to be 5m according to the third formula.
[0183] S504: The path planning device obtains the road width at the maximum turning point, and uses the obtained road width at the maximum turning point as the second passing width.
[0184] Specifically, after determining the maximum turning point, the path planning device obtains the road width of the maximum turning point, and uses the obtained road width of the maximum turning point as the second passing width.
[0185] Optionally, the method for the path planning device to obtain the road width at the maximum turning point can refer to the method for the path planning device to obtain the size parameters of the vehicle in S301, which will not be repeated here.
[0186] Exemplarily, the road width at the preset maximum turning point A is 5 m, and the second passing width is determined to be 5 m.
[0187] It should be noted that there is no limitation on the order of S503 and S504.
[0188] Optionally, S503 may be executed first and then S504; S504 may be executed first and then S503; S503 and S504 may also be executed simultaneously.
[0189] In one achievable approach, combining Figure 3 ,like Fig. 6A As shown, when the vehicle is a trailer, the trailer includes a tractor and a trailer. In the above S301, the method for the path planning device to determine the first turning radius and the first passing width may also include: S601-S606.
[0190] S601: The path planning device obtains the wheelbase of the tractor and the maximum deflection angle of the front wheels of the tractor.
[0191] Specifically, the path planning device obtains the wheelbase of the tractor and the maximum deflection angle of the front wheels of the tractor.
[0192] Optionally, the method for the path planning device to obtain the wheelbase of the tractor and the maximum deflection angle of the front wheels of the tractor can refer to the method for the path planning device to obtain the size parameters of the vehicle in S301, which will not be repeated here.
[0193] S602: The path planning device determines the minimum turning radius of the tractor as a first turning radius according to the wheelbase of the tractor and the maximum deflection angle of the front wheels of the tractor.
[0194] Specifically, after obtaining the wheelbase of the tractor and the maximum deflection angle of the front wheels of the tractor, the path planning device determines that the minimum turning radius of the tractor is the first turning radius according to the wheelbase of the tractor and the maximum deflection angle of the front wheels of the tractor.
[0195] It can be understood that the wheelbase of the tractor, the maximum deflection angle of the front wheels of the tractor and the minimum turning radius of the tractor satisfy the first formula.
[0196] S603: The path planning device obtains the body width of the tractor, the wheelbase of the tractor, the front overhang length of the tractor, and the wheelbase of the trailer.
[0197] Specifically, the path planning device obtains the body width of the tractor, the wheelbase of the tractor, the front overhang length of the tractor, and the wheelbase of the trailer.
[0198] Optionally, the method for the path planning device to obtain the body width of the tractor, the wheelbase of the tractor, the front overhang length of the tractor and the wheelbase of the trailer can refer to the method for the path planning device to obtain the size parameters of the vehicle in S301, which will not be repeated here.
[0199] It should be noted that there is no limitation on the order of S601 and S603.
[0200] Optionally, S601 may be executed first and then S603; S603 may be executed first and then S601; S601 and S603 may also be executed simultaneously.
[0201] S604: The path planning device determines the path steering angle of the trailer at the maximum turning point, the initial forward direction angle of the tractor, the initial forward direction angle of the trailer, and the driving speed of the trailer.
[0202] Specifically, the path planning device determines the path steering angle of the trailer at the maximum turning point, the initial forward direction angle of the tractor, the initial forward direction angle of the trailer, and the driving speed of the trailer.
[0203] It should be noted that there is no limitation on the order of S601 and S604.
[0204] Optionally, S601 may be executed first and then S604; S604 may be executed first and then S601; S601 and S604 may also be executed simultaneously.
[0205] S605. The path planning device determines the minimum passing width at multiple turning angles of the trailer according to the wheelbase of the tractor, the maximum deflection angle of the front wheels of the tractor, the body width of the tractor, the wheelbase of the tractor, the front overhang length of the tractor, the wheelbase of the trailer, the initial forward direction angle of the tractor, the initial forward direction angle of the trailer and the driving speed of the trailer.
[0206] Specifically, after obtaining the wheelbase of the tractor, the maximum deflection angle of the front wheels of the tractor, the body width of the tractor, the wheelbase of the tractor, the front overhang length of the tractor and the wheelbase of the trailer, and determining the path steering angle of the trailer at the maximum turning point, the initial forward direction angle of the tractor, the initial forward direction angle of the trailer and the driving speed of the trailer, the path planning device determines the minimum passing width at multiple steering angles of the trailer according to the wheelbase of the tractor, the maximum deflection angle of the front wheels of the tractor, the body width of the tractor, the wheelbase of the tractor, the front overhang length of the tractor, the wheelbase of the trailer, the initial forward direction angle of the tractor, the initial forward direction angle of the trailer and the driving speed of the trailer.
[0207] In actual applications, when a trailer is turning, the trailer has a steering delay compared to the tractor, so the road width required for the trailer is larger than that for a single vehicle. Figure 6B and Figure 6C As shown in the figure, the simulation software is used to simulate the body state of the trailer when it turns 90° and 180°. At different steering angles, the steering delay of the trailer is different compared with the tractor, resulting in different widths of the road passed by the trailer. Therefore, when determining the minimum passing width of the trailer, it is necessary to consider the passing width of the trailer at different angles during the entire turning process, and determine the maximum value of the passing width at all angles as the minimum passing width of the trailer for this turn.
[0208] When the trailer rotates its front wheels to the maximum deflection angle and turns without skidding, the path planning device obtains each steering angle of the trailer from straight driving to turning, and calculates the road width required by the trailer at each steering angle as the minimum passing width at each steering angle. Subsequently, the path planning device uses the minimum passing width with the largest value among the minimum passing widths at each steering angle as the minimum passing width for the trailer to complete the turn.
[0209] S606: The path planning device selects a minimum passing width corresponding to the path turning angle from the minimum passing widths of the trailer at multiple turning angles, and determines it as the first passing width.
[0210] Specifically, after determining the minimum passing width at multiple turning angles of the trailer, the path planning device selects the minimum passing width corresponding to the path turning angle from the minimum passing widths of the trailer at multiple turning angles, and determines it as the first passing width.
[0211] Exemplarily, it is assumed that trailer A needs to pass a turning point in the to-be-planned path B where the path steering angle is 60°. When the front wheels of the trailer rotate to the maximum deflection angle and turn without skidding, the path planning device calculates the minimum passing width of trailer A at various steering angles in the process from straight-line driving to passing the turning point, and the largest minimum passing width value is 5m when trailer A turns to 35°. 5m is the minimum passing width corresponding to the path steering angle of 60°, and the first passing width is determined to be 5m.
[0212] Optionally, after obtaining the size parameters of the trailer, the front wheel deflection angle of the trailer can be set to take values in steps of 1° from the range of [0°, θ] (θ is the maximum deflection angle of the front wheel), and at each front wheel deflection angle of the trailer, the passing width at each steering angle in the process of the trailer steering angle from 0° to 180° is calculated to obtain a two-dimensional comparison table of the minimum passing width of the trailer.
[0213] For example, according to the tractor's wheelbase of 5m, the tractor's front wheel maximum deflection angle of 35°, the tractor's body width of 2.5m, the tractor's wheelbase of 2.25m, the tractor's front overhang length of 1.22m and the trailer's wheelbase of 16.5m, the calculation results of the minimum passing width of the trailer are shown in Table 1 below:
[0214] Table 1
[0215]
[0216] In this way, after obtaining the path steering angle of the trailer at the maximum turning point on the path to be planned and the maximum deflection angle of the front wheels of the tractor, the minimum passage width required for the trailer to pass through the maximum turning point can be directly compared with the two-dimensional table. For example, if the path steering angle of the trailer at the maximum turning point on the path to be planned is 62° and the maximum deflection angle of the front wheels of the tractor is 30°, the minimum passage width required for the trailer to pass through the maximum turning point is 7.2m.
[0217] In one achievable approach, combining Fig. 6A ,like Fig. 7A As shown, in the above S604, the method in which the path planning device determines the path steering angle of the trailer at the maximum turning point, the initial forward direction angle of the tractor, the initial forward direction angle of the trailer and the driving speed of the trailer includes: S701-S706.
[0218] S701. A path planning device obtains at least one road curvature on a path leading to a maximum turning point.
[0219] Specifically, the path planning device obtains at least one road curvature on the path leading to the maximum turning point, wherein at least one road curvature on the path leading to the maximum turning point corresponds to at least one entry point.
[0220] Optionally, the method for the path planning device to obtain at least one road curvature on the path leading to the maximum turning point can refer to the method for the path planning device to obtain the size parameters of the vehicle in S301, which will not be repeated here.
[0221] S702: The path planning device obtains at least one road curvature on the path leading out of the maximum turning point.
[0222] Specifically, the path planning device obtains at least one road curvature on the path leading out of the maximum turning point, wherein at least one road curvature on the path leading out of the maximum turning point corresponds to at least one exit point.
[0223] Optionally, the method for the path planning device to obtain at least one road curvature on the path out of the maximum turning point can refer to the method for the path planning device to obtain the size parameters of the vehicle in S301, which will not be repeated here.
[0224] It should be noted that there is no limitation on the order of S701 and S702.
[0225] Optionally, S701 may be executed first and then S702; S702 may be executed first and then S701; S701 and S702 may also be executed simultaneously.
[0226] S703: When the road curvature of the target entry point among the at least one entry point is less than or equal to the preset curvature, and the road curvature of the target exit point among the at least one exit point is less than or equal to the preset curvature, the path planning device obtains the heading of the target entry point and the heading of the target exit point.
[0227] Specifically, when the road curvature of the target entry point among at least one entry point is less than or equal to the preset curvature, and the road curvature of the target exit point among at least one exit point is less than or equal to the preset curvature, the path planning device obtains the heading of the target entry point and the heading of the target exit point.
[0228] Optionally, the method for the path planning device to obtain the heading of the target entry point and the heading of the target exit point can refer to the method for the path planning device to obtain the size parameters of the vehicle in S301, which will not be repeated here.
[0229] Optionally, the value of the preset curvature may be an empirical threshold of 0.02 m^-1, or may be other values obtained based on experience, which is not limited in the present embodiment of the application.
[0230] It can be understood that when the road curvature of the entry point is less than or equal to the preset curvature value, it can be inferred that the road at that location is relatively straight, and therefore, it can be used as a target entry point or target exit point for the vehicle.
[0231] S704: The path planning device determines a path turning angle of the trailer at the maximum turning point according to the heading of the target entry point and the heading of the target exit point.
[0232] Specifically, after obtaining the heading of the target entry point and the heading of the target exit point, the path planning device determines the path turning angle of the trailer at the maximum turning point according to the heading of the target entry point and the heading of the target exit point. Among them, the heading of the target entry point, the heading of the target exit point and the path turning angle satisfy the fourth formula. The fourth formula is:
[0233] β=|∠A-∠B|.
[0234] Among them, β is the path steering angle of the trailer at the maximum turning point, ∠A is the heading of the target entry point, and ∠B is the heading of the target exit point.
[0235] Exemplary, combined Figure 7B , the preset heading of the target entry point A is 30° north by east, and the heading of the target exit point is 30° south by west. According to the fourth formula, the path turning angle of the trailer at the maximum turning point is 180°.
[0236] S705: The path planning device determines the heading of the target entry point as the initial forward direction angle of the tractor and the initial forward direction angle of the trailer.
[0237] Specifically, the path planning device determines the heading of the target entry point as the initial forward direction angle of the tractor and the initial forward direction angle of the trailer.
[0238] It should be noted that there is no limitation on the order of S704 and S705.
[0239] Optionally, S704 may be executed first and then S705; S705 may be executed first and then S704; S704 and S705 may also be executed simultaneously.
[0240] S706: The path planning device obtains a preset driving speed, and uses the obtained preset driving speed as the driving speed of the trailer.
[0241] Specifically, the path planning device obtains a preset driving speed, and uses the obtained preset driving speed as the driving speed of the trailer.
[0242] Optionally, the method for the path planning device to obtain the preset driving speed can refer to the method for the path planning device to obtain the size parameters of the vehicle in S301, which will not be repeated here.
[0243] Optionally, the preset driving speed can be artificially set. For example, when passing through a turning section with a large steering angle or a narrow road width, a smaller driving speed (e.g., 0.1 m / s) can be preset for the vehicle.
[0244] It should be noted that there is no limitation on the order of S701 and S706.
[0245] Optionally, S701 may be executed first and then S706; S706 may be executed first and then S701; S701 and S706 may also be executed simultaneously.
[0246] In one achievable approach, combining Fig. 7A ,like Figure 8 As shown, in the above S605, the path planning device determines the minimum passing width at multiple turning angles of the trailer according to the wheelbase of the tractor, the maximum deflection angle of the front wheels of the tractor, the body width of the tractor, the wheelbase of the tractor, the front overhang length of the tractor, the wheelbase of the trailer, the initial forward direction angle of the tractor, the initial forward direction angle of the trailer and the driving speed of the trailer, and the method includes: S801.
[0247] S801. The path planning device performs a first operation on each of a plurality of steering angles to obtain a minimum passing width at the plurality of steering angles of the trailer.
[0248] Specifically, after obtaining the wheelbase of the tractor, the maximum deflection angle of the front wheels of the tractor, the body width of the tractor, the wheelbase of the tractor, the front overhang length of the tractor, the wheelbase of the trailer, the initial forward direction angle of the tractor, the initial forward direction angle of the trailer and the driving speed of the trailer, the path planning device can perform a first operation on each of the multiple steering angles to obtain the minimum passing width at the multiple steering angles of the trailer.
[0249] Among them, the first operation is: based on the wheelbase of the tractor, the maximum deflection angle of the front wheels of the tractor, the body width of the tractor, the wheelbase of the tractor, the front overhang length of the tractor, the wheelbase of the trailer, the initial forward direction angle of the tractor, the initial forward direction angle of the trailer and the driving speed of the trailer, determine the minimum passing width set under multiple forward direction angles of the trailer, and select the minimum passing width with the largest value from the minimum passing width set to determine it as the minimum passing width of the trailer at the target turning angle.
[0250] The minimum forward direction angle of the multiple forward direction angles of the trailer is the initial forward direction angle of the tractor. The difference between the maximum forward direction angle of the multiple forward direction angles of the trailer and the initial forward direction angle of the tractor is equal to the target steering angle. The target steering angle is any one of the multiple steering angles.
[0251] Exemplarily, it is assumed that the front wheel of trailer A rotates to the maximum deflection angle and passes through the turning point of the path steering angle B1 in the planned path B without side slip. During the turning process, trailer A experiences a total of n forward direction angles, namely A1, A2, ..., An. Among them, An minus A1 equals the path steering angle B1. The path planning device calculates the minimum passing width set of trailer A under the n forward direction angles A1, A2, ..., An respectively. There are C1, C2, ..., Cn, a total of n minimum passing widths in the minimum passing width set, wherein C1 is the minimum passing width of the trailer under the forward direction angle A1, C2 is the minimum passing width of the trailer under the forward direction angle A2, ..., Cn is the minimum passing width of the trailer under the forward direction angle An. In the minimum passing width set, C2 has the largest value, then the path planning device selects the minimum passing width C2 of trailer A under the forward direction angle A2 as the minimum passing width corresponding to the path steering angle B1, and determines the first passing width to be C2. n is a positive integer.
[0252] In one possible implementation, Fig. 9A As shown, the method for determining the minimum passing width set at multiple forward direction angles of the trailer based on the wheelbase of the tractor, the maximum deflection angle of the front wheels of the tractor, the body width of the tractor, the wheelbase of the tractor, the front overhang length of the tractor, the wheelbase of the trailer, the initial forward direction angle of the tractor, the initial forward direction angle of the trailer and the driving speed of the trailer in the above S801 includes: S901-S903.
[0253] S901. The path planning device determines the difference between the current heading angle of the tractor and the current heading angle of the trailer based on the wheelbase of the tractor, the maximum deflection angle of the front wheels of the tractor, the wheelbase of the trailer, the driving speed of the trailer, the current heading angle of the tractor and the current heading angle of the trailer, and determines the difference as the current heading angle difference corresponding to the current heading angle of the trailer.
[0254] Specifically, the path planning device determines the difference between the current heading angle of the tractor and the current heading angle of the trailer based on the wheelbase of the tractor, the maximum deflection angle of the tractor's front wheels, the wheelbase of the trailer, the driving speed of the trailer, the current heading angle of the tractor and the current heading angle of the trailer, and determines the difference as the current heading angle difference corresponding to the current heading angle of the trailer.
[0255] The current forward direction angle of the trailer is the same as the current forward direction angle of the tractor. The initial forward direction angle of the current forward direction angle of the tractor is the initial forward direction angle of the tractor. The initial forward direction angle of the current forward direction angle of the trailer is the initial forward direction angle of the trailer.
[0256] The current forward direction angle of the tractor, the current forward direction angle of the trailer, and the current forward direction angle difference satisfy the fifth formula. The fifth formula is:
[0257] γ=θ1-θ0.
[0258] Among them, γ is the current forward direction angle difference, θ0 is the current forward direction angle of the tractor, and θ1 is the current forward direction angle of the trailer.
[0259] S902. The path planning device determines the next forward direction angle of the tractor adjacent to the current forward direction angle of the tractor, and the next forward direction angle of the trailer adjacent to the current forward direction angle of the trailer, until multiple current forward direction angle differences corresponding to multiple forward direction angles of the towing vehicle are determined.
[0260] Specifically, after determining the current forward direction angle difference corresponding to the current forward direction angle of the trailer, the path planning device determines the next forward direction angle of the tractor adjacent to the current forward direction angle of the tractor, and the next forward direction angle of the trailer adjacent to the current forward direction angle of the trailer, until multiple current forward direction angle differences corresponding one-to-one to the multiple forward direction angles of the trailer are determined.
[0261] The wheelbase of the tractor, the maximum deflection angle of the front wheels of the tractor, the speed of the trailer, the current forward direction angle of the tractor, and the next forward direction angle of the tractor satisfy the sixth formula. The sixth formula is:
[0262]
[0263] Among them, l1 is the wheelbase of the tractor, α is the maximum deflection angle of the front wheel of the tractor, v is the speed of the trailer, and θ 0+t is the next forward direction angle of the tractor.
[0264] Among them, the wheelbase of the trailer, the driving speed of the towing vehicle, the current forward direction angle of the tractor, the current forward direction angle of the trailer and the next forward direction angle of the trailer satisfy the seventh formula. The seventh formula is:
[0265]
[0266] Where l2 is the wheelbase of the trailer, θ 1+t is the next forward direction angle of the trailer, and θ1 is the current forward direction angle of the trailer.
[0267] Exemplarily, the path steering angle of trailer A at the maximum turning point on the planned path B is preset to be B1, the initial forward direction angle of the tractor is A1, and the initial forward direction angle of the trailer is C1. Then, the current forward direction angle of the tractor is A1, the current forward direction angle of the trailer is A1, and the current forward direction angle of the trailer is C1.
[0268] The path planning device calculates the current heading angle difference corresponding to the current heading angle A1 of the trailer as C1-A1. After determining the current heading angle difference, the path planning device calculates the next heading angle A2 of the tractor adjacent to A1 based on the current heading angle A1 of the tractor, and calculates the next heading angle C2 of the trailer adjacent to C1 based on the current heading angle C1 of the trailer. Then, the current heading angle of the tractor is A2, the current heading angle of the trailer is A2, and the current heading angle of the trailer is C2, and the current heading angle of the trailer is calculated to be C2-A2.
[0269] The above operation is repeated until the difference between An and A1 is equal to the path turning angle B1, and multiple current forward direction angle differences corresponding to multiple forward direction angles of the trailer are obtained, that is, A1 corresponds to C1-A1, A2 corresponds to C2-A2, ..., An corresponds to Cn-An. n is a positive integer.
[0270] S903, the path planning device performs a second operation on multiple current forward direction angle differences, the wheelbase of the tractor, the maximum deflection angle of the front wheels of the tractor, the body width of the tractor, the wheelbase of the tractor, the front overhang length of the tractor and the wheelbase of the trailer to obtain a minimum passing width set.
[0271] Specifically, the path planning device performs a second operation on multiple current forward direction angle differences, the wheelbase of the tractor, the maximum deflection angle of the front wheels of the tractor, the body width of the tractor, the wheelbase of the tractor, the front overhang length of the tractor and the wheelbase of the trailer to obtain a minimum passing width set.
[0272] The second operation includes: determining the minimum passing width at the current forward direction angle of the trailer based on the current forward direction angle difference, the wheelbase of the tractor, the maximum deflection angle of the front wheels of the tractor, the body width of the tractor, the wheelbase of the tractor, the front overhang length of the tractor and the wheelbase of the trailer.
[0273] The current forward direction angle difference, the wheelbase of the tractor, the maximum deflection angle of the front wheels of the tractor, the body width of the tractor, the wheelbase of the tractor, the front overhang length of the tractor, the wheelbase of the trailer, and the minimum passing width of the trailer at the current forward direction angle satisfy the eighth formula. The eighth formula is:
[0274]
[0275] Among them, b1 is the body width of the tractor, m1 is the wheelbase of the tractor, d1 is the front overhang length of the tractor, and w2 is the minimum passing width under the current forward direction angle of the trailer.
[0276] Exemplary, combined Fig. 9B , b1 is the body width of the tractor, m1 is the wheelbase of the tractor, d1 is the front overhang length of the tractor, l1 is the wheelbase of the tractor, α is the maximum deflection angle of the front wheel of the tractor, l2 is the wheelbase of the trailer, γ is the current forward direction angle difference, point O1 is the turning center of the vehicle, point C1 is the intersection of the extension line of the rear wheel axle of the tractor and the delay line of the rear wheel axle of the trailer, point E is the center point of the rear wheel axle of the tractor on the outside of the rotation direction, point F is the center point of the front wheel axle of the tractor on the outside of the rotation direction, point M is the midpoint between the rear wheels of the tractor, point T is the midpoint between the rear wheels of the trailer, R1 is the farthest distance between the tractor and the turning center O1, point B1 is the intersection of the extension line of the rear wheel axle of the vehicle on the outside of the rotation direction and the body on the outside of the rotation direction, and point D1 is the farthest point of the tractor from the turning center O1. When the vehicle rotates to the maximum front wheel deflection angle α, in △MTC, the path planning device calculates the size of r2 based on the known l2, b1 and γ. The path planning device calculates r3 based on the relationship between r3, line segments MC1 and MO1, and l2, γ, l1, α, b1, and m1. In △O1EF and △O1B1D1, the path planning device calculates R1 based on the known l1, α, b1, d1, and m1. Finally, the path planning device subtracts the difference between r2 and r3 from R1 to obtain the minimum passing width w2.
[0277] In one possible implementation, Fig.10 As shown, when the number of paths to be planned is multiple, the method for determining a path to be planned as a target path includes: S1001-S1003.
[0278] S1001. The path planning device obtains a plurality of road data corresponding one-to-one to a plurality of paths to be planned.
[0279] Specifically, when there are multiple paths to be planned, the path planning device obtains multiple road data corresponding to the multiple paths to be planned.
[0280] Optionally, the road data may include path length, path restriction rules, number of traffic lights, number of intersections, etc.
[0281] Optionally, the method for the path planning device to obtain multiple road data corresponding one-to-one to multiple paths to be planned can refer to the method for the path planning device to obtain the size parameters of the vehicle in S301, which will not be repeated here.
[0282] S1002: The path planning device determines a plurality of travel costs corresponding to a plurality of paths to be planned one by one according to a plurality of road data and a weight corresponding to each road data.
[0283] Specifically, after acquiring a plurality of road data corresponding one-to-one to a plurality of paths to be planned, the path planning device determines a plurality of travel costs corresponding one-to-one to the plurality of paths to be planned according to the plurality of road data and the weight corresponding to each road data.
[0284] The travel cost represents the estimated total travel time of the vehicle through the planned path.
[0285] Optionally, when the road data includes the path length, path restriction rules, the number of traffic lights and the number of intersections, the path planning device divides the path length by the average speed of the vehicle to obtain the travel time as the travel cost caused by the path length. If the vehicle violates the restriction rules on this path, the path planning device uses 5 times the travel cost caused by the path length as the travel cost caused by the violation of the restriction rules; if the vehicle does not violate the restriction rules on this path, the path planning device does not calculate this travel cost. The path planning device multiplies the number of traffic lights by the expected waiting time of a single traffic light to obtain the total waiting time as the travel cost caused by the number of traffic lights. The path planning device calculates the travel cost caused by the number of intersections based on the preset values defined by the number of intersections and the difficulty of turning (for example, 0s for straight driving, 60s for left turning, 120s for right turning and 300s for U-turn). Finally, the path planning device uses the sum of the travel costs caused by each road data as the travel cost of the path to be planned.
[0286] S1003. The path planning device selects a to-be-planned path corresponding to a to-be-planned path that satisfies a preset condition from among a plurality of to-be-planned costs, and determines the selected to-be-planned path as a target path.
[0287] Specifically, after determining multiple travel costs corresponding to multiple to-be-planned paths one by one, the path planning device selects a to-be-planned path corresponding to a travel cost that meets preset conditions from the multiple travel costs, and determines the selected to-be-planned path as the target path.
[0288] Optionally, after calculating a plurality of travel costs corresponding to a plurality of paths to be planned one by one, they are sorted in ascending order, and finally the first three paths to be planned are selected as target paths.
[0289] Optionally, the preset conditions can be preset by the user, such as the minimum number of intersections, the minimum number of traffic lights, etc., which is not limited in this embodiment of the present application.
[0290] The above mainly introduces the solution provided by the embodiment of the present application from the perspective of the method. In order to realize the above functions, it includes hardware structures and / or software modules corresponding to the execution of each function. Those skilled in the art should easily realize that, in combination with the units and algorithm steps of each example described in the embodiments disclosed herein, the present application can be implemented in the form of hardware or a combination of hardware and computer software. Whether a function is executed in the form of hardware or computer software driving hardware depends on the specific application and design constraints of the technical solution. Professional and technical personnel can use different methods to implement the described functions for each specific application, but such implementation should not be considered to exceed the scope of the present application.
[0291] The embodiment of the present application can divide the functional modules of the terminal according to the above method example. For example, each functional module can be divided according to each function, or two or more functions can be integrated into one processing module. The above integrated module can be implemented in the form of hardware or in the form of software functional modules. Optionally, the division of modules in the embodiment of the present application is schematic and is only a logical function division. There may be other division methods in actual implementation.
[0292] like Fig.11 As shown, it is a schematic diagram of the structure of a path planning device provided in an embodiment of the present application. The path planning device can be used to perform the following steps: Figures 3 to 10 The path planning method shown. Fig.11 The path planning device shown includes: a processing unit 1101 .
[0293] Processing unit 1101 is used to determine a first turning radius and a first passing width. The first turning radius is the minimum turning radius of the vehicle. The first passing width is the minimum passing width of the vehicle. For example, in combination Figure 3 , the processing unit 1101 can be used to execute S301.
[0294] The processing unit 1101 is further configured to determine a second turning radius and a second passing width. The second turning radius is the minimum turning radius of the path to be planned at the maximum turning point. The second passing width is the road width of the path to be planned at the maximum turning point. Figure 3 , the processing unit 1101 can be used to execute S302.
[0295] The processing unit 1101 is further configured to determine that the path to be planned is the target path when the first turning radius is less than or equal to the second turning radius and the first passing width is less than or equal to the second passing width. Figure 3 , the processing unit 1101 can be used to execute S303.
[0296] Optionally, the processing unit 1101 is specifically configured to:
[0297] Get the vehicle's wheelbase and maximum front wheel deflection angle. For example, combined with Figure 4A , the processing unit 1101 can be used to execute S401.
[0298] The first turning radius is determined according to the wheelbase of the vehicle and the maximum deflection angle of the front wheels of the vehicle. The wheelbase of the vehicle, the maximum deflection angle of the front wheels of the vehicle and the first turning radius satisfy the first formula. The first formula is:
[0299]
[0300] Where r1 is the first turning radius, l is the wheelbase of the vehicle, and θ is the maximum deflection angle of the front wheels of the vehicle. Figure 4A , the processing unit 1101 can be used to execute S402.
[0301] Get the vehicle's body width, track width, and front overhang length. For example, combined with Figure 4A , the processing unit 1101 can be used to execute S403.
[0302] The first passing width is determined according to the vehicle's wheelbase, the vehicle's maximum front wheel deflection angle, the first turning radius, the vehicle's body width, the vehicle's wheelbase, and the vehicle's front overhang length. The vehicle's body width, the vehicle's wheelbase, the vehicle's front wheel overhang length, the vehicle's wheelbase, the vehicle's maximum front wheel deflection angle, the first turning radius, and the first passing width satisfy the second formula. The second formula is:
[0303]
[0304] Wherein, b is the width of the vehicle, m is the wheelbase of the vehicle, d is the front overhang length of the vehicle, and w1 is the first clearance width. Figure 4A , the processing unit 1101 can be used to execute S404.
[0305] Optionally, the processing unit 1101 is specifically configured to:
[0306] Get multiple road curvatures at multiple turning points of the path to be planned. Multiple turning points correspond to multiple road curvatures one by one. For example, combined with Figure 5 , the processing unit 1101 can be used to execute S501.
[0307] The turning point with the largest curvature among the multiple road curvatures acquired by the processing unit 1101 is determined as the maximum turning point. Figure 5 , the processing unit 1101 can be used to execute S502.
[0308] The second turning radius is determined according to the road curvature at the maximum turning point. The road curvature at the maximum turning point and the second turning radius satisfy the third formula. The third formula is:
[0309]
[0310] Where r2 is the second turning radius, and K is the road curvature at the maximum turning point. Figure 5 , the processing unit 1101 can be used to execute S503.
[0311] The road width at the maximum turning point is obtained, and the obtained road width at the maximum turning point is used as the second passing width. Figure 5 , the processing unit 1101 can be used to execute S504.
[0312] Optionally, the processing unit 1101 is specifically configured to:
[0313] Get the wheelbase of the tractor and the maximum deflection angle of the tractor's front wheels. Fig. 6A , the processing unit 1101 can be used to execute S601.
[0314] According to the wheelbase of the tractor and the maximum deflection angle of the front wheels of the tractor, the minimum turning radius of the tractor is determined as the first turning radius. Fig. 6A , the processing unit 1101 can be used to execute S602.
[0315] Get the tractor's body width, tractor's wheelbase, tractor's front overhang length, and trailer's wheelbase. Fig. 6A , the processing unit 1101 can be used to execute S603.
[0316] Determine the path steering angle of the trailer at the maximum turning point, the initial heading angle of the tractor, the initial heading angle of the trailer, and the travel speed of the trailer. Fig. 6A , the processing unit 1101 can be used to execute S604.
[0317] According to the wheelbase of the tractor, the maximum deflection angle of the front wheels of the tractor, the body width of the tractor, the wheelbase of the tractor, the front overhang length of the tractor, the wheelbase of the trailer, the initial forward direction angle of the tractor, the initial forward direction angle of the trailer and the driving speed of the trailer, the minimum passing width at multiple steering angles of the trailer is determined. Fig. 6A , the processing unit 1101 can be used to execute S605.
[0318] From the minimum passing widths of the trailer at multiple turning angles, the minimum passing width corresponding to the path turning angle is selected and determined as the first passing width. Fig. 6A, the processing unit 1101 can be used to execute S606.
[0319] Optionally, the processing unit 1101 is specifically configured to:
[0320] At least one road curvature on the path leading to the maximum turning point is obtained. At least one road curvature on the path leading to the maximum turning point corresponds to at least one entry point. For example, in combination with Fig. 7A , the processing unit 1101 can be used to execute S701.
[0321] At least one road curvature on the path leading out of the maximum turning point is obtained. At least one road curvature on the path leading out of the maximum turning point corresponds to at least one exit point. For example, in combination with Fig. 7A , the processing unit 1101 can be used to execute S702.
[0322] When the road curvature of the target entry point among at least one entry point is less than or equal to the preset curvature, and the road curvature of the target exit point among at least one exit point is less than or equal to the preset curvature, the heading of the target entry point and the heading of the target exit point are obtained. Fig. 7A , the processing unit 1101 can be used to execute S703.
[0323] According to the heading of the target entry point and the heading of the target exit point, the path steering angle of the trailer at the maximum turning point is determined. The heading of the target entry point, the heading of the target exit point and the path steering angle satisfy the fourth formula. The fourth formula is:
[0324] β=|∠A-∠B|.
[0325] Where β is the path steering angle of the trailer at the maximum turning point, ∠A is the heading of the target entry point, and ∠B is the heading of the target exit point. Fig. 7A , the processing unit 1101 can be used to execute S704.
[0326] The heading of the target entry point is determined as the initial forward direction angle of the tractor and the initial forward direction angle of the trailer. Fig. 7A , the processing unit 1101 can be used to execute S705.
[0327] Obtain a preset driving speed, and use the obtained preset driving speed as the driving speed of the trailer. Fig. 7A , the processing unit 1101 can be used to execute S706.
[0328] Optionally, the processing unit 1101 is specifically configured to:
[0329] The first operation is performed for each of the plurality of steering angles to obtain the minimum passing width at the plurality of steering angles of the trailer. Figure 8 , the processing unit 1101 can be used to execute S801.
[0330] The first operation is to determine a set of minimum passing widths at multiple forward direction angles of the trailer based on the wheelbase of the tractor, the maximum deflection angle of the front wheels of the tractor, the body width of the tractor, the wheelbase of the tractor, the front overhang length of the tractor, the wheelbase of the trailer, the initial forward direction angle of the tractor, the initial forward direction angle of the trailer and the driving speed of the trailer, and select the minimum passing width with the largest value from the minimum passing width set to determine it as the minimum passing width of the trailer at the target turning angle.
[0331] The minimum forward direction angle of the multiple forward direction angles of the trailer is the initial forward direction angle of the tractor. The difference between the maximum forward direction angle of the multiple forward direction angles of the trailer and the initial forward direction angle of the tractor is equal to the target steering angle. The target steering angle is any steering angle of the multiple steering angles.
[0332] Optionally, the processing unit 1101 is specifically configured to:
[0333] Based on the wheelbase of the tractor, the maximum deflection angle of the front wheels of the tractor, the wheelbase of the trailer, the travel speed of the trailer, the current heading angle of the tractor and the current heading angle of the trailer, the difference between the current heading angle of the tractor and the current heading angle of the trailer is determined, and the difference is determined as the current heading angle difference corresponding to the current heading angle of the trailer. Fig. 9A , the processing unit 1101 can be used to execute S901.
[0334] Determine the next heading angle of the tractor adjacent to the current heading angle of the tractor, and the next heading angle of the trailer adjacent to the current heading angle of the trailer, until a plurality of current heading angle differences corresponding to the plurality of heading angles of the trailer are determined. The current heading angle of the trailer is the same as the current heading angle of the tractor. The initial heading angle of the current heading angle of the tractor is the initial heading angle of the tractor. The initial heading angle of the current heading angle of the trailer is the initial heading angle of the trailer. For example, in combination Fig. 9A , the processing unit 1101 can be used to execute S902.
[0335] The second operation is performed on multiple current forward direction angle differences, the wheelbase of the tractor, the maximum deflection angle of the front wheels of the tractor, the body width of the tractor, the wheelbase of the tractor, the front overhang length of the tractor, and the wheelbase of the trailer to obtain a minimum passing width set. Fig. 9A, the processing unit 1101 can be used to execute S903.
[0336] The second operation includes:
[0337] The minimum passing width at the current forward direction angle of the trailer is determined based on the current forward direction angle difference, the wheelbase of the tractor, the maximum deflection angle of the front wheels of the tractor, the body width of the tractor, the wheelbase of the tractor, the front overhang length of the tractor and the wheelbase of the trailer. Fig. 9A , the processing unit 1101 can be used to execute S901-S903.
[0338] Optionally, the current forward direction angle of the tractor, the current forward direction angle of the trailer, and the current forward direction angle difference satisfy the fifth formula. The fifth formula is:
[0339] γ=θ1-θ0.
[0340] Among them, γ is the current forward direction angle difference, θ0 is the current forward direction angle of the tractor, and θ1 is the current forward direction angle of the trailer.
[0341] The wheelbase of the tractor, the maximum deflection angle of the front wheels of the tractor, the speed of the trailer, the current forward direction angle of the tractor and the next forward direction angle of the tractor satisfy the sixth formula. The sixth formula is:
[0342]
[0343] Among them, l1 is the wheelbase of the tractor, α is the maximum deflection angle of the front wheel of the tractor, v is the speed of the trailer, and θ 0+t is the next forward direction angle of the tractor.
[0344] The wheelbase of the trailer, the speed of the towing vehicle, the current forward direction angle of the tractor, the current forward direction angle of the trailer and the next forward direction angle of the trailer satisfy the seventh formula. The seventh formula is:
[0345]
[0346] Where l2 is the wheelbase of the trailer, θ 1+t is the next forward direction angle of the trailer, and θ1 is the current forward direction angle of the trailer.
[0347] The current forward direction angle difference, the wheelbase of the tractor, the maximum deflection angle of the front wheels of the tractor, the body width of the tractor, the wheelbase of the tractor, the front overhang length of the tractor, the wheelbase of the trailer, and the minimum passing width of the trailer at the current forward direction angle satisfy the eighth formula. The eighth formula is:
[0348]
[0349] Among them, b1 is the body width of the tractor, m1 is the wheelbase of the tractor, d1 is the front overhang length of the tractor, and w2 is the minimum passing width under the current forward direction angle of the trailer.
[0350] Optionally, the processing unit 1101 is specifically configured to:
[0351] Acquire multiple road data corresponding to multiple paths to be planned. Fig.10 , the processing unit 1101 can be used to execute S1001.
[0352] According to the plurality of road data and the weight corresponding to each road data, a plurality of travel costs corresponding to the plurality of paths to be planned are determined. Fig.10 , the processing unit 1101 can be used to execute S1002.
[0353] From multiple travel costs, a path to be planned corresponding to a travel cost that meets preset conditions is selected, and the selected path to be planned is determined as the target path. Fig.10 , the processing unit 1101 can be used to execute S1003.
[0354] Those skilled in the art should be aware that in one or more of the above examples, the functions described in this application can be implemented using hardware, software, firmware, or any combination thereof. When implemented using software, these functions can be stored in a computer-readable medium or transmitted as one or more instructions or codes on a computer-readable medium. Computer-readable media include computer-readable storage media and communication media, wherein communication media include any media that facilitates the transmission of computer programs from one place to another. Storage media can be any available media that can be accessed by general or special-purpose computers.
[0355] Through the description of the above implementation methods, technical personnel in the relevant field can clearly understand that for the convenience and simplicity of description, only the division of the above-mentioned functional modules is used as an example. In actual applications, the above-mentioned functions can be assigned to different functional modules as needed, that is, the internal structure of the device can be divided into different functional modules to complete all or part of the functions described above.
[0356] In several embodiments provided in the present application, it should be understood that the disclosed devices and methods can be implemented in other ways. For example, the device embodiments described above are only schematic, for example, the division of modules or units is only a logical function division, and there may be other division methods in actual implementation. For example, multiple units or components can be combined or integrated into another device, or some features can be ignored or not executed. Another point is that the coupling or direct coupling or communication connection between each other shown or discussed can be through some interfaces, indirect coupling or communication connection of devices or units, which can be electrical, mechanical or other forms. The unit described as a separate component may or may not be physically separated, and the component displayed as a unit may be a physical unit or multiple physical units, that is, it may be located in one place, or it may be distributed in multiple different places. Some or all of the units can be selected according to actual needs to achieve the purpose of the scheme of this embodiment.
[0357] The above are only specific implementations of the present application, but the protection scope of the present application is not limited thereto. Any changes or substitutions that can be easily thought of by a person skilled in the art within the technical scope disclosed in the present application should 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 path planning method, characterized in that: include: Determine a first turning radius and a first passing width; the first turning radius is the minimum turning radius of the vehicle; the first passing width is the minimum passing width of the vehicle; When the vehicle is a trailer, the trailer includes a tractor and a trailer; the determining of the first turning radius and the first passing width includes: obtaining the wheelbase of the tractor and the maximum deflection angle of the front wheels of the tractor; determining the minimum turning radius of the tractor as the first turning radius according to the wheelbase of the tractor and the maximum deflection angle of the front wheels of the tractor; obtaining the body width of the tractor, the wheelbase of the tractor, the front overhang length of the tractor and the wheelbase of the trailer; determining the path steering angle of the trailer at the maximum turning point, the initial forward direction angle of the tractor, the initial the initial forward direction angle of the tractor and the driving speed of the trailer; determining the minimum passing width at multiple turning angles of the trailer according to the wheelbase of the tractor, the maximum deflection angle of the front wheels of the tractor, the body width of the tractor, the wheelbase of the tractor, the front overhang length of the tractor, the wheelbase of the trailer, the initial forward direction angle of the tractor, the initial forward direction angle of the trailer and the driving speed of the trailer; selecting the minimum passing width corresponding to the path turning angle from the minimum passing widths of the trailer at the multiple turning angles, and determining it as the first passing width; Determine a second turning radius and a second passing width; the second turning radius is the minimum turning radius of the path to be planned at the maximum turning point; the second passing width is the road width of the path to be planned at the maximum turning point; When the first turning radius is smaller than or equal to the second turning radius, and the first passing width is smaller than or equal to the second passing width, the path to be planned is determined to be a target path.
2. The path planning method according to claim 1, characterized in that: The determining of the first turning radius and the first passing width includes: Obtaining the wheelbase and maximum front wheel deflection angle of the vehicle; The first turning radius is determined according to the wheelbase of the vehicle and the maximum deflection angle of the front wheels of the vehicle; the wheelbase of the vehicle, the maximum deflection angle of the front wheels of the vehicle and the first turning radius satisfy a first formula; the first formula is: Wherein, r1 is the first turning radius, l is the wheelbase of the vehicle, and θ is the maximum deflection angle of the front wheels of the vehicle; Obtaining the body width, wheelbase and front overhang length of the vehicle; The first passing width is determined according to the wheelbase of the vehicle, the maximum deflection angle of the front wheels of the vehicle, the first turning radius, the body width of the vehicle, the wheelbase of the vehicle and the front overhang length of the vehicle; the body width of the vehicle, the wheelbase of the vehicle, the front overhang length of the vehicle, the wheelbase of the vehicle, the maximum deflection angle of the front wheels of the vehicle, the first turning radius and the first passing width satisfy a second formula; the second formula is: Among them, b is the body width of the vehicle, m is the wheelbase of the vehicle, d is the front overhang length of the vehicle, and w1 is the first passing width.
3. The path planning method according to claim 1, characterized in that: The determining of the second turning radius and the second passing width comprises: Acquire multiple road curvatures at multiple turning points of the path to be planned; the multiple turning points correspond to the multiple road curvatures one by one; Determine a turning point with the largest curvature among the multiple road curvatures as the maximum turning point; The second turning radius is determined according to the road curvature of the maximum turning point; the road curvature of the maximum turning point and the second turning radius satisfy a third formula; the third formula is: Wherein, r2 is the second turning radius, and K is the road curvature of the maximum turning point; The road width at the maximum turning point is obtained, and the obtained road width at the maximum turning point is used as the second passing width.
4. The path planning method according to claim 1, characterized in that: The determining of the path steering angle of the trailer at the maximum turning point, the initial forward direction angle of the tractor, the initial forward direction angle of the trailer, and the driving speed of the trailer includes: Acquire at least one road curvature on the path leading into the maximum turning point; the at least one road curvature on the path leading into the maximum turning point corresponds one-to-one to at least one entry point; Acquire at least one road curvature on the path leading out of the maximum turning point; the at least one road curvature on the path leading out of the maximum turning point corresponds one-to-one to at least one exit point; When the road curvature of the target entry point among the at least one entry point is less than or equal to a preset curvature, and the road curvature of the target exit point among the at least one exit point is less than or equal to the preset curvature, acquiring the heading of the target entry point and the heading of the target exit point; The path steering angle of the trailer at the maximum turning point is determined according to the heading of the target entry point and the heading of the target exit point; the heading of the target entry point, the heading of the target exit point and the path steering angle satisfy a fourth formula; the fourth formula is: β=|∠A-∠B|; Wherein, β is the path steering angle of the trailer at the maximum turning point, ∠A is the heading of the target entry point, and ∠B is the heading of the target exit point; Determining the heading of the target entry point as the initial forward direction angle of the tractor and the initial forward direction angle of the trailer; A preset driving speed is obtained, and the obtained preset driving speed is used as the driving speed of the trailer.
5. The path planning method according to claim 4, characterized in that: The method of determining a minimum passing width set at multiple heading angles of the trailer according to the wheelbase of the tractor, the maximum deflection angle of the front wheels of the tractor, the body width of the tractor, the wheelbase of the tractor, the front overhang length of the tractor, the wheelbase of the trailer, the initial heading angle of the tractor, the initial heading angle of the trailer and the driving speed of the trailer comprises: performing a first operation for each of the plurality of steering angles to obtain a minimum passing width at the plurality of steering angles of the trailer; The first operation is: based on the wheelbase of the tractor, the maximum deflection angle of the front wheels of the tractor, the body width of the tractor, the wheelbase of the tractor, the front overhang length of the tractor, the wheelbase of the trailer, the initial forward direction angle of the tractor, the initial forward direction angle of the trailer and the driving speed of the trailer, determine a minimum passing width set at multiple forward direction angles of the trailer, and select the minimum passing width with the largest value from the minimum passing width set to determine it as the minimum passing width of the trailer at the target turning angle; The minimum forward direction angle of the multiple forward direction angles of the trailer is the initial forward direction angle of the tractor; the difference between the maximum forward direction angle of the multiple forward direction angles of the trailer and the initial forward direction angle of the tractor is equal to the target steering angle; the target steering angle is any one of the multiple steering angles.
6. The path planning method according to claim 5, characterized in that: The method of determining a minimum pass width set at multiple heading angles of the trailer based on the wheelbase of the tractor, the maximum deflection angle of the front wheels of the tractor, the body width of the tractor, the wheelbase of the tractor, the front overhang length of the tractor, the wheelbase of the trailer, the initial heading angle of the tractor, the initial heading angle of the trailer and the driving speed of the trailer comprises: Determine the difference between the current heading angle of the tractor and the current heading angle of the trailer based on the wheelbase of the tractor, the maximum deflection angle of the front wheels of the tractor, the wheelbase of the trailer, the travel speed of the towing vehicle, the current heading angle of the tractor and the current heading angle of the trailer, and determine the difference as the current heading angle difference corresponding to the current heading angle of the towing vehicle; Determine the next heading angle of the tractor adjacent to the current heading angle of the tractor, and the next heading angle of the trailer adjacent to the current heading angle of the trailer, until a plurality of current heading angle differences corresponding to a plurality of heading angles of the trailer are determined; the current heading angle of the trailer is the same as the current heading angle of the tractor; the initial heading angle of the current heading angle of the tractor is the initial heading angle of the tractor; the initial heading angle of the current heading angle of the trailer is the initial heading angle of the trailer; Performing a second operation on the multiple current forward direction angle differences, the wheelbase of the tractor, the maximum deflection angle of the front wheels of the tractor, the body width of the tractor, the wheelbase of the tractor, the front overhang length of the tractor, and the wheelbase of the trailer to obtain the minimum passing width set; The second operation includes: The minimum passing width at the current forward direction angle of the trailer is determined based on the current forward direction angle difference, the wheelbase of the tractor, the maximum deflection angle of the front wheels of the tractor, the body width of the tractor, the wheelbase of the tractor, the front overhang length of the tractor and the wheelbase of the trailer.
7. The path planning method according to claim 6, characterized in that: The current forward direction angle of the tractor, the current forward direction angle of the trailer and the difference between the current forward direction angles satisfy the fifth formula; the fifth formula is: γ=θ1-θ0; Wherein, γ is the current forward direction angle difference, θ0 is the current forward direction angle of the tractor, and θ1 is the current forward direction angle of the trailer; The wheelbase of the tractor, the maximum deflection angle of the front wheels of the tractor, the travel speed of the trailer, the current forward direction angle of the tractor and the next forward direction angle of the tractor satisfy the sixth formula; the sixth formula is: Wherein, l1 is the wheelbase of the tractor, α is the maximum deflection angle of the front wheels of the tractor, v is the travel speed of the trailer, and θ 0+t is the next forward direction angle of the tractor; The wheelbase of the trailer, the travel speed of the towing vehicle, the current forward direction angle of the tractor, the current forward direction angle of the trailer and the next forward direction angle of the trailer satisfy the seventh formula; the seventh formula is: Wherein, l2 is the wheelbase of the trailer, and θ 1+t is the next forward direction angle of the trailer, and θ1 is the current forward direction angle of the trailer; The current forward direction angle difference, the wheelbase of the tractor, the maximum deflection angle of the front wheels of the tractor, the body width of the tractor, the wheelbase of the tractor, the front overhang length of the tractor, the wheelbase of the trailer, and the minimum passing width of the trailer at the current forward direction angle satisfy the eighth formula; the eighth formula is: Wherein, b1 is the body width of the tractor, m1 is the wheelbase of the tractor, d1 is the front overhang length of the tractor, and w2 is the minimum passing width of the trailer at the current forward direction angle.
8. The path planning method according to any one of claims 1 to 7, characterized in that: When there are multiple paths to be planned, determining the path to be planned as a target path includes: Acquire a plurality of road data corresponding one to one to a plurality of paths to be planned; Determining a plurality of travel costs corresponding one-to-one to the plurality of paths to be planned according to the plurality of road data and the weight corresponding to each road data; A to-be-planned path corresponding to a to-be-planned path that satisfies a preset condition is selected from the multiple toll costs, and the selected to-be-planned path is determined as the target path.
9. A path planning device, characterized in that: include: Processing unit; The processing unit is used to determine a first turning radius and a first passing width; the first turning radius is the minimum turning radius of the vehicle; the first passing width is the minimum passing width of the vehicle; When the vehicle is a trailer, the trailer includes a tractor and a trailer; the determining the first turning radius and the first passing width includes: obtaining the wheelbase of the tractor and the maximum deflection angle of the front wheels of the tractor; According to the wheelbase of the tractor and the maximum deflection angle of the front wheels of the tractor, determine that the minimum turning radius of the tractor is the first turning radius; obtain the body width of the tractor, the wheelbase of the tractor, the front overhang length of the tractor and the wheelbase of the trailer; determine the path steering angle of the trailer at the maximum turning point, the initial forward direction angle of the tractor, the initial forward direction angle of the trailer and the driving speed of the trailer; according to the wheelbase of the tractor, the maximum deflection angle of the front wheels of the tractor, the body width of the tractor, the wheelbase of the tractor, the front overhang length of the tractor, the wheelbase of the trailer, the initial forward direction angle of the tractor, the initial forward direction angle of the trailer and the driving speed of the trailer, determine the minimum passing width at multiple turning angles of the trailer; from the minimum passing widths of the trailer at the multiple turning angles, select the minimum passing width corresponding to the path steering angle and determine it as the first passing width; The processing unit is further used to determine a second turning radius and a second passing width; the second turning radius is the minimum turning radius of the path to be planned at the maximum turning point; the second passing width is the road width of the path to be planned at the maximum turning point; The processing unit is further configured to determine that the to-be-planned path is a target path when the first turning radius is smaller than or equal to the second turning radius and the first passing width is smaller than or equal to the second passing width.
10. The path planning device according to claim 9, characterized in that: The processing unit is specifically used for: Obtaining the wheelbase and maximum front wheel deflection angle of the vehicle; The first turning radius is determined according to the wheelbase of the vehicle and the maximum deflection angle of the front wheels of the vehicle; the wheelbase of the vehicle, the maximum deflection angle of the front wheels of the vehicle and the first turning radius satisfy a first formula; the first formula is: Wherein, r1 is the first turning radius, l is the wheelbase of the vehicle, and θ is the maximum deflection angle of the front wheels of the vehicle; Obtaining the body width, wheelbase and front overhang length of the vehicle; The first passing width is determined according to the wheelbase of the vehicle, the maximum deflection angle of the front wheels of the vehicle, the first turning radius, the body width of the vehicle, the wheelbase of the vehicle and the front overhang length of the vehicle; the body width of the vehicle, the wheelbase of the vehicle, the front overhang length of the vehicle, the wheelbase of the vehicle, the maximum deflection angle of the front wheels of the vehicle, the first turning radius and the first passing width satisfy a second formula; the second formula is: Among them, b is the body width of the vehicle, m is the wheelbase of the vehicle, d is the front overhang length of the vehicle, and w1 is the first passing width.
11. The path planning device according to claim 9, characterized in that: The processing unit is specifically used for: Acquire multiple road curvatures at multiple turning points of the path to be planned; the multiple turning points correspond to the multiple road curvatures one by one; Determine a turning point with the largest curvature among the multiple road curvatures as the maximum turning point; The second turning radius is determined according to the road curvature of the maximum turning point; the road curvature of the maximum turning point and the second turning radius satisfy a third formula; the third formula is: Wherein, r2 is the second turning radius, and K is the road curvature of the maximum turning point; The road width at the maximum turning point is obtained, and the obtained road width at the maximum turning point is used as the second passing width.
12. The path planning device according to claim 9, characterized in that: The processing unit is specifically used for: Acquire at least one road curvature on the path leading into the maximum turning point; the at least one road curvature on the path leading into the maximum turning point corresponds one-to-one to at least one entry point; Acquire at least one road curvature on the path leading out of the maximum turning point; the at least one road curvature on the path leading out of the maximum turning point corresponds one-to-one to at least one exit point; When the road curvature of the target entry point among the at least one entry point is less than or equal to a preset curvature, and the road curvature of the target exit point among the at least one exit point is less than or equal to the preset curvature, acquiring the heading of the target entry point and the heading of the target exit point; Determining a path steering angle of the trailer at the maximum turning point according to the heading of the target entry point and the heading of the target exit point; The heading of the target entry point, the heading of the target exit point and the path turning angle satisfy a fourth formula; the fourth formula is: β=|∠A-∠B|; Wherein, β is the path steering angle of the trailer at the maximum turning point, ∠A is the heading of the target entry point, and ∠B is the heading of the target exit point; Determining the heading of the target entry point as the initial forward direction angle of the tractor and the initial forward direction angle of the trailer; A preset driving speed is obtained, and the obtained preset driving speed is used as the driving speed of the trailer.
13. The path planning device according to claim 12, characterized in that: The processing unit is specifically used for: performing a first operation for each of the plurality of steering angles to obtain a minimum passing width at the plurality of steering angles of the trailer; The first operation is: based on the wheelbase of the tractor, the maximum deflection angle of the front wheels of the tractor, the body width of the tractor, the wheelbase of the tractor, the front overhang length of the tractor, the wheelbase of the trailer, the initial forward direction angle of the tractor, the initial forward direction angle of the trailer and the driving speed of the trailer, determine a minimum passing width set at multiple forward direction angles of the trailer, and select the minimum passing width with the largest value from the minimum passing width set to determine it as the minimum passing width of the trailer at the target turning angle; The minimum forward direction angle of the multiple forward direction angles of the trailer is the initial forward direction angle of the tractor; The difference between the maximum forward direction angle of the multiple forward direction angles of the trailer and the initial forward direction angle of the tractor is equal to the target steering angle; The target steering angle is any one of the multiple steering angles.
14. The path planning device according to claim 13, characterized in that: The processing unit is specifically used for: Determine the difference between the current heading angle of the tractor and the current heading angle of the trailer based on the wheelbase of the tractor, the maximum deflection angle of the front wheels of the tractor, the wheelbase of the trailer, the travel speed of the towing vehicle, the current heading angle of the tractor and the current heading angle of the trailer, and determine the difference as the current heading angle difference corresponding to the current heading angle of the towing vehicle; Determine the next heading angle of the tractor adjacent to the current heading angle of the tractor, and the next heading angle of the trailer adjacent to the current heading angle of the trailer, until a plurality of current heading angle differences corresponding to a plurality of heading angles of the trailer are determined; the current heading angle of the trailer is the same as the current heading angle of the tractor; the initial heading angle of the current heading angle of the tractor is the initial heading angle of the tractor; The initial forward direction angle of the current forward direction angle of the trailer is the initial forward direction angle of the trailer; Performing a second operation on the multiple current forward direction angle differences, the wheelbase of the tractor, the maximum deflection angle of the front wheels of the tractor, the body width of the tractor, the wheelbase of the tractor, the front overhang length of the tractor, and the wheelbase of the trailer to obtain the minimum passing width set; The second operation includes: The minimum passing width at the current forward direction angle of the trailer is determined based on the current forward direction angle difference, the wheelbase of the tractor, the maximum deflection angle of the front wheels of the tractor, the body width of the tractor, the wheelbase of the tractor, the front overhang length of the tractor and the wheelbase of the trailer.
15. The path planning device according to claim 14, characterized in that: The current forward direction angle of the tractor, the current forward direction angle of the trailer and the difference between the current forward direction angles satisfy the fifth formula; the fifth formula is: γ=θ1-θ0; Wherein, γ is the current forward direction angle difference, θ0 is the current forward direction angle of the tractor, and θ1 is the current forward direction angle of the trailer; The wheelbase of the tractor, the maximum deflection angle of the front wheels of the tractor, the travel speed of the trailer, the current forward direction angle of the tractor and the next forward direction angle of the tractor satisfy the sixth formula; the sixth formula is: Wherein, l1 is the wheelbase of the tractor, α is the maximum deflection angle of the front wheels of the tractor, v is the travel speed of the trailer, and θ 0+t is the next forward direction angle of the tractor; The wheelbase of the trailer, the travel speed of the towing vehicle, the current forward direction angle of the tractor, the current forward direction angle of the trailer and the next forward direction angle of the trailer satisfy the seventh formula; the seventh formula is: Wherein, l2 is the wheelbase of the trailer, and θ 1+t is the next forward direction angle of the trailer, and θ1 is the current forward direction angle of the trailer; The current forward direction angle difference, the wheelbase of the tractor, the maximum deflection angle of the front wheels of the tractor, the body width of the tractor, the wheelbase of the tractor, the front overhang length of the tractor, the wheelbase of the trailer, and the minimum passing width of the trailer at the current forward direction angle satisfy the eighth formula; the eighth formula is: Wherein, b1 is the body width of the tractor, m1 is the wheelbase of the tractor, d1 is the front overhang length of the tractor, and w2 is the minimum passing width of the trailer at the current forward direction angle.
16. The path planning device according to any one of claims 9 to 15, characterized in that: The processing unit is specifically used for: Acquire a plurality of road data corresponding one to one to a plurality of paths to be planned; Determining a plurality of travel costs corresponding one-to-one to the plurality of paths to be planned according to the plurality of road data and the weight corresponding to each road data; A to-be-planned path corresponding to a to-be-planned path that satisfies a preset condition is selected from the multiple toll costs, and the selected to-be-planned path is determined as the target path.
17. A path planning device, characterized in that: It includes a memory and a processor; the memory is used to store computer-executable instructions, and the processor is connected to the memory through a bus; when the path planning device is running, the processor executes the computer-executable instructions stored in the memory, so that the path planning device executes the path planning method as described in any one of claims 1-8.
18. A computer-readable storage medium, characterized in that: The computer-readable storage medium includes computer-executable instructions, and when the computer-executable instructions are executed on a computer, the computer is enabled to execute the path planning method according to any one of claims 1 to 8.
