Positioning method for mowing robot, electronic device and computer-readable storage medium

By integrating wheel speed data and satellite navigation data/inertial positioning data, and using Kalman filtering algorithm and other methods, the positioning accuracy of the mowing robot is improved, the problem of interference in positioning accuracy is solved, and the path planning accuracy of lawn maintenance operations is ensured.

WO2024245386A1PCT designated stage expired Publication Date: 2024-12-05YOSEMITE SHANGHAI ROBOTICS CO LTD

Patent Information

Application Number
PCT/CN2024/096593
Authority / Receiving Office
WO · WO
Patent Type
Applications
Current Assignee / Owner
Priority Date
2023-06-02
Filing Date
2024-05-31
Publication Date
2024-12-05

AI Technical Summary

Technical Problem

The positioning accuracy of the mowing robot is affected by factors such as building shading and atmospheric interference, resulting in the drift of satellite positioning signals and low accuracy.

Method used

By integrating wheel speed data and satellite navigation data/inertial positioning data, and using methods such as Kalman filtering algorithms, the first position information and the second position information are closely coupled to improve positioning accuracy.

Benefits of technology

When the satellite positioning signal is disturbed, it can ensure high positioning accuracy and ensure the accuracy of dynamic path planning of the mowing robot during lawn maintenance operations.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN2024096593_05122024_PF_FP_ABST
    Figure CN2024096593_05122024_PF_FP_ABST
Patent Text Reader

Abstract

A positioning method for a mowing robot, an electronic device, and a computer-readable storage medium. The method comprises: determining first position information of a mowing robot (S101), the first position information being related to wheel speed data of the mowing robot; determining second position information of the mowing robot (S102), the second position information being related to satellite navigation data and / or inertial positioning data of the mowing robot; and fusing the first position information and the second position information, so as to determine current position information of the mowing robot (S103). Determining the first position information of the mowing robot and the second position information of the mowing robot makes data preparations for determining the current position information of the mowing robot. Fusing the first position information and the second position information enables the first position information and the second position information to be tightly coupled. Therefore, the current position information of the mowing robot is more accurate, thus improving the positioning precision of the mowing robot.
Need to check novelty before this filing date? Find Prior Art

Description

Positioning method of lawn mowing robot, electronic device and computer-readable storage medium

[0001] This application claims priority to Chinese Patent Application No. 2023106546032, filed with the State Intellectual Property Office on June 2, 2023, entitled “Positioning Method, Electronic Device, and Computer-Readable Storage Medium for Lawn Mowing Robot,” the entire contents of which are incorporated herein by reference. Technical Field

[0002] The present application relates to the technical field of lawn mowing robots, and in particular to a positioning method, electronic device, and computer-readable storage medium for a lawn mowing robot. Background Art

[0003] A lawnmower robot is a comprehensive robotic system that integrates multiple functions, including environmental perception, dynamic path planning, and behavioral control, freeing users from the tedious task of lawn maintenance. Therefore, to achieve dynamic path planning for lawn maintenance operations, the positioning of the lawnmower robot is crucial.

[0004] Currently, mobile base stations are used to obtain satellite positioning signals, and positioning is verified using carrier phase real-time kinematic (RTK) base station calibration information. These mobile base stations are installed on robotic lawn mowers. However, factors such as building obstruction and atmospheric interference can affect satellite positioning signals, causing the robotic lawn mower to drift and resulting in low positioning accuracy.

[0005] Summary of the Invention

[0006] In view of the above problems, embodiments of the present application provide a positioning method, an electronic device, and a computer-readable storage medium for a lawn mowing robot, which can improve positioning accuracy.

[0007] According to a first aspect of an embodiment of the present application, a positioning method for a lawn mowing robot is provided, the method comprising:

[0008] determining first position information of the lawn mowing robot, where the first position information is related to wheel speed data of the lawn mowing robot;

[0009] determining second position information of the lawn mowing robot, where the second position information is related to satellite navigation data and / or inertial positioning data of the lawn mowing robot;

[0010] The first position information and the second position information are fused to determine the current position information of the lawn mowing robot.

[0011] The above method determines the first position information and the second position information of the lawn mowing robot, and can provide data sources for determining the current position information of the lawn mowing robot from multiple dimensions.

[0012] Based on this, the first position information and the second position information are fused and processed so that the first position information and the second position information are tightly coupled, thereby making the current position information of the lawn mower robot more accurate, which can improve the positioning accuracy of the lawn mower robot and is conducive to ensuring a high positioning accuracy when the satellite positioning signal is interfered with.

[0013] In an optional manner, fusing the first position information and the second position information to determine the current position information of the lawn mowing robot includes:

[0014] The first position information and the second position information are fused using a Kalman filter algorithm to obtain position estimation information;

[0015] The estimated position information is determined as the current position information of the lawn mowing robot.

[0016] The above method uses the existing Kalman filter algorithm to fuse the first position information and the second position information to obtain position estimation information, and determines the position estimation information as the current position information of the lawn mowing robot, which can achieve more accurate position information calculation at a lower cost.

[0017] In an optional manner, the first position information and the second position information are fused using a Kalman filter algorithm to obtain position estimation information, including:

[0018] Obtaining a first covariance and a second covariance, wherein the first covariance is related to the wheel speed data, and the second covariance is related to the satellite navigation data and / or the inertial positioning data;

[0019] Determine a third covariance based on the first covariance and the covariance of the position information corresponding to the previous moment of the first position information, where the third covariance is the covariance of the first position information;

[0020] determining a Kalman gain based on the third covariance and the second covariance;

[0021] Position estimation information is determined based on the first position information, the second position information, and the Kalman gain.

[0022] The above method obtains the first covariance and the second covariance, and determines the third covariance based on the first covariance and the covariance of the position information corresponding to the previous moment of the first position information. Then, the Kalman gain is determined based on the third covariance and the second covariance. The embodiment of the present application simplifies the Kalman filter algorithm to determine the position estimate information based on the first position information, the second position information, and the Kalman gain, thereby improving the computational efficiency of the fusion.

