Cleaning robot control method, cleaning robot and computer readable storage medium

By setting sensors of different heights on the cleaning robot, the actual distance between the computer robot and the obstacle is solved, and the problem of inaccurate distance measurement in the existing technology is achieved, and accurate obstacle avoidance and edge cleaning of irregular obstacles is achieved. Avoid collisions and damage.

CN119073834APending Publication Date: 2024-12-06WOCAO TECH (SHENZHEN) CO LTD
View PDF 0 Cites 3 Cited by

Patent Information

Application Number
CN202411231698.8
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-09-03
Publication Date
2024-12-06

AI Technical Summary

Technical Problem

Existing cleaning robots have inaccurate distance measurements when encountering irregular obstacles, which may lead to collisions and damage.

Method used

Using two sensors of different heights (first sensor and second sensor), by obtaining the distance data between the two and the obstacle, the actual distance between the edge of the cleaning robot and the obstacle is calculated and based on this distance. Clean the edges or avoid obstacles.

Benefits of technology

Improve the accuracy of distance measurement for irregular obstacles, avoid collision between cleaning robots and obstacles, and protect equipment and the environment.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119073834A_ABST
    Figure CN119073834A_ABST
Patent Text Reader

Abstract

The invention discloses a cleaning robot control method, a cleaning robot and a storage medium, and relates to the technical field of intelligent household appliances. The method comprises the steps that at the same moment, first environment data are acquired through a first sensor, and second environment data are acquired through a second sensor; acquiring a first distance between the first sensor and an obstacle according to the first environment data, and acquiring a second distance between the second sensor and the obstacle according to the second environment data; determining the actual distance between the body edge of the cleaning robot and the obstacle according to the first distance and the second distance; and edge cleaning is carried out according to the actual distance, or obstacle avoidance is carried out according to the actual distance. Thus, the actual distance between the edge of the cleaning robot body and the obstacle is measured through the sensors arranged at different heights, the distance of the cleaning robot for cleaning the edge of the obstacle is adjusted according to the actual distance, and therefore the situation that the cleaning robot collides with the obstacle when cleaning the edge of the irregular obstacle is avoided.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the technical field of smart home appliances, and in particular to a cleaning robot control method, a cleaning robot and a computer-readable storage medium. Background Art

[0002] When cleaning a room, a cleaning robot usually measures the distance to obstacles (walls, tables, chairs, coffee tables, etc.) to clean along the edges of the obstacles or avoid them. However, cleaning robots generally use single-point ranging sensors (such as infrared sensors, TOF sensors, PSD sensors, etc.) to measure the distance between themselves and obstacles. These sensors can only measure the distance to obstacles at a certain height where the sensors are installed on the cleaning robot. Therefore, for some irregular obstacles, the actual distance between the obstacle and the cleaning robot is not accurate enough, so the cleaning robot may collide with the obstacle, causing paint to fall off the wall and scratches on the furniture and cleaning robot. Summary of the invention

[0003] In view of this, the purpose of the present invention is to overcome the shortcomings of the prior art and to provide a cleaning robot control method, a cleaning robot and a computer-readable storage medium, which are used to obtain the actual distance between the edge of the cleaning robot body and the obstacle based on a first sensor and a second sensor of different heights, and control the cleaning robot to clean along the edge or avoid obstacles based on the actual distance.

[0004] The present invention provides the following technical solutions:

[0005] In a first aspect, the present invention provides a cleaning robot control method, which is applied to a cleaning robot provided with a first sensor and a second sensor, wherein the second sensor is provided at a height greater than the first sensor, and the method comprises:

[0006] At the same time, first environmental data is acquired through the first sensor, and second environmental data is acquired through the second sensor;

[0007] Acquire a first distance between the first sensor and the obstacle according to the first environmental data, and acquire a second distance between the second sensor and the obstacle according to the second environmental data;

[0008] Determining the actual distance between the edge of the body of the cleaning robot and the obstacle according to the first distance and the second distance;

[0009] Perform edge cleaning according to the actual distance, or perform obstacle avoidance according to the actual distance.

[0010] In one embodiment, the first sensor is located at an edge of the body, and the second sensor is located on an upper surface of the body of the cleaning robot.

[0011] In one embodiment, determining the actual distance between the edge of the body of the cleaning robot and the obstacle according to the first distance and the second distance includes:

[0012] Acquire a third distance between the edge of the body and the obstacle according to the second distance and a body parameter of the cleaning robot; the body parameter is the distance between the calibrated position of the second sensor and the edge of the body;

[0013] The actual distance between the edge of the fuselage and the obstacle is determined according to the first distance and the third distance.

[0014] In one embodiment, determining the actual distance between the edge of the fuselage and the obstacle according to the first distance and the third distance includes:

[0015] determining whether the first distance is less than the third distance;

