Search

The ability of the underwater vehicle to determine its precise position is vital to completing a mission successfully. Multi-sensor fusion methods for underwater vehicle positioning are commonly based on Kalman filtering, which requires the knowledge of process and measurement noise covariance. As the underwater conditions are continuously changing, incorrect process and measurement noise covariance affect the accuracy of position estimation and sometimes cause divergence. Furthermore, the underwater multi-path effect and nonlinearity cause outliers that have a significant impact on positional accuracy. These non-Gaussian outliers are difficult to handle with conventional Kalman-based methods and their fuzzy variants. To address these issues, this paper presents a new and improved adaptive multi-sensor fusion method by using information-theoretic, learning-based fuzzy rules for Kalman filter covariance adaptation in the presence of outliers. Two novel metrics are proposed by utilizing correntropy Gaussian and Versoria kernels for matching theoretical and actual covariance. Using correntropy-based metrics and fuzzy logic together makes the algorithm robust against outliers in nonlinear dynamic underwater conditions. The performance of the proposed sensor fusion technique is compared and evaluated using Monte-Carlo simulations, and substantial improvements in underwater position estimation are obtained. [ABSTRACT FROM AUTHOR]

The lithium-ion battery is the key power source of a hybrid vehicle. Accurate real-time state of charge (SOC) acquisition is the basis of the safe operation of vehicles. In actual conditions, the lithium-ion battery is a complex dynamic system, and it is tough to model it accurately, which leads to the estimation deviation of the battery SOC. Recursive least squares (RLS) algorithm with fixed forgetting factor is widely used in parameter identification, but it lacks sufficient robustness and accuracy when battery charge and discharge conditions change suddenly. In this paper, we proposed an adaptive forgetting factor regression least-squares–extended Kalman filter (AFFRLS–EKF) SOC estimation strategy by designing the forgetting factor of least squares algorithm to improve the accuracy of SOC estimation under the change of battery charge and discharge conditions. The simulation results show that the SOC estimation strategy of the AFFRLS–EKF based on accurate modeling can effectively improve the estimation accuracy of SOC. [ABSTRACT FROM AUTHOR]

In Kalman filter design, the filter algorithm and prediction model design are the most discussed topics in research. Another fundamental but less investigated issue is the careful selection of measurands and their contribution to the estimation problem. This is often done purely on the basis of empirical values or by experiments. This paper presents a novel holistic method to design and assess Kalman filters in an automated way and to perform their analysis based on quantifiable parameters. The optimal filter parameters are computed with the help of a nonlinear optimization algorithm. To determine and analyze an optimal filter design, two novel quantitative nonlinear observability measures are presented along with a method to quantify the dominance contribution of a measurand to an estimate. As a result, different filter configurations can be specifically investigated and compared with respect to the selection of measurands and their influence on the estimation. An unscented Kalman filter algorithm is used to demonstrate the method's capabilities to design and analyze the estimation problem parameters. For this purpose, an example of a vehicle state estimation with a focus on the tire-road friction coefficient is used, which represents a challenging problem for classical analysis and filter parameterization. [ABSTRACT FROM AUTHOR]

Nowadays, many precision farming applications rely on the use of GNSS-RTK. However, when it comes to autonomous agricultural vehicles, GNSS cannot be used as a stand-alone system for positioning. To ensure high availability and robustness of the positioning solution, GNSS-RTK must be fused with additional sensors. This paper presents a novel sensor fusion algorithm tailored to tracked agricultural vehicles. GNSS-RTK, an IMU and wheel speed sensors are fused in an error-state Kalman filter to estimate position and attitude of the vehicle. An odometry model for tracked vehicles is introduced which is used to propagate the filter state. By using both IMU and wheel speed sensors, specific motion characteristics of tracked vehicles such as slippage can be included in the dynamic model. The presented sensor fusion algorithm is tested at a composting site using a tracked compost turner. The sensor measurements are recorded using the Robot Operating System (ROS). To analyze the achievable accuracies for position and attitude of the vehicle, a precise reference trajectory is measured using two robotic total stations. The resulting trajectory of the error-state filter is then compared to the reference trajectory. To analyze how well the proposed error-state filter is suited to bridge GNSS outages, GNSS outages of 30 s are simulated in post-processing. During these outages, the vehicle's state is propagated using the wheel speed sensors, IMU, and the dynamic model for tracked vehicles. The results show that after 30 s of GNSS outage, the estimated horizontal position of the vehicle still has a sub-decimetre accuracy. [ABSTRACT FROM AUTHOR]