[0023] In an optional manner, the method further includes:

[0024] Determine a fourth covariance according to the third covariance and the Kalman gain, where the fourth covariance is the covariance of the position information corresponding to a moment after the first position information;

[0025] Store the fourth covariance.

[0026] The above method uses the third covariance and the Kalman gain to determine a fourth covariance, which is the covariance of the position information corresponding to the moment after the first position information. The fourth covariance is then stored. In this way, the Kalman filter algorithm can perform autoregressive operations to determine the current position of the lawn mower robot in real time.

[0027] In an optional manner, fusing the first position information and the second position information to determine the current position information of the lawn mowing robot includes:

[0028] determining a residual term based on the first position information and the second position information;

[0029] Based on the residual term, construct the cost function;

[0030] According to the cost function, the current position information of the mowing robot is obtained.

[0031] The above method determines a residual term using the first and second position information, and then constructs a cost function based on the residual term. The cost function then determines the current position of the robot mower. By optimizing the constraints of the first and second position information, the current position is determined with high accuracy.

[0032] In an optional manner, the left wheel of the lawn mower robot is provided with a left wheel speedometer, and the right wheel of the lawn mower robot is provided with a right wheel speedometer;

[0033] Determining first position information of the lawn mowing robot includes:

[0034] The wheel speed information of the left wheel is determined by a left wheel speed meter, and the wheel speed information of the left wheel is related to the linear speed;

[0035] The wheel speed information of the right wheel is determined by the right wheel speed meter, and the wheel speed information of the right wheel is related to the linear speed;

[0036] Dead reckoning is performed on the wheel speed information of the left wheel and the wheel speed information of the right wheel to obtain first position information.

[0037] The above method determines the wheel speed information of the left wheel through the left wheel speed meter and the wheel speed information of the right wheel through the right wheel speed meter, and then performs track calculation on the wheel speed information of the left wheel and the wheel speed information of the right wheel to obtain the first position information, thereby preparing data for the fusion processing of the first position information and the second position information.

[0038] In an optional manner, determining the wheel speed information of a wheel by a wheel speed meter on a wheel of the lawn mowing robot includes:

[0039] Get the number of pulses output by the wheel speed meter within the sampling interval;

[0040] The wheel speed information is obtained based on the sampling interval, the number of pulses and the attribute information of the wheel.

[0041] In an optional manner, performing dead reckoning on the wheel speed information of the left wheel and the wheel speed information of the right wheel to determine the first position information includes:

[0042] Get the heading angle of the lawn mower robot;

[0043] Determine the travel distance of the left wheel based on the wheel speed information and sampling interval of the left wheel;

[0044] Determine the moving distance of the right wheel based on the wheel speed information of the right wheel and the sampling interval;

[0045] The first position information is obtained according to the heading angle of the lawn mowing robot, the moving distance of the left wheel, and the moving distance of the right wheel.

[0046] The above method determines the moving distance of the left wheel and the moving distance of the right wheel, and prepares data for obtaining the first position information.

[0047] Based on this, the first position information can be obtained according to the heading angle of the lawn mowing robot, the moving distance of the left wheel, and the moving distance of the right wheel.

[0048] According to a second aspect of the present application, a positioning device for a lawn mowing robot is provided, the device comprising:

[0049] a first determining module, configured to determine first position information of the lawn mowing robot, where the first position information is related to wheel speed data of the lawn mowing robot;

[0050] a second determining module, configured to determine second position information of the lawn mowing robot, where the second position information is related to satellite navigation data and / or inertial positioning data of the lawn mowing robot;

[0051] The fusion module is used to fuse the first position information and the second position information to determine the current position information of the lawn mowing robot.

[0052] According to a third aspect of the embodiments of the present application, an electronic device is provided, including a memory and a processor. The memory stores a computer program, and when the processor executes the computer program, the positioning method of the lawn mowing robot of the previous embodiment is implemented.

[0053] According to a fourth aspect of the embodiments of the present application, a computer storage medium is provided, wherein the storage medium stores at least one executable instruction, and the executable instruction enables a processor to execute the positioning method of the lawn mowing robot of the embodiment.

[0054] The above description is only an overview of the technical solutions of the embodiments of the present application. In order to more clearly understand the technical means of the embodiments of the present application, they can be implemented in accordance with the contents of the specification. In order to make the above and other purposes, features and advantages of the embodiments of the present application more obvious and easy to understand, the specific implementation methods of the present application are listed below. BRIEF DESCRIPTION OF THE DRAWINGS

[0055] FIG1 is a structural block diagram of a lawn mowing robot provided in an embodiment of the present application;

[0056] FIG2 is a schematic flow chart of a positioning method for a lawn mowing robot provided in an embodiment of the present application;

[0057] FIG3 is a schematic flow chart of a positioning method for a lawn mowing robot provided in an embodiment of the present application;

[0058] FIG4 is a schematic flow chart of a positioning method for a lawn mowing robot provided in an embodiment of the present application;

[0059] FIG5 is a schematic flow chart of a positioning method for a lawn mowing robot provided in an embodiment of the present application;

[0060] FIG6 is a schematic flow chart of a positioning method for a lawn mowing robot provided in an embodiment of the present application;

[0061] FIG7 is a schematic flow chart of a positioning method for a lawn mowing robot provided in an embodiment of the present application;

[0062] FIG8 is a schematic structural diagram of a positioning device for a lawn mowing robot provided in an embodiment of the present application. DETAILED DESCRIPTION

[0063] To make the purpose, technical solutions, and advantages of the embodiments of this application more clear, the technical solutions in the embodiments of this application will be clearly and completely described below in conjunction with the drawings in the embodiments of this application. Obviously, the described embodiments are part of the embodiments of this application, not all of the embodiments. Based on the embodiments in this application, all other embodiments obtained by ordinary technicians in this field without making creative efforts are within the scope of protection of this application.

