阅读说明：本技术 一种防疫消毒清洁机器人避障方法、装置及设备 (Obstacle avoidance method, device and equipment for epidemic prevention disinfection cleaning robot ) 是由 李亮 张斌 景斌 张岁寒 陈凯 罗新亮 于 2020-04-15 设计创作，主要内容包括：本发明公开了一种防疫消毒清洁机器人避障方法、装置及设备,所述方法包括步骤：实时获取防疫消毒清洁机器人按规划路径行进过程中障碍物的距离；根据获取的障碍物的距离确定障碍物所在的预警区域,所述预警区域为以机器人为中心且具有不同安全距离阈值的复数个区域；根据障碍物所在的预警区域确定所述防疫消毒清洁机器人的当前行进速度,所述当前速度与所在的预警区域的安全距离阈值正相关；当持续检测到障碍物位于具有最小安全距离阈值的预警区域中时,根据持续时长控制所述防疫消毒清洁机器人执行相应的避让动作。本发明确保避障时速度变化的平滑性、避免了机身受到冲击和晃动、提高避障的灵活性,减少障碍耗时、提高了作业效率。(The invention discloses an obstacle avoidance method, device and equipment for an epidemic prevention disinfection cleaning robot, wherein the method comprises the following steps: acquiring the distance of the obstacle in the process of moving the epidemic prevention disinfection cleaning robot according to the planned path in real time; determining an early warning area where the obstacle is located according to the acquired distance of the obstacle, wherein the early warning area is a plurality of areas which take a robot as a center and have different safety distance thresholds; determining the current traveling speed of the epidemic prevention disinfection cleaning robot according to the early warning area where the obstacle is located, wherein the current speed is positively correlated with the safety distance threshold of the early warning area where the obstacle is located; and when the obstacle is continuously detected to be positioned in the early warning area with the minimum safe distance threshold value, controlling the epidemic prevention disinfection and cleaning robot to execute a corresponding avoidance action according to the continuous duration. The invention ensures the smoothness of speed change during obstacle avoidance, avoids the machine body from being impacted and shaken, improves the flexibility of obstacle avoidance, reduces the time consumption of obstacles and improves the operation efficiency.)

1. An obstacle avoidance method for an epidemic prevention disinfection cleaning robot is characterized by comprising the following steps:

acquiring the distance of the obstacle in the process of moving the epidemic prevention disinfection cleaning robot according to the planned path in real time;

determining an early warning area where the obstacle is located according to the acquired distance of the obstacle, wherein the early warning area is a plurality of areas which take a robot as a center and have different safety distance thresholds;

determining the current traveling speed of the epidemic prevention disinfection cleaning robot according to the early warning area where the obstacle is located, wherein the current speed is positively correlated with the safety distance threshold of the early warning area where the obstacle is located;

and when the obstacle is continuously detected to be positioned in the early warning area with the minimum safe distance threshold value, controlling the epidemic prevention disinfection and cleaning robot to execute a corresponding avoidance action according to the continuous duration.

2. The obstacle avoidance method for the epidemic prevention disinfection and cleaning robot as claimed in claim 1, wherein the safety distance threshold is a distance value from the body contour of the epidemic prevention disinfection and cleaning robot.

3. The obstacle avoidance method for the epidemic prevention disinfection and cleaning robot as claimed in claim 1, wherein the determination of the current traveling speed of the epidemic prevention disinfection and cleaning robot according to the early warning area where the obstacle is located is specifically:

and controlling the epidemic prevention disinfection cleaning robot to move in a deceleration mode according to the early warning area where the obstacle is located, wherein after deceleration, the moving speed of the epidemic prevention disinfection cleaning robot in each early warning area is in direct proportion to the safety distance threshold value of each early warning area.

4. The obstacle avoidance method for the epidemic prevention disinfection and cleaning robot as claimed in claim 3, wherein when an obstacle is detected in at least two early warning areas, the traveling speed of the epidemic prevention disinfection and cleaning robot is reduced to the traveling speed corresponding to the early warning area with the minimum safety distance threshold value in the at least two early warning areas.

5. The obstacle avoidance method for the epidemic prevention disinfection and cleaning robot as claimed in claim 1, wherein the controlling the epidemic prevention disinfection and cleaning robot to execute the corresponding avoidance action according to the duration when the obstacle is continuously detected to be located in the early warning area with the minimum safe distance threshold specifically comprises:

detecting a duration t for which an obstacle is located in an early warning zone having a minimum safe distance threshold;

