Pacemaker/subscribeOnly.cpp at master · vchek/Pacemaker · GitHub

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
#define MQTTCLIENT_QOS2 1
#define IAP_LOCATION 0x1FFF1FF1

#include "ESP8266Interface.h"
#include "MQTTNetwork.h"
#include "MQTTmbed.h"
#include "MQTTClient.h"

ESP8266Interface wifi(p28, p27);
unsigned long commandP[5], outputP[5], commandD[5], outputD[5];
char partID[128], deviceID[128], uuID[128];

typedef void (*IAP)(unsigned long [], unsigned long []);
IAP iap_entry;


void messageArrived(MQTT::MessageData& md) {
    MQTT::Message &message = md.message;
    // get salted ID from message
    char* saltedID = strtok((char*)message.payload, "-");
    // get generated number
    char* number = strtok(NULL, "-");
    printf("Message: %s\r\n", (char*) message.payload);
    printf("Salted ID is %s\r\n", saltedID);
    printf("Generated number is %s\r\n", number);
}

int main(int argc, char* argv[]) {
    printf("---------------Begin Setup---------------\r\n");
    // Connect to wifi
    int status = wifi.connect(MBED_CONF_APP_WIFI_SSID, MBED_CONF_APP_WIFI_PASSWORD);
    if (status != 0) {
        printf("Error with wifi connection!\r\n");
        return -1;
    }
    printf("Wifi connected!\r\n");

    MQTTNetwork mqttNetwork(&wifi);

    // Create MQTT Client
    MQTT::Client<MQTTNetwork, Countdown> client = MQTT::Client<MQTTNetwork, Countdown>(mqttNetwork);

    //Establish TCP connection with MQTT broker
    const char* hostname = "35.188.242.1";
    int port = 1883;
    int mqttStatus = mqttNetwork.connect(hostname, port);
    if (mqttStatus != 0) {
        printf("Error with connection to MQTT broker! \r\n");
        return -1;
    }

    // finding UUID
    iap_entry = (IAP) IAP_LOCATION;
    // finding partID
    commandP[0] = 54;
    iap_entry(commandP, outputP);
    sprintf(partID, "%x", outputP[1]);

    //finding deviceID
    commandD[0] = 58;
    iap_entry(commandD, outputD);
    snprintf(deviceID, sizeof(deviceID), "%x%x%x%x", outputD[1], outputD[2], outputD[3], outputD[4]);

    sprintf(uuID, "%s-%s", partID, deviceID);
    printf("UUID is %s\r\n", uuID);

    // Connect to MQTT broker
    MQTTPacket_connectData data = MQTTPacket_connectData_initializer;
    data.MQTTVersion = 3;
    data.clientID.cstring = uuID;
    data.username.cstring = "mbed";
    data.password.cstring = "homework";
    if (client.connect(data) != 0) {
        printf("Failed to connect to MQTT broker! \r\n");
        return -1;
    }
    printf("Connected to MQTT broker!\r\n");

    // subscriber subscribe to topic
    char subscribeTopic[128];
    snprintf(subscribeTopic, sizeof(subscribeTopic), "TopicIsPacemaker");
    if (client.subscribe(subscribeTopic, MQTT::QOS0, messageArrived) != 0) {
        printf("Failed to subscribe to topic!\r\n");
        return -1;
    }
    printf("Subscribed!\r\n");
    printf("---------------Setup Complete---------------\r\n");
    while(true) {
         client.yield(1000);
    }
    return 0;
}