Reboot mavlink msg enabled
Ground-truth data problem is solved