[0064] Unless otherwise defined, all technical and scientific terms used herein have the same meaning as commonly understood by those skilled in the art to which this application belongs; the terms used in the specification of the application are only for the purpose of describing specific embodiments and are not intended to limit this application; the terms "including" and "having" and any variations thereof in the specification, claims and drawings of this application are intended to cover non-exclusive inclusions.

[0065] References to "embodiments" herein mean that a particular feature, structure, or characteristic described in connection with the embodiments may be included in at least one embodiment of the present application. The appearance of the phrase "embodiment" in various places in the specification does not necessarily refer to the same embodiment, nor does it necessarily refer to independent or alternative embodiments that are mutually exclusive of other embodiments. It is understood, both explicitly and implicitly, by those skilled in the art that the embodiments described herein may be combined with other embodiments.

[0066] The term "and / or" in this document simply describes a relationship between related objects, indicating that three possible relationships exist. For example, "A and / or B" can mean: A exists, A and B exist, and B exists. Additionally, the character " / " in this document generally indicates that the related objects are in an "or" relationship.

[0067] In addition, the terms "first", "second", etc. in the description and claims of this application or the above-mentioned drawings are used to distinguish different objects, rather than to describe a specific order, and may explicitly or implicitly include one or more such features.

[0068] In the description of this application, unless otherwise specified, "plurality" means more than two (including two), and similarly, "multiple groups" means more than two (including two).

[0069] The following introduces the system architecture involved in the embodiments of this application.

[0070] Referring to Figure 1, a block diagram of a lawn mower robot provided in an embodiment of the present application is provided. As shown in Figure 1, the lawn mower robot 100 includes at least a mowing component 110, a mobile component 120, a processor 130, a sensor 140, and a memory 150. The lawn mower robot 100 may also include a communication module 170 and a bus 160. The mowing component 110, mobile component 120, processor 130, sensor 140, memory 150, and communication module 170 can communicate with each other via bus 160.

[0071] The mowing assembly 110 is used to perform mowing operations, and the mowing assembly 110 includes at least a cutterhead and a cutterhead driving structure.

[0072] The moving assembly 120 is used to realize the moving operation of the lawn mowing robot 100. The moving assembly 120 at least includes wheels and a wheel driving structure. The wheels include a left wheel and a right wheel.

[0073] The sensor 140 may be used to obtain wheel speed data and may also be used to obtain inertial positioning data.

[0074] The communication module 170 can be used to obtain satellite navigation data and can also be used to communicate with external devices. The processor 130 can call the logic instructions in the memory 150 to execute the positioning method of the lawn mowing robot in the following embodiment.

[0075] The processor 130 , the sensor 140 , and the memory 150 may each include one or multiple integrated components, which is not specifically limited in the embodiments of the present application.

[0076] In addition, the logic instructions in the memory 150 can be implemented in the form of software function modules and can be stored in a computer-readable storage medium when sold or used as an independent product.

[0077] Based on the above description, the positioning method of the lawn mower robot provided in the embodiment of the present application is executed by the software module and / or hardware module of the lawn mower robot. For the sake of simplicity, the positioning method of the lawn mower robot provided in the embodiment of the present application is described in detail below with reference to the accompanying drawings, taking the lawn mower robot as an example.

[0078] Referring to Figure 2, Figure 2 is a flow chart of a positioning method for a lawn mowing robot provided in an embodiment of the present application. As shown in Figure 2, the method includes the following steps:

[0079] S101: Determine first position information of a lawn mowing robot.

[0080] The first position information is related to the wheel speed data of the lawn mowing robot.

[0081] The wheel speed data of the lawn mower robot includes: the linear speed of the wheels of the lawn mower robot, the angular speed of the wheels of the lawn mower robot, and the heading angle of the lawn mower robot.

[0082] The heading angle of the lawn mower robot refers to the angle at which the lawn mower robot rotates.

[0083] The lawn mower robot uses a wheel speed meter to obtain wheel speed data of the lawn mower robot. The wheel speed meter can be a Hall-type wheel speed sensor or a magnetoelectric wheel speed sensor. This application does not make specific restrictions on this.

[0084] In the embodiment of the present application, the wheel speedometer includes a left wheel speedometer and a right wheel speedometer. The left wheel of the lawn mower robot is provided with a left wheel speedometer, and the right wheel of the lawn mower robot is provided with a right wheel speedometer.

[0085] Thus, the lawn mower robot obtains first position information based on the wheel speed data of the lawn mower robot, wherein the first position information includes: a first coordinate of the current position of the lawn mower robot.

[0086] The first coordinate is represented by (X1, Y1). X1 is the distance from the initial position to the origin in the X-axis direction. Y1 is the distance from the initial position to the origin in the Y-axis direction.

[0087] Therefore, with the help of the first position information of the lawn mowing robot, data preparation can be done for determining the current position information of the lawn mowing robot.

[0088] S102: Determine second position information of the lawn mowing robot.

[0089] The second position information is related to satellite navigation data and / or inertial positioning data of the lawn mowing robot.

[0090] The lawn mower robot obtains satellite navigation data through the Global Navigation Satellite System (GNSS), which includes the longitude, latitude, altitude, and location of the lawn mower robot.

[0091] The mowing robot acquires inertial positioning data through an inertial measurement unit (IMU), which includes linear acceleration measured by an accelerometer and angular velocity measured by a gyroscope.

[0092] Thus, the lawn mower robot can obtain the second position information based on the lawn mower robot's satellite navigation data. Alternatively, the lawn mower robot can obtain the second position information based on inertial positioning data. Alternatively, the lawn mower robot can obtain the second position information based on the lawn mower robot's satellite navigation data and inertial positioning data. The second position information includes: the second coordinate of the lawn mower robot's current position.

[0093] The second coordinate is represented by (X2, Y2, Z2). X2 is the distance from the initial position to the origin in the X-axis direction. Y2 is the distance from the initial position to the origin in the Y-axis direction. Z2 is the distance from the initial position to the origin in the Z-axis direction.

[0094] Therefore, with the help of the second position information of the lawn mowing robot, data preparation can be done for determining the current position information of the lawn mowing robot.

[0095] It should be noted that there is no temporal order between S101 and S102, and S102 and S103 can be executed simultaneously or sequentially.

[0096] S103: Fusing the first position information and the second position information to determine the current position information of the lawn mowing robot.

[0097] The lawn mowing robot can use a variety of implementation methods such as a Kalman filter algorithm or a cost function minimization algorithm to fuse the first position information and the second position information.

[0098] The Kalman filter algorithm uses a linear system state equation and observational data from the system's input and output to optimally estimate the system's state. Based on this, the lawn mower robot can use the first and second position information as inputs to the system corresponding to the Kalman filter algorithm to obtain position estimation information. This position estimation information can be the optimized output value of the aforementioned system.

[0099] The cost function is a crucial machine learning parameter used to accurately estimate the model. During optimization, the machine learning model aims to minimize the cost function. Based on this, the robot lawnmower can determine the fitted value corresponding to the minimized cost function as its current position.

[0100] The current position information includes the third coordinate of the robot's current position. The third coordinate is represented by (X3, Y3). X3 is the distance from the initial position to the origin in the X-axis direction. Y3 is the distance from the initial position to the origin in the Y-axis direction.

[0101] The positioning method of the lawn mower robot provided in the present application determines the first position information and the second position information of the lawn mower robot, and can provide a data source for determining the current position information of the lawn mower robot from multiple dimensions.

[0102] Based on this, the first position information and the second position information are fused and processed so that the first position information and the second position information are tightly coupled, thereby making the current position information of the lawn mower robot more accurate, which can improve the positioning accuracy of the lawn mower robot and is conducive to ensuring a high positioning accuracy when the satellite positioning signal is interfered with.

[0103] Based on the description of the above embodiment and in combination with FIG. 3 , a specific implementation method of the lawn mowing robot using the Kalman filter algorithm to fuse the first position information and the second position information in S103 is described in detail.

[0104] Referring to Figure 3, Figure 3 is a flow chart of a positioning method for a lawn mower robot provided in an embodiment of the present application. As shown in Figure 3, the positioning method for a lawn mower robot of the present application may include the following steps:

[0105] S201 , fusing the first position information and the second position information through a Kalman filter algorithm to obtain position estimation information.

[0106] S202: Determine the estimated position information as the current position information of the lawn mowing robot.

[0107] The first position information is used as the state value X in the Kalman filter algorithm. k , the second position information is used as the measurement value Z in the Kalman filter algorithm k .

[0108] The mowing robot is based on the state value X k and the measured value Z k The position estimation information can be estimated. Thus, the lawn mowing robot can use the position estimation information as the current position information of the lawn mowing robot.

[0109] In summary, the first position information and the second position information are fused using the existing Kalman filter algorithm to obtain position estimation information, and the position estimation information is determined as the current position information of the lawn mowing robot, which can achieve more accurate position information calculation at a lower cost.

[0110] For example, referring to FIG4 , FIG4 is a flow chart of a positioning method for a lawn mowing robot provided in an embodiment of the present application. Based on the above embodiment, the above S201 may include the following steps:

[0111] S301: Obtain a first covariance and a second covariance.

[0112] The first covariance is related to the wheel speed data, and the second covariance is related to the satellite navigation data and / or the inertial positioning data.

[0113] In some examples, the covariance of the wheel speed data noise is the first covariance, and the noise of the satellite navigation data and / or inertial positioning data is the second covariance. Considering that the noise in the wheel speed data and the noise in the satellite navigation data and / or inertial positioning data conform to a Gaussian distribution, it can be seen that in the Kalman filter algorithm, the first covariance and the second covariance do not change with changes in the system state. In other words, the first covariance and the second covariance are fixed.

[0114] S302: Determine a third covariance based on the first covariance and the covariance of the position information corresponding to a previous moment of the first position information.

[0115] The third covariance is the covariance of the first position information.

[0116] The mowing robot substitutes the first covariance and the covariance of the position information corresponding to the previous moment of the first position information into the following formula (1) to determine the third covariance:

[0117] in, is the third covariance, A is the state transfer matrix, A T is the transposed matrix of A, P k-1 is the covariance of the position information corresponding to the previous moment of the first position information, and Q is the first covariance.

[0118] S303: Determine a Kalman gain according to the third covariance and the second covariance.

[0119] The lawn mowing robot substitutes the third covariance and the second covariance into the following formula (2) to determine the Kalman gain:

[0120] Among them, Kg k is the Kalman gain, is the third covariance, H is the conversion matrix from state value to measurement value, H T is the transposed matrix of H, and R is the second covariance.

[0121] Among them, the third covariance and Kalman gain are both intermediate results of the Kalman filter algorithm.

[0122] S304: Determine position estimation information according to the first position information, the second position information, and the Kalman gain.

[0123] The mowing robot substitutes the first position information, the second position information and the Kalman gain into the following formula (3) to determine the position estimation information:

[0124] in, is the position estimation information, X k is the first location information, Kg k is the Kalman gain, Z k is the second position information, and H is the conversion matrix from state value to measurement value.

[0125] H represents the relationship connecting the state value and the measurement value. In the Kalman filter algorithm, H is a linear relationship. H is responsible for converting the m-dimensional measurement value to the n-dimensional one so that it conforms to the mathematical form of the state variable. It is one of the prerequisites for filtering.

[0126] It is one of the results of the Kalman filter algorithm, that is, the updated result, also called the optimal estimate.

