Intelligent fault-tolerant algorithm with two-stage and feedback for integrated navigation federated filtering

In order to take full advantage of federated filter in fault-tolerant design of integrated navigation system, the limitation of fault detection algorithm for gradual changing fault detection and the poor fault tolerance of global optimal fusion algorithm are the key problems to deal with. Based on theoretical analysis of the influencing factors of federated filtering fault tolerance, global fault-tolerant fusion algorithm and information sharing algorithm are proposed based on fuzzy assessment. It achieves intelligent fault-tolerant structure with two-stage and feedback, including real-time fault detection in sub-filters, and fault-tolerant fusion and information sharing in main filter. The simulation results demonstrate that the algorithm can effectively improve fault-tolerant ability and ensure relatively high positioning precision of integrated navigation system when a subsystem having gradual changing fault.

Multi-sensor federated unscented Kalman filtering algorithm in intermittent observations

Aiming at the adverse effect caused by limited detecting probability of sensors on filtering preci- sion of a nonlinear system state, a novel muhi-sensor federated unscented Kalman filtering algorithm is proposed. Firstly, combined with the residual detection strategy, effective observations are cor- rectly identified. Secondly, according to the missing characteristic of observations and the structural feature of unscented Kalman filter, the iterative process of the single-sensor unscented Kalman filter in intermittent observations is given. The key idea is that the state estimation and its error covariance matrix are replaced by the state one-step prediction and its error covariance matrix, when the phe- nomenon of observations missing occurs. Finally, based on the realization mechanism of federated filter, a new fusion framework of state estimation from each local node is designed. And the filtering precision of system state is improved further by the effective management of observations missing and the rational utilization of redundancy and complementary information among multi-sensor observa- tions. The theory analysis and simulation results show the feasibility and effectiveness of the pro- posed algorithm.

Federated UKF algorithm for mobile location estimation with TDOA/Doppler measurements

In order to enhance the location estimation performance of mobile station（MS）tracking and positioning, a new method of mobile location optimal estimation based on the federated filtering structure and the simplified unscented Kalman filter （UKF） is presented. The proposed algorithm uses the Singer mobile statement model as the reference system, and the simplified UKF as the subfilters. The subfilters receive the two groups of independently detected time difference of arrival （TDOA） measurement inputs and Doppler measurement inputs, and produce local estimation outputs to the main estimator. Then the main estimator performs the optimal fusion of the local estimation outputs according to the scalar weighted rule, and a global optimal or suboptimal estimation result is achieved. Finally the main estimator gives feedback and reset information to the subfilters and the reference system for next step estimation. In the simulations, the estimation performance of the proposed algorithm is evaluated and compared with the simplified UKF method with TDOA or Doppler measurement alone. The simulation results demonstrate that the proposed algorithm can effectively reduce the location estimation error and variance of the MS, and has favorable performance in both root mean square error（RMSE） and mean error cumulative distribution function（CDF）.

Pulsar/CNS integrated navigation based on federated UKF

In order to improve the autonomous navigation capability of satellite,a pulsar/CNS（celestial navigation system） integrated navigation method based on federated unscented Kalman filter（UKF） is proposed.The celestial navigation is a mature and stable navigation method.However,its position determination performance is not satisfied due to the low accuracy of horizon sensor.Single pulsar navigation is a new navigation method,which can provide highly accurate range measurements.The major drawback of single pulsar navigation is that the system is completely unobservable.As two methods are complementary to each other,the federated UKF is used here for fusing the navigation data from single pulsar navigation and CNS.Compared to the traditional celestial navigation method and single pulsar navigation,the integrated navigation method can provide better navigation performance.The simulation results demonstrate the feasibility and effectiveness of the navigation method.

Adaptive Federal Kalman Filtering for SINS/GPS Integrated System

A new adaptive federal Kalman filter for a strapdown integrated navigation system/global positioning system (SINS/GPS) is given. The developed federal Kalman filter is based on the trace operation of parameters estimation's error covariance matrix and the spectral radius of update measurement noise variance-covariance matrix for the proper choice of the filter weight and hence the filter gain factors. Theoretical analysis and results from simulation in which the SINS/GPS was compared to conventional Kalman filter are presented. Results show that the algorithm of this adaptive federal Kalman filter is simpler than that of the conventional one. Furthermore, it outperforms the conventional Kalman filter when the system is undertaken measurement malfunctions because of its possession of adaptive ability. This filter can be used in the vehicle integrated navigation system.

