Update estimator, improve reset logic
Add reset tests in test harness
Teach test harness how to test for NaN values in states as well