Warnings cleanup

This fixes a number of compile warnings (without changing logic) and makes MAVLink text feedback more efficient and consistent in commander.

@sjwilks A code review would be appreciated.