CN110132252B - Usability detection method for geomagnetic sensor in intelligent mower - Google Patents
Usability detection method for geomagnetic sensor in intelligent mower Download PDFInfo
- Publication number
- CN110132252B CN110132252B CN201910362257.4A CN201910362257A CN110132252B CN 110132252 B CN110132252 B CN 110132252B CN 201910362257 A CN201910362257 A CN 201910362257A CN 110132252 B CN110132252 B CN 110132252B
- Authority
- CN
- China
- Prior art keywords
- geomagnetic
- intelligent
- intelligent mower
- route
- mower
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C17/00—Compasses; Devices for ascertaining true or magnetic north for navigation or surveying purposes
- G01C17/38—Testing, calibrating, or compensating of compasses
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/04—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by terrestrial means
- G01C21/08—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by terrestrial means involving use of the magnetic field of the earth
Abstract
The availability detection method for the geomagnetic sensor in the intelligent mower comprises the steps of obtaining the real-time position of the intelligent mower based on the existing navigation mode, and drawing the actual travelling route of the intelligent mower based on the real-time position; in the process that the intelligent mower carries out mowing operation along an actual travelling route, acquiring geomagnetic data acquired by a geomagnetic sensor installed in the intelligent mower in real time, and drawing the geomagnetic travelling route of the intelligent mower based on the geomagnetic data; and comparing the geomagnetic travelling route with the actual travelling route, and if the error value obtained by comparison is greater than a threshold value, judging that the geomagnetic sensor is unavailable in the current working environment. The method for verifying the geomagnetic navigation by taking other navigation methods as samples can effectively judge whether the current environment can generate interference on the geomagnetic navigation, thereby accurately verifying the effectiveness of the geomagnetic navigation mode.
Description
Technical Field
The invention belongs to the field of equipment detection, and particularly relates to an availability detection method for a geomagnetic sensor in an intelligent mower.
Background
The intelligent lawn mower in the current market mainly takes a random mowing path to cover the whole lawn in a probability mode, and the working efficiency is low. If the intelligent mower can realize parallel path mowing, the working efficiency can be greatly improved.
If the parallel mowing is to be realized, the machine can be controlled to cut in parallel in a short time in an inertial navigation mode, but the inertial navigation can accumulate errors along with time, and the acquisition of the heading of the machine through a geomagnetic sensor is a very important means. However, since the geomagnetism is very weak, the data collected by the geomagnetic sensor is basically unusable under the interference of other magnetic field environments. Whether geomagnetic sensor data are available or not is detected in a certain mode, and the method has very important significance for intelligent energy mower control.
Disclosure of Invention
In order to solve the defects and shortcomings in the prior art, the invention provides a method for drawing a route based on the prior navigation technology and a geomagnetic navigation scheme respectively, comparing the two routes, and judging whether a geomagnetic sensor is available in the current environment or not based on the error obtained by comparison.
Specifically, the usability detection method for the geomagnetic sensor in the intelligent mower provided by the application comprises the following steps:
acquiring a real-time position of the intelligent mower based on the existing navigation mode, and drawing an actual travelling route of the intelligent mower based on the real-time position;
in the process that the intelligent mower carries out mowing operation along an actual travelling route, acquiring geomagnetic data acquired by a geomagnetic sensor installed in the intelligent mower in real time, and drawing the geomagnetic travelling route of the intelligent mower based on the geomagnetic data;
and comparing the geomagnetic travelling route with the actual travelling route, and if the error value obtained by comparison is greater than a threshold value, judging that the geomagnetic sensor is unavailable in the current working environment.
Optionally, the obtaining a real-time position of the intelligent mower based on the existing navigation manner, and drawing an actual traveling route of the intelligent mower based on the real-time position include:
acquiring the real-time position of the intelligent mower at preset intervals based on the existing navigation mode;
connecting the real-time positions acquired within a preset time period to obtain a theoretical advancing route of the intelligent mower;
and correcting the theoretical advancing route based on the steering parameters of the intelligent mower to obtain a corrected actual advancing route.
Optionally, the correcting the theoretical traveling route based on the steering parameter of the intelligent mower to obtain a corrected actual traveling route includes:
determining steering parameters of the intelligent mower based on the size of the body of the intelligent mower and the steering angle;
and selecting error nodes which cannot be realized by the intelligent mower in the theoretical advancing route according to the steering parameters, deleting the error nodes, and performing curve fitting on the deleted missing route to obtain the corrected actual advancing route.
Optionally, in the process of mowing along the actual travelling route by the intelligent mower, acquiring, in real time, geomagnetic data acquired by a geomagnetic sensor installed in the intelligent mower, and drawing the geomagnetic travelling route of the intelligent mower based on the geomagnetic data, the method includes:
in the process of mowing along an actual travelling route by the intelligent mower, acquiring geomagnetic data which is output by a geomagnetic sensor and represents the travelling direction and travelling speed of the intelligent mower, wherein the geomagnetic data is installed in the intelligent mower at preset time intervals;
and drawing a geomagnetic travelling route of the intelligent mower based on the known travelling direction and travelling speed.
Optionally, the plotting a geomagnetic travel route of the intelligent lawn mower based on the known travel direction and travel speed includes:
determining a traveling direction and a traveling distance of the intelligent mower relative to the previous moment according to the time interval for acquiring the geomagnetic data and the traveling speed in the geomagnetic data in the previous moment;
and accumulating the travelling direction and the travelling distance of the intelligent mower in at least two time periods to finish the drawing of the geomagnetic travelling route of the intelligent mower.
Optionally, the existing navigation mode comprises
Real-time dynamic positioning, and or inertial navigation.
The technical scheme provided by the invention has the beneficial effects that:
the method for verifying the geomagnetic navigation by taking other navigation methods as samples can effectively judge whether the current environment can interfere with the geomagnetic navigation, thereby accurately verifying the effectiveness of the geomagnetic navigation mode.
Drawings
In order to more clearly illustrate the technical solution of the present invention, the drawings needed to be used in the description of the embodiments will be briefly introduced below, and it is obvious that the drawings in the following description are only some embodiments of the present invention, and it is obvious for those skilled in the art to obtain other drawings based on the drawings without creative efforts.
Fig. 1 is a schematic flowchart of an availability detection method for a geomagnetic sensor in an intelligent lawn mower according to the present application.
Detailed Description
To make the structure and advantages of the present invention clearer, the structure of the present invention will be further described with reference to the accompanying drawings.
Example one
The geomagnetic sensor is a very useful sensor in the design of an intelligent mower control system, the heading angle of a machine can be obtained through the geomagnetic sensor (compass principle), and the geomagnetic sensor can also be used for correcting the drift of an inertial element, but the geomagnetic sensor is easily interfered by other magnetic field environments, so that the geomagnetic sensor is not available.
In order to verify whether the geomagnetic sensor is effective in the current working environment, the usability detection method for the geomagnetic sensor in the intelligent lawn mower, as shown in fig. 1, includes:
11. acquiring a real-time position of the intelligent mower based on the existing navigation mode, and drawing an actual travelling route of the intelligent mower based on the real-time position;
12. in the process that the intelligent mower carries out mowing operation along an actual travelling route, acquiring geomagnetic data acquired by a geomagnetic sensor installed in the intelligent mower in real time, and drawing the geomagnetic travelling route of the intelligent mower based on the geomagnetic data;
13. and comparing the geomagnetic travelling route with the actual travelling route, and if the error value obtained by comparison is greater than a threshold value, judging that the geomagnetic sensor is unavailable in the current working environment.
The main idea of the geomagnetic sensor availability detection method provided by the application is that an existing mature navigation method is used as a standard sample, an error value existing between geomagnetic navigation data and the standard sample is obtained, and if the error value exceeds a threshold value representing an acceptable range, it represents that the current geomagnetic environment has too much interference on a geomagnetic sensor, and navigation cannot be performed based on geomagnetic data generated by the geomagnetic sensor, that is, the geomagnetic sensor is unavailable at this time.
It should be noted that the comparison in step 13 may be a comparison between the actual travel route and the geomagnetic travel route by sampling the coordinates of the key points, or a comparison between the overall route shapes of the two travel routes.
Existing navigation approaches include Real-time kinematic (RTK) carrier-phase differential techniques, or inertial navigation, and combinations thereof. By means of a positioning technology or an inertial navigation method, a real-time travelling route of the intelligent mower based on the existing navigation mode and a geomagnetic travelling route under geomagnetic navigation are calculated, and whether geomagnetic navigation is effective or not is judged based on an error value obtained by comparing the two travelling routes. And as another implementation mode, the heading angles of the intelligent mower in different navigation modes can be calculated, the heading angle data obtained in the two navigation modes are compared, and the reliability of the data of the geomagnetic sensor is analyzed, so that whether the geomagnetic sensor is available in the environment or not is judged.
Firstly, the scheme for comparing whether the geomagnetic sensor is available or not based on the travel route is as follows:
the content realized in the step 11 is to draw an actual traveling route of the intelligent mower based on the existing navigation mode, and specifically comprises the following steps:
111. acquiring the real-time position of the intelligent mower at preset intervals based on the existing navigation mode;
112. connecting the real-time positions acquired within a preset time period to obtain a theoretical advancing route of the intelligent mower;
113. and correcting the theoretical advancing route based on the steering parameters of the intelligent mower to obtain a corrected actual advancing route.
According to the implementation manner shown in step 111-113, the real-time positions of the intelligent mower in a plurality of time periods are obtained, and all the real-time positions are connected to obtain the theoretical travel route of the intelligent mower in all the time periods. However, in consideration of the inevitable error of the theoretical travel route obtained based on the navigation information, the theoretical travel route is taken as a sample for subsequent comparison, and therefore the theoretical travel route needs to be corrected so as to obtain an actual travel route more conforming to the actual travel path of the intelligent lawn mower.
The process of correcting the theoretical travel route comprises the following steps:
1131. determining steering parameters of the intelligent mower based on the size of the body of the intelligent mower and the steering angle;
1132. and selecting error nodes which cannot be realized by the intelligent mower in the theoretical advancing route according to the steering parameters, deleting the error nodes, and performing curve fitting on the deleted missing route to obtain the corrected actual advancing route.
Considering that the position where an error may exist is a turn, it is important here to correct the turning portion in the theoretical travel route. The correction method comprises the steps of determining the minimum turning radius which can be realized by the intelligent mower based on the size of the intelligent mower and the steering angle of a steering wheel, deleting wrong nodes with turning radii obviously smaller than the minimum turning radius in a theoretical advancing route, and carrying out curve fitting processing based on actual coordinate values on a discontinuous route obtained after deletion, so as to finally obtain an actual advancing route which is more in line with the advancing mode of the intelligent mower.
121. in the process of mowing along an actual travelling route by the intelligent mower, acquiring geomagnetic data which is output by a geomagnetic sensor and represents the travelling direction and travelling speed of the intelligent mower, wherein the geomagnetic data is installed in the intelligent mower at preset time intervals;
122. and drawing a geomagnetic travelling route of the intelligent mower based on the known travelling direction and travelling speed.
The geomagnetic data which can be generated by the geomagnetic sensor comprises a traveling direction and a traveling speed which represent the traveling state of the intelligent mower, and the traveling direction and the traveling distance relative to the intelligent mower at the previous moment are determined according to the time interval for acquiring the geomagnetic data and the traveling speed in the geomagnetic data at the previous moment; and accumulating the travelling direction and the travelling distance of the intelligent mower in at least two time periods to finish the drawing of the geomagnetic travelling route of the intelligent mower.
In addition, comparing whether the geomagnetic sensor is available or not based on the heading angle data is to replace the traveling route in the scheme with a heading angle, and whether the difference value between the heading angle obtained by the existing navigation at a plurality of sampling moments and the heading angle obtained by the geomagnetic navigation is larger than a threshold value is taken as a basis for judging whether the geomagnetic sensor is available or not in the current environment.
The sequence numbers in the above embodiments are merely for description, and do not represent the sequence of the assembly or the use of the components.
The above description is only exemplary of the present invention and should not be taken as limiting the invention, as any modification, equivalent replacement, or improvement made within the spirit and principle of the present invention should be included in the protection scope of the present invention.
Claims (6)
1. An availability detection method for a geomagnetic sensor in an intelligent lawn mower, the availability detection method comprising:
acquiring a real-time position of the intelligent mower based on the existing navigation mode, and drawing an actual travelling route of the intelligent mower based on the real-time position;
in the process that the intelligent mower carries out mowing operation along an actual travelling route, acquiring geomagnetic data acquired by a geomagnetic sensor installed in the intelligent mower in real time, and drawing the geomagnetic travelling route of the intelligent mower based on the geomagnetic data;
and comparing the geomagnetic travelling route with the actual travelling route, and if the error value obtained by comparison is greater than a threshold value, judging that the geomagnetic sensor is unavailable in the current working environment.
2. The method for detecting the availability of the geomagnetic sensor in the intelligent lawn mower according to claim 1, wherein the obtaining the real-time position of the intelligent lawn mower based on the existing navigation manner, and the drawing the actual traveling route of the intelligent lawn mower based on the real-time position comprises:
acquiring the real-time position of the intelligent mower at preset intervals based on the existing navigation mode;
connecting the real-time positions acquired within a preset time period to obtain a theoretical advancing route of the intelligent mower;
and correcting the theoretical advancing route based on the steering parameters of the intelligent mower to obtain a corrected actual advancing route.
3. The method for detecting the availability of the geomagnetic sensor in the intelligent mower according to claim 2, wherein the correcting the theoretical travel route based on the steering parameter of the intelligent mower to obtain the corrected actual travel route comprises:
determining steering parameters of the intelligent mower based on the size of the body of the intelligent mower and the steering angle;
and selecting error nodes which cannot be realized by the intelligent mower in the theoretical advancing route according to the steering parameters, deleting the error nodes, and performing curve fitting on the deleted missing route to obtain the corrected actual advancing route.
4. The method for detecting the availability of the geomagnetic sensor in the intelligent mower according to claim 1, wherein the method for obtaining the geomagnetic data obtained by the geomagnetic sensor installed in the intelligent mower in real time during the mowing operation of the intelligent mower along the actual travelling route, and drawing the geomagnetic travelling route of the intelligent mower based on the geomagnetic data comprises:
in the process of mowing along an actual travelling route by the intelligent mower, acquiring geomagnetic data which is output by a geomagnetic sensor and represents the travelling direction and travelling speed of the intelligent mower, wherein the geomagnetic data is installed in the intelligent mower at preset time intervals;
and drawing a geomagnetic travelling route of the intelligent mower based on the known travelling direction and travelling speed.
5. The method for detecting availability of a geomagnetic sensor in an intelligent lawn mower according to claim 4, wherein the plotting a geomagnetic travel route of the intelligent lawn mower based on the known travel direction and travel speed comprises:
determining a traveling direction and a traveling distance of the intelligent mower relative to the previous moment according to the time interval for acquiring the geomagnetic data and the traveling speed in the geomagnetic data in the previous moment;
and accumulating the travelling direction and the travelling distance of the intelligent mower in at least two time periods to finish the drawing of the geomagnetic travelling route of the intelligent mower.
6. The method for detecting usability of a geomagnetic sensor in an intelligent lawn mower according to any one of claims 1 to 5, wherein the existing navigation manner comprises
Real-time dynamic positioning, and or inertial navigation.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910362257.4A CN110132252B (en) | 2019-04-30 | 2019-04-30 | Usability detection method for geomagnetic sensor in intelligent mower |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910362257.4A CN110132252B (en) | 2019-04-30 | 2019-04-30 | Usability detection method for geomagnetic sensor in intelligent mower |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110132252A CN110132252A (en) | 2019-08-16 |
CN110132252B true CN110132252B (en) | 2021-08-10 |
Family
ID=67575866
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910362257.4A Active CN110132252B (en) | 2019-04-30 | 2019-04-30 | Usability detection method for geomagnetic sensor in intelligent mower |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110132252B (en) |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101213419A (en) * | 2005-05-04 | 2008-07-02 | Nxp股份有限公司 | Device comprising a sensor arrangement and an estimator |
CN102023007A (en) * | 2009-09-17 | 2011-04-20 | 索尼公司 | Navigation device, correcting value initializing method and cellular phone with navigation function |
CN103201593A (en) * | 2011-06-13 | 2013-07-10 | 松下电器产业株式会社 | Noise pattern acquisition device and position detection apparatus provided therewith |
CN103913170A (en) * | 2007-03-23 | 2014-07-09 | 高通股份有限公司 | Multi-sensor data collection and/or processing |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9739635B2 (en) * | 2012-06-12 | 2017-08-22 | Trx Systems, Inc. | Methods for improved heading estimation |
KR20180045510A (en) * | 2016-10-26 | 2018-05-04 | 삼성에스디에스 주식회사 | Method and apparatus for geomagnetic signal processing |
CN108398124B (en) * | 2018-02-05 | 2020-10-16 | 无锡北微传感科技有限公司 | Electronic compass calibration method |
-
2019
- 2019-04-30 CN CN201910362257.4A patent/CN110132252B/en active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101213419A (en) * | 2005-05-04 | 2008-07-02 | Nxp股份有限公司 | Device comprising a sensor arrangement and an estimator |
CN103913170A (en) * | 2007-03-23 | 2014-07-09 | 高通股份有限公司 | Multi-sensor data collection and/or processing |
CN102023007A (en) * | 2009-09-17 | 2011-04-20 | 索尼公司 | Navigation device, correcting value initializing method and cellular phone with navigation function |
CN103201593A (en) * | 2011-06-13 | 2013-07-10 | 松下电器产业株式会社 | Noise pattern acquisition device and position detection apparatus provided therewith |
Also Published As
Publication number | Publication date |
---|---|
CN110132252A (en) | 2019-08-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106918342B (en) | Method and system for positioning driving path of unmanned vehicle | |
CN110019609A (en) | Map updating method, device and computer readable storage medium | |
CN109752725A (en) | A kind of low speed business machine people, positioning navigation method and Position Fixing Navigation System | |
KR20170088228A (en) | Map building system and its method based on multi-robot localization | |
EP1947542B1 (en) | Method and system for automatically guiding an unmanned vehicle | |
JP2014235510A (en) | Traveling path information generation device | |
CN105865461A (en) | Automobile positioning system and method based on multi-sensor fusion algorithm | |
CN109916421B (en) | Path planning method and device | |
CN105674984A (en) | Method for acquiring advancing directions of pedestrians by aid of mobile terminals without constraints | |
CN105204510A (en) | Generation method and device for probability map for accurate positioning | |
CN109629379B (en) | Pavement detection method based on mobile phone sensor data | |
CN106323267A (en) | Orchard work agricultural robot interrow positioning method | |
CN111002346A (en) | Robot trapped detection method and robot | |
CN104034337B (en) | Map matching method and device for geographic position point of floating vehicle | |
CN110132252B (en) | Usability detection method for geomagnetic sensor in intelligent mower | |
CN110191412B (en) | Method for correcting vehicle driving route information and vehicle-mounted terminal | |
CN109975848B (en) | Precision optimization method of mobile measurement system based on RTK technology | |
CN109945877B (en) | Patrol track generation method and device | |
CN109710594A (en) | The Effective judgement method, apparatus and readable storage medium storing program for executing of map datum | |
CN112611377B (en) | State prediction method, device and storage medium for car outdoor navigation | |
CN113514069B (en) | Real-time automatic driving positioning method and system | |
JP2019215773A (en) | Travel control device and travel control method for unmanned carrier | |
CN107765277A (en) | The method for drafting and device of map track | |
CN104749586A (en) | Satellite navigation pseudorange abnormality realtime detection method | |
CN110332937B (en) | Multi-reference-source-based positioning method applied to intelligent mower |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CP01 | Change in the name or title of a patent holder |
Address after: No. 150 Wenlong Road, Yuxin Town, Nanhu District, Jiaxing City, Zhejiang Province Patentee after: Zhejiang Yate Electric Appliance Co.,Ltd. Address before: No. 150 Wenlong Road, Yuxin Town, Nanhu District, Jiaxing City, Zhejiang Province Patentee before: ZHEJIANG YAT ELECTRICAL APPLIANCE Co.,Ltd. |
|
CP01 | Change in the name or title of a patent holder |