Mapping method and system, underwater robot, storage medium, and electronic device

By using ultrasonic radar ranging sensors in underwater robots to collect distance characteristic data and correct navigation data errors, the problem of poor map construction effect in underwater environments is solved, and accurate map construction for underwater environments of any shape is achieved, improving The work efficiency and accuracy of cleaning robots.

WO2024244071A1PCT designated stage expired Publication Date: 2024-12-05SUBLUE UNDERWATER AI CO LTD +1
View PDF 6 Cites 0 Cited by

Patent Information

Application Number
PCT/CN2023/101920
Authority / Receiving Office
WO · WO
Patent Type
Applications
Current Assignee / Owner
Priority Date
2023-06-01
Filing Date
2023-06-21
Publication Date
2024-12-05

AI Technical Summary

Technical Problem

The existing underwater robot mapping method has poor positioning accuracy in underwater environments, high requirements for the structural performance of cleaning robots, and ineffective operation, resulting in poor mapping effect.

Method used

Ultrasonic radar ranging sensors are used to collect underwater environmental distance characteristic data, and generate navigation characteristic data through navigation data error elimination processing to achieve accurate mapping of underwater environments of any shape.

Benefits of technology

Through the low-cost ultrasonic radar ranging sensor, accurate mapping of underwater environments is achieved, the requirements for the structural performance of cleaning robots are reduced, and the accuracy and stability of mapping are improved.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN2023101920_05122024_PF_FP_ABST
    Figure CN2023101920_05122024_PF_FP_ABST
Patent Text Reader

Abstract

An underwater robot mapping method and system, an underwater robot, a storage medium, and an electronic device. The mapping method comprises: on the basis of a preset algorithm, moving to a first pool wall having the shortest distance from an underwater robot, and maintaining a first preset distance from the first pool wall (S100); moving along a pool wall from the first pool wall (S200); in the process of moving along the pool wall, acquiring distance feature data from the pool wall on the basis of at least two preset sensors (S300); performing error elimination processing on navigation data of the underwater robot on the basis of the distance feature data, to obtain navigation feature data (S400); and generating an environment feature map on the basis of the distance feature data and the navigation feature data (S500). Distance feature data of an underwater environment is collected by means of ultrasonic radar ranging sensors, and error elimination processing is performed on navigation data of an underwater robot, so as to achieve mapping of the underwater environment in any shape.
Need to check novelty before this filing date? Find Prior Art

Description

Mapping method and system thereof, underwater robot, storage medium and electronic device Technical Field

[0001] The present application relates to the field of intelligent robot technology, and in particular to a mapping method for an underwater robot and a system thereof, an underwater robot, a storage medium, and an electronic device. Background Art

[0002] With the rapid development of national scientific and technological innovation and high-end manufacturing, the robotics industry has gradually developed into all areas of people's lives, and different types of intelligent robots can already replace humans in various tasks.

[0003] An underwater robot is a type of robot that works underwater, replacing manual labor in underwater environments. For example, a pool cleaning robot is designed to clean the bottom and walls of a swimming pool. It automatically cleans the pool without draining it. This robot replaces the traditional manual cleaning methods of brushing and changing water, saving labor and providing a more thorough cleaning than manual cleaning.

[0004] Currently, when performing cleaning work, swimming pool cleaning robots need to complete a three-dimensional map of the swimming pool environment in advance in order to plan a specific cleaning path.

[0005] Currently, common mapping methods for cleaning robots include random collision mapping, monocular camera combined with collision mapping, and lidar mapping. However, the inventors of this application have discovered that these methods suffer from poor positioning accuracy, high requirements for the cleaning robot's structural performance, and inability to operate well in underwater environments, resulting in poor mapping results.

[0006] Summary of the Invention

[0007] The present application provides an underwater robot mapping method and system, an underwater robot, a storage medium and an electronic device, which are used to solve the problem of poor mapping effect of the current underwater robot mapping method.

[0008] According to one aspect of the present application, a mapping method for an underwater robot is provided. The mapping method includes moving to a first pool wall that is shortest from the underwater robot based on a preset algorithm, while maintaining a first preset distance from the first pool wall; moving along the pool wall from the first pool wall; while moving along the pool wall, acquiring distance feature data from the pool wall based on at least two preset sensors; performing error elimination processing on the underwater robot's navigation data based on the distance feature data to obtain navigation feature data; and generating an environmental feature map based on the distance feature data and the navigation feature data.

[0009] According to some embodiments of the present application, moving to the first pool wall that is shortest in distance from the underwater robot based on a preset algorithm includes: rotating in place by a preset angle based on the initial posture; obtaining the distance between the attitude angle of the underwater robot and the pool wall during the rotation; determining the shortest pool wall distance and the attitude angle corresponding to the shortest pool wall distance; and moving forward in a straight line with the attitude angle as a control reference until a first preset distance is maintained from the first pool wall.

[0010] According to some embodiments of the present application, error elimination processing is performed on the navigation data of the underwater robot based on the distance feature data to obtain navigation feature data, including: determining the initial motion point of the underwater robot as the origin; determining a first distance feature vector of the origin based on the distance feature data of the origin obtained by at least two preset sensors; determining a second distance feature vector of the motion point based on the distance feature data of the motion point at a second preset distance from the origin obtained by at least two preset sensors; performing error correction on the navigation data according to the first distance feature vector and the second distance feature vector; and generating navigation feature data based on the corrected navigation data.

