Improved Adaptive Iterated Extended Kalman Filter for GNSS/INS/UWB-Integrated Fixed-Point Positioning

To provide stable and accurate position information of control points in a complex coastal environment,an adaptive iterated extended Kalman filter(AIEKF)for fixed-point positioning integrating global navigation satellite system,inertial navigation system,and ultra wide band(UWB)is proposed.In thismethod,the switched global navigation satellite system(GNSS)and UWB measurement are used as the measurement of the proposed filter.For the data fusion filter,the expectation-maximization(EM)based IEKF is used as the forward filter,then,the Rauch-Tung-Striebel smoother for IEKF filter’s result smoothing.Tests illustrate that the proposed AIEKF is able to provide an accurate estimation.

Orbit determination and thrust force modeling for a maneuvered GEO satellite using two-way adaptive Kalman filtering

A two-way adaptive Kalman filter is proposed by combining a two-way filter with an adaptive filter for orbit determination of a maneuvered GEO satellite.A method of using Newton's high-resolution differential formula and polynomial fitting for modeling the thrust force of a maneuvered GEO satellite is developed.The adaptive factor,which balances the contributions of the measurements and the dynamic model information,is determined by using a two-segment function and predicted residual statistics.Simulations with a maneuvered GEO satellite tracked by the Chinese ground tracking network were conducted to verify the performance of the proposed orbit determination technique and the method of thrust force modeling.The results show that refining the thrust force model is beneficial for the orbit determination of a maneuvered GEO satellite;the two-way adaptive Kalman filter can efficiently control the influence of the dynamic model errors on the orbit state estimate.

Application of adaptive Kalman filter in rocket impact point estimation

In order to measure the parameters of flight rocket by using radar,rocket impact point was estimated accurately for rocket trajectory correction.The Kalman filter with adaptive filter gain matrix was adopted.According to the particle trajectory model,the adaptive Kalman filter trajectory model was constructed for removing and filtering the outliers of the parameters during a section of flight detected by three-dimensional data radar and the rocket impact point was extrapolated.The results of numerical simulation show that the outliers and noise in trajectory measurement signal can be removed effectively by using the adaptive Kalman filter and the filter variance can converge in a short period of time.Based on the relation of filtering time and impact point estimation error,choosing the filtering time of 8-10 scan get the minimum estimation error of impact point.

IAE-adaptive Kalman filter for INS/GPS integrated navigation system

A marine INS/GPS adaptive navigation system is presented. GPS with two antenna providing vessel＇ s altitude is selected as the auxiliary system fusing with INS to improve the performance of the hybrid system. The Kalman filter is the most frequently used algorithm in the integrated navigation system, which is capable of estimating INS errors online based on the measured errors between INS and GPS. The standard Kalman filter （SKF） assumes that the statistics of the noise on each sensor are given. As long as the noise distributions do not change, the Kalman filter will give the optimal estimation. However GPS receiver will be disturbed easily and thus temporally changing measurement noise will join into the outputs of GPS, which will lead to performance degradation of the Kalman filter. Many researchers introduce fuzzy logic control method into innovation-based adaptive estimation adaptive Kalman filtering （IAE-AKF） algorithm, and accordingly propose various adaptive Kalman filters. However how to design the fuzzy logic controller is a very complicated problem still without a convincing solution. A novel IAE-AKF is proposed herein, which is based on the maximum likelihood criterion for the proper computation of the filter innovation covariance and hence of the filter gain. The approach is direct and simple without having to establish fuzzy inference rules. After having deduced the proposed IAEAKF algorithm theoretically in detail, the approach is tested by the simulation based on the system error model of the developed INS/GPS integrated marine navigation system. Simulation results show that the adaptive Kalman filter outperforms the SKF with higher accuracy, robustness and less computation. It is demonstra- ted that this proposed approach is a valid solution for the unknown changing measurement noise exited in the Kalman filter.

Navigation system of a class of underwater vehicle based on adaptive unscented Kalman fiter algorithm

Inherent flaws in the extended Kalman filter(EKF) algorithm were pointed out and unscented Kalman filter(UKF) was put forward as an alternative.Furthermore,a novel adaptive unscented Kalman filter(AUKF) based on innovation was developed.The three data-fusing approaches were analyzed and evaluated in a mathematically rigorous way.Field experiments conducted in lake further demonstrate that AUKF reduces the position error approximately by 65% compared with EKF and by 35% UKF and improves the robust performance.

Fuzzy adaptive Kalman filter for indoor mobile target positioning with INS/WSN integrated method

