CN106643445B - A kind of track roughness measurement method - Google Patents

A kind of track roughness measurement method Download PDF

Info

Publication number
CN106643445B
CN106643445B CN201611263066.5A CN201611263066A CN106643445B CN 106643445 B CN106643445 B CN 106643445B CN 201611263066 A CN201611263066 A CN 201611263066A CN 106643445 B CN106643445 B CN 106643445B
Authority
CN
China
Prior art keywords
angle
track
data
walking mechanism
angular
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN201611263066.5A
Other languages
Chinese (zh)
Other versions
CN106643445A (en
Inventor
祝国富
马震
程敏
赵伟
许春山
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Yijiahe Technology Co Ltd
Original Assignee
Yijiahe Technology Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Yijiahe Technology Co Ltd filed Critical Yijiahe Technology Co Ltd
Priority to CN201611263066.5A priority Critical patent/CN106643445B/en
Publication of CN106643445A publication Critical patent/CN106643445A/en
Application granted granted Critical
Publication of CN106643445B publication Critical patent/CN106643445B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01BMEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
    • G01B5/00Measuring arrangements characterised by the use of mechanical techniques
    • G01B5/28Measuring arrangements characterised by the use of mechanical techniques for measuring roughness or irregularity of surfaces

Landscapes

  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Gyroscopes (AREA)
  • Length Measuring Devices With Unspecified Measuring Means (AREA)
  • Navigation (AREA)

Abstract

The present invention provides a kind of track roughness measurement method, comprising the following steps: (1) will place in orbit with the walking mechanism of acceleration transducer, angular-rate sensor, Magnetic Sensor, and be moved to track corresponding position;(2) initial data for obtaining acceleration transducer, angular-rate sensor, pitch angle, yaw angle and the roll angle of walking mechanism are obtained according to initial data;(3) whether the pitch angle of acquisition, yaw angle, roll angle are located in level threshold value section in judgment step (2), illustrate that track is smooth if being located in level threshold value section, otherwise, track out-of-flatness.The present invention can realize simplification, safety and the efficiency of the operation of track installation detection process with the flatness of intelligent decision track installation.

Description

A kind of track roughness measurement method
Technical field
The present invention relates to a kind of track roughness measurement methods.
Background technique
Track machine people's Daily Round Check monitor task all carries out in orbit, therefore robot is for the stabilization of track There is high requirements for property and flatness.For with ensureing inspection monitor task trouble-free operation, need to track installation work early period Skill is rigid in checking up, and can have the angular deviation of three-dimensional space during track installation, and common manually takes inclinator The method of measurement can only obtain deviation of the track on two dimension angular, and measurement error is larger, and process is cumbersome, climb when manually There are security risk when going to measure, efficiency is lower.
Summary of the invention
In order to solve the problems existing in the prior art, the present invention provides a kind of track roughness measurement method, intelligent decision rail The flatness of road installation, realizes simplification, safety and the efficiency of the operation of track installation detection process.
Track roughness measurement method provided by the invention, comprising the following steps:
(1) it will be placed in orbit with the walking mechanism of acceleration transducer, angular-rate sensor, Magnetic Sensor, and It is moved to track corresponding position;
(2) initial data for obtaining acceleration transducer, angular-rate sensor, obtains walking mechanism according to initial data Pitch angle, yaw angle and roll angle;The pitch angle of pitch angle, yaw angle and the roll angle of walking mechanism and track, yaw angle and Roll angle is identical.
(3) whether the pitch angle of acquisition, yaw angle, roll angle are located in level threshold value section in judgment step (2), if Then illustrate that track is smooth in level threshold value section, otherwise, track out-of-flatness.
Preferably, the step (2) specifically includes;
(2.1) initial data of acceleration transducer, angular-rate sensor is obtained as four elements, is made using four element Four element q are initialized for initial value0、q1、q2、q3, by four element q0、q1、q2、q3Be converted into Eulerian angles θ, ψ,This group of Eulerian angles are made For first group of attitude angle Q0, θ, ψ,Respectively indicate pitch angle, yaw angle, roll angle;
(2.2) median filtering is carried out to the initial data of acceleration transducer, obtains acceleration information A-data, A- Data includes to respectively correspond x-axis, y-axis, the A of z-axisx,Ay,AzThree components carry out attitude algorithm using these three components, obtain Pitching angle theta, roll angleAnd the angle γ of z-axis and acceleration of gravity, wherein
(2.3) it obtains the initial data of Magnetic Sensor and carries out median filtering, obtain magnetic data M-data,
The data include three component Mx,My,Mz, then carry out slope compensation:
Yaw angle is obtained according to slope compensation resultWherein θ,To be obtained in step (2.2) To pitch angle, roll angle.
(2.4) initial data of angular velocity sensor carries out mean filter and obtains angular velocity data ω-data, to ω- Corresponding angle Q is obtained after data integral operationk=(ωkb)dt+Qk-1, wherein QkFor the angle at current time;ωkFor angle The angular speed at velocity sensor current time;ωbFor the offset of current time angular speed;Dt is the sampling period;Qk-1It is previous The angle value at moment.
(2.5) pitching angle theta, the roll angle for obtaining step (2.2), (2.3), (2.4)Yaw angle ψ, current time Angle QkIt is merged to obtain second group of attitude angle Q by Kalman filtering algorithm1
(2.6) by first group of attitude angle Q0With second group of attitude angle Q1It is merged, is merged by single order complementary filter Data Q afterwardst=α Q0+βQ1, according to data Q after fusiontObtain final accurately pitch angle, roll angle, yaw angle, wherein α, β Corresponding Q0、Q1Confidence weight, alpha+beta=1.α value range is 0.3-0.5, β value range: 0.7~0.5.
To realize the accurate positionin to uneven track position, positioning system is also equipped in walking mechanism of the present invention System, the positioning system determine walking mechanism position in orbit for positioning to walking mechanism, when detecting track not When smooth, the position that can use walking mechanism determines the position of uneven track.When pitch angle, yaw angle, roll angle do not exist When in level threshold value section, walking mechanism stopping walks about and issues alarm, up to the track be repaired it is smooth, by walking mechanism weight It newly puts back at this, measures after related data meets the requirements, walking mechanism continues to test lower track section.
For with realizing track installation technique early period stringent control, the present invention is using gyroscope to track stability and smooth Property measure, data are handled using arm processor, use handheld data analysis liquid crystal display show track flatness letter Breath, reduces the error of manual measurement.In order to realize the measurement accurate feedback to track three-dimensional perspective deviation, AHRS extension point is used When algorithm and Kalman filtering algorithm measurement data is handled, use data analysis liquid crystal display departure and aberration curve As feedback quantity, track flatness is judged using abnormal indicator light, intelligent accurate orients the orbital region of abnormal dip.This hair Bright to load measuring device using walking mechanism, measuring device, which is expanded, becomes a mobile platform, makes to operate walk away safety, improve Track installation efficiency.The present invention realizes the flatness of intelligent decision track installation, demarcates with carrying out specific region automatically, and feedback is inclined Difference is precisely corrected, so that the stability of guide rails of robots and planarization are guaranteed.
Detailed description of the invention
Fig. 1 is flow chart of the present invention;
Fig. 2 is the control interface that handheld data analyzes liquid crystal display;
Fig. 3 is the three-dimension altitude angle interface that handheld data analyzes liquid crystal display;
Fig. 4 is the angle of deviation interface that handheld data analyzes liquid crystal display.
Specific embodiment
Walking mechanism of the invention can be used application No. is 201610186221.1 patent of invention provide robot row Mechanism is walked, which uses a high-performance brush motor for power, has positioning system below driving wheel, in conjunction with electricity Machine encoder position ring can precisely acquire the distance of walking, which has eight directive wheels, in walking mechanism and track Respectively there are 4 directive wheels at the both ends of contact, cooperate, and are close to track, will not generate wobble effects gyro data;Guiding module Block can be turned an angle in the horizontal plane to adapt to turn to and adjust, it can be achieved that without dead angle steering, will not generate fortune at turning Dynamic direction stress.Positioning system is installed in walking mechanism, 9 magnet steel is taken to cooperate with Hall sensor, it can be achieved that contactless Property, in the case that track does not need installation power supply, the distance of mechanism walking is accurately positioned.Be equipped in walking mechanism gyroscope, Arm processor, 3 axis MEMS module measurement module, can also directly use MPU9250 sensor, sensor integration gyro Instrument, acceleration transducer and Magnetic Sensor.
Overall plan of the present invention is described as follows:
1, walking mechanism is placed on the track for needing testing flatness;
2, the upper arm processor of walking mechanism, 3 axis MEMS module measurement module are powered on;
3, in the level threshold value section (- 0.6 °~+0.6 °) of handheld data analysis liquid crystal display setting track flatness, the mark Quasi- threshold interval is to be orbited to guarantee horizontal attitude and set according to machine, is sent on track by wireless module Walking mechanism;
4, input needs the distance of track to be tested, clicks operation, as shown in Fig. 2, analyzing liquid crystal display for handheld data Control interface;
5, the walking mechanism of track can move in orbit, when encountering a certain section of flatness not in level threshold value section It can be automatically stopped walking when region and issue flashing red light;This section of track flatness data is transferred to handheld data analysis liquid crystal Screen;Due to measuring three roll angle, pitch angle, yaw angle data, as long as in any one data no longer level threshold value section, all It can stop walking.
6, handheld data analysis liquid crystal display shows track flatness exception information, inclined in handheld data analysis liquid crystal display observation Residual quantity and aberration curve are illustrated in figure 3 the three-dimension altitude angle interface of handheld data analysis liquid crystal display, it is shown that this section of track Roll angle, pitch angle, yaw angular data, Fig. 4 show handheld data analysis liquid crystal display angle of deviation interface, show departure And aberration curve;
7, worker carries out artificial correction in abnormal orbital region, until abnormal flash red, which becomes normal, (is indicating data just Often), this section of track flatness reaches requirement.
As shown in Figure 1, the present invention obtains accurate pitch angle, roll angle, yaw angle, specific step is as follows:
1. first group of attitude angle Q0
The MPU9250 produced using InvenSense company, MPU9250 carry DMP (digital moving processor) and MPL (embedded motion process library) handles the acceleration transducer of MPU9250 and the initial data of angular-rate sensor, obtains It to quaternary number and exports, this quaternary number is used to initialize quaternary number q as initial value0、q1、q2、q3, since Eulerian angles are more intuitive, xb、yb、zbFor the coordinate of three axis of module carrier, xn、yn、zn: for the coordinate under reference frame, need for quaternary number to be converted into Eulerian angles:
Firstly, from four element q0、q1、q2、q3It is converted into direction cosine matrix:
Then Eulerian angles are converted by direction cosine matrix again:
T in formulaijThe i-th row, the jth column element of (i, j=1,2,3) expression direction cosine matrix.It can be obtained by this way One group of attitude angle Q0(including pitch angle, roll angle, yaw angle).
2. second group of attitude angle Q1
1) acceleration information is handled
After obtaining accelerometer initial data, a median filtering is carried out, the acceleration information A- that obtains that treated Data, A-data include Ax,Ay,Az(corresponding x-axis, y-axis, z-axis) three components, then carry out posture solution using these three components It calculates:
In formula, θ,Pitch angle and roll angle are respectively corresponded, γ is the angle of z-axis and acceleration of gravity, in this way by adding The available pitch angle of speedometer and roll angle, and yaw angle is not by calibration, it may appear that obvious drift needs to pass using magnetic Sensor is corrected.
2) magnetic sensor data is handled
After obtaining magnetic sensor data, median filtering is first carried out, obtain that treated magnetic data M-data, the data packet Containing three component Mx,My,Mz, then carry out slope compensation:
Wherein θ,To obtain pitch angle, roll angle in step 1), yaw angle can pass through following trigonometric function relationship meter It calculates:
(5)
3) angular velocity data is handled
It after obtaining angular velocity omega initial data, needs first to carry out a mean filter, noise jamming is removed, after obtaining processing Then data ω-data can be obtained by corresponding angle by integral:
Qk=(ωkb)dt+Qk-1 (6)
Wherein, QkFor the angle at current time;ωkFor the angular speed at gyroscope current time;ωbFor current time angle speed The offset of degree;Dt is the sampling period;Qk-1For the angle value of previous moment.
4) Kalman filtering
Angle attitude data is merged using Kalman filtering algorithm, the input quantity of filter is systematic perspective measurement, Output quantity is the prediction of system state amount, carries out optimal estimation using the statistical property of system noise and observation noise.Assuming that being The state equation and measurement equation of system are described as follows:
Wherein, Xk, ykRespectively correspond state vector and observation vector;A shifts square for -1 moment of kth to kth moment state Battle array;B is the gain matrix of input control vector;UkFor input control vector;H is gain matrix of the quantity of state to observed quantity;WkFor System input noise;vkFor observation noise;It is assumed that system input noise and observation noise all Normal Distributions, input noise Covariance is Q, and the covariance of observation noise is R, then Kalman filtering can be described as following 5 formula:
State quantity prediction:
Error covariance prediction:
Pk|k-1=APk-1AT+Q (9)
Kalman gain updates:
Kk=Pk|k-1HT[HPk|k-1HT+R]-1 (10)
State updates:
Error covariance updates:
Pk=(1-KkH)Pk|k-1 (12)
In formula,For the prediction to current state true value;For the prediction based on the k-1 moment to k moment state; A is -1 moment of kth to kth moment state-transition matrix;B is the gain matrix of input control vector;H is quantity of state to observed quantity Gain matrix;ykFor the observed quantity at kth moment;KkFor kalman gain;PkFor the error covariance square of current state estimated value Battle array;Pk|k-1For the error co-variance matrix of prediction;I is unit matrix.
Gyroscope angle state indicates that accelerometer and Magnetic Sensor corresponding angle are as observation value of feedback with formula (5).For Inhibition gyroscopic drift, needs to predict offset, so system state equation are as follows:
T indicates the sampling period in formula;QkFor the angle at current time;ωbFor the offset of current time angular speed, ωk-1、 ωkRespectively correspond the angular speed at k moment and k-1 moment.In optimization process, each initial value is provided that
The angular velocity data, acceleration information and magnetic sensor data of gyroscope are melted by Kalman filtering algorithm It closes, available second group of attitude angle Q1(including pitch angle, roll angle, yaw angle).
3. single order complementary filter
In order to further increase the accuracy for obtaining attitude angle, by first group of three attitude angle Q0(pitch angle, roll angle, Yaw angle) and second group of three attitude angle Q1(pitch angle, roll angle, yaw angle) is merged by complementary filter Data Qt (pitch angle, roll angle, yaw angle) complementary filter formula is as follows:
Qt=α Q0+βQ1 (14)
α, β correspond to Q0、Q1Confidence weight, alpha+beta=1, the general value range that α is set: 0.3~0.5, the value range of β is set: 0.7~0.5;Qt is fused data, can thus obtain a very accurate attitude data, be shown by display screen.