when the duration t is greater than a threshold t₁And is less than or equal to threshold t₂When the epidemic prevention disinfection and cleaning robot stops, t₁Less than the quotient, t, of the minimum safe distance threshold and the current traveling speed of the epidemic prevention disinfection and cleaning robot₂>t₁；

When the duration t is greater than a threshold t₂And when the robot avoids the obstacle according to the newly planned path, the robot returns to the previously planned path again to continue to travel.

6. The obstacle avoidance method of the epidemic prevention disinfection and cleaning robot as claimed in any one of claims 1 to 5, wherein the early warning area comprises a third early warning area, a second early warning area and a first early warning area which are arranged in sequence from inside to outside with the robot as a center, wherein the safety distance thresholds of the third early warning area, the second early warning area and the first early warning area are increased from small to large.

7. The obstacle avoidance method of the epidemic prevention disinfection cleaning robot as claimed in claim 6, comprising: the early warning system comprises a first early warning area, a second early warning area, a third early warning area and a control system, wherein the first early warning area detects obstacles through a multi-line laser radar, the second early warning area detects obstacles through a single-line laser radar, the third early warning area detects obstacles through an ultrasonic radar, and the detection distances of the ultrasonic radar, the single-line laser radar and the multi-line laser radar are respectively matched with the safety distance threshold values of the third early warning area, the second early warning area and the first early warning area.

8. The obstacle avoidance method of the epidemic prevention disinfection cleaning robot as claimed in claim 1, further comprising the steps of:

the ground form is detected through a sensor, when the ground height difference mutation is detected, the robot is controlled to carry out local path re-planning to avoid the ground cliff, and the robot returns to the original planned path again to continue traveling after avoiding the ground cliff according to the newly planned path.

9. The utility model provides an epidemic prevention disinfection cleaning machines people keeps away barrier device which characterized in that includes:

the distance detection module is used for acquiring the distance of the obstacle in the process of the epidemic prevention disinfection and cleaning robot moving along the planned path in real time;

the early warning area confirmation module is used for determining an early warning area where the obstacle is located according to the acquired distance of the obstacle, and the early warning area is a plurality of areas which take a robot as a center and have different safety distance thresholds;

the speed control module is used for determining the current travelling speed of the epidemic prevention disinfection and cleaning robot according to the early warning area where the obstacle is located, and the current speed is associated with the safety distance threshold of the early warning area where the obstacle is located;

and the avoidance action control module is used for controlling the epidemic prevention disinfection and cleaning robot to execute corresponding avoidance actions according to the duration when the obstacle is continuously detected to be positioned in the early warning area with the minimum safe distance threshold value.

10. An electronic device comprising a memory, a processor and a computer program stored on the memory and operable on the processor, wherein the processor implements the method according to any one of claims 1 to 8 when executing the program.

Technical Field

The invention relates to the field of environment-friendly robots, in particular to a method, a device and equipment for avoiding obstacles of an epidemic prevention disinfection cleaning robot.

Background

The epidemic prevention disinfection cleaning robot is used as an environment-friendly cleaning robot and is widely applied to cleaning and disinfection operations in public places such as stations, airports, hotels, stadiums and the like. Reduce operating personnel and wait to disinfect the closely contact of cleaning the environment in order to improve the degree of automation of operation and epidemic situation, automatic intelligent floor cleaning machine has appeared in the market, this floor cleaning machine can be according to the automatic operation of cleaning to the operation region of accomplishing of planning route, and simultaneously, at the operation in-process, in order to ensure safety, floor cleaning machine possesses certain obstacle avoidance function, however, the obstacle avoidance strategy of current automatic intelligent floor cleaning machine is more single, it is not flexible enough, and be used for avoidng fixed type's obstacle mostly, and simultaneously, because floor cleaning machine internally mounted has various devices and solution, too hard actions such as parking or turning to cause the fuselage to receive the impact and rock when keeping away the obstacle. For the working conditions with complex obstacles, such as stations, airports and other places with complex people flow and logistics, the obstacles are constantly changed, so that the existing obstacle avoidance strategy is difficult to achieve the balance among safety, stability, flexibility and operation efficiency during obstacle avoidance.

Disclosure of Invention

The invention provides an obstacle avoidance method of an epidemic prevention disinfection cleaning robot, aiming at solving the technical problems of single action, hardness, safety, stability, flexibility and low operation efficiency of the existing obstacle avoidance method.

The technical scheme adopted by the invention is as follows:

