Abstract
In this paper, we propose a novel solution for the low-cost indoor localization and tracking problem using radio signal strength indicator (RSSI), Inertial Measurement Unit (IMU), and magnetometer sensors available in smart handheld devices. The proposed algorithm does not require sensor calibration and operates in real-time. We develop a novel probabilistic IMU motion model as the proposal distribution of a sequential Monte-Carlo technique to track device trajectories. By formulating the problem as a simultaneous localization and mapping (SLAM) optimization, the system recovers continuous trajectories, precise Bluetooth Low Energy (BLE) beacon locations, and time-varying IMU bias. Experimental results demonstrate a localization error of approximately 1.35 m at the third quartile.
Introduction: The Challenge of Indoor Tracking
Indoor localization is often considered the "holy grail" for mobile robotics and smart device applications. While Visual-Inertial Navigation Systems (VINS) offer high accuracy, they are hampered by lighting conditions, high power consumption, and privacy concerns. Conversely, radio-based systems using WiFi or BLE RSSI are ubiquitous but suffer from significant noise due to signal shadowing and multi-path effects.
This research addresses three primary hurdles:
- Global Localization: Solving the "kidnapped robot" problem where the starting position is unknown.
- Sensor Noise: Mitigating the high variance of RSSI and the drifting bias of low-cost smartphone IMUs.
- Map Inaccuracy: Ensuring robustness when the initial positions of radio beacons are poorly surveyed or unknown.
System Architecture
The proposed system utilizes a dual-layer architecture consisting of a real-time Front-end and an optimization-based Back-end, forming a closed-loop feedback system.
The Front-end (Tracking)
The Front-end employs a Sequential Monte-Carlo (Particle Filter) approach. A key innovation is the probabilistic IMU motion model. Instead of sampling from a complex 6D state, the filter samples tangential acceleration magnitudes along the direction of movement. This focused sampling allows the filter to maintain tracking even amidst noisy RSSI measurements.
The Back-end (Optimization)
The Back-end utilizes iSAM2 (incremental Smoothing and Mapping) to formulate the tracking problem as a factor graph. While the Front-end provides immediate estimates, the Back-end analyzes the measurement history to solve for the smoothest possible trajectory, actual BLE beacon coordinates, and internal IMU biases. These optimized values are then fed back to the Front-end to improve real-time tracking accuracy.
Experimental Evaluation
The system was tested using a wheeled mobile robot equipped with a Nexus 6P smartphone. Ground truth was established using a Google Tango device providing high-accuracy visual-inertial odometry. The testing environment was a 40m x 50m office space with active staff and standard furniture. The evaluation included 100 independent runs over trajectories exceeding 100 meters, including simulations where beacon map positions were intentionally perturbed by 3 meters to test system robustness.
Key Results
The integrated system achieved a localization error of approximately 1.35 meters at the 75th percentile (3rd quartile).
Key insights from the results include:
- Self-Calibration: By treating IMU bias and beacon locations as variables, the system eliminates the need for tedious pre-deployment surveys.
- Trajectory Smoothing: As seen in the experimental data, the Back-end effectively corrects the "jumpy" estimates inherent in pure Particle Filters, producing a continuous path that closely tracks the ground truth.
- Map Robustness: The system maintains high performance even with inaccurate initial maps, as the optimization process "drags" misplaced beacons toward their true physical locations based on observed motion.
- Computational Efficiency: The MATLAB-based implementation processed 384 seconds of experimental data in under 92 seconds, confirming its suitability for real-time mobile applications.
Discussion and Future Work
While effective, the system's performance is sensitive to beacon density. In areas with sparse beacon coverage, the system relies on dead reckoning, which can lead to drift until the next beacon is encountered. Future research will focus on extending the reliable range of BLE measurements beyond the current 10-meter clamp and integrating opportunistic visual data to create a comprehensive "visual-radio-inertial SLAM" framework.
Reference: Jadidi, M. G., et al. "Calibrationless Radio-Inertial Localization and Tracking Systems using Smart Handheld Devices." arXiv:1706.05569v3 [cs.RO].
Summary updated