pathfinder-for-autonomous-navigation / psim

Six DOF flight simulator and related GNC implementations.
MIT License
4 stars 6 forks source link

Square Root Kalman Filter for Relative Orbit Estimation #307

Closed kylekrol closed 3 years ago

kylekrol commented 3 years ago

Rebasing once #302 and #304 are merged.

Fixes #298.

Summary of Changes

Testing

Originally with a process noise value of S = 1.0e-4 I gave the following results:

image

which perform fairly well and although when the CDGPS goes out of range you can see the covariance bounds of the position estimate are very conservative - likely because the process noise for the position states is too large. Secondly, the covariance bounds on the seem too tight on the z velocity component. Taking this into account, the process noise values were updated.

The following results are shown below:

image