SAFETY PROTECTION METHOD OF DYNAMIC DETECTION FOR MOBILE ROBOTS

Abstract

The present invention discloses a safety protection method of dynamic detection for mobile robots. The mobile robot is provided with a sensor. Said sensor obtains the obstacle information in the detection areas in front of a mobile robot, and the mobile robot is caused to progressively slow down and dynamically adjust the detection area when an obstacle appears in the detection area. If no obstacle is detected in the detection area after adjusting, then the mobile robot is caused to keep on moving, and if an obstacle is still detected in the detection area after adjusting, then the mobile robot is caused to keep on decelerating until they are stopped. The sensor sets different detection areas according to the traveling speed and traveling direction of the mobile robot, or presets the detection area according to the path and dynamically adjusts it when the mobile robot is running. The safety protection method of dynamic detection for mobile robots of the present invention enables a mobile robot to pass through a path with many obstacles, having good capability of anti-interference and meanwhile ensuring the consistency of the detection range and processing mechanism at curved and linear paths.

Description

FIELD OF THE INVENTION

The present invention relates to the field of mobile robots and, more particularly, to a safety protection method of dynamic detection for mobile robots.

DESCRIPTION OF THE PRIOR ART

Mobile robots are machinery that can automatically perform tasks, and they can either be commanded by a human being, or run programs written beforehand. Their mission is to assist or replace people in working, for example, in production industries, construction industries, or other dangerous works. In the process of the mobile robots performing tasks, it is usually required to sense the obstacles in the traveling path and avoid them. That is to say, a real time detection is required in the process of the movement of the mobile robot movement, and the obstacle detection areas are generally one stop zone and one deceleration zone. When obstacles are detected in the deceleration zone, the mobile robot will decelerate, and when obstacles are detected in the stop zone, the robot will be stopped. Usually, a larger stop zone is statically set up to guarantee that the robot will completely stop when it collides with the obstacle.

The setup of the static stop zone can desirably protect the mobile robot from colliding, however, it may also make the passing requirements of mobile robots higher, resulting in that some specific areas cannot be passed. Therefore, those skilled in the art desire to research and develop a safety protection method for mobile robots with lower passing requirements and higher efficiency.

SUMMARY OF THE INVENTION

In view of the above-mentioned drawbacks in the prior art, the technical problem to be solved by the present invention is to provide a safety protection method for mobile robots with lower passing requirements and higher efficiency.

In order to attain the above-mentioned goals, the present invention provides a safety protection method of dynamic detection for mobile robots, and, specifically, the technical scheme provided by the present invention is as follows:

A safety protection method of dynamic detection for mobile robots, wherein a mobile robot is provided with a sensor obtaining obstacle information in a detection area in front of the mobile robot, causing the mobile robot to progressively decelerate when an obstacle appears in the detection area, and the detection area is dynamically adjusted; if no obstacle is detected in the detection area after adjusting, then the mobile robot is caused to keep on moving; if an obstacle is still detected in the detection area after adjusting, then the mobile robot is caused to keep on decelerating until it stops.

Preferably, the detection area is divided into a stop zone that is close to the mobile robot and a deceleration zone in front of the stop zone.

Preferably, dynamically adjusting the detection area comprises progressively decreasing the area of the detection area of sensor.

Furthermore, the progressively decreasing of the area of the detection area of the sensor is a proportional decreasing.

Furthermore, the maximum detection width of the detection area vertical to the direction of movement of the mobile robot is greater than the width of the mobile robot.

Preferably, the detection area has a rectangle shape by default. When the mobile robot is in a turning status, the direction, curvature and shape of the detection area are adjusted according to the traveling direction and the magnitude of the angular velocity of the mobile robot.

Preferably, there are a plurality of sensors, each provided with different detection distances, the mobile robot dynamically adjusting the detection area by switching the combination pattern of the sensors.

Furthermore, said sensors comprise photoelectric sensors and/or laser sensors and/or visual sensors and/or ultrasonic sensors.

Preferably, the mobile robot presets the parameters of the detection area of different sections of a path according to the condition of the path.

The present invention also provides a safety protection method of dynamic detection for mobile robots, the mobile robot is provided with a sensor for obtaining the obstacle information in a detection area in front of the mobile robot, said sensor is provided with different detection areas according to the traveling speed and traveling direction of the mobile robot.