an obstacle avoidance method for an epidemic prevention disinfection cleaning robot comprises the following steps:

acquiring the distance of the obstacle in the process of moving the epidemic prevention disinfection cleaning robot according to the planned path in real time;

determining an early warning area where the obstacle is located according to the acquired distance of the obstacle, wherein the early warning area is a plurality of areas which take a robot as a center and have different safety distance thresholds;

determining the current traveling speed of the epidemic prevention disinfection cleaning robot according to the early warning area where the obstacle is located, wherein the current speed is positively correlated with the safety distance threshold of the early warning area where the obstacle is located; and when the obstacle is continuously detected to be positioned in the early warning area with the minimum safe distance threshold value, controlling the epidemic prevention disinfection and cleaning robot to execute a corresponding avoidance action according to the continuous duration.

Further, the safety distance threshold is a distance value from the profile of the body of the epidemic prevention disinfection and cleaning robot.

Further, the specific determination of the current traveling speed of the epidemic prevention disinfection and cleaning robot according to the early warning area where the obstacle is located is as follows:

and controlling the epidemic prevention disinfection cleaning robot to move in a deceleration mode according to the early warning area where the obstacle is located, wherein after deceleration, the moving speed of the epidemic prevention disinfection cleaning robot in each early warning area is in direct proportion to the safety distance threshold value of each early warning area.

Further, when the obstacles are detected in at least two early warning areas, the travelling speed of the epidemic prevention disinfection and cleaning robot is reduced to the travelling speed corresponding to the early warning area with the minimum safety distance threshold in the at least two early warning areas.

Further, when the obstacle is continuously detected to be located in the early warning area with the minimum safe distance threshold value, the controlling the epidemic prevention disinfection and cleaning robot to execute the corresponding avoidance action according to the duration specifically includes:

detecting a duration t for which an obstacle is located in an early warning zone having a minimum safe distance threshold;

when the duration t is greater than a threshold t₁And is less than or equal to threshold t₂When the epidemic prevention disinfection and cleaning robot stops, t₁Less than the minimum safe distance threshold and the current line of the epidemic prevention disinfection cleaning robotQuotient of the advancing speed, t₂>t₁；

When the duration t is greater than a threshold t₂And when the robot avoids the obstacle according to the newly planned path, the robot returns to the previously planned path again to continue to travel.

Further, the early warning area comprises a third early warning area, a second early warning area and a first early warning area which are sequentially arranged from inside to outside by taking a robot as a center, wherein the safety distance threshold of the third early warning area, the second early warning area and the first early warning area is sequentially increased from small to large.

Furthermore, the first early warning area detects obstacles through a multi-line laser radar, the second early warning area detects obstacles through a single-line laser radar, the third early warning area detects obstacles through an ultrasonic radar, and the detection distances of the ultrasonic radar, the single-line laser radar and the multi-line laser radar are respectively matched with the safety distance threshold values of the third early warning area, the second early warning area and the first early warning area.

Further, the method also comprises the following steps:

the ground form is detected through a sensor, when the ground height difference mutation is detected, the robot is controlled to carry out local path re-planning to avoid the ground cliff, and the robot returns to the original planned path again to continue traveling after avoiding the ground cliff according to the newly planned path.

In another aspect, the present invention provides an obstacle avoidance device for an epidemic prevention disinfection cleaning robot, comprising:

the distance detection module is used for acquiring the distance of the obstacle in the process of the epidemic prevention disinfection and cleaning robot moving along the planned path in real time;

the early warning area confirmation module is used for determining an early warning area where the obstacle is located according to the acquired distance of the obstacle, and the early warning area is a plurality of areas which take a robot as a center and have different safety distance thresholds;

the speed control module is used for determining the current travelling speed of the epidemic prevention disinfection and cleaning robot according to the early warning area where the obstacle is located, and the current speed is associated with the safety distance threshold of the early warning area where the obstacle is located;

and the avoidance action control module is used for controlling the epidemic prevention disinfection and cleaning robot to execute corresponding avoidance actions according to the duration when the obstacle is continuously detected to be positioned in the early warning area with the minimum safe distance threshold value.

The invention further provides electronic equipment which comprises a memory, a processor and a computer program stored on the memory and capable of running on the processor, wherein the processor executes the program to realize the obstacle avoidance method of the epidemic prevention disinfection cleaning robot.

The invention has the following beneficial effects:

