#include <SmingCore.h>
#include <Network/Mqtt/MqttBuffer.h>
#include "configuration.h" // application configuration

extern void BMPinit();
extern void SIinit();

MqttClient mqtt;

namespace
{
// Publish our message
void publishMessage() // uncomment timer in connectOk() if need publishMessage() loop
{
	if(mqtt.getConnectionState() != eTCS_Connected)
		startMqttClient(); // Auto reconnect

	Serial.println(_F("publish message"));
	mqtt.publish(VER_TOPIC, "ver.1.2"); // or publishWithQoS
}

// Callback for messages, arrived from MQTT server
int onMessageReceived(MqttClient& client, mqtt_message_t* message)
{
	Serial << _F("Received: ") << MqttBuffer(message->publish.topic_name) << ':' << endl;
	Serial << '\t' << MqttBuffer(message->publish.content) << endl;
	return 0;
}

void gotIP(IpAddress ip, IpAddress netmask, IpAddress gateway)
{
	Serial << _F("Connected: ") << ip << endl;
	startMqttClient();
	publishMessage(); // run once publishMessage
}

} // namespace

void startMqttClient()
{
	Url url(URI_SCHEME_MQTT, F(LOG), F(PASS), F(MQTT_SERVER), MQTT_PORT);
	mqtt.connect(url, CLIENT);
	Serial.println(_F("Connected to MQTT server"));
	mqtt.subscribe(SUB_TOPIC);
}

void init()
{
	Serial.begin(SERIAL_BAUD_RATE); // 115200 by default

	Wire.pins(4, 5); // SDA, SCL
	Wire.begin();

	// initialization config
	mqtt.setMessageHandler(onMessageReceived);

	BMPinit(); // BMP180 sensor initialization
	SIinit();  // HTU21D sensor initialization

	WifiStation.config(WIFI_SSID, WIFI_PWD);
	WifiStation.enable(true);
	WifiEvents.onStationGotIP(gotIP);
	WifiAccessPoint.enable(false);
	WDT.enable(false); //disable watchdog
}