WO2022247899A1

WO2022247899A1 - Traveling route planning method and apparatus, storage medium, and mobile apparatus

Info

Publication number: WO2022247899A1
Application number: PCT/CN2022/095190
Authority: WO
Inventors: 张文君; 范小军
Original assignee: 北京迈格威科技有限公司
Priority date: 2021-05-28
Filing date: 2022-05-26
Publication date: 2022-12-01
Also published as: CN113449827A

Abstract

Provided in the present application are a traveling route planning method and apparatus, a storage medium, and a mobile apparatus. The method comprises: acquiring a traveling route and a configuration file of an automated navigation mobile apparatus within a calibration area, wherein the configuration file comprises a motion restriction condition for the automated navigation mobile apparatus at each position in the calibration area; and verifying, according to the configuration file, whether the motion restriction condition for a corresponding position is met when the automated navigation mobile apparatus travels according to the traveling route, and determining a final traveling route according to a verification result. By means of the technical solution of the present application, the safety of the generated final traveling route can be improved.

Description

A driving route planning method, device, storage medium and mobile device

This application claims the priority of the Chinese patent application submitted to the China Patent Office on May 28, 2021, with the application number 202110591640.4, and the title of the invention is "A driving route planning method, device, storage medium and mobile device", the entire content of which Incorporated in this application by reference.

technical field

The present application relates to the technical field of intelligent control, in particular, to a driving route planning method, device, storage medium and mobile device.

Background technique

With the rapid development of warehousing and logistics technology, AGV (Automated Guided Vehicle, automatic guided vehicle) and other moving vehicles are widely used in fields such as e-commerce and smart factories to transport goods stored in warehouses. There are areas planned in the warehouse that can be used by transport vehicles. Two-dimensional codes are set on the ground in these areas. The transport vehicles plan the driving route by recognizing the two-dimensional code on the ground, and complete the connection of goods according to the driving route. However, planning the driving route based on the two-dimensional code on the ground cannot determine the space conditions on the driving route, which may cause the truck to collide with the limit bracket in the driving area, causing safety accidents.

Contents of the invention

The problem solved by this application is how to improve the safety of the automatic navigation mobile device during driving.

In order to solve the above problems, the present application provides a driving route planning method, device, storage medium and automatic navigation mobile device.

In the first aspect, the embodiment of the present application provides a driving route planning method, including:

Acquiring the driving route and configuration file of the automatic navigation mobile device in the marked area, the configuration file including the movement restriction conditions of the automatic navigation mobile device at each position in the marked area;

Check whether the automatic navigation mobile device satisfies the motion restriction condition of the corresponding position when driving according to the driving route according to the configuration file, and determine the final driving route according to the verification result.

Optionally, in some embodiments, the checking according to the configuration file whether the automatic navigation mobile device satisfies the movement restriction condition of the corresponding location when driving according to the driving route includes:

Determining motion indications of the automatic navigation mobile device at multiple positions on the driving route according to the driving route, and judging whether each of the motion indications meets the movement restriction condition of the corresponding position.

Optionally, in some embodiments, the motion indication includes a steering indication, and the motion restriction condition includes a steering restriction condition,

The judging whether each of the motion indications meet the motion restriction condition of the corresponding position includes:

judging whether the steering instructions at multiple positions on the driving route comply with the corresponding steering restriction conditions;

The determination of the final driving route according to the verification result includes:

If each of the steering instructions meets the corresponding steering restriction conditions, then determine the driving route as the final driving route; if at least one of the steering instructions does not meet the corresponding steering restriction conditions, restart The driving route is obtained for verification until the final driving route is determined.

Optionally, in some embodiments, the steering restriction condition includes a rotation angle range,

The judging whether the steering instructions at multiple positions on the driving route comply with the corresponding steering restriction conditions includes:

For any position on the driving route, if the rotation angle corresponding to the steering indication is within the range of the rotation angle, it means that the steering indication at the position complies with the steering restriction condition at the position; if the If the rotation angle corresponding to the steering indication is not within the rotation angle range, it means that the steering indication at the position does not comply with the steering restriction condition at the position.

Optionally, in some embodiments, the motion restriction condition includes a maximum rotation angle, and the method further includes:

If the automatic navigation mobile device deviates from the final driving route during driving, then obtain the lateral deviation of the automatic navigation mobile device at the current position;

generating a trimming angle based on the lateral deviation;

