Search Results (21)

The escalating threat posed by low-altitude swarm targets underscores the critical need for precise tracking and situation awareness to secure key areas. While existing tracking methods based on random matrix theory offer promising opportunities, they face significant challenges. The high similarity among swarm targets, combined with radar resolution limitations, often leads to instabilities in target counts and measurements due to occlusion, environmental factors, and other disturbances, significantly increasing tracking complexity. To address these challenges, we design a digital staring radar system integrated with an adaptive random matrix method for efficient tracking of low-altitude swarm targets. The system achieves full spatiotemporal coverage without beam scanning or complex resource scheduling, enabling simultaneous detection and tracking of multiple targets. Algorithmically, the random matrix model is enhanced by introducing extension parameters to accurately capture the dynamic changes in swarm shape. Leveraging an adaptive Rao-Blackwellized Particle Filter (RBPF), the presented method jointly estimates the motion and extension states of swarm targets. Extensive simulation experiments and real-data validation demonstrate that the proposed method significantly improves the estimation accuracy for swarm extension states under complex shape variations while maintaining high precision in motion state estimation. This work provides a practical and effective solution for countering low-altitude swarm threats, with strong potential for real-world security applications. Full article

In this paper, we introduce an innovative interacting multiple-criterion selection (IMCS) idea to design the optimal radar waveform, aimingto reduce tracking error and enhance tracking performance. This method integrates the multiple-hypothesis tracking (MHT) and Rao–Blackwellized particle filter (RBPF) algorithms to tackle maneuvering First-Person-View (FPV) drones in a three-dimensional low-altitude cluttered environment. A complex hybrid model, combining linear and nonlinear states, is constructed to describe the high maneuverability of the target. Based on the interacting multiple model (IMM) framework, our proposed IMCS method employs several waveform selection criteria as models and determines the optimal criterion with the highest probability to select waveform parameters. The simulation results indicate that the MHT–RBPF algorithm, using the IMCS method for adaptive parameter selection, exhibits high accuracy and robustness in tracking a low-altitude maneuvering target, resulting in lower root mean square error (RMSE) compared with fixed- or single-waveform selection mechanisms. Full article

In this paper, to track maneuvering unmanned surface vehicles (USVs) in scenarios with clutter, we propose a novel method based on the probabilistic data association (PDA) algorithm and Rao-Blackwellized particle filter (RBPF) algorithm, and we further improve the tracking performance by Max-Q criterion-based waveform selection. This work develops a maneuvering target model in the context of clutter, integrating linear and nonlinear states as well as observations with false alarms. In order to jointly tackle the mixed-state tracking problem, the PDA algorithm is integrated into the RBPF framework. This allows it to be used with the complex nonlinear and linear hybrid system and helps to minimize the state dimensions of conventional particle filtering (PF). Additionally, by utilizing Q-learning principles, we provide a Max-Q-based criterion to select the waveform parameters, which guarantees low measurement errors and efficiently handles measurement uncertainties. Our simulation results show that the PDA-RBPF algorithm, which has a more appropriate tracking mechanism, produces results that are more accurate than those of the EKF or PF algorithms alone. Furthermore, the RMSE derived by the Max-Q-based criterion is smaller and more robust than that of other selection methods, as well as yielding a fixed waveform. Our proposed mechanism, which combines the concepts of PDA-RBPF and Max-Q waveform selection, performs well in target tracking tasks and exhibits relatively good performance over some existing ones. Full article

Object-level simultaneous localization and mapping (SLAM) has gained popularity in recent years since it can provide a means for intelligent robot-to-environment interactions. However, most of these methods assume that the distribution of the errors is Gaussian. This assumption is not valid under many circumstances. Further, these methods use a delayed initialization of the objects in the map. During this delayed period, the solution relies on the motion model provided by an inertial measurement unit (IMU). Unfortunately, the errors tend to accumulate quickly due to the dead-reckoning nature of these motion models. Finally, the current solutions depend on a set of salient features on the object’s surface and not the object’s shape. This research proposes an accurate object-level solution to the SLAM problem with a 4.1 to 13.1 cm error in the position (0.005 to 0.021 of the total path). The developed solution is based on Rao–Blackwellized Particle Filtering (RBPF) that does not assume any predefined error distribution for the parameters. Further, the solution relies on the shape and thus can be used for objects that lack texture on their surface. Finally, the developed tightly coupled IMU/camera solution is based on an undelayed initialization of the objects in the map. Full article

