Babu Alikapati / Mbed 2 deprecated TCU-POC_BACK_WORKING

working

Dependencies:   C027_Support IBMIoTClientCellularExample MQTT mbed

Fork of MQTT-GSM-GPS-CAN-SMS by Babu Alikapati

main.cpp@15:7c3279ac3c52, 2015-07-02 (annotated)

Committer:
mazgch
Date:
Thu Jul 02 08:19:04 2015 +0000
Revision:
15:7c3279ac3c52
Parent:
14:6f36d75b3917
Child:
16:a931c0a6d987
added in location as gps event in json

Who changed what in which revision?

UserRevisionLine numberNew contents of line
samdanbury 6:37b6d0d56190 1 /*******************************************************************************
samdanbury 6:37b6d0d56190 2 * Copyright (c) 2014 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
chris 10:0b5e0dfee08e 18 *
chris 10:0b5e0dfee08e 19 * To do :
chris 10:0b5e0dfee08e 20 * Add magnetometer sensor output to IoT data stream
chris 10:0b5e0dfee08e 21 *
samdanbury 6:37b6d0d56190 22 *******************************************************************************/
samdanbury 6:37b6d0d56190 23
mazgch 12:d6b94e8051b0 24 #define USE_CELLULAR // Enable this switch on the C027 to use cellular
mazgch 12:d6b94e8051b0 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 "C12832.h"
samdanbury 6:37b6d0d56190 30 #include "Arial12x12.h"
samdanbury 6:37b6d0d56190 31 #include "rtos.h"
samdanbury 6:37b6d0d56190 32
chris 10:0b5e0dfee08e 33 // Update this to the next number *before* a commit
chris 10:0b5e0dfee08e 34 #define __APP_SW_REVISION__ "10"
chris 10:0b5e0dfee08e 35
samdanbury 6:37b6d0d56190 36 // Configuration values needed to connect to IBM IoT Cloud
icraggs 8:80d49dd91542 37 #define ORG "quickstart" // For a registered connection, replace with your org
icraggs 8:80d49dd91542 38 #define ID "" // For a registered connection, replace with your id
icraggs 8:80d49dd91542 39 #define AUTH_TOKEN "" // For a registered connection, replace with your auth-token
mazgch 12:d6b94e8051b0 40 #define TYPE_NAME DEFAULT_TYPE_NAME // For a registered connection, replace with your type
samdanbury 6:37b6d0d56190 41
samdanbury 6:37b6d0d56190 42 #define MQTT_PORT 1883
samdanbury 6:37b6d0d56190 43 #define MQTT_TLS_PORT 8883
samdanbury 6:37b6d0d56190 44 #define IBM_IOT_PORT MQTT_PORT
samdanbury 6:37b6d0d56190 45
samdanbury 6:37b6d0d56190 46 #define MQTT_MAX_PACKET_SIZE 250
samdanbury 6:37b6d0d56190 47
mazgch 14:6f36d75b3917 48 //------------------------------------------------------------------------------------
mazgch 13:6a0af5deb2db 49 // You need to configure these cellular modem / SIM parameters.
mazgch 13:6a0af5deb2db 50 // These parameters are ignored for LISA-C200 variants and can be left NULL.
mazgch 13:6a0af5deb2db 51 //------------------------------------------------------------------------------------
mazgch 13:6a0af5deb2db 52 # include "MDM.h"
mazgch 13:6a0af5deb2db 53 //! Set your secret SIM pin here (e.g. "1234"). Check your SIM manual.
mazgch 13:6a0af5deb2db 54 # define SIMPIN NULL
mazgch 13:6a0af5deb2db 55 /*! The APN of your network operator SIM, sometimes it is "internet" check your
mazgch 13:6a0af5deb2db 56 contract with the network operator. You can also try to look-up your settings in
mazgch 13:6a0af5deb2db 57 google: https://www.google.de/search?q=APN+list */
mazgch 13:6a0af5deb2db 58 # define APN NULL
mazgch 13:6a0af5deb2db 59 //! Set the user name for your APN, or NULL if not needed
mazgch 13:6a0af5deb2db 60 # define USERNAME NULL
mazgch 13:6a0af5deb2db 61 //! Set the password for your APN, or NULL if not needed
mazgch 13:6a0af5deb2db 62 # define PASSWORD NULL
mazgch 13:6a0af5deb2db 63 //------------------------------------------------------------------------------------
mazgch 15:7c3279ac3c52 64 # include "GPS.h"
mazgch 15:7c3279ac3c52 65 //------------------------------------------------------------------------------------
mazgch 13:6a0af5deb2db 66
mazgch 14:6f36d75b3917 67 C12832 lcd(D11, D13, D12, D7, D10);
mazgch 14:6f36d75b3917 68 PwmOut r(D5);
mazgch 14:6f36d75b3917 69 PwmOut g(D9);
mazgch 14:6f36d75b3917 70 PwmOut b(D8);
mazgch 14:6f36d75b3917 71 DigitalOut led1(LED1); DigitalOut led2(LED2); DigitalOut led3(LED3);
mazgch 14:6f36d75b3917 72 MMA7660 MMA(D14, D15);
mazgch 14:6f36d75b3917 73 LM75B sensor(D14,D15);
mazgch 14:6f36d75b3917 74 DigitalIn Up(A2); DigitalIn Down(A3); DigitalIn Left(A4); DigitalIn Right(A5); DigitalIn Click(D4);
mazgch 14:6f36d75b3917 75 AnalogIn ain1 (A0); AnalogIn ain2 (A1);
mazgch 14:6f36d75b3917 76
mazgch 14:6f36d75b3917 77 #define LED2_OFF 0
mazgch 14:6f36d75b3917 78 #define LED2_ON 1
mazgch 14:6f36d75b3917 79
mazgch 14:6f36d75b3917 80 static uint32_t linkStatus(void) { return true; }
mazgch 14:6f36d75b3917 81
mazgch 14:6f36d75b3917 82 #define DEFAULT_TYPE_NAME "iotsample-mbed-c027"
mazgch 14:6f36d75b3917 83
mazgch 13:6a0af5deb2db 84 #define MQTT_CLIENT_TYPE MQTTSocket
mazgch 13:6a0af5deb2db 85 #include "MQTTSocket.h"
samdanbury 6:37b6d0d56190 86
icraggs 8:80d49dd91542 87 bool quickstartMode = true;
samdanbury 6:37b6d0d56190 88 char org[11] = ORG;
mazgch 12:d6b94e8051b0 89 char type[30] = TYPE_NAME;
mazgch 15:7c3279ac3c52 90 char id[30] = ID; // device ID
samdanbury 6:37b6d0d56190 91 char auth_token[30] = AUTH_TOKEN; // Auth_token is only used in non-quickstart mode
samdanbury 6:37b6d0d56190 92
samdanbury 6:37b6d0d56190 93 bool connected = false;
mazgch 15:7c3279ac3c52 94 bool shieldConnected = false;
samdanbury 6:37b6d0d56190 95 char* joystickPos = "CENTRE";
samdanbury 6:37b6d0d56190 96 int blink_interval = 0;
samdanbury 6:37b6d0d56190 97
samdanbury 6:37b6d0d56190 98
samdanbury 6:37b6d0d56190 99 void off()
samdanbury 6:37b6d0d56190 100 {
samdanbury 6:37b6d0d56190 101 r = g = b = 1.0; // 1 is off, 0 is full brightness
samdanbury 6:37b6d0d56190 102 }
samdanbury 6:37b6d0d56190 103
samdanbury 6:37b6d0d56190 104 void red()
samdanbury 6:37b6d0d56190 105 {
samdanbury 6:37b6d0d56190 106 r = 0.7; g = 1.0; b = 1.0; // 1 is off, 0 is full brightness
samdanbury 6:37b6d0d56190 107 }
samdanbury 6:37b6d0d56190 108
samdanbury 6:37b6d0d56190 109 void yellow()
samdanbury 6:37b6d0d56190 110 {
samdanbury 6:37b6d0d56190 111 r = 0.7; g = 0.7; b = 1.0; // 1 is off, 0 is full brightness
samdanbury 6:37b6d0d56190 112 }
samdanbury 6:37b6d0d56190 113
samdanbury 6:37b6d0d56190 114 void green()
samdanbury 6:37b6d0d56190 115 {
samdanbury 6:37b6d0d56190 116 r = 1.0; g = 0.7; b = 1.0; // 1 is off, 0 is full brightness
samdanbury 6:37b6d0d56190 117 }
samdanbury 6:37b6d0d56190 118
samdanbury 6:37b6d0d56190 119
samdanbury 6:37b6d0d56190 120 void flashing_yellow(void const *args)
samdanbury 6:37b6d0d56190 121 {
samdanbury 6:37b6d0d56190 122 bool on = false;
samdanbury 6:37b6d0d56190 123 while (!connected) // flashing yellow only while connecting
samdanbury 6:37b6d0d56190 124 {
samdanbury 6:37b6d0d56190 125 on = !on;
samdanbury 6:37b6d0d56190 126 if (on)
samdanbury 6:37b6d0d56190 127 yellow();
samdanbury 6:37b6d0d56190 128 else
samdanbury 6:37b6d0d56190 129 off();
samdanbury 6:37b6d0d56190 130 wait(0.5);
samdanbury 6:37b6d0d56190 131 }
samdanbury 6:37b6d0d56190 132 }
samdanbury 6:37b6d0d56190 133
samdanbury 6:37b6d0d56190 134
samdanbury 6:37b6d0d56190 135 void flashing_red(void const *args) // to be used when the connection is lost
samdanbury 6:37b6d0d56190 136 {
samdanbury 6:37b6d0d56190 137 bool on = false;
samdanbury 6:37b6d0d56190 138 while (!connected)
samdanbury 6:37b6d0d56190 139 {
samdanbury 6:37b6d0d56190 140 on = !on;
samdanbury 6:37b6d0d56190 141 if (on)
samdanbury 6:37b6d0d56190 142 red();
samdanbury 6:37b6d0d56190 143 else
samdanbury 6:37b6d0d56190 144 off();
samdanbury 6:37b6d0d56190 145 wait(2.0);
samdanbury 6:37b6d0d56190 146 }
samdanbury 6:37b6d0d56190 147 }
samdanbury 6:37b6d0d56190 148
samdanbury 6:37b6d0d56190 149
samdanbury 6:37b6d0d56190 150 void printMenu(int menuItem)
samdanbury 6:37b6d0d56190 151 {
samdanbury 6:37b6d0d56190 152 lcd.cls();
samdanbury 6:37b6d0d56190 153 lcd.locate(0,0);
samdanbury 6:37b6d0d56190 154 switch (menuItem)
samdanbury 6:37b6d0d56190 155 {
samdanbury 6:37b6d0d56190 156 case 0:
samdanbury 6:37b6d0d56190 157 lcd.printf("IBM IoT Cloud");
samdanbury 6:37b6d0d56190 158 lcd.locate(0,16);
samdanbury 6:37b6d0d56190 159 lcd.printf("Scroll with joystick");
samdanbury 6:37b6d0d56190 160 break;
samdanbury 6:37b6d0d56190 161 case 1:
samdanbury 6:37b6d0d56190 162 lcd.printf("Go to:");
samdanbury 6:37b6d0d56190 163 lcd.locate(0,16);
samdanbury 6:37b6d0d56190 164 lcd.printf("http://ibm.biz/iotqstart");
samdanbury 6:37b6d0d56190 165 break;
samdanbury 6:37b6d0d56190 166 case 2:
samdanbury 6:37b6d0d56190 167 lcd.printf("Device Identity:");
samdanbury 6:37b6d0d56190 168 lcd.locate(0,16);
samdanbury 6:37b6d0d56190 169 lcd.printf("%s", id);
samdanbury 6:37b6d0d56190 170 break;
samdanbury 6:37b6d0d56190 171 case 3:
samdanbury 6:37b6d0d56190 172 lcd.printf("Status:");
samdanbury 6:37b6d0d56190 173 lcd.locate(0,16);
samdanbury 6:37b6d0d56190 174 lcd.printf(connected ? "Connected" : "Disconnected");
samdanbury 6:37b6d0d56190 175 break;
chris 10:0b5e0dfee08e 176 case 4:
chris 10:0b5e0dfee08e 177 lcd.printf("App version:");
chris 10:0b5e0dfee08e 178 lcd.locate(0,16);
chris 10:0b5e0dfee08e 179 lcd.printf("%s",__APP_SW_REVISION__);
chris 10:0b5e0dfee08e 180 break;
samdanbury 6:37b6d0d56190 181 }
samdanbury 6:37b6d0d56190 182 }
samdanbury 6:37b6d0d56190 183
samdanbury 6:37b6d0d56190 184
samdanbury 6:37b6d0d56190 185 void setMenu()
samdanbury 6:37b6d0d56190 186 {
samdanbury 6:37b6d0d56190 187 static int menuItem = 0;
samdanbury 6:37b6d0d56190 188 if (Down)
samdanbury 6:37b6d0d56190 189 {
samdanbury 6:37b6d0d56190 190 joystickPos = "DOWN";
chris 10:0b5e0dfee08e 191 if (menuItem >= 0 && menuItem < 4)
samdanbury 6:37b6d0d56190 192 printMenu(++menuItem);
samdanbury 6:37b6d0d56190 193 }
samdanbury 6:37b6d0d56190 194 else if (Left)
samdanbury 6:37b6d0d56190 195 joystickPos = "LEFT";
samdanbury 6:37b6d0d56190 196 else if (Click)
samdanbury 6:37b6d0d56190 197 joystickPos = "CLICK";
samdanbury 6:37b6d0d56190 198 else if (Up)
samdanbury 6:37b6d0d56190 199 {
samdanbury 6:37b6d0d56190 200 joystickPos = "UP";
chris 10:0b5e0dfee08e 201 if (menuItem <= 4 && menuItem > 0)
samdanbury 6:37b6d0d56190 202 printMenu(--menuItem);
samdanbury 6:37b6d0d56190 203 }
samdanbury 6:37b6d0d56190 204 else if (Right)
samdanbury 6:37b6d0d56190 205 joystickPos = "RIGHT";
samdanbury 6:37b6d0d56190 206 else
samdanbury 6:37b6d0d56190 207 joystickPos = "CENTRE";
samdanbury 6:37b6d0d56190 208 }
samdanbury 6:37b6d0d56190 209
samdanbury 6:37b6d0d56190 210
samdanbury 6:37b6d0d56190 211 /**
samdanbury 6:37b6d0d56190 212 * Display a message on the LCD screen prefixed with IBM IoT Cloud
samdanbury 6:37b6d0d56190 213 */
samdanbury 6:37b6d0d56190 214 void displayMessage(char* message)
samdanbury 6:37b6d0d56190 215 {
samdanbury 6:37b6d0d56190 216 lcd.cls();
samdanbury 6:37b6d0d56190 217 lcd.locate(0,0);
samdanbury 6:37b6d0d56190 218 lcd.printf("IBM IoT Cloud");
samdanbury 6:37b6d0d56190 219 lcd.locate(0,16);
samdanbury 6:37b6d0d56190 220 lcd.printf(message);
samdanbury 6:37b6d0d56190 221 }
samdanbury 6:37b6d0d56190 222
samdanbury 6:37b6d0d56190 223
mazgch 12:d6b94e8051b0 224 int connect(MQTT::Client<MQTT_CLIENT_TYPE, Countdown, MQTT_MAX_PACKET_SIZE>* client, MQTT_CLIENT_TYPE* ipstack)
samdanbury 6:37b6d0d56190 225 {
samdanbury 6:37b6d0d56190 226 const char* iot_ibm = ".messaging.internetofthings.ibmcloud.com";
samdanbury 6:37b6d0d56190 227
samdanbury 6:37b6d0d56190 228 char hostname[strlen(org) + strlen(iot_ibm) + 1];
samdanbury 6:37b6d0d56190 229 sprintf(hostname, "%s%s", org, iot_ibm);
mazgch 11:7a6df9a2dcdc 230 DEBUG("hostname is %s\n", hostname);
samdanbury 6:37b6d0d56190 231 int rc = ipstack->connect(hostname, IBM_IOT_PORT);
samdanbury 6:37b6d0d56190 232 if (rc != 0)
samdanbury 6:37b6d0d56190 233 return rc;
samdanbury 6:37b6d0d56190 234
samdanbury 6:37b6d0d56190 235 // Construct clientId - d:org:type:id
samdanbury 6:37b6d0d56190 236 char clientId[strlen(org) + strlen(type) + strlen(id) + 5];
samdanbury 6:37b6d0d56190 237 sprintf(clientId, "d:%s:%s:%s", org, type, id);
samdanbury 6:37b6d0d56190 238 DEBUG("clientid is %s\n", clientId);
samdanbury 6:37b6d0d56190 239
samdanbury 6:37b6d0d56190 240 // MQTT Connect
samdanbury 6:37b6d0d56190 241 MQTTPacket_connectData data = MQTTPacket_connectData_initializer;
samdanbury 6:37b6d0d56190 242 data.MQTTVersion = 3;
samdanbury 6:37b6d0d56190 243 data.clientID.cstring = clientId;
samdanbury 6:37b6d0d56190 244
samdanbury 6:37b6d0d56190 245 if (!quickstartMode)
samdanbury 6:37b6d0d56190 246 {
samdanbury 6:37b6d0d56190 247 data.username.cstring = "use-token-auth";
samdanbury 6:37b6d0d56190 248 data.password.cstring = auth_token;
samdanbury 6:37b6d0d56190 249 }
samdanbury 6:37b6d0d56190 250
icraggs 8:80d49dd91542 251 if ((rc = client->connect(data)) == 0)
samdanbury 6:37b6d0d56190 252 {
samdanbury 6:37b6d0d56190 253 connected = true;
samdanbury 6:37b6d0d56190 254 green();
samdanbury 6:37b6d0d56190 255 displayMessage("Connected");
samdanbury 6:37b6d0d56190 256 wait(2);
samdanbury 6:37b6d0d56190 257 displayMessage("Scroll with joystick");
samdanbury 6:37b6d0d56190 258 }
samdanbury 6:37b6d0d56190 259 return rc;
samdanbury 6:37b6d0d56190 260 }
samdanbury 6:37b6d0d56190 261
samdanbury 6:37b6d0d56190 262
samdanbury 6:37b6d0d56190 263 int getConnTimeout(int attemptNumber)
samdanbury 6:37b6d0d56190 264 { // First 10 attempts try within 3 seconds, next 10 attempts retry after every 1 minute
samdanbury 6:37b6d0d56190 265 // after 20 attempts, retry every 10 minutes
samdanbury 6:37b6d0d56190 266 return (attemptNumber < 10) ? 3 : (attemptNumber < 20) ? 60 : 600;
samdanbury 6:37b6d0d56190 267 }
samdanbury 6:37b6d0d56190 268
samdanbury 6:37b6d0d56190 269
mazgch 12:d6b94e8051b0 270 void attemptConnect(MQTT::Client<MQTT_CLIENT_TYPE, Countdown, MQTT_MAX_PACKET_SIZE>* client, MQTT_CLIENT_TYPE* ipstack)
samdanbury 6:37b6d0d56190 271 {
samdanbury 6:37b6d0d56190 272 int retryAttempt = 0;
samdanbury 6:37b6d0d56190 273 connected = false;
icraggs 8:80d49dd91542 274
icraggs 8:80d49dd91542 275 // make sure a cable is connected before starting to connect
icraggs 8:80d49dd91542 276 while (!linkStatus()) {
icraggs 8:80d49dd91542 277 wait(1.0f);
mazgch 12:d6b94e8051b0 278 WARN("Internet link not present. Check cable connection\n");
icraggs 8:80d49dd91542 279 }
samdanbury 6:37b6d0d56190 280
samdanbury 6:37b6d0d56190 281 while (connect(client, ipstack) != 0)
samdanbury 6:37b6d0d56190 282 {
samdanbury 6:37b6d0d56190 283 #if defined(TARGET_K64F)
samdanbury 6:37b6d0d56190 284 red();
samdanbury 6:37b6d0d56190 285 #else
samdanbury 6:37b6d0d56190 286 Thread red_thread(flashing_red);
samdanbury 6:37b6d0d56190 287 #endif
samdanbury 6:37b6d0d56190 288 int timeout = getConnTimeout(++retryAttempt);
samdanbury 6:37b6d0d56190 289 WARN("Retry attempt number %d waiting %d\n", retryAttempt, timeout);
icraggs 8:80d49dd91542 290
icraggs 8:80d49dd91542 291 // if ipstack and client were on the heap we could deconstruct and goto a label where they are constructed
icraggs 8:80d49dd91542 292 // or maybe just add the proper members to do this disconnect and call attemptConnect(...)
icraggs 8:80d49dd91542 293
icraggs 8:80d49dd91542 294 // this works - reset the system when the retry count gets to a threshold
icraggs 8:80d49dd91542 295 if (retryAttempt == 5)
icraggs 8:80d49dd91542 296 NVIC_SystemReset();
icraggs 8:80d49dd91542 297 else
icraggs 8:80d49dd91542 298 wait(timeout);
samdanbury 6:37b6d0d56190 299 }
samdanbury 6:37b6d0d56190 300 }
samdanbury 6:37b6d0d56190 301
samdanbury 6:37b6d0d56190 302
mazgch 12:d6b94e8051b0 303 int publish(MQTT::Client<MQTT_CLIENT_TYPE, Countdown, MQTT_MAX_PACKET_SIZE>* client, MQTT_CLIENT_TYPE* ipstack)
samdanbury 6:37b6d0d56190 304 {
samdanbury 6:37b6d0d56190 305 MQTT::Message message;
samdanbury 6:37b6d0d56190 306 char* pubTopic = "iot-2/evt/status/fmt/json";
samdanbury 6:37b6d0d56190 307
samdanbury 6:37b6d0d56190 308 char buf[250];
mazgch 15:7c3279ac3c52 309 int l = 0;
mazgch 15:7c3279ac3c52 310 l += sprintf(buf+l,"{\"d\":{\"myName\":\"IoT mbed\"");
mazgch 15:7c3279ac3c52 311 if (shieldConnected) {
mazgch 15:7c3279ac3c52 312 l += sprintf(buf+l,",\"accelX\":%0.4f,\"accelY\":%0.4f,\"accelZ\":%0.4f", MMA.x(), MMA.y(), MMA.z());
mazgch 15:7c3279ac3c52 313 l += sprintf(buf+l,",\"temp\":%0.4f", sensor.temp());
mazgch 15:7c3279ac3c52 314 l += sprintf(buf+l,",\"joystick\":\"%s\"", joystickPos);
mazgch 15:7c3279ac3c52 315 l += sprintf(buf+l,",\"potentiometer1\":%0.4f,\"potentiometer2\":%0.4f", ain1.read(), ain2.read());
mazgch 15:7c3279ac3c52 316 }
mazgch 15:7c3279ac3c52 317 l += sprintf(buf+l,"}}");
mazgch 15:7c3279ac3c52 318
samdanbury 6:37b6d0d56190 319 message.qos = MQTT::QOS0;
samdanbury 6:37b6d0d56190 320 message.retained = false;
samdanbury 6:37b6d0d56190 321 message.dup = false;
samdanbury 6:37b6d0d56190 322 message.payload = (void*)buf;
samdanbury 6:37b6d0d56190 323 message.payloadlen = strlen(buf);
samdanbury 6:37b6d0d56190 324
samdanbury 6:37b6d0d56190 325 LOG("Publishing %s\n", buf);
icraggs 8:80d49dd91542 326 return client->publish(pubTopic, message);
samdanbury 6:37b6d0d56190 327 }
samdanbury 6:37b6d0d56190 328
mazgch 15:7c3279ac3c52 329 int publishGps(MQTT::Client<MQTT_CLIENT_TYPE, Countdown, MQTT_MAX_PACKET_SIZE>* client, MQTT_CLIENT_TYPE* ipstack, double lat, double lon)
mazgch 15:7c3279ac3c52 330 {
mazgch 15:7c3279ac3c52 331 MQTT::Message message;
mazgch 15:7c3279ac3c52 332 char* pubTopic = "iot-2/evt/gps/fmt/json";
mazgch 15:7c3279ac3c52 333 char buf[250];
mazgch 15:7c3279ac3c52 334 sprintf(buf,"{\"d\":{\"lat\":\"%.7f\",\"long\":\"%.7f\"}}", lat, lon);
mazgch 15:7c3279ac3c52 335 message.qos = MQTT::QOS0;
mazgch 15:7c3279ac3c52 336 message.retained = false;
mazgch 15:7c3279ac3c52 337 message.dup = false;
mazgch 15:7c3279ac3c52 338 message.payload = (void*)buf;
mazgch 15:7c3279ac3c52 339 message.payloadlen = strlen(buf);
mazgch 15:7c3279ac3c52 340 LOG("Publishing GPS %s\n", buf);
mazgch 15:7c3279ac3c52 341 return client->publish(pubTopic, message);
mazgch 15:7c3279ac3c52 342 }
mazgch 15:7c3279ac3c52 343
samdanbury 6:37b6d0d56190 344 void messageArrived(MQTT::MessageData& md)
samdanbury 6:37b6d0d56190 345 {
samdanbury 6:37b6d0d56190 346 MQTT::Message &message = md.message;
samdanbury 6:37b6d0d56190 347 char topic[md.topicName.lenstring.len + 1];
samdanbury 6:37b6d0d56190 348
samdanbury 6:37b6d0d56190 349 sprintf(topic, "%.*s", md.topicName.lenstring.len, md.topicName.lenstring.data);
samdanbury 6:37b6d0d56190 350
samdanbury 6:37b6d0d56190 351 LOG("Message arrived on topic %s: %.*s\n", topic, message.payloadlen, message.payload);
samdanbury 6:37b6d0d56190 352
samdanbury 6:37b6d0d56190 353 // Command topic: iot-2/cmd/blink/fmt/json - cmd is the string between cmd/ and /fmt/
samdanbury 6:37b6d0d56190 354 char* start = strstr(topic, "/cmd/") + 5;
samdanbury 6:37b6d0d56190 355 int len = strstr(topic, "/fmt/") - start;
samdanbury 6:37b6d0d56190 356
samdanbury 6:37b6d0d56190 357 if (memcmp(start, "blink", len) == 0)
samdanbury 6:37b6d0d56190 358 {
samdanbury 6:37b6d0d56190 359 char payload[message.payloadlen + 1];
samdanbury 6:37b6d0d56190 360 sprintf(payload, "%.*s", message.payloadlen, (char*)message.payload);
samdanbury 6:37b6d0d56190 361
samdanbury 6:37b6d0d56190 362 char* pos = strchr(payload, '}');
samdanbury 6:37b6d0d56190 363 if (pos != NULL)
samdanbury 6:37b6d0d56190 364 {
samdanbury 6:37b6d0d56190 365 *pos = '\0';
samdanbury 6:37b6d0d56190 366 if ((pos = strchr(payload, ':')) != NULL)
samdanbury 6:37b6d0d56190 367 {
samdanbury 6:37b6d0d56190 368 int blink_rate = atoi(pos + 1);
samdanbury 6:37b6d0d56190 369 blink_interval = (blink_rate <= 0) ? 0 : (blink_rate > 50 ? 1 : 50/blink_rate);
samdanbury 6:37b6d0d56190 370 }
samdanbury 6:37b6d0d56190 371 }
samdanbury 6:37b6d0d56190 372 }
samdanbury 6:37b6d0d56190 373 else
samdanbury 6:37b6d0d56190 374 WARN("Unsupported command: %.*s\n", len, start);
samdanbury 6:37b6d0d56190 375 }
samdanbury 6:37b6d0d56190 376
samdanbury 6:37b6d0d56190 377 int main()
samdanbury 6:37b6d0d56190 378 {
icraggs 8:80d49dd91542 379 quickstartMode = (strcmp(org, "quickstart") == 0);
mazgch 15:7c3279ac3c52 380 shieldConnected = MMA.testConnection() && sensor.open();
icraggs 8:80d49dd91542 381
samdanbury 6:37b6d0d56190 382 lcd.set_font((unsigned char*) Arial12x12); // Set a nice font for the LCD screen
samdanbury 6:37b6d0d56190 383
samdanbury 6:37b6d0d56190 384 led2 = LED2_OFF; // K64F: turn off the main board LED
samdanbury 6:37b6d0d56190 385
samdanbury 6:37b6d0d56190 386 displayMessage("Connecting");
samdanbury 6:37b6d0d56190 387 #if defined(TARGET_K64F)
samdanbury 6:37b6d0d56190 388 yellow(); // Don't flash on the K64F, because starting a thread causes the EthernetInterface init call to hang
samdanbury 6:37b6d0d56190 389 #else
samdanbury 6:37b6d0d56190 390 Thread yellow_thread(flashing_yellow);
samdanbury 6:37b6d0d56190 391 #endif
samdanbury 6:37b6d0d56190 392
mazgch 12:d6b94e8051b0 393 MDMSerial mdm;
mazgch 12:d6b94e8051b0 394 //mdm.setDebug(4); // enable this for debugging issues
mazgch 12:d6b94e8051b0 395 if (!mdm.connect(SIMPIN, APN,USERNAME,PASSWORD))
mazgch 12:d6b94e8051b0 396 return -1;
mazgch 13:6a0af5deb2db 397
mazgch 15:7c3279ac3c52 398 GPSI2C gps;
mazgch 15:7c3279ac3c52 399
mazgch 12:d6b94e8051b0 400 MQTT_CLIENT_TYPE ipstack;
mazgch 12:d6b94e8051b0 401 MQTT::Client<MQTT_CLIENT_TYPE, Countdown, MQTT_MAX_PACKET_SIZE> client(ipstack);
samdanbury 6:37b6d0d56190 402 if (quickstartMode)
samdanbury 6:37b6d0d56190 403 {
mazgch 15:7c3279ac3c52 404 MDMParser::DevStatus dev;
mazgch 15:7c3279ac3c52 405 mdm.getDevStatus(&dev);
mazgch 15:7c3279ac3c52 406 if (*dev.imei) strncpy(id, dev.imei, sizeof(id)-1);
mazgch 15:7c3279ac3c52 407 else if (*dev.meid) strncpy(id, dev.meid, sizeof(id)-1);
samdanbury 6:37b6d0d56190 408 }
samdanbury 6:37b6d0d56190 409
samdanbury 6:37b6d0d56190 410 attemptConnect(&client, &ipstack);
samdanbury 6:37b6d0d56190 411
samdanbury 6:37b6d0d56190 412 if (!quickstartMode)
samdanbury 6:37b6d0d56190 413 {
samdanbury 6:37b6d0d56190 414 int rc = 0;
samdanbury 6:37b6d0d56190 415 if ((rc = client.subscribe("iot-2/cmd/+/fmt/json", MQTT::QOS1, messageArrived)) != 0)
samdanbury 6:37b6d0d56190 416 WARN("rc from MQTT subscribe is %d\n", rc);
samdanbury 6:37b6d0d56190 417 }
samdanbury 6:37b6d0d56190 418
samdanbury 6:37b6d0d56190 419 blink_interval = 0;
samdanbury 6:37b6d0d56190 420 int count = 0;
mazgch 15:7c3279ac3c52 421 int count2 = 0;
samdanbury 6:37b6d0d56190 422 while (true)
samdanbury 6:37b6d0d56190 423 {
samdanbury 6:37b6d0d56190 424 if (++count == 100)
samdanbury 6:37b6d0d56190 425 { // Publish a message every second
samdanbury 6:37b6d0d56190 426 if (publish(&client, &ipstack) != 0)
samdanbury 6:37b6d0d56190 427 attemptConnect(&client, &ipstack); // if we have lost the connection
samdanbury 6:37b6d0d56190 428 count = 0;
samdanbury 6:37b6d0d56190 429 }
mazgch 15:7c3279ac3c52 430 if (++count2 == 10)
mazgch 15:7c3279ac3c52 431 { // Publish a message every second
mazgch 15:7c3279ac3c52 432 count2 = 0;
mazgch 15:7c3279ac3c52 433 while (1) {
mazgch 15:7c3279ac3c52 434 char buf[256];
mazgch 15:7c3279ac3c52 435 int ret = gps.getMessage(buf, sizeof(buf));
mazgch 15:7c3279ac3c52 436 if (ret <= 0) break;
mazgch 15:7c3279ac3c52 437 int len = LENGTH(ret);
mazgch 15:7c3279ac3c52 438 if ((PROTOCOL(ret) == GPSParser::NMEA) && (len > 6)) {
mazgch 15:7c3279ac3c52 439 // talker is $GA=Galileo $GB=Beidou $GL=Glonass $GN=Combined $GP=GPS
mazgch 15:7c3279ac3c52 440 if ((buf[0] == '$') || buf[1] == 'G') {
mazgch 15:7c3279ac3c52 441 #define _CHECK_TALKER(s) ((buf[3] == s[0]) && (buf[4] == s[1]) && (buf[5] == s[2]))
mazgch 15:7c3279ac3c52 442 if (_CHECK_TALKER("GGA")) {
mazgch 15:7c3279ac3c52 443 //printf("%.*s\n", len, buf);
mazgch 15:7c3279ac3c52 444 char ch;
mazgch 15:7c3279ac3c52 445 double latitude, longitude, elevation;
mazgch 15:7c3279ac3c52 446 static double lastLat = 0, lastLon = 0;
mazgch 15:7c3279ac3c52 447 if (gps.getNmeaAngle(2,buf,len,latitude) &&
mazgch 15:7c3279ac3c52 448 gps.getNmeaAngle(4,buf,len,longitude) &&
mazgch 15:7c3279ac3c52 449 gps.getNmeaItem(6,buf,len,ch) &&
mazgch 15:7c3279ac3c52 450 gps.getNmeaItem(9,buf,len,elevation)) {
mazgch 15:7c3279ac3c52 451 //printf("GPS Location: %.5f %.5f %.1f %c\r\n", latitude, longitude, elevation, ch);
mazgch 15:7c3279ac3c52 452 if ((ch == '1' || ch == '2' || ch == '6') && (latitude != lastLat) && (lastLon != longitude)) {
mazgch 15:7c3279ac3c52 453 publishGps(&client, &ipstack, latitude, longitude);
mazgch 15:7c3279ac3c52 454 lastLat = latitude;
mazgch 15:7c3279ac3c52 455 lastLon = longitude;
mazgch 15:7c3279ac3c52 456 }
mazgch 15:7c3279ac3c52 457 }
mazgch 15:7c3279ac3c52 458 }
mazgch 15:7c3279ac3c52 459 }
mazgch 15:7c3279ac3c52 460 }
mazgch 15:7c3279ac3c52 461 }
mazgch 15:7c3279ac3c52 462 }
samdanbury 6:37b6d0d56190 463
samdanbury 6:37b6d0d56190 464 if (blink_interval == 0)
samdanbury 6:37b6d0d56190 465 led2 = LED2_OFF;
samdanbury 6:37b6d0d56190 466 else if (count % blink_interval == 0)
samdanbury 6:37b6d0d56190 467 led2 = !led2;
samdanbury 6:37b6d0d56190 468 if (count % 20 == 0)
samdanbury 6:37b6d0d56190 469 setMenu();
samdanbury 6:37b6d0d56190 470 client.yield(10); // allow the MQTT client to receive messages
samdanbury 6:37b6d0d56190 471 }
samdanbury 6:37b6d0d56190 472 }