CPC A47L 11/4011 (2013.01) [G05D 1/0219 (2013.01); G05D 1/024 (2013.01); G05D 1/0274 (2013.01); A47L 2201/04 (2013.01)] | 16 Claims |
1. A detection method, applied to a mobile robot to detect a region environment for drawing a region environment map, wherein the mobile robot is provided with a detection sensor, the region environment map is gradually expanded by a combination of detection of the detection sensor and a behavior path of the mobile robot until an entire region environment map is finally generated, wherein a region detected by the detection sensor is a detected region, a region not detected by the detection sensor is an undetected region; the method comprises:
step S1, obtaining a first region environment map through the detection sensor detecting the region environment, the first region environment map comprising an outer contour of a region environment currently detectable by the mobile robot and the undetected region, the outer contour comprising obstacles around the region environment, the obstacles representing a wall around the region environment, an obstacle placed against the wall and a free obstacle, the free obstacle being an obstacle that is less than or equal to a body width of the mobile robot from any other obstacle on the outer contour of the region environment;
step S2, determining a detection target point based on the first region environment map, the detection target point being a position needed to be detected by the mobile robot, generating a first detection path based on the detection target point, the first detection path being configured for guiding the mobile robot to move, the first detection path comprising a start point of the first detection path and an end point of the first detection path, the start point of the first detection path being a current position of the mobile robot when detecting the first region environment map, a distance between the end point of the first detection path and the detection target point not exceeding a detection range of the detection sensor;
step S3, during a movement of the mobile robot according to the first detection path, obtaining a second region environment map through the detection sensor detecting the region environment, the second region environment map comprising an outer contour of a region environment detected by the mobile robot during the movement and the outer contour of the first region environment map; and
step S4, in response to detecting that path detection executed by the mobile robot is over, taking the end point of the first detection path as a start point of a second detection path and generating the second detection path based on the second region environment map, determining a third region environment map according to the second detection path, the third region environment map comprising an outer contour of a region environment detected by the mobile robot during a movement according to the second detection path and an outer contour of the second region environment map, loop executing an operation of determining a region environment map until the mobile robot detects that the entire region environment map is drawn; wherein the mobile robot is configured to move along the outer contour while keeping a certain distance from the outer contour and/or move along an edge of the outer contour when moving according to the detection path generated based on any one of region environment maps;
wherein the step S2, determining a detection target point based on the first region environment map comprises:
step S201, extracting the outer contour of the region environment and the undetected region from the first region environment map to form a detection map, and determining a detection start point in the detection map; and
step S202, starting from the detection start point, traversing the outer contour of the region environment in the detection map along a clockwise or counterclockwise direction to query a first point located at a junction of the detected region and the undetected region as the detection target point; and
the step S2, generating a first detection path based on the detection target point comprises:
step S203, determining the end point of the first detection path within a detection range of the mobile robot by taking the detection target point as a center, the distance between the detection target point and the end point of the first detection path not exceeding the detection range of the detection sensor of the mobile robot, such that the mobile robot is capable of detecting the detection target point at the end point of the first detection path; and
step S204, generating the first detection path by taking the start point of the first detection path as a start point and taking the end point of the first detection path as an end point.
|