SMART SNOW REMOVAL METHOD, SNOW REMOVAL ROBOT AND SMART SNOW REMOVAL EQUIPMENT
20250172946 ยท 2025-05-29
Assignee
Inventors
Cpc classification
E01H5/045
FIXED CONSTRUCTIONS
International classification
G05D1/648
PHYSICS
E01H5/04
FIXED CONSTRUCTIONS
Abstract
Disclosed is a smart snow removal method, applied to a snow removal robot. The method includes: obtaining, through global positioning system real-time kinematic (GPS-RTK) positioning technology, a latitude and longitude coordinates of a target snow throwing area and a target snow removal area, to generate a snow removal map; rasterizing the snow removal map; converting the snow removal map into a potential field: starting from a grid located in the target snow throwing area, and assigning, through a breadth-first search (BFS) algorithm, a potential energy value to the grid located in the target snow removal area in an outward diffusion manner; wherein the potential energy value increases with an increase in a number of diffusion layers; and controlling the snow removal robot to travel on an uncleaned grid with a highest current potential energy value one by one, and performing the snow removal operation on an arrived grid.
Claims
1. A smart snow removal method, applied to a snow removal robot, wherein the snow removal robot comprises: a traveling component, configured to travel along a planned path; a snow feeding component, provided at the traveling component, and configured to collect snow during a snow removal operation; and a snow throwing component, provided at the traveling component, connected to the snow feeding component, and configured to throw the snow collected by the snow feeding component to a preset area during the snow removal operation; the smart snow removal method comprises: obtaining, through global positioning system real-time kinematic (GPS-RTK) positioning technology, a latitude and longitude coordinates of a target snow throwing area and a target snow removal area, to generate a snow removal map; rasterizing the snow removal map; converting the snow removal map into a potential field: starting from a grid located in the target snow throwing area, and assigning, through a breadth-first search (BFS) algorithm, a potential energy value to the grid located in the target snow removal area in an outward diffusion manner; wherein the potential energy value increases with an increase in a number of diffusion layers; and controlling the snow removal robot to travel on an uncleaned grid with a highest current potential energy value one by one, and performing the snow removal operation on an arrived grid.
2. The smart snow removal method according to claim 1, wherein after the rasterizing the snow removal map, the method further comprises: determining, through an angle method, whether each grid is located in the target snow removal area: taking a connection line between a center point of each grid and each vertex of the target snow removal area as a first auxiliary line, and determining whether a sum of angles between all the first auxiliary lines corresponding to the center point is 360; in response to that the sum of the angles between all the first auxiliary lines corresponding to the center point is 360, determining that a corresponding grid is located in the target snow removal area; setting the grid in the target snow removal area as a snow removal grid; and setting the grid in the target snow throwing area as a snow throwing grid; wherein the starting from the grid located in the target snow throwing area, and assigning, through the BFS algorithm, the potential energy value to the grid located in the target snow removal area in the outward diffusion manner comprises: starting from the snow throwing grid, and assigning, through the BFS algorithm, the potential energy value to the snow removal grid in the outward diffusion manner.
3. The smart snow removal method according to claim 2, wherein the obtaining, through GPS-RTK positioning technology, the latitude and longitude coordinates of the target snow throwing area and the target snow removal area, to generate the snow removal map comprises: obtaining, through GPS-RTK positioning technology, the latitude and longitude coordinates of the target snow throwing area, the target snow removal area and a static obstacle area, to generate the snow removal map; wherein after the rasterizing the snow removal map, the method further comprises: determining, through the angle method, whether each grid overlaps with the static obstacle area: taking the connection line between each grid vertex of every grid and each vertex of the static obstacle area as a second auxiliary line, and determining whether the sum of angles between all the second auxiliary lines corresponding to each grid vertex is 360; in response to that the sum of angles between all the second auxiliary lines corresponding to each grid vertex is 360, determining that the corresponding grid overlaps with the static obstacle area; and setting the grid overlapping with the static obstacle area as a static obstacle grid; wherein before the starting from the snow throwing grid, and assigning, through the BFS algorithm, the potential energy value to the snow removal grid in the outward diffusion manner, the method further comprises: determining whether there is the static obstacle grid in the snow removal grid; in response to that there is the static obstacle grid in the snow removal grid, removing the static obstacle grid from the snow removal grid.
4. The smart snow removal method according to claim 2, wherein the taking the connection line between the center point of each grid and each vertex of the target snow removal area as the first auxiliary line, and determining whether the sum of the angles between all the first auxiliary lines corresponding to the center point is 360 comprises: determining whether the center point satisfies the following formula:
5. The smart snow removal method according to claim 3, wherein the taking the connection between each grid vertex of every grid to each vertex of the static obstacle area as the second auxiliary line, and determining whether the sum of the angles between all the second auxiliary lines corresponding to each grid vertex is 360 comprises: determining whether the grid vertex satisfy the following formula:
6. The smart snow removal method according to claim 2, wherein the controlling the snow removal robot to travel on the uncleaned grid with the highest current potential energy value one by one, and performing the snow removal operation on the arrived grid comprises: in response to the snow removal robot completing the snow removal operation on the snow removal grid, searching, with the snow removal robot as a center, whether there is a first target snow removal grid with the potential energy value being greater than or equal to the potential energy value of the grid where the snow removal robot is currently located within a preset range; wherein the first target snow removal grid is in an uncleared state; in response to an existence of the first target snow removal grid with the potential energy value being greater than or equal to the potential energy value of the grid where the snow removal robot is currently located within the preset range, controlling the snow removal robot to travel along the snow removal grid to the nearest first target snow removal grid, to perform the snow removal operation on the first target snow removal grid; in response to an absence of the first target snow removal grid with the potential energy value being greater than or equal to the potential energy value of the grid where the snow removal robot is currently located within the preset range, searching, with the snow removal robot as the center, whether there is a second target snow removal grid with the potential energy value being less than the potential energy value of the grid where the snow removal robot is currently located within the preset range; wherein the second target snow removal grid is in the uncleared state; and in response to the existence of the second target snow removal grid with the potential energy value being less than the potential energy value of the grid where the snow removal robot is currently located within the preset range, controlling the snow removal robot to travel along the snow removal grid to the nearest second target snow removal grid, to perform the snow removal operation on the second target snow removal grid.
7. The smart snow removal method according to claim 6, wherein after the searching, with the snow removal robot as the center, whether there is the second target snow removal grid with the potential energy value being less than the potential energy value of the grid where the snow removal robot is currently located within the preset range, the method further comprises: in response to the absence of the second target snow removal grid with potential energy value being less than the potential energy value of the grid where the snow removal robot is currently located within the preset range, searching, with the snow removal robot as the center, whether there is the snow throwing grid within the preset range; in response to the existence of the snow throwing grid within the preset range, searching whether there is a third target snow removal grid uncleared in the snow removal map; in response to the existence of the third target snow removal grid in the snow removal map, controlling, through a D*Lite algorithm, the snow removal robot to travel along the snow removal grid to the third target snow removal grid with the highest potential energy value, to perform the snow removal operation on the third target snow removal grid; and in response to the snow removal robot completing the snow removal operation on the third target snow removal grid, repeating the step of searching, with the snow removal robot as the center, whether there is the first target snow removal grid with potential energy value being greater than or equal to the potential energy value of the grid where the snow removal robot is currently located within the preset range.
8. The smart snow removal method according to claim 6, wherein the performing the snow removal operation on the arrived grid comprises: collecting snow by the snow feeding component; determining whether there is the snow throwing grid in the preset range; in response to the absence of the snow throwing grid in the preset range, taking the uncleared snow removal grid with the potential energy value being the lowest in the preset range as an actual snow throwing grid; in response to the existence of the snow throwing grid in the preset range, taking the snow throwing grid as the actual snow throwing grid; and directing a snow throwing direction of the snow throwing component toward the actual snow throwing grid.
9. The smart snow removal method according to claim 6, wherein an uncleaned mark is set on the snow throwing grid and on the snow removal grid where the snow removal robot has not performed the snow removal operation; and a cleared mark is set on the snow removal grid where the snow removal robot has completed the snow removal operation.
10. The smart snow removal method according to claim 6, wherein the traveling component is provided with a millimeter wave radar sensor device; and the controlling the snow removal robot to travel along the snow removal grid to the nearest first target snow removal grid, to perform the snow removal operation on the first target snow removal grid comprises: during the snow removal robot traveling toward the nearest first target snow removal grid, performing, by the millimeter wave radar sensor device, dynamic obstacle detection on a traveling path; in response to the millimeter wave radar sensor device detecting a dynamic obstacle in front of the snow removal robot, controlling the snow removal robot to stop traveling; obtaining, by the millimeter wave radar sensor device, dynamic obstacle information, to mark the grid overlapping with the dynamic obstacle as a dynamic obstacle grid; and excluding the dynamic obstacle grid from the snow removal grid, and repeating the step of searching, with the snow removal robot as the center, whether there is the first target snow removal grid with potential energy value being greater than or equal to the potential energy value of the grid where the snow removal robot is currently located within the preset range.
11. The smart snow removal method according to claim 6, wherein the traveling component is provided with a millimeter wave radar sensor device; and the controlling the snow removal robot to travel along the snow removal grid to the nearest second target snow removal grid, to perform the snow removal operation on the second target snow removal grid comprises: during the snow removal robot traveling toward the nearest second target snow removal grid, performing, by the millimeter wave radar sensor device, dynamic obstacle detection on the traveling path; in response to the millimeter wave radar sensor device detecting the dynamic obstacle in front of the snow removal robot, controlling the snow removal robot to stop traveling; obtaining, by the millimeter wave radar sensor device, the dynamic obstacle information, to mark the grid overlapping with the dynamic obstacle as the dynamic obstacle grid; and excluding the dynamic obstacle grid from the snow removal grid, and repeating the step of searching, with the snow removal robot as the center, whether there is the second target snow removal grid with potential energy value being less than the potential energy value of the grid where the snow removal robot is currently located within the preset range.
12. The smart snow removal method according to claim 8, wherein the directing the snow throwing direction of the snow throwing component toward the actual snow throwing grid comprises: obtaining, through GPS-RTK positioning technology, first relative position information between the grid where the snow removal robot is currently located and the actual snow throwing grid; and adjusting, according to the first relative position information, a snow throwing angle of the snow throwing component.
13. The smart snow removal method according to claim 12, wherein the snow throwing component comprises a snow throwing drive device, a first rotary drive device, a second rotary drive device, a snow throwing cylinder and a snow throwing cylinder cover; the snow throwing cylinder is rotatably connected to the traveling component along a vertical axis, and the snow throwing cylinder cover is rotatably connected to the snow throwing cylinder along a horizontal axis; one end of the snow throwing cylinder is communicated with the snow feeding component, and the other end of the snow throwing cylinder is communicated with one end of the snow throwing cylinder cover; the snow throwing drive device is provided between one end of the snow throwing cylinder and the snow feeding component; the first rotary drive device is connected to the snow throwing cylinder through a rotary base, and the second rotating drive device is connected to the snow throwing cylinder cover; the snow throwing drive device is configured to push the snow collected by the snow feeding component into the snow throwing cylinder, and throw the snow out from the other end of the snow throwing cylinder cover; and the obtaining, through GPS-RTK positioning technology, the first relative position information between the grid where the snow removal robot is currently located and the actual snow throwing grid comprises: obtaining, through GPS-RTK positioning technology, a first center point coordinates of the grid where the snow removal robot is currently located and a second center point coordinates of the actual snow throwing grid; taking a horizontal line between the first center point coordinates and the second center point coordinates as an adjustment reference line, and obtaining a length of the adjustment reference line; driving, by the first rotary drive device, the snow throwing cylinder to rotate, so that a horizontal angle between the direction of the other end of the snow throwing cylinder cover on the horizontal plane and the adjustment reference line is less than a first preset angle; and calculating a snow throwing inclination angle based on the length of the adjustment reference line, and driving, by the second rotary drive device, the snow throwing cylinder cover to rotate, so that a vertical angle between the direction of the other end of the snow throwing cylinder cover on the vertical plane and the adjustment reference line is equal to the snow throwing inclination angle.
14. The smart snow removal method according to claim 1, wherein the snow feeding component comprises a snow feeding channel, a snow shovel, a snow feeding drive device, a lifting mechanism, an image sensor device and an image processing module; the snow feeding channel is communicated with the snow throwing component, and the lifting mechanism is connected with the snow feeding channel; the snow shovel is provided at a snow inlet of the snow feeding channel, and the snow feeding drive device is connected to the snow shovel; the image sensor device is provided in the snow feeding channel, and the image processing module is electrically connected to the image sensor device and the lifting mechanism; and the performing the snow removal operation on the arrived grid comprises: driving, by the snow feeding drive device, the snow shovel to cut external snow, and continuously feeding the external snow into the snow feeding channel; obtaining, by the image sensor device, a snow feeding image of the snow feeding channel, and transmitting the snow feeding image to the image processing module; determining, by the image processing module, whether a proportion of the snow in the snow feeding image exceeds a first preset proportion threshold, and whether the proportion of the snow in the snow feeding image is lower than a second preset proportion threshold; wherein the first preset proportion threshold is higher than the second preset proportion threshold; in response to the proportion exceeding the first preset proportion threshold, driving, by the lifting mechanism, the snow feeding channel to go up; and in response to the proportion being less than the second preset proportion threshold, driving, by the lifting mechanism, the snow feeding channel to go down.
15. The smart snow removal method according to claim 14, wherein the snow inlet is provided with an infrared sensor device electrically connected to the snow feeding drive device; and after the driving, by the snow feeding drive device, the snow shovel to cut the external snow, and continuously feeding the external snow into the snow feeding channel, the method further comprises: obtaining, by the infrared sensor device, a temperature signal at the snow inlet; and in response to a fluctuation value of the temperature signal exceeding a preset temperature threshold, controlling the snow feeding drive device to stop working.
16. The smart snow removal method according to claim 14, wherein the snow shovel is made of rubber.
17. A snow removal robot, operated by the smart snow removal method according to claim 1, comprising: a positioning module, configured to obtain the latitude and longitude coordinates of the target snow throwing area and the target snow removal area through GPS-RTK positioning technology to generate the snow removal map; a rasterization module, configured to rasterize the snow removal map; a potential field module, configured to assign the potential energy value to the grid located in the target snow removal area in the outward diffusion manner, starting from the grid located in the target snow throwing area, through the BFS algorithm; and a driver module, configured to control the snow removal robot to travel on the uncleaned grid with the highest current potential energy value one by one, and perform the snow removal operation on the arrived grid.
18. A smart snow removal equipment, comprising: a controller; and a memory; wherein the memory stores at least one instruction or at least one program loaded and executed by the controller to implement the smart snow removal method according to claim 1.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
[0091]
[0092]
[0093]
[0094]
[0095]
[0096]
[0097]
[0098]
[0099]
[0100]
[0101]
[0102]
[0103]
[0104]
[0105]
[0106]
DETAILED DESCRIPTION OF THE EMBODIMENTS
[0107] An embodiment of the present application provides a smart snow removal method for application to a snow removal robot, as shown in
[0111] The smart snow removal method includes: [0112] S1, obtaining, through global positioning system real-time kinematic (GPS-RTK) positioning technology, a latitude and longitude coordinates of a target snow throwing area and a target snow removal area, to generate a snow removal map; [0113] S2, rasterizing the snow removal map; [0114] S3, converting the snow removal map into a potential field: starting from a grid located in the target snow throwing area, and assigning, through a breadth-first search (BFS) algorithm, a potential energy value to the grid located in the target snow removal area in an outward diffusion manner; the potential energy value increases with an increase in the number of diffusion layers; and [0115] S4, controlling the snow removal robot to travel on an uncleaned grid with the highest current potential energy value one by one, and performing the snow removal operation on an arrived grid.
[0116] In an embodiment, the travelling component may include a chassis and a travelling wheel or track arranged on the chassis, which may be driven by a power device. The power device can be driven by converting energy such as electric energy and heat energy into mechanical energy. The snow feeding component may include a snow shovel and an accompanying drive device. The drive device drives the snow shovel to cut the snow in the target snow removal area and pushes the cut snow continuously in the direction of the snow throwing component through the motion of the snow shovel. The snow throwing component may include a snow throwing cylinder and an accompanying drive device. The driving device continuously throws the snow pushed by the snow feeding component into the snow throwing cylinder, which limits the direction of the snow exit through its internal channel. Snow can finally be thrown to the target snow throwing area at a preset angle through the guidance of the snow throwing cylinder, which does not affect the normal travel of pedestrians and vehicles, so as to achieve the purpose of clearing snow and avoiding snow blocking the road.
[0117] In the related art, ultra-wide band (UWB) tag wireless carrier communication is generally adopted to realize the positioning of the snowplow. Specifically, three mobile base stations with identification are used as the signal transmitting end, and the three mobile base stations are enclosed to form an electronic fence. The positioning rod of the snowplow is used as the signal receiving end. By obtaining the location information of the mobile base station, combining with the current driving speed, angular speed, direction and other information of the snow plow, the coordinates of the snow plow in the specified position are calculated. In this way, the internal program of the snow plow can realize the function of automatic snow removal by combining the obtained coordinate information with the path planning algorithm. The limitation of this technology is that the snow removal area is small (usually limited to 28 m28 m area), and because three mobile base stations with identification are required as electronic fences, and a snow removal plan can only sweep the area surrounded by an electronic fence, so if the user needs to sweep multiple areas, the mobile base station needs to be moved. The goal of completing multiple snow removal programs in a single setup is not achieved.
[0118] Based on the above defects of the related art, this embodiment provides an smart snow removal method. Specifically, the GPS-RTK positioning technology is the related art, which can realize the accurate positioning of the snow removal robot through satellite and signal assisted base station. Specifically, the internal algorithm of the snow removal robot can be adapted to the position signal returned by GPS-RTK, so that the target snow throwing area and target snow removal area can be set within the coverage area of the satellite. In order to obtain accurate longitude and latitude coordinates of the snow removal map, breaking through the current positioning method of the snow removal area restrictions.
[0119] After the snow removal map is obtained, the snow removal map can be divided into several grids, and a corresponding potential energy value is set for each grid through BFS algorithm. For example, as shown in
[0120] After the above potential field operation is completed, the snow removal robot can be controlled to start from any uncleaned grid with the highest current potential energy value (i.e., the uncleaned grid with a potential energy value of 8). When the snow removal robot finishes cleaning the grid, the grid will become cleaned (an electronic mark can be set at the corresponding position in the snow removal map to distinguish it from the grid in the uncleaned state). At this time, the snow removal robot will move to the next uncleaned grid with the highest current potential energy value (which can be an uncleaned grid with a potential energy value of 8 adjacent to the previous grid) and perform snow removal operations. It can be understood that when the snow removal robot has cleaned all grids with a potential energy value of 8, the uncleared grid with the highest current potential energy value becomes an uncleaned grid with a potential energy value of 7. At this time, the snow removal robot will move to the uncleaned grid with a potential energy value of 7 adjacent to the current grid to repeat the above cleaning and cruising operations. Based on the above path planning method, the travel path of the snow removal robot will be as shown in
[0121] Further, referring to
[0126] After rasterizing the snow removal map, it is necessary to determine whether each grid is located in the target snow removal area. Specifically, referring to
[0127] After all snow removal grids are determined by the above method, a basis can be provided for subsequent potential field operation to define the path for subsequent snow removal robots to travel in the target snow removal area.
[0128] Further, referring to
[0132] The coordinates of O, P.sub.i and P.sub.j can be obtained through GPS-RTK positioning technology. Based on the above-mentioned vector cross multiplication method, it is convenient to determine whether the sum of the angles between all the first auxiliary lines corresponding to the center point of the grid is equal to 360, thereby quickly determining the snow removal grid.
[0133] Further, referring to
[0140] Static obstacles are obstacles set at fixed positions in the target snow removal area. After the snow removal map is rasterized, it is necessary to determine the grid occupied by the static obstacle to prevent the snow removal robot from entering the grid and colliding with the static obstacle during the subsequent movement. Specifically, on the horizontal projection plane, the lines (i.e., the second auxiliary lines) between the four grid vertices D.sub.1, D.sub.2, D.sub.3 and D.sub.4 of the grid and the five vertices P.sub.1, P.sub.2, P.sub.3, P.sub.4 and P.sub.5 of the static obstacle area are shown in
[0141] After all static obstacle grids are determined by the above method, the static obstacle grids in the snow removal grid can be removed, so that the static obstacle grids do not participate in the subsequent potential field operation and cannot be assigned potential energy values. Referring to the planned path after removing the static obstacle grids in
[0142] Further, referring to
[0146] The coordinates of D, P.sub.i and P.sub.j can be obtained through GPS-RTK positioning technology. Based on the above-mentioned vector cross multiplication method, it is convenient to determine whether the sum of the angles between all the second auxiliary lines corresponding to the grid vertices is equal to 360, thereby quickly determining the static obstacle grid.
[0147] Further, referring to
[0152] Specifically, the above-mentioned preset range can be within the range of multiple grids centered on the snow removal robot, for example, within the range of eight grids centered on the snow removal robot. Referring to
[0153] Further, referring to
[0158] When multiple snow throwing grids are set, after the potential field operation is performed with multiple snow throwing grids as the starting point, the grid potential energy value distribution image is shown in
[0159] Further, referring to
[0165] The snow throwing strategy provided in this embodiment can ensure that the snow throwing direction is always toward the uncleaned grid whose potential energy value is less than the potential energy value of the grid where the snow removal robot is currently located, waiting for subsequent cleaning. As shown in
[0166] Further, in an embodiment, an uncleaned mark is set on the snow throwing grid and on the snow removal grid where the snow removal robot has not performed snow removal operation; and a cleared mark is set on the snow removal grid where the snow removal robot has completed snow removal operation.
[0167] By setting marks, the cleaning status of each grid can be recorded in real time to ensure the accuracy of path planning.
[0168] Further, in an embodiment, the traveling component is provided with a millimeter wave radar sensor device; [0169] the controlling the snow removal robot to travel along the snow removal grid to the nearest first target snow removal grid, to perform the snow removal operation on the first target snow removal grid includes: [0170] in response to the snow removal robot traveling toward the nearest first target snow removal grid, performing, by the millimeter wave radar sensor device, dynamic obstacle detection on a traveling path; [0171] in response to the millimeter wave radar sensor device detecting a dynamic obstacle in front of the snow removal robot, controlling the snow removal robot to stop traveling; [0172] obtaining, by the millimeter wave radar sensor device, a dynamic obstacle information, to mark the grid overlapping with the dynamic obstacle as a dynamic obstacle grid; and [0173] excluding the dynamic obstacle grid from the snow removal grid, and repeating the step of searching, with the snow removal robot as a center, whether there is a first target snow removal grid whose potential energy value is greater than or equal to the potential energy value of the grid where the snow removal robot is currently located within a preset range.
[0174] Further, in an embodiment, the traveling component is provided with a millimeter wave radar sensor device; and [0175] the controlling the snow removal robot to travel along the snow removal grid to the nearest second target snow removal grid, to perform the snow removal operation on the second target snow removal grid includes: [0176] in response to the snow removal robot traveling toward the nearest second target snow removal grid, performing, by the millimeter wave radar sensor device, dynamic obstacle detection on the traveling path; [0177] in response to the millimeter wave radar sensor device detecting the dynamic obstacle in front of the snow removal robot, controlling the snow removal robot to stop traveling; [0178] obtaining, by the millimeter wave radar sensor device, the dynamic obstacle information, to mark the grid overlapping with the dynamic obstacle as the dynamic obstacle grid; and [0179] excluding the dynamic obstacle grid from the snow removal grid, and repeating the step of searching, with the snow removal robot as the center, whether there is a second target snow removal grid whose potential energy value is less than the potential energy value of the grid where the snow removal robot is currently located within the preset range.
[0180] Dynamic obstacles are obstacles that temporarily appear in the target snow removal area during the movement of the snow removal robot. With the help of the millimeter wave radar sensor device, dynamic obstacles in the direction of the snow removal robot can be detected to control the snow removal robot to stop traveling in time to avoid collision. Through the combination of the millimeter wave radar sensor device and the GPS-RTK positioning technology, the specific coordinates and other information of the dynamic obstacles can be obtained, so that the dynamic obstacle grid can be determined by the above-mentioned angle method of determining the snow removal grid and the static obstacle grid. After determining the dynamic obstacle grid, the dynamic obstacle grid existing in the snow removal grid can be removed, and the above-mentioned path planning operation for the snow removal grid can be performed again based on the grid where the snow removal robot is currently located, so that the dynamic obstacle grid does not participate in the path planning operation. Since the travel path of the snow removal robot is always located on the snow removal grid with a potential energy value, after the dynamic obstacle grid is removed from the snow removal grid, the snow removal robot can be prevented from entering the dynamic obstacle grid during the movement and colliding, thereby further improving the automatic obstacle avoidance function of the snow removal robot.
[0181] Further, referring to
[0184] In an embodiment, referring to
[0189] The snow throwing drive device can be configured as a blade structure driven by a motor. The blade is driven by the motor to rotate continuously, the blade can receive the snow pushed by the snow feeding component and continuously throw the snow into the snow throwing cylinder 1 and the snow throwing cylinder cover 2 above, and finally throw the snow from the upper opening of the snow throwing cylinder cover 2. Since the upper opening of the snow throwing cylinder cover 2 has a certain inclination angle relative to the lower end of the snow throwing cylinder cover 2, the movement trajectory of the snow after being thrown is in a certain parabolic shape.
[0190] After obtaining the relative angle position between the grid where the snow removal robot is currently located and the actual snow throwing grid through GPS-RTK positioning technology, the first rotary drive device 5 can be controlled to move based on a preset program to drive the rotary base 7 to drive the snow throwing cylinder 1 to rotate on the horizontal plane (the snow throwing cylinder cover 2 also rotates with the snow throwing cylinder 1), so that the upper end opening of the snow throwing cylinder cover 2 points to the actual snow throwing grid in the horizontal direction, thereby achieving the adjustment of the horizontal snow throwing angle of the snow throwing cylinder cover 2. It can be understood that by setting the first preset angle, the horizontal snow throwing angle of the snow throwing cylinder cover 2 can be allowed to have a certain error; specifically, the first preset angle can be set to 5. When the horizontal angle between the direction of the upper end opening of the snow throwing cylinder cover 2 on the horizontal plane and the adjustment reference line is 5, it can be considered that the horizontal snow throwing angle of the snow throwing cylinder cover 2 has been adjusted to the right position.
[0191] After obtaining the straight-line distance between the grid where the snow removal robot is currently located and the actual snow throwing grid (i.e., the length of the adjustment reference line) through GPS-RTK positioning technology, the theoretical snow throwing inclination angle of the snow throwing cylinder cover 2 can be calculated by combining the straight-line distance with parameters such as the snow throwing speed. Based on the preset program, the second rotary drive device 6 is controlled to operate so as to drive the snow throwing cylinder cover 2 to rotate on the vertical plane through the connecting member 3, so that the angle between the upper end opening of the snow throwing cylinder cover 2 and the horizontal plane is equal to the calculated snow throwing inclination angle, thereby realizing the adjustment of the vertical snow throwing angle of the snow throwing cylinder cover 2.
[0192] Through the above operation, the purpose of adjusting the snow throwing angle in real time according to the different snow throwing areas is achieved.
[0193] Further, in an embodiment, the snow feeding component includes a snow feeding channel, a snow shovel, a snow feeding drive device, a lifting mechanism, an image sensor device and an image processing module; the snow feeding channel is connected to the snow throwing component, and the lifting mechanism is connected with the snow feeding channel; the snow shovel is provided at a snow inlet of the snow feeding channel, and the snow feeding drive device is connected to the snow shovel; the image sensor device is provided in the snow feeding channel, and the image processing module is electrically connected to the image sensor device and the lifting mechanism; and [0194] the performing the snow removal operation on an arrived grid includes: [0195] driving, by the snow feeding drive device, the snow shovel to cut external snow, and continuously feeding the external snow into the snow feeding channel; [0196] obtaining, by the image sensor device, a snow feeding image of the snow feeding channel, and transmitting the snow feeding image to the image processing module; [0197] determining, by the image processing module, whether a proportion of the snow in the snow feeding image exceeds a first preset proportion threshold, and whether the proportion of the snow in the snow feeding image is lower than a second preset proportion threshold; the first preset proportion threshold is higher than the second preset proportion threshold; [0198] in response to the proportion exceeding the first preset proportion threshold, driving, by the lifting mechanism, the snow feeding channel to go up; and [0199] in response to the proportion being less than the second preset proportion threshold, driving, by the lifting mechanism, the snow feeding channel to go down.
[0200] Through the above operation, the purpose of automatically adjusting the height of the snow feeding channel according to the amount of snow entering is achieved. Specifically, the first preset ratio threshold is set to 80%, and the second preset ratio threshold is set to 20%; if the calculated screen ratio of snow in the snow feeding image exceeds 80%, it means that the current amount of snow entering is large, the height of the snow feeding channel is low, and the height of the snow feeding channel needs to be appropriately increased; if the calculated screen ratio of snow in the snow feeding image is less than 20%, it means that the current amount of snow entering is small, the height of the snow feeding channel is high, and the height of the snow feeding channel needs to be appropriately lowered.
[0201] Further, in an embodiment, the snow inlet is provided with an infrared sensor device electrically connected to the snow feeding drive device; and [0202] after the driving, by the snow feeding drive device, the snow shovel to cut the external snow, and continuously feeding the external snow into the snow feeding channel, the method includes: [0203] obtaining, by the infrared sensor device, a temperature signal at the snow inlet; and [0204] in response to a fluctuation value of the temperature signal exceeding a preset temperature threshold, controlling the snow feeding drive device to stop working.
[0205] Based on the consideration that the temperature of the living body is significantly higher than the temperature of the snow, this embodiment uses an infrared sensor device to detect the snow inlet. When the temperature signal acquired by the infrared sensor device fluctuates greatly, it means that the user's body parts or small animals appear at the snow inlet and may be involved in the snow inlet. At this time, the snow drive device can be controlled to stop working in time based on the preset program (for example, turning off the drive motor to stop the snow shovel from rotating) to prevent unnecessary dangers, thus improving the safety performance of the snow removal robot.
[0206] Further, in an embodiment, the snow shovel is made of rubber.
[0207] Setting the snow shovel to rubber material can help increase the tolerance and permeability of the snow shovel, adapt to different road conditions, and improve the safety factor during cutting ice and snow.
[0208] Referring to
[0213] Since the snow removal robot adopts all the technical solutions of all the embodiments of the above-mentioned smart snow removal method, it at least has all the beneficial effects brought by the technical solutions of the above-mentioned embodiments, which will not be described one by one here.
[0214] The present application also provides a smart snow removal equipment, which includes a controller and a memory. The memory stores at least one instruction or at least one program loaded and executed by the controller to implement the above-mentioned smart snow removal method.
[0215] Since the smart snow removal equipment adopts all the technical solutions of all the embodiments of the above-mentioned smart snow removal method, it at least has all the beneficial effects brought by the technical solutions of the above-mentioned embodiments, which will not be described one by one here.
[0216] It should be noted that if there are directional indications (such as up, down, left, right, front, back, etc.) in the embodiments of the present application, the directional indications are only used to explain the relative position relationship and movement of the components in a certain posture. If the specific posture changes, the directional indication will also change accordingly.
[0217] In addition, if there are descriptions involving first, second, etc. in the embodiments of the present application, the descriptions of first, second, etc. are only for descriptive purposes and cannot be understood as indicating or implying their relative importance or implicitly indicating the number of technical features indicated. Therefore, the features limited to first and second can explicitly or implicitly include at least one of the features. In addition, if and/or appears in the full text, its meaning includes three parallel schemes. Taking A and/or B as an example, it includes scheme A, or scheme B, or schemes that A and B meet at the same time. In addition, the technical solutions between the various embodiments can be combined with each other, but it must be based on the ability of those skilled in the art to implement. When the combination of technical solutions is contradictory or cannot be implemented, it should be considered that such a combination of technical solutions does not exist and is not within the scope of protection required by the present application.
[0218] According to the disclosure and teaching of the above description, those skilled in the art of the present application may also change and modify the above implementation. Therefore, the present application is not limited to the specific implementation disclosed and described above, and some modifications and changes to the present application should also fall within the scope of protection of the claims of the present application. In addition, although some specific terms are used in this specification, these terms are only for the convenience of description and do not constitute any limitation to the present application.