Claims (4)

1. a kind of track roughness measurement method, which comprises the following steps:
(1) it will be placed in orbit with the walking mechanism of acceleration transducer, angular-rate sensor, Magnetic Sensor, and mobile To track corresponding position;
(2) initial data for obtaining acceleration transducer, angular-rate sensor, the pitching of walking mechanism is obtained according to initial data Angle, yaw angle and roll angle;
(3) whether the pitch angle of acquisition, yaw angle, roll angle are located in level threshold value section in judgment step (2), if be located at Then illustrate that track is smooth in level threshold value section, otherwise, track out-of-flatness;
The step (2) specifically includes;
(2.1) initial data of acceleration transducer, angular-rate sensor is obtained as four elements, using four element as just Four element q of value initialization0、q1、q2、q3, by four element q0、q1、q2、q3Be converted into Eulerian angles θ, ψ,This group of Eulerian angles are as One group of attitude angle Q0, θ, ψ,Respectively indicate pitch angle, yaw angle, roll angle;
(2.2) median filtering is carried out to the initial data of acceleration transducer, obtains acceleration information A-data, A-data includes Respectively correspond x-axis, y-axis, the A of z-axisx,Ay,AzThree components carry out attitude algorithm using these three components, obtain pitching angle theta, Roll angleAnd the angle γ of z-axis and acceleration of gravity, wherein
(2.3) it obtains the initial data of Magnetic Sensor and carries out median filtering, obtain magnetic data M-data, which includes three Component Mx,My,Mz, then carry out slope compensation:
Yaw angle is obtained according to slope compensation resultWherein θ,To obtain pitching in step (2.2) Angle, roll angle;
(2.4) initial data of angular velocity sensor carries out mean filter and obtains angular velocity data ω-data, to ω-data Corresponding angle Q is obtained after integral operationk=(ωkb)dt+Qk-1, wherein QkFor the angle at current time;ωkFor angular speed The angular speed at sensor current time;λωbFor the offset of current time angular speed;Dt is the sampling period;Qk-1When being previous The angle value at quarter;
(2.5) pitching angle theta, the roll angle for obtaining step (2.2), (2.3), (2.4)Yaw angle ψ, the angle at current time QkIt is merged to obtain second group of attitude angle Q by Kalman filtering algorithm1
(2.6) by first group of attitude angle Q0With second group of attitude angle Q1It is merged by single order complementary filter, number after being merged According to Qt=α Q0+βQ1, according to data Q after fusiontObtain final accurately pitch angle, roll angle, yaw angle, wherein α, β are corresponding Q0、Q1Confidence weight, alpha+beta=1.
2. track roughness measurement method as described in claim 1, which is characterized in that α value range is 0.3-0.5, β value Range: 0.7~0.5.
3. track roughness measurement method as described in claim 1, which is characterized in that it is fixed to be also equipped in the walking mechanism Position system, the positioning system determine walking mechanism position in orbit for positioning to walking mechanism.
4. track roughness measurement method as described in claim 1, which is characterized in that when pitch angle, yaw angle, roll angle not When in level threshold value section, walking mechanism stopping walks about and issues alarm.
CN201611263066.5A 2016-12-30 2016-12-30 A kind of track roughness measurement method Active CN106643445B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201611263066.5A CN106643445B (en) 2016-12-30 2016-12-30 A kind of track roughness measurement method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201611263066.5A CN106643445B (en) 2016-12-30 2016-12-30 A kind of track roughness measurement method

