Extended Kalman Filter Arduino Code