according to the method, the early warning area where the obstacle is located is determined according to the acquired distance of the obstacle, and then different current traveling speeds of the epidemic prevention disinfection cleaning robot are correspondingly controlled according to different early warning areas, so that the smoothness of speed change during obstacle avoidance is ensured, the body is prevented from being impacted and shaken, and the stability of the body in the obstacle avoidance process is ensured; in addition, the method can also execute corresponding avoidance actions according to the duration of the detected obstacle, thereby improving the obstacle avoidance flexibility, reducing the time consumption of the obstacle and improving the operation efficiency.

In addition to the objects, features and advantages described above, other objects, features and advantages of the present invention are also provided. The present invention will be described in further detail below with reference to the accompanying drawings.

Drawings

The accompanying drawings, which are incorporated in and constitute a part of this application, illustrate embodiments of the invention and, together with the description, serve to explain the invention and not to limit the invention. In the drawings:

fig. 1 is a schematic flow chart of an obstacle avoidance method of an epidemic prevention disinfection cleaning robot in the preferred embodiment of the invention.

Fig. 2 is a schematic front view of the epidemic prevention disinfection cleaning robot.

Fig. 3 is a schematic diagram of the components of the unmanned system of the epidemic prevention disinfection cleaning robot.

Fig. 4 is a schematic view of an avoidance operation flow according to a preferred embodiment of the present invention.

Fig. 5 is a schematic diagram of setting of the warning area in the preferred embodiment of the present invention.

Fig. 6 is a schematic view of an obstacle avoidance apparatus of an epidemic prevention disinfection cleaning robot in the preferred embodiment of the invention.

In the figure: 1. a brush disc assembly; 2. a hub motor; 3. a steering device; 4. a water absorption assembly; 5. a brush disc push rod; 6. a water absorption pushing rod; 7. a traveling wheel; 8. a walking machine body; 9. a spray disinfection device; 10. a steering wheel; 11. an unmanned system; 12. a water tank assembly; 13. an electrical control system; 14. a front lower ultrasonic sensor; 15. a solid-state area array radar; 16. a single line laser radar; 17. front upper ultrasonic radar; 18. a front depth camera; 19. a side ultrasonic sensor; 20. an inertial measurement unit; 21. a multiline laser radar; 22. a rear depth camera; 23. a rear ultrasonic sensor; 24. and an industrial personal computer.

Detailed Description

It should be noted that the embodiments and features of the embodiments in the present application may be combined with each other without conflict. The present invention will be described in detail below with reference to the embodiments with reference to the attached drawings.

Referring to fig. 1, a preferred embodiment of the present invention provides an obstacle avoidance method for an epidemic prevention disinfection cleaning robot, comprising the steps of:

s1, acquiring the distance of the obstacle in the process of the epidemic prevention disinfection and cleaning robot moving along the planned path in real time;

s2, determining an early warning area where the obstacle is located according to the obtained distance of the obstacle, wherein the early warning area is a plurality of areas which take a robot as a center and have different safety distance thresholds;

s3, determining the current traveling speed of the epidemic prevention disinfection and cleaning robot according to the early warning area where the obstacle is located, wherein the current speed is positively correlated with the safety distance threshold of the early warning area where the obstacle is located;

and S4, controlling the epidemic prevention disinfection and cleaning robot to execute corresponding avoidance action according to the duration when the obstacle is continuously detected to be positioned in the early warning area with the minimum safe distance threshold value.

The embodiment can be applied to a plurality of sweeper with automatic walking, such as the epidemic prevention disinfection and cleaning robot shown in fig. 3 and 4, which integrates disinfection and cleaning and sweeping, and comprises a walking machine body 8, a water tank assembly 12, a brush disc assembly 1, a water absorption assembly 4, a spray disinfection device 9, an unmanned system 11 and an electrical control system 13.

The bottom of walking organism 8 is provided with walking wheel 7, and the top is provided with the steering wheel 10 that is used for manual driving, wherein, is located walking wheel 7 of walking organism 8 front end through turn to device 3 with walking organism 8 is connected, is convenient for turn to, is located walking wheel 7 of walking organism 8 rear end then only provides power, does not possess and turns to the function. The walking wheel 7 is provided with the hub motor 2 which is powered by a lithium battery to drive the wheel body to rotate, the obstacle avoidance method of the epidemic prevention disinfection cleaning robot takes the lithium battery as power energy, the epidemic prevention disinfection cleaning robot is driven to walk by the hub motor 2, the hub motor 2 and the walking wheel 7 are integrally installed, the structure of the robot can be effectively simplified, and the structure of the robot is more compact and reliable.

