public void TestInformationFilter() { System.Console.WriteLine("Filter 1 - DiscreteKalmanFilter, Filter 2 - InformationFilter"); Matrix x0 = RangeBearingTracker.TwoPointDifferenceState(rM[0], rM[1], bM[0], bM[1], T); Matrix P0 = RangeBearingTracker.TwoPointDifferenceCovariance(rM[0], rM[1], bM[0], bM[1], re, the, T); DiscreteKalmanFilter dkf = new DiscreteKalmanFilter(x0, P0); InformationFilter inf = new InformationFilter(x0, P0); Assert.IsTrue(RunTest(dkf, inf, DefaultTolerance)); }
public void TestInformationFilter() { System.Console.WriteLine("Filter 1 - DiscreteKalmanFilter, Filter 2 - InformationFilter"); Matrix<double> x0 = RangeBearingTracker.TwoPointDifferenceState(rM[0], rM[1], bM[0], bM[1], T); Matrix<double> P0 = RangeBearingTracker.TwoPointDifferenceCovariance(rM[0], rM[1], bM[0], bM[1], re, the, T); DiscreteKalmanFilter dkf = new DiscreteKalmanFilter(x0, P0); InformationFilter inf = new InformationFilter(x0, P0); Assert.IsTrue(RunTest(dkf, inf, DefaultTolerance)); }