Search Results (59)

Measurement outliers remain a major source of performance degradation in nonlinear bearings-only target tracking, where a few corrupted observations can produce large innovations and even trigger filter divergence. This paper proposes a non-iterative robust square-root cubature Kalman filter (RSCKF) for bearings-only tracking with measurement outliers. Motivated by a TLS-type errors-in-variables interpretation of the pseudo-linear bearings-only measurement model, robustness is introduced through a closed-form equivalent weighting and rejection mechanism within the square-root cubature Kalman filtering framework. The proposed method preserves the derivative-free square-root filtering structure in implementation and avoids inner fixed-point or variational iterations. For the scalar bearing update considered in this paper, the weighting thresholds are determined from a normalized innovation statistic using prescribed confidence levels, so that moderate outliers are down-weighted, and extreme ones are rejected. Simulations under nominal, moderately contaminated, and severely contaminated measurement conditions show that the proposed RSCKF achieves accuracy comparable to the standard square-root cubature Kalman filter (SCKF) in the Gaussian case, while providing improved robustness and only a small computational overhead under the measurement outliers. Under the most severe contamination setting, where 15% of the bearings are corrupted by outliers with a standard deviation 30 times the nominal noise level, RSCKF limits the position-MSE increase to 8.4% relative to the nominal case and achieves the lowest position MSE among the seven compared filters, whereas the standard SCKF deteriorates by more than two orders of magnitude. It is also the only filter whose time-averaged ANEES remains within the consistency band used in the Monte Carlo evaluation, with a computation time close to that of the baseline CKF. Full article

Owing to multi-target tracking in scenarios with nonlinearity, uncertain measurement model and high clutter density, the Poisson multi-Bernoulli mixture (PMBM) recursion is prone to unstable covariance propagation under nonlinear dynamics as well as uncertainty in measurement-to-target association caused by mismatched gate that causes erroneous updates from clutters. In the prediction stage, the singular value decomposition (SVD) is used in place of Cholesky factorization to construct and propagate the square-root covariance factor in the square-root cubature Kalman filter (SCKF), yielding a numerically stable square-root implementation. Then, the resulting SVD-SCKF is incorporated into the PMBM prediction step and used to propagate the Gaussian-mixture components of both the Poisson point process (PPP) intensity and the Bernoulli component in the Multi-Bernoulli mixture (MBM), yielding predicted means and covariances under nonlinear dynamics. An adaptive fading factor is determined from innovation statistics, and covariance inflation is performed to improve robustness under target maneuvers and model mismatch. In the update stage, the unknown measurement function is regressed by Gaussian process (GP) using historical state–measurement samples, yielding an equivalent measurement mapping and state-dependent uncertainty. Furthermore, the predicted measurement distribution is generated from the GP-based conditional measurement distribution with state prior approximated by SVD-SCKF cubature points. An adaptive gate is determined from the GP-based conditional measurement distribution, which is approximated by an equivalent ellipsoidal gate via fitting for screening the current measurements and filtering out clutter. Residual in-gate clutter measurements are handled via Bayesian target discrimination, where the posterior probability of measurement originated from target is employed as a weight and incorporated into association weights and update likelihoods. Simulation results further confirm the effectiveness and stability of the proposed filter in complex scenarios. Full article

This paper proposes a robust navigation method based on a robust square-root cubature Kalman filter (RSRCKF) to address the accuracy divergence of integrated navigation systems caused by drilling-induced slippage and the mismatch between the tail-cable encoder and the robot motion during operations of a seafloor drilling robot in deep-sea soft sedimentary layers. Considering the large-deformation mechanical characteristics of the seabed under drilling conditions, a unified state-space model incorporating a time-varying odometer scale-factor error is first established. To alleviate the numerical instability of the nonlinear system in the presence of non-Gaussian noise, a square-root cubature Kalman filter (SRCKF) framework is employed, in which the positive definiteness of the error covariance matrix is dynamically preserved via QR decomposition. Subsequently, an online fault detection mechanism based on a modified chi-square test is developed. By introducing a two-segment IGG (a classical robust weighting scheme) weighting function, an adaptive variance inflation factor is constructed to enable real-time identification and down-weighting of abnormal observations induced by slippage. Field experiments, including drilling and turning tests conducted on tidal mudflats off the coast of Zhoushan, demonstrate that the proposed method can effectively mitigate the impact of “false displacement” disturbances caused by typical soft clay slippage conditions through enhanced statistical robustness. Taking the conventional SINS/OD integration scheme as the baseline, the proposed method achieves an approximate 82.4% reduction in positioning error. These results verify the robustness and engineering applicability of the proposed algorithm in complex seabed environments. Full article

Real-time performance and adaptability are critical factors influencing the safety and stability of autonomous vehicle trajectory tracking. Therefore, enhancing these aspects is essential for improving driving safety. This paper proposes a trajectory tracking control method for autonomous vehicles based on an adaptive model parameter correction controller (MPACC). First, by integrating the variable universe fuzzy control (VUFC) principle with a model predictive controller (MPC), a variable universe fuzzy model predictive controller (VUFMPC) is designed. This controller enables adaptive adjustment of MPC weighting coefficients, thereby effectively improving the real-time capability and adaptability of the MPC. Second, an adaptive square root cubature Kalman filter (ASRCKF) tire lateral force estimator with adaptive scaling factors is introduced to obtain real-time tire cornering stiffness values as MPC parameters, achieving adaptive correction of the MPC parameters and forming an adaptive model predictive controller (AMPC). Furthermore, an MPACC is designed by integrating VUFMPC and AMPC. This controller allows for real-time adaptive correction of control parameters according to the vehicle’s driving state. Finally, hardware in loop (HIL) tests are conducted for comparative analysis. The results demonstrate that the proposed MPACC exhibits excellent real-time performance and adaptability, while effectively balancing trajectory tracking accuracy and driving stability of autonomous vehicles. Full article

Orbit determination for non-cooperative targets represents a significant focus of research within the domain of space situational awareness. In contrast to cooperative targets, non-cooperative targets do not provide their orbital parameters, necessitating the use of observation data for accurate orbit determination. The increasing prevalence of low-cost, low-thrust spacecraft has heightened the demand for advancements in real-time orbit determination and parameter estimation for low-thrust maneuvers. This paper presents a novel dual-layer filter approach designed to facilitate real-time acceleration estimation for non-cooperative targets. Initially, the method employs a square-root cubature Kalman filter (SRCKF) to handle the nonlinearity of the system and a Jerk model to address the challenges in acceleration modeling, thereby yielding a preliminary estimation of the acceleration produced by the thruster of the non-cooperative target. Subsequently, a specialized filtering structure is established for the estimated acceleration, and two filtering frameworks are integrated into a dual-layer filter model via the cubature transform, significantly enhancing the estimation accuracy of acceleration parameters. Finally, to adapt to the potential on/off states of the thrusters, the Interacting Multiple Model (IMM) algorithm is employed to bolster the robustness of the proposed solution. Simulation results validate the effectiveness of the proposed method in achieving real-time orbit determination and acceleration estimation. Full article

To achieve accurate estimates of a lithium-ion battery’s charge level (SOC) and health condition (SOH), this paper tackles key issues in battery management by introducing a framework built around an adaptive square root cubature Kalman filter (ASRCKF) that tracks parameters in real time for better performance in changing environments. It uses ASRCKF to gauge SOC, while an extended Kalman filter (EKF) identifies battery traits online and monitors capacity loss, with a two-way feedback system that feeds SOH updates directly into the SOC calculations. Testing in high-speed driving, the New European Driving Cycle, and urban stop–start conditions showed the method keeps average SOC errors to 0.16% at most and peak errors to 0.33%, beating out standard EKF and SRCKF approaches in accuracy; SOH errors averaged 0.42%. Overall, this setup proves reliable for combined SOC-SOH tracking in diverse real-world situations, helping to ensure safer battery operations. Full article

