High-accuracy railway track surveying is essential for railway construction and maintenance. The traditional approaches based on total station equipment are not efficient enough since high precision surveying frequently needs static measurements. This paper proposes a new filtering and smoothing algorithm based on the IMU/odometer and landmarks integration for the railway track surveying. In order to overcome the difficulty of estimating too many error parameters with too few landmark observations, a new model with completely observable error states is established by combining error terms of the system. Based on covariance analysis, the analytical relationship between the railway track surveying accuracy requirements and equivalent gyro drifts including bias instability and random walk noise are established. Experiment results show that the accuracy of the new filtering and smoothing algorithm for railway track surveying can reach 1 mm (1σ) when using a Ring Laser Gyroscope (RLG)-based Inertial Measurement Unit (IMU) with gyro bias instability of 0.03°/h and random walk noise of 0.005 °h while control points of the track control network (CPIII) position observations are provided by the optical total station in about every 60 m interval. The proposed approach can satisfy at the same time the demands of high accuracy and work efficiency for railway track surveying. Full article

Based on stochastic modeling of Coriolis vibration gyros by the Allan variance technique, this paper discusses Angle Random Walk (ARW), Rate Random Walk (RRW) and Markov process gyroscope noises which have significant impacts on the North-finding accuracy. A new continuous rotation alignment algorithm for a Coriolis vibration gyroscope Inertial Measurement Unit (IMU) is proposed in this paper, in which the extended observation equations are used for the Kalman filter to enhance the estimation of gyro drift errors, thus improving the north-finding accuracy. Theoretical and numerical comparisons between the proposed algorithm and the traditional ones are presented. The experimental results show that the new continuous rotation alignment algorithm using the extended observation equations in the Kalman filter is more efficient than the traditional two-position alignment method. Using Coriolis vibration gyros with bias instability of 0.1°/h, a north-finding accuracy of 0.1° (1σ) is achieved by the new continuous rotation alignment algorithm, compared with 0.6° (1σ) north-finding accuracy for the two-position alignment and 1° (1σ) for the fixed-position alignment. Full article

Count data are subject to considerable sources of what is often referred to as non-sampling error. Errors such as misclassification, measurement error and unmeasured confounding can lead to substantially biased estimators. It is strongly recommended that epidemiologists not only acknowledge these sorts of errors in data, but incorporate sensitivity analyses into part of the total data analysis. We extend previous work on Poisson regression models that allow for misclassification by thoroughly discussing the basis for the models and allowing for extra-Poisson variability in the form of random effects. Via simulation we show the improvements in inference that are brought about by accounting for both the misclassification and the overdispersion. Full article

This paper presents a novel approach for estimating the ego-motion of a vehicle in dynamic and unknown environments using tightly-coupled inertial and visual sensors. To improve the accuracy and robustness, we exploit the combination of point and line features to aid navigation. The mathematical framework is based on trifocal geometry among image triplets, which is simple and unified for point and line features. For the fusion algorithm design, we employ the Extended Kalman Filter (EKF) for error state prediction and covariance propagation, and the Sigma Point Kalman Filter (SPKF) for robust measurement updating in the presence of high nonlinearities. The outdoor and indoor experiments show that the combination of point and line features improves the estimation accuracy and robustness compared to the algorithm using point features alone. Full article

The Kalman filter (KF) has always been used to improve north-finding performance under practical conditions. By analyzing the characteristics of the azimuth rotational inertial measurement unit (ARIMU) on a stationary base, a linear state equality constraint for the conventional KF used in the fine north-finding filtering phase is derived. Then, a constrained KF using the state equality constraint is proposed and studied in depth. Estimation behaviors of the concerned navigation errors when implementing the conventional KF scheme and the constrained KF scheme during stationary north-finding are investigated analytically by the stochastic observability approach, which can provide explicit formulations of the navigation errors with influencing variables. Finally, multiple practical experimental tests at a fixed position are done on a postulate system to compare the stationary north-finding performance of the two filtering schemes. In conclusion, this study has successfully extended the utilization of the stochastic observability approach for analytic descriptions of estimation behaviors of the concerned navigation errors, and the constrained KF scheme has demonstrated its superiority over the conventional KF scheme for ARIMU stationary north-finding both theoretically and practically. Full article