[0016] If the first distance is smaller than the third distance, taking the first distance as the actual distance;

[0017] If the first distance is greater than the third distance, the third distance is used as the actual distance.

[0018] In one embodiment, before determining whether the first distance is less than the third distance, the method further includes:

[0019] determining a distance difference between the first distance and the third distance;

[0020] If the distance difference is less than or equal to a preset difference threshold, taking the first distance as the actual distance;

[0021] Accordingly, determining whether the first distance is less than the third distance includes:

[0022] If the distance difference is greater than a preset difference threshold, it is determined whether the first distance is less than the third distance.

[0023] In one embodiment, determining the actual distance between the edge of the fuselage and the obstacle according to the first distance and the third distance includes:

[0024] Determining whether the first distance or the second distance is less than a preset distance threshold;

[0025] If yes, the actual distance between the edge of the fuselage and the obstacle is determined according to the first distance and the third distance.

[0026] In one embodiment, the first sensor is an infrared sensor, a TOF sensor or a PSD sensor, and the second sensor is a laser radar.

[0027] In one embodiment, after acquiring the second environment data through the second sensor, the method further includes:

[0028] Acquire a target rotation angle of the cleaning robot according to the second environmental data;

[0029] Accordingly, edge cleaning is performed according to the actual distance, including:

[0030] The edge cleaning is performed according to the actual distance and the target rotation angle.

[0031] In one embodiment, the edge cleaning according to the actual distance and the target rotation angle includes:

[0032] Determining an adjustment distance of the cleaning robot according to the actual distance and a preset edge distance;

[0033] Controlling the cleaning robot to move to a target position according to the adjustment distance; and performing edge cleaning at the target position;

[0034] At the same time, the forward direction of the cleaning robot is adjusted to be parallel to the obstacle according to the target rotation angle to perform edge cleaning.

[0035] In one embodiment, the acquiring the second environment data by the second sensor includes:

[0036] acquiring data to be processed through the second sensor according to the position of the first sensor;

[0037] The to-be-processed data closest to the obstacle is used as the second environment data.

[0038] In one embodiment, the first sensor is located at the right side of the cleaning robot, and acquiring the data to be processed through the second sensor according to the position of the first sensor includes: acquiring the data to be processed within the range of 0° to -180° in the clockwise direction.

[0039] In a second aspect, the present invention proposes a cleaning robot, comprising a memory and a processor, wherein the memory stores a computer program, and when the computer program is executed by the processor, the cleaning robot control method proposed in the first aspect is implemented.

[0040] In a third aspect, the present invention proposes a computer-readable storage medium storing a computer program, which, when executed by a processor, implements the cleaning robot control method proposed in the first aspect.

[0041] The cleaning robot control method, cleaning robot and computer-readable storage medium disclosed in the present invention, by means of sensors arranged at different heights, can accurately measure the actual distance between the edge of the cleaning robot body and the obstacle for irregular obstacles. Furthermore, the obstacle can be cleaned along the edge or avoided according to the actual distance, thereby preventing the cleaning robot from colliding with the obstacle when encountering an irregular obstacle. BRIEF DESCRIPTION OF THE DRAWINGS

[0042] In order to more clearly illustrate the technical solution of the present invention, the following is a brief introduction to the drawings required for use in the embodiments. It should be understood that the following drawings only illustrate certain embodiments of the present invention and should not be regarded as limiting the scope of protection of the present invention. In each of the drawings, similar components are numbered similarly.

[0043] Figure 1 A schematic diagram of a flow chart of the cleaning robot control method proposed in this embodiment is shown;

[0044] Figure 2A A front view diagram of the cleaning robot and an obstacle proposed in this embodiment is shown;

[0045] Figure 2B Another front view schematic diagram between the cleaning robot and the obstacle proposed in this embodiment is shown;

[0046] Figure 3 Another front view schematic diagram between the cleaning robot and the obstacle proposed in this embodiment is shown;

[0047] Figure 4 Another schematic diagram of the cleaning robot control method proposed in this embodiment is shown;

[0048] Figure 5 A schematic top view of the cleaning robot and an obstacle proposed in this embodiment is shown;

[0049] Figure 6 Another schematic diagram of the cleaning robot control method proposed in this embodiment is shown;

[0050] Figure 7 A schematic structural diagram of the cleaning robot control device proposed in this embodiment is shown.

[0051] Description of the accompanying drawings: 201-cleaning robot; 202-obstacle on the slope; 203-obstacle with a suspended part; 204-obstacle with a protrusion on the upper side; 2011-first sensor; 2012-second sensor; 700-cleaning robot control device; 701-first acquisition module; 702-second acquisition module; 703-determination module; 704-control module. DETAILED DESCRIPTION

[0052] The technical solutions in the embodiments of the present invention will be described clearly and completely below in conjunction with the accompanying drawings in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, rather than all the embodiments.

