Improve basic integration of mavlink protocol

This is a first MR for improving mavlink protocol integration.

This MR is self-contained, just works as itself.

In this MR, I focused on improving single vehicle and connection management.

You can find detailed descriptions in commit messages.