Method, device, and system for controlling route of unmanned vehicle
A route control method for unmanned vehicles using landmarks on both road sides enables two-way traffic, addressing congestion issues and enhancing navigation efficiency.
Patent Information
- Application Number
- JP2021568594
- Authority / Receiving Office
- JP · JP
- Patent Type
- Patents
- Current Assignee / Owner
- Priority Date
- 2019-05-17
- Filing Date
- 2020-03-24
- Publication Date
- 2024-11-05
- Estimated Expiration
- 2040-03-24
AI Technical Summary
Unmanned transportation vehicles face congestion issues due to the use of one-way landmarks, leading to inefficiencies in route navigation and increased congestion at lane exits where vehicles may go straight, turn left, or turn right, affecting work efficiency.
Implementing a route control method that utilizes landmarks on both sides of the road to plan routes with minimum cost, allowing vehicles to move in both directions on lanes and main lines, thereby alleviating congestion by enabling two-way traffic.
The method effectively reduces congestion by allowing unmanned vehicles to navigate efficiently in both directions, improving operational efficiency in warehouses and production environments.
Smart Images

Figure 0007577689000001 
Figure 0007577689000002 
Figure 0007577689000003
Abstract
Description
[Technical field]
[0001] CROSS-REFERENCE TO RELATED APPLICATIONS This application is based on and claims priority to Chinese Patent Application No. 201910411149.1, filed on May 17, 2019, the disclosure of which is incorporated herein by reference in its entirety.
[0002] The present disclosure relates to the field of path planning, and in particular to methods, devices, and systems for controlling the path of an unmanned vehicle. [Background technology]
[0003] In the prior art, automated equipment such as unmanned vehicles have been widely used in warehouse management and production. By providing unidirectional landmarks on lanes between adjacent shelves and main roads that are convenient for unmanned vehicles to pass through, it can be ensured that the unmanned vehicles move within a preset path by identifying the unidirectional landmarks. Summary of the Invention [Means for solving the problem]
[0004] According to a first aspect of an embodiment of the present disclosure, a method for controlling a path of an unmanned vehicle is provided, the method including the steps of: querying a current position and a target position of the unmanned vehicle; executing route planning according to the current position, the target position, and a traveling direction indicated by landmarks placed on both sides of a road to obtain a planned route having a minimum route cost, wherein the unmanned vehicle moves forward on a predetermined side of the road; and transmitting the planned route to the unmanned vehicle, whereby the unmanned vehicle reaches the target position according to the planned route.
[0005] In some embodiments, the step of performing path planning according to the current position, the target position, and a traveling direction indicated by landmarks located on both sides of the road includes: determining whether the current position and the target position are both in a first lane in the road; determining whether the unmanned vehicle can reach the target position by going straight without turning, according to the traveling direction indicated by the landmark corresponding to the current position, under the condition that the current position and the target position are both in the first lane; and planning a first path according to the current position, the target position, and a traveling direction indicated by landmarks located on a predetermined side of the first lane, under the condition that the unmanned vehicle can reach the target position by going straight without turning, whereby the unmanned vehicle goes straight from the current position to reach the target position according to the first path.
[0006] In some embodiments, detecting a type of landmark corresponding to a current location, under a condition that the unmanned vehicle reaches the target location by turning around, and planning a second route according to the current location, the target location, and a traveling direction indicated by landmarks located on both sides of the first lane, under a condition that the type of landmark corresponding to the current location is a first type of landmark, whereby the unmanned vehicle turns around at the current location to reach the target location according to the second route, and the first type of landmark includes a first traveling direction for turning around.
[0007] In some embodiments, determining a turn position according to the current position, the target position, and a traveling direction of the landmark corresponding to the current position, under a condition that the type of the landmark corresponding to the current position is a second type of landmark, whereby the unmanned vehicle reaches the target position directly after turning from the turn position to another side of the lane or goes straight to reach the target position, the second type of landmark including a second traveling direction for going straight and a third traveling direction for turning; determining whether the turn position matches the current position; and planning a third path according to the current position, the target position, and a traveling direction indicated by the landmarks located on both sides of the first lane, under a condition that the turn position matches the current position, whereby the unmanned vehicle turns at the current position to reach the target position according to the third path.
[0008] In some embodiments, planning a fourth route according to the current location, the turn location, the target location, and a traveling direction indicated by landmarks located on both sides of the first lane, under a condition that the turn location does not coincide with the current location, whereby the unmanned vehicle travels straight from the current location to the turn location and turns around at the turn location to reach the target location according to the fourth route.
[0009] In some embodiments, under a condition that the current location is within a first lane and the target location is within a second lane in the road, selecting a lane opening in a first lane corresponding to the current location and a lane opening in a second lane corresponding to the target location according to the current location and the target location, where the lane opening is an intersection area between an exit of a corresponding lane and a main line in the road; and under a condition that the first lane opening matches the second lane opening, planning a fifth route according to the current location, the target location, a traveling direction indicated by landmarks disposed in the first lane opening, a traveling direction indicated by landmarks disposed on both sides of the first lane, and a traveling direction indicated by landmarks disposed on both sides of the second lane, whereby the unmanned vehicle enters the first lane opening from the current location, goes straight through the first lane opening, and enters the second lane to reach the target location according to the fifth route.
[0010] In some embodiments, under a condition that the first lane gap does not coincide with the second lane gap, planning a sixth path according to the current location, the target location, a direction of travel indicated by the landmarks disposed in the first lane gap, a direction of travel indicated by the landmarks disposed in the second lane gap, a direction of travel indicated by the landmarks disposed on both sides of the first main line between the first lane gap and the second lane gap, a direction of travel indicated by the landmarks disposed on both sides of the first lane, and a direction of travel indicated by the landmarks disposed on both sides of the second lane, whereby the unmanned vehicle enters the first lane gap from the current location, turns from the first lane gap to the first main line, enters the second lane gap from the first main line, and enters the second lane from the second lane gap to reach the target location according to the sixth path.
[0011] In some embodiments, selecting a gap in a third lane corresponding to the target position according to the current position and the target position under the condition that the current position is within a second main line of the road and the target position is within a third lane of the road, and planning a seventh route according to the current position, the target position, a traveling direction indicated by landmarks arranged on both sides of the second main line, a traveling direction indicated by landmarks arranged in the gap in the third lane, and a traveling direction indicated by landmarks arranged on both sides of the third lane, whereby the unmanned vehicle enters from the current position into the gap in the third lane and enters from the gap in the third lane into the third lane to reach the target position according to the seventh route.
[0012] In some embodiments, each lane gap includes four third type landmarks, each third type landmark including a fourth direction of travel for going straight and a fifth direction of travel for turning, and the unmanned vehicle may cyclically move between positions corresponding to the four third type landmarks within each lane gap.
[0013] In some embodiments, under a condition that the unmanned vehicle travels straight through the predetermined lane gap, the steps include controlling the unmanned vehicle to reach a first position corresponding to a first landmark within the predetermined lane gap, controlling the unmanned vehicle to travel straight from the first position to reach a second position corresponding to a second landmark within the predetermined lane gap, and controlling the unmanned vehicle to travel straight from the second position to pass through the predetermined lane gap.
[0014] In some embodiments, controlling the unmanned vehicle to reach a first position corresponding to a first landmark within a predetermined lane gap, under a condition that the unmanned vehicle turns to a predetermined side through the predetermined lane gap, and controlling the unmanned vehicle to turn to the predetermined side from the first position, whereby the unmanned vehicle turns to the predetermined side through the predetermined lane gap.
[0015] In some embodiments, the steps of: controlling the unmanned vehicle to reach a first position corresponding to a first landmark within the predetermined lane gap, under a condition that the unmanned vehicle turns to the opposite side of the predetermined side through the predetermined lane gap; controlling the unmanned vehicle to go straight from the first position to reach a second position corresponding to a second landmark within the predetermined lane gap; controlling the unmanned vehicle to turn to the opposite side of the predetermined side from the second position to reach a third position corresponding to a third landmark within the predetermined lane gap; and controlling the unmanned vehicle to go straight from the third position, whereby the unmanned vehicle turns to the opposite side of the predetermined side through the predetermined lane gap.
[0016] In some embodiments, the step of querying a current location of the unmanned vehicle includes determining the current location of the unmanned vehicle according to landmark information related to the current location of the unmanned vehicle.
[0017] According to a second aspect of an embodiment of the present disclosure, an apparatus for controlling a path of an unmanned vehicle is provided, the apparatus including: an inquiry module configured to inquire about a current position and a target position of the unmanned vehicle; a path planning module configured to execute path planning according to the current position, the target position, and a traveling direction indicated by landmarks located on both sides of a road to obtain a planned path having a minimum path cost, wherein the unmanned vehicle moves forward on a predetermined side of the road; and a transmission module configured to transmit the planned path to the unmanned vehicle, thereby causing the unmanned vehicle to reach the target position according to the planned path.
[0018] According to a third aspect of an embodiment of the present disclosure, there is provided an apparatus for controlling a path of an unmanned vehicle, the apparatus including: a memory configured to store instructions; and a processor coupled to the memory, wherein based on the instructions stored in the memory, the processor is configured to perform a method according to any one of the preceding embodiments.
[0019] According to a fourth aspect of an embodiment of the present disclosure, there is provided a system for controlling a path of an unmanned vehicle, the system including: an apparatus for controlling a path of the unmanned vehicle according to any one of the above-mentioned embodiments; and an unmanned vehicle configured to transmit landmark information regarding a current location to the apparatus, whereby the apparatus plans a path from the current location of the unmanned vehicle to a target location, and the unmanned vehicle is configured to move to the target location according to the planned path transmitted by the apparatus.
[0020] In some embodiments, the unmanned vehicle is further configured to identify landmark information of landmarks located on both sides of the road while traveling to the target location according to the planned route, compare the identified landmark information with the planned route, and send the landmark information at the current location to the device under a condition that the identified landmark information does not match the planned route, so that the device re-plans a route from the current location to the target location.
[0021] According to a fifth aspect of an embodiment of the present disclosure, there is provided a computer-readable storage medium storing computer instructions which, when executed by a processor, cause the processor to perform a method according to any one of the preceding embodiments.
[0022] According to a sixth aspect of an embodiment of the present disclosure, there is provided a computer program configured to cause a processor to perform a method according to any one of the preceding embodiments.
[0023] Other features and advantages of the present disclosure will become apparent from the following detailed description of illustrative embodiments thereof, which proceeds with reference to the accompanying drawings.
[0024] In order to more clearly show the technical solutions of the embodiments of the present disclosure or the prior art, the drawings used in the description of the embodiments or the prior art are briefly described below. Obviously, the drawings in the following description are only a part of the embodiments of the present disclosure, and for those skilled in the art, other drawings may be obtained according to the drawings without inventive efforts. [Brief description of the drawings]
[0025] [Figure 1] 1 is a schematic flow diagram of a method for controlling a path of an unmanned vehicle according to one embodiment of the present disclosure. [Diagram 2] FIG. 1 is a schematic diagram of an application scenario according to an embodiment of the present disclosure. [Diagram 3] FIG. 2 is a schematic diagram of an application scenario according to another embodiment of the present disclosure. [Figure 4] FIG. 13 is a schematic diagram of an application scenario of yet another embodiment of the present disclosure. [Diagram 5] FIG. 13 is a schematic diagram of an application scenario of yet another embodiment of the present disclosure. [Figure 6] FIG. 13 is a schematic diagram of an application scenario of yet another embodiment of the present disclosure. [Figure 7] FIG. 13 is a schematic diagram of an application scenario of yet another embodiment of the present disclosure. [Figure 8] FIG. 1 is a schematic structural diagram of an apparatus for controlling the path of an unmanned vehicle according to an embodiment of the present disclosure. [Figure 9] FIG. 11 is a schematic structural diagram of an apparatus for controlling the path of an unmanned vehicle according to another embodiment of the present disclosure. [Figure 10] FIG. 2 is a schematic structural diagram of a system for controlling a path of an unmanned vehicle according to another embodiment of the present disclosure. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0026] The technical solutions of the embodiments of the present disclosure are described clearly and completely with reference to the drawings of the embodiments of the present disclosure, and it is clear that the described embodiments are only a part, not all, of the embodiments of the present disclosure. The following description of at least one exemplary embodiment is merely exemplary in nature and is in no way intended to limit the present disclosure, its application, or uses. All other embodiments that can be derived by those skilled in the art from the embodiments posted herein without inventive step are intended to be within the scope of the present disclosure.
[0027] The relative arrangement, numerical expressions, and values of parts and steps set forth in these embodiments do not limit the scope of the disclosure unless expressly stated otherwise.
[0028] However, it should be understood that the sizes of the various parts shown in the drawings are not drawn to scale for the sake of convenience.
[0029] Techniques, methods, and apparatus known by those skilled in the relevant art may not be discussed in detail, but are intended to be part of this specification, where appropriate.
[0030] In all examples shown and discussed herein, all specific values should be considered as exemplary only and not limiting, and thus other examples of example embodiments may have different values.
[0031] It should be noted that like reference numbers and letters refer to like items in the following figures, and thus once an item is defined in one figure, that item is not necessarily further discussed in subsequent figures.
[0032] The inventor has found through research that only one-way landmarks are provided on the lanes and main lines, that is, unmanned vehicles moving in different directions use the same landmarks, which is prone to congestion. At the exit of the lane, there are many unmanned vehicles going straight, turning left or turning right, which aggravates the congestion situation and seriously affects the work efficiency.
[0033] To this end, the present disclosure provides a routing control scheme for unmanned vehicles that alleviates congestion situations.
[0034] 1 is a schematic flow diagram of a method for controlling a path of an unmanned vehicle according to one embodiment of the present disclosure. In some embodiments, the following steps of the method for controlling a path of an unmanned vehicle are performed by an apparatus for controlling a path of an unmanned vehicle:
[0035] In step 101, the current and target positions of the unmanned vehicle are queried.
[0036] In some embodiments, the current location of the unmanned vehicle is determined based on landmark information related to the current location of the unmanned vehicle.
[0037] In step 102, route planning is performed according to the current position, the target position, and a traveling direction indicated by landmarks placed on both sides of the road to obtain a planned route with a minimum route cost, and the unmanned vehicle moves forward on a predetermined side of the road.
[0038] 2 is a schematic diagram of an application scenario according to an embodiment of the present disclosure, where the road traveled by the unmanned vehicle is a two-way road, and landmarks indicating the moving direction of the unmanned vehicle are disposed on both sides of the road. When the unmanned vehicle is moving forward, it approaches a predetermined side of the road, for example, when the unmanned vehicle is moving forward, it always approaches the right side of the road. The road includes lanes and a main line, the lanes are disposed between adjacent shelves, and the intersection area between the lane exit and the main line is the lane opening.
[0039] 2, the path between adjacent shelves 11 is a lane 12. The intersection between the exit of lane 12 and main line 13 is a lane gap 14. Lanes 12 and main line 13 are provided with landmarks 15 for bidirectional movement of unmanned vehicles.
[0040] In step 103, the planned path is transmitted to the unmanned vehicle, so that the unmanned vehicle follows the planned path to reach the target location.
[0041] In the method for controlling the route of an unmanned vehicle provided by the above-mentioned embodiment of the present disclosure, the lanes and main lines in the warehouse are both set as two-way roads, so that unmanned vehicles with different moving directions can conveniently travel on different roads, and road congestion is effectively alleviated.
[0042] 3 is a schematic diagram of an application scenario of another embodiment of the present disclosure. As shown in FIG. 3, there are three kinds of landmarks provided on lanes and main lines. For simplicity, only a part of the types of landmarks are labeled in FIG. 3.
[0043] The landmarks contained in box 21 are a first type of landmark, also called bidirectional landmarks.
[0044] A bidirectional landmark, i.e., an end landmark, has only two landmarks adjacent to it. A bidirectional landmark includes an inlet direction and a forward direction. That is, of the two landmarks adjacent to a bidirectional landmark, the unmanned vehicle moves from a position corresponding to one of the adjacent landmarks along the inlet direction to a position corresponding to the bidirectional landmark, and moves from the position corresponding to the bidirectional landmark along the forward direction to a position corresponding to the other of the adjacent landmarks.
[0045] For example, the format information of a bidirectional landmark is [X, Y, landmark KEY, Up _ NONE _ NONE, Down _ Inlet _ landmark KEY, Left _ Outlet _ landmark KEY, Right _ NONE _ NONE], where X and Y represent the coordinates of the bidirectional landmark, landmark KEY is the related information of the landmark, up, lower, left, or right represents the adjacent positions, Down _ Inlet _ landmark KEY indicates that the unmanned vehicle can move from a position corresponding to the landmark below the bidirectional landmark to a position corresponding to the bidirectional landmark, and Left _ Outlet _ landmark KEY indicates that the unmanned vehicle can move from a position corresponding to the bidirectional landmark to a position corresponding to the adjacent landmark to the left.
[0046] Because the inlets and outlets of the bidirectional landmarks are both unidirectional and an unmanned vehicle on a bidirectional landmark has only one direction of travel, the unmanned vehicle thereby passes through a position corresponding to the bidirectional landmark according to its direction of travel.
[0047] The landmarks contained within box 22 are a second type of landmark, also known as three-way landmarks.
[0048] The three-way landmark has three adjacent landmarks. The three-way landmark includes an entry direction, a second travel direction for going straight, and a third travel direction for turning. The unmanned vehicle can move from a position corresponding to the first adjacent landmark to a position corresponding to the current three-way landmark and can advance from a position corresponding to the current three-way landmark to a position corresponding to the second adjacent landmark. Additionally, the unmanned vehicle can also traverse between a position corresponding to the current three-way landmark and a position corresponding to the third adjacent landmark (also a three-way landmark).
[0049] For example, the format information for a three-way landmark is [X, Y, Landmark KEY, Up _ Inlet _ Landmark KEY, Down _ Outlet _ Landmark KEY, Left _ NONE _ NONE, Right _ Inlet / Outlet _ Landmark KEY].
[0050] Because the entrance and exit points of the three-way landmark are both bidirectional, the unmanned vehicle can turn around when needed.
[0051] The landmarks contained in box 23 are a third type of landmark, also known as four-way landmarks.
[0052] The lane gaps can be considered as a crossroads, and four four-way landmarks are disposed in each lane gap. The four-way landmarks include two entry directions, a fourth travel direction for going straight, and a fifth travel direction for turning. The unmanned vehicle can move cyclically between positions corresponding to the four landmarks in each lane gap. The four-way landmarks have four adjacent landmarks on the upper, lower, left, and right sides, and the unmanned vehicle can move through the positions corresponding to two adjacent landmarks to a position corresponding to an adjacent landmark of the current four-way landmark, and can also move from the position corresponding to the current four-way landmark to a position corresponding to the other two adjacent landmarks.
[0053] For example, the format information for a four-way landmark is [X, Y, Landmark KEY, Up _ Inlet _ Landmark KEY, Down _ Outlet _ Landmark KEY, left _ Outlet _ Landmark KEY, Right _ Inlet _ Landmark KEY].
[0054] As shown in FIG. 3, in the gaps between lanes, the four four-way landmarks can form a counterclockwise circulation, so that the unmanned vehicle can realize the adjustment of various directions in the gaps between lanes, and the occurrence of congestion can be effectively prevented.
[0055] FIG. 4 is a schematic diagram of an application scenario of another embodiment of the present disclosure.
[0056] As shown on the right side of FIG. 4 , when the unmanned vehicle needs to travel straight through the lane gap, the unmanned vehicle first arrives at a first location from landmark 31 corresponding to a first landmark in the lane gap. The unmanned vehicle continues to travel straight from the first location to a second location corresponding to a second landmark in the lane gap. The unmanned vehicle continues to travel straight from the second location to reach the location of landmark 32, achieving straight travel through the lane gap. The corresponding path is shown as path 41.
[0057] 4, when an unmanned vehicle needs to make a right turn through a lane gap, the unmanned vehicle first arrives at a first location corresponding to a first landmark in the lane gap from landmark 33. The unmanned vehicle turns right from the first location to arrive at the location of landmark 34 to accomplish the right turn through the lane gap. The corresponding path is shown as path 42.
[0058] As shown on the left side of FIG. 4 , when an unmanned vehicle needs to make a left turn through a lane gap, the unmanned vehicle first arrives at a first location from landmark 35 corresponding to a first landmark in the lane gap. The unmanned vehicle continues to travel straight from the first location to a second location corresponding to a second landmark in the lane gap. The unmanned vehicle turns left from the second location to arrive at a third location corresponding to a third landmark in the lane gap. The unmanned vehicle continues to travel straight from the third location to arrive at the location of landmark 36 to accomplish the left turn through the lane gap. The corresponding path is shown as path 43.
[0059] FIG. 5 is a schematic diagram of an application scenario of another embodiment of the present disclosure.
[0060] As shown in FIG. 5, in some embodiments, a first route is planned according to the current location, the target location, and a traveling direction indicated by landmarks located on a predetermined side of the lane, under the condition that the current location and the target location are both in the same lane and the unmanned vehicle can reach the target location by going straight without turning, whereby the unmanned vehicle goes straight from the current location to reach the target location according to the first route.
[0061] 5, the unmanned vehicle needs to move from a position corresponding to landmark 51 to a position corresponding to landmark 52. Because the unmanned vehicle travels straight ahead to reach the target position, a path 501 may be planned in a straight line between landmark 51 and landmark 52.
[0062] In some embodiments, the type of landmark corresponding to the current location is detected under the condition that the current location and the target location are in the same lane, and the unmanned vehicle can reach the target location by turning around. If the type of landmark corresponding to the current location is a two-way landmark, the unmanned vehicle must turn around. A second route is planned according to the current location, the target location, and the travel direction indicated by the landmarks located on both sides of the lane, so that the unmanned vehicle turns around at the current location to reach the target location according to the second route.
[0063] 5, the unmanned vehicle needs to travel from a position corresponding to landmark 53 to a position corresponding to landmark 55. Because landmark 53 is a bidirectional landmark, the unmanned vehicle must turn to reach the target position, and thus path 502 may be planned between landmark 53, landmark 54, and landmark 55.
[0064] In some embodiments, the current position and the target position are in the same lane, and the unmanned vehicle reaches the target position by turning around. The turning position is determined according to the current position and the target position under the condition that the type of the landmark corresponding to the current position is a three-way landmark, and the unmanned vehicle can reach the target position directly or go straight to reach the target position after turning around from the turning position to another side of the lane. A third path is planned according to the current position, the target position, and a traveling direction indicated by the landmarks arranged on both sides of the lane under the condition that the turning position coincides with the current position, whereby the unmanned vehicle turns around at the current position to reach the target position according to the third path. A fourth path is planned according to the current position, the turning position, the target position, and a traveling direction indicated by the landmarks arranged on both sides of the lane under the condition that the turning position does not coincide with the current position, whereby the unmanned vehicle goes straight from the current position to the turning position and turns around at the turning position to reach the target position according to the fourth path.
[0065] 5, landmark 56 and landmark 58 are on both sides of the road, and the unmanned vehicle needs to turn to reach the location of landmark 58. The unmanned vehicle can reach landmark 58 by turning at landmark 56, where the unmanned vehicle is currently located, and since landmark 56 is a three-way landmark, route 503 can be planned between landmark 56, landmark 57, and landmark 58.
[0066] As shown in the lower left portion of FIG. 5 , landmark 59 and landmark 511 are on both sides of the road, and the unmanned vehicle needs to turn to reach the location of landmark 511. Although landmark 59 is a three-way landmark, the unmanned vehicle cannot reach landmark 511 after turning at landmark 59. Therefore, the unmanned vehicle needs to move to landmark 510 first. Landmark 510 is also a three-way landmark, and therefore the unmanned vehicle can turn from landmark 510 to reach landmark 511. Thus, path 504 may be planned between landmark 59, landmark 510, and landmark 511.
[0067] FIG. 6 is a schematic diagram of an application scenario of another embodiment of the present disclosure.
[0068] In some embodiments, as shown in Fig. 6, the current location is in the first lane, the target location is in the second lane, and a gap in the first lane corresponding to the current location and a gap in the second lane corresponding to the target location are selected according to the current location and the target location. A fifth path is planned according to the current location, the target location, a traveling direction indicated by the landmarks disposed in the gap in the first lane, a traveling direction indicated by the landmarks disposed on both sides of the first lane, and a traveling direction indicated by the landmarks disposed on both sides of the second lane, under the condition that the gap in the first lane coincides with the gap in the second lane, whereby the unmanned vehicle enters the first lane gap from the current location, goes straight through the gap in the first lane, and enters the second lane where the target location is located, to reach the target location according to the fifth path.
[0069] 6, an unmanned vehicle needs to move from a position corresponding to landmark 61 to a position corresponding to landmark 62. Because the lane gap for exiting the lane in which landmark 61 is located is the same as the lane gap for entering the lane in which landmark 62 is located, a path 601 can be planned using landmark 61, lane gap a1, and landmark 62.
[0070] In some embodiments, once a first lane gap corresponding to the current location and a second lane gap corresponding to the target location are selected, a sixth path is planned according to the current location, the target location, a direction of travel indicated by the landmarks located in the first lane gap, a direction of travel indicated by the landmarks located in the second lane gap, a direction of travel indicated by the landmarks located on both sides of the main line between the first lane gap and the second lane gap, a direction of travel indicated by the landmarks located on both sides of the first lane, and a direction of travel indicated by the landmarks located on both sides of the second lane, under the condition that the first lane gap does not coincide with the second lane gap, whereby the unmanned vehicle enters the first lane gap from the current location, turns from the first lane gap to the second lane gap, and enters the second lane from the second lane gap to reach the target location according to the sixth path.
[0071] 6, an unmanned vehicle needs to move from a position corresponding to landmark 63 to a position corresponding to landmark 64. Because the lane gap a3 for exiting the lane in which landmark 63 is located is not the same as the lane gap a2 for entering the lane in which landmark 64 is located, a path 602 can be planned using landmark 63, lane gap a3, lane gap a2, and landmark 64.
[0072] In some embodiments, a gap in the third lane corresponding to the target location is selected according to the current location and the target location under the condition that the current location is within a main line of the road and the target location is within the third lane. A seventh route is planned according to the current location, the target location, a heading indicated by the landmarks disposed on both sides of the main line, a heading indicated by the landmarks disposed in the gap in the third lane, and a heading indicated by the landmarks disposed on both sides of the third lane, whereby the unmanned vehicle enters the gap in the third lane from the current location and enters the third lane from the gap in the third lane to reach the target location according to the seventh route.
[0073] As shown in the left part of FIG. 6, the unmanned vehicle needs to move from landmark 65 to landmark 66. Landmark 65 is on the main line. The unmanned vehicle moves to landmark 66 according to landmark 65, and selects lane gap a2 corresponding to landmark 66. Thus, a path 603 is planned according to landmark 65, lane gap a2, and landmark 66.
[0074] 7 is a schematic diagram of an application scenario of yet another embodiment of the present disclosure. As shown in FIG. 7, an unmanned vehicle is first at a position corresponding to a landmark having coordinates (9, 4), and needs to sequentially reach positions corresponding to landmarks having coordinates (5, 1), (4, 2), (2, 0), (1, 1), and (1, 7).
[0075] According to the embodiment of Figures 1 to 6, in the process of an unmanned vehicle traveling from a landmark with coordinates (9,4) to a landmark with coordinates (5,1), the corresponding information of the landmarks the unmanned vehicle passes through is as follows: [9, 4, KEY / 9 / 4, Up _ NONE _ NONE, Down _ Inlet _ KEY / 9 / 5, Left _ Outlet _ KEY / 8 / 5, Right _ NONE _ NONE], [8, 4, KEY / 8 / 4, Up _ Outlet _ KEY / 8 / 3, Down _ Inlet _ KEY / 8 / 5, Left _ Outlet _ KEY / 7 / 4, Right _ Inlet _ KEY / 9 / 4], ... [5, 2, KEY / 5 / 2, Up _ Outlet _ KEY / 5 / 1, Down _ Inlet _ KEY / 5 / 3, Left _ Inlet / Outlet _ KEY / 4 / 2, Right _ NONE _ NONE], [5, 1, KEY / 5 / 1, Up _ Outlet _ KEY / 5 / 0, Down _ Inlet _ KEY / 5 / 2, Left _ Inlet / Outlet _ KEY / 4 / 1, Right _ NONE _ NONE]
[0076] Thus, after the unmanned vehicle reaches a landmark having coordinates (5,1), landmarks having coordinates (4,2), (2,0), (1,1), and (1,7) may also be reached in sequence by the embodiments of Figures 1 to 6.
[0077] 8 is a schematic structural diagram of an apparatus for controlling the path of an unmanned vehicle according to an embodiment of the present disclosure. As shown in FIG. 8, the apparatus includes an inquiry module 81, a path planning module 82, and a sending module 83.
[0078] The interrogation module 81 is configured to interrogate the current location and the target location of the unmanned vehicle.
[0079] The path planning module 82 is configured to perform path planning according to the current position, the target position, and a traveling direction indicated by landmarks placed on both sides of the road to obtain a planned path having a minimum path cost, and the unmanned vehicle moves forward on a predetermined side of the road.
[0080] In some embodiments, the path planning module 82 performs path planning according to the embodiments illustrated in FIGS.
[0081] The transmitting module 83 is configured to transmit the planned path to the unmanned vehicle, so that the unmanned vehicle reaches the target location according to the planned path.
[0082] In the apparatus for controlling the route of an unmanned vehicle provided by the above-mentioned embodiment of the present disclosure, the lanes and main lines in the warehouse are both set as two-way roads, so that unmanned vehicles with different moving directions can travel on different roads, and congestion on the roads is effectively alleviated.
[0083] 9 is a schematic structural diagram of an apparatus for controlling the path of an unmanned vehicle according to another embodiment of the present disclosure. As shown in FIG. 9, the apparatus includes a memory 91 and a processor 92.
[0084] The memory 91 is used for storing instructions, and the processor 92 is coupled to the memory 91, the processor 92 being configured to execute the method according to any one of Figures 1 to 7 based on the instructions stored in the memory.
[0085] 9, the device for controlling the path of the unmanned vehicle further includes a communication interface 93 for information interaction with other devices. At the same time, the device for controlling the path of the unmanned vehicle further includes a bus 94, and the processor 92, the communication interface 93, and the memory 91 communicate with each other through the bus 94.
[0086] The memory 91 may include high-speed RAM memory and may also include non-volatile memory such as at least one disk memory. The memory 91 may be a memory array. The storage 91 may be partitioned and blocks may be combined into virtual volumes according to certain rules.
[0087] Moreover, the processor 92 may be a central processing unit CPU, or may be an application specific integrated circuit ASIC, or one or more integrated circuits configured to implement embodiments of the present disclosure.
[0088] The present disclosure also relates to a computer readable storage medium having stored thereon computer instructions which, when executed by a processor, perform a method according to any one of Figures 1 to 7.
[0089] 10 is a schematic structural diagram of a system for controlling the path of an unmanned vehicle according to an embodiment of the present disclosure. As shown in FIG. 10, the apparatus for controlling the path of an unmanned vehicle includes an unmanned vehicle path control device 1001 and an unmanned vehicle 1002. The unmanned vehicle path control device 1001 is an apparatus for controlling the path of an unmanned vehicle according to any one of the embodiments in FIG. 8 and FIG. 9.
[0090] The unmanned vehicle 1002 is configured to provide landmark information regarding the current location to the unmanned vehicle path control device 1001 so that the unmanned vehicle path control device 1001 plans a path for the unmanned vehicle 1002 from the current location to the target location. After receiving the planned path sent by the unmanned vehicle path control device 1001, the unmanned vehicle 1002 moves to the target location according to the planned path.
[0091] In some embodiments, the unmanned vehicle 1002 is further configured to identify landmark information set on the road while moving to the target location according to the planned route, and compare the identified landmark information with the planned route. If the recognized landmark information does not match the planned route, the unmanned vehicle 1002 sends the landmark information related to the current location to the unmanned vehicle's route control device 1001 so that the unmanned vehicle's route control device 1001 re-plans a route from the unmanned vehicle's 1002's current location to the target location.
[0092] In some embodiments, the functional unit modules described above may be implemented as a general purpose processor, a programmable logic controller (PLC), a digital signal processor (DSP), an application specific integrated circuit (ASIC), a field programmable gate array (FPGA) or other programmable logic device, discrete gate or transistor logic, discrete hardware components, or any suitable combination thereof for performing the functions described in this disclosure.
[0093] It will be understood by those skilled in the art that all or part of the steps for implementing the above embodiments may be implemented by hardware, or may be implemented by a program instructing related hardware, and the program may be stored in a computer-readable storage medium, where the storage medium may be a read-only memory, a magnetic disk, or an optical disk.
[0094] The description of the present disclosure has been presented for purposes of illustration and explanation, and is not intended to be exhaustive or limited to the present disclosure in the disclosed form. Many modifications and changes will be apparent to those skilled in the art. The embodiments have been chosen and described in order to best explain the principles and practical application of the present disclosure, and to enable those skilled in the art to understand the present disclosure in terms of various embodiments with various modifications suitable for the particular applications envisioned. [Explanation of symbols]
[0095] 11 Shelves 12 Lane 13 Main Line 14 Lane Gap 15. Landmarks 21 square 22 squares 23 squares 31 Landmark 32 Landmarks 33 Landmark 34 Landmark 35 Landmarks 36 Landmarks 41 Routes 42 Routes 43 Routes 51 Landmark 52 Landmarks 53 Landmark 54 Landmark 55 Landmark 56 Landmarks 57 Landmark 58 Landmark 59 Landmarks 501 Route 502 Route 503 Route 504 Routes 510 Landmark 511 Landmark 61 Landmark 62 Landmarks 63 Landmarks 64 Landmarks 65 Landmarks 66 Landmark 601 Routes 602 Routes a1 lane gap a2 Lane gap a3 Lane gap 81 Inquiry Module 82 Path Planning Module 83 Transmitting Module 91 Memory, storage 92 processors 93 Communication Interface 94 Bus 1001 Route control device for unmanned vehicles 1002 Unmanned transportation means
Claims
1. 1. A method for controlling a path of an unmanned vehicle, comprising: Querying a current location and a target location of the unmanned vehicle; executing a route planning according to the current location, the target location, and a traveling direction indicated by landmarks disposed on both sides of a road to obtain a planned route with a minimum route cost, wherein the unmanned vehicle travels forward on a predetermined side of the road; transmitting the planned path to the unmanned vehicle, whereby the unmanned vehicle reaches the target location according to the planned path; Including, The step of executing a route plan according to the current position, the target position, and a traveling direction indicated by landmarks arranged on both sides of the road, determining whether the current location and the target location are both in a first lane of the road; determining whether the unmanned vehicle can reach the target position by moving straight ahead without turning, according to a travel direction indicated by a landmark corresponding to the current position, under a condition that the current position and the target position are both in a first lane; Detecting the type of the landmark corresponding to the current position under a condition that the unmanned vehicle reaches the target position by turning around; determining a turn position according to the current position, the target position, and a traveling direction of the landmark corresponding to the current position, under a condition that the type of the landmark corresponding to the current position is a second type of the landmark, whereby the unmanned vehicle reaches the target position directly after turning from the turn position to another side of the lane or travels straight to reach the target position, and the second type of the landmark includes a second traveling direction for traveling straight and a third traveling direction for turning; determining whether the turn location matches the current location; planning a third route according to the current location, the target location, and the travel direction indicated by landmarks disposed on both sides of the first lane, under a condition that the location of the turn is consistent with the current location, whereby the unmanned vehicle turns at the current location to reach the target location according to the third route; A method comprising:
2. The step of executing a route plan according to the current position, the target position, and a traveling direction indicated by landmarks arranged on both sides of the road, planning a first route according to the current location, the target location, and a traveling direction indicated by the landmarks located on the predetermined side of the first lane, under a condition that the unmanned vehicle can reach the target location by traveling straight without turning, whereby the unmanned vehicle travels straight from the current location to reach the target location according to the first route; The method of claim 1, comprising:
3. The step of executing a route plan according to the current position, the target position, and a traveling direction indicated by landmarks arranged on both sides of the road, planning a second route according to the current location, the target location, and a travel direction indicated by the landmarks disposed on both sides of the first lane, under a condition that the type of the landmark corresponding to the current location is a first type of the landmark, whereby the unmanned vehicle turns at the current location to reach the target location according to the second route, and the first type of the landmark includes a first travel direction for turning; The method of claim 2, comprising:
4. The step of executing a route plan according to the current position, the target position, and a traveling direction indicated by landmarks arranged on both sides of the road, 4. The method of claim 3, further comprising: planning a fourth route according to the current location, the turn location, the target location, and the traveling direction indicated by the landmarks located on both sides of the first lane, under a condition that the turn location does not coincide with the current location, whereby the unmanned vehicle travels straight from the current location to the turn location and turns around at the turn location to reach the target location according to the fourth route.
5. The step of executing a route plan according to the current position, the target position, and a traveling direction indicated by landmarks arranged on both sides of the road, Selecting a first lane gap corresponding to the current location and a second lane gap corresponding to the target location according to the current location and the target location, under a condition that the current location is in the first lane and the target location is in a second lane in the road, where a lane gap is an intersection area between an exit of a corresponding lane and a main line in the road; planning a fifth route according to the current location, the target location, a direction of travel indicated by the landmarks disposed in the first lane gap, a direction of travel indicated by the landmarks disposed on both sides of the first lane, and a direction of travel indicated by the landmarks disposed on both sides of the second lane, under a condition that the first lane gap coincides with the second lane gap, whereby the unmanned vehicle enters the first lane gap from the current location, travels straight through the first lane gap, and enters the second lane to reach the target location according to the fifth route; The method of claim 2, comprising:
6. The step of executing a route plan according to the current position, the target position, and a traveling direction indicated by landmarks arranged on both sides of the road, 6. The method of claim 5, further comprising: planning a sixth path according to the current location, the target location, the direction of travel indicated by the landmarks disposed in the first lane gap, the direction of travel indicated by the landmarks disposed in the second lane gap, the direction of travel indicated by the landmarks disposed on both sides of a first main line between the first lane gap and the second lane gap, the direction of travel indicated by the landmarks disposed on both sides of the first lane, and the direction of travel indicated by the landmarks disposed on both sides of the second lane, under a condition that the first lane gap does not coincide with the second lane gap, whereby the unmanned vehicle enters the first lane gap from the current location, turns from the first lane gap to the first main line, enters the second lane gap from the first main line, and enters the second lane from the second lane gap to reach the target location according to the sixth path.
7. The step of executing a route plan according to the current position, the target position, and a traveling direction indicated by landmarks arranged on both sides of the road, selecting a gap of a third lane corresponding to the target position according to the current position and the target position under a condition that the current position is within a second main line of the road and the target position is within a third lane of the road; planning a seventh route according to the current location, the target location, a direction of travel indicated by the landmarks disposed on both sides of the second main line, a direction of travel indicated by the landmarks disposed in a gap of the third lane, and a direction of travel indicated by the landmarks disposed on both sides of the third lane, whereby the unmanned vehicle enters the gap of the third lane from the current location and enters the third lane from the gap of the third lane to reach the target location according to the seventh route; The method of claim 2, comprising:
8. 8. The method of claim 7, wherein each lane gap includes four third type landmarks, each third type landmark including a fourth direction of travel for going straight and a fifth direction of travel for turning, and the unmanned vehicle is capable of cyclically moving between positions corresponding to the four third type landmarks within each lane gap.
9. controlling the unmanned vehicle to reach a first location corresponding to a first landmark within a predetermined lane gap, under a condition that the unmanned vehicle travels straight through the predetermined lane gap; controlling the unmanned vehicle to travel from the first location in a straight line to reach a second location corresponding to a second landmark within the predetermined lane gap; controlling the unmanned vehicle to travel straight from the second location to pass through the predetermined lane gap; 9. The method of claim 8, further comprising:
10. controlling the unmanned vehicle to reach a first location corresponding to a first landmark within the predetermined lane gap under a condition that the unmanned vehicle turns to a predetermined side through the predetermined lane gap; controlling the unmanned vehicle to turn to the predetermined side from the first position, whereby the unmanned vehicle turns to the predetermined side through the predetermined lane gap; 9. The method of claim 8, further comprising:
11. controlling the unmanned vehicle to reach a first location corresponding to a first landmark within the predetermined lane gap under a condition that the unmanned vehicle turns through the predetermined lane gap to an opposite side of the predetermined side; controlling the unmanned vehicle to travel from the first location in a straight line to reach a second location corresponding to a second landmark within the predetermined lane gap; controlling the unmanned vehicle to turn from the second location to the opposite side of the predetermined side to reach a third location corresponding to a third landmark within a predetermined lane gap; controlling the unmanned vehicle to travel straight from the third position, whereby the unmanned vehicle turns through the predetermined lane gap to an opposite side of the predetermined side; and 9. The method of claim 8, further comprising:
12. The step of querying the current location of the unmanned vehicle includes:
12. The method of claim 1, further comprising determining the current location of the unmanned vehicle according to landmark information related to the current location of the unmanned vehicle.
13. 1. An apparatus for controlling a path of an unmanned vehicle, comprising: an interrogation module configured to interrogate a current location and a target location of the unmanned vehicle; a path planning module configured to perform path planning according to the current location, the target location, and a traveling direction indicated by landmarks disposed on both sides of a road to obtain a planned path having a minimum path cost, wherein the unmanned vehicle travels forward on a predetermined side of the road; and a transmitting module configured to transmit the planned path to the unmanned vehicle, whereby the unmanned vehicle reaches the target location according to the planned path; The path planning module includes: determining whether the current location and the target location are both in a first lane of the road; determining whether the unmanned vehicle can reach the target position by moving straight ahead without turning, according to a travel direction indicated by a landmark corresponding to the current position, under a condition that the current position and the target position are both in a first lane; Detecting the type of the landmark corresponding to the current position under a condition that the unmanned vehicle reaches the target position by changing direction; determining a turning position according to the current position, the target position, and a traveling direction of the landmark corresponding to the current position, under a condition that the type of the landmark corresponding to the current position is a second type of the landmark, and determining such a turning position, so that the unmanned vehicle directly reaches the target position after turning from the turning position to another side of the lane or travels straight to reach the target position, and the second type of the landmark includes a second traveling direction for traveling straight and a third traveling direction for turning; determining whether the turn location matches the current location; planning a third route according to the current location, the target location, and the travel direction indicated by landmarks disposed on both sides of the first lane, under a condition that the location of the turn is consistent with the current location, so that the unmanned vehicle turns at the current location to reach the target location according to the third route; An apparatus comprising:
14. 1. An apparatus for controlling a path of an unmanned vehicle, comprising: A memory configured to store instructions; a processor coupled to the memory; 13. An apparatus comprising: a processor configured to execute a method according to claim 1, said processor comprising: a processor for executing a plurality of instructions stored in said memory;
15. 1. A system for controlling a path of an unmanned vehicle, comprising: A device for controlling the path of an unmanned vehicle according to claim 13 or 14; an unmanned vehicle configured to transmit landmark information regarding a current location to the device, whereby the device plans a route from the current location of the unmanned vehicle to a target location, and the unmanned vehicle is configured to travel to the target location according to the planned route transmitted by the device; A system comprising:
16. 16. The system of claim 15, wherein the unmanned vehicle is further configured to identify landmark information of landmarks located on both sides of a road while moving to the target location according to the planned route, compare the identified landmark information with the planned route, and transmit the landmark information regarding the current location to the device under a condition that the identified landmark information does not match the planned route, thereby causing the device to re-plan a route from the current location to the target location.
17. A computer-readable storage medium, characterized in that it stores computer instructions which, when executed by a processor, cause the processor to carry out the method according to any one of claims 1 to 12.
18. A computer program product arranged to cause a processor to carry out the method according to any one of claims 1 to 12.
Citation Information
Patent Citations
Vehicle dispatching system and method
JP2009015684A
Apparatus and method for navigation control
JP2018508087A
Systems and methods for removing debris from warehouse floors
US9665095B1
