Smoothed navigation solution using filtered resets

摘要

A navigation system includes at least one inertial sensor configured to detect motion of the system and generate inertial data; at least one aiding device configured to generate aiding device measurement data; at least one processing unit configured to generate an un-smoothed navigation solution inclusive of navigation state variable error resets based on the inertial data and the aiding device measurement data; wherein the at least one processing unit is further configured to sum the state variable error resets into a cumulative sum of the state variable error resets; wherein the at least one processing unit is further configured to high pass filter the cumulative sum of the state variable error resets; and wherein the at least one processing unit is further configured to subtract the high pass filtered cumulative sum of the state variable error resets from the un-smoothed navigation solution to generate a smoothed navigation solution.