SLAM-based Integrity Monitoring Using GPS and Fish-eye Camera
Urban navigation using GPS and fish-eye camera suffers from multipath effects in GPS measurements and data association errors in pixel intensities across image frames. We propose a Simultaneous Localization and Mapping (SLAM)-based Integrity Monitoring (IM) algorithm to compute the position protection levels while accounting for multiple faults in both GPS and vision. We perform graph optimization using the sequential data of GPS pseudoranges, pixel intensities, vehicle dynamics, and satellite ephemeris to simultaneously localize the vehicle as well as the landmarks, namely GPS satellites and key image pixels in the world frame. We estimate the fault mode vector by analyzing the temporal correlation across the GPS measurement residuals and spatial correlation across the vision intensity residuals. In particular, to detect and isolate the vision faults, we developed a superpixel-based piecewise Random Sample Consensus (RANSAC) technique to perform spatial voting across image pixels. For an estimated fault mode, we compute the protection levels by applying worst-case failure slope analysis to the linearized Graph-SLAM framework. We perform ground vehicle experiments in the semi-urban area of Champaign, IL and have demonstrated the successful detection and isolation of multiple faults. We also validate tighter protection levels and lower localization errors achieved via the proposed algorithm as compared to SLAM-based IM that utilizes only GPS measurements.
Code (0)
등록된 구현이 없습니다.
Tasks
Simultaneous Localization and MappingSimilar Papers 제목 키워드 기반
MultiCol-SLAM - A Modular Real-Time Multi-Camera SLAM System
The basis for most vision based applications like robotics, self-driving cars and potentially augmented and virtual reality is a robust, continuous estimation of the position and orientation of a camera system w.r.t the …
PositionSelf-Driving CarsSimultaneous Localization and MappingFisheye-Calib-Adapter: An Easy Tool for Fisheye Camera Model Conversion
The increasing necessity for fisheye cameras in fields such as robotics and autonomous driving has led to the proposal of various fisheye camera models. While the evolution of camera models has facilitated the developmen…
Autonomous DrivingA Particle Filtering Framework for Integrity Risk of GNSS-Camera Sensor Fusion
Adopting a joint approach towards state estimation and integrity monitoring results in unbiased integrity monitoring unlike traditional approaches. So far, a joint approach was used in Particle RAIM [l] for GNSS measurem…
PositionSensor FusionState EstimationDirection-Aware Semi-Dense SLAM
To aide simultaneous localization and mapping (SLAM), future perception systems will incorporate forms of scene understanding. In a step towards fully integrated probabilistic geometric scene understanding, localization …
Scene UnderstandingSegmentationSimultaneous Localization and MappingPMOF: A Dataset and Benchmark for Passenger Monitoring Using Overhead Fisheye Cameras
Autonomous staff-free public transport requires reliable in-vehicle passenger monitoring. However, perception inside moving vehicles is challenged by confined spaces, variable illumination, motion-induced background vari…
Action RecognitionObject Detection