v3 - working version

Fixed deliberate errors that were used for testing, now this "works" but would not be useful for anything other than testing.

Uses the modified interface (without KalmanFilterSupported)