Since the drifts of Inertial Navigation System (INS) solutions are inevitable and also grow over time, a Doppler Velocity Log (DVL) is used to aid the INS to restrain its error growth. Therefore, INS/DVL integration is a common approach for Autonomous Underwater Vehicle (AUV) navigation. The parameters including the scale factor of DVL and misalignments between INS and DVL are key factors which limit the accuracy of the INS/DVL integration. In this paper, a novel parameter calibration method is proposed. An iterative implementation of the method is designed to reduce the error caused by INS initial alignment. Furthermore, a simplified INS/DVL integration scheme is employed. The proposed method is evaluated with both river trial and sea trial data sets. Using 0.03°/h(1σ) ring laser gyroscopes, 5 × 10⁻⁵ g(1σ) quartz accelerometers and DVL with accuracy 0.5% V ± 0.5 cm/s, INS/DVL integrated navigation can reach an accuracy of about 1‰ of distance travelled (CEP) in a river trial and 2‰ of distance travelled (CEP) in a sea trial. Full article

An actual account of the angle random walk (ARW) coefficients of gyros in the constant rate biased rate ring laser gyro (RLG) inertial navigation system (INS) is very important in practical engineering applications. However, no reported experimental work has dealt with the issue of characterizing the ARW of the constant rate biased RLG in the INS. To avoid the need for high cost precise calibration tables and complex measuring set-ups, the objective of this study is to present a cost-effective experimental approach to characterize the ARW of the gyros in the constant rate biased RLG INS. In the system, turntable dynamics and other external noises would inevitably contaminate the measured RLG data, leading to the question of isolation of such disturbances. A practical observation model of the gyros in the constant rate biased RLG INS was discussed, and an experimental method based on the fast orthogonal search (FOS) for the practical observation model to separate ARW error from the RLG measured data was proposed. Validity of the FOS-based method was checked by estimating the ARW coefficients of the mechanically dithered RLG under stationary and turntable rotation conditions. By utilizing the FOS-based method, the average ARW coefficient of the constant rate biased RLG in the postulate system is estimated. The experimental results show that the FOS-based method can achieve high denoising ability. This method estimate the ARW coefficients of the constant rate biased RLG in the postulate system accurately. The FOS-based method does not need precise calibration table with high cost and complex measuring set-up, and Statistical results of the tests will provide us references in engineering application of the constant rate biased RLG INS. Full article

In-motion alignment of Strapdown Inertial Navigation Systems (SINS) without any geodetic-frame observations is one of the toughest challenges for Autonomous Underwater Vehicles (AUV). This paper presents a novel scheme for Doppler Velocity Log (DVL) aided SINS alignment using Unscented Kalman Filter (UKF) which allows large initial misalignments. With the proposed mechanism, a nonlinear SINS error model is presented and the measurement model is derived under the assumption that large misalignments may exist. Since a priori knowledge of the measurement noise covariance is of great importance to robustness of the UKF, the covariance-matching methods widely used in the Adaptive KF (AKF) are extended for use in Adaptive UKF (AUKF). Experimental results show that the proposed DVL-aided alignment model is effective with any initial heading errors. The performances of the adaptive filtering methods are evaluated with regards to their parameter estimation stability. Furthermore, it is clearly shown that the measurement noise covariance can be estimated reliably by the adaptive UKF methods and hence improve the performance of the alignment. Full article

COMPASS is an indigenously developed Chinese global navigation satellite system and will share many features in common with GPS (Global Positioning System). Since the ultra-tight GPS/INS (Inertial Navigation System) integration shows its advantage over independent GPS receivers in many scenarios, the federated ultra-tight COMPASS/INS integration has been investigated in this paper, particularly, by proposing a simplified prefilter model. Compared with a traditional prefilter model, the state space of this simplified system contains only carrier phase, carrier frequency and carrier frequency rate tracking errors. A two-quadrant arctangent discriminator output is used as a measurement. Since the code tracking error related parameters were excluded from the state space of traditional prefilter models, the code/carrier divergence would destroy the carrier tracking process, and therefore an adaptive Kalman filter algorithm tuning process noise covariance matrix based on state correction sequence was incorporated to compensate for the divergence. The federated ultra-tight COMPASS/INS integration was implemented with a hardware COMPASS intermediate frequency (IF), and INS’s accelerometers and gyroscopes signal sampling system. Field and simulation test results showed almost similar tracking and navigation performances for both the traditional prefilter model and the proposed system; however, the latter largely decreased the computational load. Full article