[0053] The components of the embodiments of the present invention generally described and shown in the drawings herein may be arranged and designed in a variety of different configurations. Therefore, the following detailed description of the embodiments of the present invention provided in the drawings is not intended to limit the scope of the claimed invention, but merely represents selected embodiments of the present invention. Based on the embodiments of the present invention, all other embodiments obtained by those skilled in the art without creative work are within the scope of protection of the present invention.

[0054] Hereinafter, the terms "including", "having" and their cognates, which may be used in various embodiments of the present invention, are intended only to indicate specific features, numbers, steps, operations, elements, components or combinations of the foregoing items, and should not be understood as first excluding the existence of one or more other features, numbers, steps, operations, elements, components or combinations of the foregoing items or adding the possibility of one or more features, numbers, steps, operations, elements, components or combinations of the foregoing items.

[0055] Furthermore, the terms “first”, “second”, “third”, etc. are merely used for distinguishing descriptions and are not to be understood as indicating or implying relative importance.

[0056] Unless otherwise defined, all terms (including technical terms and scientific terms) used herein have the same meanings as those generally understood by those skilled in the art to which the various embodiments of the present invention belong. Terms (such as those defined in generally used dictionaries) will be interpreted as having the same meanings as the contextual meanings in the relevant technical field and will not be interpreted as having idealized meanings or overly formal meanings unless clearly defined in the various embodiments of the present invention.

[0057] Example 1

[0058] An embodiment of the present disclosure provides a cleaning robot control method, which is applied to a cleaning robot provided with a first sensor and a second sensor, wherein the second sensor is set at a height greater than the first sensor, and is used to obtain the actual distance between the edge of the cleaning robot body and an obstacle based on the first sensor and the second sensor of different heights, and control the cleaning robot to clean along the edge based on the actual distance, or control the cleaning robot to avoid obstacles based on the actual distance.

[0059] See also Figure 1 The cleaning robot control method includes steps S101 to S104, and each step is described in detail below.

[0060] Step S101: at the same time, first environmental data is acquired through the first sensor, and second environmental data is acquired through the second sensor.

[0061] Specifically, during the operation of the cleaning robot, the first sensor and the second sensor of the cleaning robot will collect data of the surrounding environment in real time, and the cleaning robot will obtain the first environment data and the second environment data collected by the first sensor and the second sensor at the same time.

[0062] It should be noted that, when the cleaning robot is moving, the environment in which the cleaning robot is located will change. By acquiring the first environment data and the second environment data at the same time, it can be ensured that the environments corresponding to the first environment data and the second environment data are the same.

[0063] Step S102: acquiring a first distance between the first sensor and an obstacle according to the first environmental data, and acquiring a second distance between the second sensor and the obstacle according to the second environmental data.

[0064] In this embodiment, for example, see Figure 2A and Figure 2B The processor inside the cleaning robot calculates the first distance L1 between the first sensor 2011 and the inclined obstacle 202 according to the first environmental data, and calculates the second distance L2 between the second sensor 2012 and the inclined obstacle 202 according to the second environmental data. In this way, the distances are calculated respectively according to the data obtained by the sensors at different locations, providing an accurate data basis for the subsequent determination of the actual distance.

[0065] Step S103: determining the actual distance between the edge of the body of the cleaning robot and the obstacle according to the first distance and the second distance.

[0066] In this embodiment, the first distance L1 and the second distance L2 obtained at this time are only the distances between the sensor and the obstacle, and cannot accurately reflect the actual distance between the edge of the cleaning robot's body and the obstacle. Therefore, it is also necessary to perform data comparison or other data processing methods based on the first distance L1 and the second distance L2 to determine the actual distance between the edge of the body and the obstacle.

[0067] Exemplarily, if the first sensor and the second sensor are both arranged on the edge of the body on the same side of the cleaning robot, and the first sensor or the second sensor are both photoelectric position sensors (Position Sensitive Detectors, PSD), a beam of infrared light or laser is emitted by the PSD sensor, this light beam is irradiated on the obstacle, and then reflected back and focused on the photosensitive surface of the PSD sensor, and the position of the light spot on the photosensitive surface is detected, and then the first distance between the first sensor and the obstacle and the second distance between the second sensor and the obstacle are determined. Since the first sensor and the second sensor are both arranged on the edge of the body, if the shape of the obstacle is irregular, the minimum distance between the first distance and the second distance can be used as the actual distance between the edge of the body and the obstacle.

[0068] Step S104: performing edge cleaning according to the actual distance, or performing obstacle avoidance according to the actual distance.

[0069] Specifically, the cleaning robot is controlled to move to a preset edge distance according to the actual distance to clean the obstacle along the edge; or, the cleaning robot is controlled to move to a preset safety distance according to the actual distance and then turns to avoid obstacles.

