Extended Kalman Filter Arduino