Mark Radbourne / Mbed 2 deprecated FXOS8700CQ_To_Azure_IoT

Simple sample that demonstrates reading the FXOS8700CQ accelerometer, convert the data to JSON and send to an Azure IoT Hub.

Dependencies:   azure_umqtt_c iothub_mqtt_transport mbed-rtos mbed wolfSSL Socket lwip-eth lwip-sys lwip

main.cpp@6:0bffe8529f60, 2017-04-18 (annotated)

Committer:
markrad
Date:
Tue Apr 18 22:15:09 2017 +0000
Revision:
6:0bffe8529f60
Parent:
5:3d814faa2b2e
Child:
7:2564d95cbf81
Fixed NTP error

Who changed what in which revision?

UserRevisionLine numberNew contents of line
markrad 0:6c46c366f500 1 // Copyright (c) Microsoft. All rights reserved.
markrad 0:6c46c366f500 2 // Licensed under the MIT license. See LICENSE file at https://github.com/Azure/azure-iot-sdks/blob/master/LICENSE for full license information.
markrad 0:6c46c366f500 3
markrad 0:6c46c366f500 4 /* -------------------------------------------------------------------------- *\
markrad 0:6c46c366f500 5
markrad 0:6c46c366f500 6 Simple progam to demonstrate reading the FRDM-K64F FXOS8700CQ
markrad 0:6c46c366f500 7 accelerometer, convert the data to JSON and send to an Azure IoT Hub. You
markrad 0:6c46c366f500 8 must provide your hub's connection string in the variable
markrad 0:6c46c366f500 9 'connectionString'.
markrad 0:6c46c366f500 10
markrad 0:6c46c366f500 11 markrad
markrad 0:6c46c366f500 12
markrad 0:6c46c366f500 13 \* -------------------------------------------------------------------------- */
markrad 0:6c46c366f500 14
markrad 0:6c46c366f500 15 #include <string.h>
markrad 4:9b3da9969b1b 16 #include <limits.h>
markrad 0:6c46c366f500 17
markrad 0:6c46c366f500 18 #include "SingletonFXOS8700CQ.h"
markrad 0:6c46c366f500 19
markrad 0:6c46c366f500 20 #include "iothub_client.h"
markrad 0:6c46c366f500 21 #include "iothub_message.h"
markrad 0:6c46c366f500 22 #include "azure_c_shared_utility/threadapi.h"
markrad 0:6c46c366f500 23 #include "azure_c_shared_utility/crt_abstractions.h"
markrad 0:6c46c366f500 24 #include "azure_c_shared_utility/platform.h"
markrad 0:6c46c366f500 25 #include "iothubtransportmqtt.h"
markrad 2:2b9acda15ef0 26 #include "lock.h"
markrad 0:6c46c366f500 27
markrad 0:6c46c366f500 28 #include "certs.h"
markrad 5:3d814faa2b2e 29 #include "NTPClient.h"
markrad 5:3d814faa2b2e 30
markrad 5:3d814faa2b2e 31 NTPClient ntp;
markrad 0:6c46c366f500 32
markrad 4:9b3da9969b1b 33 /*
markrad 0:6c46c366f500 34 int readingToJSON(char *buffer, int bufferlen, READING &reading)
markrad 0:6c46c366f500 35 {
markrad 0:6c46c366f500 36 static const char READING[] = "\"reading\"";
markrad 0:6c46c366f500 37 static const char ACCELEROMETER[] = "\"accelerometer\"";
markrad 0:6c46c366f500 38 static const char MAGNOMETER[] = "\"magnometer\"";
markrad 0:6c46c366f500 39 static const char X[] = "\"X\"";
markrad 0:6c46c366f500 40 static const char Y[] = "\"Y\"";
markrad 0:6c46c366f500 41 static const char Z[] = "\"Z\"";
markrad 0:6c46c366f500 42 static const char STARTOBJ[] = " : {\n";
markrad 0:6c46c366f500 43 static const char ENDOBJ[] = "}\n";
markrad 0:6c46c366f500 44 static const char PREPEND[] = "{\n";
markrad 0:6c46c366f500 45 static const int MINBUFFERLEN =
markrad 0:6c46c366f500 46 sizeof(READING) +
markrad 0:6c46c366f500 47 sizeof(ACCELEROMETER) +
markrad 0:6c46c366f500 48 sizeof(MAGNOMETER) +
markrad 0:6c46c366f500 49 2 * (sizeof(X) + sizeof(Y) + sizeof(Z)) +
markrad 0:6c46c366f500 50 3 * sizeof(STARTOBJ) +
markrad 0:6c46c366f500 51 4 * sizeof(ENDOBJ) +
markrad 0:6c46c366f500 52 sizeof(PREPEND) +
markrad 0:6c46c366f500 53 6 * 9;
markrad 0:6c46c366f500 54 static const char numConvert[] = "%d";
markrad 0:6c46c366f500 55
markrad 0:6c46c366f500 56 char toNum[10];
markrad 0:6c46c366f500 57 char work[MINBUFFERLEN + 1];
markrad 0:6c46c366f500 58
markrad 0:6c46c366f500 59 if (buffer == NULL)
markrad 0:6c46c366f500 60 return 0;
markrad 0:6c46c366f500 61
markrad 0:6c46c366f500 62 buffer[0] = '\0';
markrad 0:6c46c366f500 63
markrad 0:6c46c366f500 64 strcpy(work, PREPEND);
markrad 0:6c46c366f500 65 strcat(work, READING);
markrad 0:6c46c366f500 66 strcat(work, STARTOBJ);
markrad 0:6c46c366f500 67 strcat(work, ACCELEROMETER);
markrad 0:6c46c366f500 68 strcat(work, STARTOBJ);
markrad 0:6c46c366f500 69 strcat(work, X);
markrad 0:6c46c366f500 70 strcat(work, " : ");
markrad 0:6c46c366f500 71 sprintf(toNum, numConvert, reading.accelerometer.x);
markrad 0:6c46c366f500 72 strcat(work, toNum);
markrad 0:6c46c366f500 73 strcat(work, ",\n");
markrad 0:6c46c366f500 74 strcat(work, Y);
markrad 0:6c46c366f500 75 strcat(work, " : ");
markrad 0:6c46c366f500 76 sprintf(toNum, numConvert, reading.accelerometer.y);
markrad 0:6c46c366f500 77 strcat(work, toNum);
markrad 0:6c46c366f500 78 strcat(work, ",\n");
markrad 0:6c46c366f500 79 strcat(work, Z);
markrad 0:6c46c366f500 80 strcat(work, " : ");
markrad 0:6c46c366f500 81 sprintf(toNum, numConvert, reading.accelerometer.z);
markrad 0:6c46c366f500 82 strcat(work, toNum);
markrad 0:6c46c366f500 83 strcat(work, "\n");
markrad 0:6c46c366f500 84 strcat(work, ENDOBJ);
markrad 0:6c46c366f500 85 strcat(work, MAGNOMETER);
markrad 0:6c46c366f500 86 strcat(work, STARTOBJ);
markrad 0:6c46c366f500 87 strcat(work, X);
markrad 0:6c46c366f500 88 strcat(work, " : ");
markrad 0:6c46c366f500 89 sprintf(toNum, numConvert, reading.magnometer.x);
markrad 0:6c46c366f500 90 strcat(work, toNum);
markrad 0:6c46c366f500 91 strcat(work, ",\n");
markrad 0:6c46c366f500 92 strcat(work, Y);
markrad 0:6c46c366f500 93 strcat(work, " : ");
markrad 0:6c46c366f500 94 sprintf(toNum, numConvert, reading.magnometer.y);
markrad 0:6c46c366f500 95 strcat(work, toNum);
markrad 0:6c46c366f500 96 strcat(work, ",\n");
markrad 0:6c46c366f500 97 strcat(work, Z);
markrad 0:6c46c366f500 98 strcat(work, " : ");
markrad 0:6c46c366f500 99 sprintf(toNum, numConvert, reading.magnometer.z);
markrad 0:6c46c366f500 100 strcat(work, toNum);
markrad 0:6c46c366f500 101 strcat(work, "\n");
markrad 0:6c46c366f500 102 strcat(work, ENDOBJ);
markrad 0:6c46c366f500 103 strcat(work, ENDOBJ);
markrad 0:6c46c366f500 104 strcat(work, ENDOBJ);
markrad 0:6c46c366f500 105
markrad 0:6c46c366f500 106 if (strlen(work) + 1 < bufferlen)
markrad 0:6c46c366f500 107 strcpy(buffer, work);
markrad 0:6c46c366f500 108
markrad 0:6c46c366f500 109 return strlen(work);
markrad 0:6c46c366f500 110 }
markrad 4:9b3da9969b1b 111 */
markrad 4:9b3da9969b1b 112
markrad 4:9b3da9969b1b 113 static int JSONifyData(char *buffer, int bufferlen, int reading)
markrad 4:9b3da9969b1b 114 {
markrad 5:3d814faa2b2e 115 static const char *format = "{ \"device\": \"%s\", \"timestamp\": \"%s\", \"reading\": %f }";
markrad 5:3d814faa2b2e 116 static const char *timeFormat = "%FT%X";
markrad 5:3d814faa2b2e 117 char timeOut[80];
markrad 4:9b3da9969b1b 118 double work;
markrad 4:9b3da9969b1b 119 int rc;
markrad 5:3d814faa2b2e 120 time_t rawtime = 0;
markrad 5:3d814faa2b2e 121 struct tm *ptm;
markrad 4:9b3da9969b1b 122
markrad 5:3d814faa2b2e 123 // gmtime() does not work on the FRDM K64F - set RTC to UTC
markrad 5:3d814faa2b2e 124 time(&rawtime);
markrad 5:3d814faa2b2e 125 printf("%x\r\n", ptm);
markrad 5:3d814faa2b2e 126 ptm = localtime(&rawtime);
markrad 5:3d814faa2b2e 127 printf("%x\r\n", ptm);
markrad 5:3d814faa2b2e 128
markrad 5:3d814faa2b2e 129 strftime(timeOut, sizeof(timeOut), timeFormat, ptm);
markrad 5:3d814faa2b2e 130 printf("rawtime >>%d<<\r\n", rawtime);
markrad 5:3d814faa2b2e 131 printf("timeOut >>%s<<\r\n", timeOut);
markrad 5:3d814faa2b2e 132 printf("month=%d\r\n", ptm->tm_mon);
markrad 4:9b3da9969b1b 133 work = sqrt((double)reading);
markrad 5:3d814faa2b2e 134 rc = snprintf(buffer, bufferlen, format, "mydevice", timeOut, work);
markrad 4:9b3da9969b1b 135
markrad 4:9b3da9969b1b 136 if (rc < 0)
markrad 4:9b3da9969b1b 137 printf("*** ERROR *** out of buffer space\r\n");
markrad 4:9b3da9969b1b 138
markrad 4:9b3da9969b1b 139 return rc;
markrad 4:9b3da9969b1b 140 }
markrad 0:6c46c366f500 141
markrad 2:2b9acda15ef0 142 static LOCK_HANDLE msgLock;
markrad 2:2b9acda15ef0 143 static int msgCount = 0;
markrad 3:c0556ff7b8e3 144 static Timer t;
markrad 3:c0556ff7b8e3 145 static int CONNECTIONTIMEOUT = (20 * 1000);
markrad 2:2b9acda15ef0 146
markrad 0:6c46c366f500 147 static IOTHUBMESSAGE_DISPOSITION_RESULT ReceiveMessageCallback(IOTHUB_MESSAGE_HANDLE message, void* userContextCallback)
markrad 0:6c46c366f500 148 {
markrad 0:6c46c366f500 149 int* counter = (int*)userContextCallback;
markrad 0:6c46c366f500 150 const char* buffer;
markrad 0:6c46c366f500 151 size_t size;
markrad 0:6c46c366f500 152
markrad 0:6c46c366f500 153 if (IoTHubMessage_GetByteArray(message, (const unsigned char**)&buffer, &size) != IOTHUB_MESSAGE_OK)
markrad 0:6c46c366f500 154 {
markrad 0:6c46c366f500 155 (void)printf("unable to retrieve the message data\r\n");
markrad 0:6c46c366f500 156 }
markrad 0:6c46c366f500 157 else
markrad 0:6c46c366f500 158 {
markrad 0:6c46c366f500 159 (void)printf("Received Message [%d] with Data: <<<%.*s>>> & Size=%d\r\n", *counter, (int)size, buffer, (int)size);
markrad 0:6c46c366f500 160 }
markrad 0:6c46c366f500 161
markrad 0:6c46c366f500 162 // Some device specific action code goes here...
markrad 0:6c46c366f500 163 (*counter)++;
markrad 0:6c46c366f500 164
markrad 0:6c46c366f500 165 return IOTHUBMESSAGE_ACCEPTED;
markrad 0:6c46c366f500 166 }
markrad 0:6c46c366f500 167
markrad 0:6c46c366f500 168 static void SendConfirmationCallback(IOTHUB_CLIENT_CONFIRMATION_RESULT result, void* userContextCallback)
markrad 0:6c46c366f500 169 {
markrad 2:2b9acda15ef0 170 int* messageTrackingId = (int*)userContextCallback;
markrad 0:6c46c366f500 171
markrad 0:6c46c366f500 172 (void)printf("Confirmation received for message tracking id = %d with result = %s\r\n",
markrad 2:2b9acda15ef0 173 *messageTrackingId, ENUM_TO_STRING(IOTHUB_CLIENT_CONFIRMATION_RESULT, result));
markrad 0:6c46c366f500 174
markrad 2:2b9acda15ef0 175 free(userContextCallback);
markrad 2:2b9acda15ef0 176 Lock(msgLock);
markrad 2:2b9acda15ef0 177 msgCount--;
markrad 3:c0556ff7b8e3 178
markrad 3:c0556ff7b8e3 179 if (result == IOTHUB_CLIENT_CONFIRMATION_OK)
markrad 3:c0556ff7b8e3 180 {
markrad 3:c0556ff7b8e3 181 t.stop();
markrad 3:c0556ff7b8e3 182 t.reset();
markrad 3:c0556ff7b8e3 183 }
markrad 3:c0556ff7b8e3 184
markrad 2:2b9acda15ef0 185 Unlock(msgLock);
markrad 2:2b9acda15ef0 186
markrad 0:6c46c366f500 187 }
markrad 0:6c46c366f500 188
markrad 0:6c46c366f500 189 void stall(Serial &pc, char *message)
markrad 0:6c46c366f500 190 {
markrad 0:6c46c366f500 191 printf(message);
markrad 0:6c46c366f500 192 printf("stalled ");
markrad 0:6c46c366f500 193
markrad 4:9b3da9969b1b 194 while(true)
markrad 4:9b3da9969b1b 195 {
markrad 0:6c46c366f500 196 pc.putc('.'); // idle dots
markrad 0:6c46c366f500 197 wait(1.0);
markrad 0:6c46c366f500 198 }
markrad 0:6c46c366f500 199 }
markrad 0:6c46c366f500 200
markrad 3:c0556ff7b8e3 201 IOTHUB_CLIENT_HANDLE setupConnection(Serial &pc, const char *connectionString, IOTHUB_CLIENT_TRANSPORT_PROVIDER protocol, void *receiveContext)
markrad 3:c0556ff7b8e3 202 {
markrad 3:c0556ff7b8e3 203 IOTHUB_CLIENT_HANDLE iotHubClientHandle = NULL;
markrad 3:c0556ff7b8e3 204
markrad 3:c0556ff7b8e3 205 printf("Calling platform_init\r\n");
markrad 3:c0556ff7b8e3 206
markrad 3:c0556ff7b8e3 207 while (platform_init())
markrad 3:c0556ff7b8e3 208 {
markrad 3:c0556ff7b8e3 209 pc.putc('P');
markrad 3:c0556ff7b8e3 210 wait(1.0);
markrad 3:c0556ff7b8e3 211 platform_deinit();
markrad 3:c0556ff7b8e3 212 }
markrad 3:c0556ff7b8e3 213
markrad 3:c0556ff7b8e3 214 // if (platform_init() != 0)
markrad 3:c0556ff7b8e3 215 // stall(pc, "Failed to initialize platform\n");
markrad 3:c0556ff7b8e3 216
markrad 3:c0556ff7b8e3 217 printf("Calling IoTHubClient_CreateFromConnectionString\r\n");
markrad 3:c0556ff7b8e3 218 if ((iotHubClientHandle = IoTHubClient_CreateFromConnectionString(connectionString, protocol)) == NULL)
markrad 3:c0556ff7b8e3 219 stall(pc, "ERROR: Could not create iotHubClientHandle\n");
markrad 3:c0556ff7b8e3 220
markrad 3:c0556ff7b8e3 221 bool traceOn = false;
markrad 3:c0556ff7b8e3 222 //bool traceOn = true;
markrad 3:c0556ff7b8e3 223
markrad 3:c0556ff7b8e3 224 printf("Calling IoTHubClient_SetOption logtrace with %d\r\n", traceOn);
markrad 3:c0556ff7b8e3 225 IoTHubClient_SetOption(iotHubClientHandle, "logtrace", &traceOn);
markrad 3:c0556ff7b8e3 226
markrad 3:c0556ff7b8e3 227 // For mbed add the certificate information
markrad 3:c0556ff7b8e3 228 printf("Calling IoTHubClient_SetOption TrustedCerts\r\n");
markrad 3:c0556ff7b8e3 229
markrad 3:c0556ff7b8e3 230 if (IoTHubClient_SetOption(iotHubClientHandle, "TrustedCerts", certificates) != IOTHUB_CLIENT_OK)
markrad 3:c0556ff7b8e3 231 stall(pc, "ERROR: failure to set option \"TrustedCerts\"\n");
markrad 3:c0556ff7b8e3 232
markrad 3:c0556ff7b8e3 233 printf("Calling IoTHubClient_SetMessageCallback\r\n");
markrad 3:c0556ff7b8e3 234
markrad 3:c0556ff7b8e3 235 if (IoTHubClient_SetMessageCallback(iotHubClientHandle, ReceiveMessageCallback, receiveContext) != IOTHUB_CLIENT_OK)
markrad 3:c0556ff7b8e3 236 stall(pc, "ERROR: IoTHubClient_SetMessageCallback failed\r\n");
markrad 3:c0556ff7b8e3 237
markrad 3:c0556ff7b8e3 238 return iotHubClientHandle;
markrad 3:c0556ff7b8e3 239 }
markrad 3:c0556ff7b8e3 240
markrad 3:c0556ff7b8e3 241 void terminateConnection(Serial &pc, IOTHUB_CLIENT_HANDLE iotHubClientHandle)
markrad 3:c0556ff7b8e3 242 {
markrad 3:c0556ff7b8e3 243 printf("Calling IoTHubClient_Destroy\r\n");
markrad 3:c0556ff7b8e3 244 IoTHubClient_Destroy(iotHubClientHandle);
markrad 3:c0556ff7b8e3 245 printf("Calling platform_deinit\r\n");
markrad 3:c0556ff7b8e3 246 platform_deinit();
markrad 3:c0556ff7b8e3 247 printf("Connection terminated\r\n");
markrad 3:c0556ff7b8e3 248 }
markrad 3:c0556ff7b8e3 249
markrad 5:3d814faa2b2e 250 void calibrate(double *pmean, double *pdeviation)
markrad 5:3d814faa2b2e 251 {
markrad 5:3d814faa2b2e 252 READING reading;
markrad 5:3d814faa2b2e 253 const int calibrationPeriod = 10; // in seconds
markrad 5:3d814faa2b2e 254 SingletonFXOS8700CQ &sfxos = SingletonFXOS8700CQ::getInstance();
markrad 5:3d814faa2b2e 255
markrad 6:0bffe8529f60 256 double *data = new double[calibrationPeriod * 50];
markrad 5:3d814faa2b2e 257 int i;
markrad 6:0bffe8529f60 258 double sum = 0.0;
markrad 6:0bffe8529f60 259 double mean = 0.0;
markrad 5:3d814faa2b2e 260 double temp;
markrad 5:3d814faa2b2e 261
markrad 5:3d814faa2b2e 262 printf("Calibrating...\r\n");
markrad 5:3d814faa2b2e 263
markrad 5:3d814faa2b2e 264 for (i = 0; i < calibrationPeriod * 50; i++)
markrad 5:3d814faa2b2e 265 {
markrad 5:3d814faa2b2e 266 if (sfxos.getInt2Triggered())
markrad 5:3d814faa2b2e 267 {
markrad 5:3d814faa2b2e 268 sfxos.setInt2Triggered(false);
markrad 5:3d814faa2b2e 269 sfxos.getData(reading);
markrad 6:0bffe8529f60 270 data[i] = sqrt((double)(reading.accelerometer.x * reading.accelerometer.x) + (reading.accelerometer.y * reading.accelerometer.y));
markrad 6:0bffe8529f60 271 // data[i] = reading.accelerometer.x + reading.accelerometer.y;
markrad 6:0bffe8529f60 272 printf("x=%d\t\ty=%d\t\tsum=%f\r\n", reading.accelerometer.x, reading.accelerometer.y, data[i]);
markrad 5:3d814faa2b2e 273 sum += data[i];
markrad 5:3d814faa2b2e 274 wait_ms(20);
markrad 5:3d814faa2b2e 275 }
markrad 5:3d814faa2b2e 276 else
markrad 5:3d814faa2b2e 277 {
markrad 5:3d814faa2b2e 278 printf("no data\r\n");
markrad 6:0bffe8529f60 279 wait_ms(20);
markrad 5:3d814faa2b2e 280 i--; // Try that reading again
markrad 5:3d814faa2b2e 281 }
markrad 5:3d814faa2b2e 282 }
markrad 5:3d814faa2b2e 283
markrad 5:3d814faa2b2e 284 mean = (double)sum / (double)(calibrationPeriod * 50);
markrad 5:3d814faa2b2e 285
markrad 5:3d814faa2b2e 286 for (i = 0; i < calibrationPeriod * 50; i++)
markrad 5:3d814faa2b2e 287 {
markrad 5:3d814faa2b2e 288 temp += ((float)data[i] - mean) * ((float)data[i] - mean);
markrad 5:3d814faa2b2e 289 }
markrad 5:3d814faa2b2e 290
markrad 5:3d814faa2b2e 291 temp /= (double)(calibrationPeriod * 50);
markrad 5:3d814faa2b2e 292
markrad 5:3d814faa2b2e 293 delete [] data;
markrad 5:3d814faa2b2e 294
markrad 5:3d814faa2b2e 295 *pmean = mean;
markrad 5:3d814faa2b2e 296 *pdeviation = sqrt(temp);
markrad 5:3d814faa2b2e 297
markrad 5:3d814faa2b2e 298 printf("Calibration complete - mean=%f; devation=%f\r\n", *pmean, *pdeviation);
markrad 5:3d814faa2b2e 299 }
markrad 3:c0556ff7b8e3 300
markrad 0:6c46c366f500 301 int main()
markrad 0:6c46c366f500 302 {
markrad 4:9b3da9969b1b 303 const char *connectionString = "HostName=MarkRadHub1.azure-devices.net;DeviceId=mrcc3200;SharedAccessKey=8pGKChTBsz0VGw234iLX7XDDKwcyWRC7hsrVZEHfZHs=";
markrad 0:6c46c366f500 304
markrad 0:6c46c366f500 305 READING reading;
markrad 0:6c46c366f500 306 Serial pc(USBTX, USBRX); // Primary output to demonstrate library
markrad 0:6c46c366f500 307 SingletonFXOS8700CQ &sfxos = SingletonFXOS8700CQ::getInstance();
markrad 0:6c46c366f500 308 IOTHUB_CLIENT_HANDLE iotHubClientHandle;
markrad 0:6c46c366f500 309 int receiveContext = 0;
markrad 0:6c46c366f500 310 int transmitCounter = 0;
markrad 5:3d814faa2b2e 311 double mean;
markrad 5:3d814faa2b2e 312 double deviation;
markrad 2:2b9acda15ef0 313
markrad 0:6c46c366f500 314 pc.baud(115200); // Print quickly! 200Hz x line of output data!
markrad 0:6c46c366f500 315
markrad 6:0bffe8529f60 316 printf("\n\n\rFXOS8700CQ identity = %X\r\n", sfxos.getWhoAmI());
markrad 0:6c46c366f500 317
markrad 2:2b9acda15ef0 318 msgLock = Lock_Init(); // TODO: Check error code
markrad 2:2b9acda15ef0 319
markrad 0:6c46c366f500 320 sfxos.enable();
markrad 0:6c46c366f500 321 sfxos.getData(reading);
markrad 0:6c46c366f500 322
markrad 0:6c46c366f500 323 int rc;
markrad 0:6c46c366f500 324
markrad 1:0366fad6e60c 325 int LOOPCOUNT = -1; // Set to -1 to run forever
markrad 0:6c46c366f500 326
markrad 2:2b9acda15ef0 327 int localMsgCount;
markrad 2:2b9acda15ef0 328 int *userContext;
markrad 2:2b9acda15ef0 329 IOTHUB_MESSAGE_HANDLE msgHandle;
markrad 3:c0556ff7b8e3 330 int elapsedTime = 0;
markrad 2:2b9acda15ef0 331
markrad 0:6c46c366f500 332 char buffer[200];
markrad 0:6c46c366f500 333
markrad 3:c0556ff7b8e3 334 iotHubClientHandle = setupConnection(pc, connectionString, MQTT_Protocol, &receiveContext);
markrad 3:c0556ff7b8e3 335
markrad 5:3d814faa2b2e 336 calibrate(&mean, &deviation);
markrad 5:3d814faa2b2e 337
markrad 4:9b3da9969b1b 338 int readCount = 0;
markrad 4:9b3da9969b1b 339 int32_t maxVal = LONG_MIN;
markrad 4:9b3da9969b1b 340 int32_t curVal;
markrad 5:3d814faa2b2e 341 int32_t oneHour = 60 * 60 * 50;
markrad 4:9b3da9969b1b 342
markrad 0:6c46c366f500 343 while (LOOPCOUNT)
markrad 0:6c46c366f500 344 {
markrad 0:6c46c366f500 345 if (sfxos.getInt2Triggered())
markrad 0:6c46c366f500 346 {
markrad 0:6c46c366f500 347 sfxos.setInt2Triggered(false);
markrad 0:6c46c366f500 348 sfxos.getData(reading);
markrad 4:9b3da9969b1b 349 curVal = (reading.accelerometer.x * reading.accelerometer.x) + (reading.accelerometer.y * reading.accelerometer.y);
markrad 4:9b3da9969b1b 350
markrad 4:9b3da9969b1b 351 if (curVal > maxVal)
markrad 5:3d814faa2b2e 352 {
markrad 4:9b3da9969b1b 353 maxVal = curVal;
markrad 6:0bffe8529f60 354 //printf("new maxVal=%d\r\n", maxVal);
markrad 5:3d814faa2b2e 355 }
markrad 4:9b3da9969b1b 356
markrad 4:9b3da9969b1b 357 //rc = readingToJSON(buffer, sizeof(buffer), reading);
markrad 4:9b3da9969b1b 358
markrad 4:9b3da9969b1b 359 //if (rc > sizeof(buffer))
markrad 4:9b3da9969b1b 360 //printf("ERROR: JSON buffer too small - require %d characters\n", rc);
markrad 0:6c46c366f500 361
markrad 4:9b3da9969b1b 362 if (++readCount >= 50)
markrad 0:6c46c366f500 363 {
markrad 4:9b3da9969b1b 364 Lock(msgLock);
markrad 4:9b3da9969b1b 365 localMsgCount = msgCount;
markrad 4:9b3da9969b1b 366 Unlock(msgLock);
markrad 4:9b3da9969b1b 367
markrad 4:9b3da9969b1b 368 if (localMsgCount < 2)
markrad 0:6c46c366f500 369 {
markrad 4:9b3da9969b1b 370 rc = JSONifyData(buffer, sizeof(buffer), maxVal);
markrad 6:0bffe8529f60 371 //printf("DATA >>>%s<<<\r\n", buffer);
markrad 2:2b9acda15ef0 372
markrad 4:9b3da9969b1b 373 if ((msgHandle = IoTHubMessage_CreateFromByteArray((const unsigned char*)buffer, rc)) == NULL)
markrad 4:9b3da9969b1b 374 {
markrad 4:9b3da9969b1b 375 (void)printf("ERROR: iotHubMessageHandle is NULL!\r\n");
markrad 4:9b3da9969b1b 376 }
markrad 4:9b3da9969b1b 377 else
markrad 0:6c46c366f500 378 {
markrad 4:9b3da9969b1b 379 userContext = (int *) malloc(sizeof(userContext));
markrad 4:9b3da9969b1b 380
markrad 4:9b3da9969b1b 381 if (userContext != NULL)
markrad 2:2b9acda15ef0 382 {
markrad 4:9b3da9969b1b 383 *userContext = transmitCounter;
markrad 4:9b3da9969b1b 384
markrad 4:9b3da9969b1b 385 if (IoTHubClient_SendEventAsync(iotHubClientHandle, msgHandle, SendConfirmationCallback, userContext) != IOTHUB_CLIENT_OK)
markrad 4:9b3da9969b1b 386 {
markrad 4:9b3da9969b1b 387 (void)printf("ERROR: IoTHubClient_LL_SendEventAsync..........FAILED!\r\n");
markrad 4:9b3da9969b1b 388 }
markrad 4:9b3da9969b1b 389 else
markrad 4:9b3da9969b1b 390 {
markrad 4:9b3da9969b1b 391 (void)printf("IoTHubClient_LL_SendEventAsync accepted message [%d] for transmission to IoT Hub.\r\n", (int)transmitCounter);
markrad 4:9b3da9969b1b 392 }
markrad 4:9b3da9969b1b 393
markrad 4:9b3da9969b1b 394 IoTHubMessage_Destroy(msgHandle);
markrad 4:9b3da9969b1b 395 Lock(msgLock);
markrad 4:9b3da9969b1b 396 msgCount++;
markrad 4:9b3da9969b1b 397 t.start();
markrad 4:9b3da9969b1b 398 Unlock(msgLock);
markrad 4:9b3da9969b1b 399
markrad 4:9b3da9969b1b 400 transmitCounter++;
markrad 2:2b9acda15ef0 401 }
markrad 2:2b9acda15ef0 402 else
markrad 2:2b9acda15ef0 403 {
markrad 4:9b3da9969b1b 404 (void)printf("ERROR: malloc - unable to allocate user context\r\n");
markrad 2:2b9acda15ef0 405 }
markrad 0:6c46c366f500 406 }
markrad 0:6c46c366f500 407 }
markrad 4:9b3da9969b1b 408 else
markrad 4:9b3da9969b1b 409 {
markrad 6:0bffe8529f60 410 (void)printf("WARNING: Message dropped queue length %d\r\n", localMsgCount);
markrad 4:9b3da9969b1b 411 }
markrad 4:9b3da9969b1b 412
markrad 4:9b3da9969b1b 413 Lock(msgLock);
markrad 4:9b3da9969b1b 414 elapsedTime = t.read_ms();
markrad 4:9b3da9969b1b 415 Unlock(msgLock);
markrad 4:9b3da9969b1b 416
markrad 4:9b3da9969b1b 417 if (elapsedTime > CONNECTIONTIMEOUT)
markrad 4:9b3da9969b1b 418 {
markrad 4:9b3da9969b1b 419 printf("No response for %d milliseconds - attempt reconnection\r\n", elapsedTime);
markrad 4:9b3da9969b1b 420 NVIC_SystemReset(); // Just blow it all away
markrad 4:9b3da9969b1b 421 terminateConnection(pc, iotHubClientHandle);
markrad 4:9b3da9969b1b 422 iotHubClientHandle = setupConnection(pc, connectionString, MQTT_Protocol, &receiveContext);
markrad 4:9b3da9969b1b 423 printf("Reconnection complete\r\n");
markrad 4:9b3da9969b1b 424 }
markrad 4:9b3da9969b1b 425
markrad 4:9b3da9969b1b 426 if (LOOPCOUNT > 0)
markrad 4:9b3da9969b1b 427 LOOPCOUNT--;
markrad 4:9b3da9969b1b 428 readCount = 0;
markrad 4:9b3da9969b1b 429 maxVal = LONG_MIN;
markrad 2:2b9acda15ef0 430 }
markrad 4:9b3da9969b1b 431 }
markrad 4:9b3da9969b1b 432 else
markrad 4:9b3da9969b1b 433 {
markrad 6:0bffe8529f60 434 printf("WARNING: Sensor was not ready in time\r\n");
markrad 0:6c46c366f500 435 }
markrad 0:6c46c366f500 436
markrad 4:9b3da9969b1b 437 // Read at 50 hz
markrad 5:3d814faa2b2e 438
markrad 6:0bffe8529f60 439 if (--oneHour <= 0)
markrad 5:3d814faa2b2e 440 {
markrad 5:3d814faa2b2e 441 printf("INFO: Updating RTC from NTP server\r\n");
markrad 5:3d814faa2b2e 442
markrad 5:3d814faa2b2e 443 if (ntp.setTime("0.pool.ntp.org") != 0)
markrad 5:3d814faa2b2e 444 {
markrad 5:3d814faa2b2e 445 printf("ERROR: Failed to set current time from NTP server\r\n");
markrad 5:3d814faa2b2e 446 }
markrad 6:0bffe8529f60 447 else
markrad 6:0bffe8529f60 448 {
markrad 6:0bffe8529f60 449 oneHour = 60 * 60 * 50;
markrad 6:0bffe8529f60 450 }
markrad 5:3d814faa2b2e 451 }
markrad 5:3d814faa2b2e 452
markrad 4:9b3da9969b1b 453 wait_ms(20);
markrad 0:6c46c366f500 454 }
markrad 0:6c46c366f500 455
markrad 0:6c46c366f500 456 printf("Loop complete - clean up\n");
markrad 0:6c46c366f500 457
markrad 3:c0556ff7b8e3 458 terminateConnection(pc, iotHubClientHandle);
markrad 2:2b9acda15ef0 459 Lock_Deinit(msgLock);
markrad 2:2b9acda15ef0 460
markrad 0:6c46c366f500 461 printf("Test complete\n");
markrad 0:6c46c366f500 462
markrad 0:6c46c366f500 463
markrad 4:9b3da9969b1b 464 while(true)
markrad 4:9b3da9969b1b 465 {
markrad 0:6c46c366f500 466 pc.putc('.'); // idle dots
markrad 0:6c46c366f500 467 wait(1.0);
markrad 0:6c46c366f500 468 }
markrad 0:6c46c366f500 469 }