Mavlink message added.
Message added to Mavlink.c