[0011] According to some embodiments of the present application, performing error correction on navigation data based on a first distance characteristic vector and a second distance characteristic vector includes: determining whether the error between the first distance characteristic vector and the second distance characteristic vector is greater than a first threshold; if so, performing error correction on the navigation data based on the error amount between the first distance characteristic vector and the second distance characteristic vector.

[0012] According to some embodiments of the present application, the preset sensor is an ultrasonic radar ranging sensor.

[0013] According to another aspect of the present application, a mapping system for an underwater robot is provided. The mapping system includes a position determination unit, a motion management unit, and a data processing unit. The position determination unit, based on a preset algorithm, moves the underwater robot to the first pool wall that is shortest to the underwater robot, maintaining a first preset distance from the first pool wall. The motion management unit controls the underwater robot to move along the pool wall starting from the first pool wall. The data processing unit, while the underwater robot is moving along the pool wall, obtains distance feature data from the pool wall based on at least two preset sensors, performs error elimination processing on the underwater robot's navigation data based on the distance feature data to obtain navigation feature data, and generates a swimming pool environment feature map based on the distance feature data and the navigation feature data.

[0014] According to some embodiments of the present application, the position determination unit controls the underwater robot to rotate in place by a preset angle based on the initial posture, obtains the attitude angle of the underwater robot and the distance from the pool wall during the rotation, and determines the shortest pool wall distance and the attitude angle corresponding to the shortest pool wall distance, and controls the underwater robot to move forward in a straight line with the attitude angle as the control reference until it maintains a first preset distance from the target pool wall.

[0015] According to some embodiments of the present application, the data processing unit determines the initial motion point of the underwater robot as the origin, determines the first distance characteristic vector of the origin based on the distance characteristic data of the origin obtained by at least two preset sensors, and determines the second distance characteristic vector of the motion point based on the distance characteristic data of the motion point at a second preset distance from the origin obtained by at least two preset sensors; the data processing unit also performs error correction on the navigation data based on the first distance characteristic vector and the second distance characteristic vector, and generates navigation characteristic data based on the corrected navigation data.

[0016] According to some embodiments of the present application, the data processing unit determines whether the error between the first distance characteristic vector and the second distance characteristic vector is greater than a first threshold; when the error between the first distance characteristic vector and the second distance characteristic vector is greater than the first threshold, the data processing unit performs error correction on the navigation data based on the error amount between the first distance characteristic vector and the second distance characteristic vector.

[0017] According to another aspect of the present application, an underwater robot is provided, which includes the mapping system described above.

[0018] According to another aspect of the present application, a non-volatile computer-readable storage medium is provided, wherein a computer program is stored on the storage medium, and the computer program can implement the mapping method described above.

[0019] According to another aspect of the present application, an electronic device is provided. The electronic device includes one or more processors and a storage device, wherein the storage device is configured to store one or more programs. When the one or more programs are executed by the one or more processors, the one or more processors can implement the mapping method described above.

[0020] This application uses a low-cost ultrasonic radar ranging sensor to collect distance feature data of the underwater environment, and obtains navigation feature data by performing error elimination processing on the underwater robot navigation data. The navigation feature data and distance feature data can be used to realize environmental mapping of underwater environments of arbitrary shapes. BRIEF DESCRIPTION OF THE DRAWINGS

[0021] In order to more clearly illustrate the technical solutions in the embodiments of the present application, the following briefly introduces the drawings required for use in the description of the embodiments. Obviously, the drawings described below are only some embodiments of the present application. For ordinary technicians in this field, other drawings can be obtained based on these drawings without any creative work.

[0022] FIG1 shows a flow chart of a mapping method according to an exemplary embodiment of the present application;

[0023] FIG2 shows a schematic diagram of a swimming pool according to an exemplary embodiment of the present application;

[0024] FIG3 shows another schematic diagram of a swimming pool according to an exemplary embodiment of the present application;

[0025] FIG4 shows another flow chart of the mapping method according to an exemplary embodiment of the present application;

[0026] FIG5 shows another flow chart of the mapping method according to an exemplary embodiment of the present application;

[0027] FIG6 shows a schematic structural diagram of a mapping system according to an exemplary embodiment of the present application.

[0028] Description of reference numerals:

[0029] Mapping system 1; position determination unit 10; motion management unit 20; data processing unit 30;

[0030] Underwater robot M; swimming pool wall N; first pool wall N1; first preset distance La; second preset distance Lb; origin A; moving point B; first distance characteristic data L1; second distance characteristic data L2; third distance characteristic data L3; fourth distance characteristic data L4. DETAILED DESCRIPTION

[0031] Example embodiments will now be described more fully with reference to the accompanying drawings. However, example embodiments can be embodied in many forms and should not be construed as limited to the embodiments set forth herein; rather, these embodiments are provided so that this disclosure will be thorough and complete and will fully convey the concepts of the example embodiments to those skilled in the art. Like reference numerals in the drawings represent like or similar parts, and thus repetitive description thereof will be omitted.

[0032] The described features, structures or characteristics may be combined in any suitable manner in one or more embodiments. In the following description, many specific details are provided to provide a full understanding of the embodiments of the present disclosure. However, those skilled in the art will appreciate that the technical solutions of the present disclosure may be practiced without one or more of these specific details, or other methods, components, materials, devices, etc. may be employed. In these cases, well-known structures, methods, devices, implementations, materials or operations will not be shown or described in detail.