In multi-target tracking, the sequential Monte Carlo probability hypothesis density (SMC-PHD) filter is a practical algorithm. Influenced by outliers under unknown heavy-tailed measurement noise, the SMC-PHD filter suffers severe performance degradation. In this paper, a robust SMC-PHD (RSMC-PHD) filter is proposed. In the proposed filter, Student-t distribution is introduced to describe the unknown heavy-tailed measurement noise where the degrees of freedom (DOF) and the scale matrix of the Student-t distribution are respectively modeled as a Gamma distribution and an inverse Wishart distribution. Furthermore, the variational Bayesian (VB) technique is employed to infer the unknown DOF and scale matrix parameters while the recursion estimation framework of the RSMC-PHD filter is derived. In addition, considering that the introduced Student- t distribution might lead to an overestimation of the target number, a strategy is applied to modify the updated weight of each particle. Simulation results demonstrate that the proposed filter is effective with unknown heavy-tailed measurement noise. [ABSTRACT FROM AUTHOR]

Received signal strength indication (RSSI) obtained by Medium Access Control (MAC) layer is widely used in range-based and fingerprint location systems due to its low cost and low complexity. However, RSS is affected by noise signals and multi-path, and its positioning performance is not stable. In recent years, many commercial WiFi devices support the acquisition of physical layer channel state information (CSI). CSI is an index that can characterize the signal characteristics with more fine granularity than RSS. Compared with RSS, CSI can avoid the effects of multi-path and noise by analyzing the characteristics of multi-channel sub-carriers. To improve the indoor location accuracy and algorithm efficiency, this paper proposes a hybrid fingerprint location technology based on RSS and CSI. In the off-line phase, to overcome the problems of low positioning accuracy and fingerprint drift caused by signal instability, a methodology based on the Kalman filter and a Gaussian function is proposed to preprocess the RSSI value and CSI amplitude value, and the improved CSI phase is incorporated after the linear transformation. The mutation and noisy data are then effectively eliminated, and the accurate and smoother outputs of the RSSI and CSI values can be achieved. Then, the accurate hybrid fingerprint database is established after dimensionality reduction of the obtained high-dimensional data values. The weighted k-nearest neighbor (WKNN) algorithm is applied to reduce the complexity of the algorithm during the online positioning stage, and the accurate indoor positioning algorithm is accomplished. Experimental results show that the proposed algorithm exhibits good performance on anti-noise ability, fusion positioning accuracy, and real-time filtering. Compared with CSI-MIMO, FIFS, and RSSI-based methods, the proposed fusion correction method has higher positioning accuracy and smaller positioning error. [ABSTRACT FROM AUTHOR]

In this paper, we propose a robust adaptive cubature Kalman filter (CKF) to deal with the problem of an inaccurately known system model and noise statistics. In order to overcome the kinematic model error, we introduce an adaptive factor to adjust the covariance matrix of state prediction, and process the influence introduced by dynamic disturbance error. Aiming at overcoming the abnormality error, we propose the robust estimation theory to adjust the CKF algorithm online. The proposed adaptive CKF can detect the degree of gross error and subsequently process it, so the influence produced by the abnormality error can be solved. The paper also studies a typical application system for the proposed method, which is the ultra-tightly coupled navigation system of a hypersonic vehicle. Highly dynamical scene experimental results show that the proposed method can effectively process errors aroused by the abnormality data and inaccurate model, and has better tracking performance than UKF and CKF tracking methods. Simultaneously, the proposed method is superior to the tracing method based on a single-modulating loop in the tracking performance. Thus, the stable and high-precision tracking for GPS satellite signals are preferably achieved and the applicability of the system is promoted under the circumstance of high dynamics and weak signals. The effectiveness of the proposed method is verified by a highly dynamical scene experiment. [ABSTRACT FROM AUTHOR]

