Subscriptions added, now a fully working MQTT QoS 0 broker
Tidy up code