The water tank assembly 12 is fixedly arranged on the walking machine body 8 and is used for containing a disinfection solution for operation and sweeping waste water, on one hand, the water tank assembly 12 provides the prepared disinfection solution, and on the other hand, a user can collect the sweeping waste water in a sealing manner, so that secondary pollution of the waste water generated by the robot sweeping operation to the environment is prevented;

the brush disc assembly 1 is movably arranged at the front end of the walking machine body 8 and mainly cleans the ground in a rotating mode.

The assembly 4 activity of absorbing water sets up 8 bottoms of walking organism just are located brush dish assembly 1 rear for collect waste water of sweeping the floor and carry extremely water tank assembly 12, the robot is at the operation in-process of walking, brush dish assembly 1 rotates according to the settlement speed and sprays the disinfection solution that mixes, cleans and disinfects ground, and the sewage after cleaning is then through being located brush dish assembly 1 rear absorb water assembly 4 collect the back and carry extremely carry out subsequent innocent treatment in the sewage collection of water tank assembly 12.

The spray disinfection device 9 is arranged on the water tank assembly 12 and connected with disinfection solution in the water tank assembly 12, and is used for spraying disinfection on the surface of a specified object according to a set time length, wherein the surface of the specified object is specifically a part which is frequently contacted by a human body in an operation area, and comprises object surfaces which are easily touched by the human body, such as a seat, a door handle, a handrail and the like.

The electric control system 13 is electrically connected with the walking machine body 8, the water tank assembly 12, the brush disc assembly 1, the water absorption assembly 4, the spray disinfection device 9 and the unmanned system 11 respectively, and is used for controlling the action of each part of executive elements according to manual operation or a driving strategy of the unmanned system 11.

The unmanned system 11 comprises a sensing layer and a decision layer, the sensing layer performs map construction, positioning, navigation and obstacle avoidance after correcting relevant errors through data fusion of sensors, and the decision layer comprises an industrial personal computer 24.

Wherein, the perception layer specifically includes:

the multi-line laser radar 21 is arranged at the upper end of the walking machine body 8, is electrically connected with the industrial personal computer 24 through an Ethernet interface, and is used for constructing a map, positioning and navigating;

the front lower ultrasonic sensor 14, the front upper ultrasonic radar 17, the side ultrasonic sensor 19 and the rear ultrasonic sensor 23 are respectively arranged at the front lower end, the front upper end, the two side edges and the rear end of the walking machine body 8, are electrically connected with the industrial personal computer 24 through RS485 interfaces and are used for avoiding obstacles on the front, the back, the left and the right of the robot;

the single-line laser radar 16 is arranged at the front end of the walking machine body 8, is electrically connected with the industrial personal computer 24 through an Ethernet interface, and is used for constructing a map, positioning and avoiding barriers;

the solid-state area array radar 15 is arranged at the front end of the walking machine body 8, is electrically connected with the industrial personal computer 24 through an Ethernet interface, and is used for obstacle avoidance and ground cliff detection;

the inertial measurement unit 20 is electrically connected with the industrial personal computer 24 through an RS232 interface, and is used for correcting positioning and navigation by combining the multi-line laser radar 21 and the single-line laser radar 16;

the front depth camera 18 and the rear depth camera 22 are both made of realsent 435 cameras, are respectively arranged at the front end and the rear end of the walking machine body 8, are electrically connected with the industrial personal computer 24 through a USB interface, and can be used for identifying objects and avoiding obstacles through machine vision.

The decision layer comprises an industrial personal computer 24 which is electrically connected with each sensor of the sensing layer respectively and used for planning a path and controlling a process according to known position information constructed by each sensor of the sensing layer, and planning a traveling path, a speed and an obstacle avoidance mode of the robot.

The walking machine body 8 is provided with a brush disc push rod 5 which is connected with the brush disc assembly 1 and is used for adjusting the operation position of the brush disc assembly 1; and the water absorption and shoving push rods 6 are connected with the water absorption assembly 4 and are used for adjusting the operation position of the water absorption and shoving in the water absorption assembly 4, each push rod is driven by a hydraulic or pneumatic system, the position adjustment of the brush disc push rod 5 and the water absorption and shoving push rod 6 can be realized, for example, the brush disc assembly 1 and the water absorption and shoving can be lifted by the push rods when the operation is carried out from a storage place to an operation area or in a transition area, or after the operation is finished, and the relative positions of the brush disc assembly 1 and the water absorption and the bottom surface can be adjusted by the push rods before or in the operation process, so that the requirements of washing and water absorption operation are met.

