mavlink: heartbeat message bug fixed