Cleaning robot and shortest path planning method based on cleaning robot
A cleaning robot and a shortest path planning method based on a cleaning robot are disclosed, a plurality of cleaning lines are formed by controlling the cleaning robot to perform cleaning in an area according to a zigzag-shaped path; association information of midpoints of at least a part of the cleaning lines is recorded to form a node skeleton tree in which midpoints are represented by nodes, the association information of each midpoint includes: position information of a node corresponding to the midpoint, position information of a parent node, and information of the number of child nodes of the parent node; in the process of traversing upwardly from a current node or traversing upwardly from both a current node and a target node in the node skeleton tree, the node skeleton tree is compressed, so as to determine the shortest planned path from the current node to the target node.
1. A shortest path planning method based on a cleaning robot, comprising the following steps:
controlling the cleaning robot to perform cleaning in an area according to a boustrophedon type path, to form a plurality of cleaning lines;
recording association information of midpoints of at least a part of the cleaning lines to form a node skeleton tree in which the midpoints are represented by nodes, wherein the association information of each of the midpoints includes: position information of a node corresponding to the midpoint, position information of a parent node, and information of a number of child nodes of the parent node; and
compressing the node skeleton tree in a process of traversing upwardly from a current node in the node skeleton tree or in a process of traversing upwardly from both the current node and a target node in the node skeleton tree, so as to determine a shortest planned path from the current node to the target node,
wherein when the cleaning robot moves from a cleaned area to an uncleaned area, association information of a midpoint of an open boundary line between the cleaned area and the uncleaned area is recorded to serve as a node of the node skeleton tree.
2. The method according to claim 1 , wherein the target node is a root node, and in the process of traversing upwardly from the current node, parent nodes having at least two child nodes are retained and parent nodes having one child node are removed by compression, until the target node becomes a parent node of the current node.
3. The method according to claim 1 , wherein the target node is a leaf node, and in the process of traversing upwardly from both the current node and the target node, parent nodes having at least two child nodes are retained, and parent nodes having one child node are removed by compression, until the current node and the target node have a same parent node.
4. The method according to claim 1 , wherein association information of midpoints of cleaning lines formed when the cleaning robot repeatedly cleans a cleaned area is not recorded, so as to prevent a loopback path from being formed in the node skeleton tree.
5. The method according to claim 1 , wherein when the cleaning robot is controlled to perform cleaning in the area along the boustrophedon type path, a navigation map is established; and if the navigation map is corrected, the node skeleton tree is corrected correspondingly.
6. The method according to claim 1 , wherein association information of midpoints of cleaning lines whose length is smaller than a preset threshold is not recorded, with the cleaning lines located in an area with an excessively high degree of closure.
7. The method according to claim 6 , wherein the preset threshold is twice a body width of the cleaning robot.
8. The method according to claim 6 , wherein the area with an excessively high degree of closure is an area where the cleaning robot is blocked by obstacles in three directions of four directions.
9. The method according to claim 1 , wherein the node skeleton tree has only one root node.
10. A cleaning robot, comprising: at least one processor; and
a memory in communication connection with the at least one processor,
wherein the memory stores instructions executable by the at least one processor, and the instructions are executed by the at least one processor to cause the at least one processor to execute the method of claim 1 .
11. The method according to claim 2 , wherein association information of midpoints of cleaning lines formed when the cleaning robot repeatedly cleans a cleaned area is not recorded, so as to prevent a loopback path from being formed in the node skeleton tree.
12. The method according to claim 3 , wherein association information of midpoints of cleaning lines formed when the cleaning robot repeatedly cleans a cleaned area is not recorded, so as to prevent a loopback path from being formed in the node skeleton tree.
13. The method according to claim 2 , wherein when the cleaning robot is controlled to perform cleaning in the area along the boustrophedon type path, a navigation map is established; and if the navigation map is corrected, the node skeleton tree is corrected correspondingly.
14. The method according to claim 3 , wherein when the cleaning robot is controlled to perform cleaning in the area along the boustrophedon type path, a navigation map is established; and if the navigation map is corrected, the node skeleton tree is corrected correspondingly.
15. The method according to claim 2 , wherein association information of midpoints of cleaning lines whose length is smaller than a preset threshold is not recorded, with the cleaning lines located in an area with an excessively high degree of closure.
16. The method according to claim 3 , wherein association information of midpoints of cleaning lines whose length is smaller than a preset threshold is not recorded, with the cleaning lines located in an area with an excessively high degree of closure.
17. The method according to claim 2 , wherein the node skeleton tree has only one root node.