When the floor and corner areas are washed, disinfected and cleaned, the obstacle avoidance method of the epidemic prevention disinfection and cleaning robot covers the working area according to the planned path of the unmanned system 11 to conduct autonomous navigation, walking and obstacle avoidance, simultaneously, mixed disinfection solution is sprayed to all passing areas, the brushing disc assembly 1 cleans dirt and oil stains in the area, the water absorption assembly 4 absorbs the washed sewage and the dirty dirt into the sewage storage container to be stored until the sewage storage container is full, and the robot autonomously conducts disinfection and cleaning work according to the planned path.

The obstacle avoidance method of the epidemic prevention disinfection cleaning robot in the embodiment can utilize a multi-line laser radar 21, a single-line laser radar 16, a front lower ultrasonic sensor 14, a front upper ultrasonic radar 17, a side ultrasonic sensor 19 and a rear ultrasonic sensor 23 to detect obstacles and obtain the distance between the obstacles and the robot, then determine an early warning area where the obstacles are located according to the obtained distance between the obstacles, correspondingly control the epidemic prevention disinfection cleaning robot to have different current traveling speeds according to the different early warning areas, ensure the smoothness of speed change during obstacle avoidance, avoid the impact and shake of the robot body, and ensure the stability of the robot body in the obstacle avoidance process; in addition, the embodiment can also execute corresponding avoidance actions according to the duration of the detected obstacle, so that the obstacle avoidance flexibility is improved, the time consumption of the obstacle is reduced, and the operation efficiency is improved.

Specifically, the safe distance threshold is a distance value from the profile of the body of the epidemic prevention disinfection and cleaning robot.

In a possible embodiment, the determining of the current traveling speed of the epidemic prevention disinfection and cleaning robot according to the early warning area where the obstacle is located specifically includes:

and controlling the epidemic prevention disinfection cleaning robot to move in a deceleration mode according to the early warning area where the obstacle is located, wherein after deceleration, the moving speed of the epidemic prevention disinfection cleaning robot in each early warning area is in direct proportion to the safety distance threshold value of each early warning area.

The epidemic prevention disinfection and cleaning robot is controlled to slow down to advance according to the early warning area where the obstacle is located, the advancing speed of the epidemic prevention disinfection and cleaning robot in each early warning area is in direct proportion to the safety distance threshold value of each early warning area, namely, the closer the obstacle is to the epidemic prevention disinfection and cleaning robot, the slower the current advancing speed of the epidemic prevention disinfection and cleaning robot is, so that the obstacle avoidance processing time of the epidemic prevention disinfection and cleaning robot is enough, the smoothness of speed change during obstacle avoidance can be ensured, the impact and shaking of the machine body are avoided, and the stability of the machine body in the obstacle avoidance process is ensured.

In a possible embodiment, when the obstacle is detected in at least two early warning areas, the traveling speed of the epidemic prevention disinfection and cleaning robot is reduced to the traveling speed corresponding to the early warning area with the minimum safe distance threshold in the at least two early warning areas.

The embodiment is mainly directed at the situation that a plurality of barriers with different distances are arranged near the epidemic prevention disinfection and cleaning robot, safety consideration is given, threat coefficients of the detected plurality of barriers with different distances to the epidemic prevention disinfection and cleaning robot are screened, and obviously, the influence of the closest barrier to the epidemic prevention disinfection and cleaning robot on the epidemic prevention disinfection and cleaning robot is the highest priority.

As shown in fig. 4, in a possible embodiment, the controlling the epidemic prevention disinfection and cleaning robot to perform the corresponding avoidance action according to the duration when the obstacle is continuously detected to be located in the early warning area with the minimum safe distance threshold specifically includes:

s211, detecting the duration t of the obstacle in the early warning area with the minimum safe distance threshold;

s212, when the duration t is greater than a threshold t1 and less than or equal to a threshold t2, controlling the epidemic prevention disinfection and cleaning robot to stop moving, wherein t1 is less than the quotient of the minimum safe distance threshold and the current traveling speed of the epidemic prevention disinfection and cleaning robot, and t2> t 1;

and S213, when the duration t is greater than a threshold t2, controlling the robot to perform local path re-planning to avoid the obstacle, and when the robot avoids the obstacle according to the newly planned path, returning to the previously planned path to continue traveling.

