Unstable; Commit for safe keeping; Continued work on integrator/HPF
Stable; Ready to test on hardware; DSP calcs incomplete