[0033] Furthermore, the terms "include," "comprise," and "have," and any variations thereof, are intended to cover non-exclusive inclusions. For example, a process, method, system, product, or apparatus comprising a series of steps or elements is not limited to the listed steps or elements, but may optionally include steps or elements not listed, or may optionally include other steps or elements inherent to the process, method, product, or apparatus.

[0034] The following is a clear and complete description of the technical solution of this application in conjunction with the drawings in the embodiments of this application. Obviously, the embodiments described are part of the embodiments of this application, not all of them. Based on the embodiments in this application, all other embodiments obtained by those skilled in the art without making any creative efforts are within the scope of protection of this application.

[0035] Current mapping methods for cleaning robots generally include random collision mapping, monocular camera combined with random collision mapping, and lidar mapping.

[0036] Random collision mapping primarily uses the robot's trajectory and the projections of obstacles it encounters to create a map. However, the inventors have discovered that random collision mapping suffers from low positioning accuracy. A monocular camera combined with a collision sensor is implemented using a monocular camera. The robot is equipped with collision contacts, which mark the points impacted by the contact on the robot's collisions to create a map. However, the inventors have discovered that this mapping method places high demands on the robot's structural stability, as the robot frequently collides with obstacles through the contact. A lidar mapping method uses the robot's built-in lidar sensor to perform a 360-degree scan of the underwater environment, creating a map based on the scanned plane of the surrounding environment. However, the inventors have also discovered that this mapping method is not well-suited for underwater environments. For example, the laser radar emitted by a pool cleaning robot attenuates significantly in water, reducing its detection range and thus affecting the accuracy of the map.

[0037] Based on this, the inventor believes that the current mapping method based on swimming pool cleaning robots needs to be improved.

[0038] According to one aspect of the present application, the present application provides a mapping method for an underwater robot, which can collect distance feature data of the underwater environment through a low-cost ultrasonic radar ranging sensor, and obtain navigation feature data by performing error elimination processing on the underwater robot navigation data. The navigation feature data and distance feature data can be used to realize environmental mapping of underwater environments of arbitrary shapes.

[0039] According to the example embodiment, the underwater robot can be a pool cleaning robot used for pool cleaning work, or it can be an underwater working robot with other tasks. The following text introduces the technical solution of this application using the pool cleaning robot as an example, but this application is not limited to this.

[0040] The present application will be described in detail below with reference to the accompanying drawings.

[0041] FIG1 shows a flow chart of a mapping method according to an exemplary embodiment of the present application. As shown in FIG1 , the mapping method includes steps S100 - S500 , and the mapping method can be performed by an underwater robot.

[0042] According to an example embodiment, in step S100 , the underwater robot moves to a first pool wall that is shortest to the underwater robot based on a preset algorithm, and maintains a first preset distance from the first pool wall.

[0043] For example, Figure 2 shows a schematic diagram of a swimming pool according to an exemplary embodiment of the present application. As shown in Figure 2 , the underwater robot M is placed into the swimming pool as shown in Figure 2 from any position, depending on the user's needs. For example, the swimming pool in Figure 2 is rectangular in shape, but the present application is not limited to this.

[0044] After the underwater robot M enters the bottom of the swimming pool and remains stationary, the underwater robot M initializes its current posture information (for example, to 0) and moves to the first pool wall that is shortest to the underwater robot M based on a preset algorithm, thereby completing the underwater robot's automatic initial positioning (i.e., completing the entry into the water - finding the nearest pool wall) process.

[0045] For example, FIG3 shows another schematic diagram of a swimming pool according to an exemplary embodiment of the present application. As shown in FIG3 , after entering the water, the underwater robot M automatically moves to the first pool wall N1 closest to it according to a preset algorithm, and maintains a first preset distance La from the first pool wall N1. The specific size of the first preset distance La is related to the body size of the underwater robot M. The size of the first preset distance La is required to ensure that the underwater robot M can smoothly complete operations such as rotation and movement at this distance without colliding with the pool wall N.

[0046] FIG4 shows another flowchart of the mapping method according to an exemplary embodiment of the present application.

[0047] Optionally, in step S100 , as shown in FIG4 , the underwater robot moving to the first pool wall that is shortest to the underwater robot based on a preset algorithm may include steps S110 - S140 .

[0048] In step S110 , the underwater robot rotates in place by a preset angle based on the initial posture.

[0049] In step S120, the underwater robot obtains the distance between the attitude angle of the underwater robot and the pool wall during the rotation process.

[0050] For example, after entering the water, the underwater robot starts at the initial position and rotates in place for one circle (360°), and measures the distance between the underwater robot and the surrounding pool wall based on the preset ranging sensor installed on the underwater robot body.

[0051] Optionally, the preset ranging sensor installed on the underwater robot can be an ultrasonic radar ranging sensor. The ultrasonic radar ranging sensor sends an ultrasonic signal to a target object and receives the ultrasonic signal reflected by the target object. The ultrasonic radar ranging sensor can measure the distance to the target object based on the time between the two ultrasonic signals.

[0052] While measuring the distance between the underwater robot and the surrounding pool wall, the underwater robot also records the current attitude angle of the underwater robot and the attitude angle θ corresponding to a certain position i i Distance from pool wall L i The array {θ i, L i}.

[0053] In step S130 , the underwater robot determines the shortest distance to the pool wall and the attitude angle corresponding to the shortest distance to the pool wall.

