Merge pull request #174 from pamod/mqtt_dev

MQTT Performance improvements, Attending to TODOs
MQTT fixing some loggging issues