Update localization algorithm after tests on the drone