[0127] In summary, by obtaining the first covariance and the second covariance, and determining the third covariance based on the first covariance and the covariance of the position information corresponding to the previous moment of the first position information, and then determining the Kalman gain based on the third covariance and the second covariance. The embodiment of the present application simplifies the Kalman filter algorithm to a certain extent, so that the position estimation information can be determined based on the first position information, the second position information, and the Kalman gain, thereby improving the computational efficiency of the fusion.

[0128] Based on the description of the embodiment shown in FIG4 , after determining based on the third covariance and the Kalman gain, the mowing robot may store in advance the covariance of the position information corresponding to the next moment of the first position information, which may be used as a basis for the next use.

[0129] Exemplarily, the lawn mowing robot determines a fourth covariance based on the third covariance and the Kalman gain, where the fourth covariance is the covariance of the position information corresponding to a later moment of the first position information.

[0130] In some examples, the mowing robot substitutes the third covariance and the Kalman gain into the following formula (4) to determine the fourth covariance:

[0131] Among them, P k is the fourth covariance, I is the identity matrix, Kg k is the Kalman gain, H is the conversion matrix from state value to measurement value, is the third covariance.

[0132] The fourth covariance is the covariance corresponding to the position estimate. This covariance represents the uncertainty of the system state and is one of the results of the Kalman filter algorithm. Therefore, the mowing robot can store this fourth covariance.

[0133] Thus, when the system corresponding to the Kalman filter algorithm enters the next moment, the fourth covariance is the covariance of the position information corresponding to the previous moment of the first position information, that is, in formula (1). In this way, the Kalman filter algorithm can continue the autoregressive operation and determine the current position information of the lawn mower robot in real time.

[0134] For example, the first position information of the lawn mower robot at time t1, time t2, and time t3 are X1, X2, and X3 respectively, and the second position information of the lawn mower robot at time t1, time t2, and time t3 are Z1, Z2, and Z3 respectively. The current position information of the lawn mower robot at time t1, time t2, and time t3 are and

[0135] At time t1, based on the fourth covariance stored at time t0, it can be known that P0 is the covariance corresponding to X1. Then, X1 and Z1 are summed to obtain the current position information corresponding to time t1 and the covariance P1 corresponding to the current position information, that is, the fourth covariance at time t1, through formulas (1)-(4).

[0136] At time t2, based on the fourth covariance stored at time t1, it can be known that P1 is the covariance corresponding to X2. Then, X2 and Z2 are obtained through formulas (1)-(4) to obtain the current position information corresponding to the mowing robot at time t2 and the covariance P2 corresponding to the current position information, that is, the fourth covariance at time t2.

[0137] At time t3, based on the fourth covariance stored at time t2, it can be known that P2 is the covariance corresponding to X2. Then, X3 and Z3 are obtained through formulas (1)-(4) to obtain the current position information corresponding to the mowing robot at time t3 and the covariance P3 corresponding to the current position information, that is, the fourth covariance at time t3.

[0138] In summary, the fourth covariance is determined using the third covariance and the Kalman gain. The fourth covariance is the covariance of the position information corresponding to the moment after the first position information. The fourth covariance is then stored. In this way, the Kalman filter algorithm can continue its autoregressive operation and determine the current position information of the lawn mower robot in real time.

[0139] Based on the description of the above embodiment and in combination with FIG. 5 , the specific implementation process of the lawn mowing robot in S103 fusing the first position information and the second position information by minimizing the cost function is described in detail.

[0140] Referring to Figure 5, Figure 5 is a flow chart of a positioning method for a lawn mower robot provided in an embodiment of the present application. As shown in Figure 5, the positioning method for a lawn mower robot of the present application may include the following steps:

[0141] S401: Determine a residual term according to first position information and second position information.

[0142] Among them, residual refers to the difference between the actual observed value and the fitted value in mathematical statistics.

[0143] The mowing robot determines a first difference between the fitting value and the first position information, and a second difference between the fitting value and the second position information. Thus, the mowing robot can determine the sum of the first difference and the second difference as a residual term.

[0144] In some examples, the lawn mowing robot may substitute the first position information and the second position information into the following formula (5) to determine the residual term:

[0145] in, is the residual term, z j is the first position information, i.e. the first position information corresponding to the wheel speed data of the jth frame, h t is the second position information, that is, the second position information corresponding to the t-th frame satellite navigation data and / or inertial positioning data, and x is the fitting value.

[0146] S402: Construct a cost function based on the residual term.

[0147] The mowing robot substitutes the residual term into the following formula (6) to construct the cost function:

[0148] Where c(x) is the cost function, T is the total number of frames of wheel speed data, K is the total number of frames of satellite navigation data and / or inertial positioning data, is the residual term, e m is the marginalized residual term, for e m The transposed matrix of is the residual weight used in the optimization process.

[0149] S403: Obtain the current position information of the mowing robot according to the cost function.

[0150] The lawn mowing robot determines the minimum value of the cost function, that is, minimizes the cost function. Thus, the lawn mowing robot determines the fitting value corresponding to the minimized cost function as the current position information of the lawn mowing robot.

[0151] In summary, the residual term is determined using the first and second position information, and a cost function is constructed based on the residual term. The current position information of the mowing robot is then obtained based on the cost function. By optimizing the constraints of the first and second position information, the current position information is obtained with high accuracy.

[0152] Based on the description of the above embodiment, referring to FIG6 , FIG6 is a flow chart of a positioning method of a lawn mowing robot provided by an embodiment of the present application. Based on the above embodiment, the above S101 may include the following steps:

[0153] S501: Determine the wheel speed information of the left wheel using a left wheel speedometer.

[0154] The wheel speed information of the left wheel is related to the linear speed.

[0155] S502: Determine the wheel speed information of the right wheel using the right wheel speedometer.

[0156] The wheel speed information of the right wheel is related to the linear speed.

