mavlink: move commands stream to mavlink_messages.cpp, bugs fixed