A cooperative integrity monitoring (CIM) algorithm is proposed in this work. Under the CIM architecture, the algorithm can fully exploit the global navigation satellite system (GNSS) data and inter-vehicle measurements data to improve the detection and isolation of faulty measurements due to multipath or non line of sight (NLOS). Taking the advantages of cooperative scheme, a residual decomposition method is used to model the measurement errors into common and specific parts, a greedy search strategy is used to exclude the faulty measurements based on its sub-statistics. Simulation results show that CIM has better detection of GNSS fault than traditional receiver autonomous integrity monitoring (RAIM). Also, CIM is capable of detecting the faulty outliers in inter-vehicle measurements. The results indicate that CIM can be applied to many existing multi-sensor cooperative positioning algorithms.

With the rapid development of smartphone technology, pedestrian navigation based on built-in inertial sensors in smartphones shows great application prospects. Currently, most smartphone-based pedestrian dead reckoning (PDR) algorithms normally require a user to hold the phone in a fixed mode and, thus, need to correct the gyroscope heading with inputs from other sensors, which restricts the viability of pedestrian navigation significantly. In this paper, in order to improve the accuracy of the traditional step detection and step length estimation method for different users, a state transition-based step detection method and a step length estimation method using a neural network are proposed. In order to decrease the heading errors and inertial sensor errors in multi-mode system, a multi-mode intelligent recognition method based on a neural network was constructed. On this basis, we propose a heading correction method based on zero angular velocity and an overall correction method based on lateral velocity limitation (LV). Experimental results show that the maximum positioning errors obtained by the proposed algorithm are about 0.9% of the total path length. The proposed novel PDR algorithm dramatically enhances the user experience and, thus, has high value in real applications.

This work proposes a new cooperative architecture that using Global Navigation Satellite System (GNSS), Inertial Measurement Unit (IMU) and vehicle-to-vehicle (V2V) observations to obtain robust and accurate inter-vehicle state estimation. A new cascade structure of relative filter which consists of float estimator and fixed estimator is presented that can take advantage of both the multi-sensor data and the information from Least-squares ambiguity decorrelation adjustment (LAMBDA). Also, a cooperative baseline estimation method based on multidimensional scaling (MDS) is proposed to further exploit the relative estimation from many other collaborators. Lastly, we combine the cascade relative filter (CRF) with MDS to estimate the relative states cooperatively using a feedback scheme. In the verification part, we use realistic sensor noise and a GNSS signal simulator to obtain inter-vehicle and GNSS measurements for a multiple-vehicle network. In a harsh GNSS scenario, only 51.20% of epochs in RTKLIB software can pass the LAMBDA acceptance test, but our proposed methods can achieve 77.85% (CRF) and 85.05% (CRF/MDS). Referring to the recovery time from a float solution to fixed solution, RTKLIB needs 179.23s in the case of 4 satellites, but only 34.88s (CRF) and 21.39s (CRF/MDS) for the proposed methods. Results show that the proposed CRF has good performance when fusing with IMU and V2V observations, and has a better performance than existing methods. Moreover, the proposed architecture that combines CRF and MDS can have a further improvement, which substantially increases the robustness and accuracy of relative state estimation.

This paper provides an adaptive hybrid robust filter (AHRF) for multi-sensor relative navigation systems that can be used to support cooperative intelligent transport systems. It is known that Huber’s M-estimation based robust filter and the fault detection and exclusion (FDE) based RAIM filter each has its own drawbacks, depending on the nature of the observation error biases. Based on the interactive multiple model (IMM) framework, our proposed AHRF in this paper can take advantage of both filters in a complementary sense. A new adaptive IMM (AIMM) algorithm with Markov transition probability prediction is proposed to allow AHRF to switch efficiently between the two filters. We consider the relative navigation system with Global Navigation Satellite System (GNSS) and ultra-wideband (UWB) as observations to verify AHRF in three cases of possible failure modes and multipath-induced errors. Our results show that AHRF outperforms both the FDE and robust filter in all cases. AHRF framework can be further adapted to include many other fault-tolerant filters to improve the robustness of multi-sensor relative navigation system even further.

Compared with simultaneous localization and mapping (SLAM) problems based on Lidar or visual sensors, range-only SLAM (RO-SLAM) is lacking bearing information. It brings challenges to particle sampling and SLAM estimation. This article proposes an efficient distributed particle filter (EDPF) for RO-SLAM problems. To overcome the difficulties of sampling in a high-dimensional state space, EDPF is decomposed into a set of subparticle filters (sub-PFs) with low dimensionality. Each sub-PF corresponds with an observed beacon, which directly reduces the sampling complexity. A joint weight update method is proposed to exploit the correlation among sub-PFs. It reweighs the particles via an auxiliary distribution after each sub-PF’s local filtering and embodies a better proposal distribution for distributed filtering. In addition, a beacon diagnosis method is proposed, it can detect and reinitialize the wrong converged beacon position estimates, which further reduces the SLAM error accumulation problem. We consider a RO-SLAM system with an odometer and ultrawideband (UWB) to verify the proposed EDPF. Results show that EDPF outperforms many existing RO-SLAM methods, which obtains the best performance with the acceptable computational load.

This paper presents a perception-aware path planner for active SLAM in dynamic environments using micro-aerial vehicles (MAV). The “Next-Best-View” planner (NBVP planner) is combined with an active loop closing, which is called the Active Loop Closing Planner (ALCP planner). The planner is proposed to avoid both static and dynamic obstacles in unknown environments while reducing the uncertainty of the SLAM system and further improving the accuracy of localization. First, the receding horizon strategy is adopted to find the next waypoint. The cost function that combines the exploration gain and the loop closing gain is designed. The former can reduce the mapping uncertainty, while the latter takes the loop closing possibility into consideration. Second, a key waypoint selection strategy is designed. The selected key waypoints, instead of all waypoints, are treated as potential loop-closing points to make the algorithm more efficient. Moreover, a fuzzy RRT-based dynamic obstacle avoidance algorithm is adopted to realize obstacle avoidance in dynamic environments. Simulations in different challenging scenarios are conducted to verify the effectiveness of the proposed algorithm.