Cleanup ekf