The present embodiment mainly relates to a condition when an obstacle is continuously detected. It can be understood that, many times, the duration time of the barrier on the walking path of the epidemic prevention disinfection and cleaning robot is different, and sometimes, the barrier is moved, the detected duration time is short, and the epidemic prevention disinfection and cleaning robot only needs to slow down to move according to preset parameters; sometimes, the obstacle is moving, but the detected duration is longer, and the epidemic prevention disinfection and cleaning robot can be controlled to stop moving without causing too much influence on the continuous operation of the epidemic prevention disinfection and cleaning robot, wherein the threshold t1 is smaller than the quotient of the minimum safe distance threshold and the current traveling speed of the epidemic prevention disinfection and cleaning robot, so that the epidemic prevention disinfection and cleaning robot is prevented from colliding with the obstacle before stopping moving. If the obstacle is continuously detected in the early warning area with the minimum safety distance threshold value and the duration is longer than the threshold value t2, the robot is controlled to perform local path re-planning to avoid the obstacle, and the robot returns to the previously planned path to continue traveling after avoiding the obstacle according to the newly planned path. It should be noted that, after the epidemic prevention disinfection and cleaning robot is stopped because the duration of the obstacle detection is longer than the threshold t1, if the duration for which the obstacle is detected is greater than the threshold t1 but less than or equal to the threshold t2, the epidemic prevention disinfection and cleaning robot will keep the state of stopping, considering the problem of operation efficiency, the epidemic prevention disinfection and cleaning robot can not continuously wait, if the obstacle continues to be detected, when the duration t is longer than the threshold t2, the epidemic prevention disinfection cleaning robot is controlled to firstly carry out local path re-planning to bypass the barrier, and then, the robot returns to the previously planned path to continue to travel after bypassing the obstacle, so that the excessive waiting time of the epidemic prevention disinfection and cleaning robot is reduced, the overall operation efficiency of the epidemic prevention disinfection and cleaning robot is improved, and the balance among safety, flexibility and operation efficiency during obstacle avoidance is realized.

As shown in fig. 5, in a possible embodiment, the early warning areas include a third early warning area, a second early warning area, and a first early warning area, which are sequentially arranged from inside to outside with a robot as a center, wherein safety distance thresholds of the third early warning area, the second early warning area, and the first early warning area sequentially increase from small to large. Taking the epidemic prevention disinfection cleaning robot shown in fig. 2 to 3 as an example, the first early warning area detects obstacles through the multi-line laser radar 21, the second early warning area detects obstacles through the single-line laser radar 16, the third early warning area detects obstacles through the front lower ultrasonic sensor 14, the front upper ultrasonic radar 17, the side ultrasonic sensor 19 and the rear ultrasonic sensor 23, and the detection distances of the ultrasonic radars, the single-line laser radar 16 and the multi-line laser radar 21 are respectively matched with the safety distance threshold values of the third early warning area, the second early warning area and the first early warning area.

The whole multi-protection mechanism is adopted in the embodiment to avoid the obstacle of the whole machine: the multi-line laser radar 21 detects a first early warning area, and a safety distance threshold value of the first early warning area is set to be a distance L1 from the outline of the robot body; detecting a second early warning area by the single-line laser radar 16, and setting a safety distance threshold value to be a distance L2 from the outline of the robot body; the front lower ultrasonic sensor 14, the front upper ultrasonic radar 17, the side ultrasonic sensor 19 and the rear ultrasonic sensor 23 adopt a double-probe mode to detect a third early warning area, and a safety distance threshold value of the third early warning area is set to be a distance L3 from the outline of the robot body; according to different sensor detection distance ranges, corresponding safe distance thresholds L1, L2 and L3 and corresponding traveling speeds v1, v2 and v3 are set (v1 > v 2> v3), and then the obstacle avoidance method of the embodiment comprises the following steps:

a) when the distance of the obstacle detected by the multi-line laser radar 21 is smaller than a safe distance threshold value L1, the industrial personal computer 24 issues an instruction to control the robot to decelerate to v 1;

b) when the single-line laser radar 16 detects that the distance of the obstacle is smaller than a safe distance threshold value L2, the industrial personal computer 24 issues an instruction to control the robot to decelerate to v 2;

c) when the distance of the obstacles detected by each ultrasonic sensor is smaller than a safe distance threshold value L3, the industrial personal computer 24 issues an instruction to control the robot to decelerate to v 3;

