Track joint beacon and inertial navigation combined monorail crane positioning method

By using a combination of track joint beacons and inertial navigation systems in underground monorail cranes in coal mines, combined with natural beacon identification and extended Kalman filtering algorithm, the poor autonomy and insufficient reliability of downhole monorail crane positioning are solved, and low cost is achieved , high-precision positioning, supporting intelligent scheduling of underground auxiliary transportation systems.

CN118936461APending Publication Date: 2024-11-12XUZHOU KERUI MINING TECH CO LTD +1
View PDF 0 Cites 2 Cited by

Patent Information

Application Number
CN202410956312.3
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-17
Publication Date
2024-11-12

AI Technical Summary

Technical Problem

The prior art has problems such as poor autonomy, high cost, difficulty in orientation and insufficient reliability in the positioning of underground single-rail lifting of coal mines. In particular, GPS and Beidou navigation cannot be used, and the accumulated error of inertial navigation leads to the inability to perform long-term high-precision positioning.

Method used

A single-track lifting positioning method is adopted that combines track joint beacons and inertial navigation, combining natural beacon recognition, kinematic modeling, dead estimation algorithm, short-distance inertial navigation algorithm, track joint judgment model and adaptive extended Kalman filtering algorithm. Achieve low-cost, high-precision and reliable positioning.

Benefits of technology

Through the combination of track joint beacon identification and inertial navigation system, cumulative errors are reduced, positioning accuracy and stability are improved, cost is reduced, and high-precision positioning of downhole single-rail cranes is achieved, supporting intelligent scheduling of downhole auxiliary transportation systems.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118936461A_ABST
    Figure CN118936461A_ABST
Patent Text Reader

Abstract

The invention discloses a track joint beacon and inertial navigation combined monorail crane positioning method. A speedometer kinematics model of a monorail crane is established through an encoder on the monorail crane, and a course angle resolved by the kinematics model and a course angle resolved by strapdown inertial navigation are fused by adopting extended Kalman filtering. Beacons are arranged at rail joints of the monorail crane, and vibration signals are collected by vibration sensors. In combination with a strapdown inertial navigation system, an encoder and a track installation diagram, a track joint judgment model is constructed to screen out impact signals, meeting requirements, at track joint beacons. And the identified beacon of the track joint is matched with the specific coordinate of the beacon in the track installation diagram by using the beacon number, so that a time-position coordinate sequence of the monorail crane running to the track joint is obtained. And constructing a combined positioning model of a track joint beacon and strapdown inertial navigation, and realizing the combination of local relative positioning and global absolute positioning of the monorail crane. The method can improve the positioning precision of the monorail crane and reduce the positioning cost at the same time.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention relates to the technical field of underground monorail crane positioning, and in particular to a monorail crane positioning method combining a track joint beacon and an inertial navigation system. Background Art

[0002] In the actual production process of coal, auxiliary transportation is one of the most important links. Monorail crane is currently one of the main auxiliary transportation equipment in coal mines. Its main function is to transport personnel and materials. It has large traction and runs along the steel rails fixed on the top of the coal mine tunnel. The running speed is not affected by the road conditions on the ground of the tunnel. Therefore, it is widely used underground. In order to realize the intelligent scheduling of the underground auxiliary transportation system, the precise positioning of the monorail crane is an important part of realizing the intelligent scheduling of the underground auxiliary transportation system.

[0003] Due to the special environment of coal mines, GPS and Beidou navigation systems cannot be used underground. Currently, the positioning technologies used in coal mines mainly include wireless positioning technology and inertial navigation technology. Wireless positioning technologies include laser scanning positioning technology, Bluetooth positioning technology, Wi-Fi positioning technology, RFID positioning technology, ZigBee positioning technology, and UWB positioning technology. However, there are problems such as signal attenuation caused by wireless signal reflection, non-line-of-sight scenarios, and multipath effects, which limit the application of various wireless positioning technologies in coal mines. Inertial navigation technology calculates position information through measured acceleration and angular velocity information. Although it has strong autonomy and is not affected by the external environment, it cannot perform long-term high-precision positioning due to the existence of cumulative errors.

[0004] The research on the positioning technology of monorail cranes in underground coal mines is still insufficient. There are problems such as poor autonomy, high cost, difficulty in orientation and insufficient reliability. An effective solution is to find a new, reliable and low-cost positioning technology suitable for monorail cranes in underground coal mines, and to improve the accuracy and stability of the entire positioning system by combining positioning technologies with different characteristics. Summary of the invention

