3D simultaneous localization and mapping using IMU and its observability analysis

Robotica ◽  
2010 ◽  
Vol 29 (6) ◽  
pp. 805-814 ◽  
Author(s):  
Farhad Aghili

SUMMARYThis paper investigates 3-dimensional (3D) Simultaneous Localization and Mapping (SLAM) and the corresponding observability analysis by fusing data from landmark sensors and a strap-down Inertial Measurement Unit (IMU) in an adaptive Kalman filter (KF). In addition to the vehicle's states and landmark positions, the self-tuning filter estimates the IMU calibration parameters as well as the covariance of the measurement noise. The discrete-time covariance matrix of the process noise, the state transition matrix and the observation sensitivity matrix are derived in closed form, making it suitable for real-time implementation. Examination of the observability of the 3D SLAM system leads to the the conclusion that the system remains observable, provided that at least three known landmarks, which are not placed in a straight line, are observed.

Sensors ◽  
2019 ◽  
Vol 19 (23) ◽  
pp. 5084 ◽  
Author(s):  
Alwin Poulose ◽  
Dong Seog Han

Smartphone camera or inertial measurement unit (IMU) sensor-based systems can be independently used to provide accurate indoor positioning results. However, the accuracy of an IMU-based localization system depends on the magnitude of sensor errors that are caused by external electromagnetic noise or sensor drifts. Smartphone camera based positioning systems depend on the experimental floor map and the camera poses. The challenge in smartphone camera-based localization is that accuracy depends on the rapidness of changes in the user’s direction. In order to minimize the positioning errors in both the smartphone camera and IMU-based localization systems, we propose hybrid systems that combine both the camera-based and IMU sensor-based approaches for indoor localization. In this paper, an indoor experiment scenario is designed to analyse the performance of the IMU-based localization system, smartphone camera-based localization system and the proposed hybrid indoor localization system. The experiment results demonstrate the effectiveness of the proposed hybrid system and the results show that the proposed hybrid system exhibits significant position accuracy when compared to the IMU and smartphone camera-based localization systems. The performance of the proposed hybrid system is analysed in terms of average localization error and probability distributions of localization errors. The experiment results show that the proposed oriented fast rotated binary robust independent elementary features (BRIEF)-simultaneous localization and mapping (ORB-SLAM) with the IMU sensor hybrid system shows a mean localization error of 0.1398 m and the proposed simultaneous localization and mapping by fusion of keypoints and squared planar markers (UcoSLAM) with IMU sensor-based hybrid system has a 0.0690 m mean localization error and are compared with the individual localization systems in terms of mean error, maximum error, minimum error and standard deviation of error.


2021 ◽  
Vol 18 (2) ◽  
pp. 172988142199992
Author(s):  
Ping Jiang ◽  
Liang Chen ◽  
Hang Guo ◽  
Min Yu ◽  
Jian Xiong

As an important research field of mobile robot, simultaneous localization and mapping technology is the core technology to realize intelligent autonomous mobile robot. Aiming at the problems of low positioning accuracy of Lidar (light detection and ranging) simultaneous localization and mapping with nonlinear and non-Gaussian noise characteristics, this article presents a mobile robot simultaneous localization and mapping method that combines Lidar and inertial measurement unit to set up a multi-sensor integrated system and uses a rank Kalman filtering to estimate the robot motion trajectory through inertial measurement unit and Lidar observations. Rank Kalman filtering is similar to the Gaussian deterministic point sampling filtering algorithm in structure, but it does not need to meet the assumptions of Gaussian distribution. It completely calculates the sampling points and the sampling points weights based on the correlation principle of rank statistics. It is suitable for nonlinear and non-Gaussian systems. With multiple experimental tests of small-scale arc trajectories, we can see that compared with the alone Lidar simultaneous localization and mapping algorithm, the new algorithm reduces the mean error of the indoor mobile robot in the X direction from 0.0928 m to 0.0451 m, with an improved accuracy rate of 46.39%, and the mean error in the Y direction from 0.0772 m to 0.0405 m, which improves the accuracy rate of 48.40%. Compared with the extended Kalman filter fusion algorithm, the new algorithm reduces the mean error of the indoor mobile robot in the X direction from 0.0597 m to 0.0451 m, with an improved accuracy rate of 24.46%, and the mean error in the Y direction from 0.0537 m to 0.0405 m, which improves the accuracy rate of 24.58%. Finally, we also tested on a large-scale rectangular trajectory, compared with the extended Kalman filter algorithm, rank Kalman filtering improves the accuracy of 23.84% and 25.26% in the X and Y directions, respectively, it is verified that the accuracy of the algorithm proposed in this article has been improved.