Target tracking in typical radar applications faces critical challenges in complex environments, including nonlinear dynamics, non-Gaussian noise, and sensor outliers. Current robustness-enhanced approaches remain constrained by empirical kernel tuning and computational trade-offs, failing to achieve balanced noise suppression and real-time efficiency. To address these limitations, this paper proposes the variational Bayesian-based maximum correntropy criterion cubature Kalman filter (VBMCC-CKF), which integrates variational Bayesian inference with CKF to establish a fully adaptive robust filtering framework for nonlinear systems. The core innovation lies in constructing a joint estimation framework of state and kernel size, where the kernel size is modeled as an inverse-gamma distributed random variable. Leveraging the conjugate properties of Gaussian-inverse gamma distributions, the method synchronously optimizes the state posterior distribution and kernel size parameters via variational Bayesian inference, eliminating reliance on manual empirical adjustments inherent to conventional correntropy-based filters. Simulation confirms the robust performance of the VBMCC-CKF framework in both single and multi-target tracking under non-Gaussian noise conditions. For the single-target case, it achieves a reduction in trajectory average root mean square error (Avg-RMSE) by at least 14.33% compared to benchmark methods while maintaining real-time computational efficiency. Integrated with multi-Bernoulli filtering, the method achieves a 40% lower optimal subpattern assignment (OSPA) distance even under 10-fold covariance mutations, accompanied by superior hit rates (HRs) and minimal trajectory position RMSEs in cluttered environments. These results substantiate its precision and adaptability for dynamic tracking scenarios. Full article

To address the issue of poor yaw stability in distributed-drive electric pickup trucks at medium-to-high speeds, particularly under the influence of continuously varying tire forces and road adhesion coefficients, a novel Kalman filter-based method for estimating the road adhesion coefficient, combined with a Tube-based Model Predictive Control (Tube-MPC) algorithm, is proposed. This integrated approach enables real-time estimation of the dynamically changing road adhesion coefficient while simultaneously ensuring vehicle yaw stability is maintained under rapid response requirements. The developed hierarchical yaw stability control architecture for distributed-drive electric pickup trucks employs a square root cubature Kalman filter (SRCKF) in its upper layer for accurate road adhesion coefficient estimation; this estimated coefficient is subsequently fed into the intermediate layer’s corrective yaw moment solver where Tube-based Model Predictive Control (Tube-MPC) tracks desired sideslip angle and yaw rate trajectories to derive the stability-critical corrective yaw moment, while the lower layer utilizes a quadratic programming (QP) algorithm for precise four-wheel torque distribution. The proposed control strategy was verified through co-simulation using Simulink and Carsim, with results demonstrating that, compared to conventional MPC and PID algorithms, it significantly improves both the driving stability and control responsiveness of distributed-drive electric pickup trucks under medium- to high-speed conditions. Full article

In order to solve the problem that intelligent vehicle active collision avoidance systems have different decision-making results under different road conditions, the square-root cubature Kalman filtering algorithm is used to estimate the road adhesion coefficients, which are introduced into the safety distance model and combined with the fireworks algorithm for braking and steering weight coefficient allocation to ensure that the vehicle can safely avoid collision. The simulation results show that the square-root cubature Kalman filter has higher estimation accuracy and robustness compared with the cubature Kalman filter, and a more reasonable collision avoidance control can be adopted in the subsequent collision avoidance control. Therefore, the proposed new estimation method of road adhesion coefficients proves effective in mitigating vehicle collision risks. Full article

An adaptive constant acceleration (ACA) model is proposed for the maneuvering target tracking problem. Based on the Taylor series expansion of acceleration, we establish the relationship between the Jerk and the velocity as well as the acceleration so that the maneuvering acceleration variance is approximated by the components in the state error covariance matrix. Then, the latter one is connected with the process noise, and the adaptive adjustment of the ACA model is realized. Combining with the strong tracking square-root cubature filter (ST-SCKF) in our previous work, an ACA-ST-SCKF is developed. The simulation results show that the proposed filter possesses better adaptability, tracking accuracy and lower computational complexity compared with the adaptive current statistical (ACS) model-based ST-SCKF, the modified CS (MCS) model-based ST-SCKF, and the IMM-based STF-SCKF. Full article

The field of autonomous vehicle technology has experienced remarkable growth. A pivotal trend in this development is the enhancement of tracking performance and stability under high-speed conditions. Model predictive control (MPC), as a prevalent motion control method, necessitates an extended prediction horizon as vehicle speed increases and will lead to heightened online computational demands. To address this, a path preview strategy is integrated into the MPC framework that temporarily freezes the vehicle state within the prediction horizon. This approach assumes that the vehicle state will remain consistent for a specified preview distance and duration, effectively extending the prediction horizon for the MPC controller. In addition, a stability controller is designed to maintain handling stability under high-speed conditions, in which a square-root cubature Kalman filter (SRCKF) estimator is employed to predict tire forces to facilitate the cornering stiffness estimation of vehicle tires. The double lane change maneuver under high-speed conditions is conducted through the Carsim/Simulink co-simulation. The outcomes demonstrate that the SRCKF estimator could provide a reasonably accurate estimation of lateral tire forces throughout the whole traveling process and facilitates the stability controller to guarantee the handling stability. On the premise of ensuring handling stability, integrating the preview strategy could nearly double the prediction horizon for MPC, resulting in the limited increase of online computation burden brought while maintaining path tracking accuracy. Full article

