Clean up MQTTReader code
The implementation is not thread-safe and potentially blocks with busy waiting.