Pure inertial navigation system(INS) has divergent localization errors after a long time. In order to compensate the disadvantage, wireless sensor network(WSN) associated with the INS was applied to estimate the mobile target positioning. Taking traditional Kalman filter(KF) as the framework, the system equation of KF was established by the INS and the observation equation of position errors was built by the WSN. Meanwhile, the observation equation of velocity errors was established by the velocity difference between the INS and WSN, then the covariance matrix of Kalman filter measurement noise was adjusted with fuzzy inference system(FIS), and the fuzzy adaptive Kalman filter(FAKF) based on the INS/WSN was proposed. The simulation results show that the FAKF method has better accuracy and robustness than KF and EKF methods and shows good adaptive capacity with time-varying system noise. Finally, experimental results further prove that FAKF has the fast convergence error, in comparison with KF and EKF methods.

Continuous rotation north-finding algorithm based on constrained adaptive Kalman filter

As an orientation measurement system,north-finder has been playing a significant role in both military and civilian fields of orientation and control.In this paper,to deal with drawbacks in the conventional north-finding systems,a dynamic strategy based on continuous rotation modulation to measure the rotational angular velocity of the earth is proposed.By modeling the dynamic error,optimizing the process constraint and estimating dynamic noise,a method combining delay compensation and hardware adjustment,and a constrained adaptive Kalman filter(CAKF)algorithm are designed for the north-finding strategy.According to simulation and experiments,the proposed algorithm can achieve the high-precision north-finding with robust and anti-noise performance.

Adaptive Kalman Filter of Transfer Alignment with Un-modeled Wing Flexure of Aircraft

The alignment accuracy of the strap-down inertial navigation system （SINS） of airborne weapon is greatly degraded by the dynamic wing flexure of the aircraft. An adaptive Kalman filter uses innovation sequences based on the maximum likelihood estimated criterion to adapt the system noise covariance matrix and the measurement noise covariance matrix on line, which is used to estimate the misalignment if the model of wing flexure of the aircraft is unknown. From a number of simulations, it is shown that the accuracy of the adaptive Kalman filter is better than the conventional Kalman filter, and the erroneous misalignment models of the wing flexure of aircraft will cause bad estimation results of Kalman filter using attitude match method.

Vertical Tire Forces Estimation of Multi-Axle Trucks Based on an Adaptive Treble Extend Kalman Filter

Vertical tire forces are essential for vehicle modelling and dynamic control.However,an evaluation of the vertical tire forces on a multi-axle truck is difficult to accomplish.The current methods require a large amount of experimental data and many sensors owing to the wide variation of the parameters and the over-constraint.To simplify the design process and reduce the demand of the sensors,this paper presents a practical approach to estimating the vertical tire forces of a multi-axle truck for dynamic control.The estimation system is based on a novel vertical force model and a proposed adaptive treble extend Kalman filter(ATEKF).To adapt to the widely varying parameters,a sliding mode update is designed to make the ATEKF adaptive,and together with the use of an initial setting update and a vertical tire force adjustment,the overall system becomes more robust.In particular,the model aims to eliminate the effects of the over-constraint and the uneven weight distribution.The results show that the ATEKF method achieves an excellent performance in a vertical force evaluation,and its performance is better than that of the treble extend Kalman filter.

Multi-sensor Hybrid Fusion Algorithm Based on Adaptive Square-root Cubature Kalman Filter

In the normal operation condition, a conventional square-root cubature Kalman filter （SRCKF） gives sufficiently good estimation results. However, if the measurements are not reliable, the SRCKF may give inaccurate results and diverges by time. This study introduces an adaptive SRCKF algorithm with the filter gain correction for the case of measurement malfunctions. By proposing a switching criterion, an optimal filter is selected from the adaptive and conventional SRCKF according to the measurement quality. A subsystem soft fault detection algorithm is built with the filter residual. Utilizing a clear subsystem fault coefficient, the faulty subsystem is isolated as a result of the system reconstruction. In order to improve the performance of the multi-sensor system, a hybrid fusion algorithm is presented based on the adaptive SRCKF. The state and error covariance matrix are also predicted by the priori fusion estimates, and are updated by the predicted and estimated information of subsystems. The proposed algorithms were applied to the vessel dynamic positioning system simulation. They were compared with normal SRCKF and local estimation weighted fusion algorithm. The simulation results show that the presented adaptive SRCKF improves the robustness of subsystem filtering, and the hybrid fusion algorithm has the better performance. The simulation verifies the effectiveness of the proposed algorithms.

Dynamic load-altering attack detection based on adaptive fading Kalman filter in power systems

