Coal mining machine accurate positioning method based on multi-source information fusion
By combining UWB and INS technology in the coal miner, the problems of positioning error accumulation and environmental interference of coal miner are solved, and higher accuracy and stable positioning are achieved, and the operating efficiency of coal miner is improved. and security.
Patent Information
- Application Number
- CN202410983566.4
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-07-22
- Publication Date
- 2024-11-26
AI Technical Summary
Coal mining machine positioning has problems such as accumulation of positioning errors, environmental interference, data asynchronousness and inefficient positioning system performance in complex mine environments, especially when wireless signal positioning is affected by obstacles.
Using a tight coupling method based on Kalman filtering, wireless ultra-wideband pulse positioning technology (UWB) and inertial navigation positioning technology (INS) are fused, and the Kalman filtering algorithm is improved through the anti-difference estimation theory, using INS measurement values as filter prediction , UWB measurement value is updated as a filter to compensate for the loss of positioning data, reduce positioning data jitter, and improve the stability of the positioning system.
It effectively improves the positioning accuracy and system stability of the coal mine, reduces noise errors and error accumulation, adapts to complex working conditions of coal mines, realizes accurate positioning of the coal mine, and improves operating efficiency and safety.
Smart Images

Figure CN119022919A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of coal mining machine navigation and positioning, and in particular to a coal mining machine precise positioning method based on multi-source information fusion. Background Art
[0002] As an important energy resource, coal plays a key role in the national energy structure and has a profound impact on the economy and residents' lives. Although the proportion of coal in energy production is gradually decreasing, it still dominates industrial production and residents' consumption. Faced with the complex environment and safety risks in coal mining, it is crucial to realize intelligent mining, especially the research on information perception technology of "three machines" (coal mining machine, scraper conveyor and hydraulic support).
[0003] In order to solve the challenges in coal mining, the application of comprehensive positioning technology has become particularly important. By complementing the advantages of different positioning technologies, the positioning accuracy of coal mining machines can be improved, thereby improving the efficiency and safety level of coal mining. National policies have also gradually supported the intelligent development of coal to improve production efficiency and safety. Smart energy construction has become a focus, promoting the intelligent upgrading of the coal industry and promoting the innovative application of advanced technology and equipment. The intelligent and unmanned development of coal mining is imperative, and it is particularly important to improve the intelligence level of coal mining units to provide basic support for the entire coal mining system. In summary, the application of coal mining machine positioning accuracy in coal mining is of great significance and has important value in improving the efficiency and safety of the coal industry.
[0004] At present, in actual coal mine applications, coal mining machine positioning is still mainly based on inertial navigation systems to obtain the position information of coal mining machines in real time. However, with the long-term use of inertial navigation systems, their cumulative errors continue to increase, resulting in inaccurate positioning of coal mining machines, which requires regular calibration.
[0005] The current status of research on coal mining machine positioning:
[0006] (1) Coal mining machine positioning method
[0007] Zhang Qigao's team from China University of Mining and Technology designed a coal mining machine positioning system based on joint inertial navigation. The system installed inertial navigation equipment on the coal mining machine and obtained the coal mining machine's three-axis acceleration and three-axis angular velocity to obtain the coal mining machine's attitude information;
[0008] Zhao Shangqing and his team established a positioning error model caused by the deviation of the coal mining machine's inertial navigation device and proposed a deviation angle calibration algorithm based on the double-point method, thereby achieving accurate positioning of the coal mining machine;
[0009] Li Hui et al. eliminated the positioning error caused by the curved shape of the base plate and improved the positioning accuracy by integrating the model of three positioning technologies: infrared sensor, shaft encoder and inertial navigation.
[0010] Wang Qiang used hybrid model technology to build a model of the underground mining environment, and based on this, he proposed a design scheme for the autonomous navigation system of the coal mining machine. Combining lidar and inertial navigation systems, he studied the position and posture determination method of the coal mining robot, and discussed in detail the working mode of the inertial navigation system and the working mechanism of the reaction module;
[0011] Zhang Peng et al. proposed to use ultrasonic technology to establish a coal mining machine positioning system;
[0012] Feng Shuai proposed to integrate the strapdown inertial navigation system, shaft encoder and infrared sensor to locate the coal mining machine;
[0013] Zhang Bin et al. proposed a scheme to combine gyroscope and odometer under the premise of coal mining machine autonomous positioning system, and achieved good results in simulation experiments;
[0014] Li Ang et al. proposed to use an inertial navigation device with automatic north-seeking function combined with an axis encoder to position the coal mining machine.
[0015] (2) Positioning error correction method
[0016] Dinghua Liu advocated an improved Kalman filtering method based on observability analysis, which can improve the accuracy of initial calibration and shorten the calibration time;
[0017] Zhang Lei studied the dynamic model of inertial navigation error based on Kalman filtering, explored the influence of Kalman filter parameter selection on filter performance, and used adaptive filter parameters to perform Kalman filter calibration for inertial navigation.
[0018] Li Xinqiu and others found through experiments that the system error mainly comes from the cumulative error of inertial devices. They used the Kalman filter algorithm combined with the kinematic model of the coal mining machine to continuously correct the cumulative error of the inertial devices and effectively reduce the system error caused by the characteristics of the inertial devices.
[0019] N Yan et al. introduced magnetometer-assisted positioning based on the inertial navigation system, proposed an inertial navigation / fiber optic gyroscope / magnetometer combined navigation system, and established an adaptive joint Kalman filter to complete the data fusion of the navigation system to improve the fault tolerance of the system;
[0020] Wang Jing and his colleagues proposed an inertial navigation positioning method for coal mining machines, using the Kalman filter algorithm to continuously correct the difference between the system's set state parameters and the actual state parameters to achieve accurate positioning of the coal mining machine.
[0021] Based on the application of the above-mentioned coal mining machine positioning technology and the current status of related technology research, the following problems still exist in coal mining machine positioning:
[0022] (1) Due to the complexity of the mine environment and the mutually constrained motion characteristics of equipment such as coal mining machines, it is difficult to fully analyze the inertial navigation positioning error of coal mining machines, or to effectively compensate for the influence of positioning errors under dynamic models. This situation leads to serious accumulation of initial calibration and attitude solution errors during long-term navigation, making the positioning accuracy unable to meet the positioning requirements of coal mining machines.
[0023] (2) Due to the poor robustness and unstable output of wire signal positioning technology, coal mining machines are often affected by environmental factors such as obstacles, multipath effects and signal attenuation when performing wireless signal positioning in complex fully mechanized mining faces. Therefore, when considering external interference, it is necessary to comprehensively consider the stability of the combined positioning system, especially in non-line-of-sight environments or when the wireless sensor network fails, to determine the coal mining machine positioning strategy.
[0024] (3) In combined positioning, there is the problem of data asynchrony. Since two different coal mining machine positioning technologies are used, they have different working principles and positioning characteristics, resulting in asynchrony in the acquisition time of various positioning data during the positioning process. This asynchrony may cause asynchronous errors in the data filtering and fusion process. Therefore, in combined positioning, it is necessary to consider the challenge of how to effectively handle asynchronous data.
[0025] (4) In recent years, a large number of studies on combined positioning of coal mining machines have been carried out at home and abroad. Most of them use Kalman filtering as the fusion method of ordinary combined positioning data. The relationship between linear and nonlinear is not taken into account in the fusion calculation, resulting in large errors. In addition, a loose coupling method is used in combined positioning, resulting in problems such as low performance and low efficiency of the positioning system. Summary of the invention
[0026] In view of the problems existing in the current positioning of coal mining machines, the present invention provides a coal mining machine precise positioning method based on multi-source information fusion which is based on Kalman filtering and integrates wireless ultra-wideband pulse positioning technology (UWB) and inertial navigation positioning technology (INS).
[0027] The solution adopted by the present invention to solve the technical problem is: a coal mining machine precise positioning method based on multi-source information fusion, based on Kalman filtering, integrating wireless ultra-wideband pulse positioning system (UWB) and inertial navigation positioning system (INS) for coal mining machine positioning, using a tightly coupled method, based on Robust Estimation Theory The unscented Kalman filter algorithm is improved as a framework, with INS measurement values as filter predictions and UWB measurement values as filter measurement updates, to compensate for the short-term positioning data loss of the fusion positioning algorithm, reduce positioning data jitter, and improve the stability of the positioning system.
[0028] Furthermore, based on the inertial navigation positioning system, the position and velocity of the motion platform in the coal mine working face coordinate system are obtained by integrating the three-axis acceleration, a E ,a N ,a U Represents the three-axis acceleration of the working surface in the navigation coordinate system:
[0029]
[0030] Where λ E , h U Indicates the initial position of the working surface; v E (t),v N (t),v U (t) represents the initial speed of the coal mining machine in the working face coordinate system; a E ,a N ,a U Calculated by coordinate system transformation:
[0031]
[0032] R represents the rotation matrix from the carrier coordinate system to the navigation coordinate system; It represents the three-axis acceleration of the motion platform based on the carrier coordinate system; g represents the gravity value of the environment where the coal mining machine is located.
[0033] The spatial transformation relationship of the shearer coordinates is:
[0034]
[0035] The wireless ultra-wideband pulse positioning system uses the TOA algorithm for positioning. After obtaining multiple TOA measurement values, the distance relationship between the unknown tag and multiple base stations is obtained, and then a distance equation group is constructed. Through the distance equation group, the coordinates of the mobile tag are determined. The mathematical expression of the distance equation group is as follows:
[0036]
[0037] (x i ,y i ,z i ) is used to measure the coordinate values of all base stations. By performing Taylor series expansion on the above formula at the approximate position and retaining the first-order term, the position offset is expressed as a linear function of the known coordinates and distance measurement values. The measurement model of the Kalman filter is constructed. The position offset is represented by (δx, δy, δz), and the distance offset of the i-th base station is represented by δr i express
[0038]
[0039] On this basis, new variables are introduced to simplify the equations, a xi ,a yi ,a zi Represents the direction cosine of the unit vector pointing to the i-th base station
[0040]
[0041] The matrix form of the system of equations is shown below:
[0042]
[0043] Further, the method of filtering by the Kalman filter algorithm includes the following process:
[0044] (1) The initial statistical characteristics of the state are:
[0045]
[0046] (2) Select the Sigma sampling strategy for UT transformation
[0047] (3) Time update process
[0048] According to the Sigma point sampling strategy in the second step, the Sigma point ξ i,k-1 (i=0,1,…,L) by and P k-1 Calculated, γ i,k|k-1 One-step state prediction can be obtained and the error covariance matrix P k|k-1 .
[0049] γ i,k|k-1 =f k-1 (ξ i,k-1 ),i=0,1,…,L
[0050]
[0051] (4) Measurement update
[0052] By measuring the function h k (·) Propagation of χ i,k|k-1 , we can get the output prediction value and the covariance matrix of the update sequence and the cross-covariance matrix
[0053] χ i,k|k-1 =h k (ξ i,k|k-1 ),i=0,1,…,L
[0054]
[0055] (5) Filter measurement update
[0056] When acquiring a new measurement Z k After that, the filter measurement update is performed as follows:
[0057]
[0058] Give the initial state Initial measurement variance P0, noise variance Q, measurement variance R, and number of iterations T.
[0059] Furthermore, the unscented Kalman filter algorithm is improved based on the equivalent weight principle in robust estimation theory.
[0060] Furthermore, the improved unscented Kalman filter algorithm based on the equivalent weight principle includes using an adaptive function to adjust each sensor value when performing sensor observation value fusion calculation. Let the observation vector be L, and the predicted state estimation value of the coal mining machine inertial navigation be The estimated state value of the nth sensor in the kth cycle is Then the error equation is:
[0061]
[0062] Where: V n YesL n The residual vector, A n is the observation matrix, then the estimated solution of the state quantity using the least squares function is:
[0063]
[0064] Where: B n is the prior weight matrix,
[0065] From the above formula, we can see that the extreme value solution can resist the outliers on L n The impact is as follows:
[0066]
[0067] Then, from the extreme value solution of the above formula, the robust estimation solution is calculated as:
[0068]
[0069] Where: As the weight function, the three-stage method is used to process the data through the iterative method to realize the estimation of the robust estimation weight. The three-stage method is as follows:
[0070]
[0071] Where: is the observed standardized residual, k0=1.5,k1∈[2.5,8.0], where k1=4,
[0072] UKF obtains Simma points through UT transformation. The sampling result depends on the estimated value at the previous moment. The UKF filter is designed using the syllogism method to change the measurement and observation update as follows:
[0073] The χ propagated through the observation equation i,(k,k-1) , output the predicted value and the covariance matrix of the update sequence
[0074]
[0075] Where: Improved R before filtering k The equivalent noise covariance matrix of
[0076] Use the equivalent weight principle to iteratively find the equivalent weight, and then update the filtered observation as follows:
[0077]
[0078] Updated state variable values:
[0079]
[0080] Error covariance matrix update value:
[0081]
[0082] The derivation of UKF is improved by the principle of robust estimation equivalence, the noise matrix is replaced, and the filter gain of UKF is adjusted in real time. Indicates the closeness of the state estimate and the observed value.
[0083] Furthermore, the method for coal mining machine combined positioning based on tightly coupled INS / UWB includes:
[0084] (1) State equation: The tightly coupled combined positioning method uses the speed, position, and posture data of the coal mining machine to derive the state vector equation:
[0085]
[0086] Among them, E, N, U. represent the northeast sky, [δv E ,δv N ,δv U ] is the northeast sky velocity error, [φ E ,φ N ,φ U] is the attitude error, [δL,δλ,δh] is the northeast sky position error, [ε x ,ε y ,ε z ] is the error value of gyroscope drift, is the accelerometer offset,
[0087] The system state equation of the tightly coupled INS / UWB integration can be as follows:
[0088] X(k+1)=F(k)X(k)+G(k)W(k)
[0089] Where: F(k) represents the system state transfer matrix, G(k) represents the process noise matrix, W(k) = [w x (k) w y (k)w z (k)] means the mean is zero and the variance is The process noise matrix of F is the transfer matrix of the system and W is the noise matrix;
[0090] (2) Observation equation: The observation vector of the system at time k is defined as Z(k), which contains the actual distance d from the tag to the base station. n (k) and the distance observation noise v n (k), then the observation equation of the system is:
[0091]
[0092] Where: h[X(k)]=[d1(k) d2(k) … d n V(k) = [v1(k) v2(k) … v n (k)] means the mean is zero and the variance is The distance observation noise matrix, where the distance from the UWB positioning tag to the base station is:
[0093]
[0094] Beneficial effects of the invention: The invention provides a coal mining machine precise positioning method based on multi-source information fusion, which is based on Kalman filtering and integrates wireless ultra-wideband pulse positioning technology (UWB) and inertial navigation positioning technology (INS), and can solve the problem of inaccuracy of a single positioning system due to large cumulative errors, thereby adapting to the complex working conditions of a coal mine working face and realizing precise positioning of the coal mining machine.
[0095] The present invention makes up for the shortcomings of a single positioning system: the traditional single positioning system may have problems such as low positioning accuracy and susceptibility to environmental interference. By integrating inertial navigation and UWB wireless positioning technology, the respective advantages of the two technologies can be combined to make up for each other's shortcomings, effectively improving the positioning accuracy of the coal mining machine, ensuring that the coal mining machine can accurately locate and perform tasks in coal mine operations, and improving operating efficiency and safety. Adopting a tightly coupled fusion method: the tightly coupled fusion method allows the inertial navigation and UWB wireless positioning technologies to work more closely together, effectively eliminating noise errors and error accumulation problems that may occur during the positioning process, and improving the stability and reliability of the system. By replacing the noise matrix and adjusting the filter gain of the UKF in real time: by improving the UKF algorithm, replacing the noise matrix and adjusting the filter gain in real time, it can better adapt to the uncertainty and changes in the actual working environment, thereby demonstrating the close relationship between the coal mining machine inertial navigation and the UWB wireless positioning technology, and improving positioning accuracy and stability. BRIEF DESCRIPTION OF THE DRAWINGS
[0096] Figure 1 It is a frame view of the coal mining machine precise positioning method based on multi-source information fusion described in the present invention.
[0097] Figure 2 It is a block diagram of the present invention based on the Kalman filter algorithm. DETAILED DESCRIPTION
[0098] In order to make the purpose, technical solution and advantages of the present invention clearer, the technical solution of the present invention will be described in detail below.
[0099] Embodiment 1: The present invention adopts a tightly coupled approach, based on the equivalent weight principle, to improve the unscented Kalman filter algorithm into a framework, using INS measurement values as filter predictions and UWB measurement values as filter measurement updates, such as Figure 1 As shown in the figure, the fusion positioning algorithm can make up for the loss of positioning data in the short term, reduce the jitter of positioning data, and improve the stability of the positioning system.
[0100] The process of coal mining machine based on inertial navigation positioning in the present invention is:
[0101] The position and velocity of the motion platform in the coal mine working face coordinate system (E system) can be obtained by integrating the three-axis acceleration. E ,a N ,a U Indicates the three-axis acceleration of the working surface in the navigation coordinate system (N system):
[0102]
[0103] Where λ E , hU Indicates the initial position of the working surface; v E (t),v N (t),v U (t) represents the initial velocity of the coal mining machine in the working face coordinate system.
[0104] a E ,a N ,a U It can be calculated by coordinate system transformation:
[0105]
[0106] R represents the rotation matrix from the carrier coordinate system to the navigation coordinate system; It represents the three-axis acceleration of the motion platform based on the carrier coordinate system; g represents the gravity value of the environment in which the coal mining machine is located.
[0107] The spatial transformation relationship of the shearer coordinates is:
[0108]
[0109] Coal mining machine positioning method based on UWB technology:
[0110] UWB positioning usually uses the TOA algorithm for positioning. After obtaining multiple TOA measurement values, the distance relationship between the unknown tag and multiple base stations can be obtained, and then a distance equation group can be constructed. By solving these equation groups, the coordinates of the mobile tag can be determined. The mathematical representation of these equations is as follows:
[0111]
[0112] (x i ,y i ,z i ) are the coordinate values of all base stations measured.
[0113] By performing a Taylor series expansion on the above formula at the approximate position and retaining the first-order term, the position offset can be expressed as a linear function of the known coordinates and distance measurement values. In this way, the measurement model of the Kalman filter can be constructed. In this algorithm, the position offset is represented by (δx, δy, δz), and the distance offset of the i-th base station is represented by δr i express:
[0114]
[0115] To simplify the above equation, a new variable will be introduced, a xi ,a yi ,a zi Represents the direction cosines of the unit vector pointing to the i-th base station:
[0116]
[0117] To sum up, the matrix form of the equation is as follows:
[0118]
[0119] The present invention is based on the UKF algorithm filtering recursive formula comprising:
[0120] (1) The initial statistical characteristics of the state are:
[0121]
[0122] (2) Select the sigma sampling strategy of UT transformation;
[0123] (3) Time update process
[0124] According to the Sigma point sampling strategy in the second step, the Sigma point ξ i,k-1 (i=0,1,…,L) by and P k-1 Calculated, γ i,k|k-1 One-step state prediction can be obtained and the error covariance matrix P k|k-1 :
[0125] γ i,k|k-1 =f k-1 (ξ i,k-1 ),i=0,1,…,L (12)
[0126]
[0127] (4) Measurement update
[0128] By measuring the function h k (·) Propagation of χ i,k|k-1 , we can get the output prediction value and the covariance matrix of the update sequence and the cross-covariance matrix
[0129] χ i,k|k-1 =h k (ξ i,k|k-1 ),i=0,1,…,L (15)
[0130]
[0131] (5) Filter measurement update
[0132] When acquiring a new measurement Z k After that, the filter measurement update is performed as follows:
[0133]
[0134] Give the initial state Initial measurement variance P0, noise variance Q, measurement variance R, number of iterations T, such as Figure 2 shown.
[0135] The UKF algorithm based on robust estimation theory in the present invention is designed as follows:
[0136] When performing sensor observation value fusion calculation, the adaptive function is used to adjust the sensor values. Assume that the observation vector is L, and the predicted state estimation value of the coal mining machine inertial navigation is The estimated state value of the nth sensor in the kth cycle is Then the error equation is:
[0137]
[0138] Where: V n YesL n The residual vector, A n is the observation matrix, then the estimated solution of the state quantity using the least squares function is:
[0139]
[0140] Where: B n is the prior weight matrix. From the above formula, we can see that in order to resist the outliers on L n The influence of, here is the extreme value solution, as shown below:
[0141]
[0142] Based on the extreme value solution of the above formula, the robust estimation solution is calculated as:
[0143]
[0144] Where: As the weight function, the three-stage method is used to process the data through the iterative method to achieve the optimal estimation of the robust estimation weight. The three-stage method is as follows:
[0145]
[0146] Where: is the observed standardized residual, k0=1.5,k1∈[2.5,8.0], where k1=4.
[0147] UKF obtains a certain number of Simma points through UT transformation. It can be seen that the sampling result depends on the estimated value at the previous moment. Here, the UKF filter is designed using the syllogism method, mainly changing the measurement and observation update, as follows:
[0148] The χ propagated through the observation equation i,(k,k-1) , output the predicted value and the covariance matrix of the update sequence
[0149]
[0150] Where: Before filtering improvement k The equivalent noise covariance matrix of .
[0151] Use the equivalent weight principle to iteratively find the equivalent weight, and then update the filtered observation as follows:
[0152]
[0153] Updated state variable values:
[0154]
[0155] Error covariance matrix update value:
[0156]
[0157] According to the above improved UKF derivation based on the principle of robust estimation equivalence, the main thing is to replace the noise matrix and adjust the filter gain of UKF in real time. Indicates the closeness of the state estimate and the observed value.
[0158] The present invention is based on a tightly coupled INS / UWB coal mining machine combined positioning method:
[0159] (1) Equation of state
[0160] The tightly coupled combined positioning method uses the speed, position, and posture data of the coal mining machine to derive the state vector equation:
[0161]
[0162] Among them, E, N, U. represent the northeast sky, [δv E ,δv N ,δv U ] is the northeast sky velocity error, [φ E ,φ N ,φ U ] is the attitude error, [δL,δλ,δh] is the northeast sky position error, [ε x ,εy ,ε z ] is the error value of gyroscope drift, is the accelerometer offset.
[0163] The system state equation of the tightly coupled INS / UWB integration can be as follows:
[0164] X(k+1)=F(k)X(k)+G(k)W(k)(31)
[0165] Where: F(k) represents the system state transfer matrix, G(k) represents the process noise matrix, W(k) = [w x (k) w y (k)w z (k)] means the mean is zero and the variance is The process noise matrix.
[0166] Where F is the transfer matrix of the system and W is the noise matrix.
[0167] (2) Observation equation
[0168] Define the observation vector of the system at time k as Z(k), which contains the actual distance d from the tag to the base station n (k) and the distance observation noise v n (k), then the observation equation of the system is:
[0169]
[0170] Where: h[X(k)]=[d1(k) d2(k) … d n V(k) = [v1(k) v2(k) … v n (k)] means the mean is zero and the variance is The distance observation noise matrix;
[0171] The distance from the UWB positioning tag to the base station is:
[0172]
[0173] The present invention integrates inertial navigation and UWB wireless positioning technology to make up for the shortcomings of a single positioning system and achieve high-precision positioning of the coal mining machine. At the same time, it adopts a tightly coupled fusion method to effectively eliminate noise errors.
[0174] The present invention improves the UKF algorithm based on robust estimation theory, mainly by replacing the noise matrix and adjusting the filter gain of the UKF in real time to show the close relationship between the state estimation value and the observation value.
[0175] Example 2: Based on the tight coupling fusion of inertial navigation and UWB wireless positioning technology and the improvement of the UKF algorithm based on the anti-error estimation theory to achieve the effect of precise positioning of the coal mining machine, sensors such as odometers and radars can also be considered to provide data support in more dimensions, and the position and posture of the coal mining machine can also be accurately located. In addition, for the existing filtering algorithms, it is also possible to consider the use of an adaptive UKF algorithm or other improved algorithms to achieve more accurate and reliable processing of system state estimation. The comprehensive application of these measures is expected to further enhance the performance of the positioning system, making it more suitable for complex working environments in fields such as coal mining machines.
[0176] Obviously, the described embodiments are only some embodiments of the present invention, not all embodiments. Based on the embodiments of the present invention, all other implementation methods obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.
Claims
1. A coal mining machine precise positioning method based on multi-source information fusion, characterized in that: Based on Kalman filtering, the coal mining machine positioning is carried out by integrating the wireless ultra-wideband pulse positioning system and the inertial navigation positioning system. A tightly coupled method is adopted, and the unscented Kalman filter algorithm is improved based on the robust estimation theory. The measurement value of the inertial navigation positioning system is used as the prediction of the filter, and the measurement value of the wireless ultra-wideband pulse positioning system is used as the filter measurement update. This can make up for the short-term positioning data loss of the fusion positioning algorithm, reduce the positioning data jitter, and improve the stability of the positioning system.
2. The method for accurate positioning of coal mining machines based on multi-source information fusion according to claim 1 is characterized in that: Based on the inertial navigation positioning system, the position and velocity of the motion platform in the coal mine working face coordinate system are obtained by integrating the three-axis acceleration, a E , a N , a U Represents the three-axis acceleration of the working surface in the navigation coordinate system: In the formula Indicates the initial position of the working surface; v E (t), v N (t), v U (t) represents the initial speed of the coal mining machine in the working face coordinate system; a E , a N , a U Calculated by coordinate system transformation: R represents the rotation matrix from the carrier coordinate system to the navigation coordinate system; It represents the three-axis acceleration of the motion platform based on the carrier coordinate system; g represents the gravity value of the environment where the coal mining machine is located. The spatial transformation relationship of the shearer coordinates is: The wireless ultra-wideband pulse positioning system uses the TOA algorithm for positioning. After obtaining multiple TOA measurement values, the distance relationship between the unknown tag and multiple base stations is obtained, and then a distance equation group is constructed. Through the distance equation group, the coordinates of the mobile tag are determined. The mathematical expression of the distance equation group is as follows: (x i ,y i , z i ) is used to measure the coordinate values of all base stations. By performing Taylor series expansion on the above formula at the approximate position and retaining the first-order term, the position offset is expressed as a linear function of the known coordinates and distance measurement values. The measurement model of the Kalman filter is constructed. The position offset is represented by (δx, δy, δz), and the distance offset of the i-th base station is represented by δr i express On this basis, new variables are introduced to simplify the equations, a xi , a yi , a zi Represents the direction cosine of the unit vector pointing to the i-th base station The matrix form of the system of equations is shown below:
3. The method for accurate positioning of coal mining machines based on multi-source information fusion according to claim 2 is characterized in that: The method of filtering by the Kalman filter algorithm includes the following process: (1) The initial statistical characteristics of the state are: (2) Select the Sigma sampling strategy for UT transformation (3) Time update process According to the Sigma point sampling strategy in the second step, the Sigma point ξ i,k-1 (i=0, 1, ..., L) by and P k-1 Calculated, γ i,k|k-1 One-step state prediction can be obtained and the error covariance matrix P k|k-1 . c i,k|k-1 =f k-1 (x) i,k-1 ), i=0, 1,…, L (4) Measurement update By measuring the function h k (·) Propagation of χ i,k|k-1 , we can get the output prediction value and the covariance matrix of the update sequence and the cross-covariance matrix X i,k|k-1 =h k (x) i,k|k-1 ), i=0, 1,…, L (5) Filter measurement update When obtaining a new measurement Z k After that, the filter measurement update is performed as follows: Give the initial state Initial measurement variance P0, noise variance Q, measurement variance R, and number of iterations T.
4. The method for accurate positioning of coal mining machines based on multi-source information fusion according to claim 3 is characterized in that: The unscented Kalman filter algorithm is improved based on the equivalent weight principle in robust estimation theory.
5. The method for accurate positioning of coal mining machines based on multi-source information fusion according to claim 4 is characterized in that: The improved unscented Kalman filter algorithm based on the equivalent weight principle includes using an adaptive function to adjust each sensor value when performing sensor observation value fusion calculation. Assuming the observation vector is L, the predicted state estimation value of the coal mining machine inertial navigation is The estimated state value of the nth sensor in the kth cycle is Then the error equation is: Where: V n YesL n The residual vector, A n is the observation matrix, then the estimated solution of the state quantity using the least squares function is: Where: B n is the prior weight matrix, From the above formula, we can see that the extreme value solution can resist the outliers on L n The impact is as follows: Then, from the extreme value solution of the above formula, the robust estimation solution is calculated as: Where: As the weight function, the three-stage method is used to process the data through the iterative method to realize the estimation of the robust estimation weight. The three-stage method is as follows: Where: is the observed standardized residual, k0=1.5, k1∈[2.5,8.0], where k1=4, UKF obtains Simma points through UT transformation, and the sampling result depends on the estimated value of the previous moment. The UKF filter is designed by the syllogism method, changing the measurement and observation update as follows: X propagated through the observation equation i,(k,k-1) , output the predicted value and the covariance matrix of the update sequence Where: Improved R before filtering k The equivalent noise covariance matrix of Use the equivalent weight principle to iteratively find the equivalent weight, and then update the filtered observation as follows: Updated state variable values: Error covariance matrix update value: The derivation of UKF is improved by the principle of robust estimation equivalence, the noise matrix is replaced, and the filter gain of UKF is adjusted in real time. Indicates the closeness of the state estimate and the observed value.
6. The method for accurate positioning of coal mining machines based on multi-source information fusion according to claim 2 is characterized in that: The combined positioning method of the coal mining machine based on the tightly coupled fusion wireless ultra-wideband pulse positioning system and the inertial navigation positioning system includes: (1) State equation: The tightly coupled combined positioning method uses the speed, position, and posture data of the coal mining machine to derive the state vector equation: Among them, E, N, U. represent the northeast sky, [δv E ,δv N ,δv U ] is the northeast sky velocity error, [φ E ,φ N ,φ U ] is the attitude error, [δL, δλ, δh] is the northeast sky position error, [ε x , ε y , ε z ] is the error value of gyroscope drift, is the accelerometer offset, The system state equation of the tightly coupled wireless ultra-wideband pulse positioning system and the inertial navigation positioning system integration can be as follows: X(k+1)=F(k)X(k)+G(k)W(k) Where: F(k) represents the system state transfer matrix, G(k) represents the process noise matrix, W(k) = [w x (k) w y (k) w z (k)] means the mean is zero and the variance is The process noise matrix of , where F is the transfer matrix of the system and W is the noise matrix; (2) Observation equation: The observation vector of the system at time k is defined as Z(k), which contains the actual distance d from the tag to the base station. n (k) and the distance observation noise v n (k), then the observation equation of the system is: Where: h[X(k)]=[d1(k) d2(k)...d n V(k) = [v1(k) v2(k)…v n (k)] means the mean is zero and the variance is The distance observation noise matrix, where the distance from the wireless ultra-wideband pulse positioning system positioning tag to the base station is:
Citation Information
Cited By
High-precision graph-free intelligent driving control method and system suitable for AGV robot
CN120335450A
Mining vehicle positioning method, device and equipment based on multi-sensor fusion and medium
CN121677749A