[0005] In view of the above-mentioned technical deficiencies, the purpose of the present invention is to provide a monorail crane positioning method combining a track joint beacon and an inertial navigation system, which combines natural beacon recognition, kinematic modeling, dead reckoning algorithm, strapdown inertial navigation algorithm, track joint judgment model and adaptive extended Kalman filter algorithm to achieve low-cost, high-precision and reliable positioning of monorail cranes in underground coal mines, and provide technical support for the intelligent scheduling of underground auxiliary transportation systems.

[0006] In order to solve the above technical problems, the present invention adopts the following technical solutions:

[0007] The present invention provides a monorail crane positioning method combining a track joint beacon and an inertial navigation system, comprising the following steps:

[0008] S1: Install an encoder on the driving wheel of the monorail crane, establish an odometer kinematic model of the monorail crane based on the data obtained by the encoder, and calculate the forward speed, heading angle and heading angular velocity information of the monorail crane by solving the odometer kinematic model;

[0009] S2: Perform strapdown inertial navigation calculation based on data acquired by the strapdown inertial navigation system installed on the monorail crane to obtain the attitude, speed and position information of the monorail crane;

[0010] S3: Using the extended Kalman filter algorithm to fuse the heading data calculated based on the odometer kinematic model and the heading angle calculated by the strapdown inertial navigation, the combined positioning result of the inertial navigation and the odometer is obtained;

[0011] S4: beacons are set at the track joints of the monorail crane, the numbers of the beacons and the specific location information of the beacons are determined according to the track installation diagram of the monorail crane, and the transportation route of the monorail crane is divided into several driving sections using the location information determined by the beacons;

[0012] S5: installing a vibration sensor at the driving wheel of the monorail crane, using the vibration sensor to collect vibration signals during the driving process of the monorail crane, and performing signal processing on the collected vibration signals to identify vibration impact signals during the driving process;

[0013] S6: Based on the information collected by the strapdown inertial navigation system and the encoder, combined with the track installation diagram, a track joint judgment model is constructed, a suitable threshold is set according to the length of the track, the extracted pulse signal is judged, and the impact signal that meets the requirements is screened out, that is, the impact signal at the track joint beacon, and the impact signal at the identified track joint beacon is numbered;

[0014] S7: using the number of the identified track joint beacon, combined with the number of each beacon in the track installation diagram and the specific position of each beacon, the number is matched to obtain the time and position coordinate sequence of the monorail crane running to the track joint;

[0015] S8: Establish a combined positioning model of track joint beacons and strapdown inertial navigation, and use the absolute positioning information obtained by combining the recognition and judgment of the track joint beacons with the track installation diagram to achieve phased calibration and reset of the monorail crane positioning information, thereby realizing the combination of local relative positioning and global absolute positioning of the monorail crane.

[0016] Preferably, in step S3, the extended Kalman filter algorithm is used to obtain the primary positioning result FPR of the monorail crane. t =(t,x 0 ,y 0 ,z0 ), where t is the time of the positioning result, and x, y, z are the coordinates of the monorail crane.

[0017] Preferably, in step S4, the track joint beacons are numbered in sequence according to the track installation diagram and the number of monorail crane track joints in the entire operation route, and are N, 1 ,N 2 ,N 3 ,…,N m , where m is the total number of track joint beacons; combined with the position coordinates of the i-th track joint in the track installation diagram (x i ,y i ,z i ), mark each letter as Bea i =(N i ,x i ,y i ,z i ), define the number as N i The length of the rail between the track joint beacon and the previous track joint beacon is L i .

[0018] Preferably, in step S5, the collected signal is preprocessed and filtered to remove noise interference; and the signal is peak detected, and the process from the monorail crane starting to stopping is set as an interval. In one interval, the average value P of the peak value of the preprocessed signal is set as the threshold value. If the peak value V P If (t) exceeds the set threshold value P, the signal is recorded as an impact signal X(t).

[0019] Preferably, in step S6, the specific method for setting the threshold of the judgment model is as follows:

[0020] The monorail crane's running route is obtained based on the attitude, speed and position information of the monorail crane obtained by strapdown inertial navigation. The mileage of the monorail crane is collected by an encoder, recorded as S(t), and the impact signal X(t) extracted in step S5 is matched with the mileage S(t) using a timestamp, recorded as the impact signal I k =(X(t),S k (t)), where k is the sequence number of the impact signal sorted by time;