SINS/CNS/GPS integrated navigation algorithm based on UKF

A new nonlinear algorithm is proposed for strapdown inertial navigation system （SINS）/celestial navigation system （CNS）/global positioning system （GPS） integrated navigation systems. The algorithm employs a nonlinear system error model which can be modified by unscented Kalman filter （UKF） to give predictions of local filters. And these predictions can be fused by the federated Kalman filter. In the system error model, the rotation vector is introduced to denote vehicle＇s attitude and has less variables than the quaternion. Also, the UKF method is simplified to estimate the system error model, which can both lead to less calculation and reduce algorithm implement time. In the information fusion section, a modified federated Kalman filter is proposed to solve the singular covariance problem. Specifically, the new algorithm is applied to maneuvering vehicles, and simulation results show that this algorithm is more accurate than the linear integrated navigation algorithm.

Data Fusion in Distributed Multi-sensor System

This paper presents a data fusion method in distributed multi-sensor system including GPS and INS sensors’ data processing. First, a residual χ 2 \|test strategy with the corresponding algorithm is designed. Then a coefficient matrices calculation method of the information sharing principle is derived. Finally, the federated Kalman filter is used to combine these independent, parallel, real\|time data. A pseudolite (PL) simulation example is given.

Information fusion of train speed and distance measurements based on fuzzy adaptive Kalman filter algorithm

The measurement accuracy of speed and distance in high speed train directly affects the control precision and driving efficiency of train control system. To improve the capability of train self control, a combined speed measurement and positioning method based on speed sensor and radar which is assisted by global positioning system（GPS） is proposed to improve the accuracy of measurement and reduce the dependence on the ground equipment. In consideration of the fact that the filtering precision of Kalman filter will decrease when the statistical characteristics are changing, this paper uses fuzzy comprehensive evaluation method to evaluate the sub filter, and information distribution coefficients are dynamically adjusted according to filtering reliability, which can improve the fusion accuracy and fault tolerance of the system. The sub filter is required to carry on the covariance shaping adaptive filtering when it is in the suboptimal state. The adjustment factor of error covariance is obtained according to the minimized cost function, which can improve the matching degree between the measured residual variance and the system recursive residual. The simulation results show that the improved filter algorithm can track the changes of the system effectively, enhance the filtering accuracy significantly, and improve the measurement accuracies of train speed and distance.

Federal extended Kalman filter based on reconstructed observation in incomplete observations

In the estimation and identification of nonlinear system state,aiming at the adverse effect of observation missing randomly caused by detection probability of used sensor which is less than 1,a novel federal extended Kalman filter( FEKF) based on reconstructed observation in incomplete observations( ROIO) is proposed in this paper. On the basis of multi-sensor observation sets,the observation is exchanged at different times to construct a new observation set. Based on each observation set,an extended Kalman filter algorithm is used to estimate the state of the target,and then the federal filtering algorithm is used to solve the state estimation based on the multi-sensor observation data. The effect of the sensor probing probability on the filtering result and the effect of the number of sensors on the filtering result are obtained by the simulation experiment,respectively. The simulation results demonstrate effectiveness of the proposed algorithm.

Node coordination mechanism based on distributed estimation and control in wireless sensor and actuator networks

Wireless sensor and actuator networks （WSANs） have a wide range of applications. To perform effective sensing and acting tasks, multiple coordination mechanisms among the nodes are required. As attempt in this direction, this paper describes collaborative estimation and control algorithms design for WSANs. First, a sensor-actuator coordination model is proposed based on distributed Kalman filter in federated configuration. This method provides the capability of fault tolerance and multi-source information fusion. On this basis, an actuator-actuator coordination model based on even-driven task allocation is introduced. Actuators utilize fused sensory information to adjust their action that incur the minimum energy cost to the system subject to the constraints that user＇s preferences regarding the states of the system are approximately satisfied. Finally, according to system requirements, a distributed algorithm is proposed to solve the task allocation problem. Simulations demonstrate the effectiveness of our proposed methods.