CN114323003A - Underground mine fusion positioning method based on UMB, IMU and laser radar - Google Patents
Underground mine fusion positioning method based on UMB, IMU and laser radar Download PDFInfo
- Publication number
- CN114323003A CN114323003A CN202111612525.7A CN202111612525A CN114323003A CN 114323003 A CN114323003 A CN 114323003A CN 202111612525 A CN202111612525 A CN 202111612525A CN 114323003 A CN114323003 A CN 114323003A
- Authority
- CN
- China
- Prior art keywords
- error
- imu
- fusion
- positioning
- constructing
- 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.)
- Pending
Links
- 230000004927 fusion Effects 0.000 title claims abstract description 28
- 238000000034 method Methods 0.000 title claims abstract description 24
- 238000005259 measurement Methods 0.000 claims abstract description 11
- 239000011159 matrix material Substances 0.000 claims description 21
- 239000000126 substance Substances 0.000 claims description 8
- 238000001914 filtration Methods 0.000 claims description 6
- 238000009434 installation Methods 0.000 claims description 5
- 230000014509 gene expression Effects 0.000 claims description 4
- 230000001133 acceleration Effects 0.000 claims description 3
- 230000008569 process Effects 0.000 claims description 3
- 230000035945 sensitivity Effects 0.000 claims description 3
- 230000007704 transition Effects 0.000 claims description 3
- 230000008859 change Effects 0.000 claims description 2
- 238000010606 normalization Methods 0.000 claims description 2
- 230000008901 benefit Effects 0.000 description 3
- 230000010354 integration Effects 0.000 description 3
- 238000012545 processing Methods 0.000 description 3
- 238000004364 calculation method Methods 0.000 description 2
- 238000005065 mining Methods 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000005457 optimization Methods 0.000 description 2
- 238000006243 chemical reaction Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000008030 elimination Effects 0.000 description 1
- 238000003379 elimination reaction Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000007499 fusion processing Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 239000000463 material Substances 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
Images
Abstract
The invention provides a method for positioning underground mine fusion based on UMB, IMU and laser radar, which comprises the following steps: constructing a vehicle position and attitude estimation model based on an IMU; constructing an EKF measurement fusion model based on UWB ranging; constructing a matching positioning model of laser radar point cloud; and constructing a fusion positioning model. The underground mine fusion positioning method based on the UMB, the IMU and the laser radar realizes accurate and stable positioning of the underground unmanned vehicle.
Description
Technical Field
The invention belongs to the field of fusion positioning, and particularly relates to a method for fusion positioning of underground mines based on UMB, IMU and laser radar.
Background
The trackless rubber-tyred vehicle for the mine comprises a material vehicle, a loading vehicle, a pickup truck, a patrol vehicle and the like, and most of the vehicles adopt a manual driving mode at present. The unmanned technology is applied to the industrial and mining wells, the equipment intelligence level and centralized management capability of the wells are improved, the production monitoring and risk identification means are improved, underground operating personnel are effectively reduced, the targets of safety under the condition of few people and safety under the condition of no people in the wells are realized, and the economic benefit and the social benefit of the industrial and mining management wells are improved.
The difficulty of unmanned underground mine is accurate underground positioning, and because of no GNSS signals, narrow and long tunnel and dim light, the vehicle is positioned accurately, which causes great trouble, and the difficulty also becomes a technical bottleneck restricting the unmanned underground mine. Ultra Wide Band (UWB) location has characteristics such as positioning accuracy height, low-power consumption, security height, signal penetrability are strong, utilizes the UWB location basic station of installation in the pit, communicates with UWB basic station through on-vehicle UWB equipment, can realize finding range between vehicle and the UWB basic station, provides effective information for accurate positioning in the pit. However, due to the limited number of underground UWB base stations, one UWB base station is usually configured at intervals of 200m-400m along the way, and the observability of the system is weak. The invention realizes the accurate and stable positioning of the underground unmanned vehicle by constructing the UMB and IMU of the vehicle-mounted UWB, the laser radar and the Inertial Measurement Unit (IMU) and the laser radar fusion positioning method.
In view of this, a method for positioning mine and mine fusion based on UMB, IMU and lidar is urgently needed.
Disclosure of Invention
Therefore, the UMB, the IMU and the laser radar fusion positioning method for the vehicle-mounted UWB, the laser radar and the Inertial Measurement Unit (IMU) are constructed, and accurate and stable positioning of the underground unmanned vehicle is achieved.
The UMB, IMU and laser radar fusion positioning method comprises the following steps:
s1, constructing an IMU-based vehicle position and posture estimation model;
s2, constructing an EKF measurement fusion model based on UWB ranging;
s3, constructing a matching positioning model of the laser radar point cloud;
s4, constructing a fusion positioning model based on S1, S2 and S3.
Further, the method for constructing the vehicle position and posture estimation model in step S1 specifically includes the following steps:
s101, calculating a deterministic error of the IMU inertial navigation system, comprising:
error of the platform angle:
wherein the content of the first and second substances,is the misalignment angle of the inertial navigation system under the navigation coordinate system;is a rotation angular velocity vector of the earth-fixed system relative to the inertial system;is a rotation angular velocity vector of the navigation system relative to the ground fixation system; epsilonnIs the gyroscope random error.
Speed error:
wherein f isnThe acceleration vector under the navigation coordinate system; v. ofnThe velocity vector of the carrier under the navigation coordinate system is obtained;is the accelerometer random error.
Position error:
wherein the content of the first and second substances,respectively, the latitude, longitude and altitude error change rate of the carrier; rNIs the radius of curvature of the meridian; rEIs the radius of curvature of the meridian;the velocity errors in the north, west and sky directions, respectively.
S102, establishing a vehicle position and attitude estimation model:
firstly, establishing a state equation of an IMU inertial navigation system:
discretizing to obtain:
Xk+1=ΦXk+Γwk;
wherein the content of the first and second substances,
x is an inertial navigation state variable;
FINSis an inertial navigation state matrix;
w is an inertial navigation error variable;
g is an inertial navigation error sensitive matrix;
phi is a state transition matrix;
Γ is a discretized input matrix;
setting the EKF filtering updating period as T, calculating to obtain:
Φ=I+FT;
Γ=GT;
then, an integral update expression of the state variable is calculated:
after quaternion normalization, recalculating the F and G matrices to obtain:
Pk+1=(I+FT)Pk(I+FT)T+T2GQGT;
to predict the covariance.
Further, the step S3 of constructing an EKF measurement fusion model based on UWB ranging specifically includes the following steps:
s201, calculating a position vector r of the UWB tag in a northwest coordinate system with the UWB base station as an origin:
wherein L isU、λU、hULatitude, longitude and altitude of the tag, respectively; l isB、λB、hBLatitude, longitude and altitude of the base station, respectively.
S202, calculating a distance observation value between the UWB tag and the base station:
ρu=ρtrue+εu;
where ρ istrueRho is the actual distance and the observation distance from the label to the base station respectively; δ r is the distance error vector from the tag to the base station;a rotation matrix from a body coordinate system to a navigation coordinate system; luA lever arm vector of a tag to an inertial navigation center; phi is an inertial navigation installation angle error vector.
S203, obtaining an observation equation:
Zu=HuX+Vu。
wherein Z isuIs a UWB observation; huIs an observation sensitivity matrix; vuTo observe the noise.
Further, the observation equation of the combined system based on the position and the heading of the laser radar is
Zlidar=HlidarX+Vlidar;
Wherein:
calculating a filter updating gain matrix:
K=Pk+1HT(HPk+1HT+R)-1;
updating the filter state variables:
xk+1=xk+1|k+K(Zk+1-yk+1);
updating the filter covariance:
Pk+1=Pk+1|k-KHPk+1|k。
compared with the prior art, the technical scheme of the invention has the following advantages:
according to the method, an Extended Kalman Filtering (EKF) -based state estimation model is constructed, the position and the attitude of the vehicle are predicted by using the IMU, UWB ranging information and laser radar point cloud matching positioning data are used for updating, the accurate position and the attitude of the vehicle in the underground are estimated in real time, and the problem of accurate positioning in the underground is solved.
Drawings
FIG. 1 is a schematic diagram of a method provided by an embodiment of the invention.
Detailed Description
The technical solutions in the embodiments of the present invention will be clearly and completely described below with reference to the drawings in the embodiments of the present invention, and it is obvious that the described embodiments are only a part of the embodiments of the present invention, and not all of the embodiments. All other embodiments, which can be derived by a person skilled in the art from the embodiments given herein without making any creative effort, shall fall within the protection scope of the present invention.
The inertial navigation system has many error sources, mainly including the error of the inertial instrument itself, the installation error and the scale error of the inertial instrument, the initial condition error of the system, the calculation error of the system, the error caused by various interferences, and the like. Inertial navigation errors can be divided into two categories: deterministic errors and random errors. The deterministic error comprises a platform angle error, a speed error and a position error, and the random error mainly comprises gyro drift, zero offset of an accelerometer and the like.
The method described in this embodiment, as shown in fig. 1, includes the following steps:
the platform error angle equation of the inertial navigation system is as follows:
wherein the content of the first and second substances,is the misalignment angle of the inertial navigation system under the navigation coordinate system;is a rotation angular velocity vector of the earth-fixed system relative to the inertial system;is a rotation angular velocity vector of the navigation system relative to the ground fixation system; epsilonnIs the gyroscope random error.
Wherein:
the velocity error equation for an inertial navigation system is described below
Consider δ gn=0,δfn=fp-fnWherein f ispIs the actual output of the accelerometer. Let the measurement error of the accelerometer beThen
The velocity error equation is then obtained as:
wherein f isnThe acceleration vector under the navigation coordinate system; v. ofnThe velocity vector of the carrier under the navigation coordinate system is obtained;is the accelerometer random error.
The available position error equation is:
wherein the content of the first and second substances,variation of latitude, longitude and altitude errors of carrier respectivelyThe conversion rate; rNIs the radius of curvature of the meridian; rEIs the radius of curvature of the meridian;the velocity errors in the north, west and sky directions, respectively.
By combining the above formulas, the state equation of the integrated navigation system can be obtained:
based on the jacobian matrix, the following discretized state equation can be established:
Xk+1=ΦXk+Γwk
where Φ is the available state transition matrix and Γ is the discretized input matrix. Let EKF filter update period be T, then their expressions are:
Φ=I+FT
Γ=GT
in order to improve the prediction precision of the state variable, a four-order Runge Kutta method is adopted to solve the differential equation.
The integral update expression of the state variable is as follows:
after the state prediction is completed, the quaternion is required to be standardized, the F and G matrixes are recalculated, and then the covariance is predicted by adopting the following formula
Pk+1=(I+FT)Pk(I+FT)T+T2GQGT
An EKF measurement fusion model of UWB ranging is constructed below;
the position vector r of the UWB tag in the North-West coordinate system with the UWB base station as the origin can be expressed as
Wherein L isU、λU、hULatitude, longitude and altitude of the tag, respectively; l isB、λB、hBLatitude, longitude and altitude of the base station, respectively.
The position vector r of the UWB tag in the North-West coordinate system with the UWB base station as the origin can be expressed as
The observed value of the distance between the vehicle-mounted UWB tag and the base station can be expressed as
The observed value of the distance between the vehicle-mounted UWB tag and the base station can be expressed as
Where ρ istrueRho is the actual distance and the observation distance from the label to the base station respectively; δ r is the distance error vector from the tag to the base station;a rotation matrix from a body coordinate system to a navigation coordinate system; luA lever arm vector of a tag to an inertial navigation center; phi is an inertial navigation installation angle error vector.
The UWB distance measurement may be expressed as
ρu=ρtrue+εu
Therefore, the observation equation can be expressed as
Zu=HuX+Vu
Wherein Z isuIs a UWB observation; huIs an observation sensitivity matrix; vuTo observe the noise.
Constructing a laser radar point cloud matching positioning model
After the data of the laser radar sensor is obtained, invalid point elimination and point cloud filtering are firstly needed to obtain effective point cloud information, the effective point cloud information is transmitted to a laser point cloud positioning module to serve as an input item of real-time scanning positioning, an IMU data processing module carries out data synchronization and pre-integration processing to obtain transformation information of the IMU sensor in adjacent moments and serves as scanning matching initial value input of the laser point cloud positioning module, a map provided by a first party is loaded by a map loading module, and IMU observed quantity in a laser point cloud positioning module [ t, t + delta t ] time sequence is input. The observation model of the IMU is:
after the point cloud information of the current scanning and the IMU pre-integration information are obtained, scanning matching between the current scanning frame and the existing map can be achieved, data constraint of the laser point cloud is obtained, then the data constraint is fused with the IMU pre-integration result, pose optimization is carried out by using an optimization method based on Unscented Kalman Filtering (UKF), and finally a laser point cloud positioning result is obtained.
And constructing a laser radar/IMU fusion positioning model.
The laser radar point cloud and the three-dimensional point cloud map are matched, so that the position and attitude data of the vehicle under a geodetic coordinate system can be obtained, the position comprises longitude, latitude and height, and the heading of the vehicle can be extracted according to the attitude data.
The observation equation of the combined system based on the position and the course of the laser radar is
Zlidar=HlidarX+Vlidar
Wherein
Equation of position observation
In a lidar/IMU fusion positioning system, the real-time position given by the inertial navigation system is the geographic latitude longitude and altitude, but contains errors. Is provided with LI、λIAnd hIRespectively latitude, longitude and altitude of the inertial navigation output, L, lambda and h respectively are true latitude, longitude and altitude, then
The lidar point cloud matching also gives the real-time position of the vehicle, and the main error source of the lidar point cloud matching is the error in the point cloud matching process. Is provided with Llidar、λlidar、hlidarLatitude, longitude and altitude of the laser radar matching output respectively, then
In the formula, NN、NW、NUThe position matching errors of the laser radar in the north, west and sky directions are obtained.
When the position difference between the INS and the GPS is taken as the observed quantity, the observation equation can be expressed by the following equation
Represents the above formula as
ZP=HPX+VP
In the formula
VP=[NN NW NU]T
Distance measurement noise VPAs white noise processing.
Calculating a course observation equation:
the real azimuth angle of the vehicle is psi, and the inertial navigation resolving error is delta psiIError angle delta phi obtained by laser radar point cloud matchingGThen, the azimuth angles of the inertial navigation and the laser radar are respectively:
ψI=ψ+δψI
ψG=ψ+δψG
the azimuthal observations of the system are:
Zψ=ψI-ψM=δψI-δψM=HψX+Vψ
wherein:
According to the UWB and laser radar observation equations constructed in the foregoing, a filtering update gain matrix can be calculated.
K=Pk+1HT(HPk+1HT+R)-1
The filter state variables are updated.
Xk+1=Xk+1|k+K(Zk+1-yk+1)
The filter covariance is updated.
Pk+1=Pk+1|k-KHPk+1|k
According to the state equation, the observation equation and the fusion processing model, the fusion positioning of UWB, laser radar and IMU can be realized.
The method adopts 1 vehicle-mounted UWB device, a plurality of UWB base stations, 1 IMU and 1 multi-line laser radar, and adopts the laser radar to carry out point cloud matching to obtain position and attitude data on the basis of constructing an underground high-precision map. By constructing a state equation with an IMU as a core and establishing a UWB and laser radar observation equation, the fusion calculation of the accurate position, speed and attitude of the unmanned vehicle under the underground mine environment without GNSS signals is realized, and accurate and stable navigation positioning information can be provided for the underground mine unmanned driving system.
It should be understood that the above examples are only for clarity of illustration and are not intended to limit the embodiments. Other variations and modifications will be apparent to persons skilled in the art in light of the above description. And are neither required nor exhaustive of all embodiments. And obvious variations or modifications therefrom are within the scope of the invention.
Claims (4)
1. A method for positioning mine and mine fusion based on UMB, IMU and laser radar is characterized by comprising the following steps:
s1, constructing an IMU-based vehicle position and posture estimation model;
s2, constructing an EKF measurement fusion model based on UWB ranging;
s3, constructing a matching positioning model of the laser radar point cloud;
s4, constructing a fusion positioning model based on S1, S2 and S3.
2. The method for positioning mine and mine fusion based on UMB, IMU and lidar according to claim 1, wherein the method for constructing the vehicle position and attitude estimation model in step S1 specifically comprises the following steps:
s101, calculating a deterministic error of the IMU inertial navigation system, comprising:
error of the platform angle:
wherein the content of the first and second substances,is the misalignment angle of the inertial navigation system under the navigation coordinate system;is a rotation angular velocity vector of the earth-fixed system relative to the inertial system;is a rotation angular velocity vector of the navigation system relative to the ground fixation system; epsilonnIs the gyroscope random error.
Speed error:
wherein f isnThe acceleration vector under the navigation coordinate system; v. ofnThe velocity vector of the carrier under the navigation coordinate system is obtained;is the accelerometer random error.
Position error:
wherein the content of the first and second substances,respectively, the latitude, longitude and altitude error change rate of the carrier; rNIs the radius of curvature of the meridian; rEIs the radius of curvature of the meridian; delta vN、δvW、δvUThe velocity errors in the north, west and sky directions, respectively.
S102, establishing a vehicle position and attitude estimation model:
firstly, establishing a state equation of an IMU inertial navigation system:
discretizing to obtain:
Xk+1=ΦXk+Γwk;
wherein the content of the first and second substances,
x is an inertial navigation state variable;
FINSis an inertial navigation state matrix;
w is an inertial navigation error variable;
g is an inertial navigation error sensitive matrix;
phi is a state transition matrix;
Γ is a discretized input matrix;
setting the EKF filtering updating period as T, calculating to obtain:
Φ=I+FT;
Γ=GT;
then, an integral update expression of the state variable is calculated:
after quaternion normalization, recalculating the F and G matrices to obtain:
Pk+1=(I+FT)Pk(I+FT)T+T2GQGT;
where Q is the process noise matrix. The covariance can be predicted according to the above equation.
3. The method for positioning fusion of underground mine based on UMB, IMU and lidar as claimed in claim 2, wherein the step S3 of constructing EKF measurement fusion model based on UWB ranging specifically comprises the following steps:
s201, calculating a position vector r of the UWB tag in a northwest coordinate system with the UWB base station as an origin:
wherein L isU、λU、hULatitude, longitude and altitude of the tag, respectively; l isB、λB、hBLatitude, longitude and altitude of the base station, respectively.
S202, calculating a distance observation value between the UWB tag and the base station:
ρu=ρtrue+εu;
where ρ istrueRho is the actual distance and the observation distance from the label to the base station respectively; δ r is the distance error vector from the tag to the base station;a rotation matrix from a body coordinate system to a navigation coordinate system; luA lever arm vector of a tag to an inertial navigation center; phi is an inertial navigation installation angle error vector.
S203, obtaining an observation equation:
Zu=HuX+Vu。
wherein Z isuIs a UWB observation; huIs an observation sensitivity matrix; vuTo observe the noise.
4. The UMB, IMU and lidar based well-mine fusion positioning method according to claim 3, wherein the specific process of step S4 is as follows:
the observation equation of the combined system based on the position and the course of the laser radar is
Zlidar=HlidarX+Vlidar;
Wherein:
calculating a filter updating gain matrix:
K=Pk+1HT(HPk+1HT+R)-1;
updating the filter state variables:
xk+1=xk+1|k+K(Zk+1-yk+1);
updating the filter covariance:
Pk+1=Pk+1|k-KHPk+1|k;
then, a fusion model is obtained according to the state equation in the step S1, the observation equation in the step S2.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111612525.7A CN114323003A (en) | 2021-12-27 | 2021-12-27 | Underground mine fusion positioning method based on UMB, IMU and laser radar |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111612525.7A CN114323003A (en) | 2021-12-27 | 2021-12-27 | Underground mine fusion positioning method based on UMB, IMU and laser radar |
Publications (1)
Publication Number | Publication Date |
---|---|
CN114323003A true CN114323003A (en) | 2022-04-12 |
Family
ID=81013611
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111612525.7A Pending CN114323003A (en) | 2021-12-27 | 2021-12-27 | Underground mine fusion positioning method based on UMB, IMU and laser radar |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114323003A (en) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115406439A (en) * | 2022-08-16 | 2022-11-29 | 中国第一汽车股份有限公司 | Vehicle positioning method, system, device and nonvolatile storage medium |
CN115561703A (en) * | 2022-09-30 | 2023-01-03 | 中国测绘科学研究院 | Three-dimensional positioning method and system for single UWB (ultra wide band) base station assisted by laser radar in closed space |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20100317420A1 (en) * | 2003-02-05 | 2010-12-16 | Hoffberg Steven M | System and method |
US20150301533A1 (en) * | 2013-04-22 | 2015-10-22 | Eagle Harbor Holdings, Llc | System and method for real-time guidance and mapping of a tunnel boring machine and tunnel |
CN110514225A (en) * | 2019-08-29 | 2019-11-29 | 中国矿业大学 | The calibrating external parameters and precise positioning method of Multi-sensor Fusion under a kind of mine |
CN111578939A (en) * | 2020-03-23 | 2020-08-25 | 济南大学 | Robot tight combination navigation method and system considering random variation of sampling period |
CN111637888A (en) * | 2020-06-15 | 2020-09-08 | 中南大学 | Tunneling machine positioning method and system based on inertial navigation and laser radar single-point distance measurement |
US20210089040A1 (en) * | 2016-02-29 | 2021-03-25 | AI Incorporated | Obstacle recognition method for autonomous robots |
CN112683268A (en) * | 2020-12-08 | 2021-04-20 | 中国铁建重工集团股份有限公司 | Roadway real-time positioning navigation method and system based on extended Kalman filtering |
CN112904395A (en) * | 2019-12-03 | 2021-06-04 | 青岛慧拓智能机器有限公司 | Mining vehicle positioning system and method |
CN113009453A (en) * | 2020-03-20 | 2021-06-22 | 青岛慧拓智能机器有限公司 | Mine road edge detection and map building method and device |
CN113286360A (en) * | 2021-05-12 | 2021-08-20 | 重庆菲莫科技有限公司 | Underground mining UWB positioning system and positioning method |
-
2021
- 2021-12-27 CN CN202111612525.7A patent/CN114323003A/en active Pending
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20100317420A1 (en) * | 2003-02-05 | 2010-12-16 | Hoffberg Steven M | System and method |
US20150301533A1 (en) * | 2013-04-22 | 2015-10-22 | Eagle Harbor Holdings, Llc | System and method for real-time guidance and mapping of a tunnel boring machine and tunnel |
US20210089040A1 (en) * | 2016-02-29 | 2021-03-25 | AI Incorporated | Obstacle recognition method for autonomous robots |
CN110514225A (en) * | 2019-08-29 | 2019-11-29 | 中国矿业大学 | The calibrating external parameters and precise positioning method of Multi-sensor Fusion under a kind of mine |
CN112904395A (en) * | 2019-12-03 | 2021-06-04 | 青岛慧拓智能机器有限公司 | Mining vehicle positioning system and method |
CN113009453A (en) * | 2020-03-20 | 2021-06-22 | 青岛慧拓智能机器有限公司 | Mine road edge detection and map building method and device |
CN111578939A (en) * | 2020-03-23 | 2020-08-25 | 济南大学 | Robot tight combination navigation method and system considering random variation of sampling period |
CN111637888A (en) * | 2020-06-15 | 2020-09-08 | 中南大学 | Tunneling machine positioning method and system based on inertial navigation and laser radar single-point distance measurement |
CN112683268A (en) * | 2020-12-08 | 2021-04-20 | 中国铁建重工集团股份有限公司 | Roadway real-time positioning navigation method and system based on extended Kalman filtering |
CN113286360A (en) * | 2021-05-12 | 2021-08-20 | 重庆菲莫科技有限公司 | Underground mining UWB positioning system and positioning method |
Non-Patent Citations (2)
Title |
---|
YUMING CUI等: "Integrated Positioning System of Unmanned Automatic Vehicle in Coal Mines", 《IEEE TRANSACTIONS ON INSTRUMENTATION AND MEASUREMENT》, pages 1 - 13 * |
陈炜翰;李世银;: "基于超宽带和微惯导组合的室内精确定位", 电子元器件与信息技术, no. 01 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115406439A (en) * | 2022-08-16 | 2022-11-29 | 中国第一汽车股份有限公司 | Vehicle positioning method, system, device and nonvolatile storage medium |
CN115561703A (en) * | 2022-09-30 | 2023-01-03 | 中国测绘科学研究院 | Three-dimensional positioning method and system for single UWB (ultra wide band) base station assisted by laser radar in closed space |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110501024B (en) | Measurement error compensation method for vehicle-mounted INS/laser radar integrated navigation system | |
CN110780326A (en) | Vehicle-mounted integrated navigation system and positioning method | |
CN107588769B (en) | Vehicle-mounted strapdown inertial navigation, odometer and altimeter integrated navigation method | |
CN110631593A (en) | Multi-sensor fusion positioning method for automatic driving scene | |
US6459990B1 (en) | Self-contained positioning method and system thereof for water and land vehicles | |
CN201955092U (en) | Platform type inertial navigation device based on geomagnetic assistance | |
De Agostino et al. | Performances comparison of different MEMS-based IMUs | |
CN112505737B (en) | GNSS/INS integrated navigation method | |
CN114323003A (en) | Underground mine fusion positioning method based on UMB, IMU and laser radar | |
CN101858748A (en) | Fault-tolerance autonomous navigation method of multi-sensor of high-altitude long-endurance unmanned plane | |
CN101109959A (en) | Attitude determining system of mini system suitable for any motion | |
CN111947681B (en) | Filtering correction method for GNSS and inertial navigation combined navigation position output | |
CN104515527A (en) | Anti-rough error integrated navigation method under non-GPS signal environment | |
CN113220013A (en) | Multi-rotor unmanned aerial vehicle tunnel hovering method and system | |
Gao et al. | Development of precise GPS/INS/wheel speed sensor/yaw rate sensor integrated vehicular positioning system | |
Ilyas et al. | Low-cost IMU/odometer/GPS integrated navigation aided with two antennae heading measurement for land vehicle application | |
Gao et al. | An integrated land vehicle navigation system based on context awareness | |
CN110940344A (en) | Low-cost sensor combination positioning method for automatic driving | |
Nebot et al. | Initial calibration and alignment of an inertial navigation | |
CN114088091A (en) | Multi-sensor-based underground mine pose fusion method and system | |
Park et al. | Implementation of vehicle navigation system using GNSS, INS, odometer and barometer | |
CN106646569A (en) | Navigation and positioning method and device | |
CN113236363A (en) | Mining equipment navigation positioning method, system, equipment and readable storage medium | |
Kubo et al. | DGPS/INS/VVheelSensor Integrationfor High Accuracy Land-Vehicle Positioning | |
US20190063925A1 (en) | Systems and Methods with Dead-Reckoning |
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 |