[0021] The track installation diagram is used to obtain the track joint beacons Bea in the running route. i And the length of each track is L i , and number each joint beacon in the path according to the running route, and number them n in the running order 1 ,n 2 ,n 3 ,…,n j,…, let the track joint beacon in the running route be R j _Bea i =(n j ,N i ,x i ,y i ,z i ) ; record the monorail crane departure position and joint beacon n 1 The driving distance between 1 , remember the connector beacon n k With connector beacon k+1 The length of the track between k+1 ;

[0022] The monorail crane route is divided into two sections with lengths of Y using the joint beacons. 1 ,Y 2 ,…,Y j Sub-intervals, set the thresholds of each interval in the judgment model to BD k =(0.9~1.1)·Y k .

[0023] Preferably, in step S6, the specific steps of judging and screening the impact signal in the judgment model are as follows:

[0024] First, the threshold value of the monorail crane in the first sub-interval is set to BD 1 =(0.9~1.1)·Y 1 , determine the impact signal I 1 Mileage R_S in the first sub-interval 1 (t) = S 1 (t)-0 whether it meets the set threshold condition. If it meets 0.9·Y 1 ≤R_S 1 (t)≤1.1·Y 1 , then the impulse signal I 1 It is the impact signal at the first track joint in the driving route, numbered n 1 ';

[0025] If the threshold condition is not met, the same method is used to verify I 2 ,I 3 ,...,I k , until the condition is met, and the impact signal I that meets the condition is p Note as I 1 '=(I p ,n 1 ',t);

[0026] Known I r '=(I q ,n r',t), then the threshold value of the r+1th subinterval is set to BD r+1 =(0.9~1.1)·Y r+1 , determine the impact signal I q+1 Mileage R_S in the r+1th subinterval q+1 (t) = S q+1 (t)-S q (t) Whether the threshold condition is met, if it is 0.9·Y r+1 ≤R_S q+1 (t)≤1.1·Y r+1 , then the impulse signal I q+1 is the impact signal at the r+1th track joint in the driving route, numbered n r+1 ';

[0027] If the threshold condition is not met, the same method is used to verify I q+2 ,I q+3 ,…,I k , until the condition is met, and the impact signal I that meets the condition is q Note as I r+1 '=(I q+1 ,n r+1 ',t).

[0028] Preferably, in step S7, each track joint beacon R in the running route is numbered. j _Bea i =(n j ,N i ,x i ,y i ,z i ) and the impact signal I at the rail joint obtained by matching model screening r+1 '=(I q+1 ,n r+1 ',t) to match, if r+1=j, then let I r+1 'With R j _Bea i Matching, get the time-coordinate sequence F where the monorail crane runs to the track joint ti _Bea i =(t,x i ,y i ,z i ).

[0029] Preferably, in step S8, the primary positioning result FPR of the monorail crane is calculated by time. t =(t,x 0 ,y 0 ,z 0 ) and the time-coordinate sequence F of the monorail crane running to the track jointti _Bea i =(t,x i ,y i ,z i ) to match, if ti = t, then use F ti _Bea i The positioning information in FPR t The position information is corrected to achieve phased calibration and resetting of the monorail crane positioning information.

[0030] The beneficial effects of the present invention are:

[0031] The present invention uses rail joints as natural beacons for positioning. Compared with other types of beacons and currently used methods such as tags, natural beacons are low-cost and do not require manual installation to reduce errors;

[0032] The present invention uses the identification of the track joint beacon for positioning, and the track joint beacon is not easily deformed, so the positioning result obtained is more accurate;

[0033] The IMU used in the present invention has a low cost and generates a large error. However, the present invention processes the positioning result by using an extended Kalman filter algorithm and uses a combined positioning method of a track joint beacon and an inertial navigation system to achieve precise positioning, thereby reducing the positioning error. Therefore, even if the present invention uses a low-cost device with a large error, it can achieve high-precision positioning.

[0034] The present invention proposes a monorail crane positioning method combining a track joint beacon and an inertial navigation system, which combines an odometer and an extended Kalman filter algorithm, incorporates the identification and positioning of the track joint beacon, effectively reduces the cumulative error caused by the strapdown inertial navigation system, improves the positioning accuracy, and saves the positioning cost. BRIEF DESCRIPTION OF THE DRAWINGS

