mavlink: add new streams in main loop, minor cleanup and fixes