d) when the duration t of the obstacle detected by each ultrasonic sensor in the third early warning area is greater than a threshold t1 and less than or equal to a threshold t2, the industrial personal computer 24 issues an instruction to control the robot to stop moving;

e) when the duration t of the obstacle detected by the ultrasonic sensor in the third early warning area is greater than the threshold t2, the industrial personal computer 24 issues an instruction to control the robot to perform local path replanning to avoid the obstacle, and the robot returns to the previously planned path to continue traveling after avoiding the obstacle according to the newly planned path.

In this embodiment, the peripheral area of the robot is divided into three early warning areas from small to large according to different safety distance thresholds, when an obstacle is detected to be located in the corresponding early warning area, the industrial personal computer 24 issues an instruction to control the robot to decelerate to the corresponding traveling speeds v1, v2 and v3, wherein v1 > v 2> v3, that is, in this embodiment, three corresponding and sequentially changed traveling speeds are set according to the distance between the obstacle when the obstacle is avoided, and the distance is proportional to the current speed, that is, as the obstacle and the robot are continuously approached, the current speed of the robot is gradually changed in steps, that is, the obstacle deceleration process of the robot is a gradual change process compared with the prior art, and cannot be decelerated to the target at one time as in the prior art, so that the whole obstacle avoidance deceleration process of the robot is a relatively smooth process, and the fuselage is prevented from being impacted and shaken, the stability of the machine body in the obstacle avoidance process is ensured, and the machine body has very practical significance for an epidemic prevention disinfection cleaning robot loaded with a large amount of solution.

In a possible embodiment, the obstacle avoidance method further includes the steps of:

the ground form is detected through a sensor, when the ground height difference mutation is detected, the robot is controlled to carry out local path re-planning to avoid the ground cliff, and the robot returns to the original planned path again to continue traveling after avoiding the ground cliff according to the newly planned path. In the embodiment, the ground cliff detection is performed through the front depth camera 18 and the solid-state area array radar 15, the ground form (ground clearance) is detected to obtain the laser point cloud, and the cliff detection is performed through the laser point cloud mutation.

As shown in fig. 6, another embodiment of the present invention provides an obstacle avoidance apparatus for an epidemic prevention disinfection cleaning robot, including:

the distance detection module is used for acquiring the distance of the obstacle in the process of the epidemic prevention disinfection and cleaning robot moving along the planned path in real time;

the early warning area confirmation module is used for determining an early warning area where the obstacle is located according to the acquired distance of the obstacle, and the early warning area is a plurality of areas which take a robot as a center and have different safety distance thresholds;

the speed control module is used for determining the current travelling speed of the epidemic prevention disinfection and cleaning robot according to the early warning area where the obstacle is located, and the current speed is associated with the safety distance threshold of the early warning area where the obstacle is located;

and the avoidance action control module is used for controlling the epidemic prevention disinfection and cleaning robot to execute corresponding avoidance actions according to the duration when the obstacle is continuously detected to be positioned in the early warning area with the minimum safe distance threshold value.

Another embodiment of the present invention provides a storage medium, which includes a stored program, wherein when the program runs, a device in which the storage medium is located is controlled to execute the obstacle avoidance method for the epidemic prevention and disinfection cleaning robot.

Another embodiment of the present invention provides an electronic device, which includes a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein the processor implements the method for avoiding obstacles by using the epidemic prevention and disinfection robot when executing the program. It should be noted that the steps illustrated in the flowcharts of the figures may be performed in a computer system such as a set of computer-executable instructions and that, although a logical order is illustrated in the flowcharts, in some cases, the steps illustrated or described may be performed in an order different than presented herein.

The functions of the method of the present embodiment, if implemented in the form of software functional units and sold or used as independent products, may be stored in one or more storage media readable by a computing device. Based on such understanding, part of the contribution of the embodiments of the present invention to the prior art or part of the technical solution may be embodied in the form of a software product stored in a storage medium and including instructions for causing a computing device (which may be a personal computer, a server, a mobile computing device, a network device, or the like) to execute all or part of the steps of the method described in the embodiments of the present invention. And the aforementioned storage medium includes: a U-disk, a removable hard disk, a Read-Only Memory (ROM), a Random Access Memory (RAM), a magnetic disk or an optical disk, and other various media capable of storing program codes.

The above description is only a preferred embodiment of the present invention and is not intended to limit the present invention, and various modifications and changes may be made by those skilled in the art. Any modification, equivalent replacement, or improvement made within the spirit and principle of the present invention should be included in the protection scope of the present invention.