Jan Kowalski / Program_KPG_2019

0

Dependencies:   Cayenne-MQTT-mbed Servo nfc X_NUCLEO_IDW01M1v2 NetworkSocketAPI 13

main.cpp@11:60c50eae8b81, 2019-09-01 (annotated)

Committer:
kapitaninternet
Date:
Sun Sep 01 15:50:42 2019 +0000
Revision:
11:60c50eae8b81
Parent:
10:8892a1436342
Child:
12:32dbf8ff8d80
cleaning

Who changed what in which revision?

UserRevisionLine numberNew contents of line
jburhenn 0:d20655cd1f3c 1 #include "MQTTTimer.h"
jburhenn 0:d20655cd1f3c 2 #include "CayenneMQTTClient.h"
jburhenn 0:d20655cd1f3c 3 #include "MQTTNetworkIDW01M1.h"
jburhenn 0:d20655cd1f3c 4 #include "SpwfInterface.h"
kapitaninternet 10:8892a1436342 5 #include "mbed.h"
kapitaninternet 11:60c50eae8b81 6 #include "XNucleoIKS01A2.h" // czujniki ruchu i otoczenia
kapitaninternet 11:60c50eae8b81 7 #include "XNucleoNFC01A1.h" // modul nfc
kapitaninternet 10:8892a1436342 8 #include "NDefLib/NDefNfcTag.h"
kapitaninternet 10:8892a1436342 9 #include "NDefLib/RecordType/RecordURI.h"
kapitaninternet 9:c206c33736fe 10
kapitaninternet 10:8892a1436342 11 AnalogIn ain(A0);
kapitaninternet 11:60c50eae8b81 12 DigitalOut led1(LED1);
kapitaninternet 11:60c50eae8b81 13 DigitalOut wifiLed(LED3);
kapitaninternet 9:c206c33736fe 14
kapitaninternet 9:c206c33736fe 15 /* Instantiate the expansion board */
kapitaninternet 9:c206c33736fe 16 static XNucleoIKS01A2 *mems_expansion_board = XNucleoIKS01A2::instance(D14, D15, D4, D5);
kapitaninternet 9:c206c33736fe 17
kapitaninternet 9:c206c33736fe 18 /* Retrieve the composing elements of the expansion board */
kapitaninternet 9:c206c33736fe 19 static HTS221Sensor *hum_temp = mems_expansion_board->ht_sensor;
kapitaninternet 9:c206c33736fe 20 static LPS22HBSensor *press_temp = mems_expansion_board->pt_sensor;
kapitaninternet 9:c206c33736fe 21
kapitaninternet 10:8892a1436342 22 // Cayenne authentication info. This should be obtained from the Cayenne Dashboard.
kapitaninternet 10:8892a1436342 23 char* username = "68880f30-7425-11e9-beb3-736c9e4bf7d0";
kapitaninternet 10:8892a1436342 24 char* password = "19f07b4d8806fe42bdda724980634f39d8e639ba";
kapitaninternet 10:8892a1436342 25 char* clientID = "bb8e7cc0-74b9-11e9-94e9-493d67fd755e";
kapitaninternet 10:8892a1436342 26
kapitaninternet 10:8892a1436342 27 // WiFi network info.
kapitaninternet 10:8892a1436342 28 char* ssid = "Interneto";
kapitaninternet 10:8892a1436342 29 char* wifiPassword = "matu1234";
kapitaninternet 10:8892a1436342 30
kapitaninternet 9:c206c33736fe 31 /* Helper function for printing floats & doubles */
kapitaninternet 9:c206c33736fe 32 static char *print_double(char* str, double v, int decimalDigits=2)
kapitaninternet 9:c206c33736fe 33 {
kapitaninternet 9:c206c33736fe 34 int i = 1;
kapitaninternet 9:c206c33736fe 35 int intPart, fractPart;
kapitaninternet 9:c206c33736fe 36 int len;
kapitaninternet 9:c206c33736fe 37 char *ptr;
kapitaninternet 9:c206c33736fe 38
kapitaninternet 9:c206c33736fe 39 /* prepare decimal digits multiplicator */
kapitaninternet 9:c206c33736fe 40 for (;decimalDigits!=0; i*=10, decimalDigits--);
kapitaninternet 9:c206c33736fe 41
kapitaninternet 9:c206c33736fe 42 /* calculate integer & fractinal parts */
kapitaninternet 9:c206c33736fe 43 intPart = (int)v;
kapitaninternet 9:c206c33736fe 44 fractPart = (int)((v-(double)(int)v)*i);
kapitaninternet 9:c206c33736fe 45
kapitaninternet 9:c206c33736fe 46 /* fill in integer part */
kapitaninternet 9:c206c33736fe 47 sprintf(str, "%i.", intPart);
kapitaninternet 9:c206c33736fe 48
kapitaninternet 9:c206c33736fe 49 /* prepare fill in of fractional part */
kapitaninternet 9:c206c33736fe 50 len = strlen(str);
kapitaninternet 9:c206c33736fe 51 ptr = &str[len];
kapitaninternet 9:c206c33736fe 52
kapitaninternet 9:c206c33736fe 53 /* fill in leading fractional zeros */
kapitaninternet 9:c206c33736fe 54 for (i/=10;i>1; i/=10, ptr++) {
kapitaninternet 9:c206c33736fe 55 if (fractPart >= i) {
kapitaninternet 9:c206c33736fe 56 break;
kapitaninternet 9:c206c33736fe 57 }
kapitaninternet 9:c206c33736fe 58 *ptr = '0';
kapitaninternet 9:c206c33736fe 59 }
kapitaninternet 9:c206c33736fe 60
kapitaninternet 9:c206c33736fe 61 /* fill in (rest of) fractional part */
kapitaninternet 9:c206c33736fe 62 sprintf(ptr, "%i", fractPart);
kapitaninternet 9:c206c33736fe 63
kapitaninternet 9:c206c33736fe 64 return str;
kapitaninternet 9:c206c33736fe 65 }
kapitaninternet 9:c206c33736fe 66
kapitaninternet 9:c206c33736fe 67 /**
kapitaninternet 9:c206c33736fe 68 * Write a Ndef URI message linking to st.com site.
kapitaninternet 9:c206c33736fe 69 * Write an NDef message with a Uri record linking the st.com site
kapitaninternet 9:c206c33736fe 70 * @param nfcNucleo expansion board where write the NDef message
kapitaninternet 9:c206c33736fe 71 */
kapitaninternet 9:c206c33736fe 72
jburhenn 0:d20655cd1f3c 73 SpwfSAInterface interface(D8, D2); // TX, RX
jburhenn 0:d20655cd1f3c 74 MQTTNetwork<SpwfSAInterface> network(interface);
jburhenn 2:445f09de09bd 75 CayenneMQTT::MQTTClient<MQTTNetwork<SpwfSAInterface>, MQTTTimer> mqttClient(network, username, password, clientID);
jburhenn 0:d20655cd1f3c 76
jburhenn 0:d20655cd1f3c 77 /**
jburhenn 0:d20655cd1f3c 78 * Print the message info.
jburhenn 0:d20655cd1f3c 79 * @param[in] message The message received from the Cayenne server.
jburhenn 0:d20655cd1f3c 80 */
jburhenn 2:445f09de09bd 81 void outputMessage(CayenneMQTT::MessageData& message)
jburhenn 0:d20655cd1f3c 82 {
jburhenn 0:d20655cd1f3c 83 switch (message.topic) {
jburhenn 0:d20655cd1f3c 84 case COMMAND_TOPIC:
jburhenn 0:d20655cd1f3c 85 printf("topic=Command");
jburhenn 0:d20655cd1f3c 86 break;
jburhenn 0:d20655cd1f3c 87 case CONFIG_TOPIC:
jburhenn 0:d20655cd1f3c 88 printf("topic=Config");
jburhenn 0:d20655cd1f3c 89 break;
jburhenn 0:d20655cd1f3c 90 default:
jburhenn 0:d20655cd1f3c 91 printf("topic=%d", message.topic);
jburhenn 0:d20655cd1f3c 92 break;
jburhenn 0:d20655cd1f3c 93 }
jburhenn 0:d20655cd1f3c 94 printf(" channel=%d", message.channel);
jburhenn 0:d20655cd1f3c 95 if (message.clientID) {
jburhenn 0:d20655cd1f3c 96 printf(" clientID=%s", message.clientID);
jburhenn 0:d20655cd1f3c 97 }
jburhenn 0:d20655cd1f3c 98 if (message.type) {
jburhenn 0:d20655cd1f3c 99 printf(" type=%s", message.type);
jburhenn 0:d20655cd1f3c 100 }
jburhenn 0:d20655cd1f3c 101 for (size_t i = 0; i < message.valueCount; ++i) {
jburhenn 2:445f09de09bd 102 if (message.getValue(i)) {
jburhenn 2:445f09de09bd 103 printf(" value=%s", message.getValue(i));
jburhenn 0:d20655cd1f3c 104 }
jburhenn 2:445f09de09bd 105 if (message.getUnit(i)) {
jburhenn 2:445f09de09bd 106 printf(" unit=%s", message.getUnit(i));
jburhenn 0:d20655cd1f3c 107 }
jburhenn 0:d20655cd1f3c 108 }
jburhenn 0:d20655cd1f3c 109 if (message.id) {
jburhenn 0:d20655cd1f3c 110 printf(" id=%s", message.id);
jburhenn 0:d20655cd1f3c 111 }
jburhenn 0:d20655cd1f3c 112 printf("\n");
jburhenn 0:d20655cd1f3c 113 }
jburhenn 0:d20655cd1f3c 114
jburhenn 0:d20655cd1f3c 115 /**
jburhenn 0:d20655cd1f3c 116 * Handle messages received from the Cayenne server.
jburhenn 0:d20655cd1f3c 117 * @param[in] message The message received from the Cayenne server.
jburhenn 0:d20655cd1f3c 118 */
jburhenn 2:445f09de09bd 119 void messageArrived(CayenneMQTT::MessageData& message)
jburhenn 0:d20655cd1f3c 120 {
jburhenn 0:d20655cd1f3c 121 int error = 0;
jburhenn 0:d20655cd1f3c 122 // Add code to process the message. Here we just ouput the message data.
jburhenn 0:d20655cd1f3c 123 outputMessage(message);
jburhenn 0:d20655cd1f3c 124
jburhenn 1:a2d8aec2bb92 125 if (message.topic == COMMAND_TOPIC) {
jburhenn 1:a2d8aec2bb92 126 switch(message.channel) {
jburhenn 1:a2d8aec2bb92 127 case 0:
jburhenn 1:a2d8aec2bb92 128 // Set the onboard LED state
jburhenn 2:445f09de09bd 129 led1 = atoi(message.getValue());
jburhenn 1:a2d8aec2bb92 130 // Publish the updated LED state
jburhenn 2:445f09de09bd 131 if ((error = mqttClient.publishData(DATA_TOPIC, message.channel, NULL, NULL, message.getValue())) != CAYENNE_SUCCESS) {
jburhenn 1:a2d8aec2bb92 132 printf("Publish LED state failure, error: %d\n", error);
jburhenn 1:a2d8aec2bb92 133 }
jburhenn 1:a2d8aec2bb92 134 break;
jburhenn 1:a2d8aec2bb92 135 }
jburhenn 1:a2d8aec2bb92 136
jburhenn 1:a2d8aec2bb92 137 // If this is a command message we publish a response. Here we are just sending a default 'OK' response.
jburhenn 1:a2d8aec2bb92 138 // An error response should be sent if there are issues processing the message.
jburhenn 4:939f308d004a 139 if ((error = mqttClient.publishResponse(message.id, NULL, message.clientID)) != CAYENNE_SUCCESS) {
jburhenn 1:a2d8aec2bb92 140 printf("Response failure, error: %d\n", error);
jburhenn 1:a2d8aec2bb92 141 }
jburhenn 0:d20655cd1f3c 142 }
jburhenn 0:d20655cd1f3c 143 }
jburhenn 0:d20655cd1f3c 144
jburhenn 0:d20655cd1f3c 145 /**
jburhenn 0:d20655cd1f3c 146 * Connect to the Cayenne server.
jburhenn 0:d20655cd1f3c 147 * @return Returns CAYENNE_SUCCESS if the connection succeeds, or an error code otherwise.
jburhenn 0:d20655cd1f3c 148 */
jburhenn 0:d20655cd1f3c 149 int connectClient(void)
jburhenn 0:d20655cd1f3c 150 {
jburhenn 0:d20655cd1f3c 151 int error = 0;
jburhenn 0:d20655cd1f3c 152 // Connect to the server.
jburhenn 0:d20655cd1f3c 153 printf("Connecting to %s:%d\n", CAYENNE_DOMAIN, CAYENNE_PORT);
jburhenn 0:d20655cd1f3c 154 while ((error = network.connect(CAYENNE_DOMAIN, CAYENNE_PORT)) != 0) {
jburhenn 0:d20655cd1f3c 155 printf("TCP connect failed, error: %d\n", error);
jburhenn 0:d20655cd1f3c 156 wait(2);
jburhenn 0:d20655cd1f3c 157 }
jburhenn 0:d20655cd1f3c 158
jburhenn 2:445f09de09bd 159 if ((error = mqttClient.connect()) != MQTT::SUCCESS) {
jburhenn 0:d20655cd1f3c 160 printf("MQTT connect failed, error: %d\n", error);
jburhenn 0:d20655cd1f3c 161 return error;
jburhenn 0:d20655cd1f3c 162 }
jburhenn 0:d20655cd1f3c 163 printf("Connected\n");
jburhenn 0:d20655cd1f3c 164
jburhenn 0:d20655cd1f3c 165 // Subscribe to required topics.
jburhenn 0:d20655cd1f3c 166 if ((error = mqttClient.subscribe(COMMAND_TOPIC, CAYENNE_ALL_CHANNELS)) != CAYENNE_SUCCESS) {
jburhenn 0:d20655cd1f3c 167 printf("Subscription to Command topic failed, error: %d\n", error);
jburhenn 0:d20655cd1f3c 168 }
jburhenn 0:d20655cd1f3c 169 if ((error = mqttClient.subscribe(CONFIG_TOPIC, CAYENNE_ALL_CHANNELS)) != CAYENNE_SUCCESS) {
jburhenn 0:d20655cd1f3c 170 printf("Subscription to Config topic failed, error:%d\n", error);
jburhenn 0:d20655cd1f3c 171 }
jburhenn 0:d20655cd1f3c 172
jburhenn 0:d20655cd1f3c 173 // Send device info. Here we just send some example values for the system info. These should be changed to use actual system data, or removed if not needed.
jburhenn 0:d20655cd1f3c 174 mqttClient.publishData(SYS_VERSION_TOPIC, CAYENNE_NO_CHANNEL, NULL, NULL, CAYENNE_VERSION);
jburhenn 0:d20655cd1f3c 175 mqttClient.publishData(SYS_MODEL_TOPIC, CAYENNE_NO_CHANNEL, NULL, NULL, "mbedDevice");
jburhenn 2:445f09de09bd 176 //mqttClient.publishData(SYS_CPU_MODEL_TOPIC, CAYENNE_NO_CHANNEL, NULL, NULL, "CPU Model");
jburhenn 2:445f09de09bd 177 //mqttClient.publishData(SYS_CPU_SPEED_TOPIC, CAYENNE_NO_CHANNEL, NULL, NULL, "1000000000");
jburhenn 0:d20655cd1f3c 178
jburhenn 0:d20655cd1f3c 179 return CAYENNE_SUCCESS;
jburhenn 0:d20655cd1f3c 180 }
jburhenn 0:d20655cd1f3c 181
jburhenn 0:d20655cd1f3c 182 /**
jburhenn 0:d20655cd1f3c 183 * Main loop where MQTT code is run.
jburhenn 0:d20655cd1f3c 184 */
jburhenn 0:d20655cd1f3c 185 void loop(void)
jburhenn 0:d20655cd1f3c 186 {
kapitaninternet 11:60c50eae8b81 187 if(network.connected())
kapitaninternet 11:60c50eae8b81 188 {
kapitaninternet 11:60c50eae8b81 189 wifiLed = 1;
kapitaninternet 11:60c50eae8b81 190 } else
kapitaninternet 11:60c50eae8b81 191 {
kapitaninternet 11:60c50eae8b81 192 wifiLed = 0;
kapitaninternet 11:60c50eae8b81 193 }
kapitaninternet 11:60c50eae8b81 194
jburhenn 7:78cefe0937ab 195 // Start the countdown timer for publishing data every 5 seconds. Change the timeout parameter to publish at a different interval.
kapitaninternet 11:60c50eae8b81 196 MQTTTimer timer(2500);
jburhenn 0:d20655cd1f3c 197
jburhenn 0:d20655cd1f3c 198 while (true) {
jburhenn 0:d20655cd1f3c 199 // Yield to allow MQTT message processing.
jburhenn 0:d20655cd1f3c 200 mqttClient.yield(1000);
jburhenn 0:d20655cd1f3c 201
jburhenn 0:d20655cd1f3c 202 // Check that we are still connected, if not, reconnect.
jburhenn 0:d20655cd1f3c 203 if (!network.connected() || !mqttClient.connected()) {
jburhenn 0:d20655cd1f3c 204 network.disconnect();
jburhenn 0:d20655cd1f3c 205 mqttClient.disconnect();
jburhenn 0:d20655cd1f3c 206 printf("Reconnecting\n");
jburhenn 0:d20655cd1f3c 207 while (connectClient() != CAYENNE_SUCCESS) {
jburhenn 0:d20655cd1f3c 208 wait(2);
jburhenn 0:d20655cd1f3c 209 printf("Reconnect failed, retrying\n");
jburhenn 0:d20655cd1f3c 210 }
jburhenn 0:d20655cd1f3c 211 }
jburhenn 0:d20655cd1f3c 212
jburhenn 0:d20655cd1f3c 213 // Publish some example data every few seconds. This should be changed to send your actual data to Cayenne.
jburhenn 0:d20655cd1f3c 214 if (timer.expired()) {
jburhenn 0:d20655cd1f3c 215 int error = 0;
kapitaninternet 9:c206c33736fe 216
kapitaninternet 10:8892a1436342 217 uint8_t id;
kapitaninternet 10:8892a1436342 218 float value1, value2;
kapitaninternet 10:8892a1436342 219 char buffer1[32], buffer2[32];
kapitaninternet 9:c206c33736fe 220
kapitaninternet 10:8892a1436342 221 /* Enable all sensors */
kapitaninternet 10:8892a1436342 222 hum_temp->enable();
kapitaninternet 10:8892a1436342 223 press_temp->enable();
kapitaninternet 10:8892a1436342 224
kapitaninternet 10:8892a1436342 225
kapitaninternet 10:8892a1436342 226 hum_temp->read_id(&id);
kapitaninternet 10:8892a1436342 227 printf("HTS221 humidity & temperature = 0x%X\r\n", id);
kapitaninternet 10:8892a1436342 228 press_temp->read_id(&id);
kapitaninternet 10:8892a1436342 229 printf("LPS22HB pressure & temperature = 0x%X\r\n", id);
kapitaninternet 9:c206c33736fe 230
kapitaninternet 10:8892a1436342 231 printf("\r\n");
kapitaninternet 10:8892a1436342 232 hum_temp->get_temperature(&value1);
kapitaninternet 10:8892a1436342 233 hum_temp->get_humidity(&value2);
kapitaninternet 10:8892a1436342 234 printf("HTS221: [temp] %7s C, [hum] %s%%\r\n", print_double(buffer1, value1), print_double(buffer2, value2));
kapitaninternet 10:8892a1436342 235
kapitaninternet 10:8892a1436342 236 press_temp->get_temperature(&value1);
kapitaninternet 10:8892a1436342 237 press_temp->get_pressure(&value2);
kapitaninternet 10:8892a1436342 238 printf("LPS22HB: [temp] %7s C, [press] %s mbar\r\n", print_double(buffer1, value1), print_double(buffer2, value2));
kapitaninternet 10:8892a1436342 239 float voltage_read = ain.read();
kapitaninternet 10:8892a1436342 240 printf("---\r\n");
kapitaninternet 9:c206c33736fe 241
kapitaninternet 9:c206c33736fe 242 if ((error = mqttClient.publishData(DATA_TOPIC, 1, TYPE_TEMPERATURE, UNIT_CELSIUS, value1)) != CAYENNE_SUCCESS) {
jburhenn 0:d20655cd1f3c 243 printf("Publish temperature failed, error: %d\n", error);
jburhenn 0:d20655cd1f3c 244 }
kapitaninternet 10:8892a1436342 245
kapitaninternet 10:8892a1436342 246 if ((error = mqttClient.publishData(DATA_TOPIC, 3, TYPE_VOLTAGE, UNIT_VOLTS, voltage_read)) != CAYENNE_SUCCESS) {
kapitaninternet 10:8892a1436342 247 printf("Publish voltage failed, error: %d\n", error);
kapitaninternet 10:8892a1436342 248 }
kapitaninternet 9:c206c33736fe 249
kapitaninternet 9:c206c33736fe 250 if ((error = mqttClient.publishData(DATA_TOPIC, 2, TYPE_BAROMETRIC_PRESSURE, UNIT_HECTOPASCAL, value2)) != CAYENNE_SUCCESS) {
jburhenn 0:d20655cd1f3c 251 printf("Publish barometric pressure failed, error: %d\n", error);
jburhenn 0:d20655cd1f3c 252 }
kapitaninternet 9:c206c33736fe 253 // Restart the countdown timer for publishing data every 2 seconds. Change the timeout parameter to publish at a different interval.
kapitaninternet 9:c206c33736fe 254 timer.countdown_ms(2000);
jburhenn 0:d20655cd1f3c 255 }
jburhenn 0:d20655cd1f3c 256 }
jburhenn 0:d20655cd1f3c 257 }
jburhenn 0:d20655cd1f3c 258
jburhenn 0:d20655cd1f3c 259 /**
jburhenn 0:d20655cd1f3c 260 * Main function.
jburhenn 0:d20655cd1f3c 261 */
jburhenn 0:d20655cd1f3c 262 int main()
jburhenn 0:d20655cd1f3c 263 {
kapitaninternet 10:8892a1436342 264 printf("Initializing interface\n");
jburhenn 0:d20655cd1f3c 265 interface.connect(ssid, wifiPassword, NSAPI_SECURITY_WPA2);
jburhenn 0:d20655cd1f3c 266
jburhenn 0:d20655cd1f3c 267 // Set the default function that receives Cayenne messages.
jburhenn 0:d20655cd1f3c 268 mqttClient.setDefaultMessageHandler(messageArrived);
jburhenn 0:d20655cd1f3c 269
jburhenn 0:d20655cd1f3c 270 // Connect to Cayenne.
jburhenn 0:d20655cd1f3c 271 if (connectClient() == CAYENNE_SUCCESS) {
jburhenn 0:d20655cd1f3c 272 // Run main loop.
jburhenn 0:d20655cd1f3c 273 loop();
jburhenn 0:d20655cd1f3c 274 }
jburhenn 0:d20655cd1f3c 275 else {
jburhenn 0:d20655cd1f3c 276 printf("Connection failed, exiting\n");
jburhenn 0:d20655cd1f3c 277 }
jburhenn 0:d20655cd1f3c 278
jburhenn 0:d20655cd1f3c 279 if (mqttClient.connected())
jburhenn 0:d20655cd1f3c 280 mqttClient.disconnect();
jburhenn 0:d20655cd1f3c 281 if (network.connected())
jburhenn 0:d20655cd1f3c 282 network.disconnect();
kapitaninternet 9:c206c33736fe 283 return 0;
jburhenn 0:d20655cd1f3c 284
kapitaninternet 10:8892a1436342 285 }