We were adding the movement error in the wrong place, causing the filter output to never vary dispite changes in sensor noise. Also some PEP-8 cleanup.
We were adding the movement error in the wrong place, causing the filter output to never vary dispite changes in sensor noise. Also some PEP-8 cleanup.