mavlink branch with HUCH modifications