[0157] For example, the lawn mower robot can determine wheel speed information using a wheel tachometer on one of the robot's wheels. In some examples, the lawn mower robot can obtain the number of pulses output by the wheel tachometer within a sampling interval. Thus, the lawn mower robot can obtain wheel speed information based on the sampling interval, the number of pulses, and wheel attribute information.

[0158] The wheel attribute information includes the wheel diameter, the number of encoder lines, and the distance between the left and right wheels.

[0159] The pulse number includes the pulse number of the left wheel speedometer and the pulse number of the right wheel speedometer.

[0160] The wheel speed information of the vehicle includes the wheel speed information of the left wheel and the wheel speed information of the right wheel.

[0161] The mowing robot substitutes the sampling interval, pulse number and wheel attribute information into the following formula (7) to obtain the wheel speed information:

[0162] Among them, △t is the sampling interval, N l is the number of pulses of the left wheel speedometer, N r is the number of pulses of the right wheel speedometer, D is the diameter of the wheel, P is the number of encoder lines, v l is the left wheel speed information, v r The wheel speed information of the right wheel.

[0163] It should be noted that there is no temporal order between the above S501 and S502, and S501 and S502 can be executed simultaneously or sequentially.

[0164] S503: Perform dead reckoning on the wheel speed information of the left wheel and the wheel speed information of the right wheel to obtain first position information.

[0165] The mowing robot determines the moving distance of the left wheel and the moving distance of the right wheel according to the wheel speed information of the left wheel and the wheel speed information of the right wheel, thereby obtaining first position information according to the moving distance of the left wheel and the moving distance of the right wheel.

[0166] The position of the mowing robot is represented by a vector. (x0, y0, θ0) T is the position of the mowing robot at the previous moment, (x1, y1, θ1) T is the pose of the lawn mowing robot at the current moment.

[0167] (x0, y0) is the first position information of the lawn mower robot corresponding to the previous moment, (x1, y1) is the first position information of the lawn mower robot corresponding to the current moment, θ0 is the heading angle corresponding to the lawn mower robot at the previous moment, and θ1 is the heading angle corresponding to the lawn mower robot at the current moment.

[0168] In some examples, the mowing robot substitutes the wheel speed information of the left wheel and the wheel speed information of the right wheel into the following formula (8) to obtain the first position information:

[0169] Where,

[0170] Among them, △s r is the moving distance of the right wheel, △s l is the moving distance of the left wheel, B is the distance between the left and right wheels, and △θ is the change in the heading angle within the sampling interval.

[0171] In summary, the wheel speed information of the left wheel is determined by the left wheel speed meter, and the wheel speed information of the right wheel is determined by the right wheel speed meter, and then the track speed information of the left wheel and the right wheel speed information are calculated to obtain the first position information, thereby preparing data for the fusion processing of the first position information and the second position information.

[0172] Referring to Figure 7, Figure 7 is a flow chart of a positioning method for a lawn mowing robot provided in an embodiment of the present application. Based on the above embodiment, the above S503 may include the following steps:

[0173] S601: Obtain the heading angle of the lawn mowing robot.

[0174] The lawn mower robot uses a wheel speed sensor to collect its heading angle. Alternatively, the lawn mower robot can calculate its heading angle based on the travel distance of its left and right wheels, as well as the distance between the left and right wheels. Alternatively, the lawn mower robot can calculate its heading angle using the aforementioned two methods. This application does not impose any specific limitations on this.

[0175] S602: Determine the movement distance of the left wheel according to the wheel speed information of the left wheel and the sampling interval.

[0176] The lawn mowing robot can determine the moving distance of the left wheel by multiplying the wheel speed information of the left wheel and the sampling interval.

[0177] S603: Determine the moving distance of the right wheel according to the wheel speed information of the right wheel and the sampling interval.

[0178] The lawn mowing robot may determine the moving distance of the right wheel by multiplying the wheel speed information of the right wheel and the sampling interval.

[0179] It should be noted that there is no temporal order between the above S601-S603, and S601-S603 can be executed simultaneously or sequentially. For the sake of convenience, in Figure 7, S601-S603 are executed sequentially.

[0180] S604: Obtain first position information according to the heading angle of the lawn mowing robot, the moving distance of the left wheel, and the moving distance of the right wheel.

[0181] The lawn mower robot substitutes the heading angle, the moving distance of the left wheel, and the moving distance of the right wheel of the lawn mower robot into formula (8) to obtain the first position information.

[0182] In summary, the data preparation for obtaining the first position information is done by using the movement distance of the left wheel and the movement distance of the right wheel. Based on this, the lawn mower robot can obtain the first position information based on the heading angle of the lawn mower robot, the movement distance of the left wheel and the movement distance of the right wheel.

[0183] Although the various steps in the above embodiment are described in the above-mentioned order, those skilled in the art will understand that in order to achieve the effect of this embodiment, different steps do not have to be executed in such an order. They can be executed simultaneously (in parallel) or in a reverse order. Such simple changes are within the scope of protection of the present invention.

[0184] In the embodiments of the present application, the lawn mower robot can be divided into functional modules according to the above-mentioned method example. For example, each functional module can be divided into corresponding functional modules, or two or more functions can be integrated into a single processing unit. The above-mentioned integrated unit can be implemented in the form of hardware or software functional modules.

[0185] The division of modules in the embodiment of the present application is schematic and is merely a logical function division. There may be other division methods in actual implementation.

[0186] 8, which is a schematic diagram of the structure of a positioning device for a lawn mowing robot provided in an embodiment of the present application. The positioning device 800 includes:

[0187] The first determining module 801 is configured to determine first position information of the lawn mowing robot, where the first position information is related to wheel speed data of the lawn mowing robot.

[0188] The second determining module 802 is configured to determine second position information of the lawn mowing robot, where the second position information is related to satellite navigation data and / or inertial positioning data of the lawn mowing robot.