If the correction angle is less than or equal to the maximum rotation angle of the current position, then generate control information of the current position, the control information includes controlling the automatic navigation mobile device to rotate according to the correction angle; if the If the correction angle is greater than the maximum rotation angle of the current position, control information of the current position is generated, and the control information includes controlling the automatic navigation mobile device to rotate according to the maximum rotation angle.

Optionally, in some embodiments, the method also includes:

Obtaining map information of the marked area, the map information including road parameters of each road in the marked area;

Combining the road parameters of the roads in the marked area and the equipment parameters of the automatic navigation mobile device, the movement restriction conditions of the automatic navigation mobile device at each position in the marked area are determined.

Optionally, in some embodiments, information codes are set at intersections of various roads, the movement restriction conditions include steering restriction conditions, and the determination of the position of the automatic navigation mobile device in each position of the marked area Movement restrictions include:

For any of the information codes, determine all roads to be selected connected to the intersection where the information code is located;

According to the road parameters of each of the candidate roads and the equipment parameters of the automatic navigation mobile device, analyze whether the automatic navigation mobile device can drive into each of the candidate roads, and determine the automatic navigation according to the analysis results The turning restriction condition of the mobile device at the intersection where the information code is located.

Optionally, in some embodiments, the movement restriction condition includes a maximum rotation angle, and the determination of the movement restriction condition of each position of the automatic navigation mobile device in the marked area further includes:

For any position in the marked area, the maximum rotation angle of the automatic navigation mobile device at the position is determined according to the road parameters of the position and the equipment parameters of the automatic navigation mobile device.

In the second aspect, the embodiment of the present application provides a computer-readable storage medium, on which a computer program is stored, and when the computer program is executed by a processor, the driving route planning method as described above is realized.

In a third aspect, the embodiment of the present application provides an automatic navigation mobile device, including a memory and a processor;

The memory is used to store computer programs;

The processor is configured to implement the driving route planning method as described above when executing the computer program.

In a fourth aspect, an embodiment of the present application provides a computer program product, including a computer program, and when the computer program is executed by a processor, the above driving route planning method is implemented.

The beneficial effect of the driving route planning method, device, storage medium and automatic navigation mobile device of the embodiment of the present application is: after obtaining the driving route, check whether the automatic navigation mobile device satisfies the requirements of the corresponding position when driving according to the driving route according to the configuration file. The motion restriction conditions determine the final driving route, which can greatly improve the safety of the generated final driving route, ensure the safety of the automatic navigation mobile device when driving according to the final driving route, and improve the ability of the automatic navigation mobile device to deal with complex terrain. The application scenarios of automatic navigation mobile devices.

Description of drawings

FIG. 1 is a schematic structural diagram of an automatic navigation mobile device according to an embodiment of the present application;

FIG. 2 is a schematic flow diagram of a driving route planning method according to an embodiment of the present application;

FIG. 3 is a schematic structural diagram of a driving route planning device according to an embodiment of the present application.

specific embodiment

In order to make the above purpose, features and advantages of the present application more obvious and understandable, specific embodiments of the present application will be described in detail below in conjunction with the accompanying drawings.

It should be noted that the terms "first" and "second" in the description and claims of the present application and the above drawings are used to distinguish similar objects, but not necessarily used to describe a specific sequence or sequence. It is to be understood that the data so used are interchangeable under appropriate circumstances such that the embodiments of the application described herein can be practiced in sequences other than those illustrated or described herein.

The warehouse in the prior art is usually divided into an area where the automatic navigation mobile device can travel, and the limit outside the area is limited by devices such as limit brackets to prevent the automatic navigation mobile device from rushing out of the specified area and colliding with goods, etc., causing safety hazards. ACCIDENT.

The technical solution of the present application can be applied not only to AGVs, AMRs, forklifts, container trucks, pallet trucks and other moving vehicles that drive automatically, but also to any other automatic navigation mobile devices that drive along a specified path, and can also be applied to Any other self-navigating mobile device that uses at least one sensor among laser sensors, vision sensors, ultrasonic sensors and infrared sensors to achieve autonomous movement.

As shown in Figure 1, an automatic navigation mobile device provided by an embodiment of the present application includes a memory and a processor; the memory is used to store a computer program; and the processor is used to realize when the computer program is executed. The driving route planning method is described below.

As shown in Figure 2, a driving route planning method provided by the embodiment of the present application, the execution subject of this method may be a host computer such as a computer and a server, or may be a processor of an automatic navigation mobile device, etc. The method includes:

