Custom telemetry system for Cortex M4, using ChibiOS