The accurate estimation of flow angles is crucial for enhancing flight performance and aircraft safety. Flow angles of fixed-wing small unmanned aerial vehicles (SUAVs) are more vulnerable due to their low airspeed. Current flow angle measurement devices have not been widely implemented in SUAVs due to their substantial cost and size constraints. Moreover, there are no general estimation methods suitable for SUAVs based on their rudimentary sensor suite. This study presents a generalized optimization-assisted filter estimation (OAFE) method for estimating the relative velocity and flow angles of fixed-wing SUAVs based on a standard sensor suite. This OAFE method mainly consists of a cubature Kalman filter and an optimizer. The filter serves as the main loop with which to generate flow angles in real time by fusing the acceleration, angular rate, attitude, and airspeed. Without flow angle measurements, the optimizer generates approximate aerodynamic derivatives, which serve as pseudo-measurements with which to refine the performance of the filter. The results demonstrate that the estimated angle of attack and side slip angle displayed root mean square errors of around 0.11° and 0.24° in the simulation. The feasibility was also verified in field tests. The OAFE method does not require flow angle measurements, the prior acquisition of aerodynamic parameters, or model training, making it suitable for quick deployment on different SUAVs. Full article

Road roughness significantly impacts vehicle safety and dynamic responses. For nonlinear suspension systems, the nonlinear characteristics often make it challenging for estimators to identify the actual road roughness accurately. This paper proposes a hybrid road roughness identification algorithm based on nonlinear auto-regressive with exogenous inputs (NARX) and a process noise adaptive square root cubature Kalman filter (PASCKF) to address this issue. Driven by vehicle acceleration data, an NARX-based road roughness identification system is constructed to mitigate the model uncertainties. Furthermore, a hybrid strategy is proposed. On the one hand, the accurate road roughness estimated by the NARX is converted into process noise covariance, enhancing the estimator’s accuracy and convergence rate. Another switching strategy is proposed to optimize the non-convergence issues of the PASCKF. Finally, simulation and actual vehicle experiment data demonstrate that this approach offers superior identification accuracy and adaptability compared to the standalone SCKF algorithm. Full article

Estimating the state of a system by fusing sensor data is a major prerequisite in many applications. When the state is time-variant, derivatives of the Kalman filter are a popular choice for solving that task. Two variants are the square-root unscented Kalman filter (SRUKF) and the square-root cubature Kalman filter (SCKF). In contrast to the unscented Kalman filter (UKF) and the cubature Kalman filter (CKF), they do not operate on the covariance matrix but on its square root. In this work, we modify the SRUKF and the SCKF for use on manifolds. This is particularly relevant for many state estimation problems when, for example, an orientation is part of a state or a measurement. In contrast to other approaches, our solution is both generic and mathematically coherent. It has the same theoretical complexity as the UKF and CKF on manifolds, but we show that the practical implementation can be faster. Furthermore, it gains the improved numerical properties of the classical SRUKF and SCKF. We compare the SRUKF and the SCKF on manifolds to the UKF and the CKF on manifolds, using the example of odometry estimation for an autonomous car. It is demonstrated that all algorithms have the same localization performance, but our SRUKF and SCKF have lower computational demands. Full article

Aiming at the problems of the poor trajectory-tracking performance and low control accuracy of unmanned vehicles under complex working conditions, we first estimate the lateral force of tires using the square root cubature Kalman filter (SRCKF) in order to correct the lateral stiffness of the tires online, which reduces the model bias caused by constant lateral stiffness, and then adopt a Gaussian function-based adaptive time-domain model predictive control method to improve the trajectory-tracking control accuracy of unmanned vehicles under complex working conditions. Finally, the proposed control algorithm is validated via Carsim and MATLAB/Simulink joint simulation. The results show that compared with the classical model predictive control (MPC) algorithm, the proposed control algorithm reduces the average lateral tracking error by 73.07% and the peak beta and the peak yaw rate by 50.89% and 47.51%, respectively, so that the unmanned vehicle is able to maintain good tracking performance and control accuracy. Full article