Digital broadcasting signals represent a promising positioning signal for indoors applications. A novel positioning technology named Time & Code Division-Orthogonal Frequency Division Multiplexing (TC-OFDM) is mainly discussed in this paper, which is based on China mobile multimedia broadcasting (CMMB). Signal strength is an important factor that affects the carrier loop performance of the TC-OFDM receiver. In the case of weak TC-OFDM signals, the current carrier loop algorithm has large residual carrier errors, which limit the tracking sensitivity of the existing carrier loop in complex indoor environments. This paper proposes a novel carrier loop algorithm based on Maximum Likelihood Estimation (MLE) and Kalman Filter (KF) to solve the above problem. The discriminator of the current carrier loop is replaced by the MLE discriminator function in the proposed algorithm. The Levenberg-Marquardt (LM) algorithm is utilized to obtain the MLE cost function consisting of signal amplitude, residual carrier frequency and carrier phase, and the MLE discriminator function is derived from the corresponding MLE cost function. The KF is used to smooth the MLE discriminator function results, which takes the carrier phase estimation, the angular frequency estimation and the angular frequency rate as the state vector. Theoretical analysis and simulation results show that the proposed algorithm can improve the tracking sensitivity of the TC-OFDM receiver by taking full advantage of the characteristics of the carrier loop parameters. Compared with the current carrier loop algorithms, the tracking sensitivity is effectively improved by 2–4 dB, and the better performance of the proposed algorithm is verified in the real environment. [ABSTRACT FROM AUTHOR]

With the rapid development of information and communication technology, the wireless sensor network (WSN) has shown broad application prospects in a growing number of fields. The non-line-of-sight (NLOS) problem is the main challenge to WSN localization, which seriously reduces the positioning accuracy. In this paper, a robust localization algorithm based on NLOS identification and classification filtering for WSN is proposed to solve this problem. It is difficult to use a single filter to filter out NLOS noise in all cases since NLOS cases are extremely complicated in real scenarios. Therefore, in order to improve the robustness, we first propose a NLOS identification strategy to detect the severity of NLOS, and then NLOS situations are divided into two categories according to the severity: mild NLOS and severe NLOS. Secondly, classification filtering is performed to obtain respective position estimates. An extended Kalman filter is applied to filter line-of-sight (LOS) noise. For mild NLOS, the large outliers are clipped by the redescending score function in the robust extended Kalman filter, yielding superior performance. For severe NLOS, a severe NLOS mitigation algorithm based on LOS reconstruction is proposed, in which the average value of NLOS error is estimated and the measurements are reconstructed and corrected for subsequent positioning. Finally, an interactive multiple model algorithm is employed to obtain the final positioning result by weighting the position estimation of LOS and NLOS. Simulation and experimental results show that the proposed algorithm can effectively suppress NLOS error and obtain higher positioning accuracy when compared with existing algorithms. [ABSTRACT FROM AUTHOR]

This paper presents a novel Kalman filter (KF)-based receiver autonomous integrity monitoring (RAIM) algorithm for reliable aircraft positioning with global navigation satellite systems (GNSS). The presented method overcomes major limitations of the authors' previous work, and uses two GNSS, namely, Navigation with Indian Constellation (NavIC) of India and the Global Positioning System (GPS). The algorithm is developed in the range domain and compared with two existing approaches—one each for the weighted least squares navigation filter and KF. Extensive simulations were carried out for an unmanned aircraft flight path over the Indian sub-continent for validation of the new approach. Although both existing methods outperform the new one, the work is significant for the following reasons. KF is an integral part of advanced navigation systems that can address frequent loss of GNSS signals (e.g., vector tracking and multi-sensor integration). Developing KF RAIM algorithms is essential to ensuring their reliability. KF solution separation (or position domain) RAIM offers good performance at the cost of high computational load. Presented range domain KF RAIM, on the other hand, offers satisfactory performance to a certain extent, eliminating a major issue of growing position error bounds over time. It requires moderate computational resources, and hence, shows promise for real-time implementations in avionics. Simulation results also indicate that addition of NavIC alongside GPS can substantially improve RAIM performance, particularly in poor geometries. [ABSTRACT FROM AUTHOR]

We present a novel hybrid localization algorithm for wireless sensor networks in the absence of knowledge regarding the transmit power and path-loss exponent. Transmit power and the path-loss exponent are critical parameters for target localization algorithms in wireless sensor networks, which help extract target position information from the received signal strength. In the absence of information on transmit power and path-loss exponent, it is critical to estimate them for reliable deployment of conventional target localization algorithms. In this paper, we propose a simultaneous estimation of transmit power and path-loss exponent based on Kalman filter. The unknown transmit power and path-loss exponent are estimated using a Kalman filter with the tentatively estimated target position based solely on angle information. Subsequently, the target position is refined using a hybrid method incorporating received signal strength measurements based on the estimated transmit power and path-loss exponent. Our proposed algorithm accurately estimates transmit power and path-loss exponent and yields almost the same target position accuracy as the simulation results confirm, as the hybrid target localization algorithms with known transmit power and path-loss exponent. Simulation results confirm the proposed algorithm achieves 99.7% accuracy of the target localization performance with known transmit power and path-loss exponent, even in the presence of severe received signal strength measurement noise. [ABSTRACT FROM AUTHOR]

