GPSと魚眼カメラを使用した都市のナビゲーションは、GPS測定のマルチパス効果と、画像フレーム全体のピクセル強度のデータ関連付けエラーの影響を受けます。 GPSとビジョンの両方の複数の障害を考慮しながら、位置保護レベルを計算するための同時ローカリゼーションとマッピング(SLAM)ベースの整合性監視(IM)アルゴリズムを提案します。 GPS擬似距離、ピクセル強度、ビークルダイナミクス、および衛星エフェメリスのシーケンシャルデータを使用してグラフの最適化を実行し、ビークルとランドマーク、つまりGPS衛星とワールドフレーム内の主要な画像ピクセルを同時にローカライズします。 GPS測定残差全体の時間的相関と視覚強度残差全体の空間的相関を分析することにより、障害モードベクトルを推定します。特に、視覚障害を検出および分離するために、スーパーピクセルベースの区分的ランダムサンプルコンセンサス(RANSAC)技術を開発し、画像ピクセル全体で空間投票を実行しました。推定された障害モードについて、線形化されたGraph-SLAMフレームワークにワーストケースの障害勾配解析を適用することにより、保護レベルを計算します。イリノイ州シャンペーンの準都市部で地上車両実験を実施し、複数の障害の検出と分離の成功を実証しました。また、GPS測定のみを使用するSLAMベースのIMと比較して、提案されたアルゴリズムによって達成されるより厳しい保護レベルと低いローカリゼーションエラーを検証します。
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.