mavlink: Change to size optimization

@thomasgubler: I think it makes sense to merge this to our WIP. I've flown this today successfully and it saves a ton of flash. Note that Tridge also runs mavlink in -Os mode.