Publications (2)

Publication Number Publication Date
CN106643445A CN106643445A (en) 2017-05-10
CN106643445B true CN106643445B (en) 2019-04-16

Family

ID=58839027

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201611263066.5A Active CN106643445B (en) 2016-12-30 2016-12-30 A kind of track roughness measurement method

Country Status (1)

Country Link
CN (1) CN106643445B (en)

Families Citing this family (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107339982B (en) * 2017-07-06 2019-10-01 湖南迈克森伟电子科技有限公司 High-speed rail wire plotting method
CN107941463B (en) * 2017-10-26 2020-11-10 深圳多哚新技术有限责任公司 Horizontal defect detection method and system for head-mounted equipment
CN107796386B (en) * 2017-10-26 2020-10-20 深圳多哚新技术有限责任公司 Horizontal defect detection method and system for PCB of head-mounted equipment
CN107843219A (en) * 2017-10-26 2018-03-27 西南交通大学 Track geometry irregularities measurement apparatus and method
CN108508928B (en) * 2018-03-15 2024-05-28 贺凯 Scooter road surface identification method
CN110542417B (en) * 2019-09-05 2022-12-13 武汉理工大学 Gyroscope linear measurement method and system based on static and dynamic inclinometer correction
CN110849299B (en) * 2019-11-22 2021-05-18 东南大学 Track unevenness measuring device and method based on image processing
CN111845712B (en) * 2020-07-28 2022-02-01 聊城大学 Control method of anti-rollover control system of tractor
CN114485562B (en) * 2022-01-25 2023-09-29 福建利利普光电科技有限公司 Handheld oscilloscope horizontal position adjusting method based on gravity sensing
CN115535026B (en) * 2022-12-05 2023-04-04 北京智弘通达科技有限公司 Railway track flatness detection method and system
CN116718098B (en) * 2023-08-09 2023-10-17 成都国营锦江机器厂 Online measurement device for coaxiality of main stay bar of helicopter and application method
CN118067073B (en) * 2024-04-16 2024-07-12 北京城建勘测设计研究院有限责任公司 Subway track deformation degree monitoring method, system and storage medium

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2000283745A (en) * 1999-03-31 2000-10-13 Komatsu Engineering Kk On-board device for measuring shape in road surface extension direction
JP2005315675A (en) * 2004-04-28 2005-11-10 Japan Science & Technology Agency Road surface flatness measuring device
CN102252636A (en) * 2011-04-12 2011-11-23 中国航空工业第六一八研究所 Multi-wavelength detection device and detection method for smoothness of high-speed railway track
CN102337710A (en) * 2010-07-19 2012-02-01 西安奥通数码科技有限公司 GPS (Global Positioning System) track irregularity detection system and method
CN102607505A (en) * 2012-03-23 2012-07-25 中国科学院深圳先进技术研究院 Road evenness detection method and road evenness detection system
CN102628249A (en) * 2012-04-27 2012-08-08 重庆邮电大学 Full-automatic inertial sensing pavement evenness detection system and detection method
CN103343498A (en) * 2013-07-24 2013-10-09 武汉大学 Track irregularity detecting system and method based on INS/GNSS

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2000283745A (en) * 1999-03-31 2000-10-13 Komatsu Engineering Kk On-board device for measuring shape in road surface extension direction
JP2005315675A (en) * 2004-04-28 2005-11-10 Japan Science & Technology Agency Road surface flatness measuring device
CN102337710A (en) * 2010-07-19 2012-02-01 西安奥通数码科技有限公司 GPS (Global Positioning System) track irregularity detection system and method
CN102252636A (en) * 2011-04-12 2011-11-23 中国航空工业第六一八研究所 Multi-wavelength detection device and detection method for smoothness of high-speed railway track
CN102607505A (en) * 2012-03-23 2012-07-25 中国科学院深圳先进技术研究院 Road evenness detection method and road evenness detection system
CN102628249A (en) * 2012-04-27 2012-08-08 重庆邮电大学 Full-automatic inertial sensing pavement evenness detection system and detection method
CN103343498A (en) * 2013-07-24 2013-10-09 武汉大学 Track irregularity detecting system and method based on INS/GNSS

Also Published As

Publication number Publication date
CN106643445A (en) 2017-05-10

Similar Documents

Publication Publication Date Title
CN106643445B (en) A kind of track roughness measurement method
CN107655493B (en) SINS six-position system-level calibration method for fiber-optic gyroscope
CN111811537B (en) Error compensation method for strapdown inertial navigation and navigation system
CN105910624B (en) A kind of scaling method of used group of optical laying prism installation error
CN106557089B (en) A kind of control method and device of unmanned plane independent landing
CN106289246B (en) A kind of flexible link arm measure method based on position and orientation measurement system
Rohac et al. Calibration of low-cost triaxial inertial sensors
US9541392B2 (en) Surveying system and method
JP4989035B2 (en) Error correction of inertial navigation system
EP2901104B1 (en) Improved inertial navigation system and method
US20130018582A1 (en) Inertial Navigation Common Azimuth Reference Determination System and Method
KR20170104623A (en) Initial alignment of inertial navigation devices
CN109870173A (en) A kind of track correct method of the submarine pipeline inertial navigation system based on checkpoint
CN102607596B (en) Strapdown flexible gyro dynamic random drift error testing method based on difference GPS (global position system) observation
CN101571394A (en) Method for determining initial attitude of fiber strapdown inertial navigation system based on rotating mechanism
CN110411444A (en) A kind of subsurface digging mobile device inertia navigation positioning system and localization method
CN104316055A (en) Two-wheel self-balancing robot attitude calculation method based on improved Extended Kalman Filter algorithm
CN109631941A (en) A kind of Inertial Platform System accelerometer installation error method for precisely marking
CN106153069A (en) Attitude rectification apparatus and method in autonomous navigation system
CN103968844A (en) Large ellipse maneuverable spacecraft autonomous navigation method based on low-orbit platform tracking measurement
Wu et al. The calibration for inner and outer lever-arm errors based on velocity differences of two RINSs
KR20120042394A (en) System and method for localizationing of autonomous vehicle
Cechowicz Bias drift estimation for mems gyroscope used in inertial navigation
Zhang et al. The standing calibration method of MEMS gyro bias for autonomous pedestrian navigation system
KR101435106B1 (en) Localization system of under water robots

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant