Navigation errors correction method based on magnetic nail positioning
View Patent ↗A navigation errors correction method based on magnetic nail positioning includes a magnetic nail is set within the moving area of AGV, and an information-bearing magnetic field mode is established according to magnetic field formed and stored in a navigation device. The method further includes a navigation device in AGV guides movement of AGV; a magnetic sensor on AGV detects features of magnetic field on movement track. Contrast features of magnetic field detected by magnetic sensor with those of magnetic field mode prestored by navigation device, and reckon the relative position of magnetic nail and AGV. Based on relative position of magnetic nail and AGV, reckon current position of AGV, the navigation device adjusts position and orientation of AGV and guides AGV to repair movement errors based on reckoning position of AGV.
1. A navigation error correction method based on magnetic nail positioning, the method comprising the following steps:
(a) a single magnetic nail is set within a moving area of an automated guided vehicle (AGV), and an information-bearing magnetic field mode is established according to a magnetic field formed by said single magnetic nail and stored in a navigation device;
(b) said navigation device guides the movement of AGV;
(c) a magnetic sensor on the AGV detects features of the magnetic field established by the single magnetic nail on a movement track;
(d) contrast the features of the magnetic field detected by the magnetic sensor with those of the magnetic field mode prestored in the navigation device, and reckon the relative position of the single magnetic nail and the AGV;
(e) based on the relative position of the single magnetic nail and the AGV, reckon a current position of the AGV; and
(f) said navigation device adjusts the position and orientation of the AGV and guides the AGV to repair a movement error based on the reckoned current position of the AGV.
2. The navigation error correction method based on magnetic nail positioning as claimed in claim 1 , wherein two or more magnetic nails are set along the movement track of the AGV.
3. The navigation error correction method based on magnetic nail positioning as claimed in claim 2 , wherein said two or more magnetic nails are laid on a ground surface of the movement track of the AGV.
4. The navigation error correction method based on magnetic nail positioning as claimed in claim 1 , wherein said magnetic sensor on the AGV detects the features of magnetic field around periodically.
5. The navigation error correction method based on magnetic nail positioning as claimed in claim 1 , wherein a coordinate system is set within the moving area of the AGV, and said single magnetic nail is located in the coordinate system such that position reckoning of the AGV is based on said coordinate system.
6. The navigation error correction method based on magnetic nail positioning as claimed in claim 1 , wherein if the magnetic sensor fails to detect magnetic field signals when the AGV passes over the single magnetic nail, said AGV stops moving, and/or, reports the failure to users.