A matrix Kalman filter (MKF) has been implemented for an integrated navigation system using visual/inertial/magnetic sensors. The MKF rearranges the original nonlinear process model in a pseudo-linear process model. We employ the observability rank criterion based on Lie derivatives to verify the conditions under which the nonlinear system is observable. It has been proved that such observability conditions are: (a) at least one degree of rotational freedom is excited, and (b) at least two linearly independent horizontal lines and one vertical line are observed. Experimental results have validated the correctness of these observability conditions. Full article

This paper presents an improved iterative nonlinear calibration method in the gravitational field for both low-grade and high-grade triaxial accelerometers. This calibration method assumes the probability density function of a Gaussian distribution for the raw outputs of triaxial accelerometers. A nonlinear criterion function is derived as the maximum likelihood estimation for the calibration parameters and inclination vectors, which is solved by the iterative estimation. First, the calibration parameters, including the scale factors, misalignments, biases and squared coefficients are estimated by the linear least squares method according to the multi-position raw outputs of triaxial accelerometers and the initial inclination vectors. Second, the sequence quadric program method is utilized to solve the nonlinear constrained optimization to update the inclination vectors according to the estimated calibration parameters and raw outputs of the triaxial accelerometers. The initial inclination vectors are supplied by normalizing raw outputs of triaxial accelerometers at different positions without any a priori knowledge. To overcome the imperfections of models, the optimal observation scheme is designed according to some maximum sensitivity principle. Simulation and experiments show good estimation accuracy for calibration parameters and inclination vectors. Full article

In Compass/INS integrated navigation systems, feedback inertial navigation solutions to baseband tracking loops may eliminate receiver dynamic effects, and effectively improve the tracking accuracy and sensitivity. In the conventional inertially-aided tracking loop, the satellite-receiver line-of-sight velocity is used directly to adjust local carrier frequency. However, if the inertial solution drifts, the phase tracking error will be enlarged. By using Kalman filter based carrier phase tracking loop, this paper introduces a new inertial aid method, in which the line-of-sight jerk obtained from inertial acceleration by a nonlinear tracking differentiator is used to adjust relevant parameters of the Kalman filter’s process noise matrix. Validation is achieved through high dynamic Compass B3 signal with line-of-sight jerk of 10 g/s collected by a GNSS simulator. Experimental results indicate that the new inertial aid method proposed in this paper is free of the impact of the receiver dynamic and inertial errors. Therefore, when the integrated navigation system is starting or re-tracking after losing lock, the inertial error is absent from the navigation solution correction that induces large drift, and the new aid method proposed in this paper can track highly dynamic signals. Full article

Temperature changes have a strong effect on Hemispherical Resonator Gyro (HRG) output; therefore, it is of vital importance to observe their influence and then make necessary compensations. In this paper, a temperature compensation model for HRG based on the natural frequency of the resonator is established and then temperature drift compensations are accomplished. To begin with, a math model of the relationship between the temperature and the natural frequency of HRG is set up. Then, the math model is written into a Taylor expansion expression and the expansion coefficients are calibrated through temperature experiments. The experimental results show that the frequency changes correspond to temperature changes and each temperature only corresponds to one natural frequency, so the output of HRG can be compensated through the natural frequency of the resonator instead of the temperature itself. As a result, compensations are made for the output drift of HRG based on natural frequency through a stepwise linear regression method. The compensation results show that temperature-frequency method is valid and suitable for the gyroscope drift compensation, which would ensure HRG’s application in a larger temperature range in the future. Full article

A novel design of force to rebalance control for a hemispherical resonator gyro (HRG) based on FPGA is demonstrated in this paper. The proposed design takes advantage of the automatic gain control loop and phase lock loop configuration in the drive mode while making full use of the quadrature control loop and rebalance control loop in controlling the oscillating dynamics in the sense mode. First, the math model of HRG with inhomogeneous damping and frequency split is theoretically analyzed. In addition, the major drift mechanisms in the HRG are described and the methods that can suppress the gyro drift are mentioned. Based on the math model and drift mechanisms suppression method, four control loops are employed to realize the manipulation of the HRG by using a FPGA circuit. The reference-phase loop and amplitude control loop are used to maintain the vibration of primary mode at its natural frequency with constant amplitude. The frequency split is readily eliminated by the quadrature loop with a DC voltage feedback from the quadrature component of the node. The secondary mode response to the angle rate input is nullified by the rebalance control loop. In order to validate the effect of the digital control of HRG, experiments are carried out with a turntable. The experimental results show that the design is suitable for the control of HRG which has good linearity scale factor and bias stability. Full article