[0189] The fusion module 803 is configured to fuse the first position information and the second position information to determine the current position information of the lawn mowing robot.

[0190] By determining the first position information and the second position information of the lawn mower robot, the embodiments of the present application can provide data sources for determining the current position information of the lawn mower robot from multiple dimensions. Based on this, the first position information and the second position information are fused and processed, so that the first position information and the second position information are tightly coupled, thereby making the current position information of the lawn mower robot more accurate, which can improve the positioning accuracy of the lawn mower robot and help maintain high positioning accuracy even when the satellite positioning signal is interfered with.

[0191] In some embodiments, the fusion module 803 is specifically configured to: fuse the first position information and the second position information using a Kalman filter algorithm to obtain position estimation information; and determine the position estimation information as the current position information of the lawn mowing robot.

[0192] In some embodiments, the fusion module 803 is specifically used to: obtain a first covariance and a second covariance, the first covariance is related to the wheel speed data, and the second covariance is related to the satellite navigation data and / or inertial positioning data; determine a third covariance based on the first covariance and the covariance of the position information corresponding to the previous moment of the first position information, the third covariance is the covariance of the first position information; determine the Kalman gain based on the third covariance and the second covariance; determine the position estimation information based on the first position information, the second position information and the Kalman gain.

[0193] In some embodiments, the positioning device 800 further includes a third determination module 804, which is used to determine a fourth covariance based on the third covariance and the Kalman gain, where the fourth covariance is the covariance of the position information corresponding to the next moment after the first position information; and store the fourth covariance.

[0194] In some embodiments, the fusion module 803 is specifically configured to: determine a residual term based on the first position information and the second position information; construct a cost function based on the residual term; and obtain the current position information of the mowing robot based on the cost function.

[0195] In some embodiments, the first determination module 801 is specifically used to: determine the wheel speed information of the left wheel through the left wheel speedometer, and the wheel speed information of the left wheel is related to the linear speed; determine the wheel speed information of the right wheel through the right wheel speedometer, and the wheel speed information of the right wheel is related to the linear speed; perform track calculation on the wheel speed information of the left wheel and the wheel speed information of the right wheel to obtain the first position information.

[0196] In some embodiments, the first determining module 801 is specifically configured to: obtain the number of pulses output by the wheel speed meter within a sampling interval; and obtain wheel speed information according to the sampling interval, the number of pulses, and the attribute information of the wheel.

[0197] In some embodiments, the first determination module 801 is specifically used to: obtain the heading angle of the lawn mower robot; determine the moving distance of the left wheel based on the wheel speed information and sampling interval of the left wheel; determine the moving distance of the right wheel based on the wheel speed information and sampling interval of the right wheel; and obtain the first position information based on the heading angle of the lawn mower robot, the moving distance of the left wheel, and the moving distance of the right wheel.

[0198] The above embodiments can be implemented in whole or in part by software, hardware, firmware or any other combination. When implemented using software, the above embodiments can be implemented in whole or in part in the form of a computer program product. The computer program product includes one or more computer instructions or computer programs. When the computer instructions or computer program are loaded or executed on a computer, the process or function described in the embodiment of the present application is generated in whole or in part. The computer can be a general-purpose computer, a special-purpose computer, a computer network, or other programmable device. The computer instructions can be stored in a computer-readable storage medium or transmitted from one computer-readable storage medium to another computer-readable storage medium. For example, the computer instructions can be transmitted from one website, computer, server or data center to another website, computer, server or data center via wired or wireless means. The computer-readable storage medium can be any available medium that can be accessed by a computer or a data storage device such as a server or data center that contains one or more available media sets. The available medium can be a magnetic medium (e.g., a floppy disk, a hard disk, a tape), an optical medium (e.g., a DVD), or a semiconductor medium. The semiconductor medium can be a solid-state drive.

[0199] Illustratively, an embodiment of the present application provides an electronic device, including a memory and a processor, wherein a computer program is stored in the memory, and when the processor executes the computer program, the positioning method of the lawn mowing robot of the previous embodiment is implemented.

[0200] It is understandable that, in order to implement the above functions, the electronic device includes hardware and / or software modules that perform the corresponding functions. In combination with the algorithm steps of each example described in the embodiments disclosed herein, the present application can be implemented in the form of hardware or a combination of hardware and computer software. Whether a function is executed in the form of hardware or computer software driving hardware depends on the specific application and design constraints in the technical solution. Those skilled in the art can use different methods to implement the described functions for each specific application in combination with the embodiments, but such implementation should not be considered to be beyond the scope of this application.

[0201] The electronic device provided in the embodiment of the present application is used to execute the positioning method of the above-mentioned lawn mowing robot, and thus can achieve the same effect as the above-mentioned implementation method.

[0202] Illustratively, an embodiment of the present application provides a computer storage medium, in which at least one executable instruction is stored. The executable instruction enables a processor to execute the positioning method of the lawn mowing robot of the embodiment.

[0203] Exemplarily, the present application provides a computer program product, comprising: execution instructions, the execution instructions are stored in a readable storage medium, at least one processor of an electronic device can read the execution instructions from the readable storage medium, and at least one processor executes the execution instructions so that the electronic device implements the positioning method of the lawn mowing robot in the previous embodiment.

[0204] Among them, the electronic device, computer-readable storage medium and computer program product provided in the embodiments of the present application are all used to execute the corresponding methods provided above. Therefore, the beneficial effects that can be achieved can refer to the beneficial effects in the corresponding methods provided above, and will not be repeated here.

[0205] Those skilled in the art will appreciate that all or part of the processes in the above-mentioned embodiments can be implemented by instructing the relevant hardware through a computer program. The computer program can be stored in a non-volatile computer-readable storage medium. When the computer program is executed, it can include the processes of the embodiments of the above-mentioned methods. Among them, any reference to memory, database or other media used in the embodiments provided in this application may include at least one of non-volatile and volatile memory. Non-volatile memory may include read-only memory (ROM), magnetic tape, floppy disk, flash memory, optical memory, high-density embedded non-volatile memory, magnetoresistive random access memory (MRAM), ferroelectric random access memory (FRAM), phase change memory (PCM), graphene memory, etc. Volatile memory may include random access memory (RAM) or external cache memory, etc. By way of illustration and not limitation, RAM can be in various forms, such as static random access memory (SRAM) or dynamic random access memory (DRAM). The database involved in the various embodiments provided herein may include at least one of a relational database and a non-relational database. Non-relational databases may include, but are not limited to, distributed databases based on blockchains. The processor involved in the various embodiments provided herein may be, but are not limited to, a general-purpose processor, a central processing unit, a graphics processing unit, a digital signal processor, a programmable logic unit, a data processing logic unit based on quantum computing, and the like.

[0206] The technical features of the above embodiments can be combined arbitrarily. To make the description concise, not all possible combinations of the technical features in the above embodiments are described. However, as long as there is no contradiction in the combination of these technical features, they should be considered to be within the scope of this specification.

[0207] The above description is merely a specific embodiment of the present invention, but the scope of protection of the present invention is not limited thereto. Any modifications or substitutions that can be easily conceived by a person skilled in the art within the technical scope disclosed in the present invention should be included in the scope of protection of the present invention. Therefore, the scope of protection of the present invention should be based on the scope of protection of the claims.

Claims

1. A positioning method for a lawn mowing robot, characterized in that: The method comprises: Determine first position information of the lawn mowing robot, where the first position information is related to wheel speed data of the lawn mowing robot; Determine second position information of the lawn mowing robot, where the second position information is related to satellite navigation data and / or inertial positioning data of the lawn mowing robot; The first position information and the second position information are fused to determine the current position information of the lawn mowing robot.

2. The method according to claim 1, characterized in that The fusing the first position information and the second position information to determine the current position information of the lawn mowing robot includes: The first position information and the second position information are fused by a Kalman filter algorithm to obtain position estimation information; The position estimation information is determined as the current position information of the lawn mowing robot.

3. The method according to claim 2, characterized in that The fusing the first position information and the second position information by using a Kalman filter algorithm to obtain position estimation information includes: Acquire a first covariance and a second covariance, wherein the first covariance is related to the wheel speed data, and the second covariance is related to the satellite navigation data and / or the inertial positioning data; Determine a third covariance according to the first covariance and the covariance of the position information corresponding to the previous moment of the first position information, where the third covariance is the covariance of the first position information; Determining a Kalman gain according to the third covariance and the second covariance; The position estimation information is determined according to the first position information, the second position information and the Kalman gain.

4. The method according to claim 3, characterized in that The method further comprises: Determine a fourth covariance according to the third covariance and the Kalman gain, where the fourth covariance is the covariance of the position information corresponding to a later moment of the first position information; The fourth covariance is stored.

5. The method according to claim 1, characterized in that The fusing the first position information and the second position information to determine the current position information of the lawn mowing robot includes: Determine a residual item according to the first position information and the second position information; Constructing a cost function according to the residual term; According to the cost function, the current position information of the lawn mowing robot is obtained.

6. The method according to any one of claims 1 to 5, characterized in that: The left wheel of the lawn mowing robot is provided with a left wheel speedometer, and the right wheel of the lawn mowing robot is provided with a right wheel speedometer; The determining of the first position information of the lawn mowing robot comprises: Determining the wheel speed information of the left wheel by the left wheel speedometer, wherein the wheel speed information of the left wheel is related to the linear speed; Determining the wheel speed information of the right wheel by the right wheel speed meter, wherein the wheel speed information of the right wheel is related to the linear speed; The first position information is obtained by performing dead reckoning on the wheel speed information of the left wheel and the wheel speed information of the right wheel.

7. The method according to claim 6, characterized in that Determining wheel speed information of a wheel by a wheel speed meter on a wheel of the lawn mowing robot includes: Obtaining the number of pulses output by the wheel speed meter within a sampling interval; The wheel speed information of the wheel is obtained according to the sampling interval, the number of pulses and the attribute information of the wheel.

8. The method according to claim 7, characterized in that The performing dead reckoning on the wheel speed information of the left wheel and the wheel speed information of the right wheel to determine the first position information includes: Collecting the heading angle of the lawn mowing robot; Determining the moving distance of the left wheel according to the wheel speed information of the left wheel and the sampling interval; Determining the moving distance of the right wheel according to the wheel speed information of the right wheel and the sampling interval; The first position information is obtained according to the heading angle of the lawn mowing robot, the moving distance of the left wheel and the moving distance of the right wheel.

9. An electronic device, characterized in that: The method comprises a memory and a processor, wherein the memory stores a computer program, and the processor implements the positioning method of the lawn mowing robot as claimed in any one of claims 1 to 8 when executing the computer program.

10. A computer-readable storage medium, characterized in that: The computer-readable storage medium stores a computer program, and when the computer program is executed by a processor, the positioning method of the lawn mowing robot according to any one of claims 1 to 8 is implemented.

Citation Information

Patent Citations

  • Positioning method of mowing robot, electronic equipment and computer readable storage medium

    CN116679336A

  • Unmanned vehicle control method and unmanned mowing vehicle

    CN107943049A

  • Unmanned vehicle directional positioning method based on information fusion of wheel type odometer and gyroscope

    CN112050809A

  • Positioning method, positioning system and robot based on multi-sensor fusion

    CN113252033A

  • Positioning method of mowing robot and related device

    CN115220076A

Cited By

  • Unmanned aerial vehicle accurate positioning method and device fusing multi-source positioning data

    CN120593727A

  • Universal navigation method, medium and equipment suitable for various motion model vehicles

    CN121067844A