This paper presents an effective and feasible method for detecting dynamic load-altering attacks(D-LAAs)in a smart grid.First,a smart grid discrete system model is established in view of D-LAAs.Second,an adaptive fading Kalman filter(AFKF)is designed for estimating the state of the smart grid.The AFKF can completely filter out the Gaussian noise of the power system,and obtain a more accurate state change curve(including consideration of the attack).A Euclidean distance ratio detection algorithm based on the AFKF is proposed for detecting D-LAAs.Amplifying imperceptible D-LAAs through the new Euclidean distance ratio improves the D-LAA detection sensitivity,especially for very weak D-LAA attacks.Finally,the feasibility and effectiveness of the Euclidean distance ratio detection algorithm are verified based on simulations.

Lithium battery state of charge and state of health prediction based on fuzzy Kalman filtering

This paper presents a more accurate battery state of charge(SOC)and state of health(SOH)estimation method.A lithium battery is represented by a nonlinear two-order resistance-capacitance equivalent circuit model.The model parameters are estimated by searching least square error optimization algorithm.Precisely defined by this method,the model parameters allow to accurately determine the capacity of the battery,which in turn allows to specify the SOC prediction value used as a basis for the SOH value.Application of the extended Kalman filter(EKF)removes the need of prior known initial SOC,and applying the fuzzy logic helps to eliminate the measurement and process noise.Simulation results obtained during the urban dynamometer driving schedule(UDDS)test show that the maximum error in estimation of the battery SOC is 0.66%.Battery capacity is estimate by offline updated Kalman filter,and then SOH will be predicted.The maximum error in estimation of the battery capacity is 1.55%.

GPS Navigation Using Adaptive Kalman Filter for Maneuvering Vehicle

Several filter techniques were available for the GPS position estimation problem of maneuvering vehicle ranging from using different process noises to Interactive Multiple Model (IMM). The limitation of using standard Kalman filters is listed.The performance of proposed adaptive filter is compared with that of the standard ones,two types of dynamic modeling of the maneuvering vehicle are used.The simulation is based on the almanac data of the GPS satellites to compute its feasibility during the simulation time and position on shape 8 track with continuous vehicle maneuvering. The goal is to obtain computationally efficient filter with reasonable accuracy for vehicle in maneuvering situation. The filter proposed is an alternative to the filter proposed in Ref. [1] with low computational burden.

Adaptive Kalman filter based state of charge estimation algorithm for lithium-ion battery

In order to improve the accuracy of the battery state of charge（SOC） estimation, in this paper we take a lithiumion battery as an example to study the adaptive Kalman filter based SOC estimation algorithm. Firstly, the second-order battery system model is introduced. Meanwhile, the temperature and charge rate are introduced into the model. Then, the temperature and the charge rate are adopted to estimate the battery SOC, with the help of the parameters of an adaptive Kalman filter based estimation algorithm model. Afterwards, it is verified by the numerical simulation that in the ideal case, the accuracy of SOC estimation can be enhanced by adding two elements, namely, the temperature and charge rate.Finally, the actual road conditions are simulated with ADVISOR, and the simulation results show that the proposed method improves the accuracy of battery SOC estimation under actual road conditions. Thus, its application scope in engineering is greatly expanded.

Adaptive Maneuvering Frequency Method of Current Statistical Model

Current statistical model(CSM) has a good performance in maneuvering target tracking. However, the fixed maneuvering frequency will deteriorate the tracking results, such as a serious dynamic delay, a slowly converging speedy and a limited precision when using Kalman filter(KF) algorithm. In this study, a new current statistical model and a new Kalman filter are proposed to improve the performance of maneuvering target tracking. The new model which employs innovation dominated subjection function to adaptively adjust maneuvering frequency has a better performance in step maneuvering target tracking, while a fluctuant phenomenon appears. As far as this problem is concerned, a new adaptive fading Kalman filter is proposed as well. In the new Kalman filter, the prediction values are amended in time by setting judgment and amendment rules,so that tracking precision and fluctuant phenomenon of the new current statistical model are improved. The results of simulation indicate the effectiveness of the new algorithm and the practical guiding significance.

Non-linear Dynamics Method to Angles-Only Navigation for Non-cooperative Rendezvous of Spacecraft

Aiming at the problem of relative navigation for non-cooperative rendezvous of spacecraft,this paper proposes a new angles-only navigation architecture using non-linear dynamics method. This method does not solve the problem of poor observability of angles-only navigation through orbital or attitude maneuvering,but improves the observability of angles-only navigation through capturing the non-linearity of the system in the evolution of relative motion. First,three relative dynamics models and their corresponding line-of-sight(LoS)measurement equations are introduced,including the rectilinear state relative dynamics model,the curvilinear state relative dynamics model,and the relative orbital elements(ROE)state relative dynamics model. Then,an observability analysis theory based on the Gramian matrix is introduced to determine which relative dynamics model could maximize the observability of angles-only navigation. Next,an adaptive extended Kalman filtering scheme is proposed to solve the problem that the angles-only navigation filter using the non-linear dynamics method is sensitive to measurement noises. Finally,the performances of the proposed angles-only navigation architecture are tested by means of numerical simulations,which demonstrates that the angles-only navigation filtering scheme without orbital or attitude maneuvering is completely feasible through improving the modeling of the relative dynamics and LoS measurement equations.

Altitude information fusion method and experiment for UAV

Altitude regulation is a fundamental problem in UAV(unmanned aerial vehicles) control to ensure hovering and autonomous navigation performance.However,data from altitude sensors may be unstable by interference.A digital-filter-based improved adaptive Kalman method is proposed to improve accuracy and reliability of the altitude measurement information.A unique sensor data fusion structure is designed to make different sensors switch automatically in different environment.Simulation and experimental results show that an improved Sage-Husa adaptive extended Kalman filter(SHAEKF) is adopted in altitude data fusion which means that altitude error is limited to 1.5m in high altitude and 1.2m near the ground.This method is proved feasible and effective through hovering flight test and three-dimensional track flight experiment.

Adaptive Kalman filter and dynamic recurrent neural networks-based control design of macro-micro manipulator

In this paper, a composite control scheme for macro-micro dual-drive positioning stage with high accel- eration and high precision is proposed. The objective of control is to improve the precision by reducing the influence of system vibration and external noise. The positioning stage is composed of voice coil motor （VCM） as macro driver and piezoelectric actuator （PEA） as micro driver. The precision of the macro drive positioning stage is improved by the com- bined PID control with adaptive Kalman filter （AKF）. AKF is used to compensate VCM vibration （as the virtual noise） and the external noise. The control scheme of the micro drive positioning stage is presented as the integrated one with PID and intelligent adaptive inverse control approach to compensate the positioning error caused by macro drive positioning stage. A dynamic recurrent neural networks （DRNN） based inverse control approach is proposed to offset the hysteresis nonlinearity of PEA. Simulations show the positioning precision of macro-micro dual-drive stage is clearly improved via the proposed control scheme.

A Robust UWB Array Localization Scheme through Passive Anchor Assistance

Ultra-Wide Bandwidth(UWB)localization based on time of arrival(TOA)and angle of arrival(AOA)has attracted increasing interest owing to its high accuracy and low cost.However,existing localization methods often fail to achieve satisfactory accuracy in realistic environments due to multipath effects and non-line-of-sight(NLOS)propagation.In this paper,we propose a passive anchor assisted localization(PAAL)scheme,where the active anchor obtains TOA/AOA measurements to the agent while the passive anchors capture the signals from the active anchor and agent.The proposed method fully exploits the time-difference-of-arrival(TDOA)information from the measurements at the passive anchors to complement single-anchor joint TOA/AOA localization.The performance limits of the PAAL system are derived as a benchmark via the information inequality.Moreover,we implement the PAAL system on a low-cost UWB platform,which can achieve 20 cm localization accuracy in NLOS environments.

Vehicular Electronic Image Stabilization System Based on a Gasoline Model Car Platform

Noise,vibration and harshness(NVH)problems in vehicle engineering are always challenging in both traditional vehicles and intelligent vehicles.Although high accuracy manufacturing,modern structural roads and advanced suspension technology have already significantly reduced NVH problems and their impacts;off-road condition,obstacles and extreme operating condition could still trigger NVH problems unexpectedly.This paper proposes a vehicular electronic image stabilization(EIS)system to solve the vibration problem of the camera and ensure the environment perceptive function of vehicles.Firstly,feature point detection and matching based on an oriented FAST and rotated BRIEF(ORB)algorithm are implemented to match images in the process of EIS.Furthermore,a novel improved random sampling consensus algorithm(i-RANSAC)is proposed to eliminate mismatched feature points and increase the matching accuracy significantly.And an adaptive Kalman filter(AKF)is applied to improve the adaptability of the vehicular EIS.Finally,an experimental platform based on a gasoline model car was established to validate its performance.The experimental results show that the proposed EIS system can satisfy vehicular performance requirements even under off-road condition with obvious obstacles.