Human body motion tracking is a key technique in robotics, virtual reality and other human–computer interaction fields. This paper proposes a novel simple-structure Kalman filter to improve the accuracy of human body motion tracking, named the Second EStimator of the Optimal Quaternion Kalman Filter (E2QKF). The new algorithm is the combination of the Second Estimator of the Optimal Quaternion (ESOQ-2) algorithm, the linear Kalman filter and the joint angle constraint method. In the proposed filter, the ESOQ-2 algorithm is used to produce an observation quaternion by preprocessing accelerometer and magnetometer measurements. The compensation for the accelerometer added in the ESOQ-2 algorithm is to eliminate the influence of human body motion acceleration included in the results. The state vector of the filter is the quaternion, which is calculated with gyroscope measurements, and the Kalman filter is to calculate the optimal quaternion by fusing the state quaternion and the observation quaternion. Therefore, the filter becomes a simple first-order linear system model, which avoids the linearization error of measurement equations and reduces the computational complexity. Furthermore, the joint angle constraint is considered in the proposed algorithm, which makes the results more accurate. To verify the accuracy of the proposed algorithm, inertial/magnetic sensors are used to perform the upper limb motion experiment, and the result of E2QKF (without joint angle constraint) is compared with an optical motion capture system and two traditional methods. Test results demonstrate the effectiveness of the proposed filter: the root mean square error (RMSE) of E2QKF is less than 2.0° and the maximum error is less than 4.6°. The result of E2QKF (with joint angle constraint) is compared with E2QKF (without joint angle constraint). Test results demonstrate the superiority of E2QKF (with joint angle constraint): the joint angle constraint method can further improve the accuracy of human body motion tracking. [ABSTRACT FROM AUTHOR]

A Multi-Constellation Software-Defined Receiver (MC-SDR) is designed and implemented to extract the Doppler measurements of Low Earth Orbit (LEO) satellite's downlink signals, such as Orbcomm, Iridium-Next, Globalstar, Starlink, OneWeb, SpaceX, etc. The Doppler positioning methods, as one of the main localization algorithms, need a highly accurate receiver design to track the Doppler as a measurement for Extended Kalman Filter (EKF)-based positioning. In this paper, the designed receiver has been used to acquire and track the Doppler shifts of two different kinds of LEO constellations. The extracted Doppler shifts of one Iridium-Next satellite as a burst-based simplex downlink signal and two Orbcomm satellites as continuous signals are considered. Also, with having the Two-Line Element (TLE) for each satellite, the position, and orbital elements of each satellite are known. Finally, the accuracy of the designed receiver is validated using an EKF-based stationary positioning algorithm with an adaptive measurement matrix. Satellite detection and Doppler tracking results are analyzed for each satellite. The positioning results for a stationary receiver showed an accuracy of about 132 m, which means 72% accuracy advancements compared to single constellation positioning. [ABSTRACT FROM AUTHOR]

Ultra-Wide-Band (UWB) positioning systems are now a real option to estimate the position of generic agents (e.g., robots) within indoor/GPS-denied environments. However, these environments can comprise metallic structures or other elements which can negatively affect the signal transmission and hence the accuracy of UWB-based position estimations. Regarding this fact, this paper proposes a novel method based on point-to-sphere ICP (Iterative Closest Point) to determine the 3D position of a UWB tag. In order to improve the results in noise-prone environments, our method first selects the anchors' subset which provides the position estimate with least uncertainty (i.e., largest agreement) in our approach. Furthermore, we propose a previous stage to filter the anchor-tag distances used as input of the ICP stage. We also consider the addition of a final step based on non-linear Kalman Filtering to improve the position estimates. Performance results for several configurations of our approach are reported in the experimental results section, including a comparison with the performance of other position-estimation algorithms based on trilateration. The experimental evaluation under laboratory conditions and inside the cargo hold of a vessel (i.e., a noise-prone scenario) proves the good performance of the ICP-based algorithm, as well as the effects induced by the prior and posterior filtering stages. [ABSTRACT FROM AUTHOR]