[0054] In step S140, the underwater robot moves forward in a straight line with the attitude angle as a control reference until it maintains a first preset distance from the first pool wall.

[0055] For example, after the underwater robot rotates one circle in place, the attitude angle θ is obtained i Distance from pool wall L i The array {θ i, L i}, the underwater robot determines the minimum distance L to the pool wall min , and the L min The underwater robot rotates in place to adjust its attitude angle to θ, and uses this attitude angle as a control reference to keep moving forward in a straight line until it maintains a first preset distance La from the nearest pool wall (i.e., the first pool wall) (as shown in Figure 3).

[0056] Optionally, after the underwater robot reaches the first pool wall, the underwater robot rotates itself to keep the body of the underwater robot parallel to the first pool wall.

[0057] Through the above exemplary embodiments, the underwater robot automatically moves to the nearest pool wall through a preset algorithm, so that the underwater robot enters the mapping work site in the fastest way.

[0058] According to an example embodiment, in step S200 , the underwater robot moves along the pool wall starting from the first pool wall.

[0059] After automatically moving to the first pool wall closest to it, the underwater robot always moves along the pool wall at a first preset distance La. For example, the underwater robot moves around the pool wall along a path as shown in the direction indicated by the arrow in FIG3 .

[0060] In step S300, the underwater robot obtains characteristic data of the distance to the pool wall based on at least two preset sensors while moving along the pool wall.

[0061] For example, the underwater robot may be provided with at least two preset sensors, such as a first ranging sensor and a second ranging sensor. The first ranging sensor may be provided on the side of the underwater robot to measure first characteristic distance data between the side of the robot and the pool wall, and the second ranging sensor may be provided on the front of the underwater robot to measure second characteristic distance data between the front of the robot and the pool wall.

[0062] As shown in Figure 3, the initial movement point of the underwater robot M is point A, then the first distance characteristic data of point A is L1, and the second distance characteristic data of point A is L2. The underwater robot M can determine the distance characteristic vector of point A as D based on the first distance characteristic data L1 and the second distance characteristic data L2. a (L1, L2).

[0063] In step S400, the underwater robot performs error elimination processing on the navigation data of the underwater robot based on the distance feature data to obtain navigation feature data.

[0064] According to example embodiments, the underwater robot will move according to preset navigation data. However, during actual navigation, the underwater robot will inevitably slip underwater due to the influence of the water environment, resulting in navigation errors. The long-term accumulation of errors can cause the underwater robot's actual positioning to change, making it unable to accurately return to its initial starting position after circumnavigating the pool, and thus preventing the underwater robot from completing a complete closed-loop mapping process.

[0065] Therefore, when the underwater robot moves along the pool wall, it obtains the distance characteristic data between the underwater robot and the pool wall through at least two preset sensors, and uses the distance characteristic data to eliminate errors in the navigation data of the underwater robot to obtain error-corrected navigation characteristic data.

[0066] FIG5 shows another flowchart of the mapping method according to an exemplary embodiment of the present application.

[0067] Optionally, in step S400 , as shown in FIG5 , the underwater robot performs error elimination processing on the navigation data of the underwater robot based on the distance characteristic data to obtain navigation characteristic data, which may also include steps S410 - S450 .

[0068] In step S410 , the underwater robot determines the initial movement point of the underwater robot as the origin.

[0069] In step S420, the underwater robot determines a first distance characteristic vector of the origin based on the origin distance characteristic data acquired by at least two preset sensors.

[0070] Optionally, at least two preset sensors are ultrasonic radar ranging sensors.

[0071] For example, as shown in FIG3 , the underwater robot M determines the initial movement point A of the underwater robot M as the origin, and starts to move along the wall of the swimming pool from the origin A. The underwater robot M obtains first distance feature data L1 and second distance feature data L2 of the origin A based on preset sensors on the underwater robot M body, such as the first distance sensor on the side of the body and the second distance sensor at the front of the body, and determines the first distance feature vector D of the origin A based on the first distance feature data L1 and the second distance feature data L2. a (L1, L2).

[0072] In step S430, the underwater robot obtains distance characteristic data of a moving point at a second preset distance from the origin based on at least two preset sensors, and determines a second distance characteristic vector of the moving point.

[0073] For example, as shown in FIG3 , when the underwater robot M moves along the swimming pool wall N according to the motion path shown in FIG3 to the motion point B, the distance between the motion point B and the origin A is the second preset distance Lb. For example, the second preset distance Lb is preset based on actual needs, such as 10 cm.

[0074] The underwater robot M obtains the third distance characteristic data L3 and the fourth distance characteristic data L4 of the moving point B based on the preset sensors on the underwater robot M, such as the first distance measuring sensor on the side of the body and the second distance measuring sensor at the front of the body, and determines the second distance characteristic vector D of the moving point B based on the third distance characteristic data L3 and the fourth distance characteristic data L4. b (L3, L4).

[0075] In step S440, the underwater robot performs error correction on the navigation data according to the first distance characteristic vector and the second distance characteristic vector.

[0076] For example, the underwater robot adjusts its position by controlling the movement of the underwater robot at the moving point B so that the second distance characteristic vector D of the moving point B is b (L3, L4) is equal to the first distance feature vector D a(L1, L2), that is, the underwater robot controls its movement to adjust the value of L3 at moving point B to L1, and the value of L4 at moving point B to L2. This allows the underwater robot's navigation to complete error correction, allowing the underwater robot to accurately return to its initial starting position, that is, origin A.