Step S110, acquiring the driving route and configuration file of the automatic navigation mobile device in the marked area, the configuration file including the movement restriction conditions of each position of the automatic navigation mobile device in the marked area.

Wherein, the calibration area can be an area in the warehouse where the automatic navigation mobile device can drive, and the driving route and configuration file can be saved in the memory of the automatic navigation mobile device or in the server. If the configuration file is saved in the server, the automatic navigation mobile device will automatically read the configuration file from the server and cache it in its own storage medium when it is first registered and powered on; if the configuration file is large, the automatic navigation mobile device will cache the current configuration file. The corresponding part of the configuration file near the map, and then judge whether it is necessary to re-acquire other part of the configuration file according to the situation when running to other areas later. If the corresponding configuration file has been cached in the current region, it will not be retrieved again. In this way, the automatic navigation mobile device can obtain the configuration file of the corresponding area in a relatively strong real-time manner during operation.

Optionally, the road map of the marked area and the driving task of the automatic navigation mobile device can be obtained in advance to determine the driving route. The driving task includes the starting point and the end point of the automatic navigation mobile device, and the starting point and the ending point are randomly based on the road map or a path planning algorithm is used. The specific process of generating the driving route of the automatic navigation mobile device in the calibration area and generating the driving route between two points based on the road map is the prior art, and will not be repeated here. Similarly, movement restriction conditions for each location in the marked area can be pre-configured to restrict the movement of the automatic navigation mobile device at each location.

Step S120, verifying whether the automatic navigation mobile device satisfies the movement restriction condition of the corresponding position when driving along the driving route according to the configuration file, and determining the final driving route according to the verification result.

Specifically, the verification process is as follows: when the automatic navigation mobile device is driving according to the driving route, it is determined whether the actions at each position on the driving route meet the movement restriction conditions of each position. When the actions of the automatic navigation mobile device at each position on the driving route meet the corresponding movement restriction conditions, the verification is passed, indicating that the automatic navigation mobile device will not collide with other devices when driving according to the driving route, so it is determined that the driving The route is the final driving route; when the action of the automatic navigation mobile device on at least one position on the driving route does not meet the corresponding movement restriction conditions, it fails the verification, indicating that safety accidents such as collisions may occur when driving according to the driving route. Therefore, this driving route cannot be identified as the final driving route, and a new driving route needs to be acquired for verification until the final driving route is determined.

In this embodiment, after obtaining the driving route, check whether the automatic navigation mobile device satisfies the motion restriction conditions of the corresponding position when driving according to the driving route according to the configuration file, and determine the final driving route, which can greatly improve the safety of the generated final driving route It ensures the safety of the automatic navigation mobile device when driving according to the final driving route, improves the ability of the automatic navigation mobile device to deal with complex terrain, and expands the application scenarios of the automatic navigation mobile device. Optionally, in an embodiment, the driving route planning method also includes:

Combining the road parameters of each road in the marked area and the equipment parameters of the automatic navigation mobile device to determine the movement restriction conditions of the automatic navigation mobile device at each position in the marked area.

Specifically, the configuration file can be manually configured, or automatically configured according to road parameters and equipment parameters of the automatic navigation device. The road parameters may include the width and height of the road, etc., and the equipment parameters include the height and width of the automatic navigation mobile device. For any position on the road, combine the road parameters of the position and the size of the automatic navigation mobile device to determine the movement restriction conditions .

For example: for the intersection of two roads, if the width of one of the roads is smaller than the width of the automatic navigation mobile device, the movement restriction conditions corresponding to the intersection include prohibiting driving into the road; The width of the navigation mobile device, and the height limit of the road is also higher than the height of the automatic navigation mobile device, etc., then the movement restriction conditions corresponding to the intersection include allowing the automatic navigation mobile device to enter the road. Further, at this time, the movement restriction conditions corresponding to the intersection may specifically include the angle at which the automatic navigation mobile device is allowed to turn when it is at the intersection, wherein, for an automatic navigation mobile device that can move in all directions, it can walk in any direction and Turning in place, you only need to consider whether the size of the changed direction meets the road parameters of the road; for the automatic navigation mobile device that cannot move in all directions, the allowable steering angle range is related to the front orientation of the automatic navigation mobile device. For example, suppose the current location of the automatic navigation mobile device is connected to two roads, wherein the first road extends eastward from the current location, and the second road extends southward from the current location. If the front of the automatic navigation mobile device is facing north at this time, the vehicle The tail is facing south, that is, the automatic navigation mobile device may enter the current position from the second road. At this time, the movement restriction condition of this position is to allow a right turn of 90 degrees, and a left or right turn of 180 degrees, and if at this time The front of the automatic navigation device faces west, and the rear of the car faces east, that is, the automatic navigation mobile device may drive into the current position from the first road. Turn right 180 degrees. And it can also be specific to the angle range of the steering, assuming that the angle range of the allowable steering includes -8°～8°, which means that under the current position and the current head orientation, the automatic navigation mobile device can turn left 8 degrees and turn right 8 degrees. Turn within the range of intervals, where "-" means left.