This paper presents a novel approach for hand-held low-cost MEMS (micro-electro-mechanical system) gyroscope in-self calibration. This method does not need the support of external high-precision equipment compared with traditional calibration scheme and can be accomplished by user hand rotation. In this approach, Kalman filter is designed to perform the calibration procedure and estimate gyroscope bias error, scale factor error and non-orthogonal error. The system observability is analyzed and the dynamic rotating conditions under which the sensor errors become observable are derived. The design principles of optimal calibration procedure are provided as well. Both simulated and practical experiments are carried out to test the validation of the proposed calibration algorithm. The achieved results demonstrate that the introduced approach can provide promising calibration scheme for the low-cost MEMS gyroscope. [ABSTRACT FROM AUTHOR]

Accurate detection of locations of indoor high-density crowds is crucial for early warning and emergency rescue during indoor safety accidents. The spatial structure of indoor environments is more complicated than outdoor environments. The locations of indoor high-density crowds are more likely to be the sites of security accidents. Existing detection methods for high-density crowd locations mostly focus on outdoor environments, and relatively few detection methods exist for indoor environments. This study proposes a novel detection framework for high-density indoor crowd locations termed IndoorSRC (Simplification–Reconstruction–Cluster). In this paper, a novel indoor spatiotemporal clustering algorithm called Indoor-STAGNES is proposed to detect the indoor trajectory stay points to simplify indoor movement trajectory. Then, we propose use of a Kalman filter algorithm to reconstruct the indoor trajectory and properly align and resample the data. Finally, an indoor spatiotemporal density clustering algorithm called Indoor-STOPTICS is proposed to detect the locations of high-density crowds in the indoor environment from the reconstructed trajectory. Extensive experiments were conducted using indoor Wi-Fi positioning datasets collected from a shopping mall. The results show that the IndoorSRC framework evidently outperforms the existing baseline method in terms of detection performance. [ABSTRACT FROM AUTHOR]

Aiming at the problems of substantial pressure loss, small range ratio and contact measurement in traditional gas flowmeters, this paper designs a new type of data-filtering ultrasonic gas flowmeter. The flowmeter is composed of hardware circuits such as STM32F407 (ARM Cortex 32-bit microcontroller) main control chip and high-precision timing chip TDC-GP22 (time to digital converter). The software uses a new data-filtering algorithm combining Kalman filtering algorithm and arithmetic average algorithm to improve the measurement accuracy of ultrasonic gas flowmeter. Through experimental comparison, we find that the filtering algorithm effectively reduces the measurement error of the system. Within the flow range of 0.025–4 m3/h, the maximum relative error of the system measurement is 2.7404%, which meets the national standard for the measurement error of the 1.5-level instruments. Moreover, it reduces the zero-drift to about one half of the original, which significantly improves the stability of the system. The gas flowmeter has the characteristics of high accuracy, good stability, low power consumption, and the overall performance is significantly improved. [ABSTRACT FROM AUTHOR]

The fault detection and isolation are very important for the driving safety of autonomous vehicles. At present, scholars have conducted extensive research on model-based fault detection and isolation algorithms in vehicle systems, but few of them have been applied for path tracking control. This paper determines the conditions for model establishment of a single-track 3-DOF vehicle dynamics model and then performs Taylor expansion for modeling linearization. On the basis of that, a novel fault-tolerant model predictive control algorithm (FTMPC) is proposed for robust path tracking control of autonomous vehicle. First, the linear time-varying model predictive control algorithm for lateral motion control of vehicle is designed by constructing the objective function and considering the front wheel declination and dynamic constraint of tire cornering. Then, the motion state information obtained by multi-sensory perception systems of vision, GPS, and LIDAR is fused by using an improved weighted fusion algorithm based on the output error variance. A novel fault signal detection algorithm based on Kalman filtering and Chi-square detector is also designed in our work. The output of the fault signal detector is a fault detection matrix. Finally, the fault signals are isolated by multiplication of signal matrix, fault detection matrix, and weight matrix in the process of data fusion. The effectiveness of the proposed method is validated with simulation experiment of lane changing path tracking control. The comparative analysis of simulation results shows that the proposed method can achieve the expected fault-tolerant performance and much better path tracking control performance in case of sensor failure. [ABSTRACT FROM AUTHOR]

