Clean up mavlink system struct. Fixes #238