[0035] In order to more clearly illustrate the embodiments of the present invention or the technical solutions in the prior art, the drawings required for use in the embodiments or the description of the prior art will be briefly introduced below. Obviously, the drawings described below are only some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying creative work.

[0036] Figure 1 A schematic diagram of the structure of a monorail crane positioning method combining a track joint beacon and an inertial navigation system provided in an embodiment of the present invention;

[0037] Figure 2 The flow chart of the first track joint judgment model;

[0038] Figure 3This is the flow chart of the model for judging the r+1th (r≥1) rail joint;

[0039] Figure 4 Schematic diagram of position calibration based on beacon recognition. DETAILED DESCRIPTION

[0040] The following will be combined with the drawings in the embodiments of the present invention to clearly and completely describe the technical solutions in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.

[0041] like Figure 1 As shown, a monorail crane positioning method combining a track joint beacon and an inertial navigation system comprises the following steps:

[0042] Step 1: Based on the data obtained by the encoder installed on the driving wheel of the monorail crane, the odometer kinematic model of the monorail crane is established, and the forward speed, heading angle and heading angular velocity information of the monorail crane are calculated by the kinematic model.

[0043] Step 2: Perform strapdown inertial navigation solution based on the data obtained by the strapdown inertial navigation system installed on the monorail crane to obtain the attitude, speed and position information of the monorail crane.

[0044] Step 3: Use the extended Kalman filter algorithm to fuse the heading data calculated based on the odometer kinematic model and the heading angle calculated by the strapdown inertial navigation to obtain the combined positioning result of the inertial navigation and odometer.

[0045] Step 4: Set up beacons at the track joints of the monorail crane, determine the number of each beacon and the specific location information of each beacon according to the track installation diagram of the monorail crane, and use the location information determined by the beacon to divide the monorail crane's transportation route into several driving sections.

[0046] Among them, Figure 4 As shown in the figure, according to the track installation diagram and the number of monorail crane track joints in the entire operation route, the track joint beacons are numbered in sequence, namely N 1 ,N 2 ,N 3 ,…,N m , where m is the total number of track joint beacons; combined with the position coordinates of the i-th track joint in the track installation diagram (x i ,y i ,z i ), mark each letter as Bea i =(N i ,x i ,y i ,zi ), define the number as N i The length of the rail between the track joint beacon and the previous track joint beacon is L i ; Number each joint beacon in the path according to the running route, and number them n in the running order 1 ,n 2 ,n 3 ,…,n j ,…, let the track joint beacon in the running route be R j _Bea i =(n j ,N i ,x i ,y i ,z i ) ; record the monorail crane departure position and joint beacon n 1 The driving distance between 1 , remember the connector beacon n k With connector beacon k+1 The length of the track between k+1 .

[0047] Step 5: Install a vibration sensor at the driving wheel of the monorail crane, use the vibration sensor to collect vibration signals during the travel of the monorail crane, and perform signal processing on the collected vibration signals to identify vibration impact signals during the travel process.

[0048] Step 6: Based on the information collected by the strapdown inertial navigation system and the encoder, combined with the track installation diagram, a track joint judgment model is constructed, and a suitable threshold is set according to the length of the track. The extracted pulse signal is judged, and the impact signal that meets the requirements is screened out, that is, the impact signal at the track joint beacon, and the impact signal at the identified track joint beacon is numbered.

[0049] Among them, Figure 2 As shown, the specific steps for judging and screening the first rail joint impact signal are as follows:

[0050] First, the threshold value of the monorail crane in the first sub-interval is set to BD 1 =(0.9~1.1)·Y 1 , determine the impact signal I 1 Mileage R_S in the first sub-interval 1 (t) = S 1 (t)-0 whether it meets the set threshold condition. If it meets 0.9·Y 1 ≤R_S 1 (t)≤1.1·Y 1 , then the impulse signal I 1 It is the impact signal at the first track joint in the driving route, numbered n1 ';

[0051] If the threshold condition is not met, the same method is used to verify I 2 ,I 3 ,…,I k , until the condition is met, and the impact signal I that meets the condition is p Note as I 1 '=(I p ,n 1 ',t).

[0052] like Figure 3 As shown, the specific steps for judging and screening the impact signal of the r+1th rail joint are as follows:

