Added telemetry handler to comms.c