Significant developments have been made in the navigation of autonomous mobile robots within indoor environments; however, there still remain challenges in the face of poor map construction accuracy and suboptimal path planning, which limit the practical applications of such robots. To solve these challenges, an enhanced Rao Blackwell Particle Filter (RBPF-SLAM) algorithm, called Lidar-based RBPF-SLAM (LRBPF-SLAM), is proposed. In LRBPF, the adjacent bit poses difference data from the 2D Lidar sensor which is used to replace the odometer data in the proposed distribution function, overcoming the vulnerability of the proposed distribution function to environmental disturbances, and thus enabling more accurate pose estimation of the robot. Additionally, a probabilistic guided search-based path planning algorithm, gravitation bidirectional rapidly exploring random tree (GBI-RRT), is also proposed, which incorporates a target bias sampling to efficiently guide nodes toward the goal and reduce ineffective searches. Finally, to further improve the efficiency of navigation, a path reorganization strategy aiming at eliminating low-quality nodes and improving the path curvature of the path is proposed. To validate the effectiveness of the proposed method, the improved algorithm is integrated into a mobile robot based on a ROS system and evaluated in simulations and field experiments. The results show that LRBPF-SLAM and GBI-RRT perform superior to the existing algorithms in various indoor environments. Full article

Commonly, simultaneous localization and mapping (SLAM) algorithm is developed using high-end sensors. Alternatively, some researchers use low-end sensors due to the lower cost of the robot. However, the low-end sensor produces noisy sensor measurements that can affect the SLAM algorithm, which is prone to error. Therefore, in this paper, a SLAM algorithm, which is a Rao-Blackwellized particle filter (RBPF) integrated with artificial neural networks (ANN) sensor model, is introduced to improve the measurement accuracy of a low-end laser distance sensor (LDS) and subsequently improve the performance of SLAM. The RBPF integrated with the ANN sensor model is experimented with by using the Turtlebot3 mobile robot in simulation and real-world experiments. The experiment is validated by comparing the occupancy grid maps estimated by RBPF integrated with the ANN sensor model and RBPF without ANN. Both the results in simulation and real-world experiments show that the SLAM performance of RBPF integrated with the ANN sensor model is better than the RBPF without ANN. In the real-world experiment results, the performance of the occupied cells integrated with the ANN sensor model is increased by 107.59%. In conclusion, the SLAM algorithm integrated with the ANN sensor model is able to improve the accuracy of the map estimate for mobile robots using low-end LDS sensors. Full article

Simultaneous localization and mapping (SLAM) is a dual process responsible for the ability of a robotic vehicle to build a map of its surroundings and estimate its position on that map. This paper presents the novel concept of creating a 3D map based on the adaptive Monte-Carlo location (AMCL) and the extended Kalman filter (EKF). This approach is intended for inspection or rescue operations in a closed or isolated area where there is a risk to humans. The proposed solution uses particle filters together with data from on-board sensors to estimate the local position of the robot. Its global position is determined through the Rao–Blackwellized technique. The developed system was implemented on a wheeled mobile robot equipped with a sensing system consisting of a laser scanner (LIDAR) and an inertial measurement unit (IMU), and was tested in the real conditions of an underground mine. One of the contributions of this work is to propose a low-complexity and low-cost solution to real-time 3D-map creation. The conducted experimental trials confirmed that the performance of the three-dimensional mapping was characterized by high accuracy and usefulness for recognition and inspection tasks in an unknown industrial environment. Full article

We present a computationally efficient algorithm for using variations in the ambient magnetic field to compensate for position drift in integrated odometry measurements (dead-reckoning estimates) through simultaneous localization and mapping (SLAM). When the magnetic field map is represented with a reduced-rank Gaussian process (GP) using Laplace basis functions defined in a cubical domain, analytic expressions of the gradient of the learned magnetic field become available. An existing approach for magnetic field SLAM with reduced-rank GP regression uses a Rao-Blackwellized particle filter (RBPF). For each incoming measurement, training of the magnetic field map using an RBPF has a computational complexity per time step of $O\left(N_p{N}_m^2\right)$, where $N_p$ is the number of particles, and $N_m$ is the number of basis functions used to approximate the Gaussian process. Contrary to the existing particle filter-based approach, we propose applying an extended Kalman filter based on the gradients of our learned magnetic field map for simultaneous localization and mapping. Our proposed algorithm only requires training a single map. It, therefore, has a computational complexity at each time step of $O\left(N_m^2\right)$. We demonstrate the workings of the extended Kalman filter for magnetic field SLAM on an open-source data set from a foot-mounted sensor and magnetic field measurements collected onboard a model ship in an indoor pool. We observe that the drift compensating abilities of our algorithm are comparable to what has previously been demonstrated for magnetic field SLAM with an RBPF. Full article