More accurate navigation systems are always required for autonomous unmanned underwater vehicles (AUUV)s under various circumstances. In this paper, a measuring complex of a heavy unmanned underwater vehicle (UUV) was investigated. The measuring complex consists of an inertial navigation platform system, a Doppler lag (DL) and an estimation algorithm. During a relatively long-term voyage of an UUV without surfacing and correction from buoys and stationary stations, errors of the measuring complex will increase over time. The increase in errors is caused by an increase in the deviation angles of the gyro platform relative to the accompanying trihedron of the selected coordinate system. To reduce these angles, correction is used in the structure of the inertial navigation system (INS) using a linear regulator. To increase accuracy, it is proposed to take into account the nonlinear features of INS errors; an adaptive nonlinear Kalman filter and a nonlinear controller were used in the correction scheme. Considering that, a modified nonlinear Kalman filter and a regulator in the measuring complex are proposed to improve the accuracy of the measurement information, and modification of the nonlinear Kalman filter was performed through a genetic algorithm, in which the regulator was developed by the State Dependent Coefficient (SDC) method of the formulated model. Modeling combined with a semi-natural experiment with a real inertial navigation system for the UUV demonstrated the efficiency and effectiveness of the proposed algorithms. [ABSTRACT FROM AUTHOR]

Microsoft Kinect, a low-cost motion capture device, has huge potential in applications that require machine vision, such as human-robot interactions, home-based rehabilitation and clinical assessments. The Kinect sensor can track 25 key three-dimensional (3D) "skeleton" joints on the human body at 30 frames per second, and the skeleton data often have acceptable accuracy. However, the skeleton data obtained from the sensor sometimes exhibit a high level of jitter due to noise and estimation error. This jitter is worse when there is occlusion or a subject moves slightly out of the field of view of the sensor for a short period of time. Therefore, this paper proposed a novel approach to simultaneously handle the noise and error in the skeleton data derived from Kinect. Initially, we adopted classification processing to divide the skeleton data into noise data and erroneous data. Furthermore, we used a Kalman filter to smooth the noise data and correct erroneous data. We performed an occlusion experiment to prove the effectiveness of our algorithm. The proposed method outperforms existing techniques, such as the moving mean filter and traditional Kalman filter. The experimental results show an improvement of accuracy of at least 58.7%, 47.5% and 22.5% compared to the original Kinect data, moving mean filter and traditional Kalman filter, respectively. Our method provides a new perspective for Kinect data processing and a solid data foundation for subsequent research that utilizes Kinect. [ABSTRACT FROM AUTHOR]

This paper presents new algorithmic methods for accuracy improvement of autonomous inertial navigation systems of aircrafts. Firstly, an inertial navigation system platform and its nonlinear error model are considered, and the correction schemes are presented for autonomous inertial navigation systems using internal information. Next, a correction algorithm is proposed based on signals from precession angle sensors. A vector of reduced measurements for the estimation algorithm is formulated using the information about the angles of precession. Finally, the accuracy of the developed correction algorithms for autonomous inertial navigation systems of aircrafts is studied. Numerical solutions for the correction algorithm are presented by the adaptive Kalman filter for the measurement data from the sensors. Real data of navigation system Ts-060K are obtained in laboratory experiments, which validates the proposed algorithms. [ABSTRACT FROM AUTHOR]

Recently, the integration of an inertial navigation system (INS) and the Global Positioning System (GPS) with a two-antenna GPS receiver has been suggested to improve the stability and accuracy in harsh environments. As is well known, the statistics of state process noise and measurement noise are critical factors to avoid numerical problems and obtain stable and accurate estimates. In this paper, a modified extended Kalman filter (EKF) is proposed by properly adapting the statistics of state process and observation noises through the innovation-based adaptive estimation (IAE) method. The impact of innovation perturbation produced by measurement outliers is found to account for positive feedback and numerical issues. Measurement noise covariance is updated based on a remodification algorithm according to measurement reliability specifications. An experimental field test was performed to demonstrate the robustness of the proposed state estimation method against dynamic model errors and measurement outliers. [ABSTRACT FROM AUTHOR]