[0077] In step S450, the underwater robot generates navigation feature data according to the corrected navigation data.

[0078] According to an example embodiment, the underwater robot moves along a planned path under the guidance of navigation data. However, deviations in the navigation path caused by factors such as inevitable slipping during movement may prevent the underwater robot from accurately returning to its starting point. This may cause the swimming pool environment scanned by the underwater robot to be an incomplete and enclosed underwater environment, thereby resulting in inaccurate mapping.

[0079] Through the above example embodiments, when the underwater robot is about to circle the swimming pool and is a certain distance away from the origin, the distance characteristic vector is determined through the distance characteristic data collected by the preset sensor on the underwater robot. By adjusting the distance characteristic vector to be the same as the origin, the underwater robot can be controlled to accurately return to the origin according to the corrected navigation data.

[0080] The underwater robot records the corrected navigation data and generates navigation feature data after the underwater robot circles the swimming pool wall based on the corrected navigation data.

[0081] Optionally, in step S440, the underwater robot performs error correction on the navigation data based on the first distance characteristic vector and the second distance characteristic vector, which may include determining whether the error between the first distance characteristic vector and the second distance characteristic vector is greater than a first threshold value; if it is greater than the first threshold value, performing error correction on the navigation data based on the error amount between the first distance characteristic vector and the second distance characteristic vector; if it is not greater than the first threshold value, not performing error correction on the navigation data.

[0082] It can be understood here that if the error between the first distance characteristic vector and the second distance characteristic vector is greater than a first threshold, it indicates that the navigation offset of the underwater robot has exceeded the expected deviation, and error elimination processing is required for the navigation data of the underwater robot. For example, the first threshold can be set according to actual needs.

[0083] For example, if the difference between L3 in the second distance characteristic vector and the first distance characteristic vector L1 is greater than a first threshold, and / or the difference between L4 in the second distance characteristic vector and the first distance characteristic vector L2 is greater than the first threshold, then error elimination processing is required for the underwater robot's navigation data. That is, the underwater robot controls its body movement to adjust the second distance characteristic vector of moving point B to the first distance characteristic vector (L3 = L1, L4 = L2).

[0084] In the case that the error between the first distance characteristic vector and the second distance characteristic vector is smaller than the first threshold, there is no need to perform error elimination processing on the navigation data of the underwater robot.

[0085] According to an example embodiment, in step S500 , the underwater robot generates an environment feature map based on distance feature data and navigation feature data.

[0086] For example, after the underwater robot completes a circle around the wall of the swimming pool, the underwater robot can determine the characteristic map of the swimming pool wall based on the distance characteristic data obtained during the movement around the wall of the swimming pool and the corrected navigation characteristic data, thereby establishing an electronic map of the underwater robot's working environment.

[0087] For example, taking origin A as an example, the first distance feature data L1 of origin A is the distance between the side of the underwater robot and the pool wall, and the second distance feature data L2 of origin A is the distance between the front end of the underwater robot and the pool wall. Therefore, by combining the first and second distance feature data L1 and L2, as well as the navigation data at origin A, the underwater environment data at origin A can be obtained. Similarly, as the underwater robot moves along the pool wall, underwater environment data at each movement point is collected, thereby realizing underwater environment mapping.

[0088] For example, when it is determined based on the first distance feature vector and the second distance feature vector that the navigation data of the current moving point requires error correction, the underwater environment data of the moving point is generated by combining the error-corrected navigation data and the distance feature data at the moving point, thereby ensuring the accuracy of the underwater environment data and achieving accurate mapping.

[0089] According to the above embodiments, the present application collects distance feature data of the underwater environment through a low-cost ultrasonic radar ranging sensor, and obtains navigation feature data by performing error elimination processing on the underwater robot navigation data. The navigation feature data and distance feature data can be used to realize environmental mapping of underwater environments of arbitrary shapes.

[0090] According to another aspect of the present application, the present application provides a mapping system for an underwater robot, which can collect distance feature data of the underwater environment through a low-cost ultrasonic radar ranging sensor, and obtain navigation feature data by performing error elimination processing on the underwater robot navigation data. The navigation feature data and distance feature data can be used to realize environmental mapping of underwater environments of arbitrary shapes.

[0091] FIG6 shows a schematic structural diagram of a mapping system according to an exemplary embodiment of the present application. As shown in FIG6 , the mapping system 1 includes a position determination unit 10 , a motion management unit 20 and a data processing unit 30 .

[0092] According to an exemplary embodiment, the position determining unit 10 moves to the first pool wall that is shortest in distance from the underwater robot based on a preset algorithm, and maintains a first preset distance from the first pool wall.

[0093] For example, the underwater robot is placed into the swimming pool from any position according to the user's needs. After the underwater robot enters the bottom of the swimming pool and remains stationary, the position determination unit 10 initializes the current posture information (for example, initializes it to 0) and moves to the first pool wall that is shortest to the underwater robot based on a preset algorithm, thereby completing the automatic initial positioning of the underwater robot (i.e., completing the entry into the water-finding the nearest pool wall) process.

[0094] After the underwater robot enters the water, the position determination unit 10 automatically moves to the first pool wall closest to it according to a preset algorithm, and maintains a first preset distance La from the first pool wall. The specific size of the first preset distance La is related to the size of the underwater robot. The first preset distance La should be large enough to ensure that the underwater robot can smoothly complete operations such as rotation and movement at this distance without colliding with the pool wall.