2021 ◽  
Vol 13 (9) ◽  
pp. 1625
Author(s):  
Zesheng Dan ◽  
Baowang Lian ◽  
Chengkai Tang

In multipath-assisted simultaneous localization and mapping (SLAM), the geometric association of specular multipath components based on radio signals with environmental features is used to simultaneously localize user equipment and map the environment. We must contend with two notable model parameter uncertainties in multipath-assisted SLAM: process noise and clutter intensity. Knowledge of these two parameters is critically important to multipath-assisted SLAM, the uncertainty of which will seriously affect the SLAM accuracy. Conventional multipath-assisted SLAM algorithms generally regard these model parameters as fixed and known, which cannot meet the challenges presented in complicated environments. We address this challenge by improving the belief propagation (BP)-based SLAM algorithm and proposing a robust multipath-assisted SLAM algorithm that can accommodate model mismatch in process noise and clutter intensity. Specifically, we describe the evolution of the process noise variance and clutter intensity via Markov chain models and integrate them into the factor graph representing the Bayesian model of the multipath-assisted SLAM. Then, the BP message passing algorithm is leveraged to calculate the marginal posterior distributions of the user equipment, environmental features and unknown model parameters to achieve the goals of simultaneous localization and mapping, as well as adaptively learning the process noise variance and clutter intensity. Finally, the simulation results demonstrate that the proposed approach is robust against the uncertainty of the process noise and clutter intensity and shows excellent performances in challenging indoor environments.


Author(s):  
J. C. K. Chow

In the absence of external reference position information (e.g. surveyed targets or Global Navigation Satellite Systems) Simultaneous Localization and Mapping (SLAM) has proven to be an effective method for indoor navigation. The positioning drift can be reduced with regular loop-closures and global relaxation as the backend, thus achieving a good balance between exploration and exploitation. Although vision-based systems like laser scanners are typically deployed for SLAM, these sensors are heavy, energy inefficient, and expensive, making them unattractive for wearables or smartphone applications. However, the concept of SLAM can be extended to non-optical systems such as magnetometers. Instead of matching features such as walls and furniture using some variation of the Iterative Closest Point algorithm, the local magnetic field can be matched to provide loop-closure and global trajectory updates in a Gaussian Process (GP) SLAM framework. With a MEMS-based inertial measurement unit providing a continuous trajectory, and the matching of locally distinct magnetic field maps, experimental results in this paper show that a drift-free navigation solution in an indoor environment with millimetre-level accuracy can be achieved. The GP-SLAM approach presented can be formulated as a maximum a posteriori estimation problem and it can naturally perform loop-detection, feature-to-feature distance minimization, global trajectory optimization, and magnetic field map estimation simultaneously. Spatially continuous features (i.e. smooth magnetic field signatures) are used instead of discrete feature correspondences (e.g. point-to-point) as in conventional vision-based SLAM. These position updates from the ambient magnetic field also provide enough information for calibrating the accelerometer bias and gyroscope bias in-use. The only restriction for this method is the need for magnetic disturbances (which is typically not an issue for indoor environments); however, no assumptions are required for the general motion of the sensor (e.g. static periods).


Author(s):  
Mohammadreza Bayat ◽  
A. Pedro Aguiar

