[fixedwing] Telemetry code
* Almost all telemetry messages migrated