[0095] Optionally, the position determination unit 10 controls the underwater robot to rotate in place by a preset angle based on the initial posture, obtains the distance between the attitude angle of the underwater robot and the pool wall during the rotation, and determines the shortest pool wall distance and the attitude angle corresponding to the shortest pool wall distance, and controls the underwater robot to move forward in a straight line based on the attitude angle until it maintains a first preset distance from the target pool wall.

[0096] For example, after the underwater robot completes entering the water, the position determination unit 10 controls the underwater robot to start at the initial position and rotate in place for one circle (360°), and measures the distance between the underwater robot and the surrounding pool wall based on the preset ranging sensor installed on the underwater robot body.

[0097] Optionally, the preset ranging sensor installed on the underwater robot can be an ultrasonic radar ranging sensor. The ultrasonic radar ranging sensor sends an ultrasonic signal to a target object and receives the ultrasonic signal reflected by the target object. The ultrasonic radar ranging sensor can measure the distance to the target object based on the time between the two ultrasonic signals.

[0098] While measuring the distance between the underwater robot and the surrounding pool wall, the position determination unit 10 also records the current attitude angle of the underwater robot and the attitude angle θ corresponding to a certain position i. i Distance from pool wall L i The array {θ i, L i}.

[0099] After the underwater robot rotates one circle in place, the position determination unit 10 obtains the attitude angle θ i Distance from pool wall L i The array {θ i, L i}, the position determination unit 10 determines the minimum pool wall distance L min , and the L min The position determination unit 10 controls the underwater robot to rotate in situ to adjust its attitude angle to θ, and uses this attitude angle as a control reference to keep moving forward in a straight line until it maintains a first preset distance La from the nearest pool wall (i.e., the first pool wall) (as shown in FIG3 ).

[0100] Optionally, after the underwater robot reaches the first pool wall, the underwater robot rotates itself to keep the body of the underwater robot parallel to the first pool wall.

[0101] Through the above exemplary embodiments, the position determination unit 10 automatically moves the underwater robot to the nearest pool wall through a preset algorithm, so that the underwater robot enters the mapping work site in the fastest way.

[0102] According to an exemplary embodiment, the motion management unit 20 controls the underwater robot to move along the pool wall starting from the first pool wall.

[0103] After automatically moving to the first pool wall closest to the robot, the motion management unit 20 controls the underwater robot to move along the pool wall at a first preset distance La. For example, the underwater robot moves around the pool wall along a path as indicated by the arrow in FIG3 .

[0104] When the underwater robot moves along the pool wall, the data processing unit 30 obtains characteristic data of the distance from the pool wall based on at least two preset sensors.

[0105] For example, the underwater robot may be provided with at least two preset sensors, such as a first ranging sensor and a second ranging sensor. The first ranging sensor may be provided on the side of the underwater robot to measure first characteristic distance data between the side of the robot and the pool wall, and the second ranging sensor may be provided on the front of the underwater robot to measure second characteristic distance data between the front of the robot and the pool wall.

[0106] As shown in Figure 3, the initial movement point of the underwater robot is point A, then the first distance characteristic data of point A is L1, and the second distance characteristic data of point A is L2. The underwater robot can determine the distance characteristic vector of point A as D based on the first distance characteristic data L1 and the second distance characteristic data L2. a (L1, L2).

[0107] The data processing unit 30 performs error elimination processing on the navigation data of the underwater robot based on the distance characteristic data to obtain navigation characteristic data.

[0108] According to example embodiments, the underwater robot will move according to preset navigation data. However, during actual navigation, the underwater robot will inevitably slip underwater due to the influence of the water environment, resulting in navigation errors. The long-term accumulation of errors can cause the underwater robot's actual positioning to change, making it unable to accurately return to its initial starting position after circumnavigating the pool, and thus preventing the underwater robot from completing a complete closed-loop mapping process.

[0109] Therefore, when the underwater robot moves along the pool wall, the data processing unit 30 obtains the distance characteristic data between the underwater robot and the pool wall through at least two preset sensors, and performs error elimination processing on the navigation data of the underwater robot through the distance characteristic data to obtain error-corrected navigation characteristic data.

[0110] Optionally, the data processing unit 30 determines the initial motion point of the underwater robot as the origin, determines the first distance characteristic vector of the origin based on the distance characteristic data of the origin obtained by at least two preset sensors, and determines the second distance characteristic vector of the motion point based on the distance characteristic data of the motion point at a second preset distance from the origin obtained by at least two preset sensors.

[0111] Optionally, at least two preset sensors are ultrasonic radar ranging sensors.

[0112] For example, as shown in FIG3 , the data processing unit 30 determines the initial movement point A of the underwater robot as the origin, and starts to move along the wall of the swimming pool from the origin A. The data processing unit 30 obtains the first distance feature data L1 and the second distance feature data L2 of the origin A based on the preset sensors on the underwater robot body, such as the first distance sensor on the side of the body and the second distance sensor at the front of the body, and determines the first distance feature vector D of the origin A based on the first distance feature data L1 and the second distance feature data L2. a (L1, L2).

[0113] When the underwater robot moves along the swimming pool wall according to the motion path shown in FIG3 to the motion point B, the distance between the motion point B and the origin A is the second preset distance Lb. For example, the second preset distance Lb is preset according to actual needs, such as 10 cm.