[0070] Among them, the edge distance and the safety distance can be pre-set based on manual experience; the edge distance is the distance at which the edge of an obstacle can be cleaned without colliding with the obstacle; the safety distance is the distance that will not cause the cleaning robot to miss a sweep and will not collide with an obstacle.

[0071] In this embodiment, for different irregular obstacles, such as Figure 3 Obstacles 202 with a mid-slope (such as furniture such as coffee table legs and chair legs), or obstacles 203 with suspended parts (such as a suspended coffee table), obstacles 204 with protrusions on the upper side (such as furniture such as TV cabinets and beds with suspended beams), etc., can all be measured by the cleaning robot 201 based on data obtained by sensors at two different heights to obtain actual distances, so that for irregular obstacles, the actual distance obtained by the cleaning robot 201 is more accurate. Furthermore, edge cleaning can be performed based on the actual distance, or obstacle avoidance can be performed based on the actual distance, so as to prevent the cleaning robot from colliding with obstacles during cleaning, thereby avoiding damage to the cleaning robot and the obstacle.

[0072] In a specific embodiment, the first sensor is located at the edge of the body, and the second sensor is located on the upper surface of the body of the cleaning robot.

[0073] Specifically, in this embodiment, see Figure 2A and Figure 2B The first sensor 2011 is located at the edge of the body of the cleaning robot 201 , and the second sensor 2012 is located at the upper surface of the body of the cleaning robot 201 .

[0074] Exemplarily, the first sensor may be located at the front edge, the left edge or the right edge of the body of the cleaning robot; the second sensor may be located at the center, the front or the rear of the upper surface of the body of the cleaning robot.

[0075] In a specific embodiment, the first sensor is an infrared sensor, a TOF sensor or a PSD sensor, and the second sensor is a laser radar.

[0076] Specifically, the infrared sensor determines the distance of the obstacle by emitting infrared light and detecting the reflected light. The TOF (Time-of-Flight) sensor uses the flight time of light or sound waves to measure the distance between the obstacle and the sensor. The PSD (Position Sensitive Device) sensor measures the distance of the obstacle by detecting the change in the incident position of light.

[0077] In this embodiment, since the laser radar is usually installed at a high position and is often used for positioning and mapping, the laser radar is used as the second sensor to confirm the second distance, and there is no need to increase the cost of adding another sensor to the cleaning robot.

[0078] In a specific embodiment, step S101 includes: acquiring the data to be processed through the second sensor according to the position of the first sensor; and using the data to be processed that is closest to the obstacle as the second environment data.

[0079] It should be noted that since the laser radar needs to be positioned and mapped, it usually scans the surrounding environment 360°, so that environmental data in all directions can be collected. However, the first sensor is a single-point ranging sensor and can only collect environmental data in a specific direction according to the position of the first sensor set on the cleaning robot. Therefore, in order to ensure the consistency of obstacles corresponding to the first environmental data and the second environmental data, it is necessary to first obtain the data to be processed through the second sensor according to the position of the first sensor.

[0080] Exemplarily, the direction in which the cleaning robot moves forward is taken as the front end of the cleaning robot, and the direction in which the cleaning robot moves forward is taken as 0°, and the counterclockwise direction is the direction of angle increase; if the first sensor is set on the front side of the cleaning robot, the environmental data in the direction of -90° to +90° collected by the second sensor is obtained, and the environmental data in this direction is used as the data to be processed; if the first sensor is set on the left side of the cleaning robot, the environmental data in the direction of 0° to +180° collected by the second sensor is obtained, and the environmental data in this direction is used as the data to be processed.

[0081] Furthermore, the second environment data closest to the obstacle is obtained from the data to be processed, thereby ensuring the accuracy of the subsequent determination of the actual distance between the edge of the body of the cleaning robot and the obstacle.

[0082] In a specific embodiment, the first sensor is located on the right side of the cleaning robot, and acquiring the data to be processed through the second sensor based on the position of the first sensor includes: acquiring the data to be processed within the range of 0° to -180° in the clockwise direction through the second sensor.

[0083] In this embodiment, the forward direction of the cleaning robot is taken as the front end of the cleaning robot, and the forward direction of the cleaning robot is taken as 0°, and the counterclockwise direction is the direction of angle increase; when the first sensor is located on the right side of the cleaning robot, the second sensor is used to obtain the data to be processed within the range of 0° to -180° in the clockwise direction, that is, the data to be processed on the same side as the first sensor can be obtained.

[0084] See also Figure 4 In a specific embodiment, step S103 includes steps S1031 to S1032, and each step is described in detail below.

[0085] Step S1031, obtaining a third distance between the edge of the body and the obstacle according to the second distance and the body parameters of the cleaning robot; the body parameters are the calibrated distance between the position of the second cleaning sensor and the edge of the body.

