Robot deviation correction method based on TOF module and equipment thereof
Through the TOF module, the gap information is detected and the deviation correction command is generated, the travel skew problem caused by the frictional force of the photovoltaic panel cleaning robot is solved, the cleaning efficiency and equipment life are improved, and the cost is reduced.
Patent Information
- Application Number
- CN202411122080.8
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-15
- Publication Date
- 2024-11-26
AI Technical Summary
The travel skew caused by frictional force changes when the photovoltaic panel cleaning robot travels on the photovoltaic panel array affects the cleaning efficiency.
The TOF module is used to detect the gap information between the photovoltaic panels, generate a deviation correction command and send it to the driving device, adjust the direction of the robot to correct the deviation, and ensure cleaning along the preset direction.
Improves cleaning efficiency, reduces repeated cleaning and missing areas, extends equipment service life, and reduces manual adjustment and maintenance costs.
Smart Images

Figure CN119017379A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of cleaning equipment, and in particular to a robot deviation correction method and equipment based on a TOF module. Background Art
[0002] Photovoltaic power generation is a sustainable and renewable clean energy source. It requires a huge number of photovoltaic panels to form a solar cell array. If dust or snow adheres to the surface of the solar photovoltaic panel, it will affect the transmittance of light and reduce the efficiency of power generation; at the same time, dust will also reduce the power generation efficiency of the solar photovoltaic panel. If dust or snow is not removed in time, the power generation efficiency will be reduced. Therefore, keeping the solar photovoltaic panel clean is an effective way to ensure the power generation capacity of the photovoltaic power station, and it must be cleaned regularly.
[0003] Patent application number CN202220231220.5 discloses a suction cup walking mechanism, including: a main walking arm for adjusting the walking direction of the cleaning robot, two auxiliary walking arms for coordinating walking and maintaining the balance of the cleaning robot; the main walking arm includes a first suction cup, a first driving member for controlling the first suction cup to adsorb or move away from the photovoltaic panel, and a second driving member for controlling the cleaning robot to rotate around the first suction cup as a whole; the auxiliary walking arm includes a second suction cup, and a third driving member for controlling the second suction cup to adsorb or move away from the photovoltaic panel; the two second suction cups are arranged on both sides of the first suction cup one after the other; a laser sensor for detecting the outer frame of the photovoltaic panel is provided near the second suction cup on the auxiliary walking arm. Although it can ensure the stability and stability of the photovoltaic cleaning robot when it is used for cleaning photovoltaic panels, it does not take into account the photovoltaic panel cleaning robot slipping when walking on a large number of photovoltaic power generation panels (friction changes and other factors), causing deviation, which will affect the cleaning efficiency of the photovoltaic panel cleaning robot.
[0004] Therefore, there is an urgent need for a robot correction method and equipment based on a TOF module to solve the above technical problems. Summary of the invention
[0005] The present application provides a robot correction method and device based on a TOF module, which are used to solve the problem in the related technology that when a photovoltaic cleaning robot moves on a photovoltaic panel array, the movement is deviated due to factors such as changes in friction with the surface of the photovoltaic panel, thereby affecting the cleaning efficiency of the photovoltaic panel cleaning robot.
[0006] To achieve the above objectives, this application is implemented through the following technical solutions:
[0007] The present application provides a robot deviation correction method based on a TOF module, which is applicable to a photovoltaic panel cleaning robot. The photovoltaic panel cleaning robot comprises a robot body and a rotating cleaning component. The robot body is provided with a main suction cup, the rotating cleaning component is provided with an auxiliary suction cup, and a TOF module is provided around the auxiliary suction cup. When the main suction cup is fixed on the photovoltaic panel, the rotating cleaning component rotates around the main suction cup. The robot deviation correction method comprises:
[0008] Using the TOF module, obtaining gap detection information of the photovoltaic panel cleaning robot;
[0009] Based on the gap detection information, generating a robot correction instruction;
[0010] The robot deviation correction instruction is sent to the driving device of the robot body, so that the driving device corrects the photovoltaic panel cleaning robot according to the robot deviation correction instruction.
[0011] The beneficial effect of this technical solution is that, without adding the hardware setting of the sensor, the TOF module set near the auxiliary suction cup is reused for walking correction. The advantage is that, on the one hand, since no additional sensors are needed, the manufacturing and maintenance costs of the photovoltaic panel cleaning robot are reduced, and the hardware configuration is simplified; on the other hand, the use of the existing TOF module for correction saves space, making the photovoltaic panel cleaning robot more compact, which helps to achieve more efficient cleaning operations in a limited space; on the other hand, through real-time correction, the photovoltaic panel cleaning robot can keep walking in a straight line as much as possible, reducing repeated cleaning or missing areas caused by deviation, thereby improving cleaning efficiency. The correction mechanism ensures that the robot can avoid areas missed due to deviation and ensures comprehensive cleaning of the photovoltaic panel; on the other hand, the automated correction reduces the need for manual adjustment, reduces labor costs and maintenance difficulties; by reducing the additional wear caused by deviation, the service life of the photovoltaic panel cleaning robot can be effectively extended, and keeping the photovoltaic panel clean can improve the efficiency of photovoltaic power generation.
[0012] Preferably, the gap detection information includes first angle data and second angle data when the gap between the TOF module and the photovoltaic panel intersects within the same rotation cycle of the rotating cleaning component; and generating the robot correction instruction based on the gap detection information includes:
[0013] Based on the first angle data, the second angle data and the position information of the photovoltaic panel cleaning robot, determining whether the angle difference between the traveling direction of the photovoltaic panel cleaning robot and the preset direction is greater than a preset difference value;
[0014] When the difference is not greater than the preset difference, the robot deviation correction instruction is not to adjust the traveling direction of the photovoltaic panel cleaning robot;
[0015] Otherwise, a robot correction instruction is generated according to the angle difference between the traveling direction and the preset direction.
[0016] The beneficial effect of this technical solution is that by combining angle data and position information, it is possible to more accurately determine whether the robot needs to be corrected, thereby improving the accuracy of the correction. Ensure that the robot always moves along the preset cleaning direction, avoid invalid movement and repeated cleaning, and improve cleaning efficiency. Accurate correction reduces additional movement caused by deviation, thereby reducing energy consumption. Correction is only performed when it fully meets the requirements, reducing mechanical wear caused by frequent correction and adjustment, and extending the service life of the photovoltaic panel cleaning robot. In summary, through precise data collection and intelligent correction logic, not only the working performance of the photovoltaic panel cleaning robot is improved, but also energy consumption can be reduced and the life of the equipment can be extended.
[0017] Preferably, the robot body is provided with a code disk for recording the rotation angle of the rotating cleaning component, and the first angle data and the second angle data are obtained in a manner including:
[0018] When the TOF module detects the crack for the first time, the angle data of the code disk is used as the first angle data; when the TOF module detects the crack again, the angle data of the code disk is used as the second angle data.
[0019] The beneficial effect of this technical solution is that the use of a code disk to record the rotation angle provides high-precision angle data, which helps to accurately determine the position and direction of travel of the robot. The use of the TOF module in conjunction with the code disk simplifies the data acquisition process and reduces the reliance on additional sensors. The rapid and accurate acquisition of angle data enables rapid response and generation of deviation correction instructions, which improves the response speed of deviation correction. Accurate deviation correction instructions help maintain the stability of the robot and reduce the decrease in cleaning efficiency caused by deviation.
[0020] Preferably, the rotating cleaning assembly includes a first rotating cleaning arm and a second rotating cleaning arm which are symmetrically arranged with respect to the rotation center of the robot body, and auxiliary suction cups and TOF modules are symmetrically arranged on the first rotating cleaning arm and the second rotating cleaning arm, respectively; the gap detection information includes a plurality of angle data groups, each of which includes first angle data, second angle data and identification information of the first rotating cleaning arm or the second rotating cleaning arm when the corresponding TOF module intersects the gap between the photovoltaic panel within the same rotation cycle of the first rotating cleaning arm or the second rotating cleaning arm;
[0021] When the angle difference between the traveling direction of the photovoltaic panel cleaning robot and the preset direction is not greater than a preset difference value for N consecutive times, the method further includes:
[0022] The gap detection information is sent to a cloud server, and the cloud server is used to obtain a travel stability score of the photovoltaic panel cleaning robot according to the gap detection information, and to determine whether the travel stability score meets a preset alarm condition, wherein the travel stability score is used to indicate a trend of a travel direction change of the photovoltaic panel cleaning robot;
[0023] When the preset alarm conditions are met, the cloud server is used to generate stability alarm information and send it to the user device; N is a positive integer greater than 3.
[0024] The beneficial effect of this technical solution is that by continuously detecting and evaluating the direction of travel of the photovoltaic panel cleaning robot, deviations can be discovered and corrected in a timely manner, thereby improving the stability of the cleaning robot. By using the cloud server to remotely analyze and process data, users can receive stability alarm information of the photovoltaic panel cleaning robot through user devices at any location. The photovoltaic panel cleaning robot does not need to maintain a communication connection with the cloud server all the time. It is only necessary to establish a communication connection between the photovoltaic panel cleaning robot and the cloud server when the results of N consecutive detections show that the angle difference is not greater than the preset difference, thereby saving electricity consumption of the photovoltaic panel cleaning robot. At the same time, the calculation process of the gap detection information is performed on the cloud server, reducing the computing power and hardware requirements for the photovoltaic panel cleaning robot. Through the travel stability scoring and alarm mechanism, users can discover potential stability problems in advance and implement preventive maintenance.
[0025] Preferably, obtaining the traveling stability score of the photovoltaic panel cleaning robot according to the gap detection information, and judging whether the traveling stability score meets the preset alarm condition, comprises:
[0026] Inputting the gap detection information into a stability scoring model to obtain a traveling stability score of the photovoltaic panel cleaning robot;
[0027] It is determined whether the traveling stability score is within a preset stability threshold. When it is not within the stability threshold, it is considered that the traveling stability score meets the preset alarm condition.
[0028] Preferably, the training process of the stability scoring model is:
[0029] Acquire a training set, the training set comprising a plurality of training data, each of the training data comprising a set of gap detection information and annotated data of a preset score corresponding to the gap detection information;
[0030] For each training data in the training set, perform the following processing:
[0031] Inputting the gap detection information in the training data into a preset deep learning model to obtain prediction data of a preset score corresponding to the gap detection information;
[0032] Based on the prediction data and the annotation data of the preset scores corresponding to the gap detection information, the model parameters of the deep learning model are updated;
[0033] Check whether the preset training end condition is met; if so, use the trained deep learning model as the stability scoring model; if not, continue to train the deep learning model using the next training data.
[0034] The beneficial effect of this technical solution is that, by designing, establishing an appropriate amount of neuron computing nodes and a multi-layer operation hierarchy, and selecting appropriate input layers and output layers, a preset deep learning model can be obtained. Through the learning and tuning of the deep learning model, a functional relationship from input to output is established. Although the functional relationship between input and output cannot be found 100%, the actual correlation relationship can be approached as much as possible. The stability scoring model thus trained can obtain corresponding output data based on the input data. It has a wide range of applications, and the calculation results are highly accurate and reliable.
[0035] The present application also provides an electronic device, comprising one or more processors and a memory; one or more programs are stored in the memory and are configured so that the one or more processors execute any of the above-mentioned methods.
[0036] The present application also provides an electronic device, the photovoltaic panel cleaning robot comprises: the electronic device mentioned above, a robot body and a rotating cleaning component; a main suction cup is provided on the robot body; an auxiliary suction cup is provided on the rotating cleaning component, and a TOF module is provided around the auxiliary suction cup; when the main suction cup is fixed on the photovoltaic panel, the rotating cleaning component rotates around the main suction cup.
[0037] Preferably, the TOF module includes a TOF laser sensor.
[0038] Preferably, the rotary cleaning assembly comprises a first rotary cleaning arm and a second rotary cleaning arm which are symmetrically arranged with respect to the rotation center of the robot body, and an auxiliary suction cup and a TOF module are symmetrically arranged on the first rotary cleaning arm and the second rotary cleaning arm, respectively. BRIEF DESCRIPTION OF THE DRAWINGS
[0039] The present application is further described below in conjunction with the accompanying drawings and embodiments.
[0040] Figure 1A schematic flow chart of a robot deviation correction method provided in an embodiment of the present application is shown.
[0041] Figure 2 A structural block diagram of a photovoltaic panel cleaning robot provided in an embodiment of the present application is shown.
[0042] Figure 3 A schematic structural diagram of an electronic device provided in an embodiment of the present application is shown.
[0043] Figure 4 A schematic structural diagram of a photovoltaic panel cleaning robot provided in an embodiment of the present application is shown. DETAILED DESCRIPTION
[0044] In order to facilitate the understanding of the present invention, the present invention will be described more fully below with reference to the relevant drawings. Preferred embodiments of the present invention are provided in the drawings. However, the present invention can be implemented in many other different forms and is not limited to the embodiments described herein. On the contrary, the purpose of providing these embodiments is to make the understanding of the disclosure of the present invention more thorough and comprehensive.
[0045] Unless otherwise defined, all technical and scientific terms used herein have the same meaning as those commonly understood by those skilled in the art of the present invention. The terms used herein in the specification of the present invention are only for the purpose of describing specific embodiments and are not intended to limit the present invention. The term "and / or" used herein includes any and all combinations of one or more related listed items.
[0046] The present application provides a robot deviation correction method and device based on a TOF module, taking into account the problem that when a photovoltaic cleaning robot moves on a photovoltaic panel array, the movement deflection caused by factors such as changes in friction with the surface of the photovoltaic panel affects the cleaning efficiency of the photovoltaic panel cleaning robot. The present application is directed to a photovoltaic panel cleaning robot including a rotating cleaning component containing an auxiliary suction cup, and uses an existing TOF module for deviation correction to solve the above problem. The following will first describe the robot deviation correction method, and then describe the device and system.
[0047] Method embodiment.
[0048] See also Figure 1 and Figure 2 , Figure 1 A schematic flow chart of a robot deviation correction method provided in an embodiment of the present application is shown. Figure 2 A structural block diagram of a photovoltaic panel cleaning robot provided in an embodiment of the present application is shown.
[0049] This embodiment provides a robot deviation correction method based on a TOF module, which is applicable to a photovoltaic panel cleaning robot. The photovoltaic panel cleaning robot includes a robot body and a rotating cleaning component. The robot body is provided with a main suction cup, and the rotating cleaning component is provided with an auxiliary suction cup. A TOF module is provided around the auxiliary suction cup. When the main suction cup is fixed on the photovoltaic panel, the rotating cleaning component rotates around the main suction cup. The robot deviation correction method includes:
[0050] S101, using the TOF module to obtain gap detection information of the photovoltaic panel cleaning robot;
[0051] S102, generating a robot correction instruction based on the gap detection information;
[0052] S103, sending the robot deviation correction instruction to the driving device of the robot body, so that the driving device corrects the photovoltaic panel cleaning robot according to the robot deviation correction instruction.
[0053] When the photovoltaic panel cleaning robot performs cleaning action, the main suction cup on the robot body is first fixed on the surface of the photovoltaic panel to ensure the stable adsorption of the photovoltaic panel cleaning robot. The rotating cleaning component rotates around the center of the main suction cup to clean the photovoltaic panel. The auxiliary suction cup is located on the rotating cleaning component to help the photovoltaic panel cleaning robot move on adjacent photovoltaic panels. The TOF module arranged around the auxiliary suction cup can be used to detect the gap between photovoltaic panels. Specifically, the TOF module measures the distance between the robot and the photovoltaic panel by emitting and receiving reflected light waves, thereby obtaining the detection information of the gap. According to the gap detection information obtained by the TOF module, the position and angle of the robot relative to the photovoltaic panel frame are analyzed to determine whether there is a deviation. Once the deviation is detected, a correction instruction is generated and sent to the driving device of the robot body, and the driving device is, for example, a motor and its transmission device. The driving device adjusts the walking direction or speed of the robot according to the correction instruction to correct the deviation, ensure that the robot walks in the straight direction of the frame of the photovoltaic panel, and improve the linearity and coverage during cleaning.
[0054] In the related art, taking the suction cup walking mechanism disclosed in patent application number CN202220231220.5 as an example, the laser sensor provided therein is used to prevent the suction cup from being adsorbed on the outer frame of the photovoltaic panel, thereby ensuring the stability and efficiency of fixed adsorption. In the present application, without adding the hardware setting of the sensor, the TOF module provided near the auxiliary suction cup is reused for traveling correction. The advantage is that, on the one hand, since no additional sensors are required, the manufacturing and maintenance costs of the photovoltaic panel cleaning robot are reduced, while the hardware configuration is simplified; on the other hand, the existing TOF module is used for correction, which saves space and makes the photovoltaic panel cleaning machine The more compact design helps to achieve more efficient cleaning operations in a limited space; on the other hand, through real-time correction, the photovoltaic panel cleaning robot can keep walking in a straight line as much as possible, reducing repeated cleaning or missed areas due to deviation, thereby improving cleaning efficiency. At the same time, the correction mechanism ensures that the robot can avoid areas missed due to deviation, ensuring comprehensive cleaning of the photovoltaic panels; on the other hand, automated correction reduces the need for manual adjustment, reducing labor costs and maintenance difficulty; by reducing the additional wear caused by deviation, the service life of the photovoltaic panel cleaning robot can be effectively extended, and keeping the photovoltaic panels clean can improve the efficiency of photovoltaic power generation.
[0055] Wherein, generating a robot deviation correction instruction according to the angle difference between the traveling direction and the preset direction may include:
[0056] Design and program the correction logic, which will determine the magnitude and direction of the correction based on the size and direction of the angle difference. Generate correction instructions based on the correction logic. The correction instructions will instruct the robot to adjust its direction of travel to reduce the angle difference. Send the correction instructions to the robot's control system, which adjusts the drive device (such as the motor) according to the instructions to change the robot's direction of travel.
[0057] In some embodiments, the gap detection information includes first angle data and second angle data when the gap between the TOF module and the photovoltaic panel intersects within the same rotation cycle of the rotating cleaning component; and generating a robot correction instruction based on the gap detection information includes:
[0058] Based on the first angle data, the second angle data and the position information of the photovoltaic panel cleaning robot, determining whether the angle difference between the traveling direction of the photovoltaic panel cleaning robot and the preset direction is greater than a preset difference value;
[0059] When the difference is not greater than the preset difference, the robot deviation correction instruction is not to adjust the traveling direction of the photovoltaic panel cleaning robot;
[0060] Otherwise, a robot correction instruction is generated according to the angle difference between the traveling direction and the preset direction.
[0061] In one rotation cycle of the rotating cleaning component, the TOF module will intersect with the gap between the photovoltaic panels, and record the first angle data and the second angle data. The first angle data and the second angle data reflect the position change of the TOF module relative to the photovoltaic panel during the rotation process. The position information of the photovoltaic panel cleaning robot may include the absolute position of the photovoltaic panel cleaning robot relative to the photovoltaic panel array or the relative position relative to the starting point. According to the position information, the distance between the center of the main suction cup of the photovoltaic panel cleaning robot in an ideal state (without deviation) and the gap corresponding to the gap detection information can be obtained. The angle difference between the actual direction of travel and the angle of the gap of the photovoltaic panel cleaning robot and the angle of the preset direction of travel and the gap can be calculated. The calculated angle difference will be compared with the preset correction threshold to determine whether the robot has deviated from the predetermined path. Generally speaking, the angle between the preset direction of travel and the gap is 90 degrees. If the angle difference is not greater than the preset threshold, the generated correction instruction is to keep the current direction of travel unchanged. If the angle difference is greater than the preset threshold, a correction instruction will be generated according to the actual angle difference to instruct the robot to adjust the direction of travel. The correction instruction is sent to the drive device of the robot body, and the drive device adjusts the robot's direction of travel according to the instruction to correct the deviation.
[0062] Therefore, by combining angle data and position information, it is possible to more accurately determine whether the robot needs to be corrected, thereby improving the accuracy of correction. Ensure that the robot always moves along the preset cleaning direction, avoid invalid movement and repeated cleaning, and improve cleaning efficiency. Accurate correction reduces additional movement caused by deviation, thereby reducing energy consumption. Correction is only performed when it fully meets the requirements, reducing mechanical wear caused by frequent correction and adjustment, and extending the service life of the photovoltaic panel cleaning robot.
[0063] In summary, through precise data collection and intelligent correction logic, not only the working performance of the photovoltaic panel cleaning robot is improved, but also energy consumption can be reduced and the life of the equipment can be extended.
[0064] The position information of the photovoltaic panel cleaning robot can be obtained by using a GPS receiver disposed in the robot body; or by using an inertial measurement unit (IMU) disposed in the robot body through calculation. The inertial measurement unit (IMU) is a sensor used in a robot system to provide accurate information about the robot's motion state. The IMU can measure the acceleration of the robot, and the position of the robot can be estimated through acceleration and other data. This application does not limit the method of obtaining the position information.
[0065] In some embodiments, the robot body is provided with a code disk for recording the rotation angle of the rotating cleaning component, and the first angle data and the second angle data are obtained by:
[0066] When the TOF module detects the crack for the first time, the angle data of the code disk is used as the first angle data; when the TOF module detects the crack again, the angle data of the code disk is used as the second angle data.
[0067] A code disc is installed on the robot body to record the rotation angle of the rotating cleaning component. Among them, the code disc is a position detection device that can provide accurate angle readings. The TOF module is installed near the auxiliary suction cup to detect the gap between the photovoltaic panels. When the TOF module detects the gap for the first time, the angle data of the code disc at this time is recorded and defined as the first angle data. As the rotating cleaning component continues to rotate, the same TOF module will intersect with the gap of the photovoltaic panel again. When the TOF module detects the gap for the second time, the angle data of the code disc is recorded again and defined as the second angle data. The acquired first angle data and second angle data are compared and analyzed with the position information to determine whether the photovoltaic panel cleaning robot needs to be corrected.
[0068] Therefore, using a code disk to record the rotation angle provides high-precision angle data, which helps to accurately determine the position and direction of the robot. The use of the TOF module and the code disk simplifies the data acquisition process and reduces the reliance on additional sensors. Quickly and accurately acquiring angle data enables rapid response and generation of correction instructions, which improves the response speed of correction. Accurate correction instructions help maintain the stability of the robot and reduce the decrease in cleaning efficiency caused by deviation.
[0069] In some embodiments, the rotating cleaning assembly includes a first rotating cleaning arm and a second rotating cleaning arm symmetrically arranged with respect to the rotation center of the robot body, and auxiliary suction cups and TOF modules are symmetrically arranged on the first rotating cleaning arm and the second rotating cleaning arm, respectively; the gap detection information includes a plurality of angle data groups, each of which includes first angle data, second angle data and identification information of the first rotating cleaning arm or the second rotating cleaning arm when the corresponding TOF module intersects the gap between the photovoltaic panel within the same rotation cycle of the first rotating cleaning arm or the second rotating cleaning arm;
[0070] When the angle difference between the traveling direction of the photovoltaic panel cleaning robot and the preset direction is not greater than a preset difference value for N consecutive times, the method further includes:
[0071] The gap detection information is sent to a cloud server, and the cloud server is used to obtain a travel stability score of the photovoltaic panel cleaning robot according to the gap detection information, and to determine whether the travel stability score meets a preset alarm condition, wherein the travel stability score is used to indicate a trend of a travel direction change of the photovoltaic panel cleaning robot; the travel stability score is, for example, in the form of 100 points, 80 points, A, B+, A, B, C, D, etc., and the preset alarm condition is, for example, a score not greater than 80 points, not greater than B+, etc.;
[0072] When the preset alarm conditions are met, the cloud server is used to generate stability alarm information and send it to the user device; N is a positive integer greater than 3. N is, for example, 4, 5, 7, 8, etc. The cloud server can provide computing resources and data storage services through the Internet. The cloud server and the user device can be connected through a 4G network, a 5G network, etc. The user device is, for example, a mobile phone, a tablet, a laptop computer, and the stability alarm information is, for example, text information, picture information, etc. in the form of text messages, emails, or pop-up windows.
[0073] The rotary cleaning assembly consists of a symmetrically arranged first rotary cleaning arm and a second rotary cleaning arm. Each cleaning arm is provided with an auxiliary suction cup and a TOF module. The symmetrical design helps the photovoltaic panel cleaning robot to achieve a balanced cleaning action on the photovoltaic panel. During the rotation of the rotary cleaning arm, the TOF module detects the gap between the photovoltaic panels and records multiple angle data groups. The angle difference between the traveling direction of the photovoltaic panel cleaning robot and the preset direction can be detected N times in a row (N is a positive integer greater than 3) to evaluate the stability of the robot's travel. When the results of N consecutive detections show that the angle difference is not greater than the preset difference, the gap detection information is sent to the cloud server. The cloud server calculates and generates the travel stability score of the photovoltaic panel cleaning robot based on the received gap detection information. The travel stability score reflects the trend of the change in the travel direction of the photovoltaic panel cleaning robot. The cloud server determines whether the travel stability score meets the preset alarm conditions. If the score indicates that there is a problem with the robot's travel stability, the cloud server will generate a stability alarm message. The stability alarm information will be sent to the user's device to remind the user to pay attention to the travel stability of the photovoltaic panel cleaning robot so that the user can take corresponding maintenance or adjustment measures.
[0074] Therefore, by continuously detecting and evaluating the direction of travel of the photovoltaic panel cleaning robot, deviations can be discovered and corrected in time, thereby improving the stability of the cleaning robot. By using the cloud server to remotely analyze and process data, users can receive stability alarm information of the photovoltaic panel cleaning robot through user devices at any location. The photovoltaic panel cleaning robot does not need to maintain a communication connection with the cloud server all the time. It is only necessary to establish a communication connection between the photovoltaic panel cleaning robot and the cloud server when the results of N consecutive detections show that the angle difference is not greater than the preset difference, thereby saving electricity consumption of the photovoltaic panel cleaning robot. At the same time, the calculation process of the gap detection information is performed on the cloud server, reducing the computing power and hardware requirements of the photovoltaic panel cleaning robot. The communication connection method is, for example, 4G, 5G, etc., which is not restricted by this application. Through the travel stability scoring and alarm mechanism, users can discover potential stability problems in advance and achieve preventive maintenance.
[0075] In some embodiments, obtaining the traveling stability score of the photovoltaic panel cleaning robot according to the gap detection information, and determining whether the traveling stability score meets a preset alarm condition includes:
[0076] Inputting the gap detection information into a stability scoring model to obtain a traveling stability score of the photovoltaic panel cleaning robot;
[0077] It is determined whether the traveling stability score is within a preset stability threshold. When it is not within the stability threshold, it is considered that the traveling stability score meets the preset alarm condition.
[0078] The training process of the stability scoring model is, for example:
[0079] Acquire a training set, the training set comprising a plurality of training data, each of the training data comprising a set of gap detection information and annotated data of a preset score corresponding to the gap detection information;
[0080] For each training data in the training set, perform the following processing:
[0081] Inputting the gap detection information in the training data into a preset deep learning model to obtain prediction data of a preset score corresponding to the gap detection information;
[0082] Based on the prediction data and the annotation data of the preset scores corresponding to the gap detection information, the model parameters of the deep learning model are updated;
[0083] Check whether the preset training end condition is met; if so, use the trained deep learning model as the stability scoring model; if not, continue to train the deep learning model using the next training data.
[0084] Therefore, by designing, establishing an appropriate amount of neuron computing nodes and a multi-layer operation hierarchy, and selecting appropriate input and output layers, a preset deep learning model can be obtained. Through the learning and tuning of the deep learning model, a functional relationship from input to output is established. Although the functional relationship between input and output cannot be found 100%, the actual correlation relationship can be approached as much as possible. The stability scoring model trained in this way can obtain the corresponding output data based on the input data. It has a wide range of applications, and the calculation results are highly accurate and reliable.
[0085] As an example, a robot deviation correction method is provided, which is applicable to a photovoltaic panel cleaning robot, wherein the photovoltaic panel cleaning robot comprises a robot body and a rotating cleaning component, wherein a main suction cup is provided on the robot body, an auxiliary suction cup is provided on the rotating cleaning component, and a TOF module is provided around the auxiliary suction cup; when the main suction cup is fixed on the photovoltaic panel, the rotating cleaning component rotates around the main suction cup;
[0086] The rotating cleaning assembly includes a first rotating cleaning arm and a second rotating cleaning arm symmetrically arranged with respect to the rotation center of the robot body, and auxiliary suction cups and TOF modules are symmetrically arranged on the first rotating cleaning arm and the second rotating cleaning arm, respectively; the gap detection information includes a plurality of angle data groups, each of which includes the first angle data, the second angle data and the identification information of the first rotating cleaning arm or the second rotating cleaning arm when the corresponding TOF module intersects the gap between the photovoltaic panel within the same rotation cycle of the first rotating cleaning arm or the second rotating cleaning arm; the robot body is provided with a code disk for recording the rotation angle of the rotating cleaning assembly. The robot deviation correction method includes:
[0087] When the TOF module detects the crack for the first time, the angle data of the code disk is used as the first angle data; when the TOF module detects the crack again, the angle data of the code disk is used as the second angle data, thereby obtaining the crack detection information composed of multiple angle data groups;
[0088] Based on the first angle data, the second angle data and the position information of the photovoltaic panel cleaning robot of the current angle data group, determining whether the angle difference between the traveling direction of the photovoltaic panel cleaning robot and the preset direction is greater than a preset difference value;
[0089] When the difference is not greater than the preset difference, the robot deviation correction instruction is not to adjust the traveling direction of the photovoltaic panel cleaning robot;
[0090] Otherwise, generating a robot deviation correction instruction according to the angle difference between the traveling direction and the preset direction;
[0091] The robot deviation correction instruction is sent to the driving device of the robot body, so that the driving device corrects the photovoltaic panel cleaning robot according to the robot deviation correction instruction.
[0092] When the angle difference between the traveling direction of the photovoltaic panel cleaning robot and the preset direction is not greater than a preset difference value for N consecutive times, the method further includes:
[0093] The gap detection information is sent to a cloud server, and the cloud server inputs the gap detection information into a stability scoring model according to the gap detection information to obtain a travel stability score of the photovoltaic panel cleaning robot;
[0094] Determine whether the travel stability score is within a preset stability threshold, and when it is not within the stability threshold, it is considered that the travel stability score meets the preset alarm condition, and the travel stability score is used to indicate the trend of the travel direction change of the photovoltaic panel cleaning robot;
[0095] When the preset alarm conditions are met, the cloud server is used to generate stability alarm information and send it to the user device; N is a positive integer greater than 3.
[0096] The training process of the stability scoring model is as follows:
[0097] Acquire a training set, the training set comprising a plurality of training data, each of the training data comprising a set of gap detection information and annotated data of a preset score corresponding to the gap detection information;
[0098] For each training data in the training set, perform the following processing:
[0099] Inputting the gap detection information in the training data into a preset deep learning model to obtain prediction data of a preset score corresponding to the gap detection information;
[0100] Based on the prediction data and the annotation data of the preset scores corresponding to the gap detection information, the model parameters of the deep learning model are updated;
[0101] Check whether the preset training end condition is met; if so, use the trained deep learning model as the stability scoring model; if not, continue to train the deep learning model using the next training data.
[0102] Electronic device embodiments.
[0103] This embodiment provides an electronic device, which includes a memory and a processor, wherein the memory stores a computer program, and the processor is configured to implement the steps of the robot correction method described in any one of the method embodiments when executing the computer program.
[0104] See also Figure 3 , Figure 3 A schematic structural diagram of an electronic device provided in an embodiment of the present application is shown.
[0105] The electronic device may include, for example, at least one memory 11, at least one processor 12, and a bus 13 connecting different platform systems.
[0106] The memory 11 may include a readable medium in the form of a volatile memory, such as a random access memory (RAM) 111 and / or a cache memory 112 , and may further include a read-only memory (ROM) 113 .
[0107] The memory 11 also stores a computer program, which can be executed by the processor 12 so that the processor 12 implements the steps of any of the above methods.
[0108] The memory 11 may also include a utility 114 having at least one program module 115, such program module 115 including but not limited to: an operating system, one or more application programs, other program modules and program data, each of which or some combination may include the implementation of a network environment.
[0109] Accordingly, the processor 12 may execute the above-mentioned computer program, and may execute the utility 114 .
[0110] The processor 12 may adopt one or more application specific integrated circuits (ASICs), DSPs, programmable logic devices (PLDs), complex programmable logic devices (CPLDs), field programmable gate arrays (FPGAs), or other electronic components.
[0111] Bus 13 may represent one or more of several types of bus structures, including a memory bus or memory controller, a peripheral bus, an accelerated graphics port, a processor or a local bus using any of a variety of bus architectures.
[0112] The electronic device may also communicate with one or more external devices 14 such as a keyboard, a pointing device, a Bluetooth device, etc., and may also communicate with one or more devices that can interact with the electronic device, and / or communicate with any device (such as a router, a modem, etc.) that enables the electronic device to communicate with one or more other computing devices. Such communication may be performed through an input / output interface 15. In addition, the electronic device may also communicate with one or more networks (such as a local area network (LAN), a wide area network (WAN) and / or a public network, such as the Internet) through a network adapter 16. The network adapter 16 may communicate with other modules of the electronic device through the bus 13. It should be understood that, although not shown in the figure, other hardware and / or software modules may be used in conjunction with the electronic device in actual applications, including but not limited to: microcode, device drivers, redundant processors, external disk drive arrays, RAID systems, tape drives, and data backup storage platforms.
[0113] System Embodiments.
[0114] See also Figure 4 , Figure 4 A schematic diagram of the structure of a photovoltaic panel cleaning robot provided in an embodiment of the present application is shown. An embodiment of the present application provides a photovoltaic panel cleaning robot, the photovoltaic panel cleaning robot comprising: the electronic device, robot body and rotating cleaning component described in the device embodiment; a main suction cup is provided on the robot body; an auxiliary suction cup is provided on the rotating cleaning component, and a TOF module is provided around the auxiliary suction cup; when the main suction cup is fixed to the photovoltaic panel, the rotating cleaning component rotates around the main suction cup. The specific implementation method of the photovoltaic panel cleaning robot is consistent with the implementation method and the technical effect achieved in the embodiment of the above method, and some contents will not be repeated.
[0115] In some embodiments, the rotary cleaning assembly includes a first rotary cleaning arm and a second rotary cleaning arm symmetrically arranged with respect to the rotation center of the robot body, and an auxiliary suction cup and a TOF module are symmetrically arranged on the first rotary cleaning arm and the second rotary cleaning arm, respectively.
[0116] The rotary cleaning assembly consists of two symmetrical first rotary cleaning arms and a second rotary cleaning arm, which are symmetrical with the rotation center of the robot body, which helps to achieve a balanced cleaning action and improve cleaning efficiency. On each rotary cleaning arm, auxiliary suction cups and TOF modules are symmetrically arranged. The auxiliary suction cups are used to help the robot to stably adsorb and move on the photovoltaic panels, while the TOF module is used to detect the gaps between the photovoltaic panels. When the rotary cleaning arm rotates, the TOF module detects the gaps between the photovoltaic panels. The synchronous rotation of the two rotary cleaning arms helps to achieve uniform cleaning coverage. At the same time, by analyzing the data collected by the two TOF modules, the robot's travel status and whether correction is needed can be more accurately judged.
[0117] In a specific application, the first rotating cleaning arm and the second rotating cleaning arm can be telescopically moved along their central axes in a direction away from or close to the main suction cup. When it is necessary to make the robot body cross the gap between adjacent photovoltaic panels and move to an adjacent photovoltaic panel, the first rotating cleaning arm and the second rotating cleaning arm are controlled to be away from the main suction cup, and the auxiliary suction cups of the first rotating cleaning arm and the second rotating cleaning arm are controlled to be adsorbed on the photovoltaic panel. In this case, one of the auxiliary suction cups is adsorbed on the adjacent photovoltaic panel, the main suction cup does not adsorb the photovoltaic panel, and the robot body moves toward the direction of the rotating cleaning arm adsorbed on the adjacent photovoltaic panel. When the robot body moves to the adjacent photovoltaic panel, the main suction cup is adsorbed on the photovoltaic panel, and the auxiliary suction cups of the first rotating cleaning arm and the second rotating cleaning arm are controlled not to adsorb the photovoltaic panel. The first rotating cleaning arm and the second rotating cleaning arm are respectively away from or close to the main suction cup, which can be achieved by a moving mechanism between the first rotating cleaning arm, the second rotating cleaning arm and the robot body. The moving mechanism is, for example, a guide rail and a slider system.
[0118] In some embodiments, the TOF module includes a TOF laser sensor.
[0119] The TOF laser sensor emits laser pulses of a specific frequency. When the pulses hit the surface of the photovoltaic panel, part of the light will be reflected back. The TOF laser sensor can very accurately measure the time required for the laser pulse to be emitted and reflected from the surface of the photovoltaic panel. Based on the speed of light and the measured time, the TOF module can calculate the distance between the sensor and the surface of the photovoltaic panel. When the cleaning robot moves, the TOF laser sensor detects the change in distance to the edge or gap of the photovoltaic panel. When a sudden change in distance is detected, the gap between the photovoltaic panels is identified. During the cleaning process of the photovoltaic panel cleaning robot, the TOF laser sensor will continue to monitor and update the data in real time to respond to possible changes on the surface of the photovoltaic panel.
[0120] The technical features of the above-described embodiments may be arbitrarily combined. To make the description concise, not all possible combinations of the technical features in the above-described embodiments are described. However, as long as there is no contradiction in the combination of these technical features, they should be considered to be within the scope of this specification.
[0121] The above-mentioned embodiments only express several implementation methods of the present invention, and the description thereof is relatively specific and detailed, but it cannot be understood as limiting the scope of the patent application. It should be pointed out that, for a person 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. Therefore, the protection scope of the patent of the present invention shall be subject to the attached claims.
Claims
1. A robot correction method based on TOF module, It is characterized in that The robot deviation correction method is applicable to a photovoltaic panel cleaning robot, which comprises a robot body and a rotating cleaning component, wherein the robot body is provided with a main suction cup, the rotating cleaning component is provided with an auxiliary suction cup, and a TOF module is provided around the auxiliary suction cup; when the main suction cup is fixed on the photovoltaic panel, the rotating cleaning component rotates with the main suction cup as the center; The robot deviation correction method comprises: Using the TOF module, obtaining gap detection information of the photovoltaic panel cleaning robot; Based on the gap detection information, generating a robot correction instruction; The robot deviation correction instruction is sent to the driving device of the robot body, so that the driving device corrects the photovoltaic panel cleaning robot according to the robot deviation correction instruction.
2. The robot deviation correction method based on the TOF module according to claim 1, It is characterized in that The gap detection information includes first angle data and second angle data when the gap between the TOF module and the photovoltaic panel intersects within the same rotation cycle of the rotating cleaning component; The generating a robot deviation correction instruction based on the gap detection information comprises: Based on the first angle data, the second angle data and the position information of the photovoltaic panel cleaning robot, determining whether the angle difference between the traveling direction of the photovoltaic panel cleaning robot and the preset direction is greater than a preset difference value; When the difference is not greater than the preset difference, the robot deviation correction instruction is not to adjust the traveling direction of the photovoltaic panel cleaning robot; Otherwise, a robot correction instruction is generated according to the angle difference between the traveling direction and the preset direction.
3. The robot deviation correction method based on the TOF module according to claim 2, It is characterized in that The robot body is provided with a code disk for recording the rotation angle of the rotating cleaning component, and the first angle data and the second angle data are obtained by: When the TOF module detects the crack for the first time, the angle data of the code disk is used as the first angle data; when the TOF module detects the crack again, the angle data of the code disk is used as the second angle data.
4. The robot deviation correction method based on the TOF module according to claim 2, It is characterized in that The rotating cleaning assembly includes a first rotating cleaning arm and a second rotating cleaning arm symmetrically arranged with respect to the rotation center of the robot body, and auxiliary suction cups and TOF modules are symmetrically arranged on the first rotating cleaning arm and the second rotating cleaning arm, respectively; the gap detection information includes a plurality of angle data groups, each of which includes first angle data, second angle data and identification information of the first rotating cleaning arm or the second rotating cleaning arm when the corresponding TOF module intersects the gap between the photovoltaic panel within the same rotation cycle of the first rotating cleaning arm or the second rotating cleaning arm; When the angle difference between the traveling direction of the photovoltaic panel cleaning robot and the preset direction is not greater than a preset difference value for N consecutive times, the method further includes: The gap detection information is sent to a cloud server, and the cloud server is used to obtain a travel stability score of the photovoltaic panel cleaning robot according to the gap detection information, and to determine whether the travel stability score meets a preset alarm condition, wherein the travel stability score is used to indicate a trend of a travel direction change of the photovoltaic panel cleaning robot; When the preset alarm conditions are met, the cloud server is used to generate stability alarm information and send it to the user device; N is a positive integer greater than 3.
5. The robot deviation correction method based on the TOF module according to claim 4, It is characterized in that The step of obtaining the traveling stability score of the photovoltaic panel cleaning robot according to the gap detection information, and judging whether the traveling stability score meets the preset alarm condition, includes: Inputting the gap detection information into a stability scoring model to obtain a traveling stability score of the photovoltaic panel cleaning robot; It is determined whether the traveling stability score is within a preset stability threshold. When it is not within the stability threshold, it is considered that the traveling stability score meets the preset alarm condition.
6. The robot deviation correction method based on the TOF module according to claim 5, It is characterized in that The training process of the stability scoring model is: Acquire a training set, the training set comprising a plurality of training data, each of the training data comprising a set of gap detection information and annotated data of a preset score corresponding to the gap detection information; For each training data in the training set, perform the following processing: Inputting the gap detection information in the training data into a preset deep learning model to obtain prediction data of a preset score corresponding to the gap detection information; Based on the prediction data and the annotation data of the preset scores corresponding to the gap detection information, the model parameters of the deep learning model are updated; Check whether the preset training end conditions are met; If yes, the trained deep learning model is used as the stability scoring model; if no, the next training data is used to continue training the deep learning model.
7. An electronic device, It is characterized in that The method comprises one or more processors and a memory; one or more programs are stored in the memory and are configured so that the one or more processors execute the method according to any one of claims 1 to 6.
8. A photovoltaic panel cleaning robot, It is characterized in that The photovoltaic panel cleaning robot comprises: the electronic device described in claim 7, a robot body and a rotating cleaning component; a main suction cup is provided on the robot body; an auxiliary suction cup is provided on the rotating cleaning component, and a TOF module is provided around the auxiliary suction cup; when the main suction cup is fixed on the photovoltaic panel, the rotating cleaning component rotates around the main suction cup.
9. The photovoltaic panel cleaning robot according to claim 8, It is characterized in that The TOF module includes a TOF laser sensor.
10. The photovoltaic panel cleaning robot according to claim 8, It is characterized in that The rotary cleaning assembly comprises a first rotary cleaning arm and a second rotary cleaning arm which are symmetrically arranged with respect to the rotation center of the robot body, and an auxiliary suction cup and a TOF module are symmetrically arranged on the first rotary cleaning arm and the second rotary cleaning arm, respectively.
Citation Information
Patent Citations
Full-automatic and intelligent robot for cleaning photovoltaic panel
CN104707831A
Continuous working photovoltaic cleaning robot
CN110882967A
Operation control method and system of photovoltaic sweeper and storage medium
CN117369476A
Sucker walking mechanism
CN219130053U
Robot for Cleaning Photovoltaic Panel and Method for Controlling the Same
US20200186080A1
