Cleaning method of underwater robot, underwater robot, and storage medium
By obtaining the historical cleaning data of the underwater robot, dynamically adjusting the pumping power, the problem of the underwater robot's reduced endurance when climbing walls or avoiding obstacles is solved, and the cleaning efficiency and stability are improved.
Patent Information
- Application Number
- PCT/CN2023/096909
- Authority / Receiving Office
- WO · WO
- Patent Type
- Applications
- Current Assignee / Owner
- Priority Date
- 2023-05-16
- Filing Date
- 2023-05-29
- Publication Date
- 2024-11-21
AI Technical Summary
The underwater robot directly adjusts the pumping power to the maximum when climbing a wall or avoiding obstacles, resulting in the problem of reduced battery life.
By obtaining the historical cleaning data of the underwater robot, the current blockage value of the filter is determined, and the pumping power is dynamically adjusted according to the blockage value to perform climbing and obstacle avoidance actions.
It improves the battery life of the underwater robot and the full coverage cleaning efficiency of the swimming pool, avoids insufficient climbing power or excessive power overflow caused by fixed pumping power, and ensures the stability and efficiency of the cleaning process.
Smart Images

Figure CN2023096909_21112024_PF_FP_ABST
Abstract
Description
Underwater robot cleaning method, underwater robot and storage medium
[0001] This application claims priority to the Chinese patent application filed with the China Patent Office on May 16, 2023, with application number 202310550938.X and application name “Cleaning method of underwater robot, underwater robot and storage medium”, the entire contents of which are incorporated by reference into the application. Technical Field
[0002] The present application relates to the field of cleaning robots, and in particular to a cleaning method of an underwater robot, an underwater robot, and a storage medium. Background Art
[0003] Underwater robots can be used in a variety of underwater environments, such as repeatedly cleaning the bottom, walls, and waterline of a swimming pool, or filtering the pool water. In related underwater robot control schemes, when controlling an underwater robot for a comprehensive pool cleaning, the robot is typically controlled to clean the pool bottom and then the walls in that order. When climbing to the pool wall, the robot typically uses a fixed pumping power to perform the wall-climbing maneuver. Higher pumping power results in greater displacement and increased climbing power.
[0004] However, the climbing power corresponding to the pumping power is also affected by the filter within the pumping mechanism. For example, after cleaning the pool bottom, if the filter is heavily laden with debris, the robot's displacement will fall far short of its fixed pumping capacity. As a result, the robot's climbing power at that moment will not be sufficient to maintain contact with the pool wall and clean it. In this case, the robot will simply adjust its pumping power to maximum to ensure the pool wall is cleaned. However, this power regulation method reduces the robot's endurance.
[0005] The above content is only used to assist in understanding the technical solution of this application and does not constitute an admission that the above content is prior art. Technical issues
[0006] The main purpose of the present application is to provide an underwater robot cleaning method, an underwater robot and a storage medium, so as to solve the problem in the prior art that the underwater robot directly adjusts the pumping power to the maximum when climbing a wall or avoiding obstacles, thereby reducing the endurance. Technical Solutions
[0007] To achieve the above objectives, the present application provides a method for cleaning an underwater robot, the method comprising the following steps:
[0008] Obtaining historical cleaning data of the underwater robot;
[0009] Determining a current clogging value of the filter according to the historical cleaning data; and
[0010] When the underwater robot performs a climbing action and / or an obstacle avoidance action, a target pumping power is determined according to the current blockage value, and the climbing action and / or the obstacle avoidance action is performed according to the target pumping power.
[0011] Optionally, the step of determining the current blockage value of the filter according to the historical cleaning data includes:
[0012] Determining a pool bottom cleaning time, a waterline cleaning time, and a pool wall cleaning time based on the historical cleaning data;
[0013] Calculating a first congestion value based on the pool bottom cleaning time and a first congestion index, calculating a second congestion value based on the waterline cleaning time and a second congestion index, and calculating a third congestion value based on the pool wall cleaning time and a third congestion index; and
[0014] The current congestion value is determined according to the first congestion value, the second congestion value, and the third congestion value.
[0015] Optionally, before the steps of calculating the first congestion value according to the pool bottom cleaning time and the first congestion index, calculating the second congestion value according to the waterline cleaning time and the second congestion index, and calculating the third congestion value according to the pool wall cleaning time and the third congestion index, the method further includes:
[0016] If the pool wall cleaning mode and / or the waterline cleaning mode have been executed before the pool bottom cleaning mode is executed, determining the index increment according to the waterline cleaning time and the pool wall cleaning time; and
[0017] The first congestion index is determined according to a preset index and the index increment.
[0018] Optionally, before the step of determining a target pumping power according to the current congestion value and performing the climbing action and / or the obstacle avoidance action according to the target pumping power, the method further includes:
[0019] When the climbing action execution condition is met, the underwater robot is controlled to execute the climbing action, and / or when an obstacle is detected, the obstacle avoidance action is executed.
[0020] Optionally, the step of determining a target pumping power according to the current congestion value, and performing the climbing action and / or the obstacle avoidance action according to the target pumping power includes:
[0021] Obtaining an initial pumping power corresponding to the climbing action and / or the obstacle avoidance action;
[0022] Determining the target pumping power according to the initial pumping power and the current blockage value; and
[0023] The climbing action and / or the obstacle avoidance action is performed according to the target pumping power.
[0024] Optionally, before the step of determining the current blockage value of the filter according to the historical cleaning data, the method further includes:
[0025] Determining a current cleaning status of the underwater robot;
[0026] Determining a cleaning sequence for the pool bottom, pool wall, and waterline based on the cleaning status and the historical cleaning data; and
[0027] A cleaning mode corresponding to the cleaning sequence is executed according to the cleaning sequence.
[0028] Optionally, the cleaning mode is a waterline cleaning mode, and the step of executing the cleaning mode corresponding to the cleaning sequence according to the cleaning sequence includes:
[0029] When the current position is not in the waterline area, controlling the underwater robot to climb to the waterline area;
[0030] When the current position is the waterline area, closing the left pumping mechanism or the right pumping mechanism of the underwater robot based on a preset cleaning route; and
[0031] When the first cleaning time of executing the waterline cleaning mode is greater than a first preset time and / or the heading angle of the underwater robot changes, the underwater robot is controlled to enter the pool wall cleaning mode.
[0032] Optionally, after the step of controlling the underwater robot to enter the pool wall cleaning mode when the first cleaning time of the waterline cleaning mode is greater than a first preset time and / or the heading angle of the underwater robot changes, the method further includes:
[0033] When the second cleaning time of the pool wall cleaning mode is greater than the second preset time, and / or the number of cleaning failures of the pool wall cleaning is greater than or equal to the preset number, the underwater robot is controlled to enter the pool bottom cleaning mode.
[0034] In addition, to achieve the above-mentioned purpose, the present application further provides an underwater robot, comprising a memory, a processor, and a cleaning program stored in the memory and executable on the processor, wherein the cleaning program, when executed by the processor, implements the following steps:
[0035] Obtaining historical cleaning data of the underwater robot;
[0036] Determining a current clogging value of the filter according to the historical cleaning data; and
[0037] When the underwater robot performs a climbing action and / or an obstacle avoidance action, a target pumping power is determined according to the current blockage value, and the climbing action and / or the obstacle avoidance action is performed according to the target pumping power.
[0038] In addition, to achieve the above-mentioned purpose, the present application further provides a computer-readable storage medium, wherein the computer-readable storage medium stores a cleaning program for an underwater robot. When the cleaning program for the underwater robot is executed by a processor, the following steps are implemented:
[0039] Obtaining historical cleaning data of the underwater robot;
[0040] Determining a current clogging value of the filter according to the historical cleaning data; and
[0041] When the underwater robot performs a climbing action and / or an obstacle avoidance action, a target pumping power is determined according to the current blockage value, and the climbing action and / or the obstacle avoidance action is performed according to the target pumping power. Beneficial effects
[0042] An embodiment of the present application provides a cleaning method for an underwater robot, an underwater robot, and a storage medium. The method first obtains historical cleaning data of the underwater robot, then determines the current blockage value of the filter based on the historical cleaning data, and when the underwater robot performs a climbing action and / or an obstacle avoidance action, determines a target pumping power based on the current blockage value, and performs the climbing action and / or the obstacle avoidance action based on the target pumping power. It can be seen that by obtaining historical cleaning data, the congestion value of the filter in the underwater robot's pumping mechanism is calculated based on the historical cleaning data. When the underwater robot needs to clean the pool wall, that is, when it needs to perform wall climbing and / or obstacle avoidance actions, the pumping power during wall climbing is dynamically adjusted based on the congestion value. This can avoid the situation where the climbing power provided by the fixed pumping power is insufficient or when obstacle avoidance is required, and the pumping power is directly adjusted to the maximum, resulting in power overflow and thus reducing endurance. At the same time, it can also avoid the abnormal situation where it is easy to slide to the bottom of the pool when climbing the wall based on the fixed pumping power when the filter is highly clogged, thereby improving the endurance of the underwater robot during cleaning and the efficiency of full coverage cleaning of the swimming pool. BRIEF DESCRIPTION OF THE DRAWINGS
[0043] The accompanying drawings herein are incorporated into and constitute a part of the specification, illustrate embodiments consistent with the present application, and together with the specification, are used to explain the principles of the present application. In order to more clearly illustrate the technical solutions of the embodiments of the present application, the following is a brief introduction to the drawings required for describing the embodiments. Obviously, for those skilled in the art, other drawings can be obtained based on these drawings without inventive work.
[0044] FIG1 is a schematic flow chart of a first embodiment of a method for cleaning an underwater robot according to the present application;
[0045] FIG2 is a schematic diagram showing the relationship between the clogging value of the filter and the cleaning time when the underwater robot cleans the pool bottom in the cleaning method of the present application;
[0046] FIG3 is a flow chart of a second embodiment of a cleaning method for an underwater robot according to the present application;
[0047] FIG4 is a schematic flow chart of a third embodiment of a cleaning method for an underwater robot according to the present application;
[0048] FIG5 is a schematic diagram of the terminal hardware structure of each embodiment of the underwater robot cleaning method of the present application.
[0049] The realization of the objectives, functional features and advantages of this application will be further explained in conjunction with embodiments and with reference to the accompanying drawings. Modes for Carrying Out the Invention
[0050] It should be understood that the specific embodiments described herein are only used to explain the present application and are not intended to limit the present application.
[0051] To better understand the above technical solutions, exemplary embodiments of the present disclosure will be described in more detail below with reference to the accompanying drawings. Although exemplary embodiments of the present disclosure are shown in the accompanying drawings, it should be understood that the present disclosure can be implemented in various forms and should not be limited by the embodiments described herein. Rather, these embodiments are provided to enable a more thorough understanding of the present disclosure and to fully convey the scope of the present disclosure to those skilled in the art.
[0052] 1 , which is a flow chart of a first embodiment of a method for cleaning an underwater robot according to the present application.
[0053] The solution of this embodiment is applied to an underwater robot, such as a swimming pool cleaning robot. The swimming pool cleaning robot includes at least a cleaning component, a travel motor, a pumping motor with a filter, an inertial sensor such as an accelerometer, a distance sensor such as a laser point cloud radar or an infrared scanning radar, a water entry detection device, and a water exit detection device. The travel motor is used to control the movement of the swimming pool cleaning robot, the pumping motor is used to suck in the cleaned sewage and discharge the filtered sewage, and can also provide power for climbing walls and avoiding obstacles based on the discharged sewage. This power is related to the degree of blockage of the filter. The inertial sensor is used to obtain the underwater robot's pitch angle and acceleration, the distance sensor is used to determine the distance between the pool wall and the swimming pool cleaning robot, the water entry detection device is used to detect whether the underwater robot has entered the water, and the water exit detection device is used to detect whether the underwater robot has left the water surface. The water entry detection device and the water exit detection device can be different names for the same device.
[0054] In this embodiment, the underwater robot cleaning method includes the following steps:
[0055] Step S10, obtaining historical cleaning data of the underwater robot;
[0056] In this embodiment, the underwater robot's cleaning scenario can be a swimming pool. Historical cleaning data refers to the underwater robot's cleaning data from the time the robot began its cleaning task to the current moment. This data includes the pool bottom cleaning time, waterline cleaning time, and pool wall cleaning time. The waterline refers to the pool's water level, and the pool wall refers to the wall area between the water level and the pool bottom to be cleaned.
[0057] For example, the underwater robot's historical cleaning data includes: pool wall cleaning time: 0 minutes, waterline cleaning time: 5 minutes, and pool bottom cleaning time: 0 minutes. Based on this, it can be determined that after entering the water to perform cleaning tasks, the underwater robot only performs cleaning tasks at the water level. It should be noted that the above data is for illustrative purposes only and does not limit this application.
[0058] When the underwater robot performs a cleaning task, the pumping mechanism is in operation. Historical cleaning data can be acquired in real time, and the filter blockage value in the pumping mechanism can be calculated based on this data. This allows the underwater robot to dynamically adjust the operating power of the pumping mechanism when performing climbing and / or obstacle avoidance maneuvers, avoiding power overflow caused by simply adjusting the pumping power to maximum. This improves the underwater robot's endurance when cleaning larger pool walls. It should be noted that the underwater robot performing a climbing maneuver refers to the underwater robot climbing from the pool bottom to the pool wall. It is understood that the pumping mechanism simultaneously drains water filtered by the filter. The drainage rate is related to the pumping power and the filter blockage value. The greater the pumping power, the more water is drained, and the greater the reverse force provided by the pumping mechanism to the underwater robot. Therefore, the underwater robot requires power from the pumping mechanism when performing climbing maneuvers or more urgent obstacle avoidance maneuvers. If the filter blockage value is high, the power provided by the drainage is less, which can cause the underwater robot to slide to the pool bottom when climbing the wall, or the current power cannot support the underwater robot to climb to the pool wall.
[0059] Step S20, determining a current clogging value of the filter according to the historical cleaning data;
[0060] In this embodiment, the blockage value represents the degree of blockage of the filter within the underwater robot's pumping mechanism. In this scenario, the degree of filter blockage can affect the drainage rate, making it impossible for the underwater robot to climb the pool wall due to the power generated during drainage, or causing the underwater robot to slip on the pool wall, affecting the pool wall cleaning efficiency. At the same time, the power generated by the underwater robot during drainage can also provide corresponding auxiliary propulsion force for the underwater robot to perform emergency obstacle avoidance.
[0061] In this embodiment, the current filter blockage value can be obtained by adding the pool bottom blockage value, the pool wall blockage value, and the waterline blockage value, and the pool bottom blockage value, the pool wall blockage value, and the waterline blockage value can be determined by the corresponding cleaning time and the corresponding blockage value of each area. That is, step S20 specifically includes:
[0062] Step S21, determining the pool bottom cleaning time, waterline cleaning time, and pool wall cleaning time based on the historical cleaning data;
[0063] Step S22, calculating a first congestion value according to the pool bottom cleaning time and the first congestion index, calculating a second congestion value according to the waterline cleaning time and the second congestion index, and calculating a third congestion value according to the pool wall cleaning time and the third congestion index;
[0064] In this embodiment, the first congestion value is the pool bottom congestion value, and the first congestion index is the pool bottom congestion index; the second congestion value is the waterline congestion value, and the second congestion index is the waterline congestion index; the third congestion value is the pool wall congestion value, and the third congestion index is the pool wall congestion index, wherein the congestion index refers to the change index of the congestion value when cleaning the area.
[0065] Specifically, the bottom congestion value can be calculated by multiplying the pool bottom congestion index by the pool bottom cleaning time, the wall congestion value can be calculated by multiplying the pool wall congestion index by the pool wall cleaning time, and the waterline congestion index by the waterline cleaning time. The congestion index can be determined by an image collector based on collected image data. For example, before cleaning, a picture of the pool can be input into an image analysis model, which then calculates the congestion index for the pool bottom, waterline, and pool wall based on the pool image.
[0066] Optionally, the pool bottom congestion index is also related to the order in which the underwater robot cleans the pool bottom. For example, if the underwater robot cleans the waterline and pool walls first and then the pool bottom, objects on the waterline and pool walls (such as moss and dust that could cause congestion) may be sucked into the underwater robot, and some of the objects may fall directly to the pool bottom. Therefore, if the pool bottom is cleaned later than other areas, the pool bottom congestion index will increase.
[0067] Specifically, before step S22, the method further includes: if the pool wall cleaning mode and / or the waterline cleaning mode have been executed before the pool bottom cleaning mode is executed, determining an index increment based on the waterline cleaning time and the pool wall cleaning time; and determining the first congestion index based on a preset index and the index increment. The preset index is a preset congestion index of the pool bottom obtained based on a photograph of the swimming pool.
[0068] For example, if before the pool bottom cleaning mode is executed, the historical cleaning data includes a waterline cleaning time of 5 minutes, a pool wall cleaning time of 0 minutes, and a pool bottom cleaning time of 0 minutes, and the waterline cleaning index is 3, the pool wall cleaning index is 2, and the pool bottom cleaning index is 10, then the calculation method of the index increment includes: 3×5×N, where N is the incremental coefficient. When the underwater robot cleans the waterline or pool wall, its cleaning efficiency is usually above 90%. Based on this, the incremental coefficient is 0.1, so the calculated index increment is 1.5. At this time, the congestion index of the pool bottom changes from 10 to 11.5. It should be noted that the above parameters are for explanation only and are not a limitation of this solution.
[0069] Alternatively, please refer to Figure 2, which shows the relationship between the filter's blockage value and cleaning time when the underwater robot first cleans the pool bottom. The 0-t1 time period shows the change in blockage value as the underwater robot cleans at a constant speed along a preset route. t1 indicates when the underwater robot has completed cleaning the pool bottom. That is, when the underwater robot completes cleaning the pool bottom, the blockage value is y1. The t1-t2 time period represents the time it takes the underwater robot to travel from the bottom cleaning position to the preset wall climbing position after completing the bottom cleaning. This time period is recorded as the pool bottom cleaning time, meaning that time t2 represents the bottom cleaning time. Therefore, when calculating the blockage value, directly based on the t2 given in the historical cleaning time, the resulting blockage value is y2, shown in Figure 2, which is completely different from the actual blockage value y1. Therefore, in order to avoid the underwater robot's misjudgment of the blockage value, which may lead to overflow of pumping power when performing subsequent wall climbing or obstacle avoidance actions, the underwater robot further divides the cleaning time in the historical cleaning data. For example, after the underwater robot completes the pool bottom cleaning, the current time is recorded through preset instructions, so that after obtaining the historical cleaning data, the underwater robot can determine the actual time taken to complete the pool bottom cleaning based on the preset instructions.
[0070] Step S23: determining the current congestion value according to the first congestion value, the second congestion value, and the third congestion value.
[0071] Specifically, the sum of the pool bottom congestion value, the waterline congestion value, and the pool wall congestion value may be used as the current congestion value.
[0072] Optionally, the current blockage value can also be calculated by the current pumping rate and drainage rate of the underwater robot. That is, when cleaning the pool bottom, the underwater robot can obtain the current pumping rate and drainage rate, calculate the difference or quotient between the pumping rate and the drainage rate, and then obtain the mapping relationship between the blockage value stored in the database and the difference or the quotient, and obtain the blockage value of the filter net of the pumping mechanism based on the mapping relationship.
[0073] Step S30, when the underwater robot performs a climbing action and / or an obstacle avoidance action, a target pumping power is determined according to the current blockage value, and the climbing action and / or the obstacle avoidance action is performed according to the target pumping power.
[0074] In this embodiment, the climbing action refers to the underwater robot preparing to climb to the pool wall. The obstacle avoidance action refers to the underwater robot detecting obstacles that need to be avoided, such as handrails, floor drains, etc., when performing the cleaning task.
[0075] For example, after calculating the blockage value, if the underwater robot needs to perform a climbing action to reach a wall, it can determine a target pumping power based on the target blockage value and execute the climbing action according to the target pumping power. If, after a period of time after climbing to the pool wall, the underwater robot detects a handrail in front of it, it will need to adjust the pumping power again to avoid the obstacle. It should be noted that the blockage value of the underwater robot's filter only affects the climbing power required for cleaning the pool wall, i.e., climbing the wall, and the additional power required for obstacle avoidance. When cleaning the pool bottom, the underwater robot's walking power mainly comes from the walking motor and has little to do with the degree of filter blockage.
[0076] In the technical solution disclosed in this embodiment, when the underwater robot performs an underwater cleaning task, it determines the cleaning time for each pool area based on historical cleaning data, selects the congestion index for each cleaning area based on the cleaning sequence, and calculates the blockage value of the pumping mechanism filter based on the congestion index and cleaning time of each area. This allows the underwater robot to perform climbing and / or obstacle avoidance actions based on the target pumping power corresponding to the current congestion value, thereby avoiding the situation where the pumping power is directly adjusted to the maximum value during climbing and / or obstacle avoidance, resulting in insufficient battery life. Therefore, dynamically adjusting the underwater robot's pumping power based on the filter congestion value can improve the battery life of the pool cleaning process and ensure full coverage of all pool areas.
[0077] 3 , in the second embodiment, based on the first embodiment, step S30 includes:
[0078] Step S31, obtaining the initial pumping power corresponding to the climbing action and / or the obstacle avoidance action;
[0079] Step S32, determining the target pumping power according to the initial pumping power and the current blockage value;
[0080] Step S33: executing the climbing action and / or the obstacle avoiding action according to the target pumping power.
[0081] In this embodiment, when the underwater robot performs climbing and / or obstacle avoidance maneuvers, an initial pumping power is preset. When the blockage value is 0, the underwater robot can complete the climbing and obstacle avoidance maneuvers based on the initial pumping power. To prevent the filter blockage value from affecting the climbing power, the target pumping power is determined based on the initial pumping power and the current blockage value.
[0082] For example, the underwater robot sets an initial pumping power of 60%. At this time, the detected congestion value is 15. According to the underwater robot's locally stored data table, when the congestion value is 15, the corresponding pumping power increment is 25%, which means the target pumping power is 85%. Alternatively, when the congestion value is 15, the corresponding pumping power increment is 40%. Based on this, the target pumping power is also approximately 85%. Therefore, when the underwater robot performs climbing or obstacle avoidance maneuvers, it needs to use 85% pumping power to perform climbing or obstacle avoidance maneuvers.
[0083] It should be noted that the above data are for illustration only and are not intended to limit the present application.
[0084] In the technical solution disclosed in this embodiment, the target pumping power is determined by obtaining the initial pumping power when performing climbing and / or obstacle avoidance actions and the calculated current blockage value, thereby ensuring the accuracy of the target pumping power, and making the target pumping power more in line with the power required by the underwater robot when currently climbing and / or avoiding obstacles, thereby improving the endurance of the underwater robot.
[0085] 4 , in a third embodiment, based on the first embodiment, before step S20, the following steps are further included:
[0086] Step S40, determining the current cleaning state of the underwater robot;
[0087] In this embodiment, the cleaning state refers to the underwater robot's current state information, including current acceleration, pitch angle, and water exit status. The underwater robot can obtain these parameters through multiple sensors and determine the cleaning sequence to be executed when cleaning the pool based on the current state parameters. For example, if the inertial sensor detects that the underwater robot's current pitch angle is 90°, the acceleration sensor detects that the acceleration is 0, and the water exit detection device detects that the current position is on the water surface, it can be determined that the underwater robot is currently in the wall climbing state, and the corresponding area for wall climbing is the waterline area.
[0088] Step S50, determining the cleaning order of the pool bottom, pool wall and waterline based on the cleaning status and the historical cleaning data;
[0089] In this embodiment, after determining the cleaning state of the underwater robot, the current cleaning sequence can be determined based on the historical cleaning data. For example, if the underwater robot is currently at the waterline position, and the historical cleaning data shows that the pool bottom cleaning time is 45 minutes, the pool wall cleaning time is 0 minutes, and the waterline cleaning time is 0 minutes, it can be determined that the underwater robot has completed cleaning the pool bottom. Since it is currently in the water level area, it can be determined that the underwater robot's current cleaning sequence is waterline-pool wall. It is understandable that if the cleaning time corresponding to each area in the historical cleaning data is 0 minutes, and the current position is the waterline, the current cleaning sequence can be waterline-pool wall-pool bottom, or waterline-pool bottom-pool wall. Alternatively, if the current position is the pool wall, the cleaning sequence can be pool wall-waterline-pool bottom or pool wall-pool bottom-waterline. It should be noted that the above data is for illustrative purposes only and does not limit this application.
[0090] Step S60 , executing a cleaning mode corresponding to the cleaning sequence according to the cleaning sequence.
[0091] In this embodiment, the cleaning area of the pool bottom is typically larger than the cleaning area of the pool walls and waterline, and the pool bottom typically contains more objects to be cleaned than the pool walls and waterline. Therefore, if the underwater robot cleans the pool bottom first and then the pool walls and waterline, the current blockage value of the underwater robot's filter will be high after the bottom cleaning is completed. This will cause the underwater robot to use a target pumping power of 100% based on the target blockage value when climbing or avoiding obstacles. This can cause the underwater robot to slip while cleaning the pool walls or waterline, or even if the current blockage value is high, it may be unable to climb to the pool wall even at 100% pumping power, resulting in an inability to complete the full coverage cleaning of the pool. Therefore, to ensure full coverage of the pool, the underwater robot can be set to clean the pool in a sequence of waterline-wall-bottom. In this cleaning sequence, the filter blockage value is calculated starting from 0, which can greatly reduce the possibility of overflow or insufficient pumping power.
[0092] Therefore, based on the cleaning sequence of waterline-pool wall-pool bottom, the current cleaning mode is the waterline cleaning mode, and step S60 specifically includes:
[0093] Step S61: When the current position is not the waterline area, control the underwater robot to climb to the waterline area;
[0094] Since the current cleaning mode is the waterline cleaning mode, if the current position is not the waterline area, you need to climb to the waterline area.
[0095] For example, when the underwater robot is at the bottom of the pool, its laser sensor continuously detects the position ahead. When the distance to the pool wall is less than 30 cm, it approaches the wall and performs a wall-climbing action based on a preset pumping power. The inertial sensor then detects the pitch angle of the underwater robot during wall-climbing. If the pitch angle is greater than 60°, the robot's wall-climbing is unaffected. The robot continues climbing until it detects a water-out signal from the water-out detection device, at which point it stops, indicating that it has reached the waterline. If the robot is already at the waterline, step S62 can be executed.
[0096] Step S62, when the current position is the waterline area, closing the left pumping mechanism or the right pumping mechanism of the underwater robot based on a preset cleaning route;
[0097] In an alternative embodiment of this embodiment, the underwater robot completes waterline cleaning by moving left and right. Specifically, when the underwater robot is at the waterline, the direction corresponding to its head is perpendicular to the waterline cleaning direction. The left or right pumping mechanism is activated, and the robot moves left and right based on the power provided by the left or right pumping mechanism to complete the cleaning. Specifically, while cleaning the waterline, the underwater robot also reads status information from the inertial sensor in real time and determines the underwater robot's pitch angle during waterline cleaning based on this status information. It is understood that when the underwater robot is cleaning the waterline, its pitch angle is 90°. If the current pitch angle is detected to be less than a first preset pitch angle, such as 45°, the underwater robot is preliminarily determined to be trapped or in a sensor abnormality at its current position. The underwater robot then performs a backward movement, which includes gradually retreating from its current position to the pool bottom. During the backward movement, if the pitch angle is detected to be less than a second preset pitch angle, such as 20°, it indicates that the current backward direction is correct. At this time, the backward heading is locked and the user retreats to the bottom of the pool based on the backward heading. It should be noted that the above data is for illustrative purposes only and is not intended to limit the present application.
[0098] Alternatively, when cleaning the waterline of a rectangular swimming pool, if the accelerometer detects significant acceleration within a preset time while the underwater robot is moving left or right, the robot can be considered to have finished cleaning the waterline of the current wall. At this point, the underwater robot can rotate 90°, climb from that wall to the next, then rotate -90° again, and continue cleaning the waterline of the current wall by moving left and right. When the underwater robot plans the cleaning route for each area, it determines the number of times it switches to clean the next wall based on the shape of the pool being cleaned.
[0099] For example, when an underwater robot executes waterline cleaning mode, the process is as follows: When the underwater robot reaches the waterline, it maintains its current position. Based on the current state analysis, the underwater robot determines that it needs to clean the current wall waterline for 25 seconds to the left and 40 seconds to the right. Therefore, the underwater robot shuts off the left pumping mechanism and begins moving to the left. After 25 seconds, the left pumping mechanism is reopened, the right pumping mechanism is shut off, and movement stops after 65 seconds. Since handrails are typically provided at the edge of the pool, the underwater robot may be above the handrail after 65 seconds of rightward movement. Therefore, the underwater robot executes a 4-second leftward movement to prevent the handrail from interfering with the robot's backward movement. During the cleaning process, the underwater robot obtains the filter blockage value and the current pitch angle change in real time based on the current cleaning time. During the cleaning process, if the pitch angle is less than 45°, it is considered a waterline anomaly and the robot performs a corresponding backward movement. The number of anomalies is recorded. If the number of anomalies exceeds four, the underwater robot exits waterline cleaning mode and enters pool wall cleaning mode. When the underwater robot reaches the end of the current pool wall, it switches to the other wall and re-executes the waterline cleaning steps.
[0100] It should be noted that the above data are only used for explanation and are not intended to limit the present application.
[0101] In step S63 , when the first cleaning time of the waterline cleaning mode is greater than a first preset time and / or the heading angle of the underwater robot changes, the underwater robot is controlled to enter the pool wall cleaning mode.
[0102] In this embodiment, after the AUV completes a preset cleaning time, or when its heading angle changes from 90° to at least 45°, it switches to a cleaning mode, i.e., entering the pool wall cleaning mode based on the waterline-pool wall-pool bottom cleaning sequence. For example, after a 30-minute waterline cleaning mode, the AUV automatically switches to the pool wall cleaning mode and adjusts the pumping power based on the current blockage value.
[0103] When executing the pool wall cleaning mode, the area closest to the pool bottom is more difficult to clean (for example, the area cleaned when the underwater robot's pitch angle is from 0° to 70°, hereinafter referred to as area A). When cleaning the pool wall, the underwater robot can be controlled to first perform a preliminary cleaning of the area with a pitch angle of less than 70°, and then clean all areas of the pool wall. That is, when the underwater robot climbs from the bottom of the pool to the pool wall, the pitch angle starts to increase from 0, and when the pitch angle becomes 70°, it performs a backward action, and after retreating to the bottom of the pool. After the initial cleaning of area A, the underwater robot cleans the submerged area according to the preset cleaning route. It should be noted that the above data is only for explanation and is not a limitation of this application.
[0104] Similarly, when cleaning the pool wall, the underwater robot determines the pitch angle of the underwater robot when climbing the pool wall based on the test parameters of the inertial sensor. If the change in the pitch angle is greater than a preset pitch angle, such as 80°, within a preset time window, the underwater robot can be considered to have failed to climb. For example, when there are many steps in the swimming pool, when the underwater robot climbs from the immersion area to the steps, the pitch angle usually changes from 90° to 0°. Or when the battery is low, the underwater robot slides from the pool wall to the bottom of the pool, and the pitch angle also changes from 90° to 0°. In both cases, it can be considered that the current climb has failed. Therefore, the number of climbing failures can be recorded. When the number of climbing failures exceeds the preset number of failures, such as 2, the current state is changed to insufficient power connection state or trapped state, and an alarm prompt is output.
[0105] For example, when the underwater robot performs pool wall cleaning mode, the process is as follows: After switching to pool wall cleaning mode, the underwater robot remains stationary for three seconds and determines its current position. If it is currently at the pool wall, it returns to the pool bottom and finds a corresponding climbing position based on a preset cleaning route to climb to the pool wall. If it is currently at the pool bottom, after determining the climbing position, it performs a wall climbing action based on the current congestion value. During wall climbing cleaning, when the underwater robot's pitch angle changes from 0° to 70°, it performs a backward movement to return to the pool bottom, then moves left or right and re-cleans the area of the pool wall with a pitch angle below 70°. After cleaning this area, the underwater robot directly climbs to the pool wall, bringing the pitch angle to 90°, and continues cleaning while moving. If the underwater robot encounters a secondary platform and fails to climb and returns to the pool bottom, the number of failures is recorded. If the number of failures exceeds four, it exits the submerged pool wall cleaning mode and enters the pool bottom cleaning mode to continue cleaning. During this process, the underwater robot obtains the congestion value in real time and adjusts the pumping power accordingly.
[0106] It should be noted that the above data are only used for explanation and are not intended to limit the present application.
[0107] Optionally, after step S63, step S64 is also included, which controls the underwater robot to enter the pool bottom cleaning mode when the second cleaning time of the pool wall cleaning mode is greater than the second preset time, and / or the number of cleaning failures of the pool wall cleaning is greater than or equal to the preset number.
[0108] In this embodiment, after the underwater robot executes the preset cleaning time based on the pool wall cleaning mode or when the number of cleaning failures is greater than 4 times, it can switch the cleaning mode, that is, enter the pool bottom cleaning mode based on the cleaning order of waterline-pool wall-pool bottom.
[0109] For example, when the underwater robot is performing pool bottom cleaning mode, the process is as follows: After the pool wall is cleaned, it enters pool bottom cleaning mode. During the cleaning process, the underwater robot continuously obtains signals from multiple sensors such as laser sensors and accelerometers and performs abnormality detection. If the heading deviates, it will perform course correction. When it reaches the pool camera or detects a non-planar surface, it will perform a full-power reverse action. If the distance to the pool wall or other obstacle is less than 40cm, or if no distance change is detected within 150 seconds, or if the distance change exceeds 50cm within 10 seconds, the underwater robot is considered to be in an abnormal situation. At this time, it can perform a rescue action such as moving left and right or performing a full-power reverse action to ensure that the underwater robot can complete the pool bottom cleaning.
[0110] It should be noted that the above data are only used for explanation and are not intended to limit the present application.
[0111] In the technical solution disclosed in this embodiment, in order to ensure that the underwater robot can successfully complete the full coverage cleaning of the swimming pool, the waterline cleaning mode, pool wall cleaning mode and pool bottom cleaning mode are executed in sequence based on the cleaning order of waterline-pool wall-pool bottom, and corresponding response plans are provided when encountering various abnormal situations during the execution of each mode, thereby improving the full coverage cleaning effect of the swimming pool.
[0112] Refer to Figure 5, which is a schematic diagram of the terminal structure of the hardware operating environment involved in the embodiment of the present application.
[0113] As shown in Figure 5, the terminal may include: a processor 1001, such as a CPU, a network interface 1004, a user interface 1003, a memory 1005, and a communication bus 1002. Among them, the communication bus 1002 is used to realize the connection and communication between these components. The user interface 1003 may include a display screen (Display), an input unit such as a keyboard (Keyboard), and the user interface 1003 may optionally include a standard wired interface and a wireless interface. The network interface 1004 may optionally include a standard wired interface and a wireless interface (such as a WI-FI interface). The memory 1005 may be a high-speed RAM memory or a stable memory (non-volatile memory), such as a disk memory. The memory 1005 may optionally be a storage device independent of the aforementioned processor 1001.
[0114] Those skilled in the art will understand that the terminal structure shown in FIG5 does not constitute a limitation on the terminal, and may include more or fewer components than shown in the figure, or combine certain components, or arrange the components differently.
[0115] As shown in FIG5 , the memory 1005 as a computer storage medium may include an operating system, a user interface module, a network communication module, and a cleaning program.
[0116] In the terminal shown in FIG5 , the network interface 1004 is mainly used to connect to the backend server and perform data communication with the backend server; the processor 1001 can call the cleaning program stored in the memory 1005 and perform the following operations:
[0117] Obtaining historical cleaning data of the underwater robot;
[0118] Determining a current clogging value of the filter according to the historical cleaning data; and
[0119] When the underwater robot performs a climbing action and / or an obstacle avoidance action, a target pumping power is determined according to the current blockage value, and the climbing action and / or the obstacle avoidance action is performed according to the target pumping power.
[0120] Furthermore, the processor 1001 may call a cleaning program stored in the memory 1005 and perform the following operations:
[0121] Determining a pool bottom cleaning time, a waterline cleaning time, and a pool wall cleaning time based on the historical cleaning data;
[0122] Calculating a first congestion value based on the pool bottom cleaning time and a first congestion index, calculating a second congestion value based on the waterline cleaning time and a second congestion index, and calculating a third congestion value based on the pool wall cleaning time and a third congestion index; and
[0123] The current congestion value is determined according to the first congestion value, the second congestion value, and the third congestion value.
[0124] Furthermore, the processor 1001 may call a cleaning program stored in the memory 1005 and perform the following operations:
[0125] If the pool wall cleaning mode and / or the waterline cleaning mode have been executed before the pool bottom cleaning mode is executed, determining the index increment according to the waterline cleaning time and the pool wall cleaning time; and
[0126] The first congestion index is determined according to a preset index and the index increment.
[0127] Furthermore, the processor 1001 may call a cleaning program stored in the memory 1005 and perform the following operations:
[0128] When the climbing action execution condition is met, the underwater robot is controlled to execute the climbing action, and / or when an obstacle is detected, the obstacle avoidance action is executed.
[0129] Furthermore, the processor 1001 may call a cleaning program stored in the memory 1005 and perform the following operations:
[0130] Obtaining an initial pumping power corresponding to the climbing action and / or the obstacle avoidance action;
[0131] Determining the target pumping power according to the initial pumping power and the current blockage value; and
[0132] The climbing action and / or the obstacle avoidance action is performed according to the target pumping power.
[0133] Furthermore, the processor 1001 may call a cleaning program stored in the memory 1005 and perform the following operations:
[0134] Determining a current cleaning status of the underwater robot;
[0135] Determining a cleaning sequence for the pool bottom, pool wall, and waterline based on the cleaning status and the historical cleaning data; and
[0136] A cleaning mode corresponding to the cleaning sequence is executed according to the cleaning sequence.
[0137] Furthermore, the processor 1001 may call a cleaning program stored in the memory 1005 and perform the following operations:
[0138] When the current position is not in the waterline area, controlling the underwater robot to climb to the waterline area;
[0139] When the current position is the waterline area, closing the left pumping mechanism or the right pumping mechanism of the underwater robot based on a preset cleaning route; and
[0140] When the first cleaning time of executing the waterline cleaning mode is greater than a first preset time and / or the heading angle of the underwater robot changes, the underwater robot is controlled to enter the pool wall cleaning mode.
[0141] Furthermore, the processor 1001 may call a cleaning program stored in the memory 1005 and perform the following operations:
[0142] When the second cleaning time of the pool wall cleaning mode is greater than the second preset time, and / or the number of cleaning failures of the pool wall cleaning is greater than or equal to the preset number, the underwater robot is controlled to enter the pool bottom cleaning mode.
[0143] Furthermore, those skilled in the art will appreciate that all or part of the steps in the method of the above-described embodiment can be implemented by instructing the relevant hardware through a computer program. The computer program includes program instructions, which can be stored in a storage medium that is computer-readable. The program instructions are executed by at least one processor in the control terminal to implement the steps of the above-described method embodiment.
[0144] Therefore, the present application also provides a computer-readable storage medium, which stores a cleaning program. When the cleaning program is executed by a processor, the cleaning program implements the various steps of the underwater robot cleaning method described in the above embodiment.
[0145] It should be noted that since the storage medium provided in the embodiments of this application is the storage medium used to implement the method of the embodiments of this application, based on the method described in the embodiments of this application, those skilled in the art will be able to understand the specific structure and deformation of the storage medium, and therefore will not be described in detail here. All storage media used in the method of the embodiments of this application fall within the scope of protection to be provided by this application.
[0146] Those skilled in the art will appreciate that the embodiments of the present application may be provided as methods, systems, or computer program products. Therefore, the present application may take the form of an entirely hardware embodiment, an entirely software embodiment, or an embodiment combining software and hardware. Furthermore, the present application may take the form of a computer program product implemented on one or more computer-usable storage media (including but not limited to magnetic disk storage, CD-ROM, optical storage, etc.) containing computer-usable program code.
[0147] This application is described with reference to flowcharts and / or block diagrams of methods, devices (systems), and computer program products according to embodiments of the application. It should be understood that each process and / or block in the flowcharts and / or block diagrams, as well as combinations of processes and / or blocks in the flowcharts and / or block diagrams, can be implemented by computer program instructions. These computer program instructions can be provided to a processor of a general-purpose computer, a special-purpose computer, an embedded processor, or other programmable data processing device to produce a machine, so that the instructions executed by the processor of the computer or other programmable data processing device produce a device for implementing the functions specified in one or more processes in the flowchart and / or one or more blocks in the block diagram.
[0148] These computer program instructions may also be stored in a computer-readable memory that can direct a computer or other programmable data processing device to operate in a specific manner, so that the instructions stored in the computer-readable memory produce a product including an instruction device that implements the functions specified in one or more processes in the flowchart and / or one or more boxes in the block diagram.
[0149] These computer program instructions can also be loaded onto a computer or other programmable data processing device so that a series of operating steps are executed on the computer or other programmable device to produce a computer-implemented process, so that the instructions executed on the computer or other programmable device provide steps for implementing the functions specified in one or more processes in the flowchart and / or one or more boxes in the block diagram.
[0150] It should be noted that in the claims, any reference signs placed between parentheses shall not be construed as limiting the claims. The word "comprising" does not exclude the presence of components or steps not listed in the claim. The word "a" or "an" preceding a component does not exclude the presence of a plurality of such components. The present application may be implemented by means of hardware comprising several different components and by means of a suitably programmed computer. In a unit claim enumerating several means, several of these means may be embodied by one and the same item of hardware. The use of the words first, second and third etc. does not indicate any order. These words may be interpreted as names.
[0151] Although the preferred embodiments of the present application have been described, those skilled in the art may make additional changes and modifications to these embodiments once they have learned the basic creative concept. Therefore, the appended claims are intended to be interpreted as including the preferred embodiments and all changes and modifications that fall within the scope of the present application.
[0152] Obviously, those skilled in the art may make various changes and modifications to this application without departing from the spirit and scope of this application. Thus, if these modifications and variations of this application fall within the scope of the claims of this application and their equivalents, this application is intended to include these modifications and variations.
[0153] The above are only preferred embodiments of the present application and do not limit the patent scope of the present application. Any equivalent structure or equivalent process transformation made using the contents of the present application specification and drawings, or directly or indirectly applied in other related technical fields, are also included in the patent protection scope of the present application.
Claims
1. A method for cleaning an underwater robot, wherein: Applied to an underwater robot, the water pumping mechanism of the underwater robot includes a filter screen, and the cleaning method of the underwater robot includes: Acquiring historical cleaning data of the underwater robot; Determining a current clogging value of the filter screen according to the historical cleaning data; and When the underwater robot performs a climbing action and / or an obstacle avoidance action, a target pumping power is determined according to the current blockage value, and the climbing action and / or the obstacle avoidance action is performed according to the target pumping power.
2. The method for cleaning an underwater robot according to claim 1, wherein: The step of determining the current blockage value of the filter screen according to the historical cleaning data comprises: Determining the pool bottom cleaning time, the waterline cleaning time, and the pool wall cleaning time based on the historical cleaning data; Calculating a first congestion value according to the pool bottom cleaning time and the first congestion index, calculating a second congestion value according to the waterline cleaning time and the second congestion index, and calculating a third congestion value according to the pool wall cleaning time and the third congestion index; and The current congestion value is determined according to the first congestion value, the second congestion value and the third congestion value.
3. The method for cleaning an underwater robot according to claim 2, wherein: Before the steps of calculating the first congestion value according to the pool bottom cleaning time and the first congestion index, calculating the second congestion value according to the waterline cleaning time and the second congestion index, and calculating the third congestion value according to the pool wall cleaning time and the third congestion index, the method further includes: If the pool wall cleaning mode and / or the water line cleaning mode have been executed before the pool bottom cleaning mode is executed, determining the index increment according to the water line cleaning time and the pool wall cleaning time; and The first congestion index is determined according to a preset index and the index increment.
4. The method for cleaning an underwater robot according to claim 1, wherein: Before the step of determining the target pumping power according to the current congestion value and performing the climbing action and / or the obstacle avoidance action according to the target pumping power, the step further includes: When the climbing action execution condition is met, the underwater robot is controlled to execute the climbing action, and / or when an obstacle is detected, the obstacle avoidance action is executed.
5. The method for cleaning an underwater robot according to claim 1, wherein: The step of determining the target pumping power according to the current congestion value, and performing the climbing action and / or the obstacle avoidance action according to the target pumping power includes: Obtaining an initial pumping power corresponding to the climbing action and / or the obstacle avoiding action; Determining the target pumping power according to the initial pumping power and the current blockage value; and The climbing action and / or the obstacle avoiding action is performed according to the target pumping power.
6. The method for cleaning an underwater robot according to claim 1, wherein: Before the step of determining the current blockage value of the filter screen according to the historical cleaning data, the method further includes: Determining a current cleaning state of the underwater robot; Determining a cleaning sequence for the pool bottom, pool wall, and waterline based on the cleaning status and the historical cleaning data; and A cleaning mode corresponding to the cleaning sequence is executed according to the cleaning sequence.
7. The method for cleaning an underwater robot according to claim 6, wherein: The cleaning mode is a waterline cleaning mode, and the step of executing the cleaning mode corresponding to the cleaning sequence according to the cleaning sequence includes: When the current position is not a waterline area, controlling the underwater robot to climb to the waterline area; When the current position is the waterline area, closing the left pumping mechanism or the right pumping mechanism of the underwater robot based on a preset cleaning route; and When the first cleaning time of executing the waterline cleaning mode is greater than the first preset time and / or the heading angle of the underwater robot changes, the underwater robot is controlled to enter the pool wall cleaning mode.
8. The method for cleaning an underwater robot according to claim 7, wherein: After the step of controlling the underwater robot to enter the pool wall cleaning mode when the first cleaning time of executing the waterline cleaning mode is greater than the first preset time and / or when the heading angle of the underwater robot changes, the method further includes: When the second cleaning time of the pool wall cleaning mode is greater than the second preset time, and / or the number of cleaning failures of the pool wall cleaning is greater than or equal to a preset number, the underwater robot is controlled to enter the pool bottom cleaning mode.
9. An underwater robot, wherein: The underwater robot comprises: a memory, a processor, and a cleaning program of the underwater robot stored in the memory and executable on the processor. When the cleaning program of the underwater robot is executed by the processor, the following steps are implemented: Acquiring historical cleaning data of the underwater robot; Determining a current clogging value of the filter screen according to the historical cleaning data; and When the underwater robot performs a climbing action and / or an obstacle avoidance action, a target pumping power is determined according to the current blockage value, and the climbing action and / or the obstacle avoidance action is performed according to the target pumping power.
10. A computer-readable storage medium, wherein: The computer-readable storage medium stores a cleaning program of the underwater robot. When the cleaning program of the underwater robot is executed by the processor, the following steps are implemented: Acquiring historical cleaning data of the underwater robot; Determining a current clogging value of the filter screen according to the historical cleaning data; and When the underwater robot performs a climbing action and / or an obstacle avoidance action, a target pumping power is determined according to the current blockage value, and the climbing action and / or the obstacle avoidance action is performed according to the target pumping power.
Citation Information
Patent Citations
Cleaning robot control method and device, cleaning robot and storage medium
CN113907646A
Pool wall obstacle avoidance moving method and device of swimming pool cleaning robot and electronic equipment
CN115185282A
Control method and device of cleaning robot and controller
CN115716271A
Water surface line swimming pool robot cleaning method and system and readable storage medium
CN116006001A
Swimming pool cleaning method and device, electronic equipment and storage medium
CN116048059A