[0086] Specifically, in this embodiment, when the second sensor is located on the upper surface of the body of the cleaning robot, the body parameters of the cleaning robot can be subtracted from the second distance L2 to obtain the third distance L3 between the edge of the body and the obstacle.

[0087] It should be noted that since the second sensor can be located at the center, front or rear of the upper surface of the cleaning robot's body, in order to facilitate the subsequent processing of the data collected by the second sensor when the cleaning robot is working, the position of the second sensor will be calibrated before the cleaning robot leaves the factory, and the processor inside the cleaning robot will calibrate the position of the second sensor at the center of the upper surface of the cleaning robot's body.

[0088] The following is a detailed description of the fuselage parameters:

[0089] Taking the laser radar as the second sensor as an example, when the volume of the laser radar is ignored, the body radius of the cleaning robot can be used as the body parameter. When the volume of the laser radar is relatively large and cannot be ignored, the distance between the edge of the laser radar and the edge of the cleaning robot is used as the body parameter of the cleaning robot. In this way, the volume of the laser radar is taken into account and the calculation accuracy of the actual distance between the edge of the body and the obstacle is improved.

[0090] For illustration, please see again Figure 2A , taking the second sensor 2012 as a laser radar as an example, the second distance L2 is actually the distance between the center of the laser radar and the obstacle. Then, in order to more accurately obtain the third distance L3 between the edge of the body and the obstacle, the body radius of the cleaning robot itself is subtracted from the second distance L2 to obtain the third distance L3 between the edge of the body and the obstacle.

[0091] Step S1032: determining the actual distance between the edge of the fuselage and the obstacle according to the first distance and the third distance.

[0092] In this embodiment, the first distance L1 is the distance between the first sensor located at the edge of the cleaning robot body and the obstacle, and the third distance L3 is the distance between the edge of the cleaning robot body and the obstacle obtained by the second sensor located on the upper surface of the cleaning robot body. The first sensor and the second sensor are located at different positions, so the first distance L1 and the third distance L3 cannot reflect the actual distance between the edge of the body and the obstacle independently, but need to be combined to determine the actual distance.

[0093] In a specific embodiment, step S1032 includes: determining whether the first distance is smaller than the third distance; if the first distance is smaller than the third distance, taking the first distance as the actual distance; if the first distance is greater than the third distance, taking the third distance as the actual distance.

[0094] For example, Figure 2A As shown, if the first distance L1 is greater than the third distance L3, the third distance L3 is taken as the actual distance; Figure 2BAs shown, if the first distance L1 is smaller than the third distance L3, the first distance L1 is taken as the actual distance.

[0095] In this embodiment, since the first sensor and the second sensor are set at different heights, the distance with the smallest value is taken as the actual distance. When the obstacle is irregular, the actual distance between the cleaning robot and the obstacle can be determined more accurately. While avoiding a collision between the cleaning robot and the obstacle, the cleaning robot can also get as close to the obstacle as possible according to the actual distance, thereby avoiding inadequate cleaning of the corners of the obstacle.

[0096] In a specific embodiment, before determining whether the first distance is smaller than the third distance, the method further includes: determining a distance difference between the first distance and the third distance; if the distance difference is smaller than or equal to a preset difference threshold, taking the first distance as the actual distance; correspondingly, determining whether the first distance is smaller than the third distance includes: if the distance difference is greater than a preset difference threshold, determining whether the first distance is smaller than the third distance.

[0097] Specifically, the preset difference threshold may be preset according to manual experience, for example, may be 1 cm.

[0098] In this embodiment, if the distance difference between the first distance L1 and the third distance L3 is less than or equal to the preset difference threshold, it can be known that the distance difference between the first distance L1 and the third distance L3 is small, or the distance between the first distance L1 and the third distance L3 is equal. Since the first distance L1 is the distance between the first sensor and the obstacle calculated directly based on the first environmental data obtained by the first sensor located at the edge of the fuselage, and the first sensor collects environmental data in a specific direction in real time, while the second sensor collects environmental data in all directions, when determining the distance between an obstacle in a specific direction and the edge of the fuselage, the collection frequency of the environmental data collected by the first sensor is higher. In summary, it is more accurate to use the first distance L1 as the actual distance between the cleaning robot and the obstacle. If the distance difference between the first distance L1 and the third distance L3 is greater than the preset difference threshold, it can be known that the distance difference between the first distance L1 and the third distance L3 is large. At this time, the actual distance is determined from the first distance L1 and the third distance L3 according to the size of the first distance L1 and the third distance L3.

[0099] In a specific embodiment, determining the actual distance between the edge of the fuselage and the obstacle based on the first distance and the third distance includes: determining whether the first distance or the third distance is less than a preset distance threshold; if so, determining the actual distance between the edge of the fuselage and the obstacle based on the first distance and the third distance.