The safety protection method of dynamic detection for mobile robots that is provided by the present invention sets up different detection areas according to the different traveling speeds, directions and paths, enabling mobile robots to pass through the paths with many obstacles, having good capability of anti-interference. The special detection area can be customized for special paths, special demands, and meanwhile the consistency of the curved and linear detection ranges and the processing mechanisms can also be ensured.

The method and the technical effects of the present invention will be further illustrated below in conjunction with the accompanying drawings, in order to fully understand the objects, features and effects of the present invention.

BRIEF DESCRIPTION OF THE DRAWINGS

FIG. 1 is a schematic diagram of a conventional static detection area of a mobile robot;

FIG. 2 is a schematic diagram of a dynamic detection area in a preferred embodiment of the present invention;

FIG. 3 is a schematic diagram of dynamically adjusting the detection area at each section of the road according to the path in a preferred embodiment of the present invention;

FIG. 4 is a schematic diagram of dual vehicle dispatching utilizing a dynamic detection area.

DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS

It is usually necessary to perform obstacle detection for mobile robots in the process of movement. When the detection area is inappropriately set, the robot cannot pass through the path in some circumstances. Shown in FIG. 1 is a schematic diagram of mobile robots meeting with obstacles in the conventional statical detection areas (in which, the circles denote mobile robots, the black solid lines denote the paths, the triangles or rectangles with grid shading denote obstacles, the left and right rectangles with shadow shadings denote the deceleration zones and the stop zones, respectively; robots will stop when obstacles are detected inside the stop zones, and they will decelerate smoothly when obstacles are detected inside the deceleration zones, the denotations are the same in FIG. 2-4). As seen from FIG. 1, when obstacles are detected in the deceleration zones, mobile robots will decelerate, and when obstacles enter into the stop zones, mobile robots will stop moving.

However, in the present invention, by dynamic setting of the detection areas, tolerance values towards the passing conditions are increased, and passing requirements are lowered, avoiding the problem of impassability in some special paths. By modelizing and generalizing the detection areas of robots, the different detection areas can be set according to the different travel directions and the different traveling speeds of mobile robots, and the requirements for performing special customization to special paths can also be met. All these three cooperating with one other, and comprehensively taking into consideration the factors such as vehicle velocities, vehicle postures, road conditions, safe, reliable road obstacles detection and protection mechanism for robots can be achieved. Shown in FIG. 2 is a schematic diagram of the dynamic detection areas in a preferred embodiment of the present invention in the same running condition as in FIG. 1. When obstacles are detected in the deceleration zones of the detection area of mobile robots, mobile robots will decelerate and dynamically adjust the detection area, as seen from FIG. 2, and no obstacles are detected in the detection area after dynamically adjusting, mobile robots can keep on moving according to the original specified path. Therefore, when a number of interfering objects are detected in the path, the mobile robots moving in normal speed will decelerate first when detecting the obstacles, and then progressively decrease detection areas by switching detection area under slow speeds, thus allowing robots to smoothly pass through the paths with rigorous operating environments. In other embodiments, adjusting of the detection area can also be achieved by setting different detection distances for a plurality of sensors. For example, when photoelectric, laser, visual or ultrasonic sensors are used, different detection distances can be dynamically set for a plurality of sensors, and changing of detection areas can be achieved by dynamic combination of the turn-on or turn-off of these sensors. In practical applications, two groups of photoelectric, laser, visual or ultrasonic sensors can be installed in the direction of advance, with various combinations having different detection distances, and these two groups can be switched over according to the velocities of advancing of robots. With regard to sensors mounted on different positions of mobile robots, under different moving conditions, sensors on specific positions can be turned on for protecting. For example, sensors mounted on front positions are enabled to take effect when advancing, and sensors mounted on rear positions are enabled to take effect when retreating; sensors mounted on left front positions are enabled to take effect when turning left and advancing, and sensors mounted on right front positions are enabled to take effect when turning right and advancing.