[0114] The data processing unit 30 obtains the third distance characteristic data L3 and the fourth distance characteristic data L4 of the moving point B based on the preset sensors on the underwater robot body, such as the first distance measuring sensor on the side of the body and the second distance measuring sensor at the front of the body, and determines the second distance characteristic vector D of the moving point B based on the third distance characteristic data L3 and the fourth distance characteristic data L4. b (L3, L4).

[0115] According to an example embodiment, the data processing unit 30 further performs error correction on the navigation data according to the first distance feature vector and the second distance feature vector, and generates navigation feature data according to the corrected navigation data.

[0116] The data processing unit 30 controls the underwater robot to move at the moving point B and adjusts the position of the underwater robot so that the second distance characteristic vector D of the moving point B is b (L3, L4) is equal to the first distance feature vector D a (L1, L2), that is, the underwater robot controls its movement to adjust the value of L3 at moving point B to L1, and the value of L4 at moving point B to L2. This allows the underwater robot's navigation to complete error correction, allowing the underwater robot to accurately return to its initial starting position, that is, origin A.

[0117] According to an example embodiment, the underwater robot moves along a planned path under the guidance of navigation data. However, deviations in the navigation path caused by factors such as inevitable slipping during movement may prevent the underwater robot from accurately returning to its starting point. This may cause the swimming pool environment scanned by the underwater robot to be an incomplete and enclosed underwater environment, thereby resulting in inaccurate mapping.

[0118] Through the above example embodiment, when the data processing unit 30 is about to circle the swimming pool and is a certain distance away from the origin, it determines the distance characteristic vector through the distance characteristic data collected by the preset sensor on the underwater robot. By adjusting the distance characteristic vector to be the same as the origin, the underwater robot can be controlled to accurately return to the origin according to the corrected navigation data.

[0119] The data processing unit 30 records the corrected navigation data, and generates navigation feature data after the underwater robot circles the swimming pool wall according to the corrected navigation data.

[0120] Optionally, the data processing unit 30 determines whether an error between the first distance characteristic vector and the second distance characteristic vector is greater than a first threshold. If the error between the first distance characteristic vector and the second distance characteristic vector is greater than the first threshold, the data processing unit performs error correction on the navigation data based on the error between the first distance characteristic vector and the second distance characteristic vector.

[0121] It can be understood here that if the error between the first distance characteristic vector and the second distance characteristic vector is greater than a first threshold, it indicates that the navigation offset of the underwater robot has exceeded the expected deviation, and error elimination processing is required for the navigation data of the underwater robot. For example, the first threshold can be set according to actual needs.

[0122] For example, if the difference between L3 in the second distance characteristic vector and the first distance characteristic vector L1 is greater than a first threshold, and / or the difference between L4 in the second distance characteristic vector and the first distance characteristic vector L2 is greater than the first threshold, then error elimination processing is required for the underwater robot's navigation data. That is, the underwater robot controls its body movement to adjust the second distance characteristic vector of moving point B to the first distance characteristic vector (L3 = L1, L4 = L2).

[0123] In the case that the error between the first distance characteristic vector and the second distance characteristic vector is smaller than the first threshold, there is no need to perform error elimination processing on the navigation data of the underwater robot.

[0124] According to an example embodiment, the data processing unit 30 generates an environment characteristic map based on the distance characteristic data and the navigation characteristic data.

[0125] For example, after the underwater robot completes a circle around the swimming pool wall, the data processing unit 30 can determine the characteristic map of the swimming pool wall based on the distance characteristic data and the corrected navigation characteristic data obtained during the movement around the swimming pool wall, thereby establishing an electronic map of the underwater robot's working environment.

[0126] For example, taking origin A as an example, the first distance feature data L1 of origin A is the distance between the side of the underwater robot and the pool wall, and the second distance feature data L2 of origin A is the distance between the front end of the underwater robot and the pool wall. Therefore, by combining the first and second distance feature data L1 and L2, as well as the navigation data at origin A, the underwater environment data at origin A can be obtained. Similarly, as the underwater robot moves along the pool wall, underwater environment data at each movement point is collected, thereby realizing underwater environment mapping.

[0127] For example, when it is determined based on the first distance feature vector and the second distance feature vector that the navigation data of the current moving point requires error correction, the underwater environment data of the moving point is generated by combining the error-corrected navigation data and the distance feature data at the moving point, thereby ensuring the accuracy of the underwater environment data and achieving accurate mapping.

[0128] According to the above embodiments, the present application collects distance feature data of the underwater environment through a low-cost ultrasonic radar ranging sensor, and obtains navigation feature data by performing error elimination processing on the underwater robot navigation data. The navigation feature data and distance feature data can be used to realize environmental mapping of underwater environments of arbitrary shapes.

[0129] According to another aspect of the present application, an underwater robot is provided, which includes the mapping system described above.

[0130] According to another aspect of the present application, a non-volatile computer-readable storage medium is provided, wherein a computer program is stored on the storage medium, and the computer program can implement the mapping method described above.

[0131] According to another aspect of the present application, an electronic device is provided. The electronic device includes one or more processors and a storage device, wherein the storage device is configured to store one or more programs. When the one or more programs are executed by the one or more processors, the one or more processors can implement the mapping method described above.