[0100] Specifically, if it is, that is, the first distance L1 or the third distance L3 is less than the preset distance threshold, it can be known that the cleaning robot has approached the obstacle, and the subsequent step of determining the actual distance between the edge of the body and the obstacle according to the first distance and the third distance can be performed. If not, that is, the first distance L1 and the third distance L3 are both greater than or equal to the preset distance threshold, it can be known that the cleaning robot is far away from the obstacle, and the cleaning robot needs to continue to move according to the preset planned path, and go to step S101.

[0101] Optionally, the preset distance threshold may be 8m.

[0102] In a specific embodiment, after step S101, the method further includes: acquiring a target rotation angle of the cleaning robot according to the second environmental data; correspondingly, step S104 includes: performing edge cleaning according to the actual distance and the target rotation angle.

[0103] Specifically, the second environment data is point cloud data, and based on the point cloud data, the processor inside the cleaning robot can calculate the target rotation angle.

[0104] In this embodiment, edge cleaning is performed based on the actual distance and the target rotation angle at the same time, which can better adapt to obstacles of different shapes and achieve better edge cleaning effects.

[0105] For example, see Figure 5 , determine the reference angle according to the current forward direction of the cleaning robot, the reference angle is generally 0°; and determine the clockwise direction or counterclockwise direction as the direction of angle increase.

[0106] Further, the direction pointed by the second sensor toward the obstacle is determined as the obstacle direction.

[0107] Further, based on the reference angle and the angle increasing direction, the angle θ1 between the obstacle direction and the advancing direction is obtained according to the second environment data. At this time, if the counterclockwise direction is the angle increasing direction, then θ1 = -135°.

[0108] Furthermore, the angle difference between the included angle θ1 and the preset angle θ2 is used as the target rotation angle. Taking the preset angle θ2 = -90° as an example, the target rotation angle is -45°. At this time, -45° means that the rotation direction is clockwise, and the rotation angle value is 45°.

[0109] It should be noted that the preset angle is determined based on the expected value of the angle between the obstacle direction and the forward direction. Generally, the obstacle direction is expected to be perpendicular to the forward direction, so based on the counterclockwise direction as the angle increasing direction, the preset angle θ2 = -90°.

[0110] In a specific embodiment, the edge cleaning according to the actual distance and the target rotation angle includes: determining the adjustment distance of the cleaning robot according to the actual distance and the preset edge distance; controlling the cleaning robot to move to the target position according to the adjustment distance; performing edge cleaning at the target position; and at the same time, adjusting the forward direction of the cleaning robot to be parallel to the obstacle according to the target rotation angle to perform edge cleaning.

[0111] In this embodiment, the adjustment distance of the cleaning robot is determined according to the actual distance and the preset edge distance. The adjustment distance is generally slightly smaller than the actual distance and is used to control a safe distance between the edge of the cleaning robot and the obstacle.

[0112] Furthermore, the cleaning robot is controlled to move to the target position according to the adjusted distance, and the cleaning robot performs edge cleaning at the target position, thereby preventing the cleaning robot from colliding with obstacles. In addition, the cleaning robot is rotated according to the target rotation angle at the same time, so that the forward direction of the cleaning robot after rotation is parallel to the obstacle, thereby further preventing the cleaning robot from scratching the obstacle, thereby achieving better edge cleaning.

[0113] In order to facilitate those skilled in the art to understand the present application, Figure 6 The method provided by the present application is introduced in detail. In a specific embodiment, the cleaning robot control method includes the following steps:

[0114] S601, at the same time, obtaining first environmental data through a first sensor, and obtaining second environmental data through a second sensor.

[0115] S602, acquiring a first distance between the first sensor and the obstacle according to the first environmental data, acquiring a second distance between the second sensor and the obstacle according to the second environmental data; and acquiring a target rotation angle of the cleaning robot according to the second environmental data.

[0116] S603, acquiring a third distance between the edge of the body and the obstacle according to the second distance and the body parameter of the cleaning robot; the body parameter is the distance between the calibrated position of the second sensor and the edge of the body.

[0117] S604: Determine whether the first distance or the third distance is less than a preset distance threshold.

[0118] Specifically, if yes, execute S605; if no, return to execute S601.

[0119] S605: Determine a distance difference between the first distance and the third distance.

[0120] Specifically, if the distance difference is greater than the preset difference threshold, S606 is executed; if the distance difference is less than or equal to the preset difference threshold, S609 is executed.

[0121] S606: If the distance difference is greater than a preset difference threshold, determine whether the first distance is less than a third distance.

[0122] Specifically, if yes, execute S607; if no, execute S608.

[0123] S607: If the first distance is smaller than the third distance, the first distance is taken as the actual distance.

[0124] S608: If the first distance is greater than the third distance, use the third distance as the actual distance.

[0125] S609: If the distance difference is less than or equal to the preset difference threshold, the first distance is taken as the actual distance.

