Changes:
- Removed FIR filter to derivatives
- Converted to alpha-beta filter to smoothen and differentiate signal
- Changed to trapezoidal rule for integration
- Removed 2nd derivative
- Removed polling delay. Position can be directly updated in main loop
Changes: