Fixed PID priority issue where it could interrupt I2C and UART
Added sync signal and behavior to telemetry