Efficient path planning method for robot used for collecting marine debris
An efficient path planning method for a robot used for collecting marine debris includes: traversing all target positions of the marine debris by depth-first search (DFS) to generate a target position sequence; and calculating a target position with a lowest total cost by a path planning algorithm, and setting the target position with the lowest total cost as a next target position to be traversed for the robot. The efficient path planning method can plan an optimal or near-optimal cleaning path for the robot based on real-time environmental information, reducing unnecessary path repetition and ineffective motion, thereby significantly improving the cleaning efficiency.
This application claims priority to Chinese Patent Application No. 2024112269826, filed on Sep. 3, 2024, which is herein incorporated by reference in its entirety.
TECHNICAL FIELDThe disclosure relates to the field of marine collection, and more particularly to an efficient path planning method for a robot used for collecting marine debris.
BACKGROUNDSurface marine unmanned robotic force (SMURF) is an improved path planning method derived from a spiral-curvature algorithm for navigation (SCAN), which traverses an entire area based on full coverage. However, in a dynamic marine environment, traversing the entire area would waste a lot of time and electricity costs. Moreover, marine debris is dynamic, and some of the marine debris may not be collected by a robot during movement of the robot. Therefore, the SMURF assumes a static marine environment, which does not conform to real-world scenarios.
SUMMARYIn order to solve above problems, the disclosure provides an efficient path planning method for a robot used for collecting marine debris.
The technical solutions of the disclosure are as follows.
The efficient path planning method for the robot used for collecting the marine debris includes:
-
- traversing all target positions of the marine debris by using a depth-first search (DFS) to generate a target position sequence; and
- determining a target position with a lowest total cost of the all target positions by using a path planning algorithm, and setting the target position with the lowest total cost as a next target position to be traversed for the robot.
In an embodiment, the robot includes a processor, a memory and a controller, the processor is connected to the memory and the controller, and the processor, the memory and the controller work together to perform above steps; and the efficient path planning method for the robot used for collecting the marine debris further includes: controlling, by the controller, the robot to move to the next target position to be traversed, and collecting, by the robot, marine debris at the next target position to be traversed.
In an embodiment, the traversing all target positions of the marine debris includes:
-
- setting a threshold td, where a distance between the next target position to be traversed and a current position of the robot is less than or equal to the threshold td.
In an embodiment, a formula for the path planning algorithm is as follows:
-
- where f(Gi) represents a comprehensive priority corresponding to a current position Gi of the robot, the comprehensive priority includes total costs of the all target positions relative to the current position Gi, g(Gi) represents an actual cost from the current position Gi to a starting position Gs, h(Gi) represents an estimated cost from the current position Gi to a target position Gk, and p(Gi) represents an adaptive cost from the current position Gi to the target position Gk.
In an embodiment, the actual cost is a distance cost consumed by the robot from the starting position Gs to the current position Gi, and a formula of the actual cost is expressed as follows:
-
- where Gs represents the starting position, Gi represents the current position, Gj represents a j-th position, and dist(Gs,Gj) represents a distance between Gs and Gj.
In an embodiment, the estimated cost is calculated as follows:
-
- where Gk represents the target position, Gi represents the current position, Gj represents the j-th position, and dist(Gi,Gj) represents a distance between Gi and Gj.
In an embodiment, the adaptive cost is calculated as follows:
-
- where ti,k represents travel time of the robot from the current position Gi to the target position Gk.
In an embodiment, the travel time of the robot is determined based on a direction and a speed of a water current, when the water current is downstream, collection time and energy consumption are in an optimal state; when the water current is upstream, the collection time and the energy consumption are in a worst state.
In an embodiment, when the water current is in a direction same as a heading angle of the robot, the travel time ti,k of the robot is calculated as follows:
-
- where v (distance per unit of time) represents a movement speed of the robot, w (with units of distance per unit of time) represents the speed of the water current, d represents a distance from a grid a to a grid b (i.e., a distance from the current position Gi to the target position Gk), and θ (in degrees) represents the heading angle of the robot, and Te represents an effective velocity of the robot in the water current.
In an embodiment, when the water current is in a direction opposite to the heading angle of the robot (i.e., the water current is upstream), the travel time ti,k of the robot is calculated as follows:
-
- where v (distance per unit of time) represents the movement speed of the robot, w (with units of distance per unit of time) represents the speed of the water current, d represents the distance from a grid a to a grid b (i.e., a distance from the current position Gi to the target position Gk), and θ (in degrees) represents the heading angle of the robot, and Te represents an effective velocity of the robot in the water current.
Compared to the related art, the disclosure has the following beneficial effects.
The disclosure can plan an optimal or near-optimal cleaning path for the robot used for collecting marine debris based on real-time environmental information, reducing unnecessary path repetition and ineffective motion, thereby significantly improving the cleaning efficiency.
The accompanying drawings generally illustrate various embodiments by way of example rather than limitation, and are used to explain embodiments of the disclosure in conjunction with the specification and claims. At appropriate times, same reference numerals are used in all the accompanying drawings to refer to same or similar parts. Such embodiments are illustrative and not intended to be exhaustive or exclusive embodiments of the device or method.
It should be noted that the embodiments and features in the embodiments of the disclosure can be combined with each other without conflict. the disclosure is described in detail below with reference to the accompanying drawings and in conjunction with embodiments.
An embodiment of the disclosure provides an efficient path planning method for a robot used for collecting marine debris, which includes the following steps.
1. Definition and AssumptionsIn mobile A-star (MA*) algorithm, it is assumed that the robot can obtain positions of all marine debris through satellites. In the disclosure, obstacles are enclosed within rectangular frames, as shown in
Firstly, in the disclosure, target positions that the robot needs to move to must be determined. In the disclosure, it is assumed that there are marine debris with the number of N in the environment, and grids where the marine debris are located are referred to as the target positions. The target positions of the marine debris are traversed through DFS. To avoid prioritizing traversing farther marine debris during a traversal process, a threshold td is set, i.e., a distance between a next target position to be traversed and a current position of the robot must be less than or equal to the threshold td.
-
- where a first target position to be traversed is assumed as Gi, and the next target position to be traversed is Gi+1, the distance between the target position to be traversed Gi and the next target position to be traversed Gi+1 must be less than or equal to the threshold td. The reason for this design is to avoid the robot first traversing farther target positions before closer target positions, which would result in redundant paths, leading to excessive path length and waste of time and power costs.
Path Planning
- where a first target position to be traversed is assumed as Gi, and the next target position to be traversed is Gi+1, the distance between the target position to be traversed Gi and the next target position to be traversed Gi+1 must be less than or equal to the threshold td. The reason for this design is to avoid the robot first traversing farther target positions before closer target positions, which would result in redundant paths, leading to excessive path length and waste of time and power costs.
To cope with a dynamic marine environment, where the marine debris is also in motion during the movement of the robot, the disclosure must consider the movement of the marine debris to identify the next target position to be traversed. After traversing through the DFS, a candidate sequence is obtained. Each target element in the candidate sequence undergoes individual path planning calculations. A target position with a lowest total cost is selected and set as the next target position to be traversed for the robot.
The disclosure designs a path planning algorithm called MA* based on the A-star (A*) algorithm and improvement of a heuristic function. In the MA* algorithm, the heuristic function is defined as follows:
-
- where f(Gi) represents a comprehensive priority corresponding to the current position Gi of the robot, the comprehensive priority includes total costs of the all target positions relative to the current position Gi, when traversing next marine debris, the robot selects the marine debris with the best comprehensive priority (i.e., the lowest total cost) to traverse; g(Gi) represents an actual cost from the current position Gi to a starting position Gs, h(Gi) represents an estimated cost from the current position Gi to a target position Gk, and p(Gi) represents an adaptive cost from the current position Gi to the target position Gk.
The actual cost is a distance cost consumed by the robot from the starting position Gs to the current position Gi, and a formula of the actual cost is expressed calculated as follows:
The estimated cost is calculated as follows; where Gk represents the target position, and Gi represents the current position.
Considering the time and power costs, a last item in the comprehensive priority calculation is the adaptive cost, and ti,k represents travel time of the robot from the current position Gi to the target position Gk. The travel time is determined based on the direction and speed of the water current. When the water current is downstream, collection time and energy consumption are in an optimal state; conversely, when the water current is upstream, the collection time and energy consumption are in a worst state.
The following formulas are for calculating the travel time when the robot is heading towards a target grid, at downstream and upstream. v (distance per unit of time) represents a movement speed of the robot, w (with units of distance per unit of time) represents the speed of the water current, d represents a distance from a grid a to a grid b, and θ (in degrees) represents the heading angle of the robot.
When the water current is in a direction same as the heading angle of the robot, the travel time ti,k of the robot is calculated as follows:
When the water current is in a direction opposite to the heading angle of the robot (i.e., the water current is upstream), the travel time ti,k of the robot is calculated as follows:
The disclosure utilizes a Windows 11 operating system equipped with 16 gigabytes (GB) of DDR4-3000 memory. In terms of simulation development, the disclosure employs C/C++ language, MATLAB, and Gnuplot (a plotting tool) as auxiliary tools for plotting and complex calculations. The disclosure conducts four sets of experiments to compare the performance of five algorithms including: MA*, Greedy, rapidly-exploring random tree (RRT), SMURF, and underwater (U*), in terms of average path length and average number of collected marine debris. The four sets of experiments are conducted as follows: (A) changing the total number of marine debris, (B) changing the movement speed of the robot, (C) changing the size of the obstacles, and (D) changing the ocean current velocity (i.e., the speed of the water current). The parameters set for the experiments are listed in Table 1.
The average path length Avglength is calculated by the following formula:
-
- where exet represents a total number of executions. If there is an edge E between a grid i and a grid j, eij=1; otherwise, eij=0.
The following formula defines the average number of collected marine debris GNavg:
-
- where GNm represents the number of collected marine debris in a m-th experiment. Additionally, if the distance between the robot and the marine debris is less than 1 m, it is considered a successful collection; otherwise, it is a failure. exet represents the total number of executions.
To make the experiments closer to reality, in addition to using OrcaFlex software (a dynamic analysis software for offshore marine systems) to simulate the marine environment for a movement pattern of the marine debris, the disclosure adopts the Ocean current model (kinematic model)[24] as an ocean movement model. The kinematic model of the Ocean current model can be written as:
-
- where Vx represents a velocity on an x-axis, Vy represents a velocity on a y-axis, k1, k2, k3, λ and V represent variables closely related to environmental factors such as tides and water depth. These parameters vary in different environments, as shown in Table 2.
The Effects of the Number of the Marine Debris
This set of experiments compares the effects of changing the total number of the marine debris on the total path length of the robot and the efficiency of marine debris collection for five methods. The robot starts from the top-left corner of the area, with a speed of 3 m/s, and each experiment executes for 3000 seconds (s).
In
In
The Effects of the Movement Speed of the Robot
This set of experiments compares the effects of changes in the robot movement speed on the total path length and the efficiency of marine debris collection for five methods. 50 pieces of marine debris are randomly generated, and the robot starts from the top-left corner of the area. The robot movement speed is increased from 5 m/s to 14 m/s, with each experiment executing for 3000 s.
In
In
The Effects of Obstacle Size
This set of experiments compares the effects of the obstacle size on the marine debris. The disclosure randomly generates 50 marine debris, with obstacle sizes increasing from 10% to 55%. The robot starts from the top-left corner of the area, with a movement speed set at 3 m/s, and each experiment for 3000 s.
In
This set of experiments compares the efficiency of marine debris collection when the ocean current velocity varies. 50 marine debris are randomly generated, with the ocean current velocity increasing from 2.2 m/s to 4 m/s. The robot starts from the top-left corner of the area, with a detection radius set at 50 m, a detection frequency of once every 10 s, the robot movement speed set at 3 m/s, the ocean current velocity increasing from 1 m/s to 2.8 m/s, and each experiment lasting for 3000 s.
In
The above is only a preferred specific embodiment of the disclosure, but the scope of protection of the disclosure is not limited to this. Within the technical scope disclosed in the disclosure, any equivalent substitution or change made by those skilled in the art according to the technical solution and inventive concept of the disclosure should be included in the scope of protection of the disclosure.
Claims
1. A path planning method for a robot used for collecting marine debris, wherein the robot comprises a processor and a controller, and the processor is connected to the controller; and the path planning method comprises: f ( G i ) = g ( G i ) + h ( G i ) + p ( G i ) p ( G i ) = t i, k
- traversing, by the processor, all target positions of the marine debris by using a depth-first search (DFS) algorithm to generate a target position sequence;
- determining, by the processor, a target position with a lowest total cost of the all target positions by using a path planning algorithm, and setting, by the processor, the target position with the lowest total cost as a target movement position for the robot; and
- controlling, by the controller, the robot to move to the target movement position, and collecting, by the robot, marine debris at the target movement position;
- wherein a formula for the path planning algorithm is as follows:
- where f(Gi) represents a comprehensive priority corresponding to a current position Gi of the robot, the comprehensive priority comprises total costs of the all target positions relative to the current position Gi, g(Gi) represents an actual cost from the current position Gi to a starting position Gs of the robot, h(Gi) represents an estimated cost from the current position Gi to a target position Gk, and p(Gi) represents an adaptive cost from the current position Gi to the target position Gk;
- wherein the adaptive cost is calculated as follows:
- where ti,k represents travel time of the robot from the current position Gi to the target position Gk.
2. The path planning method for the robot used for collecting the marine debris as claimed in claim 1, wherein the traversing all target positions of the marine debris comprises:
- setting a threshold td, wherein a distance between the target movement position and the current position of the robot is less than or equal to the threshold td.
3. The path planning method for the robot used for collecting the marine debris as claimed in claim 1, wherein the actual cost is a distance cost consumed by the robot from the starting position Gs to the current position Gi, and a formula of the actual cost is expressed as follows: g ( G i ) = ∑ j = 1 i dist ( G s, G j )
- where Gs represents the starting position, Gi represents the current position, and dist(Gs,Gj) represents a distance between Gs and Gj.
4. The path planning method for the robot used for collecting the marine debris as claimed in claim 1, wherein the estimated cost is calculated as follows: h ( G i ) = ∑ j = i + 1 k dist ( G i, G j ) dist ( G i, G j ) ≤ t d
- where Gk represents the target position, Gi represents the current position, and dist(Gi,Gj) represents a distance between Gi and Gj.
5. The path planning method for the robot used for collecting the marine debris as claimed in claim 1, wherein the travel time of the robot is determined based on a direction and a speed of a water current; when the water current is downstream, collection time and energy consumption are in an optimal state; when the water current is upstream, the collection time and the energy consumption are in a worst state.
6. The path planning method for the robot used for collecting the marine debris as claimed in claim 5, wherein when the water current is in a direction same as a heading angle of the robot, the travel time ti,k of the robot is calculated as follows: t i, k = d T e T e = v + w × cos ( θ )
- where v represents a movement speed of the robot, w represents the speed of the water current, d represents a distance from the current position Gi to the target position Gk, θ represents the heading angle of the robot, and Te represents an effective velocity of the robot in the water current.
7. The path planning method for the robot used for collecting the marine debris as claimed in claim 5, wherein when the water current is upstream in a direction opposite to a heading angle of the robot, the travel time ti,k of the robot is calculated as follows: t i, k = d T e T e = v - w × cos ( θ )
- where v represents a movement speed of the robot, w represents the speed of the water current, d represents a distance from the current position Gi to the target position Gk, and θ represents the heading angle of the robot, and Te represents an effective velocity of the robot in the water current.
| 115542887 | December 2022 | CN |
| 101554498 | September 2015 | KR |
| 2029596 | June 2023 | NL |
- Chen, Jingchuan, et al., “Path Planning Considering Time-Varying and Uncertain Movement Speed in Multi-Robot Automatic Warehouses: Problem Formulation and Algorithm”, Dec. 1, 2022, arXiv.org (Year: 2022).
- Machine translation of Hou et al. (CN-115542887-A) (Year: 2022).
- Machine translation of Lee (KR-101554498-B1) (Year: 2015).
- Ou, Yangqi, et al., “Improved A* Path Planning Method Based on the Grid Map”, Aug. 18, 2022 (Year: 2022).
Type: Grant
Filed: Nov 20, 2024
Date of Patent: Sep 29, 2026
Patent Publication Number: 20260064127
Assignee: GUANGDONG UNIVERSITY OF SCIENCE AND TECHNOLOGY (Dongguan)
Inventors: Rong-Guei Tsai (Dongguan), Shu Gong (Dongguan), Wen Wang (Dongguan), Ronghao Li (Dongguan), Xiaolan Chen (Dongguan), Lin Lin (Dongguan), Delin Luo (Dongguan), Shanna He (Dongguan), Xinxin Chen (Dongguan), Jung-Feng Tsai (Dongguan)
Primary Examiner: Navid Z. Mehdizadeh
Assistant Examiner: Sarah A. Mueller
Application Number: 18/953,111