[0053] Known I r '=(I q ,n r ',t), then the threshold value of the r+1th subinterval is set to BD r+1 =(0.9~1.1)·Y r+1 , determine the impact signal I q+1 Mileage R_S in the r+1th subinterval q+1 (t) = S q+1 (t)-S q (t) Whether the threshold condition is met, if it is 0.9·Y r+1 ≤R_S q+1 (t)≤1.1·Y r+1 , then the impulse signal I q+1 is the impact signal at the r+1th track joint in the driving route, numbered n r+1 ';

[0054] If the threshold condition is not met, the same method is used to verify I q+2 ,I q+3 ,…,I k , until the condition is met, and the impact signal I that meets the condition is q Note as I r+1 '=(I q+1 ,n r+1 ',t).

[0055] Step 7: Using the number of the identified track joint beacon, combined with the number of each beacon in the track installation diagram and the specific position of each beacon, the number is matched to obtain the time and position coordinate sequence of the monorail crane running to the track joint.

[0056] Step 8: Establish a combined positioning model of track joint beacons and strapdown inertial navigation, and use the absolute positioning information obtained by combining the recognition and judgment of the track joint beacons with the track installation diagram to achieve phased calibration and reset of the monorail crane positioning information, thereby realizing the combination of local relative positioning and global absolute positioning of the monorail crane.

[0057] Obviously, those skilled in the art can make various changes and modifications to the present invention without departing from the spirit and scope of the present invention. Thus, if these modifications and variations of the present invention fall within the scope of the claims of the present invention and their equivalents, the present invention is also intended to include these modifications and variations.

Claims

1. A monorail crane positioning method combining a track joint beacon and an inertial navigation system, characterized in that: The following steps are involved: S1: Install an encoder on the driving wheel of the monorail crane, establish an odometer kinematic model of the monorail crane based on the encoder data, and calculate the forward speed, heading angle and heading angular velocity information of the monorail crane by solving the odometer kinematic model; S2: Perform strapdown inertial navigation calculation based on data acquired by the strapdown inertial navigation system installed on the monorail crane to obtain the attitude, speed and position information of the monorail crane; S3: Using the extended Kalman filter algorithm to fuse the heading data calculated based on the odometer kinematic model and the heading angle calculated by the strapdown inertial navigation, the combined positioning result of the inertial navigation and the odometer is obtained; S4: beacons are set at the track joints of the monorail crane, the numbers of the beacons and the specific location information of the beacons are determined according to the track installation diagram of the monorail crane, and the transportation route of the monorail crane is divided into several driving sections using the location information determined by the beacons; S5: installing a vibration sensor at the driving wheel of the monorail crane, using the vibration sensor to collect vibration signals during the driving process of the monorail crane, and performing signal processing on the collected vibration signals to identify vibration impact signals during the driving process; S6: Based on the information collected by the strapdown inertial navigation system and the encoder, combined with the track installation diagram, a track joint judgment model is constructed, a suitable threshold is set according to the length of the track, the extracted pulse signal is judged, and the impact signal that meets the requirements is screened out, that is, the impact signal at the track joint beacon, and the impact signal at the identified track joint beacon is numbered; S7: using the number of the identified track joint beacon, combined with the number of each beacon in the track installation diagram and the specific position of each beacon, the number is matched to obtain the time and position coordinate sequence of the monorail crane running to the track joint; S8: Establish a combined positioning model of track joint beacons and strapdown inertial navigation, and use the absolute positioning information obtained by combining the recognition and judgment of the track joint beacons with the track installation diagram to achieve phased calibration and reset of the monorail crane positioning information, thereby realizing the combination of local relative positioning and global absolute positioning of the monorail crane.

2. A monorail crane positioning method combining a track joint beacon and an inertial navigation system as claimed in claim 1, characterized in that: In step S3, the extended Kalman filter algorithm is used to obtain the primary positioning result FPR of the monorail crane t =(t,x0,y0,z0), where t is the time of the positioning result, and x, y, z are the coordinates of the monorail crane.

3. A monorail crane positioning method combining a track joint beacon and an inertial navigation system as claimed in claim 2, characterized in that: In step S4, according to the track installation diagram and the number of monorail track joints in the entire operation route, the track joint beacons are numbered in sequence, namely N1, N2, N3, ..., N m , where m is the total number of track joint beacons; combined with the position coordinates of the i-th track joint in the track installation diagram (x i ,y i ,z i ), mark each letter as Bea i =(N i ,x i ,y i ,z i ), define the number as N i The length of the rail between the track joint beacon and the previous track joint beacon is L i .

