Noodling on some mavlink code