Optionally, in another embodiment, information codes are set at intersections of each road, the movement restriction conditions include steering restriction conditions, and the determination of all positions of the automatic navigation mobile device in each position of the marked area The exercise restrictions mentioned above include:

Specifically, in the prior art, when the automatic navigation mobile device transports goods in the warehouse, the real-time position of the automatic navigation mobile device is often determined by scanning the information code on the ground. The information code includes two-dimensional codes, bar codes and other signs that can store information , since the road parameters at various locations on the same road are usually the same, such as the width and height limit, etc., the information code is often set at a key position in the route, such as an intersection where multiple roads intersect or where road parameters change location etc. For any information code position, determine whether the automatic navigation mobile device can drive into the road adjacent to the information code position, if it can drive into the left-turn road connected to the information code position, it cannot drive into the road connected to the information code position If there is a right-turning road, the movement restriction conditions of the information code position include being able to turn left and not turning right, and then setting the configuration file of the position of the information point, for example: if the coordinate point {500, 500, 1} cannot be rotated, Set a configuration file for this point, the content of the configuration file can include [rotate]x=500, y=500, z=1, unrotate=1, where x represents the X-axis coordinate, y represents the Y-axis coordinate, z represents the Z Axis coordinates, unrotate indicates the rotation restriction condition, when it is set to 1, it means that it cannot be rotated, and when it is set to 0, it means that it can be rotated.

In addition to configuring the rotation restriction conditions for the location of each information code, you can also set the configuration file for the specified area according to the coordinates or the map of the information code location. If you need to restrict the rotation of all points in a certain area, that is, within the area All points cannot be rotated. For example, the starting points of a straight line area (straight road) are {500, 500, 1}, {500, 10500, 1} respectively, then the configuration file of this area can include [rotate]x=500, y=500-10500, z=1, unrotate=1.

Optionally, in yet another embodiment, the movement restriction condition includes a maximum rotation angle, and the determination of the movement restriction condition of each position of the automatic navigation mobile device in the marked area includes:

For any position in the marked area, determine the maximum rotation angle of the automatic navigation mobile device at the position according to the road parameters of the position and the equipment parameters of the automatic navigation mobile device.

Specifically, the road parameters such as width, height limit, and direction of each position in any road are basically the same. For two roads, for example: if there are two adjacent roads in a straight road, one of which has a width of 3 meters and the other has a width of 2 meters, and the change value of the width of 1 meter exceeds the preset threshold, Then the two sections of roads can be regarded as two different roads, and information codes need to be set at the junction of the two sections of roads. Therefore, for each position in each road where the road parameters are consistent, the movement restriction conditions of the automatic navigation mobile device at each position in each road are consistent.

In this optional embodiment, combine the road parameters of each road in the marked area and the size of the automatic navigation mobile device to determine the movement restriction conditions at each position. Devices collide, so using motion constraints to validate the travel path increases the safety of the resulting final travel path.

Optionally, in yet another embodiment, the checking according to the configuration file whether the automatic navigation mobile device satisfies the movement restriction condition of the corresponding location when driving according to the driving route includes:

Specifically, for an automatic navigation mobile device that can move in all directions, the movement instruction includes a steering instruction, etc., and the steering instruction includes whether the automatic navigation mobile device turns right or left, the angle range that can be turned, and the like. When verifying the driving route, each position on the driving route or the movement indication of the location of the information code can be verified sequentially in the order from the starting point to the end point, and the configuration file can be automatically read in advance and cached in the memory. If the calibration area If the entire configuration file is large, you can first cache the movement restriction conditions of each position in the vicinity of the current verified position (such as the current position as the center and a radius of 10 meters) into the memory. During the verification process, Read the movement restriction conditions of the corresponding position in real time.

Optionally, in yet another embodiment, the movement indication includes a turning indication, the movement restriction condition includes a steering restriction condition, and the judging whether each of the movement indications meets the movement restriction condition of the corresponding position includes:

If each of the steering instructions meets the corresponding steering restriction condition, then determine the driving route as the final driving route; if at least one of the steering instructions does not meet the corresponding steering restriction condition, Then the driving route is reacquired for verification until the final driving route is determined or all driving routes are verified.

Optionally, the steering restriction condition includes a rotation angle range, and the judging whether the steering instructions at multiple positions on the driving route comply with the corresponding steering restriction condition includes:

Specifically, for any position on the driving route, if the steering instruction at this position is a 90° right turn, and the steering restriction at this position includes a rotation angle range of -8° to 8°, since 90° > 8° , so the rotation indication of this position on the driving route does not meet the steering restriction conditions of this position, then the driving route fails the verification, and the pre-stored driving route needs to be retrieved, or the driving route should be regenerated according to the starting point and the ending point, for example: If the driving route is a-c-b, then regenerate the driving route a-d-b. If the steering instructions at each location meet the corresponding steering restriction conditions, it means that the driving route has passed the verification, and the driving route is the final driving route.

In this optional embodiment, for any position on the driving route, the priority of the movement restriction condition is higher than the priority of the movement indication. If the steering indication of this position conflicts with the rotation restriction condition of this position, the position cannot If the steering is performed, correspondingly, the driving route cannot be continued, so it is necessary to return to obtain or generate a new driving route. Through the verification of the driving route by the steering restriction condition, the driving route that does not meet the steering restriction condition can be filtered out, that is, the driving route that may cause a safety accident can be filtered out, thereby improving the safety of the final output driving route.

Optionally, in yet another embodiment, the method further includes:

If the automatic navigation mobile device deviates from the final driving route during driving, acquiring the lateral deviation of the automatic navigation mobile device at the current position;

generating a trimming angle based on the lateral deviation;

If the correction angle is less than or equal to the maximum rotation angle of the current position, generate control information of the current position, the control information includes controlling the automatic navigation mobile device to rotate according to the correction angle; if the correction angle is greater than the maximum rotation angle of the current position, and generates control information of the current position, where the control information includes controlling the automatic navigation mobile device to rotate according to the maximum rotation angle.

Most of the automatic navigation mobile devices use omnidirectional wheels, etc., which can move in all directions. During the driving process, the body is prone to deviation. When driving according to the driving route, if it deviates from the driving route at a certain position, it needs to be corrected. The autopilot mobile device is back on the driving route. The correction angle refers to the angle of rotation needed to correct the current lateral deviation. It has a direction, which can be distinguished by "+" and "-". "-" means turn left, and "+" means turn right. It should be noted that the rotation angle range of each position corresponds to the direction that the position is allowed to rotate, assuming that the rotation angle range is -8° to 8°, which is the range between 8° left rotation and 8° right rotation. The location allows both left and right turns. In this embodiment, after the correction angle is generated according to the lateral deviation, it is also possible to determine whether the automatic navigation mobile device can perform correction at the current position according to the correction angle and the rotation angle range of the current position; when the rotation direction of the correction angle Satisfying the allowable rotation direction of the position means that the deviation correction can be performed; otherwise, it means that the deviation correction cannot be performed. For example, if the correction angle of this position is that the vehicle body turns right 90°, and the rotation angle range of this position is -8°～0, it means that the automatic navigation mobile device at this position can only rotate to the left, and the rotation direction of the correction angle is related to the movement The constraints allow a different direction of rotation, so no rotation is done at this location.

If deflection correction is possible, compare the deflection angle with the maximum rotation angle. Among them, the maximum rotation angle is the maximum rotation angle in the direction of the correction rotation, such as the boundary value of the rotation angle range, if the correction angle of this position is that the vehicle body turns right 90°, and the maximum allowable rotation angle of the same rotation direction at this position is 8°, because 90°>8°, the correction angle exceeds the maximum angle that the automatic navigation device can rotate at present, then control the vehicle body of the automatic navigation mobile device to turn right 8° and continue driving, and continue at the subsequent rotatable position Adjust until the lateral deviation of the autopilot mobile device is corrected and it returns to the driving path. Correspondingly, if the rotation angle indicated by the deviation correction is within the range of the rotation angle, the automatic navigation mobile device is controlled to rotate according to the deviation correction instruction and then continue driving.