4. A monorail crane positioning method combining a track joint beacon and an inertial navigation system as claimed in claim 3, characterized in that: In step S5, the collected signal is preprocessed and filtered to remove noise interference; and the signal is peak detected, and the process from the start to the stop of the monorail crane is set as an interval. In one interval, the average value P of the peak value of the preprocessed signal is set as the threshold value. If the peak value V P If (t) exceeds the set threshold P, the signal is recorded as an impulse signal X(t).

5. A monorail crane positioning method combining a track joint beacon and an inertial navigation system as claimed in claim 4, characterized in that: In step S6, the specific method for setting the threshold of the judgment model is as follows: The monorail crane's running route is obtained based on the attitude, speed and position information of the monorail crane obtained by strapdown inertial navigation. The mileage of the monorail crane is collected by an encoder, recorded as S(t), and the impact signal X(t) extracted in step S5 is matched with the mileage S(t) using a timestamp, recorded as the impact signal I k =(X(t),S k (t)), where k is the sequence number of the impact signal sorted by time; The track installation diagram is used to obtain the track joint beacons Bea in the running route. i And the length of each track is L i , and number each joint beacon in the path according to the running route, and number them n1, n2, n3, ..., n in the running order. j ,..., the beacon of each track joint in the running route is R j _Bea i =(n j ,N i ,x i ,y i ,z i ); the travel distance between the monorail crane departure position and the joint beacon n1 is Y1, and the joint beacon n k With connector beacon k+1 The length of the track between k+1 ; The monorail crane route is divided into sections with lengths of Y1, Y2, ..., Y j Sub-intervals, set the thresholds of each interval in the judgment model to BD k =(0.9~1.1)·Y k .

6. A monorail crane positioning method combining a track joint beacon and an inertial navigation system as claimed in claim 5, characterized in that: In step S6, the specific steps of judging and screening the impact signal in the judgment model are as follows: First, the threshold value set for the monorail crane in the first sub-interval is BD1=(0.9-1.1)·Y1, and it is determined whether the mileage of the impact signal I1 in the first sub-interval R_S1(t)=S1(t)-0 meets the set threshold condition. If 0.9·Y1≤R_S1(t)≤1.1·Y1 is satisfied, the impact signal I1 is the impact signal at the first track joint in the driving route, numbered as n1'; If the threshold condition is not met, the same method is used to verify I2, I3, ..., I k , until the condition is met, and the impact signal I that meets the condition is p Denoted as I1'=(I p ,n1',t); Known I r '=(I q ,n r ',t), then the threshold value of the r+1th subinterval is set to BD r+1 =(0.9~1.1)·Y r+1 , determine the impact signal I q+1 Mileage R_S in the r+1th subinterval q+1 (t) = S q+1 (t)-S q (t) Whether the threshold condition is met, if it is 0.9·Y r+1 ≤R_S q+1 (t)≤1.1·Y r+1 , then the impulse signal I q+1 is the impact signal at the r+1th track joint in the driving route, numbered n r+1 '; If the threshold condition is not met, the same method is used to verify I q+2 ,I q+3 ,…,I k , until the condition is met, and the impact signal I that meets the condition is q Note as I r+1 '=(I q+1 ,n r+1 ',t).

7. A monorail crane positioning method combining a track joint beacon and an inertial navigation system as claimed in claim 6, characterized in that: In step S7, the track joint beacons R in the running route are numbered. j _Bea i =(n j ,N i ,x i ,y i ,z i ) and the impact signal I at the rail joint obtained by matching model screening r+1 '=(I q+1 ,n r+1 ',t) to match, if r+1=j, then let I r+1 'With R j _Bea i Matching, get the time-coordinate sequence F where the monorail crane runs to the track joint ti _Bea i =(t,x i ,y i ,z i ).

8. A monorail crane positioning method combining a track joint beacon and an inertial navigation system as claimed in claim 7, characterized in that: In step S8, the primary positioning result FPR of the monorail crane is calculated by time. t = (t, x0, y0, z0) and the time-coordinate sequence F of the monorail crane running to the track joint ti _Bea i =(t,x i ,y i ,z i ) to match, if ti = t, then use F ti _Bea i The positioning information in FPR t The position information is corrected to achieve phased calibration and resetting of the monorail crane positioning information.

Citation Information

Cited By

  • Method for positioning accurate position of monorail crane in underground environment

    CN121410643A

  • Monorail hoist positioning method combining rail joint beacons and inertial navigation

    WO2026016836A1