Low-speed track detection system and method
By using the deep fusion and model combination of inertial navigation system and multi-sensors in the low-speed inertial rail detection system, the problem of detection accuracy being affected by environmental and velocity changes is solved, and higher track detection accuracy and reliability are achieved.
Patent Information
- Application Number
- CN202010792410.X
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2020-08-09
- Publication Date
- 2024-11-19
- Estimated Expiration
- 2040-08-09
AI Technical Summary
Under complex track detection conditions, the detection accuracy of the existing low-speed inertial rail detection system is greatly affected by changes in ambient temperature, detection speed and track parameters, making it difficult to effectively overcome gyroscope error, accelerometer error and initial alignment error. The lack of track constraints and ambient temperature compensation limits the improvement of detection accuracy.
The deep fusion of inertial navigation system, odometer, gauge, satellite navigation receiver and total station is adopted, combined with gravity anomaly model, orbital constraint model and vehicle body dynamics model, through dual position alignment and optimal estimation methods, Perform error compensation and accuracy improvement.
It significantly improves the accuracy and reliability of track detection, effectively reduces the initial alignment error, enhances the detection accuracy when ambient temperature and speed changes, and improves the measurement accuracy and reliability.
Smart Images

Figure CN111778791B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of railway track detection, and in particular to a low-speed track detection system and a low-speed track detection method. Background Art
[0002] Since the beginning of this century, the country has stepped up the construction of rail transit facilities. The mileage of various tracks such as high-speed rail, EMU, conventional rail and subway has developed rapidly, and the heavy task of train transportation has reached an unprecedented level. Tracks are the basis for train operation. The quality of track geometric parameters (gauge, level, track direction, height, lateral deviation and vertical deviation, etc.) is closely related to the safety of train operation.
[0003] With the continuous increase in the running speed, traffic density and load of rail transit trains, the track performance is under great test, and the difficulty of track maintenance is also increasing. The track (geometric parameter) detection system has been highly valued as an important means to ensure track safety. The construction and maintenance of various types of tracks require comprehensive detection of track geometric parameters. At present, the mileage of various rail transits at home and abroad is increasing rapidly, and the demand for track detection systems is also increasing rapidly.
[0004] At present, track detection systems can be divided into two categories in terms of detection carrier and speed:
[0005] (1) Low-speed track inspection system: The main carrier is a non-powered inspection vehicle, usually a T-shaped structure. During the inspection operation, it needs to be pushed by humans or other powered vehicles. The maximum inspection speed is usually less than 60 km / h;
[0006] (2) High-speed track inspection system: The main carriers are various powered operating vehicles (high-speed rail, EMU, conventional rail, intercity train, subway, etc.) and work vehicles (tamping vehicles, grinding vehicles, inspection vehicles, etc.). Track inspection is carried out while the train is running. The maximum inspection speed is usually greater than 60 km / h.
[0007] Currently, there are mainly three types of low-speed track detection systems: low-speed optical track detection system, low-speed gyroscopic track detection system and low-speed inertial navigation track detection system.
[0008] The low-speed inertial navigation track detection system is a new generation of track detection system that has emerged in recent years. The system adopts an inertial navigation system detection solution, and uses the inertial navigation system and odometer, total station, satellite navigation receiver (satellite navigation receiver) and other multi-sensor simple fusion, which can continuously measure the three-dimensional coordinates of the left and right tracks, and can perform relative and absolute measurements. It can also effectively deduct the track detection errors caused by the rotation of the earth and gravity, and significantly improve the track measurement accuracy and reliability. However, the existing low-speed inertial navigation track detection system still has the following problems:
[0009] (1) The actual track inspection operating conditions (ambient temperature, inspection speed, track parameters) are very complex: the ambient temperature range is above 80°C. When the ambient temperature changes, the zero bias, installation error and scale factor of the gyroscope and accelerometer of the inertial navigation system will change, resulting in a decrease in track inspection accuracy; the inspection speed range is more than 20 times, and the main track parameters (horizontal, track direction, height) vary by more than 200 mm. When the inspection speed and track parameters change, the motion and vibration characteristics of the track inspection vehicle will change, resulting in changes in the zero bias and scale factor of the gyroscope and accelerometer of the inertial navigation system, resulting in a decrease in track inspection accuracy.
[0010] (2) The existing low-speed inertial navigation track detection system adopts a simple fusion data processing method of multiple sensors including inertial navigation system, total station, odometer and satellite navigation receiver. It is difficult to effectively overcome the negative effects of gyro error (zero bias, installation error, scale factor error, etc.), accelerometer error (zero bias, installation error, scale factor error, etc.) and initial alignment error of inertial navigation system on track detection accuracy.
[0011] (3) The existing low-speed inertial navigation track detection system is applied to the low-speed track detection system. This detection system does not combine track constraints, vehicle dynamics and gravity anomaly model solution and error compensation for the special circumstances in the track detection field, which limits the further improvement of track detection accuracy.
[0012] (4) The existing low-speed inertial navigation track detection system does not address the ambient temperature and dynamic characteristics requirements in the track detection field, and adopts a special temperature compensation and system calibration method, which limits the further improvement of track detection accuracy.
[0013] Therefore, there is an urgent need to develop a system that can improve track detection accuracy. Summary of the invention
[0014] In view of the multiple problems existing in the prior art, the present invention provides a low-speed track detection system and a low-speed track detection method which can improve the detection accuracy.
[0015] According to a first aspect of the present invention, there is provided a low-speed track detection system, comprising: an inertial navigation system, an odometer, a track gauge and a track detection vehicle; wherein:
[0016] The track inspection vehicle body includes a T-shaped beam and a plurality of running wheels; a cavity is provided in the T-shaped beam, including three ends, and a running wheel is provided on the side of each end;
[0017] The inertial navigation system is arranged above the T-shaped beam, the gauge meter is arranged inside the T-shaped beam, and the odometer is installed on the running wheel;
[0018] The inertial navigation system is connected to the odometer and the gauge meter via an electrical interface, and is used at least to measure the attitude, speed and position data of the track inspection vehicle, and calculate the geometric state of the track in combination with the data of the odometer and the gauge meter.
[0019] According to an example embodiment of the present invention, the low-speed track detection system also includes a satellite navigation receiver, which is connected to the inertial navigation system through an electrical interface and is arranged on a detection vehicle loaded with the low-speed track detection system. The inertial navigation system also calculates the geometric state of the track in combination with data from the satellite navigation receiver.
[0020] According to an example embodiment of the present invention, the low-speed track detection system also includes a total station, which is connected to the inertial navigation system via an electrical interface and is arranged on a detection vehicle loaded with the low-speed track detection system. The inertial navigation system also calculates the geometric state of the track in combination with data from the total station.
[0021] Deeply integrate the inertial navigation system solution data with the total station or satellite navigation receiver data to improve track detection accuracy.
[0022] According to an exemplary embodiment of the present invention, the low-speed track detection system further includes a display control device, which is connected to the inertial navigation system via an electrical interface and is used at least for displaying and controlling the system.
[0023] According to an exemplary embodiment of the present invention, the satellite navigation receiver and the total station are arranged above the T-shaped beam.
[0024] According to an exemplary embodiment of the present invention, the low-speed track detection system further includes a push rod disposed above the T-beam.
[0025] According to an exemplary embodiment of the present invention, the low-speed track detection system further includes a power circuit and a battery. The power circuit is used to convert external power into various power sources required within the system, and the battery is used to power various parts of the system.
[0026] According to an example embodiment of the present invention, the battery includes a lithium battery, a lead-acid battery, or a nickel-hydrogen battery.
[0027] According to an exemplary embodiment of the present invention, an inertial navigation system includes a gyroscope, an accelerometer, an inertial device circuit, a navigation computer and a universal interface circuit; wherein,
[0028] The gyroscope is used to measure angular velocity data;
[0029] The accelerometer is used to measure acceleration data;
[0030] The inertial device circuit is used to collect gyro and accelerometer measurement data;
[0031] The navigation computer is used at least to complete the inertial navigation solution, the odometer data solution, the gauge data solution, and the various measurement models and error compensation model solutions;
[0032] The universal interface circuit is used to connect at least the odometer and the gauge meter.
[0033] According to an exemplary embodiment of the present invention, the navigation computer is also used to complete the calculation of satellite navigation receiver data and the calculation of total station data; the universal interface circuit is also used to connect the satellite navigation receiver and the total station.
[0034] According to an exemplary embodiment of the present invention, the universal interface circuit is further used to connect to a display control device.
[0035] According to an exemplary embodiment of the present invention, the inertial navigation system further includes a temperature sensor, the temperature sensor is used to measure temperature data, the universal interface circuit is further used to connect to the temperature sensor, and the navigation computer is further used to complete the calculation of temperature data.
[0036] According to an example embodiment of the present invention, the navigation computer includes a system error correction module, a navigation solution module, an optimal estimation module, a track detection solution module and a result output module;
[0037] The navigation solution module is used to complete attitude solution, velocity solution and position solution based on the gyroscope and accelerometer measurement data;
[0038] The system error correction module is used to correct the system error and gravity anomaly error;
[0039] The optimal estimation module is at least used to optimally estimate the system error of the inertial navigation data, the odometer data, and the gauge data;
[0040] The track detection solution module is used for track detection model solution and error compensation.
[0041] According to an example embodiment of the present invention, the navigation computer further comprises one or more of a gravity anomaly solving module, a track constraint solving module, and a vehicle dynamics solving module;
[0042] The gravity anomaly solution module is used to calculate gravity anomaly data and compensate for the error between the actual gravity and the gravity model used in the inertial navigation solution process;
[0043] The track constraint solving module is used to solve the motion constraint model and error compensation of the detection vehicle equipped with the low-speed track detection system on the track;
[0044] The vehicle dynamics solution module is used for vehicle dynamics motion model solution and error compensation.
[0045] According to an exemplary embodiment of the present invention, the system error correction module is further used to correct gravity anomaly errors.
[0046] According to an exemplary embodiment of the present invention, the optimal estimation module is further used to optimally estimate the system error using the data of the track constraint solving module and the data of the vehicle dynamics solving module.
[0047] According to an exemplary embodiment of the present invention, the vehicle dynamics solution module uses odometer data, gauge data and a motion model to perform motion parameter solution and error compensation.
[0048] According to an example embodiment of the present invention, the navigation computer further comprises an error compensation module and a fault detection module;
[0049] The error compensation module is at least used to perform error compensation on the gyro data, the accelerometer data, the odometer data and the gauge meter data;
[0050] The fault detection module is used to perform fault detection on the data output by various error compensation modules;
[0051] The result output module is used to output at least orbit detection data, inertial navigation data and orbit geometry state data.
[0052] According to an exemplary embodiment of the present invention, the optimal estimation module is further used to optimally estimate the system error of the satellite navigation receiver data and the total station data, and the error compensation module is further used to perform error compensation on the satellite navigation receiver data and the total station data.
[0053] According to an exemplary embodiment of the present invention, the optimal estimation module is further used to optimally estimate the system error of the temperature data, and the error compensation module is further used to perform error compensation on the temperature data.
[0054] The use of the optimal estimation module to deeply integrate inertial navigation data, odometer data, temperature data, satellite navigation receiver data, and total station data can improve the accuracy and reliability of track detection.
[0055] According to an example embodiment of the present invention, the navigation computer further comprises a data storage module, which is used to store various raw data and result data in real time, wherein these data mainly include sensor data, track detection data, inertial navigation data and various status data.
[0056] According to an exemplary embodiment of the present invention, the odometer is used to measure at least the mileage and speed of the inspection vehicle equipped with the low-speed track inspection system.
[0057] According to an exemplary embodiment of the present invention, the odometer includes a photoelectric encoder, a magnetoelectric encoder, a resistance encoder, or a magnetic nail plus a Hall sensor.
[0058] According to an exemplary embodiment of the present invention, there are more than two odometers, each of which is arranged on a running wheel. The existing low-speed track detection system usually uses only one odometer, while the present invention uses multiple odometers, each of which is installed on a wheel of the detection vehicle, which can significantly improve the mileage measurement accuracy and reliability.
[0059] According to an exemplary embodiment of the present invention, the track gauge is used to measure the distance between two rails of a track, and includes a left track gauge and a right track gauge.
[0060] According to an exemplary embodiment of the present invention, the track gauge uses a linear displacement sensor.
[0061] According to an exemplary embodiment of the present invention, the linear displacement sensor includes a potentiometer sensor, a magnetostrictive displacement sensor, a grating measurement linear displacement sensor, or a laser image measurement linear displacement sensor.
[0062] According to an exemplary embodiment of the present invention, the satellite navigation receiver is used to measure the position and speed of a detection vehicle equipped with a low-speed track detection system, and simultaneously provide time data based on the satellite navigation system and a synchronized second pulse signal.
[0063] According to an exemplary embodiment of the present invention, the total station is used to measure the parameters of the distance, azimuth and pitch angle of the CP3 point, which is a measurement mark point arranged at intervals of about 60 meters on both sides of the track line.
[0064] According to an exemplary embodiment of the present invention, two ends of the T-beam are on one side of one track, and the other end is on the other side of the other track.
[0065] According to an exemplary embodiment of the present invention, the running wheel is used to detect that the vehicle is running on the track.
[0066] According to an example embodiment of the present invention, the track inspection vehicle body further includes a plurality of limiting wheels, an integral pretensioning device and a gauge pretensioning device, the plurality of limiting wheels including travel limiting wheels respectively arranged at the three ends of the T-shaped beam and a gauge limiting wheel arranged between the travel limiting wheels located on the same side of the rail; the integral pretensioning device is connected to the travel limiting wheel to make the travel limiting wheel close to the inner side surface of the rail; the gauge pretensioning device is connected to the gauge limiting wheel and can move in the direction of the sleeper relative to the track inspection vehicle body to make the gauge limiting wheel close to the inner side surface of the rail.
[0067] According to a second aspect of the present invention, there is provided a low-speed track detection method, comprising the following steps:
[0068] A: The inertial navigation system is initially aligned using a dual-position alignment method;
[0069] B: Perform temperature calibration and error compensation on the zero bias, installation error and scale factor of the gyro and accelerometer according to the changing characteristics of the orbital ambient temperature;
[0070] C: Collect data from gyroscope, accelerometer, odometer, and gauge meter;
[0071] D: Perform navigation calculation on the gyro data and accelerometer data according to the data of the gravity anomaly calculation module, and make optimal estimation on the result of navigation calculation, odometer data, gauge data, data of track constraint calculation module and data of vehicle body dynamics calculation module;
[0072] E: Solve the orbit solution model and perform error compensation on the optimal estimation result of step D to obtain the orbit detection result.
[0073] Compared with the existing solution of simply fusing data from multiple sensors, the present invention adds a gravity anomaly model, a track constraint model and a vehicle dynamics model on the basis of physical sensors such as the inertial navigation system, the odometer and the gauge meter, and deeply fuses the physical sensors with these three models. It can effectively estimate and compensate for multiple errors (initial alignment error, inertial navigation system installation error, zero bias of gyroscopes and accelerometers, installation error and scale factor), thereby improving the track detection accuracy and reliability.
[0074] According to an exemplary embodiment of the present invention, in step A, the method of initially aligning the inertial navigation system using a dual-position alignment method includes:
[0075] A1: The inertial navigation system is fixedly installed on the vehicle body of the low-speed track detection system;
[0076] A2: Place the vehicle on the ground or track and keep it stationary for a predetermined period of time;
[0077] A3: Rotate the vehicle body 90 to 270 degrees with the vertical direction as the axis, place the vehicle body on the ground or track, and keep it stationary for a predetermined time;
[0078] A4: Use inertial navigation system data and optimal estimation method to complete initial alignment and horizontal gyro bias and horizontal accelerometer bias estimation, wherein the optimal estimation method includes using Kalman filtering, extended Kalman filtering, unscented Kalman filtering or least squares method for optimal estimation.
[0079] According to an exemplary embodiment of the present invention, the predetermined time is 10 to 1000 seconds.
[0080] According to an exemplary embodiment of the present invention, in step A3, the vehicle body is rotated in a clockwise or counterclockwise manner when viewed from top to bottom, with the vertical direction as the axis.
[0081] According to an exemplary embodiment of the present invention, in step A2, the vehicle body is placed in the opposite direction of the track to be measured, and in step A3, the vehicle body is rotated 180 degrees to be placed in the direction of the track to be measured.
[0082] According to an exemplary embodiment of the present invention, step B further comprises performing high-precision calibration and error compensation on the zero bias, installation error, and scale factor of the gyroscope and accelerometer according to the detection velocity and orbit parameter variation characteristics.
[0083] According to an exemplary embodiment of the present invention, the odometer data collected in step C is data from more than two odometers, and in step D, the more than two odometer data are deeply integrated with the result data of the navigation solution.
[0084] According to an exemplary embodiment of the present invention, in step D, navigation solution is performed using a cone error compensation, a paddling error compensation or a vortex error compensation method.
[0085] According to an exemplary embodiment of the present invention, in step D, Kalman filtering, extended Kalman filtering, unscented Kalman filtering or least squares method is used to perform optimal estimation.
[0086] According to an exemplary embodiment of the present invention, in step D, the optimal estimation adopts a single-stage or multi-stage optimal estimation structure.
[0087] According to an exemplary embodiment of the present invention, in step C, data of a satellite navigation receiver is also collected, and in step D, the satellite navigation receiver data is optimally estimated.
[0088] According to an exemplary embodiment of the present invention, in step C, data of a total station is also collected, and in step D, the total station data is optimally estimated.
[0089] According to an exemplary embodiment of the present invention, in step C, data from a temperature sensor is also collected, and in step D, the temperature data is optimally estimated.
[0090] The beneficial effects of the present invention are:
[0091] The present invention makes improvements from various perspectives that may lead to reduced detection accuracy, and provides a low-speed track detection system and a low-speed track detection method, which can improve the accuracy and reliability of track detection, and is specifically described in the following points:
[0092] (1) The present invention adopts a solution of deep fusion of multiple sensors, deeply integrates the inertial navigation system with the total station, odometer, gauge meter, and satellite navigation receiver, and uses the optimal estimation method to effectively estimate and compensate for the attitude error of the inertial navigation system and the error of inertial devices (gyroscope and accelerometer), thereby improving the accuracy and reliability of track detection.
[0093] (2) In the process of deep fusion, the present invention uses the gravity anomaly model, track constraint model and vehicle dynamics model as virtual sensors and deeply integrates them with the data of physical sensors such as inertial navigation system, total station, odometer, gauge meter and satellite navigation receiver, which can further improve the accuracy and reliability of track detection.
[0094] (3) The present invention adopts a dual-position alignment method, which can significantly reduce the initial alignment error of the inertial navigation system, effectively estimate the horizontal gyro bias and horizontal accelerometer bias, and further improve the measurement accuracy and reliability of orbital horizontal parameters.
[0095] (4) The present invention performs high-precision temperature compensation on the zero bias, installation error, and scale factor of the gyroscope and accelerometer, thereby improving the track detection accuracy and reliability when the ambient temperature changes.
[0096] (5) The present invention performs high-precision calibration on the symmetry and nonlinearity of the scale factors of the gyroscope and accelerometer, which significantly improves the detection accuracy and reliability when detecting changes in speed and orbital parameters.
[0097] (6) The present invention deeply integrates multiple odometers and inertial navigation systems, significantly improving measurement accuracy and reliability. BRIEF DESCRIPTION OF THE DRAWINGS
[0098] Figure 1 It is a connection diagram of the detection components of the low-speed track detection system.
[0099] Figure 2 This is a module connection diagram of the navigation computer.
[0100] Figure 3 It is a three-dimensional diagram of the track inspection vehicle body.
[0101] Figure 4 This is the front view of the track inspection vehicle body.
[0102] Figure 5 It is a schematic diagram of the track inspection vehicle body being placed in the opposite direction of the track to be measured.
[0103] Figure 6 It is a schematic diagram of the forward placement of the track inspection vehicle along the direction of the track that needs to be measured.
[0104] Among them, 1 is an inertial navigation system, 2 is an odometer, 3 is a track gauge, 4 is a satellite navigation receiver, 5 is a total station, 6 is a T-beam, 7 is a push rod, 8 is a walking wheel, and 9 is a limit wheel. DETAILED DESCRIPTION
[0105] Example embodiments will now be described more fully with reference to the accompanying drawings. However, example embodiments can be implemented in a variety of forms and should not be construed as limited to the examples set forth herein; rather, these embodiments are provided so that the description of the present invention will be more comprehensive and complete and to fully convey the concepts of the example embodiments to those skilled in the art. The accompanying drawings are merely schematic illustrations of the present invention and are not necessarily drawn to scale.
[0106] In addition, the described features, structures or characteristics may be combined in one or more embodiments in any suitable manner. In the following description, many specific details are provided to provide a full understanding of the embodiments of the present invention. However, those skilled in the art will appreciate that the technical solution of the present invention may be practiced while omitting one or more of the specific details, or other methods, components, steps, etc. may be adopted. In other cases, known structures, methods, implementations or operations are not shown or described in detail to avoid obscuring various aspects of the present invention.
[0107] According to a first embodiment of the present invention, the present invention provides a low-speed track detection system, such as Figure 1-3 As shown, it includes: an inertial navigation system 1, an odometer 2, a gauge meter 3, a satellite navigation receiver 4, a total station 5, a display and control computer and a track inspection vehicle body. The inertial navigation system 1 is connected with the odometer 2, the gauge meter 3, the satellite navigation receiver 4, the total station 5 and the display and control computer through an electrical interface.
[0108] The inertial navigation system 1 is used to measure at least the attitude, speed and position data of the track inspection vehicle, and calculate the geometric state of the track in combination with the data of the odometer 2, the gauge meter 3, the satellite navigation receiver 4 and the total station 5.
[0109] The inertial navigation system 1 includes a gyroscope, an accelerometer, an inertial device circuit, a navigation computer, a temperature sensor and a universal interface circuit; wherein,
[0110] The gyroscope is used to measure angular velocity data;
[0111] The accelerometer is used to measure acceleration data;
[0112] The inertial device circuit is used to collect gyro and accelerometer measurement data;
[0113] The navigation computer is used at least to complete inertial navigation solution, temperature data solution, odometer data solution, gauge data solution, satellite navigation receiver data solution, total station data solution, and various measurement models and error compensation model solutions;
[0114] The temperature sensor is used to measure temperature data;
[0115] The universal interface circuit is at least used for connecting the odometer 2, the track gauge 3, the satellite navigation receiver 4, the total station 5, the temperature sensor and the display and control computer.
[0116] like Figure 2 As shown, the navigation computer includes a gravity anomaly solving module, a track constraint solving module, a vehicle dynamics solving module, a system error correction module, a navigation solving module, an optimal estimation module, a track detection solving module, an error compensation module, a fault detection module, a data storage module and a result output module.
[0117] The gravity anomaly solution module is used to calculate gravity anomaly data and compensate for the error between the actual gravity and the gravity model used in the inertial navigation solution process.
[0118] The track constraint solving module is used for solving the motion constraint model and error compensation of the inspection vehicle equipped with the low-speed track inspection system on the track.
[0119] The vehicle body dynamics solution module is used for vehicle body dynamics motion model solution and error compensation, and the wheel dynamics solution module uses odometer data, gauge meter data and motion model to solve motion parameters and compensate errors.
[0120] The navigation solution module is used to complete attitude solution, velocity solution and position solution.
[0121] The system error correction module is used to correct system errors and gravity anomaly errors.
[0122] The optimal estimation module is used to optimally estimate the system error based on the inertial navigation data (i.e., the data after the gyroscope data and acceleration data are solved by the navigation solution module), odometer data, temperature data, gauge meter data, satellite navigation receiver data, total station data, data from the track constraint solution module, and data from the vehicle dynamics solution module; the optimal estimation module is used to deeply integrate the inertial navigation data, odometer data, temperature data, gauge meter data, satellite navigation receiver data, and total station data to improve the accuracy and reliability of track detection.
[0123] The track detection solution module is used for track detection model solution and error compensation.
[0124] The error compensation module is used to perform error compensation on gyro data, accelerometer data, odometer data, gauge meter data, total station data, satellite navigation receiver data and temperature data.
[0125] The fault detection module is used to perform fault detection on the data output by various error compensation modules.
[0126] The data storage module is used to store various raw data and result data in real time, and these data mainly include sensor data, track detection data, inertial navigation data and various status data.
[0127] The result output module is at least used to output track detection data, inertial navigation data and track geometric state data to the display and control computer.
[0128] The odometer 2 is used to measure the mileage and speed of the detection vehicle equipped with the low-speed track detection system and is installed on the wheel of the detection vehicle. The odometer includes a photoelectric encoder, a magnetoelectric encoder, a resistance encoder, or a magnetic nail plus a Hall sensor. The existing low-speed track detection system usually uses only one odometer. This embodiment uses two or three odometers, each odometer 2 is installed on a wheel of the detection vehicle, which can significantly improve the mileage measurement accuracy and reliability.
[0129] The gauge meter 3 is arranged in the cavity of the T-beam 6 of the track inspection vehicle body, and is used to measure the distance between the two rails of the track, including the left gauge meter and the right gauge meter. The gauge meter 3 adopts a linear displacement sensor. The linear displacement sensor includes a potentiometer sensor, a magnetostrictive displacement sensor, a grating measurement linear displacement sensor, and a laser image measurement linear displacement sensor.
[0130] The satellite navigation receiver 4 is used to measure the position and speed of the detection vehicle equipped with the low-speed track detection system, and at the same time provide time data and synchronized second pulse signals based on the satellite navigation system.
[0131] The total station 5 is used to measure the parameters of the distance, azimuth and pitch angle of the CP3 point, which is a measuring mark point arranged at intervals of about 60 meters on both sides of the track line.
[0132] The display and control computer is used at least for display and control of the system.
[0133] The low-speed track detection system also includes a power supply circuit (not shown in the figure) and a battery (not shown in the figure). The power supply circuit is used to convert the external power supply into various power supplies required by the system, and the battery is used to power various parts of the system. The battery includes a lithium battery, a lead-acid battery or a nickel-metal hydride battery.
[0134] like Figure 3 and Figure 4As shown, the track inspection vehicle body includes a T-beam 6, a push rod 7, three running wheels 8 and four limiting wheels 9. A cavity is provided in the T-beam 6, including three ends, one of which is on one side of a track and the other two ends are on the side of another track. A running wheel 8 is provided on each end for the inspection vehicle to run on the track. The limiting wheels 9 are arranged at the bottom of the T-beam 6, including running limiting wheels respectively arranged at the three ends of the T-beam 6 and a gauge limiting wheel arranged between the running limiting wheels on the same side. The push rod 7, the inertial navigation system 1 of the low-speed track inspection system, the gauge meter 3, the satellite navigation receiver 4 and the total station 5 are arranged above the T-beam 6, the odometer 2 is installed on the running wheel 8, and each odometer 2 is installed on a running wheel 8.
[0135] The track inspection vehicle body also includes an integral pretensioning device (not shown in the figure) and a gauge pretensioning device (not shown in the figure). The integral pretensioning device is connected to the travel limiting wheel to make the travel limiting wheel close to the inner side of the rail; the gauge pretensioning device is connected to the gauge limiting wheel and can move in the direction of the sleeper relative to the track inspection vehicle body to make the gauge limiting wheel close to the inner side of the rail.
[0136] Detecting railway tracks according to the low-speed track detection system includes the following steps:
[0137] A: Initial alignment of the inertial navigation system 1 using a dual position alignment method;
[0138] B: Perform temperature calibration and error compensation on the zero bias, installation error and scale factor of the gyro and accelerometer according to the characteristics of the orbital environment temperature change; perform high-precision calibration and error compensation on the zero bias, installation error and scale factor of the gyro and accelerometer according to the characteristics of the detection speed and orbital parameter changes;
[0139] C: Collect data from gyroscopes, accelerometers, temperature sensors, more than two odometers, gauge meters, satellite navigation receivers, and total stations;
[0140] D: Perform navigation calculation on the gyro data and accelerometer data according to the data from the gravity anomaly calculation module, and make optimal estimation on the navigation calculation result and the temperature data, satellite navigation receiver data, odometer data, gauge meter data, total station data, track constraint calculation module data and vehicle dynamics calculation module data;
[0141] E: Solve the orbit solution model and perform error compensation on the optimal estimation result of step D to obtain the orbit detection result.
[0142] In step A, the method of initially aligning the inertial navigation system using a dual-position alignment method includes:
[0143] A1: The inertial navigation system 1 is fixedly mounted on the track inspection vehicle body of the low-speed track inspection system;
[0144] A2: If Figure 5 As shown, place the vehicle body on the ground or track in the opposite direction of the track direction to be measured and keep it still for 10 to 1000 seconds;
[0145] A3: If Figure 6 As shown, the vehicle body is rotated 180 degrees with the vertical direction as the axis, so that the vehicle body is placed on the ground or the track along the track direction to be measured, and remains stationary for 10 to 1000 seconds; in addition to rotating the vehicle body 180 degrees, in actual operation, it can also be rotated 90 degrees or 270 degrees, and the degree range of the rotation of the vehicle body can be between 90 and 270 degrees;
[0146] A4: Use inertial navigation system data and optimal estimation method to complete initial alignment and horizontal gyro bias and horizontal accelerometer bias estimation, wherein the optimal estimation method includes using Kalman filtering, extended Kalman filtering, unscented Kalman filtering or least squares method for optimal estimation.
[0147] Inertial navigation data and optimal estimation methods are used to complete high-precision initial alignment and error estimation of inertial devices (gyroscopes and accelerometers). Compared with single-position alignment, this method can significantly improve the initial alignment accuracy and can also estimate the errors of inertial devices, thereby improving orbit detection accuracy.
[0148] In step D, navigation solution is performed using cone error compensation, paddling error compensation or vortex error compensation methods; then Kalman filtering, extended Kalman filtering, unscented Kalman filtering or least squares method is used for optimal estimation, and the optimal estimation uses a single-stage or multi-stage optimal estimation structure.
[0149] Compared with the existing solution of simply fusing data from multiple sensors, the present invention adds a gravity anomaly model, a track constraint model and a vehicle dynamics model on the basis of physical sensors such as the inertial navigation system 1, the odometer 2, the gauge meter 3, the total station 5 and the satellite navigation receiver 4, and deeply fuses the physical sensors with these three models, which can effectively estimate and compensate for multiple errors (initial alignment error, inertial navigation system installation error, zero bias of gyroscopes and accelerometers, installation error and scale factor), thereby improving the track detection accuracy and reliability.
[0150] The preferred embodiments of the present invention disclosed above are only used to help illustrate the present invention. The preferred embodiments do not describe all the details in detail, nor do they limit the invention to the specific implementation methods described. Obviously, many modifications and changes can be made according to the content of this specification. This specification selects and specifically describes these embodiments in order to better explain the principles and practical applications of the present invention, so that those skilled in the art can understand and use the present invention well. The present invention is limited only by the claims and their full scope and equivalents.
Claims
1. A low-speed track detection method, characterized in that: The steps include: A: The inertial navigation system is initially aligned using a dual-position alignment method; B: Perform temperature calibration and error compensation on the zero bias, installation error and scale factor of the gyro and accelerometer according to the changing characteristics of the orbital ambient temperature; C: Collect measurement data from gyroscopes, accelerometers, odometers, and gauge meters; D: Perform navigation calculation based on gyro data, accelerometer data, and gravity anomaly calculation data, and make optimal estimates based on the navigation calculation results, odometer data, gauge data, track constraint calculation module data, and vehicle dynamics calculation module data; E: Solve the orbit solution model and perform error compensation on the optimal estimation result of step D to obtain the orbit detection result; The low-speed track inspection system includes: inertial navigation system, odometer, gauge meter and track inspection vehicle; The track inspection vehicle body includes a T-shaped beam and a plurality of running wheels; the T-shaped beam includes three ends, and a running wheel is arranged on the side of each end; The inertial navigation system is arranged above the T-shaped beam, the gauge meter is arranged inside the T-shaped beam, and the odometer is installed on the running wheel; The inertial navigation system is connected to the odometer and the gauge meter via an electrical interface, and is used at least to measure the attitude, speed and position data of the track inspection vehicle, and calculate the track geometry state in combination with the data of the odometer and the gauge meter; The inertial navigation system includes a gyroscope, an accelerometer, an inertial device circuit, a navigation computer and a universal interface circuit; among which, The gyroscope is used to measure angular velocity data; The accelerometer is used to measure acceleration data; The inertial device circuit is used to collect the measurement data of the gyroscope and accelerometer; The navigation computer is used at least to complete the inertial navigation solution, the odometer data solution, the gauge data solution, and the various measurement models and error compensation model solutions; The universal interface circuit is used to connect at least the odometer and the gauge meter; The navigation computer includes a system error correction module, a navigation solution module, an optimal estimation module, a track detection solution module and a result output module; The navigation solution module is used to complete attitude solution, velocity solution and position solution according to the measurement data of the gyroscope and accelerometer; The system error correction module is used to correct the system error and gravity anomaly error; The optimal estimation module is at least used to optimally estimate the system error of the inertial navigation data, the odometer data, and the gauge data; The track detection solution module is used for track detection model solution and error compensation; The result output module is at least used to output track detection data, inertial navigation data and track geometry state data; The navigation computer also includes one or more modules of a gravity anomaly solving module, a track constraint solving module, and a vehicle body dynamics solving module; The gravity anomaly solution module is used to calculate gravity anomaly data and compensate for the error between the actual gravity and the gravity model used in the inertial navigation solution process; The track constraint solving module is used to solve the motion constraint model and error compensation of the detection vehicle equipped with the low-speed track detection system on the track; The vehicle dynamics solution module is used for vehicle dynamics motion model solution and error compensation.
2. The low-speed track detection method according to claim 1, characterized in that: The mileage is more than 2; The track inspection vehicle body also includes a plurality of limiting wheels, an integral pretensioning device and a gauge pretensioning device. The plurality of limiting wheels are arranged at the bottom of the T-shaped beam, including travel limiting wheels respectively arranged at the three ends of the T-shaped beam and a gauge limiting wheel arranged between the travel limiting wheels located on the same side of the rail; the integral pretensioning device is connected to the travel limiting wheel to make the travel limiting wheel close to the inner side of the rail; the gauge pretensioning device is connected to the gauge limiting wheel to make the gauge limiting wheel close to the inner side of the rail.
3. The low-speed track detection method according to claim 1, characterized in that: It also includes a total station or satellite navigation receiver, which deeply integrates the data solved by the inertial navigation system with the data of the total station or satellite navigation receiver to improve the accuracy of track detection.
4. The low-speed track detection method according to claim 1, characterized in that: In step A, the method of initially aligning the inertial navigation system using a dual-position alignment method includes: A1: The inertial navigation system is fixedly installed on the vehicle body of the low-speed track detection system; A2: Place the vehicle on the ground or track and keep it stationary for a predetermined period of time; A3: Rotate the vehicle body 90 to 270 degrees with the vertical direction as the axis, place the vehicle body on the ground or track, and keep it stationary for a predetermined time; A4: Use inertial navigation system data and optimal estimation method to complete initial alignment and horizontal gyro bias and horizontal accelerometer bias estimation, wherein the optimal estimation method includes using extended Kalman filter, unscented Kalman filter or least squares method for optimal estimation.
5. The low-speed track detection method according to claim 1, characterized in that: The step B also includes high-precision calibration and error compensation of the zero bias, installation error, and scale factor of the gyroscope and accelerometer according to the detection speed and orbit parameter change characteristics.
6. The low-speed track detection method according to claim 1, characterized in that: The odometer data collected in step C is data from more than two odometers, and in step D, the more than two odometer data are deeply integrated with the result data of the navigation solution.
