A method for assisting positioning of a photovoltaic cleaning robot
By combining camera optical flow algorithm and Kalman filter fusion data on the photovoltaic cleaning robot, the problem of encoder odometer slipping on the inclined panel is solved, positioning accuracy and stability are improved, and autonomous driving and cost savings are achieved.
Patent Information
- Application Number
- CN202011563190.X
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2020-12-25
- Publication Date
- 2024-11-01
- Estimated Expiration
- 2040-12-25
AI Technical Summary
Photovoltaic cleaning robots are prone to slip when positioning using encoder odometers on tilted photovoltaic array panels, resulting in inaccurate data and cumulative errors, and cannot be used alone.
By installing camera components on the photovoltaic cleaning robot, the visual mileage is obtained using the optical flow algorithm, and combining the extended Kalman filter with the encoder mileage to generate a quadratic curve of speed compensation, and the speed of the driving drive device is adjusted in real time to achieve auxiliary position.
It effectively repairs the perceived data deviation caused by the odometer slippage of the encoder, improves the degree of automation and positioning stability of the photovoltaic cleaning robot, realizes autonomous driving, saves manpower and reduces power station maintenance costs.
Smart Images

Figure CN115701810B_ABST
Abstract
Description
Technical Field
[0001] The invention relates to a method for auxiliary positioning of a photovoltaic cleaning robot. Background Art
[0002] As a renewable and clean energy, solar photovoltaic has become an important force in today's global energy transformation. The surface of solar panels is prone to accumulation of sand, dust and other dirt. If not cleaned in a timely, scientific and professional manner, it can cause the power generation of the components to attenuate by up to 40%-60% and the power generation to drop by 20%-30%. Therefore, the concept of improving the power generation and efficiency of power stations by cleaning solar panels reasonably and scientifically and maintaining the components carefully has been recognized by the industry.
[0003] When the photovoltaic cleaning robot is performing cleaning operations, it is basically a fully automated process. At present, the main positioning method used in the industry is the encoder odometer positioning method. However, the encoder odometer is prone to slipping on the tilted photovoltaic array panel, resulting in inaccurate data, and there is a cumulative error and it cannot be used alone. Summary of the invention
[0004] In view of the above problems existing in the prior art, the main purpose of the present invention is to provide a method for auxiliary positioning of a photovoltaic cleaning robot.
[0005] The technical solution of the present invention is as follows:
[0006] A method for assisting positioning of a photovoltaic cleaning robot, the photovoltaic cleaning robot comprising a body, a cleaning device being arranged at the front end of the body, and a travel drive device being arranged at the bottom end of the body, the photovoltaic cleaning robot travels under the drive of the travel drive device, and performs a cleaning operation on a photovoltaic panel through the cleaning device, the front end of the body being arranged with a camera assembly, and the method comprising the following steps:
[0007] S1: placing the photovoltaic cleaning robot on photovoltaic panels with different inclinations in sequence, recording the slipping conditions of the photovoltaic cleaning robot on photovoltaic panels with different inclinations during the cleaning operation of the photovoltaic cleaning robot on the photovoltaic panels, and generating corresponding quartic curves for speed compensation;
[0008] S2: According to the placement direction and the forward direction of the photovoltaic cleaning robot, selective real-time compensation feedback of the speed of the driving device is performed;
[0009] S3: photographing the surface of the photovoltaic panel located below the front side of the fuselage through a camera assembly to obtain a surface image of the photovoltaic panel, and performing an optical flow algorithm on the surface image of the photovoltaic panel to obtain a visual mileage;
[0010] S4: Use the extended Kalman filter to fuse the encoder mileage and the visual mileage to obtain a fused mileage, and use the fused mileage as the mileage of the final basic positioning to achieve auxiliary positioning.
[0011] The fuselage includes a chassis and a connecting frame arranged on the chassis. The first positioning hole and the second positioning hole are respectively arranged at the left and right sides of the chassis, and the first positioning hole and the second positioning hole are both provided with a travel drive device.
[0012] The connecting frame includes a first connecting plate, a second connecting plate, a third connecting plate and a fourth connecting plate, wherein the first connecting plate is fixedly set on the upper surface of the left side of the chassis, the second connecting plate is fixedly set on the upper surface of the front side of the chassis, the third connecting plate is fixedly set on the upper surface of the right side of the chassis, and the fourth connecting plate is fixedly set on the upper surface of the rear side of the chassis.
[0013] In step S1, the photovoltaic cleaning robot is placed on photovoltaic panels with different inclinations in sequence, and the photovoltaic cleaning robot performs cleaning operations on the photovoltaic panels, wherein the inclination of the photovoltaic panels is 0° to 60°.
[0014] The photovoltaic cleaning robot performs cleaning operations on the photovoltaic panels, wherein:
[0015] When the photovoltaic cleaning robot is driving on a photovoltaic panel with an inclination of 0°, the actual mileage is recorded once when it moves forward 1 meter, and once when it moves backward 1 meter;
[0016] When the photovoltaic cleaning robot travels on a photovoltaic panel with an inclination of 5° to 60°, data is recorded four times when the inclination of the photovoltaic panel is 5° at intervals.
[0017] The states of the four data records are: moving forward 1 meter upward, moving backward 1 meter downward, moving backward 1 meter upward, and moving forward 1 meter downward, and the actual mileage of the photovoltaic cleaning robot under the four data recording states is recorded.
[0018] When the photovoltaic cleaning robot is moving forward to perform cleaning operations, the inclination of the photovoltaic panel is converted into radians and used as the x1 variable. At the same time, the difference between the actual mileage of the photovoltaic cleaning robot and the target mileage of 1 meter is divided by the target mileage of 1 meter as the slip deviation rate y1 variable. The quartic curve of speed compensation in the forward state is fitted as: y1 = 0.0082x1 4 -0.0238x1 3 +0.0527x1 2 -0.074x1.
[0019] When the photovoltaic cleaning robot is in the forward state and is performing cleaning operations, the inclination x1 of the photovoltaic panel where the photovoltaic cleaning robot is currently located is obtained, and the quartic curve of the speed compensation in the forward state is used.
[0020] y1=0.0082x1 4 -0.0238x1 3 +0.0527x1 2 -0.074x1,
[0021] The deviation rate y1 can be obtained, and then according to the formula v1 1 =(y1+1)*v1 0 The feedback speed v1 of the forward state can be obtained 1 , where v1 0 is the original driving speed of the photovoltaic cleaning robot in the forward state.
[0022] When the photovoltaic cleaning robot is in the backward state for cleaning, the inclination of the photovoltaic panel is converted into radians and used as the x2 variable. At the same time, the difference between the actual mileage of the photovoltaic cleaning robot and the target mileage of 1 meter is divided by the target mileage of 1 meter as the slip deviation rate y2 variable. The quartic curve of speed compensation in the backward state is fitted as: y2 = 0.0171x2 4 -0.0349x2 3 +0.01x2 2 -0.0346x2.
[0023] When the photovoltaic cleaning robot is in the backward state to perform cleaning operations, the inclination x2 of the photovoltaic panel where the photovoltaic cleaning robot is currently located is obtained, and the quartic curve of the speed compensation in the backward state is used
[0024] y2=0.0171x2 4 -0.0349x2 3 +0.01x2 2 -0.0346x2,
[0025] The deviation rate y2 can be obtained, and then according to the formula v2 1 =(y2+1)*v2 0 The feedback speed v2 of the compensated backward state can be obtained 1 , where v2 0 is the original driving speed of the photovoltaic cleaning robot in the backward state.
[0026] The present invention has the following advantages and beneficial effects: an embodiment of the present invention provides a method for auxiliary positioning of a photovoltaic cleaning robot, which is used to repair the large deviation between the perception data and the actual data of the photovoltaic cleaning robot caused by the slipping of the driving device during the cleaning operation through the encoder odometer, thereby achieving more stable continuous automatic control operation, thereby effectively improving the automation level of the photovoltaic cleaning robot, optimizing the positioning function of the photovoltaic cleaning robot, and improving the stability of the photovoltaic cleaning robot, so as to achieve autonomous driving operation, save manpower and reduce the maintenance cost of the power station. BRIEF DESCRIPTION OF THE DRAWINGS
[0027] Figure 1 A schematic diagram of the three-dimensional structure of a photovoltaic cleaning robot provided in an embodiment of the present invention.
[0028] Figure 2 A schematic diagram of the top structure of a photovoltaic cleaning robot provided in an embodiment of the present invention.
[0029] Figure 3 An enlarged three-dimensional structural schematic diagram of a camera assembly provided in an embodiment of the present invention.
[0030] Figure 4 This is a schematic diagram of an enlarged exploded structure of a camera assembly provided in an embodiment of the present invention.
[0031] Figure 5 A schematic diagram of the three-dimensional structure of a photovoltaic cleaning robot provided in an embodiment of the present invention performing cleaning operations on an inclined photovoltaic panel surface.
[0032] Figure 6 A schematic diagram of the top view of the photovoltaic cleaning robot provided in an embodiment of the present invention performing cleaning operations on an inclined photovoltaic panel surface.
[0033] Figure 7 A schematic side view of the structure of a photovoltaic cleaning robot provided in an embodiment of the present invention performing a cleaning operation on an inclined photovoltaic panel surface. DETAILED DESCRIPTION
[0034] In order to make the purpose, technical solutions and advantages of the embodiments of the present invention clearer, the technical solutions in the embodiments of the present invention will be clearly and completely described below in conjunction with the drawings in the embodiments of the present invention. Obviously, the described embodiments are part of the embodiments of the present invention, rather than all of the embodiments. The components of the embodiments of the present invention generally described and shown in the drawings here can be arranged and designed in various different configurations. Therefore, the following detailed description of the embodiments of the present invention provided in the drawings is not intended to limit the scope of the claimed invention, but merely represents selected embodiments of the present invention. Based on the embodiments in the present invention, all other embodiments obtained by ordinary technicians in this field without making creative work are within the scope of protection of the present invention.
[0035] In the description of the present invention, it should be noted that the terms "center", "upper", "lower", "left", "right", "vertical", "horizontal", "inner", "outer", etc., indicating the orientation or positional relationship, are based on the orientation or positional relationship shown in the drawings, and are only for the convenience of describing the present invention and simplifying the description, rather than indicating or implying that the device or element referred to must have a specific orientation, be constructed and operated in a specific orientation, and therefore cannot be understood as limiting the present invention. In addition, the terms "first", "second", and "third" are used for descriptive purposes only, and cannot be understood as indicating or implying relative importance.
[0036] In the description of the present invention, it is also necessary to explain that, unless otherwise clearly specified and limited, the terms "set", "install", "connect", and "connect" should be understood in a broad sense, for example, it can be a fixed connection, a detachable connection, or an integral connection; it can be a mechanical connection or an electrical connection; it can be a direct connection, or it can be indirectly connected through an intermediate medium, or it can be the internal communication of two elements. For ordinary technicians in this field, the specific meanings of the above terms in the present invention can be understood according to specific circumstances.
[0037] The present invention will be further described below with reference to the accompanying drawings and specific embodiments.
[0038] like Figures 1 to 7 As shown: a method for auxiliary positioning of a photovoltaic cleaning robot provided by an embodiment of the present invention, the photovoltaic cleaning robot comprises a body 100, a cleaning device 200 is arranged at the front end of the body 100, and a driving device 400 is arranged at the bottom end of the body 100, the photovoltaic cleaning robot travels under the drive of the driving device 400, and cleans the photovoltaic panel through the cleaning device 200, the front end of the body 100 is arranged with a camera assembly 300, and the method comprises the following steps:
[0039] S1: placing the photovoltaic cleaning robot on photovoltaic panels with different inclinations in sequence, recording the slipping conditions of the photovoltaic cleaning robot on photovoltaic panels with different inclinations during the cleaning operation of the photovoltaic cleaning robot on the photovoltaic panels, and generating corresponding quartic curves for speed compensation;
[0040] S2: According to the placement direction and the forward direction of the photovoltaic cleaning robot, selective real-time compensation feedback of the speed of the driving device is performed;
[0041] S3: photographing the surface of the photovoltaic panel located below the front side of the fuselage through the camera assembly 300 to obtain a surface image of the photovoltaic panel, and obtaining visual mileage by performing an optical flow algorithm on the surface image of the photovoltaic panel;
[0042] S4: Use the extended Kalman filter to fuse the encoder mileage and the visual mileage to obtain the fused mileage, and use the fused mileage as the mileage of the final basic positioning to achieve auxiliary positioning. The above encoder mileage is the mileage recorded by the encoder device 120 rotating the drive device 400, and the encoder device 120 is arranged on the drive device 400.
[0043] In step S1, the photovoltaic cleaning robot is placed on photovoltaic panels with different inclinations in sequence, and the photovoltaic cleaning robot performs cleaning operations on the photovoltaic panels, wherein the inclination of the photovoltaic panels is 0° to 60°.
[0044] During the cleaning operation of the photovoltaic cleaning robot on the photovoltaic panel, when the photovoltaic cleaning robot is driving on the photovoltaic panel with an inclination of 0°, the actual mileage is recorded once when it moves forward 1 meter, and the actual mileage is recorded once when it moves backward 1 meter; when the photovoltaic cleaning robot is driving on the photovoltaic panel with an inclination of 5° to 60°, the data is recorded 4 times when the inclination of the photovoltaic panel is 5°. In summary, a total of 50 data records are made.
[0045] The states of the four data records are: moving forward 1 meter upward, moving backward 1 meter downward, moving backward 1 meter upward, and moving forward 1 meter downward, and the actual mileage of the photovoltaic cleaning robot under the four data record states is recorded. In addition, the states of the 50 data records can be divided into two categories, that is, the states of the photovoltaic cleaning robot moving forward upward and moving forward downward are classified as forward states, and the data records of the photovoltaic cleaning robot in the forward state are 25 times; at the same time, the photovoltaic cleaning robot moving backward downward and moving backward upward are classified as backward states, and the data records of the photovoltaic cleaning robot in the backward state are 25 times.
[0046] When the photovoltaic cleaning robot is driving in the forward state for cleaning operations, the inclination of the photovoltaic panel is converted into radians and used as the x1 variable. At the same time, the difference between the actual mileage of the photovoltaic cleaning robot and the target mileage of 1 meter is divided by the target mileage of 1 meter as the slip deviation rate y1 variable. According to the data records of the above 25 forward states, the quartic curve of speed compensation in the forward state is fitted as: y1 = 0.0082x1 4 -0.0238x1 3 +0.0527x1 2 -0.074x1.
[0047] When the photovoltaic cleaning robot is in the forward state and is performing cleaning operations, the inclination x1 of the photovoltaic panel where the photovoltaic cleaning robot is currently located is obtained, and the quartic curve of the speed compensation in the forward state is used.
[0048] y1=0.0082x1 4 -0.0238x1 3 +0.0527x1 2 -0.074x1,
[0049] The deviation rate y1 can be obtained, and then according to the formula v1 1 =(y1+1)*v1 0 The feedback speed v1 of the forward state can be obtained 1 , where v1 0 is the original driving speed of the photovoltaic cleaning robot in the forward state.
[0050] When the photovoltaic cleaning robot is in the backward state for cleaning, the inclination of the photovoltaic panel is converted into radians and used as the x2 variable. At the same time, the difference between the actual mileage of the photovoltaic cleaning robot and the target mileage of 1 meter is divided by the target mileage of 1 meter as the slip deviation rate y2 variable. According to the data records of the above 25 backward states, the quartic curve of speed compensation in the backward state is fitted as: y2 = 0.0171x2 4 -0.0349x2 3 +0.01x2 2 -0.0346x2.
[0051] When the photovoltaic cleaning robot is in the backward state to perform cleaning operations, the inclination x2 of the photovoltaic panel where the photovoltaic cleaning robot is currently located is obtained, and the quartic curve of the speed compensation in the backward state is used
[0052] y2=0.0171x2 4 -0.0349x2 3 +0.01x2 2 -0.0346x2,
[0053] The deviation rate y2 can be obtained, and then according to the formula v2 1 =(y2+1)*v2 0 The feedback speed v2 of the compensated backward state can be obtained 1 , where v2 0 is the original driving speed of the photovoltaic cleaning robot in the backward state.
[0054] The fuselage 100 includes a chassis 101 and a connecting frame arranged on the chassis 101. The first positioning hole 151 and the second positioning hole 152 are respectively arranged at the left and right sides of the chassis 101, and the first positioning hole 151 and the second positioning hole 152 are both provided with a travel drive device 400.
[0055] The connecting frame includes a first connecting plate 102, a second connecting plate 103, a third connecting plate 104 and a fourth connecting plate 105, wherein the first connecting plate 102 is fixedly set on the upper surface of the left side of the chassis 101, the second connecting plate 103 is fixedly set on the upper surface of the front side of the chassis 101, the third connecting plate 104 is fixedly set on the upper surface of the right side of the chassis 101, and the fourth connecting plate 105 is fixedly set on the upper surface of the rear side of the chassis 101.
[0056] The first connecting plate 102, the second connecting plate 103, the third connecting plate 104 and the fourth connecting plate 105 are all in the shape of a rectangular parallelepiped. The first connecting plate 102 is fixedly arranged on the upper surface of the left side of the chassis 101 along the length direction, the second connecting plate 103 is arranged on the upper surface of the front side of the chassis 101 along the length direction, the third connecting plate 104 is fixedly arranged on the upper surface of the right side of the chassis 101 along the length direction, and the fourth connecting plate 105 is fixedly arranged on the upper surface of the rear side of the chassis 101 along the length direction.
[0057] The camera assembly 300 includes a shell 301, which is square in shape. A cavity (not shown in the figure) is arranged inside the shell 301. An opening (not shown in the figure) communicating with the cavity is arranged at the lower end of the shell 301. A camera module is arranged at the top of the shell 301. The camera module includes a camera 303, a camera driving board 304 and a height adjustment nylon column 305. The camera 303 is fixedly arranged on the lower surface of the camera driving board 304. The camera driving board 304 is arranged above the top of the shell 301 through the height adjustment nylon column 305. The camera 303 passes through the first positioning hole 306 arranged at the top of the shell 301 and is located in the cavity of the shell 301. At the same time, a brush 302 is arranged at the bottom of the shell 301.
[0058] The outer wall around the bottom of the shell 301 extends outwards to be provided with a mounting portion, the mounting portion matches the brush 302, and the shell 301 is arranged on the top of the brush through the mounting portion. Through the above design, that is, the outer wall around the bottom of the shell 301 extends outwards to be provided with a mounting portion, and the mounting portion matches the structure of the brush 302, so that the shell 301 can be arranged on the top of the brush 302 through the mounting portion and tightly matched. Through the above design, that is, the brush is arranged at the lower end of the shell 300, and the plane where the bottom end of the brush 302 is located is the same plane as the plane where the bottom end of the fuselage 100 is located, so that the brush 302 can be installed tightly with the bottom of the shell 300; when the photovoltaic cleaning robot performs cleaning operations on the photovoltaic panels of the photovoltaic array, the cavity of the shell 301 forms a relatively closed environment between the brush 302 and the upper surface of the photovoltaic panel to ensure the exposure effect of the shell 301, and at the same time, it can also minimize the influence of the external environment on the shooting of the camera installed on the top of the shell 301, thereby ensuring the stability of the shooting environment.
[0059] The shell 301 also includes a fill light assembly, which includes a fill light driving board 321 and a fill light 317 arranged below the fill light driving board 321. The fill light driving board 321 is connected to the top of the shell 301 through a second fastening bolt 350. The upper end of the fill light 317 is fixed in the fill light driving board 321, and the lower end of the fill light 317 passes through a second positioning hole 322 set on the top of the shell 301 and extends into the cavity of the shell 301. Through the above design, four fill light assemblies are also provided on the camera assembly 300, and each fill light assembly includes a fill light driving board 321 and a fill light 317 arranged below the fill light driving board 321, the fill light driving board 321 is connected to the top of the shell 301 through the second fastening bolt 350, the upper end of the fill light 317 is fixed in the fill light driving board 321, and the lower end of the fill light 317 passes through the second positioning hole 322 set on the top of the shell 301 and extends into the cavity of the shell 301, so as to achieve the purpose of convenient adjustment and later maintenance.
[0060] There are four fill light assemblies, and the four fill light assemblies are respectively fixedly arranged at the four corners of the top of the housing 301. Through the above design, that is, a fill light assembly is respectively arranged at the four corners of the top of the housing 301, the exposure effect of the housing 301 can be improved.
[0061] The mounting portion includes a first mounting plate 337, a second mounting plate 338, a third mounting plate 339 and a fourth mounting plate (not shown in the figure), wherein: the first mounting plate 337 is fixedly set on the outer wall of the left bottom of the shell 301, the second mounting plate 338 is fixedly set on the outer wall of the front bottom of the shell 301, the third mounting plate 339 is fixedly set on the outer wall of the right bottom of the shell 301, and the fourth mounting plate is fixedly set on the outer wall of the rear bottom of the shell 301; the plane where the lower surfaces of the first mounting plate 337, the second mounting plate 338, the third mounting plate 339 and the fourth mounting plate are located is the same plane as the plane where the bottom of the shell 301 is located, and the first mounting plate 337, the second mounting plate 338, the third mounting plate 339 and the fourth mounting plate are integrally formed with the shell 301.
[0062] Through the above design, that is, the plane where the lower surfaces of the first mounting plate 337, the second mounting plate 338, the third mounting plate 339 and the fourth mounting plate are located is the same plane as the plane where the bottom of the shell 301 is located, so the upper end of the brush 302 can be tightly matched with the lower ends of the first mounting plate 337, the second mounting plate 338, the third mounting plate 339 and the fourth mounting plate, thereby making the cavity in the shell 301 in a relatively closed environment; at the same time, since the first mounting plate 337, the second mounting plate 338, the third mounting plate 339 and the fourth mounting plate are integrally formed with the shell 301, the firmness of the mounting part, that is, the first mounting plate 337, the second mounting plate 338, the third mounting plate 339 and the fourth mounting plate combined with the shell 301 can be improved, thereby extending the service life of the shell 301.
[0063] The brush 302 includes a first brush 311, a second brush 312, a third brush 313 and a fourth brush 314, and the first brush 311, the second brush 312, the third brush 313 and the fourth brush 314 are connected end to end and form a square structure with a through hole in the middle; the first brush 311 is located below the first mounting plate 337, and the outer wall of the first brush 311 is flush with the outer wall of the first mounting plate 337; the second brush 312 is located below the second mounting plate 338, and the outer wall of the second brush 312 is flush with the outer wall of the second mounting plate 338; the third brush 313 is located below the third mounting plate 339, and the outer wall of the third brush 313 is flush with the outer wall of the third mounting plate 339; the fourth brush 314 is located below the fourth mounting plate, and the outer wall of the fourth brush 314 is flush with the outer wall of the fourth mounting plate.
[0064] Through the above design, the brush 302 is formed by connecting the first brush 311, the second brush 312, the third brush 313 and the fourth brush 314 end to end, and forming a square structure with through holes in the middle, so as to match the structure of the shell 301 and fit more tightly, and facilitate the early assembly and later maintenance, and at the same time, it can also improve the firmness of the combination of the first brush 311, the second brush 312, the third brush 313 and the fourth brush 314, thereby improving safety and reliability, so as to extend the service life of the brush 302 and the photovoltaic cleaning robot.
[0065] The camera driving board 304 is in a square shape, and the camera 303 is fixedly arranged on the lower surface of the camera driving board 304. The four corners of the camera driving board 304 are fixedly connected to the top of the housing 301 through the height adjustment nylon columns 305, and the height adjustment nylon columns 305 are respectively connected to the top of the housing 301 and the camera driving board 304 through the first fastening bolts 340. The camera 303 in the above-mentioned camera assembly 300 adopts a 480P60 frame high-speed camera, and is placed directly above a relatively closed space using a certain fill light method. The camera assembly 300 is placed directly in front of the photovoltaic cleaning robot.
[0066] Through the above design, that is, the number of height-adjusting nylon columns 305 is four, which are respectively located at the four corners of the camera driving board 304, and a fixing hole is provided in the height-adjusting nylon column 305, and the lower end of the height-adjusting nylon column 305 is fastened to the shell 301 by the first fastening bolt 340, which can improve the firmness of the height-adjusting nylon column 305 and the shell 301; at the same time, the height-adjusting nylon column 305 is respectively connected to the top of the shell 301 and the camera driving board 304 by the first fastening bolt 340, thereby improving the firmness of the height-adjusting nylon column 305 and the shell 301 and the camera driving board 304; in addition, the distance between the camera driving board 304 and the top of the shell 301 can be adjusted by the above-mentioned four height-adjusting nylon columns 305, thereby achieving the distance between the camera 303 and the surface of the photovoltaic panel in the photovoltaic array where the fuselage 100 is located, and the operation is convenient and quick.
[0067] The plane where the upper surface of the first brush 311 is located is parallel to the plane where the lower surface of the first mounting plate 337 is located; the plane where the upper surface of the second brush 312 is located is parallel to the plane where the lower surface of the second mounting plate 338 is located; the plane where the upper surface of the third brush 313 is located is parallel to the plane where the lower surface of the third mounting plate 339 is located; the plane where the upper surface of the fourth brush 314 is located is parallel to the plane where the lower surface of the fourth mounting plate is located. Through the above design, the plane where the upper surface of the brushes (i.e., the first brush 311, the second brush 312, the third brush 313, and the fourth brush 314) is located is parallel to the plane where the lower end surface of the mounting portion (i.e., the first mounting plate 337, the second mounting plate 338, the third mounting plate 339, and the fourth mounting plate) is located, so that the brushes can be closely matched with the mounting portion.
[0068] Finally, it should be noted that the above-described embodiments are only used to illustrate the technical solutions of the present invention, rather than to limit the present invention. Although the present invention has been described in detail with reference to the aforementioned embodiments, those skilled in the art should understand that the technical solutions described in the aforementioned embodiments may still be modified, or some or all of the technical features thereof may be replaced by equivalents. However, these modifications or replacements do not deviate the essence of the corresponding technical solutions from the scope of the technical solutions of the embodiments of the present invention.
Claims
1. A method for assisting positioning of a photovoltaic cleaning robot, wherein the photovoltaic cleaning robot comprises a body, a cleaning device is disposed at the front end of the body, and a driving device is disposed at the bottom end of the body, the photovoltaic cleaning robot travels under the drive of the driving device, and performs cleaning operations on photovoltaic panels through the cleaning device, characterized in that: A camera assembly is disposed at the front end of the fuselage, and the method comprises the following steps: S1: placing the photovoltaic cleaning robot on photovoltaic panels with different inclinations in sequence, recording the slipping conditions of the photovoltaic cleaning robot on photovoltaic panels with different inclinations during the cleaning operation of the photovoltaic cleaning robot on the photovoltaic panels, and generating corresponding quartic curves for speed compensation; S2: According to the placement direction and the forward direction of the photovoltaic cleaning robot, selective real-time compensation feedback of the speed of the driving device is performed; S3: photographing the surface of the photovoltaic panel located below the front side of the fuselage through a camera assembly to obtain a surface image of the photovoltaic panel, and performing an optical flow algorithm on the surface image of the photovoltaic panel to obtain a visual mileage; S4: using an extended Kalman filter to fuse the encoder mileage and the visual mileage to obtain a fused mileage, and using the fused mileage as the mileage of the final basic positioning to achieve auxiliary positioning; the encoder mileage is the mileage of the rotation of the travel drive device recorded by the encoder device, and the encoder device is arranged on the travel drive device; In step S1, the photovoltaic cleaning robot is placed on photovoltaic panels with different inclinations in sequence, and the photovoltaic cleaning robot performs a cleaning operation on the photovoltaic panel, wherein the inclination of the photovoltaic panel is 0° to 60°; The photovoltaic cleaning robot performs cleaning operations on the photovoltaic panels, wherein: When the photovoltaic cleaning robot is driving on a photovoltaic panel with an inclination of 0°, the actual mileage is recorded once when it moves forward 1 meter, and once when it moves backward 1 meter; When the photovoltaic cleaning robot is driving on a photovoltaic panel with an inclination of 5° to 60°, data is recorded 4 times when the inclination of the photovoltaic panel is 5°; The states of the four data records are: moving forward 1 meter upward, moving backward 1 meter downward, moving backward 1 meter upward, and moving forward 1 meter downward, and the actual mileage of the photovoltaic cleaning robot under the four data recording states is recorded; When the photovoltaic cleaning robot is moving forward to perform cleaning operations, the inclination of the photovoltaic panel is converted into radians and used as the x1 variable. At the same time, the difference between the actual mileage of the photovoltaic cleaning robot and the target mileage of 1 meter is divided by the target mileage of 1 meter as the slip deviation rate y1 variable. The quartic curve of speed compensation in the forward state is fitted as: y1 = 0.0082x1 4 -0.0238x1 3 +0.0527x1 2 -0.074x1.
2. The method for assisted positioning of a photovoltaic cleaning robot according to claim 1, characterized in that: The fuselage includes a chassis and a connecting frame arranged on the chassis. The first positioning hole and the second positioning hole are respectively arranged at the left and right sides of the chassis, and the first positioning hole and the second positioning hole are both provided with a travel drive device.
3. The photovoltaic cleaning robot assisted positioning method according to claim 2, characterized in that: The connecting frame includes a first connecting plate, a second connecting plate, a third connecting plate and a fourth connecting plate, wherein the first connecting plate is fixedly set on the upper surface of the left side of the chassis, the second connecting plate is fixedly set on the upper surface of the front side of the chassis, the third connecting plate is fixedly set on the upper surface of the right side of the chassis, and the fourth connecting plate is fixedly set on the upper surface of the rear side of the chassis.
4. The photovoltaic cleaning robot assisted positioning method according to claim 1, characterized in that: When the photovoltaic cleaning robot is in the forward state and is performing cleaning operations, the inclination x1 of the photovoltaic panel where the photovoltaic cleaning robot is currently located is obtained, and the quartic curve of the speed compensation in the forward state is used. y1=0.0082x1 4 -0.0238x1 3 +0.0527x1 2 -0.074x1, The deviation rate y1 can be obtained, and then according to the formula v1 1 =(y1+1)*v1 0 The feedback speed v1 of the forward state can be obtained 1 , where v1 0 is the original driving speed of the photovoltaic cleaning robot in the forward state.
5. The photovoltaic cleaning robot assisted positioning method according to claim 1, characterized in that: When the photovoltaic cleaning robot is in the backward state for cleaning, the inclination of the photovoltaic panel is converted into radians and used as the x2 variable. At the same time, the difference between the actual mileage of the photovoltaic cleaning robot and the target mileage of 1 meter is divided by the target mileage of 1 meter as the slip deviation rate y2 variable. The quartic curve of speed compensation in the backward state is fitted as: y2 = 0.0171x2 4 -0.0349x2 3 +0.01x2 2 -0.0346x2.
6. The photovoltaic cleaning robot assisted positioning method according to claim 5, characterized in that: When the photovoltaic cleaning robot is in the backward state to perform cleaning operations, the inclination x2 of the photovoltaic panel where the photovoltaic cleaning robot is currently located is obtained, and the quartic curve of the speed compensation in the backward state is used y2=0.0171x2 4 -0.0349x2 3 +0.01x2 2 -0.0346x2, The deviation rate y2 can be obtained, and then according to the formula v2 1 =(y2+1)*v2 0 The feedback speed v2 of the compensated backward state can be obtained 1 , where v2 0 is the original driving speed of the photovoltaic cleaning robot in the backward state.
