[fix] ECEF correction
Merge branch 'state_interface_update' into ardrone_to_master