Fuzzy interacting multiple model H∞ particle filter algorithm based on current statistical model

In this paper, fuzzy theory and interacting multiple model are introduced into H∞ filter-based particle filter to propose a new fuzzy interacting multiple model H∞ particle filter based on current statistical model. Each model uses H∞ particle filter algorithm for filtering, in which the current statistical model can describe the maneuver of target accurately and H∞ filter can deal with the nonlinear system effectively. Aiming at the problem of large amount of probability calculation in interacting multiple model by using combination calculation method, our approach calculates each model matching probability through the fuzzy theory, which can not only reduce the calculation amount, but also improve the state estimation accuracy to some extent. The simulation results show that the proposed algorithm can be more accurate and robust to track maneuvering target

Trajectory generation for lane-change maneuver of autonomous vehicles

Lane-change maneuver is one of the most thoroughly investigated automatic driving operations that can be used by an autonomous self-driving vehicle as a primitive for performing more complex operations like merging, entering/exiting highways or overtaking another vehicle. This thesis focuses on two coherent problems that are associated with the trajectory generation for lane-change maneuvers of autonomous vehicles in a highway scenario: (i) an effective velocity estimation of neighboring vehicles under different road scenarios involving linear and curvilinear motion of the vehicles, and (ii) trajectory generation based on the estimated velocities of neighboring vehicles for safe operation of self-driving cars during lane-change maneuvers. ^ We first propose a two-stage, interactive-multiple-model-based estimator to perform multi-target tracking of neighboring vehicles in a lane-changing scenario. The first stage deals with an adaptive window based turn-rate estimation for tracking maneuvering target vehicles using Kalman filter. In the second stage, variable-structure models with updated estimated turn-rate are utilized to perform data association followed by velocity estimation. Based on the estimated velocities of neighboring vehicles, piecewise Bezier-curve-based methods that minimize the safety/collision risk involved and maximize the comfort ride have been developed for the generation of desired trajectory for lane-change maneuvers. The proposed velocity-estimation and trajectory-generation algorithms have been validated experimentally using Pioneer3- DX mobile robots in a simulated lane-change environment as well as validated by computer simulations

Tracking gate algorithm for general nonlinear systems with target class information

Multitarget tracking in clutter usually involves data association. The traditional method to handle this problem is to construct a tracking gate for predicting the position of the target being tracked, which leads to great uncertainties of measurements-to-tracks association with the unknown class of targets. This paper proposes a new tracking gate algorithm for general nonlinear systems, where the target class information is integrated into our algorithm. Firstly, a joint probability density description of the target state and target class is given, by which the tracking gates for each target class in general nonlinear system are developed. Then, a simulation with ground formation target tracking is carried out to examine our algorithm. Compared with the traditional tracking gate, the results demonstrate that our algorithm has significantly improved the probabilities of the measurements-to-tracks association