There was a little more fixed to do when telemetry was not eanbled.

Tested arm/disarm/arm/disarm with telemetry on and off, all working now.

See #155.