[0132] Finally, it should be noted that the above description is merely a preferred embodiment of the present application and is not intended to limit the present application. Although the present application is described in detail with reference to the aforementioned embodiments, those skilled in the art will be able to modify the technical solutions of the aforementioned embodiments or replace some of the technical features therein with equivalents. Any modifications, equivalent replacements, improvements, etc. made within the spirit and principles of the present application shall be included within the scope of protection of the present application.

Claims

1. A method for mapping an underwater robot, characterized in that: The mapping method comprises: Move to the first pool wall that is shortest to the underwater robot based on a preset algorithm, and maintain a first preset distance from the first pool wall; Starting from the first pool wall, move along the pool wall; In the process of moving along the pool wall, acquiring characteristic data of distance to the pool wall based on at least two preset sensors; performing error elimination processing on the navigation data of the underwater robot based on the distance characteristic data to obtain navigation characteristic data; An environmental feature map is generated based on the distance feature data and the navigation feature data.

2. The mapping method according to claim 1, characterized in that: The step of moving to the first pool wall which is shortest to the underwater robot based on a preset algorithm comprises: Rotate the preset angle in place based on the initial posture; Obtaining the distance between the attitude angle of the underwater robot and the pool wall during the rotation process; Determining the shortest pool wall distance and the attitude angle corresponding to the shortest pool wall distance; Move forward in a straight line with the attitude angle as a control reference until the first preset distance from the first pool wall is maintained.

3. The mapping method according to claim 1, characterized in that: The performing error elimination processing on the navigation data of the underwater robot based on the distance characteristic data to obtain the navigation characteristic data comprises: Determine the initial movement point of the underwater robot as the origin; Determine a first distance characteristic vector of the origin based on the distance characteristic data of the origin acquired by the at least two preset sensors; Acquiring distance characteristic data of a moving point at a second preset distance from the origin based on the at least two preset sensors, and determining a second distance characteristic vector of the moving point; performing error correction on the navigation data according to the first distance characteristic vector and the second distance characteristic vector; The navigation feature data is generated according to the corrected navigation data.

4. The mapping method according to claim 3, characterized in that: The performing error correction on the navigation data according to the first distance characteristic vector and the second distance characteristic vector comprises: Determining whether an error between the first distance feature vector and the second distance feature vector is greater than a first threshold; If yes, error correction is performed on the navigation data based on the error amount between the first distance characteristic vector and the second distance characteristic vector.

5. The mapping method according to claim 1, characterized in that: The preset sensor is an ultrasonic radar ranging sensor.

6. A mapping system for an underwater robot, characterized in that: The mapping system is used to execute the mapping method according to any one of claims 1 to 5, and the mapping system includes: A position determination unit, based on a preset algorithm, moves the underwater robot to a first pool wall that is shortest to the underwater robot, and maintains a first preset distance from the first pool wall; A motion management unit, controlling the underwater robot to move along the pool wall starting from the first pool wall; The data processing unit obtains distance characteristic data from the pool wall based on at least two preset sensors during the movement of the underwater robot along the pool wall, performs error elimination processing on the navigation data of the underwater robot based on the distance characteristic data to obtain navigation characteristic data, and generates a swimming pool environment characteristic map based on the distance characteristic data and the navigation characteristic data.

7. The mapping system according to claim 6, characterized in that: The position determination unit controls the underwater robot to rotate in situ by a preset angle based on the initial position, obtains the distance between the attitude angle of the underwater robot and the pool wall during the rotation, determines the shortest pool wall distance and the attitude angle corresponding to the shortest pool wall distance, and controls the underwater robot to move forward in a straight line with the attitude angle as a control reference until it maintains the first preset distance with the target pool wall.

8. The mapping system according to claim 6, characterized in that: The data processing unit determines the initial moving point of the underwater robot as the origin, determines a first distance characteristic vector of the origin based on the distance characteristic data of the origin acquired by the at least two preset sensors, and determines a second distance characteristic vector of the moving point based on the distance characteristic data of the moving point at a second preset distance from the origin acquired by the at least two preset sensors; The data processing unit further performs error correction on the navigation data according to the first distance characteristic vector and the second distance characteristic vector, and generates navigation characteristic data according to the corrected navigation data.

9. The mapping system according to claim 8, characterized in that: The data processing unit determines whether the error between the first distance feature vector and the second distance feature vector is greater than a first threshold; When the error between the first distance characteristic vector and the second distance characteristic vector is greater than a first threshold, the data processing unit performs error correction on the navigation data based on the error amount between the first distance characteristic vector and the second distance characteristic vector.

10. An underwater robot, characterized in that: The underwater robot comprises a mapping system as described in any one of claims 6-9.

11. A non-volatile computer-readable storage medium having a computer program stored thereon, characterized in that: The computer program implements the mapping method as described in any one of claims 1-5.

12. An electronic device, characterized in that: include: one or more processors; A storage device for storing one or more programs; When the one or more programs are executed by the one or more processors, the One or more processors implement the mapping method as described in any one of claims 1-5.

Citation Information

Patent Citations

  • Pool cleaner with laser range finder

    CN105308414A

  • Pool cleaner with laser range finder system and method

    CN108661362A

  • Robot obstacle avoidance method and device, robot and readable storage medium

    CN111258320A

  • Underwater robot and underwater robot navigation positioning method

    CN113108774A

  • Underwater robot path planning method based on ultrasonic radar and underwater robot

    CN115047893A