In this paper, we provide a novel Bayesian solution to forecasting extreme quantile thresholds that are dynamic in nature. This is an important problem in many fields of study including climatology, structural engineering, and finance. We utilize results from extreme value theory to provide the backdrop for developing a state-space model for the unknown parameters of the observed time-series. To solve for the requisite probability densities, we derive a Rao-Blackwellized particle filter and, most importantly, a computationally efficient, recursive solution. Using the filter, the predictive distribution of future observations, conditioned on the past data, is forecast at each time-step and used to compute extreme quantile levels. We illustrate the improvement in forecasting ability, versus traditional methods, using simulations and also apply our technique to financial market data. Full article

Under realistic environmental conditions, heuristic-based data association and map management routines often result in divergent map and trajectory estimates in robotic Simultaneous Localization And Mapping (SLAM). To address these issues, SLAM solutions have been proposed based on the Random Finite Set (RFS) framework, which models the map and measurements such that the usual requirements of external data association routines and map management heuristics can be circumvented and realistic sensor detection uncertainty can be taken into account. Rao–Blackwellized particle filter (RBPF)-based RFS SLAM solutions have been demonstrated using the Probability Hypothesis Density (PHD) filter and subsequently the Labeled Multi-Bernoulli (LMB) filter. In multi-target tracking, the LMB filter, which was introduced as an efficient approximation to the computationally expensive $\delta$ -Generalized LMB ( $\delta$ -GLMB) filter, converts its representation of an LMB distribution to $\delta$ -GLMB form during the measurement update step. This not only results in a loss of information yielding inferior results (compared to the $\delta$ -GLMB filter) but also fails to take computational advantages in parallelized implementations possible with RBPF-based SLAM algorithms. Similar to state-of-the-art random vector-valued RBPF solutions such as FastSLAM and MH-FastSLAM, the performances of all RBPF-based SLAM algorithms based on the RFS framework also diverge from ground truth over time due to random sampling approaches, which only rely on control noise variance. Further, the methods lose particle diversity and diverge over time as a result of particle degeneracy. To alleviate this problem and further improve the quality of map estimates, a SLAM solution using an optimal kernel-based particle filter combined with an efficient variant of the $\delta$ -GLMB filter ( $\delta$ -GLMB-SLAM) is presented. The performance of the proposed $\delta$ -GLMB-SLAM algorithm, referred to as $\delta$ -GLMB-SLAM2.0, was demonstrated using simulated datasets and a section of the publicly available KITTI dataset. The results suggest that even with a limited number of particles, $\delta$ -GLMB-SLAM2.0 outperforms state-of-the-art RBPF-based RFS SLAM algorithms. Full article

In this paper, we propose a novel fuzzy expectation maximization (FEM) based Takagi-Sugeno (T-S) fuzzy particle filtering (FEMTS-PF) algorithm for a passive sensor system. In order to incorporate target spatial-temporal information into particle filtering, we introduce a T-S fuzzy modeling algorithm, in which an improved FEM approach is proposed to adaptively identify the premise parameters, and the model probability is adjusted by the premise membership functions. In the proposed FEM, the fuzzy parameter is derived by the fuzzy C-regressive model clustering method based on entropy and spatial-temporal characteristics, which can avoid the subjective influence caused by the artificial setting of the initial value when compared to the traditional FEM. Furthermore, using the proposed T-S fuzzy model, the algorithm samples particles, which can effectively reduce the particle degradation phenomenon and the parallel filtering, can realize the real-time performance of the algorithm. Finally, the results of the proposed algorithm are evaluated and compared to several existing filtering algorithms through a series of Monte Carlo simulations. The simulation results demonstrate that the proposed algorithm is more precise, robust and that it even has a faster convergence rate than the interacting multiple model unscented Kalman filter (IMMUKF), interacting multiple model extended Kalman filter (IMMEKF) and interacting multiple model Rao-Blackwellized particle filter (IMMRBPF). Full article