In this optional embodiment, when the automatic navigation mobile device deviates from the driving route, the deviation is corrected in time, so that the automatic navigation mobile device returns to the driving route, which can prevent the automatic navigation mobile device from deviating from the driving route and cause collisions and other accidents, and complete the driving task . In addition, by restricting the rotation angle of the automatic navigation mobile device through the rotation restriction conditions, it is possible to prevent the automatic navigation mobile device from colliding with devices such as limit brackets during the deflection correction rotation process, causing safety accidents, even if the deflection correction angle exceeds the maximum rotation angle, it can Without affecting the driving of the automatic navigation mobile device, the deviation is corrected at the maximum rotation angle first, and then the deviation is gradually corrected during the subsequent driving process until returning to the driving route, which improves the safety and security of the automatic navigation mobile device during driving. reliability.

Optionally, in yet another embodiment, the method further includes: outputting the final driving route, and controlling the automatic navigation mobile device to drive according to the final driving route.

In this optional embodiment, after determining the final driving route that meets the movement restriction conditions, the automatic navigation mobile device can be controlled to complete the driving task according to the driving route to realize the connection of goods, and the driving process will not interfere with the limit Collisions such as brackets improve the safety of the driving process.

As shown in FIG. 3 , a driving route planning device provided in an embodiment of the present application is used to execute the driving route planning method as described above, including:

An acquisition module, configured to acquire the driving route and configuration file of the automatic navigation mobile device in the calibration area, the configuration file including the movement restriction conditions of each position of the automatic navigation mobile device in the calibration area;

A verification module, configured to verify, according to the configuration file, whether the automatic navigation mobile device satisfies the movement restriction condition of the corresponding position when driving according to the driving route, and determine a final driving route according to the verification result.

Optionally, the verification module is specifically used for:

Optionally, the movement indication includes a steering indication, the movement restriction condition includes a steering restriction condition, and the verification module is further configured to:

Optionally, the steering restriction condition includes a range of rotation angles, and the verification module is further configured to:

Optionally, the device also includes a deviation correction module, and the deviation correction module is used for:

Generate a deviation correction angle according to the lateral deviation, and determine whether the automatic navigation mobile device can perform deviation correction at the current position according to the deviation correction angle and the rotation angle range of the current position;

If so, compare the maximum rotation angle in the correction angle and the rotation angle range;

If the correction angle is less than or equal to the maximum rotation angle of the current position, generate control information of the current position, the control information includes controlling the automatic navigation mobile device to rotate according to the correction angle; if the correction The declination angle is greater than the maximum rotation angle of the current position, and control information of the current position is generated, where the control information includes controlling the automatic navigation mobile device to rotate according to the maximum rotation angle.

Optionally, the device further includes a configuration module, the configuration module is used for:

Optionally, information codes are set at intersections of each road, the movement restriction conditions include steering restriction conditions, and the configuration module is specifically used for:

Optionally, the motion restriction condition includes a maximum rotation angle, and the configuration module is specifically further configured to:

A computer-readable storage medium provided by another embodiment of the present application stores a computer program, and when the computer program is executed by a processor, the above driving route planning method is realized.

The embodiment of the present application also provides a computer program product, including a computer program, which realizes the above driving route planning method when the computer program is executed by a processor.

Those of ordinary skill in the art can understand that all or part of the processes in the methods of the above embodiments can be implemented through computer programs to instruct related hardware, and the programs can be stored in a computer-readable storage medium. During execution, it may include the processes of the embodiments of the above-mentioned methods. Wherein, the storage medium may be a magnetic disk, an optical disk, a read-only memory (Read-Only Memory, ROM) or a random access memory (Random Access Memory, RAM), etc. In this application, the units described as separate components may or may not be physically separated, and the components displayed as units may or may not be physical units, that is, they may be located in one place, or may be distributed to multiple on a network unit. Part or all of the units can be selected according to actual needs to achieve the purpose of the solution of the embodiment of the present application. In addition, each functional unit in each embodiment of the present application may be integrated into one processing unit, each unit may exist separately physically, or two or more units may be integrated into one unit. The above-mentioned integrated units can be implemented in the form of hardware or in the form of software functional units.

Although the disclosure of the present application is as above, the scope of protection disclosed in the present application is not limited thereto. Those skilled in the art can make various changes and modifications without departing from the spirit and scope disclosed in the present application, and these changes and modifications will all fall within the protection scope of the present application.

Claims

A driving route planning method, comprising:

Acquiring the driving route and configuration file of the automatic navigation mobile device in the marked area, the configuration file including the movement restriction conditions of the automatic navigation mobile device at each position in the marked area;

Verifying according to the configuration file whether the automatic navigation mobile device satisfies the movement restriction condition of the corresponding position when driving according to the driving route, and determining the final driving route according to the verification result.
The driving route planning method according to claim 1, wherein the checking according to the configuration file whether the automatic navigation mobile device satisfies the movement restriction condition of the corresponding position when driving according to the driving route comprises:

Determining motion indications of the automatic navigation mobile device at multiple positions on the driving route according to the driving route, and judging whether each of the motion indications meets the movement restriction condition of the corresponding position.
The driving route planning method according to claim 2, wherein the movement indication includes a steering indication, and the movement restriction condition includes a steering restriction condition,

The judging whether each of the motion indications meet the motion restriction condition of the corresponding position includes:

judging whether the steering instructions at multiple positions on the driving route comply with the corresponding steering restriction conditions;

The determination of the final driving route according to the verification result includes:

If each of the steering instructions meets the corresponding steering restriction conditions, then determine the driving route as the final driving route; if at least one of the steering instructions does not meet the corresponding steering restriction conditions, restart The driving route is obtained for verification until the final driving route is determined.
The driving route planning method according to claim 3, wherein the steering restriction condition includes a rotation angle range,

The judging whether the steering instructions at multiple positions on the driving route comply with the corresponding steering restriction conditions includes:

For any position on the driving route, if the rotation angle corresponding to the steering indication is within the range of the rotation angle, it means that the steering indication at the position complies with the steering restriction condition at the position; if the If the rotation angle corresponding to the steering indication is not within the rotation angle range, it means that the steering indication at the position does not comply with the steering restriction condition at the position.
The driving route planning method according to any one of claims 1 to 4, wherein the movement restriction condition includes a maximum rotation angle, and the method further includes:

If the automatic navigation mobile device deviates from the final driving route during driving, acquiring the lateral deviation of the automatic navigation mobile device at the current position;

generating a trimming angle based on the lateral deviation;

If the correction angle is less than or equal to the maximum rotation angle of the current position, generate control information of the current position, the control information includes controlling the automatic navigation mobile device to rotate according to the correction angle; if the correction The declination angle is greater than the maximum rotation angle of the current position, and control information of the current position is generated, where the control information includes controlling the automatic navigation mobile device to rotate according to the maximum rotation angle.
The driving route planning method according to any one of claims 1 to 5, wherein the method further comprises:

Obtaining map information of the marked area, the map information including road parameters of each road in the marked area;

Combining the road parameters of the roads in the marked area and the equipment parameters of the automatic navigation mobile device, the movement restriction conditions of the automatic navigation mobile device at each position in the marked area are determined.
The driving route planning method according to claim 6, wherein information codes are set at the intersections of each road, the movement restriction conditions include steering restriction conditions, and the determination that the automatic navigation mobile device is in each of the marked areas The movement constraints of the position include:

For any of the information codes, determine all roads to be selected connected to the intersection where the information code is located;

According to the road parameters of each of the candidate roads and the equipment parameters of the automatic navigation mobile device, analyze whether the automatic navigation mobile device can drive into each of the candidate roads, and determine the automatic navigation according to the analysis results The turning restriction condition of the mobile device at the intersection where the information code is located.
The driving route planning method according to claim 6, wherein the movement restriction condition includes a maximum rotation angle, and the determination of the movement restriction condition of each position of the automatic navigation mobile device in the calibration area further includes:

For any position in the marked area, the maximum rotation angle of the automatic navigation mobile device at the position is determined according to the road parameters of the position and the equipment parameters of the automatic navigation mobile device.
A computer-readable storage medium, on which a computer program is stored, and when the computer program is executed by a processor, the driving route planning method according to any one of claims 1 to 8 is realized.
A self-navigating mobile device including a memory and a processor;

The memory is used to store computer programs;

The processor is configured to implement the driving route planning method according to any one of claims 1 to 8 when executing the computer program.
A computer program product, comprising a computer program, which implements the method according to any one of claims 1 to 8 when the computer program is executed by a processor.