MPU change for Elliot

MPU change for Elliot's board
Velocity correction

Fixed comp velocity correction