The B-spline function representation is commonly used for data approximation and trajectory definition, but filter-based methods for nonlinear weighted least squares (NWLS) approximation are restricted to a bounded definition range. We present an algorithm termed nonlinear recursive B-spline approximation (NRBA) for an iterative NWLS approximation of an unbounded set of data points by a B-spline function. NRBA is based on a marginalized particle filter (MPF), in which a Kalman filter (KF) solves the linear subproblem optimally while a particle filter (PF) deals with nonlinear approximation goals. NRBA can adjust the bounded definition range of the approximating B-spline function during run-time such that, regardless of the initially chosen definition range, all data points can be processed. In numerical experiments, NRBA achieves approximation results close to those of the Levenberg–Marquardt algorithm. An NWLS approximation problem is a nonlinear optimization problem. The direct trajectory optimization approach also leads to a nonlinear problem. The computational effort of most solution methods grows exponentially with the trajectory length. We demonstrate how NRBA can be applied for a multiobjective trajectory optimization for a battery electric vehicle in order to determine an energy-efficient velocity trajectory. With NRBA, the effort increases only linearly with the processed data points and the trajectory length. Full article

High Definition (HD) maps are becoming key elements of the autonomous driving because they can provide information about the surrounding environment of the autonomous car without being affected by the real-time perception limit. To provide the most recent environmental information to the autonomous driving system, the HD map must maintain up-to-date data by updating changes in the real world. This paper presents a simultaneous localization and map change update (SLAMCU) algorithm to detect and update the HD map changes. A Dempster–Shafer evidence theory is applied to infer the HD map changes based on the evaluation of the HD map feature existence. A Rao–Blackwellized particle filter (RBPF) approach is used to concurrently estimate the vehicle position and update the new map state. The detected and updated map changes by the SLAMCU are reported to the HD map database in order to reflect the changes to the HD map and share the changing information with the other autonomous cars. The SLAMCU was evaluated through experiments using the HD map of traffic signs in the real traffic conditions. Full article

Terrain-aided navigation (TAN) is a technology that estimates the position of the vehicle by comparing the altitude measured by an altimeter and height from the digital elevation model (DEM). The particle filter (PF)-based TAN has been commonly used to obtain stable real-time navigation solutions in cases where the unmanned aerial vehicle (UAV) operates at a high altitude. Even though TAN performs well on rough and unique terrains, its performance degrades in flat and repetitive terrains. In particular, in the case of PF-based TAN, there has been no verified technique for deciding its terrain validity. Therefore, this study designed a Rao-Blackwellized PF (RBPF)-based TAN, used long short-term memory (LSTM) networks to endure flat and repetitive terrains, and trained the noise covariances and measurement model of RBPF. LSTM is a modified recurrent neural network (RNN), which is an artificial neural network that recognizes patterns from time series data. Using this, this study tuned the noise covariances and measurement model of RBPF to minimize the navigation errors in various flight trajectories. This paper designed a TAN algorithm based on combining RBPF and LSTM and confirmed that it can enable a more precise navigation performance than conventional RBPF based TAN through simulations. Full article

In the past few years, it has become increasingly important to automatically detect falls and provide feedback in emergency situations. To meet these demands, fall detection studies have been undertaken using various methods ranging from wearable devices to vision-based methods. However, each method has its own limitations and one common limitation that is prevalent in almost all fall detection studies is that they are restricted to indoor environments. Therefore, we focused on a more dynamic and complex outdoor environment. We used two-dimensional features and Rao-Blackwellized Particle Filtering for human detection and tracking, and extracted three-dimensional features from depth images estimated by the supervised learning method from single input images. As we used the methods in combination, we could distinguish a series of states in which a person falls more precisely and then successfully perform fall detection under dynamic and complex scenes. In this study, we solved the initialization problem, the main constraint of existing tracking studies, by applying the particle swarm optimization method to the human detection system. In addition, we avoided using the background reference image feature for image segmentation due to its vulnerability towards dynamic outdoor changes. The experimental results show a reliable and robust performance for the proposed method and suggest the possibility of effective application to the pre-existing surveillance systems. Full article