[0126] S610: Perform edge cleaning according to the actual distance and the target rotation angle, or perform obstacle avoidance according to the actual distance.

[0127] The cleaning robot control method proposed in this embodiment, by setting sensors at different heights, can accurately measure the actual distance between the edge of the cleaning robot body and the obstacle for irregular obstacles. Furthermore, the obstacle can be cleaned along the edge or avoided according to the actual distance, thereby preventing the cleaning robot from colliding with the obstacle when encountering an irregular obstacle.

[0128] Example 2

[0129] In addition, the embodiment of the present disclosure provides a cleaning robot control device 700, which is applied to a cleaning robot provided with a first sensor and a second sensor, wherein the second sensor is provided at a height greater than the first sensor. Figure 7 , the device comprises:

[0130] A first acquisition module 701 is used to acquire first environmental data through the first sensor and acquire second environmental data through the second sensor at the same time;

[0131] A second acquisition module 702, configured to acquire a first distance between the first sensor and the obstacle according to the first environmental data, and acquire a second distance between the second sensor and the obstacle according to the second environmental data;

[0132] A determination module 703 is used to determine the actual distance between the edge of the cleaning robot and the obstacle according to the first distance and the second distance;

[0133] The control module 704 is used to perform edge cleaning according to the actual distance, or to avoid obstacles according to the actual distance.

[0134] Optionally, a determination module 703 is used to obtain a third distance between the edge of the body and the obstacle based on the second distance and the body parameters of the cleaning robot; the body parameters are the distance between the calibrated position of the second sensor and the edge of the body; and determine the actual distance between the edge of the body and the obstacle based on the first distance and the third distance.

[0135] Optionally, the determination module 703 is used to determine whether the first distance is smaller than the third distance; if the first distance is smaller than the third distance, the first distance is used as the actual distance; if the first distance is greater than the third distance, the third distance is used as the actual distance.

[0136] Optionally, a determination module 703 is used to determine a distance difference between the first distance and the third distance; if the distance difference is less than or equal to a preset difference threshold, the first distance is used as the actual distance; accordingly, judging whether the first distance is less than the third distance includes: if the distance difference is greater than a preset difference threshold, judging whether the first distance is less than the third distance.

[0137] Optionally, the determination module 703 is used to determine whether the first distance or the second distance is less than a preset distance threshold; if so, determine the actual distance between the edge of the fuselage and the obstacle based on the first distance and the third distance.

[0138] Optionally, the first sensor is an infrared sensor, a TOF sensor or a PSD sensor, and the second sensor is a lidar.

[0139] Optionally, a determination module 703 is used to obtain a target rotation angle of the cleaning robot according to the second environment data;

[0140] The control module 704 is used to perform edge cleaning according to the actual distance and the target rotation angle.

[0141] Optionally, the control module 704 is used to determine the adjustment distance of the cleaning robot according to the actual distance and the preset edge distance; control the cleaning robot to move to the target position according to the adjustment distance; perform edge cleaning at the target position; and at the same time, adjust the forward direction of the cleaning robot to be parallel to the obstacle according to the target rotation angle to perform edge cleaning.

[0142] Optionally, the first acquisition module 701 is further configured to acquire the data to be processed through the second sensor according to the position of the first sensor; and use the data to be processed that is closest to the obstacle as the second environment data.

[0143] Optionally, the first sensor is located on the right side of the cleaning robot, and the first acquisition module 701 is used to acquire the data to be processed within a range of 0° to -180° in a clockwise direction.

[0144] The device provided in the embodiment of the present disclosure can execute the steps of the cleaning robot control method provided in Example 1, which will not be described again to avoid repetition.

[0145] Example 3

[0146] In addition, an embodiment of the present disclosure provides a cleaning robot, including a memory and a processor, wherein the memory stores a computer program, and when the computer program is executed by the processor, the cleaning robot control method of embodiment 1 is implemented.

[0147] The cleaning robot provided in the embodiment of the present disclosure can execute the steps of the cleaning robot control method provided in Example 1, which will not be described again to avoid repetition.

[0148] Example 4

[0149] The embodiment of the present disclosure provides a computer-readable storage medium storing a computer program. When the computer program is executed by a processor, the cleaning robot control method of the embodiment 1 is implemented.

[0150] In this embodiment, the computer-readable storage medium may be a read-only memory (ROM), a random access memory (RAM), a magnetic disk, or an optical disk.

[0151] The computer-readable storage medium provided in this embodiment can implement the cleaning robot control method provided in Example 1, and will not be described again here to avoid repetition.

[0152] In all examples shown and described herein, any specific values ​​should be interpreted as merely exemplary and not as limiting, and thus other examples of the exemplary embodiments may have different values.

[0153] It should be noted that similar reference numerals and letters denote similar items in the following drawings, and therefore, once an item is defined in one drawing, further definition and explanation thereof is not required in subsequent drawings.

[0154] The above embodiments only express several implementation methods of the present invention, and the descriptions thereof are relatively specific and detailed, but they cannot be understood as limiting the scope of the present invention. It should be pointed out that, for those of ordinary skill in the art, several variations and improvements can be made without departing from the concept of the present invention, and these all belong to the protection scope of the present invention.

Claims

1. A cleaning robot control method, characterized in that: Applied to a cleaning robot provided with a first sensor and a second sensor, the second sensor being provided at a height greater than the first sensor, the method comprising: At the same time, first environmental data is acquired through the first sensor, and second environmental data is acquired through the second sensor; Acquire a first distance between the first sensor and the obstacle according to the first environmental data, and acquire a second distance between the second sensor and the obstacle according to the second environmental data; Determining the actual distance between the edge of the body of the cleaning robot and the obstacle according to the first distance and the second distance; Perform edge cleaning according to the actual distance, or perform obstacle avoidance according to the actual distance.

2. The cleaning robot control method according to claim 1, characterized in that: The first sensor is located at the edge of the body, and the second sensor is located at the upper surface of the body of the cleaning robot.

3. The cleaning robot control method according to claim 2, characterized in that: The determining the actual distance between the edge of the body of the cleaning robot and the obstacle according to the first distance and the second distance includes: Acquire a third distance between the edge of the body and the obstacle according to the second distance and a body parameter of the cleaning robot; the body parameter is the distance between the calibrated position of the second sensor and the edge of the body; The actual distance between the edge of the fuselage and the obstacle is determined according to the first distance and the third distance.

4. The cleaning robot control method according to claim 3, characterized in that: The determining the actual distance between the edge of the fuselage and the obstacle according to the first distance and the third distance includes: determining whether the first distance is less than the third distance; If the first distance is smaller than the third distance, taking the first distance as the actual distance; If the first distance is greater than the third distance, the third distance is used as the actual distance.

5. The cleaning robot control method according to claim 4, characterized in that: Before determining whether the first distance is less than the third distance, the method further includes: determining a distance difference between the first distance and the third distance; If the distance difference is less than or equal to a preset difference threshold, taking the first distance as the actual distance; Accordingly, determining whether the first distance is less than the third distance includes: If the distance difference is greater than a preset difference threshold, it is determined whether the first distance is less than the third distance.

6. The cleaning robot control method according to claim 3, characterized in that: The determining the actual distance between the edge of the fuselage and the obstacle according to the first distance and the third distance includes: Determining whether the first distance or the second distance is less than a preset distance threshold; If yes, the actual distance between the edge of the fuselage and the obstacle is determined according to the first distance and the third distance.

7. The cleaning robot control method according to any one of claims 1 to 6, characterized in that: The first sensor is an infrared sensor, a TOF sensor or a PSD sensor, and the second sensor is a laser radar.

8. The cleaning robot control method according to claim 7, characterized in that: After acquiring the second environment data through the second sensor, the method further includes: Acquire a target rotation angle of the cleaning robot according to the second environmental data; Accordingly, edge cleaning is performed according to the actual distance, including: The edge cleaning is performed according to the actual distance and the target rotation angle.

9. The cleaning robot control method according to claim 8, characterized in that: The edge cleaning according to the actual distance and the target rotation angle includes: Determining an adjustment distance of the cleaning robot according to the actual distance and a preset edge distance; controlling the cleaning robot to move to a target position according to the adjustment distance; and performing edge cleaning at the target position; At the same time, the forward direction of the cleaning robot is adjusted to be parallel to the obstacle according to the target rotation angle to perform edge cleaning.

10. The cleaning robot control method according to claim 7, characterized in that: The acquiring the second environment data by the second sensor includes: acquiring data to be processed through the second sensor according to the position of the first sensor; The to-be-processed data closest to the obstacle is used as the second environment data.

11. The cleaning robot control method according to claim 10, characterized in that: The first sensor is located at the right side of the cleaning robot, and acquiring the data to be processed through the second sensor according to the position of the first sensor includes: acquiring the data to be processed within the range of 0° to -180° in the clockwise direction through the second sensor.

12. A cleaning robot, characterized in that: It comprises a memory and a processor, the memory stores a computer program, and when the computer program is executed by the processor, the cleaning robot control method according to any one of claims 1 to 11 is implemented.

13. A computer-readable storage medium, characterized in that: It stores a computer program, which, when executed by a processor, implements the cleaning robot control method as described in any one of claims 1 to 11.

Citation Information

Cited By

  • Cleaning equipment control method and equipment, readable storage medium and program product

    CN121221011A

  • Control method of mobile device, electronic device and storage medium

    CN122111032A

  • Control methods, electronic devices and storage media for mobile devices

    CN122111032B