Complementary Filtering (GPS)

The approach described in Section 4.9.4 and depicted in Figure 4.8 is an example of a feed-forward complementary filter implementation. For this example, the kinematics are given by eqn. (4.141),tmp3AC1439_thumbrepresents the acceleration measurement in eqn. (4.142), the output prediction is ;tmp3AC1440_thumband the error estimator is defined in eqns. (4.145) anddesigned by the choice of L.tmp3AC1441_thumbsuperscript is indicated on thetmp3AC1442_thumbvariable because the error state estimator can compute either variable at any time needed to form the rightmost summation in the figure. The error estimator can also propagate eqns. (4.125) and (4.127) to maintain an estimate of the system accuracy.


The feed-forward complementary filter approach has the navigation system integrating the variable u through the system kinematics to produce x_ and the error state estimator integratingtmp3AC1443_thumbbetweenaiding measurements to produce the corrected state estimate denoted astmp3AC1444_thumbin Figure 4.8.

As an alternative approach, over the sampling intervaltmp3AC1445_thumb starting from the initial conditiontmp3AC1446_thumbthe navigation system could integratetmp3AC1447_thumbthrough the system kinematics to producetmp3AC1448_thumbAt time tmp3AC1462_thumbthe error state estimatetmp3AC1463_thumbis added to the prior state estimate to produce the initial condition for the next interval of integration

tmp3AC1464_thumb

 

 

Feedback complementary filter implementation diagram.

Figure 4.9: Feedback complementary filter implementation diagram.

Because the navigation system state now accounts for the estimated error, the expected value of the error intmp3AC1465_thumbis zero and it is therefore proper to resettmp3AC1467_thumb

This makes the time update portion of eqn. (4.145) trivial, so that it need not be implemented. This feedback approach is theoretically equivalent to the feed-forward approach. It is depicted in Figure 4.9 where the feedback of JX should be read as correcting the initial condition for each period of integration.

Next post:

Previous post: