IMU calculating velocity

@Idahowalker The Kalman library is amazing :slight_smile: thank you I've been trying for months to find something that works.

The velocity is still increasing when stationary so I'm going to have a look into sensor fusion with a barometer

-Harvey