Systems and methods for landmark selection for navigation

摘要

Systems and methods are provided for selecting landmarks for navigation. In one embodiment, a system comprises an IMU that provides inertial measurements for a vehicle and at least one image sensor that acquires measurements of the vehicle's environment. The system also comprises a processing unit that calculates a navigation solution for the vehicle based on the inertial measurements, identifies a plurality of landmarks in the acquired measurements, and identifies a plurality of usable landmarks from the plurality of landmarks. The processing unit also selects a subset of useable landmarks from the plurality of useable landmarks such that the subset of landmarks has a smaller dilution of precision (DOP) than other possible subsets of landmarks from the plurality of useable landmarks, and calculates an updated navigation solution from the subset of landmarks. The DOP is an amplification factor of measurement errors derived from the geometry of the subset of useable landmarks.