Eliminated the mavlink packet losing issue