The present invention relates generally to a robotic mower for performing navigation and a method for navigating the robotic mower. The present invention also relates to a computer program implementing the method.
Self-propelled robotic mowers have become more and more popular and are now widely used to cut grass within a predetermined work area. The work area is typically limited by boundary wires to ensure that the robotic mower does not move outside the work area and in order to prevent that the robotic mower, objects or living beings get damaged or injured. In newer versions of robotic mowers there are no longer any need for boundary wires. Instead, the robotic mower is provided with a positioning unit used to determine the position of the robotic mower and the robotic mower is allowed to move within a boundary of a predefined work area. If the position obtained by the positioning unit cannot be reliably obtained the robotic mower is stopped as a safety measure.
One example of such a robotic mower is described in WO2020143972, which discloses a method in which a distance from a position determined by a positioning unit of the robotic mower to the boundary is estimated as a boundary distance. The boundary distance is used to set a maximum dead reckoning navigating distance. If a new reliable position cannot be determined before the maximum dead reckoning navigating distance has been reached a safety operation is initiated.
Even if WO2020143972 solves some of the problems of securely keeping the robotic mower within a work area there are still improvements to be made. Especially when it comes to increasing the accuracy of determining the position of the robotic mower and decreasing the maximum dead reckoning distance which the robotic mower needs to travel when position cannot be reliably obtained.
Thus, there is a need for a more accurate and robust solution for navigating the robotic mower when there is uncertainty in determining the position of the robotic mower.
An objective of the present invention is to accomplish a more accurate and robust navigation for a robotic mower when there is an uncertainty in determining the position with a positioning unit.
According to an aspect of the invention a method for navigating a robotic mower within a work area is disclosed. The work area is limited by a boundary and the method comprises, repeatedly determining a position of the robotic mower by means of a positioning unit provided in or arranged on the robotic mower, navigating the robotic mower within the work area based on the determined position, determining that a new position of the robotic mower cannot be accurately obtained, determining a position uncertainty distance based on the positions obtained by the positioning unit and a dead reckoning sensor provided in the robotic mower, calculating a distance to the closest boundary, determining a navigation margin as the difference between the distance to the closest boundary and the position uncertainty distance, and executing a safety operation if the navigation margin equals a predetermined value.
In another embodiment of the method further comprises the steps of generating a trajectory of the positions determined by the positioning unit while the robotic mower navigates, generating a trajectory of the positions determined by the dead reckoning sensor while the robotic mower navigates, aligning by moving at least one of the generated trajectories within a 2D or 3D coordinate system for minimisation of the distance between the trajectories resulting in aligned trajectories, calculating a metric of difference between the aligned trajectories for quantifying the alignment quality of the aligned trajectories, and determining the position uncertainty distance as the metric of difference between the aligned trajectories.
In yet another embodiment the position determined by the positioning unit is determined by using any one of Real-Time Kinematic, RTK, Global Positioning System, GPS, and Differential Global Navigation Satellite Systems, DGNSS, or any combination thereof.
In another embodiment of the method further comprises repeatedly determining a position of an RTK base station with a positioning unit provided in the RTK base station, and wherein determining the position of the RTK base station with the positioning unit is performed with a fixed time interval of between 5 to 15 seconds.
In yet another embodiment of the method the determining of the position of the robotic mower with the positioning unit and the dead reckoning sensor is performed with a fixed frequency of 8 to 12 Hz, preferably with a fixed frequency of 10 Hz.
In one embodiment of the method executing the safety operation comprises any one of, stopping the robotic mower to move, stopping the robotic mower to move more than a robotic mower length outside the boundary, and reversing or turning the robotic mower for navigating the robotic mower in the direction from the boundary, or any combination thereof.
In yet another embodiment of the method the distance to the closest boundary is the distance between the position determined by the positioning unit and any one of, the substantially closest point on the closest boundary, the substantially closest point on the closest boundary in the mowing direction of the robotic mower, and the substantially closest point on the closest boundary that the robotic mower risks traversing based on a preplanned trajectory, or any combination thereof.
According to another aspect of the invention a robotic mower for performing navigating within a work area is disclosed. The work area is limited by a boundary and the robotic mower comprises a positioning unit, a dead reckoning sensor, a controller comprising a processor and a memory, wherein the memory comprises instructions which when executed by the processer causes the mower to: repeatedly determine a position of the robotic mower by means of the positioning unit, navigate the robotic mower within the work area based on the determined position, determine that a new position of the robotic mower cannot be accurately obtained, determine a position uncertainty distance based on the positions obtained by the positioning unit and the dead reckoning sensor, calculate a distance to the closest boundary, determine a navigation margin as the difference between the distance to the closest boundary and the position uncertainty distance, and execute a safety operation if the navigation margin equals a predetermined value.
In an embodiment the robotic mower is further configured to generate a trajectory of the positions determined by the positioning unit while the robotic mower navigates, generate a trajectory of the positions determined by the dead reckoning sensor while the robotic mower navigates, align by moving at least one of the generated trajectories within a 2D or 3D coordinate system for minimisation of the distance between the trajectories resulting in aligned trajectories, calculate a metric of difference between the aligned trajectories for quantifying the alignment quality of the aligned trajectories, and determine the position uncertainty distance as the metric of difference between the aligned trajectories.
In yet another embodiment the positioning unit is any one of a Real-Time Kinematic, RTK, positioning unit, a Global Positioning System, GPS, positioning unit and a Differential Global Navigation Satellite Systems, DGNSS, positioning unit or any combination thereof.
In an embodiment the robotic mower is further configured to repeatedly determine, with a fixed time interval of between 5 to 15 seconds, a position of an RTK base station with a positioning unit provided in the RTK base station.
In another embodiment the robotic mower is further configured to determine the position of the robotic mower with the positioning unit and the dead reckoning sensor using a fixed frequency of 8 to 12 Hz, preferably using a fixed frequency of 10 Hz.
In yet another embodiment the robotic mower is further configured to execute the safety operation according to any one of stopping the robotic mower to move, stopping the robotic mower to move more than a robotic mower length outside the boundary, and reversing or turning the robotic mower for navigating the robotic mower in the direction from the boundary or any combination thereof.
In another embodiment the distance to the closest boundary is the distance between the position determined by the positioning unit and any one of the substantially closest point on the closest boundary, the substantially closest point on the closest boundary in the mowing direction of the robotic mower, and the substantially closest point on the closest boundary that the robotic mower risks traversing based on a preplanned trajectory or any combination thereof.
According to another aspect of the invention a computer program is disclosed, comprising computer program code, wherein the computer program code is adapted, if executed by the processer of the controller, to implement the methods described above.
Thus, by determining a position uncertainty distance and using this information and the distance to the boundary a safe and reliable navigation of the robotic mower is executed.
Furthermore, by using information from both the positioning unit and the dead reckoning sensor when determining the position uncertainty distance it is possible to achieve a more accurate and robust navigation for the robotic mower, which in the end also leads to a more efficient mowing process.
Moving at least one of the generated trajectories may be conducted by rotating and/or translating at least one of the generated trajectories within said 2D or 3D coordinate system.
Three examples of common methods, among others, for calculating the metric of difference and the minimisation of the distance between the trajectories are root mean square error, using the maximum distance between any of the corresponding pairs of the positions determined by the positioning unit and the dead reckoning sensor respectively, and using the distance between the last corresponding pair of the positions determined by the positioning unit and the dead reckoning sensor respectively.
The invention will now be described, by way of example, with reference to the accompanying drawings, in which:
The positioning unit 8 may use any wireless technique to the determine the position of the robotic mower 2, but is preferably a Real-Time Kinematic, RTK, unit, a Global Positioning System, GPS, unit, or a Differential Global Navigation Satellite Systems, DGNSS, unit or any suitable combination thereof.
In the vicinity to the work area 4, there is also an RTK base station 22 provided with a positioning unit for determining the position of the RTK base station 22. As is well known in the art the RTK base station 22 can communicate wirelessly with the positioning unit 8 provided in the robotic mower 2 for communication of information there in between, such as information about the position of the RTK base station to the robotic mower 2. The robotic mower may also be able to communicate wirelessly with an external database 20. Such a database 20 can be provided as a cloud service or provided in a server connected to the RTK base station 22.
Turning now to
In step S102 the robotic mower 2 is navigated within the work area 4 based on the determined position. In step S104 it is determined that a new position of the robotic mower 2 cannot be accurately obtained. There can be many reasons that the position cannot be accurately obtained. For example, the RTK, GPS or DGNSS coverage may be poor due to trees or other obstacles blocking the wireless signal or the wireless signal quality is poor. Thus, if the controller 12 in the robotic mower 2 determines in step S104 that the position cannot be obtained accurately enough a position uncertainty distance R is calculated in step S106. The decision that the position is not accurate enough may be based on different thresholds for the signals received by the positioning unit 8, which is believed to be known to a person skilled in the art.
In step S106 the position uncertainty distance R is determined by the controller 12 based on both the positions obtained by the positioning unit 8 and the positions obtained by the dead reckoning sensor 10.
The position uncertainty distance R can be seen in
The determination of the position uncertainty distance R in step S106 is based on the positions obtained by the positioning unit 8 and the dead reckoning sensor 10 provided in the robotic mower 2.
The position uncertainty distance R in step S106 may be calculated using different methods. In
The positions obtained by the dead reckoning sensor 10 is as the positioning unit 8 also made repeatedly, and may be made with the same frequency as the positioning unit 8. The dead reckoning sensor 10 may determine the position of the robotic mower 2 with a fixed frequency of 8 to 12 Hz. The dead reckoning sensor 10 may also determine the position of the robotic mower 2 with a fixed frequency of 10 Hz.
In step S108 a distance D to the closest boundary is calculated. The distance D to the closest boundary 6 may be the distance between the position determined by the positioning unit 8 and any one of the substantially closest point on the closest boundary 6, the substantially closest point on the closest boundary 6 in the mowing direction of the robotic mower 2, and the substantially closest point on the closest boundary 6 that the robotic mower 2 risks traversing based on a preplanned trajectory or any combination thereof.
In step S110 a navigation margin is determined as the difference between the distance D to the closest boundary 6 and the position uncertainty distance R. The navigation margin, D-R, is to be understood as the maximum distance the robotic mower 2 can travel when it has been determined that a new position of the robotic mower 2 cannot be accurately obtained, taking the distance to the boundary and the position uncertainty distance into account.
In step S112 a safety operation is executed if the navigation margin, D-R, equals the predetermined value and no accurate position can be obtained by the positioning unit 8. The robotic mower 2 continues to navigate until the navigation margin, D-R, equals the predetermined value and no accurate position can be obtained by the positioning unit 8 or a new position from the positioning unit 8 can be accurately obtained. If a new position from the positioning unit 8 can be accurately obtained the operation of the robotic mower 2 can be continued since the robotic mower 2 with the accurately obtained position safely can be controlled within the work area 4.
The execution of the safety operation may be done in different ways. In one embodiment executing the safety operation comprises to either stop the robotic mower 2 to move, to stop the robotic mower 2 to move more than a robotic mower 2 length outside the boundary, or to reverse or turn the robotic mower 2 for navigating the robotic mower 2 in the direction from the boundary 6. These three safety operations could be combined in any way.
To further increase the accuracy in determining the position of the robotic mower 2, the position data of the RTK base station 22 can be used to determine the accuracy of the position obtained by the positioning unit 8 in the robotic mower. Thus, the controller 12 of the robotic mower 2 may in an optional step, S114, repeatedly determine the position of the RTK base station 22 by requesting this information from the RTK base station 22. This time interval for such requests is preferably once every 5 to 15 seconds, and most preferably once every 10 seconds.
The present invention relates to a robotic mower that performs the methods described above, i.e. navigating within a work area 4, wherein the work area 4 is limited by a boundary 6. The robotic mower 2 comprising a positioning unit 8, a dead reckoning sensor 10, a controller 12 comprising a processor 14 and a memory 16, the memory 16 comprising instructions which when executed by the processer 14 causes the mower to: repeatedly determine a position of the robotic mower 2 by means of the positioning unit 8, navigate the robotic mower 2 within the work area 4 based on the determined position, determine that a new position of the robotic mower 2 cannot be accurately obtained, determine a position uncertainty distance R based on the positions obtained by the positioning unit 8 and the dead reckoning sensor 10, calculate a distance D to the closest boundary 6, determine a navigation margin as the difference between the distance D to the closest boundary 6 and the position uncertainty distance R, and execute a safety operation if the navigation margin equals a predetermined value.
The method executes a safety operation if the navigation margin equals a predetermined value, otherwise it may continue navigating the robotic mower.
The predetermined value could equal zero. It could also equal any positive value, which would result in the robotic mower 2 keeping a safety distance to the boundary 6. It could also equal any negative value, which would imply that the robotic mower 2 would surpass the boundary 6.
Furthermore, the robotic mower 2 is also configured to perform all of the different embodiments of the method for navigating the robotic mower 2 as they have been described above and are therefore not repeated again.
The present invention also relates to a computer program 18, see
Although the description above contains a plurality of specificities, these should not be construed as limiting the scope of the concept described herein but as merely providing illustrations of some exemplifying embodiments of the described concept. It will be appreciated that the scope of the presently described concept fully encompasses other embodiments which may become obvious to those skilled in the art, and that the scope of the presently described concept is accordingly not to be limited. Reference to an element in the singular is not intended to mean “one and only one” unless explicitly so stated, but rather “one or more.” Further, the term “a number of”, such as in “a number of wireless devices” signifies one or more devices. All structural and functional equivalents to the elements of the above-described embodiments that are known to those of ordinary skill in the art are expressly incorporated herein by reference and are intended to be encompassed hereby. Moreover, it is not necessary for an apparatus or method to address each and every problem sought to be solved by the presently described concept, for it to be encompassed hereby. In the exemplary figures, a broken line generally signifies that the feature within the broken line is optional.
The present application is a Continuation Application of PCT Application No. PCT/CN2023/126061 filed on Oct. 24, 2023, the contents of which are incorporated herein by reference in their entirety.
Number | Date | Country | |
---|---|---|---|
Parent | PCT/CN2023/126061 | Oct 2023 | WO |
Child | 19010158 | US |