Purpose – The authors aim to investigate the observability properties of the process of simultaneous localization and mapping of an autonomous underwater vehicle (AUV), a challenging and important problem in marine robotics, and illustrate the derived results through computer simulations and experimental results with a real AUV. Design/methodology/approach – The authors address the single/multiple beacon observability analysis of the process of simultaneous localization and mapping of an AUV by deriving the nonlinear mathematical model that describes the process; then applying a suitable coordinate transformation, and subsequently a time-scaling transformation to obtain a linear time varying (LTV) system. The AUV considered is equipped with a set of inertial sensors, a depth sensor, and an acoustic ranging device that provides relative range measurements to a set of stationary beacons. The location of the beacons does not need to be necessarily known and in that case, the authors are also interested to localize them. Numerical tests and experimental results illustrate the derived theoretical results. Findings – The authors show that if either the position of one of the beacons or the initial position of the AUV is known, then the system is at least locally weakly observable, in the sense that the set of indistinguishable states from a given initial configuration contains a finite set of isolated points. The simulations and experiments results illustrate the findings. Originality/value – In the single and multiple beacon case and for manoeuvres with constant linear and angular velocities both expressed in the body-frame, known as trimming or steady-state trajectories, the authors derive conditions under which it is possible to infer the state of the resulting system (and in particular the position of the AUV). The authors also describe the implementation of an advanced continuous time constrained minimum energy observer combined with multiple model techniques. Numerical tests and experimental results illustrate the derived theoretical results.


Author(s):  
Robbin Romijnders ◽  
Elke Warmerdam ◽  
Clint Hansen ◽  
Julius Welzel ◽  
Gerhard Schmidt ◽  
...  

Abstract Background Identification of individual gait events is essential for clinical gait analysis, because it can be used for diagnostic purposes or tracking disease progression in neurological diseases such as Parkinson’s disease. Previous research has shown that gait events can be detected from a shank-mounted inertial measurement unit (IMU), however detection performance was often evaluated only from straight-line walking. For use in daily life, the detection performance needs to be evaluated in curved walking and turning as well as in single-task and dual-task conditions. Methods Participants (older adults, people with Parkinson’s disease, or people who had suffered from a stroke) performed three different walking trials: (1) straight-line walking, (2) slalom walking, (3) Stroop-and-walk trial. An optical motion capture system was used a reference system. Markers were attached to the heel and toe regions of the shoe, and participants wore IMUs on the lateral sides of both shanks. The angular velocity of the shank IMUs was used to detect instances of initial foot contact (IC) and final foot contact (FC), which were compared to reference values obtained from the marker trajectories. Results The detection method showed high recall, precision and F1 scores in different populations for both initial contacts and final contacts during straight-line walking (IC: recall $$=$$ = 100%, precision $$=$$ = 100%, F1 score $$=$$ = 100%; FC: recall $$=$$ = 100%, precision $$=$$ = 100%, F1 score $$=$$ = 100%), slalom walking (IC: recall $$=$$ = 100%, precision $$\ge$$ ≥ 99%, F1 score $$=$$ = 100%; FC: recall $$=$$ = 100%, precision $$\ge$$ ≥ 99%, F1 score $$=$$ = 100%), and turning (IC: recall $$\ge$$ ≥ 85%, precision $$\ge$$ ≥ 95%, F1 score $$\ge$$ ≥ 91%; FC: recall $$\ge$$ ≥ 84%, precision $$\ge$$ ≥ 95%, F1 score $$\ge$$ ≥ 89%). Conclusions Shank-mounted IMUs can be used to detect gait events during straight-line walking, slalom walking and turning. However, more false events were observed during turning and more events were missed during turning. For use in daily life we recommend identifying turning before extracting temporal gait parameters from identified gait events.


Author(s):  
Zewen Xu ◽  
Zheng Rong ◽  
Yihong Wu

AbstractIn recent years, simultaneous localization and mapping in dynamic environments (dynamic SLAM) has attracted significant attention from both academia and industry. Some pioneering work on this technique has expanded the potential of robotic applications. Compared to standard SLAM under the static world assumption, dynamic SLAM divides features into static and dynamic categories and leverages each type of feature properly. Therefore, dynamic SLAM can provide more robust localization for intelligent robots that operate in complex dynamic environments. Additionally, to meet the demands of some high-level tasks, dynamic SLAM can be integrated with multiple object tracking. This article presents a survey on dynamic SLAM from the perspective of feature choices. A discussion of the advantages and disadvantages of different visual features is provided in this article.


2020 ◽  
Vol 1682 ◽  
pp. 012049
Author(s):  
Jianjie Zhenga ◽  
Haitao Zhang ◽  
Kai Tang ◽  
Weidi Kong

Sign in / Sign up

Export Citation Format

Share Document