mavlink: store last heartbeat time in telemetry_status topic
commander: failsafe_state removed, replaced with bool failsafe, navigation state and failsafe determined directly from main state and conditions