Tool command to print full filter states
Merge branch 'paul_estimator' into paul_estimator_mtd