Rigid body orientation determined by IMU (Inertial Measurement Unit) is widely applied in robotics, navigation, rehabilitation, and human-computer interaction. In this paper, aiming at dynamically fusing quaternions computed from angular rate integration and FQA algorithm, a quaternion-based complementary filter algorithm is proposed to support a computationally efficient, wearable motion-tracking system. Firstly, a gradient descent method is used to determine a function from several sample points. Secondly, this function is used to dynamically estimate the fusion coefficient based on the deviation between measured magnetic field, gravity vectors and their references in Earth-fixed frame. Thirdly, a test machine is designed to evaluate the performance of designed filter. Experimental results validate the filter design and show its potential of real-time human motion tracking. [ABSTRACT FROM AUTHOR]

This paper presents a linear Kalman filter for yaw estimation of land vehicles using magnetic angular rate and gravity (MARG) sensors. A gyroscope measurement update depending on the vehicle status and constraining yaw estimation is introduced. To determine the vehicle status, the correlations between outputs from different sensors are analyzed based on the vehicle kinematic model and Coriolis theorem, and a vehicle status marker is constructed. In addition, a two-step measurement update method is designed. The method treats the magnetometer measurement update separately after the other updates and eliminates its impact on attitude estimation. The performances of the proposed algorithm are tested in experiments and the results show that: the introduced measurement update is an effective supplement to the magnetometer measurement update in magnetically disturbed environments; the two-step measurement update method makes attitude estimation immune to errors induced by magnetometer measurement update, and the proposed algorithm provides more reliable yaw estimation for land vehicles than the conventional algorithm. [ABSTRACT FROM AUTHOR]

The conventional initial alignment algorithms are invalid in the polar region. This is caused by the rapid convergence of the Earth meridians in the high-latitude areas. However, the initial alignment algorithms are important for the accurate navigation of Unmanned Underwater Vehicles. The polar transversal initial alignment algorithm is proposed to overcome this problem. In the polar transversal initial alignment algorithm, the transversal geographic frame is chosen as the navigation frame. The polar region in the conventional frames is equivalent to the equatorial region in the transversal frames. Therefore, the polar transversal initial can be effectively applied in the polar region. According to the complex environment in the polar region, a large misalignment angle is considered in this paper. Based on the large misalignment angle condition, the non-linear dynamics models are established. In addition, the simplified unscented Kalman filter (UKF) is chosen to realize the data fusion. Two comparison simulations and an experiment are performed to verify the performance of the proposed algorithm. The simulation and experiment results indicate the validity of the proposed algorithm, especially when large misalignment angles occur. [ABSTRACT FROM AUTHOR]

In recent years, the rapid development of microelectronics, wireless communications, and electro-mechanical systems has occurred. The wireless sensor network (WSN) has been widely used in many applications. The localization of a mobile node is one of the key technologies for WSN. Among the factors that would affect the accuracy of mobile localization, non-line of sight (NLOS) propagation caused by a complicated environment plays a vital role. In this paper, we present a hierarchical voting based mixed filter (HVMF) localization method for a mobile node in a mixed line of sight (LOS) and NLOS environment. We firstly propose a condition detection and distance correction algorithm based on hierarchical voting. Then, a mixed square root unscented Kalman filter (SRUKF) and a particle filter (PF) are used to filter the larger measurement error. Finally, the filtered results are subjected to convex optimization and the maximum likelihood estimation to estimate the position of the mobile node. The proposed method does not require prior information about the statistical properties of the NLOS errors and operates in a 2D scenario. It can be applied to time of arrival (TOA), time difference of arrival (TDOA), received signal (RSS), and other measurement methods. The simulation results show that the HVMF algorithm can efficiently reduce the effect of NLOS errors and can achieve higher localization accuracy than the Kalman filter and PF. The proposed algorithm is robust to the NLOS errors. [ABSTRACT FROM AUTHOR]

Recent developments in localisation systems for autonomous robotic technology have been a driving factor in the deployment of robots in a wide variety of environments. Estimating sensor measurement noise is an essential factor when producing uncertainty models for state-of-the-art robotic positioning systems. In this paper, a surveying grade optical instrument in the form of a Trimble S7 Robotic Total Station is utilised to dynamically characterise the error of positioning sensors of a ground based unmanned robot. The error characteristics are used as inputs into the construction of a Localisation Extended Kalman Filter which fuses Pozyx Ultra-wideband range measurements with odometry to obtain an optimal position estimation, all whilst using the path generated from the remote tracking feature of the Robotic Total Station as a ground truth metric. Experiments show that the proposed method yields an improved positional estimation compared to the Pozyx systems’ native firmware algorithm as well as producing a smoother trajectory. [ABSTRACT FROM AUTHOR]