Mavlink library fixes