Code Sample for ERS4 GEII UNICE ERS4

Dependencies:   C12832 EthernetInterface LM75B MMA7660 MQTT mbed-rtos mbed

Fork of DU4SmartCities by Philippe Bazot

Committer:
bazot
Date:
Thu Jan 25 11:15:06 2018 +0000
Revision:
20:3045570c01ff
Parent:
19:48522ea6acef
Firts version for GEII ERS4

Who changed what in which revision?

UserRevisionLine numberNew contents of line
samdanbury 6:37b6d0d56190 1 /*******************************************************************************
bazot 20:3045570c01ff 2 * Copyright (c) 2014, 2015, 2016, 2017 IBM Corp.
samdanbury 6:37b6d0d56190 3 *
samdanbury 6:37b6d0d56190 4 * All rights reserved. This program and the accompanying materials
samdanbury 6:37b6d0d56190 5 * are made available under the terms of the Eclipse Public License v1.0
samdanbury 6:37b6d0d56190 6 * and Eclipse Distribution License v1.0 which accompany this distribution.
samdanbury 6:37b6d0d56190 7 *
samdanbury 6:37b6d0d56190 8 * The Eclipse Public License is available at
samdanbury 6:37b6d0d56190 9 * http://www.eclipse.org/legal/epl-v10.html
samdanbury 6:37b6d0d56190 10 * and the Eclipse Distribution License is available at
samdanbury 6:37b6d0d56190 11 * http://www.eclipse.org/org/documents/edl-v10.php.
samdanbury 6:37b6d0d56190 12 *
samdanbury 6:37b6d0d56190 13 * Contributors:
samdanbury 6:37b6d0d56190 14 * Sam Danbury - initial implementation
samdanbury 6:37b6d0d56190 15 * Ian Craggs - refactoring to remove STL and other changes
icraggs 8:80d49dd91542 16 * Sam Grove - added check for Ethernet cable.
chris 10:0b5e0dfee08e 17 * Chris Styles - Added additional menu screen for software revision
icraggs 16:2420bfbf5f1c 18 * James Sutton - Mac fix and extra debug
icraggs 16:2420bfbf5f1c 19 * Ian Craggs - add not authorized messages
chris 10:0b5e0dfee08e 20 *
chris 10:0b5e0dfee08e 21 * To do :
chris 10:0b5e0dfee08e 22 * Add magnetometer sensor output to IoT data stream
chris 10:0b5e0dfee08e 23 *
samdanbury 6:37b6d0d56190 24 *******************************************************************************/
samdanbury 6:37b6d0d56190 25
samdanbury 6:37b6d0d56190 26 #include "LM75B.h"
samdanbury 6:37b6d0d56190 27 #include "MMA7660.h"
samdanbury 6:37b6d0d56190 28 #include "MQTTClient.h"
samdanbury 6:37b6d0d56190 29 #include "MQTTEthernet.h"
samdanbury 6:37b6d0d56190 30 #include "C12832.h"
samdanbury 6:37b6d0d56190 31 #include "Arial12x12.h"
samdanbury 6:37b6d0d56190 32 #include "rtos.h"
samdanbury 6:37b6d0d56190 33
chris 10:0b5e0dfee08e 34 // Update this to the next number *before* a commit
icraggs 18:94da9de96d54 35 #define __APP_SW_REVISION__ "18"
chris 10:0b5e0dfee08e 36
samdanbury 6:37b6d0d56190 37 // Configuration values needed to connect to IBM IoT Cloud
bazot 20:3045570c01ff 38 #define ORG "" // For a registered connection, replace with your org
bazot 20:3045570c01ff 39 #define ID "" // For a registered connection, replace with your id
bazot 20:3045570c01ff 40 #define AUTH_TOKEN "" // For a registered connection, replace with your auth-token
bazot 20:3045570c01ff 41 #define TYPE "" // For a registered connection, replace with your type
bazot 20:3045570c01ff 42 #define DEVICE_NAME "" // Replace with your own name
bazot 20:3045570c01ff 43 // End Of Configuration values needed to connect to IBM IoT Cloud
samdanbury 6:37b6d0d56190 44
samdanbury 6:37b6d0d56190 45 #define MQTT_PORT 1883
samdanbury 6:37b6d0d56190 46 #define MQTT_TLS_PORT 8883
samdanbury 6:37b6d0d56190 47 #define IBM_IOT_PORT MQTT_PORT
samdanbury 6:37b6d0d56190 48
samdanbury 6:37b6d0d56190 49 #define MQTT_MAX_PACKET_SIZE 250
samdanbury 6:37b6d0d56190 50
mazgch 11:7a6df9a2dcdc 51 #if defined(TARGET_UBLOX_C027)
mazgch 11:7a6df9a2dcdc 52 #warning "Compiling for mbed C027"
mazgch 11:7a6df9a2dcdc 53 #include "C027.h"
mazgch 11:7a6df9a2dcdc 54 #elif defined(TARGET_LPC1768)
samdanbury 6:37b6d0d56190 55 #warning "Compiling for mbed LPC1768"
samdanbury 6:37b6d0d56190 56 #include "LPC1768.h"
samdanbury 6:37b6d0d56190 57 #elif defined(TARGET_K64F)
samdanbury 6:37b6d0d56190 58 #warning "Compiling for mbed K64F"
samdanbury 6:37b6d0d56190 59 #include "K64F.h"
samdanbury 6:37b6d0d56190 60 #endif
samdanbury 6:37b6d0d56190 61
jsutton 14:1f961d19f3cf 62
bazot 19:48522ea6acef 63 bool quickstartMode = false;
samdanbury 6:37b6d0d56190 64 char org[11] = ORG;
samdanbury 6:37b6d0d56190 65 char type[30] = TYPE;
samdanbury 6:37b6d0d56190 66 char id[30] = ID; // mac without colons
samdanbury 6:37b6d0d56190 67 char auth_token[30] = AUTH_TOKEN; // Auth_token is only used in non-quickstart mode
samdanbury 6:37b6d0d56190 68
samdanbury 6:37b6d0d56190 69 bool connected = false;
jsutton 14:1f961d19f3cf 70 bool mqttConnecting = false;
jsutton 14:1f961d19f3cf 71 bool netConnected = false;
jsutton 14:1f961d19f3cf 72 bool netConnecting = false;
jsutton 14:1f961d19f3cf 73 bool ethernetInitialising = true;
icraggs 16:2420bfbf5f1c 74 int connack_rc = 0; // MQTT connack return code
jsutton 14:1f961d19f3cf 75 int retryAttempt = 0;
jsutton 14:1f961d19f3cf 76 int menuItem = 0;
jsutton 14:1f961d19f3cf 77
samdanbury 6:37b6d0d56190 78 char* joystickPos = "CENTRE";
samdanbury 6:37b6d0d56190 79 int blink_interval = 0;
samdanbury 6:37b6d0d56190 80
jsutton 13:85801e3b83d3 81 char* ip_addr = "";
jsutton 13:85801e3b83d3 82 char* gateway_addr = "";
jsutton 14:1f961d19f3cf 83 char* host_addr = "";
jsutton 14:1f961d19f3cf 84 int connectTimeout = 1000;
jsutton 14:1f961d19f3cf 85
jsutton 14:1f961d19f3cf 86 // If we wanted to manually set the MAC address,
jsutton 14:1f961d19f3cf 87 // this is how to do it. In this example, we take
jsutton 14:1f961d19f3cf 88 // the original Mbed Set MAC address and combine it
jsutton 14:1f961d19f3cf 89 // with a prefix of our choosing.
jsutton 14:1f961d19f3cf 90 /*
jsutton 14:1f961d19f3cf 91 extern "C" void $Super$$mbed_mac_address(char *s);
jsutton 14:1f961d19f3cf 92 extern "C" void $Sub$$mbed_mac_address(char *s)
jsutton 14:1f961d19f3cf 93 {
jsutton 15:09458079f4bb 94 char originalMAC[6] = "";
jsutton 15:09458079f4bb 95 $Super$$mbed_mac_address(originalMAC);
jsutton 14:1f961d19f3cf 96
jsutton 14:1f961d19f3cf 97 char mac[6];
jsutton 14:1f961d19f3cf 98 mac[0] = 0x00;
jsutton 14:1f961d19f3cf 99 mac[1] = 0x08;
jsutton 14:1f961d19f3cf 100 mac[2] = 0xdc;
jsutton 15:09458079f4bb 101 mac[3] = originalMAC[3];
jsutton 15:09458079f4bb 102 mac[4] = originalMAC[4];
jsutton 15:09458079f4bb 103 mac[5] = originalMAC[5];
jsutton 14:1f961d19f3cf 104 memcpy(s, mac, 6);
jsutton 14:1f961d19f3cf 105 }
jsutton 14:1f961d19f3cf 106 */
jsutton 13:85801e3b83d3 107
samdanbury 6:37b6d0d56190 108
samdanbury 6:37b6d0d56190 109 void off()
samdanbury 6:37b6d0d56190 110 {
samdanbury 6:37b6d0d56190 111 r = g = b = 1.0; // 1 is off, 0 is full brightness
samdanbury 6:37b6d0d56190 112 }
samdanbury 6:37b6d0d56190 113
samdanbury 6:37b6d0d56190 114 void red()
samdanbury 6:37b6d0d56190 115 {
samdanbury 6:37b6d0d56190 116 r = 0.7; g = 1.0; b = 1.0; // 1 is off, 0 is full brightness
samdanbury 6:37b6d0d56190 117 }
samdanbury 6:37b6d0d56190 118
samdanbury 6:37b6d0d56190 119 void yellow()
samdanbury 6:37b6d0d56190 120 {
samdanbury 6:37b6d0d56190 121 r = 0.7; g = 0.7; b = 1.0; // 1 is off, 0 is full brightness
samdanbury 6:37b6d0d56190 122 }
samdanbury 6:37b6d0d56190 123
samdanbury 6:37b6d0d56190 124 void green()
samdanbury 6:37b6d0d56190 125 {
samdanbury 6:37b6d0d56190 126 r = 1.0; g = 0.7; b = 1.0; // 1 is off, 0 is full brightness
samdanbury 6:37b6d0d56190 127 }
samdanbury 6:37b6d0d56190 128
samdanbury 6:37b6d0d56190 129
samdanbury 6:37b6d0d56190 130 void flashing_yellow(void const *args)
samdanbury 6:37b6d0d56190 131 {
samdanbury 6:37b6d0d56190 132 bool on = false;
icraggs 16:2420bfbf5f1c 133 while (!connected && connack_rc != MQTT_NOT_AUTHORIZED && connack_rc != MQTT_BAD_USERNAME_OR_PASSWORD) // flashing yellow only while connecting
samdanbury 6:37b6d0d56190 134 {
samdanbury 6:37b6d0d56190 135 on = !on;
samdanbury 6:37b6d0d56190 136 if (on)
samdanbury 6:37b6d0d56190 137 yellow();
samdanbury 6:37b6d0d56190 138 else
samdanbury 6:37b6d0d56190 139 off();
samdanbury 6:37b6d0d56190 140 wait(0.5);
samdanbury 6:37b6d0d56190 141 }
samdanbury 6:37b6d0d56190 142 }
samdanbury 6:37b6d0d56190 143
samdanbury 6:37b6d0d56190 144
samdanbury 6:37b6d0d56190 145 void flashing_red(void const *args) // to be used when the connection is lost
samdanbury 6:37b6d0d56190 146 {
samdanbury 6:37b6d0d56190 147 bool on = false;
samdanbury 6:37b6d0d56190 148 while (!connected)
samdanbury 6:37b6d0d56190 149 {
samdanbury 6:37b6d0d56190 150 on = !on;
samdanbury 6:37b6d0d56190 151 if (on)
samdanbury 6:37b6d0d56190 152 red();
samdanbury 6:37b6d0d56190 153 else
samdanbury 6:37b6d0d56190 154 off();
samdanbury 6:37b6d0d56190 155 wait(2.0);
samdanbury 6:37b6d0d56190 156 }
samdanbury 6:37b6d0d56190 157 }
samdanbury 6:37b6d0d56190 158
samdanbury 6:37b6d0d56190 159
samdanbury 6:37b6d0d56190 160 void printMenu(int menuItem)
samdanbury 6:37b6d0d56190 161 {
icraggs 18:94da9de96d54 162 static char last_line1[30] = "", last_line2[30] = "";
icraggs 18:94da9de96d54 163 char line1[30] = "", line2[30] = "";
icraggs 18:94da9de96d54 164
samdanbury 6:37b6d0d56190 165 switch (menuItem)
samdanbury 6:37b6d0d56190 166 {
samdanbury 6:37b6d0d56190 167 case 0:
icraggs 18:94da9de96d54 168 sprintf(line1, "IBM IoT Cloud");
icraggs 18:94da9de96d54 169 sprintf(line2, "Scroll with joystick");
samdanbury 6:37b6d0d56190 170 break;
samdanbury 6:37b6d0d56190 171 case 1:
icraggs 18:94da9de96d54 172 sprintf(line1, "Go to:");
icraggs 18:94da9de96d54 173 sprintf(line2, "http://ibm.biz/iotqstart");
samdanbury 6:37b6d0d56190 174 break;
samdanbury 6:37b6d0d56190 175 case 2:
icraggs 18:94da9de96d54 176 sprintf(line1, "Device Identity:");
icraggs 18:94da9de96d54 177 sprintf(line2, "%s", id);
samdanbury 6:37b6d0d56190 178 break;
samdanbury 6:37b6d0d56190 179 case 3:
icraggs 18:94da9de96d54 180 sprintf(line1, "MQTT Status:");
icraggs 16:2420bfbf5f1c 181 if (mqttConnecting)
icraggs 18:94da9de96d54 182 sprintf(line2, "Connecting... %d/5", retryAttempt);
icraggs 16:2420bfbf5f1c 183 else
icraggs 16:2420bfbf5f1c 184 {
icraggs 16:2420bfbf5f1c 185 if (connected)
icraggs 18:94da9de96d54 186 sprintf(line2, "Connected");
icraggs 16:2420bfbf5f1c 187 else
icraggs 16:2420bfbf5f1c 188 {
icraggs 16:2420bfbf5f1c 189 switch (connack_rc)
icraggs 16:2420bfbf5f1c 190 {
icraggs 16:2420bfbf5f1c 191 case MQTT_CLIENTID_REJECTED:
icraggs 18:94da9de96d54 192 sprintf(line2, "Clientid rejected");
icraggs 16:2420bfbf5f1c 193 break;
icraggs 16:2420bfbf5f1c 194 case MQTT_BAD_USERNAME_OR_PASSWORD:
icraggs 18:94da9de96d54 195 sprintf(line2, "Invalid username or password");
icraggs 16:2420bfbf5f1c 196 break;
icraggs 16:2420bfbf5f1c 197 case MQTT_NOT_AUTHORIZED:
icraggs 18:94da9de96d54 198 sprintf(line2, "Not authorized");
icraggs 16:2420bfbf5f1c 199 break;
icraggs 16:2420bfbf5f1c 200 default:
icraggs 18:94da9de96d54 201 sprintf(line2, "Disconnected");
icraggs 16:2420bfbf5f1c 202 }
icraggs 16:2420bfbf5f1c 203 }
jsutton 14:1f961d19f3cf 204 }
samdanbury 6:37b6d0d56190 205 break;
chris 10:0b5e0dfee08e 206 case 4:
icraggs 18:94da9de96d54 207 sprintf(line1, "Ethernet State:");
icraggs 18:94da9de96d54 208 sprintf(line2, ethernetInitialising ? "Initializing..." : "Initialized");
jsutton 14:1f961d19f3cf 209 break;
jsutton 14:1f961d19f3cf 210 case 5:
icraggs 18:94da9de96d54 211 sprintf(line1, "Socket State:");
icraggs 16:2420bfbf5f1c 212 if (netConnecting)
icraggs 18:94da9de96d54 213 sprintf(line2, "Connecting... %d/5", retryAttempt);
icraggs 16:2420bfbf5f1c 214 else
icraggs 18:94da9de96d54 215 sprintf(line2, netConnected ? "Connected" : "Disconnected");
jsutton 13:85801e3b83d3 216 break;
jsutton 14:1f961d19f3cf 217 case 6:
icraggs 18:94da9de96d54 218 sprintf(line1, "IP Address:");
icraggs 18:94da9de96d54 219 sprintf(line2, "%s", ip_addr);
jsutton 13:85801e3b83d3 220 break;
jsutton 14:1f961d19f3cf 221 case 7:
icraggs 18:94da9de96d54 222 sprintf(line1, "Gateway:");
icraggs 18:94da9de96d54 223 sprintf(line2, "%s", gateway_addr);
jsutton 13:85801e3b83d3 224 break;
jsutton 14:1f961d19f3cf 225 case 8:
icraggs 18:94da9de96d54 226 sprintf(line1, "App version:");
icraggs 18:94da9de96d54 227 sprintf(line2, "%s", __APP_SW_REVISION__);
chris 10:0b5e0dfee08e 228 break;
jsutton 14:1f961d19f3cf 229 case 9:
icraggs 18:94da9de96d54 230 sprintf(line1, "Current Timeout:");
icraggs 18:94da9de96d54 231 sprintf(line2, "%d ms", connectTimeout);
jsutton 14:1f961d19f3cf 232 break;
samdanbury 6:37b6d0d56190 233 }
icraggs 18:94da9de96d54 234
icraggs 18:94da9de96d54 235 if (strcmp(line1, last_line1) != 0 || strcmp(line2, last_line2) != 0)
icraggs 18:94da9de96d54 236 {
icraggs 18:94da9de96d54 237 lcd.cls();
icraggs 18:94da9de96d54 238 lcd.locate(0, 0);
icraggs 18:94da9de96d54 239 lcd.printf(line1);
icraggs 18:94da9de96d54 240 strncpy(last_line1, line1, sizeof(last_line1));
icraggs 18:94da9de96d54 241
icraggs 18:94da9de96d54 242 lcd.locate(0,16);
icraggs 18:94da9de96d54 243 lcd.printf(line2);
icraggs 18:94da9de96d54 244 strncpy(last_line2, line2, sizeof(last_line2));
icraggs 18:94da9de96d54 245 }
samdanbury 6:37b6d0d56190 246 }
samdanbury 6:37b6d0d56190 247
samdanbury 6:37b6d0d56190 248
samdanbury 6:37b6d0d56190 249 void setMenu()
samdanbury 6:37b6d0d56190 250 {
jsutton 14:1f961d19f3cf 251
samdanbury 6:37b6d0d56190 252 if (Down)
samdanbury 6:37b6d0d56190 253 {
samdanbury 6:37b6d0d56190 254 joystickPos = "DOWN";
jsutton 14:1f961d19f3cf 255 if (menuItem >= 0 && menuItem < 9)
samdanbury 6:37b6d0d56190 256 printMenu(++menuItem);
samdanbury 6:37b6d0d56190 257 }
samdanbury 6:37b6d0d56190 258 else if (Left)
samdanbury 6:37b6d0d56190 259 joystickPos = "LEFT";
samdanbury 6:37b6d0d56190 260 else if (Click)
samdanbury 6:37b6d0d56190 261 joystickPos = "CLICK";
samdanbury 6:37b6d0d56190 262 else if (Up)
samdanbury 6:37b6d0d56190 263 {
samdanbury 6:37b6d0d56190 264 joystickPos = "UP";
jsutton 14:1f961d19f3cf 265 if (menuItem <= 9 && menuItem > 0)
samdanbury 6:37b6d0d56190 266 printMenu(--menuItem);
samdanbury 6:37b6d0d56190 267 }
samdanbury 6:37b6d0d56190 268 else if (Right)
samdanbury 6:37b6d0d56190 269 joystickPos = "RIGHT";
samdanbury 6:37b6d0d56190 270 else
samdanbury 6:37b6d0d56190 271 joystickPos = "CENTRE";
samdanbury 6:37b6d0d56190 272 }
samdanbury 6:37b6d0d56190 273
jsutton 13:85801e3b83d3 274 void menu_loop(void const *args)
jsutton 13:85801e3b83d3 275 {
jsutton 14:1f961d19f3cf 276 int count = 0;
icraggs 16:2420bfbf5f1c 277 while(true)
icraggs 16:2420bfbf5f1c 278 {
jsutton 13:85801e3b83d3 279 setMenu();
icraggs 16:2420bfbf5f1c 280 if (++count % 10 == 0)
jsutton 14:1f961d19f3cf 281 printMenu(menuItem);
jsutton 14:1f961d19f3cf 282 Thread::wait(100);
jsutton 13:85801e3b83d3 283 }
jsutton 13:85801e3b83d3 284 }
jsutton 13:85801e3b83d3 285
samdanbury 6:37b6d0d56190 286
samdanbury 6:37b6d0d56190 287 /**
samdanbury 6:37b6d0d56190 288 * Display a message on the LCD screen prefixed with IBM IoT Cloud
samdanbury 6:37b6d0d56190 289 */
samdanbury 6:37b6d0d56190 290 void displayMessage(char* message)
samdanbury 6:37b6d0d56190 291 {
samdanbury 6:37b6d0d56190 292 lcd.cls();
samdanbury 6:37b6d0d56190 293 lcd.locate(0,0);
samdanbury 6:37b6d0d56190 294 lcd.printf("IBM IoT Cloud");
samdanbury 6:37b6d0d56190 295 lcd.locate(0,16);
samdanbury 6:37b6d0d56190 296 lcd.printf(message);
samdanbury 6:37b6d0d56190 297 }
samdanbury 6:37b6d0d56190 298
samdanbury 6:37b6d0d56190 299
samdanbury 6:37b6d0d56190 300 int connect(MQTT::Client<MQTTEthernet, Countdown, MQTT_MAX_PACKET_SIZE>* client, MQTTEthernet* ipstack)
bazot 20:3045570c01ff 301 {
bazot 20:3045570c01ff 302
bazot 20:3045570c01ff 303 // The following 3 lines of code are ONLY used when connected to IBM Cloud !
bazot 20:3045570c01ff 304 // const char* iot_ibm = ".messaging.internetofthings.ibmcloud.com";
bazot 20:3045570c01ff 305 // char hostname[strlen(org) + strlen(iot_ibm) + 1];
bazot 20:3045570c01ff 306 // sprintf(hostname, "%s%s", org, iot_ibm);
samdanbury 6:37b6d0d56190 307
bazot 20:3045570c01ff 308 //Instead, for a connection to a local PC, specify HERE BELOW the IP @ of the local PC!!!
bazot 20:3045570c01ff 309 char hostname[]="192.168.0.6";
bazot 20:3045570c01ff 310
bazot 20:3045570c01ff 311
bazot 20:3045570c01ff 312
jsutton 13:85801e3b83d3 313 EthernetInterface& eth = ipstack->getEth();
jsutton 13:85801e3b83d3 314 ip_addr = eth.getIPAddress();
jsutton 13:85801e3b83d3 315 gateway_addr = eth.getGateway();
jsutton 14:1f961d19f3cf 316
jsutton 14:1f961d19f3cf 317 // Construct clientId - d:org:type:id
jsutton 14:1f961d19f3cf 318 char clientId[strlen(org) + strlen(type) + strlen(id) + 5];
jsutton 14:1f961d19f3cf 319 sprintf(clientId, "d:%s:%s:%s", org, type, id);
jsutton 14:1f961d19f3cf 320
icraggs 16:2420bfbf5f1c 321 // Network debug statements
jsutton 14:1f961d19f3cf 322 LOG("=====================================\n");
jsutton 14:1f961d19f3cf 323 LOG("Connecting Ethernet.\n");
jsutton 14:1f961d19f3cf 324 LOG("IP ADDRESS: %s\n", eth.getIPAddress());
jsutton 14:1f961d19f3cf 325 LOG("MAC ADDRESS: %s\n", eth.getMACAddress());
jsutton 14:1f961d19f3cf 326 LOG("Gateway: %s\n", eth.getGateway());
jsutton 14:1f961d19f3cf 327 LOG("Network Mask: %s\n", eth.getNetworkMask());
jsutton 14:1f961d19f3cf 328 LOG("Server Hostname: %s\n", hostname);
jsutton 14:1f961d19f3cf 329 LOG("Client ID: %s\n", clientId);
jsutton 14:1f961d19f3cf 330 LOG("=====================================\n");
jsutton 14:1f961d19f3cf 331
jsutton 14:1f961d19f3cf 332 netConnecting = true;
jsutton 14:1f961d19f3cf 333 int rc = ipstack->connect(hostname, IBM_IOT_PORT, connectTimeout);
icraggs 16:2420bfbf5f1c 334 if (rc != 0)
icraggs 16:2420bfbf5f1c 335 {
icraggs 18:94da9de96d54 336 WARN("IP Stack connect returned: %d\n", rc);
samdanbury 6:37b6d0d56190 337 return rc;
jsutton 13:85801e3b83d3 338 }
jsutton 13:85801e3b83d3 339 netConnected = true;
jsutton 14:1f961d19f3cf 340 netConnecting = false;
jsutton 14:1f961d19f3cf 341
samdanbury 6:37b6d0d56190 342 // MQTT Connect
jsutton 14:1f961d19f3cf 343 mqttConnecting = true;
samdanbury 6:37b6d0d56190 344 MQTTPacket_connectData data = MQTTPacket_connectData_initializer;
samdanbury 6:37b6d0d56190 345 data.MQTTVersion = 3;
samdanbury 6:37b6d0d56190 346 data.clientID.cstring = clientId;
samdanbury 6:37b6d0d56190 347
samdanbury 6:37b6d0d56190 348 if (!quickstartMode)
samdanbury 6:37b6d0d56190 349 {
samdanbury 6:37b6d0d56190 350 data.username.cstring = "use-token-auth";
samdanbury 6:37b6d0d56190 351 data.password.cstring = auth_token;
samdanbury 6:37b6d0d56190 352 }
samdanbury 6:37b6d0d56190 353
icraggs 8:80d49dd91542 354 if ((rc = client->connect(data)) == 0)
samdanbury 6:37b6d0d56190 355 {
samdanbury 6:37b6d0d56190 356 connected = true;
samdanbury 6:37b6d0d56190 357 green();
samdanbury 6:37b6d0d56190 358 displayMessage("Connected");
jsutton 13:85801e3b83d3 359 wait(1);
samdanbury 6:37b6d0d56190 360 displayMessage("Scroll with joystick");
samdanbury 6:37b6d0d56190 361 }
icraggs 16:2420bfbf5f1c 362 else
icraggs 16:2420bfbf5f1c 363 WARN("MQTT connect returned %d\n", rc);
icraggs 16:2420bfbf5f1c 364 if (rc >= 0)
icraggs 16:2420bfbf5f1c 365 connack_rc = rc;
jsutton 14:1f961d19f3cf 366 mqttConnecting = false;
samdanbury 6:37b6d0d56190 367 return rc;
samdanbury 6:37b6d0d56190 368 }
samdanbury 6:37b6d0d56190 369
samdanbury 6:37b6d0d56190 370
samdanbury 6:37b6d0d56190 371 int getConnTimeout(int attemptNumber)
samdanbury 6:37b6d0d56190 372 { // First 10 attempts try within 3 seconds, next 10 attempts retry after every 1 minute
samdanbury 6:37b6d0d56190 373 // after 20 attempts, retry every 10 minutes
samdanbury 6:37b6d0d56190 374 return (attemptNumber < 10) ? 3 : (attemptNumber < 20) ? 60 : 600;
samdanbury 6:37b6d0d56190 375 }
samdanbury 6:37b6d0d56190 376
samdanbury 6:37b6d0d56190 377
samdanbury 6:37b6d0d56190 378 void attemptConnect(MQTT::Client<MQTTEthernet, Countdown, MQTT_MAX_PACKET_SIZE>* client, MQTTEthernet* ipstack)
samdanbury 6:37b6d0d56190 379 {
samdanbury 6:37b6d0d56190 380 connected = false;
icraggs 16:2420bfbf5f1c 381
icraggs 8:80d49dd91542 382 // make sure a cable is connected before starting to connect
icraggs 16:2420bfbf5f1c 383 while (!linkStatus())
icraggs 16:2420bfbf5f1c 384 {
icraggs 8:80d49dd91542 385 wait(1.0f);
icraggs 8:80d49dd91542 386 WARN("Ethernet link not present. Check cable connection\n");
icraggs 8:80d49dd91542 387 }
samdanbury 6:37b6d0d56190 388
icraggs 16:2420bfbf5f1c 389 while (connect(client, ipstack) != MQTT_CONNECTION_ACCEPTED)
samdanbury 6:37b6d0d56190 390 {
icraggs 16:2420bfbf5f1c 391 if (connack_rc == MQTT_NOT_AUTHORIZED || connack_rc == MQTT_BAD_USERNAME_OR_PASSWORD)
icraggs 16:2420bfbf5f1c 392 return; // don't reattempt to connect if credentials are wrong
icraggs 16:2420bfbf5f1c 393
samdanbury 6:37b6d0d56190 394 Thread red_thread(flashing_red);
chris 12:8b480eb8a496 395
samdanbury 6:37b6d0d56190 396 int timeout = getConnTimeout(++retryAttempt);
samdanbury 6:37b6d0d56190 397 WARN("Retry attempt number %d waiting %d\n", retryAttempt, timeout);
icraggs 8:80d49dd91542 398
icraggs 8:80d49dd91542 399 // if ipstack and client were on the heap we could deconstruct and goto a label where they are constructed
icraggs 8:80d49dd91542 400 // or maybe just add the proper members to do this disconnect and call attemptConnect(...)
icraggs 8:80d49dd91542 401
icraggs 8:80d49dd91542 402 // this works - reset the system when the retry count gets to a threshold
icraggs 8:80d49dd91542 403 if (retryAttempt == 5)
icraggs 8:80d49dd91542 404 NVIC_SystemReset();
icraggs 8:80d49dd91542 405 else
icraggs 8:80d49dd91542 406 wait(timeout);
samdanbury 6:37b6d0d56190 407 }
samdanbury 6:37b6d0d56190 408 }
samdanbury 6:37b6d0d56190 409
samdanbury 6:37b6d0d56190 410
samdanbury 6:37b6d0d56190 411 int publish(MQTT::Client<MQTTEthernet, Countdown, MQTT_MAX_PACKET_SIZE>* client, MQTTEthernet* ipstack)
samdanbury 6:37b6d0d56190 412 {
samdanbury 6:37b6d0d56190 413 MQTT::Message message;
samdanbury 6:37b6d0d56190 414 char* pubTopic = "iot-2/evt/status/fmt/json";
samdanbury 6:37b6d0d56190 415
samdanbury 6:37b6d0d56190 416 char buf[250];
bazot 20:3045570c01ff 417 //sprintf(buf, "%0.4f \",\"%0.4f \",\"%0.4f", sensor.temp(),ain1.read(),ain2.read());
samdanbury 6:37b6d0d56190 418 sprintf(buf,
bazot 20:3045570c01ff 419 "{\"d\":{\"name\":\"IoT mbed\",\"accelX\":%0.4f,\"accelY\":%0.4f,\"accelZ\":%0.4f,\"temp\":%0.4f,\"joystick\":\"%s\",\"potentiometer1\":%0.4f,\"potentiometer2\":%0.4f,\"lat\":43.9,\"long\":7.25,\"Rfid\":12345}}",
samdanbury 6:37b6d0d56190 420 MMA.x(), MMA.y(), MMA.z(), sensor.temp(), joystickPos, ain1.read(), ain2.read());
samdanbury 6:37b6d0d56190 421 message.qos = MQTT::QOS0;
samdanbury 6:37b6d0d56190 422 message.retained = false;
samdanbury 6:37b6d0d56190 423 message.dup = false;
samdanbury 6:37b6d0d56190 424 message.payload = (void*)buf;
samdanbury 6:37b6d0d56190 425 message.payloadlen = strlen(buf);
samdanbury 6:37b6d0d56190 426
samdanbury 6:37b6d0d56190 427 LOG("Publishing %s\n", buf);
icraggs 8:80d49dd91542 428 return client->publish(pubTopic, message);
samdanbury 6:37b6d0d56190 429 }
samdanbury 6:37b6d0d56190 430
samdanbury 6:37b6d0d56190 431
samdanbury 6:37b6d0d56190 432 char* getMac(EthernetInterface& eth, char* buf, int buflen) // Obtain MAC address
samdanbury 6:37b6d0d56190 433 {
samdanbury 6:37b6d0d56190 434 strncpy(buf, eth.getMACAddress(), buflen);
samdanbury 6:37b6d0d56190 435
samdanbury 6:37b6d0d56190 436 char* pos; // Remove colons from mac address
samdanbury 6:37b6d0d56190 437 while ((pos = strchr(buf, ':')) != NULL)
samdanbury 6:37b6d0d56190 438 memmove(pos, pos + 1, strlen(pos) + 1);
samdanbury 6:37b6d0d56190 439 return buf;
samdanbury 6:37b6d0d56190 440 }
chris 12:8b480eb8a496 441
samdanbury 6:37b6d0d56190 442
samdanbury 6:37b6d0d56190 443 void messageArrived(MQTT::MessageData& md)
samdanbury 6:37b6d0d56190 444 {
samdanbury 6:37b6d0d56190 445 MQTT::Message &message = md.message;
samdanbury 6:37b6d0d56190 446 char topic[md.topicName.lenstring.len + 1];
samdanbury 6:37b6d0d56190 447
samdanbury 6:37b6d0d56190 448 sprintf(topic, "%.*s", md.topicName.lenstring.len, md.topicName.lenstring.data);
samdanbury 6:37b6d0d56190 449
samdanbury 6:37b6d0d56190 450 LOG("Message arrived on topic %s: %.*s\n", topic, message.payloadlen, message.payload);
samdanbury 6:37b6d0d56190 451
samdanbury 6:37b6d0d56190 452 // Command topic: iot-2/cmd/blink/fmt/json - cmd is the string between cmd/ and /fmt/
samdanbury 6:37b6d0d56190 453 char* start = strstr(topic, "/cmd/") + 5;
samdanbury 6:37b6d0d56190 454 int len = strstr(topic, "/fmt/") - start;
samdanbury 6:37b6d0d56190 455
samdanbury 6:37b6d0d56190 456 if (memcmp(start, "blink", len) == 0)
samdanbury 6:37b6d0d56190 457 {
samdanbury 6:37b6d0d56190 458 char payload[message.payloadlen + 1];
samdanbury 6:37b6d0d56190 459 sprintf(payload, "%.*s", message.payloadlen, (char*)message.payload);
samdanbury 6:37b6d0d56190 460
samdanbury 6:37b6d0d56190 461 char* pos = strchr(payload, '}');
samdanbury 6:37b6d0d56190 462 if (pos != NULL)
samdanbury 6:37b6d0d56190 463 {
samdanbury 6:37b6d0d56190 464 *pos = '\0';
samdanbury 6:37b6d0d56190 465 if ((pos = strchr(payload, ':')) != NULL)
samdanbury 6:37b6d0d56190 466 {
samdanbury 6:37b6d0d56190 467 int blink_rate = atoi(pos + 1);
samdanbury 6:37b6d0d56190 468 blink_interval = (blink_rate <= 0) ? 0 : (blink_rate > 50 ? 1 : 50/blink_rate);
samdanbury 6:37b6d0d56190 469 }
samdanbury 6:37b6d0d56190 470 }
samdanbury 6:37b6d0d56190 471 }
samdanbury 6:37b6d0d56190 472 else
samdanbury 6:37b6d0d56190 473 WARN("Unsupported command: %.*s\n", len, start);
samdanbury 6:37b6d0d56190 474 }
samdanbury 6:37b6d0d56190 475
samdanbury 6:37b6d0d56190 476
samdanbury 6:37b6d0d56190 477 int main()
samdanbury 6:37b6d0d56190 478 {
icraggs 8:80d49dd91542 479 quickstartMode = (strcmp(org, "quickstart") == 0);
icraggs 8:80d49dd91542 480
samdanbury 6:37b6d0d56190 481 lcd.set_font((unsigned char*) Arial12x12); // Set a nice font for the LCD screen
samdanbury 6:37b6d0d56190 482
samdanbury 6:37b6d0d56190 483 led2 = LED2_OFF; // K64F: turn off the main board LED
samdanbury 6:37b6d0d56190 484
samdanbury 6:37b6d0d56190 485 displayMessage("Connecting");
jsutton 13:85801e3b83d3 486 Thread yellow_thread(flashing_yellow);
jsutton 13:85801e3b83d3 487 Thread menu_thread(menu_loop);
jsutton 13:85801e3b83d3 488
jsutton 14:1f961d19f3cf 489 LOG("***** IBM IoT Client Ethernet Example *****\n");
samdanbury 6:37b6d0d56190 490 MQTTEthernet ipstack;
jsutton 14:1f961d19f3cf 491 ethernetInitialising = false;
samdanbury 6:37b6d0d56190 492 MQTT::Client<MQTTEthernet, Countdown, MQTT_MAX_PACKET_SIZE> client(ipstack);
icraggs 18:94da9de96d54 493 LOG("Ethernet Initialized\n");
jsutton 13:85801e3b83d3 494
samdanbury 6:37b6d0d56190 495 if (quickstartMode)
icraggs 16:2420bfbf5f1c 496 getMac(ipstack.getEth(), id, sizeof(id));
icraggs 16:2420bfbf5f1c 497
icraggs 16:2420bfbf5f1c 498 attemptConnect(&client, &ipstack);
icraggs 16:2420bfbf5f1c 499
icraggs 16:2420bfbf5f1c 500 if (connack_rc == MQTT_NOT_AUTHORIZED || connack_rc == MQTT_BAD_USERNAME_OR_PASSWORD)
samdanbury 6:37b6d0d56190 501 {
icraggs 16:2420bfbf5f1c 502 red();
icraggs 16:2420bfbf5f1c 503 while (true)
icraggs 16:2420bfbf5f1c 504 wait(1.0); // Permanent failures - don't retry
samdanbury 6:37b6d0d56190 505 }
icraggs 16:2420bfbf5f1c 506
samdanbury 6:37b6d0d56190 507 if (!quickstartMode)
samdanbury 6:37b6d0d56190 508 {
samdanbury 6:37b6d0d56190 509 int rc = 0;
samdanbury 6:37b6d0d56190 510 if ((rc = client.subscribe("iot-2/cmd/+/fmt/json", MQTT::QOS1, messageArrived)) != 0)
samdanbury 6:37b6d0d56190 511 WARN("rc from MQTT subscribe is %d\n", rc);
samdanbury 6:37b6d0d56190 512 }
samdanbury 6:37b6d0d56190 513
samdanbury 6:37b6d0d56190 514 blink_interval = 0;
samdanbury 6:37b6d0d56190 515 int count = 0;
samdanbury 6:37b6d0d56190 516 while (true)
samdanbury 6:37b6d0d56190 517 {
bazot 19:48522ea6acef 518 if (++count == 2500) // Here is the count to change the number of publish/second
samdanbury 6:37b6d0d56190 519 { // Publish a message every second
samdanbury 6:37b6d0d56190 520 if (publish(&client, &ipstack) != 0)
samdanbury 6:37b6d0d56190 521 attemptConnect(&client, &ipstack); // if we have lost the connection
samdanbury 6:37b6d0d56190 522 count = 0;
samdanbury 6:37b6d0d56190 523 }
samdanbury 6:37b6d0d56190 524
samdanbury 6:37b6d0d56190 525 if (blink_interval == 0)
samdanbury 6:37b6d0d56190 526 led2 = LED2_OFF;
samdanbury 6:37b6d0d56190 527 else if (count % blink_interval == 0)
samdanbury 6:37b6d0d56190 528 led2 = !led2;
samdanbury 6:37b6d0d56190 529 client.yield(10); // allow the MQTT client to receive messages
samdanbury 6:37b6d0d56190 530 }
samdanbury 6:37b6d0d56190 531 }