Mavlink multi-stream support

This is a joint effort with Julian and Anton. Lengthy discussion and review done, ready to merge. Go for it!