Secondly, the shapes of the detection areas can be changed synchronously with regard to the different travel directions of mobile robots. In the process of movement, if the detection areas during direct movement and turning are not accordingly adjusted, inconsistency of motion situations will be caused between the direct movement and turning movement due to the changes of vehicle postures of robots when turning. By adjusting the directions, curvatures and shapes of the detection areas according to different travel directions and magnitudes of angular velocities, safe, normal passing can be guaranteed. As shown in FIG. 2, when mobile robots are turning, the parameters of the detection area are dynamically adjusted according to the traveling directions and the magnitudes of the angular velocities of mobile robots. The diamonds as shown in the figures are only schematic, and the detection areas can also be set to other shapes, as long as it is guaranteed that the mobile robots can safely pass through the paths they are in. Of course, preferably, the maximum detection widths of the detection areas vertical to the direction of moving of the mobile robots is not smaller than the widths of mobile robots.

Moreover, with regard to the paths with special road conditions or with special demands, by adjusting various parameters of detection ranges, special detection areas can be customized to satisfy the special requirements of paths. Shown in FIG. 3 is a schematic diagram of dynamically adjusting detection areas of each section of the road according to the path. By presetting different detection areas for mobile robots according to road condition information of different sections of roads, for instance, when mobile robots need to pass through narrow roadways, the widths of detection areas are dynamically adjusted to narrow, to adapt to special paths of roadways, enabling mobile robots to safely pass through.

In practical applications, if mobile robots adopt the method for dynamically adjusting the detection area of the present invention, when two mobile robots dispatch on meeting, it is not necessary for one of them to wait to finish the dispatching of both vehicles, which greatly increases the efficiency of dispatching. As shown in FIG. 4, when the mobile robot on the lower part detects that there is another mobile robot in the deceleration zone in the front, it causes detection area to be decreased while decelerating, and there are no robots in the upper part inside the detection areas after the dynamic adjustment, which means that the robot in the lower part can safely pass through without waiting.

The preferred specific embodiment of the invention has been described in detail above. It is to be understood that numerous modifications and variations can be made by those ordinary skilled in the art in accordance with the concepts of the present invention without any inventive effort. Therefore, the technical solutions that may be derived by those skilled in the art according to the concepts of the present invention on the basis of the prior art through logical analysis, reasoning and limited experiments should be within the scope of protection defined by the claims.

Claims

1. A safety protection method of dynamic detection for mobile robots, wherein a mobile robot is provided with a sensor obtaining obstacle information in a detection area in front of the mobile robot, causing the mobile robot to progressively decelerate when an obstacle appears in the detection area, and the detection area is dynamically adjusted; if no obstacle is detected in the detection area after adjusting, then the mobile robot is caused to keep on moving; if an obstacle is still detected in the detection area after adjusting, then the mobile robot is caused to keep on decelerating until it stops.

2. The safety protection method of dynamic detection for mobile robots according to claim 1, wherein the detection area is divided into a stop zone that is close to the mobile robot and a deceleration zone in front of the stop zone.

3. The safety protection method of dynamic detection for mobile robots according to claim 1, wherein dynamically adjusting the detection area comprises progressively decreasing the area of the detection area of the sensor.

4. The safety protection method of dynamic detection for mobile robots according to claim 3, wherein the progressively decreasing of the area of the detection area of the sensor is a proportional decreasing.

5. The safety protection method of dynamic detection for mobile robots according to claim 4, wherein the maximum detection width of the detection area vertical to the direction of movement of the mobile robot is greater than the width of the mobile robot.

6. The safety protection method of dynamic detection for mobile robots according to claim 1, wherein, when the mobile robot is in a turning status, the direction, curvature and shape of the detection area are adjusted according to the traveling direction and the magnitude of the angular velocity of the mobile robot.

7. The safety protection method of dynamic detection for mobile robots according to claim 1, wherein there are a plurality of sensors, each provided with different detection distances, the mobile robot dynamically adjusting the detection area by switching the combination pattern of the sensors.

8. The safety protection method of dynamic detection for mobile robots according to claim 7, wherein said sensors comprise photoelectric sensors and/or laser sensors and/or visual sensors and/or ultrasonic sensors.

9. The safety protection method of dynamic detection for mobile robots according to claim 1, wherein the mobile robot presets the parameters of the detection area of different sections of a path according to the condition of the path.

10. A safety protection method of dynamic detection for mobile robots, wherein the mobile robot is provided with a sensor for obtaining the obstacle information in a detection area in front of the mobile robot, said sensor is provided with different detection areas according to the traveling speed and traveling direction of the mobile robot.