#include "easy-connect.h"
#include "MQTTNetwork.h"
#include "MQTTmbed.h"
#include "MQTTClient.h"

int arrivedcount = 0,rc;
char buffer[50];

MQTT::Message message;
 NetworkInterface* ipstack = easy_connect(true); 
 
MQTTNetwork mqttnetwork(ipstack);
MQTT::Client<MQTTNetwork, Countdown> client = MQTT::Client<MQTTNetwork, Countdown>(mqttnetwork);

int received=0;
Serial pc(USBTX,USBRX);
void messageArrived(MQTT::MessageData& md)
{
    MQTT::Message &message = md.message;
    pc.printf("Message arrived: qos %d, retained %d, dup %d, packetid %d \n", message.qos, message.retained, message.dup, message.id);
    pc.printf("Payload %.*s\n", message.payloadlen, (char*)message.payload);
   
}

void serialRx(void)
{
    while(pc.readable()) {              
    char c=pc.getc();               
     buffer[received++]=c;                 
    }
   
    message.qos = MQTT::QOS1; 
     message.retained = false;
    message.dup = false;
    message.payload = (void*)buffer;
   message.payloadlen = strlen(buffer)+1;
    rc = client.publish("testout", message);
    received=0;
    }


int main(int argc, char* argv[])
{
    float version = 0.6;
   
  pc.attach(&serialRx,pc.RxIrq);
    pc.printf("HelloMQTT: version is %.2f \n", version);
    char* hostname = "m12.cloudmqtt.com";
    int port =16479;
    pc.printf("Connecting to %s:%d\r\n", hostname, port);
    int rc = mqttnetwork.connect(hostname, port);
    if (rc != 0)
        pc.printf("rc from TCP connect is %d \n", rc);

    MQTTPacket_connectData data = MQTTPacket_connectData_initializer;
    data.MQTTVersion = 3;
    data.clientID.cstring = "1";
    data.username.cstring = "sxdzesyk";
    data.password.cstring = "dc_pY7Q7gOTw";
    rc = client.connect(data);
    pc.printf("rc from MQTT connect is %d \n", rc);

  rc = client.subscribe("testing", MQTT::QOS1, messageArrived);
  pc.printf("rc from MQTT subscribe is %d \n", rc);

  while(1)
{
client.yield(100);
}
}