final product

Dependencies:   FRDM_MMA8451Q mbed

Fork of mbed_Pedometer_pressup by Costa

Committer:
eddytomhall
Date:
Thu Jun 16 15:22:50 2016 +0000
Revision:
2:b6569bd9af81
Parent:
1:bf4ad12efb64
Child:
4:a8d5a55a89da
Finished running unit for fitness unit

Who changed what in which revision?

UserRevisionLine numberNew contents of line
muyiq 0:0cccdf8e396f 1 #include "mbed.h"
eddytomhall 1:bf4ad12efb64 2 #include "MMA8451Q.h"
muyiq 0:0cccdf8e396f 3 //#include "TSISensor.h"
muyiq 0:0cccdf8e396f 4 #define DEBUG
muyiq 0:0cccdf8e396f 5 #define INFOMESSAGES
muyiq 0:0cccdf8e396f 6 #define WARNMESSAGES
muyiq 0:0cccdf8e396f 7 #define ERRMESSAGES
eddytomhall 1:bf4ad12efb64 8
muyiq 0:0cccdf8e396f 9 #define FUNCNAME "MAIN"
eddytomhall 1:bf4ad12efb64 10
eddytomhall 1:bf4ad12efb64 11
eddytomhall 1:bf4ad12efb64 12
eddytomhall 1:bf4ad12efb64 13 #if defined (TARGET_KL25Z) || defined (TARGET_KL46Z)
eddytomhall 1:bf4ad12efb64 14 PinName const SDA = PTE25;
eddytomhall 1:bf4ad12efb64 15 PinName const SCL = PTE24;
eddytomhall 1:bf4ad12efb64 16 #elif defined (TARGET_KL05Z)
eddytomhall 1:bf4ad12efb64 17 PinName const SDA = PTB4;
eddytomhall 1:bf4ad12efb64 18 PinName const SCL = PTB3;
eddytomhall 1:bf4ad12efb64 19 #elif defined (TARGET_K20D50M)
eddytomhall 1:bf4ad12efb64 20 PinName const SDA = PTB1;
eddytomhall 1:bf4ad12efb64 21 PinName const SCL = PTB0;
eddytomhall 1:bf4ad12efb64 22 #else
eddytomhall 1:bf4ad12efb64 23 #error TARGET NOT DEFINED
eddytomhall 1:bf4ad12efb64 24 #endif
eddytomhall 1:bf4ad12efb64 25
eddytomhall 1:bf4ad12efb64 26 #define MMA8451_I2C_ADDRESS (0x1d<<1)
eddytomhall 1:bf4ad12efb64 27
eddytomhall 1:bf4ad12efb64 28
muyiq 0:0cccdf8e396f 29 #ifdef NoDEBUG
muyiq 0:0cccdf8e396f 30 #define DBG(x, ...) pc.printf(" ["FUNCNAME" : DBG] "x" <line %d>\r\n", ##__VA_ARGS__,__LINE__);
muyiq 0:0cccdf8e396f 31 #else
muyiq 0:0cccdf8e396f 32 #define DBG(x, ...)
muyiq 0:0cccdf8e396f 33 #endif
eddytomhall 1:bf4ad12efb64 34
muyiq 0:0cccdf8e396f 35 #ifdef ERRMESSAGES
muyiq 0:0cccdf8e396f 36 #define ERR(x, ...) pc.printf(" ["FUNCNAME" : ERR] "x"\r\n", ##__VA_ARGS__);
muyiq 0:0cccdf8e396f 37 #else
muyiq 0:0cccdf8e396f 38 #define ERR(x, ...)
muyiq 0:0cccdf8e396f 39 #endif
eddytomhall 1:bf4ad12efb64 40
muyiq 0:0cccdf8e396f 41 #ifdef WARNMESSAGES
muyiq 0:0cccdf8e396f 42 #define WARN(x, ...) printf("["FUNCNAME" : WARN] "x"\r\n", ##__VA_ARGS__);
muyiq 0:0cccdf8e396f 43 #else
muyiq 0:0cccdf8e396f 44 #define WARN(x, ...)
muyiq 0:0cccdf8e396f 45 #endif
eddytomhall 1:bf4ad12efb64 46
muyiq 0:0cccdf8e396f 47 #ifdef INFOMESSAGES
eddytomhall 1:bf4ad12efb64 48 #define INFO(x, ...) pc.printf("["FUNCNAME" : INFO] "x"\r\n",##__VA_ARGS__);
muyiq 0:0cccdf8e396f 49 #else
muyiq 0:0cccdf8e396f 50 #define INFO(x, ...)
muyiq 0:0cccdf8e396f 51 #endif
eddytomhall 1:bf4ad12efb64 52
muyiq 0:0cccdf8e396f 53 #define BUFF_SIZE 1024
muyiq 0:0cccdf8e396f 54 // PIN DEFS NOW FOR OLD FIRMWARE VERSION OF THE KL25Z
muyiq 0:0cccdf8e396f 55 Serial pc(USBTX, USBRX);
muyiq 0:0cccdf8e396f 56 //RawSerial dev(D1, D0);
eddytomhall 1:bf4ad12efb64 57 Serial dev(PTE22,PTE23); //tx,rx
muyiq 0:0cccdf8e396f 58 DigitalOut led1(LED1);
muyiq 0:0cccdf8e396f 59 DigitalOut led4(LED3); // CHANGE TO LED 3
eddytomhall 1:bf4ad12efb64 60 DigitalOut reset(PTB0,1);
eddytomhall 1:bf4ad12efb64 61
eddytomhall 1:bf4ad12efb64 62
eddytomhall 1:bf4ad12efb64 63
eddytomhall 1:bf4ad12efb64 64 PwmOut led(LED_GREEN);
muyiq 0:0cccdf8e396f 65 // TSISensor tsi;
muyiq 0:0cccdf8e396f 66 volatile int state=0;
muyiq 0:0cccdf8e396f 67 volatile int ready=0;
eddytomhall 1:bf4ad12efb64 68 int glue=0;
muyiq 0:0cccdf8e396f 69 char ipAddress[20];
muyiq 0:0cccdf8e396f 70 char macAddress[32];
muyiq 0:0cccdf8e396f 71 char *buffer;
muyiq 0:0cccdf8e396f 72 unsigned int bufferPnt=0;
eddytomhall 1:bf4ad12efb64 73
muyiq 0:0cccdf8e396f 74 void dev_recv()
muyiq 0:0cccdf8e396f 75 {
muyiq 0:0cccdf8e396f 76 char c;
eddytomhall 1:bf4ad12efb64 77
muyiq 0:0cccdf8e396f 78 int count = 0;
eddytomhall 1:bf4ad12efb64 79
muyiq 0:0cccdf8e396f 80 led1 = !led1;
muyiq 0:0cccdf8e396f 81 if(bufferPnt==0) {
muyiq 0:0cccdf8e396f 82 memset(buffer,0,BUFF_SIZE);
muyiq 0:0cccdf8e396f 83 }
muyiq 0:0cccdf8e396f 84 while(dev.readable()) {
muyiq 0:0cccdf8e396f 85 c = (char)dev.getc();
muyiq 0:0cccdf8e396f 86 #ifdef DEBUG
eddytomhall 1:bf4ad12efb64 87 pc.putc(c);
muyiq 0:0cccdf8e396f 88 #endif
muyiq 0:0cccdf8e396f 89 buffer[bufferPnt]=c;
muyiq 0:0cccdf8e396f 90 bufferPnt++;
muyiq 0:0cccdf8e396f 91 if (bufferPnt>1000) {
muyiq 0:0cccdf8e396f 92 ready=1;
muyiq 0:0cccdf8e396f 93 }
eddytomhall 1:bf4ad12efb64 94 // if ((c==0x0a)||(c==0x0d)){
muyiq 0:0cccdf8e396f 95 // ready=1;
muyiq 0:0cccdf8e396f 96 // }else
muyiq 0:0cccdf8e396f 97 if (c==0x0a) {
muyiq 0:0cccdf8e396f 98 if (bufferPnt>1) {
muyiq 0:0cccdf8e396f 99 if (buffer[bufferPnt -2]==0x0d) {
muyiq 0:0cccdf8e396f 100 ready=1;
muyiq 0:0cccdf8e396f 101 break;
muyiq 0:0cccdf8e396f 102 }
muyiq 0:0cccdf8e396f 103 }
muyiq 0:0cccdf8e396f 104 }
muyiq 0:0cccdf8e396f 105 if (!dev.readable()) {
muyiq 0:0cccdf8e396f 106 wait_us(10);
muyiq 0:0cccdf8e396f 107 }
muyiq 0:0cccdf8e396f 108 }
muyiq 0:0cccdf8e396f 109 }
eddytomhall 1:bf4ad12efb64 110
muyiq 0:0cccdf8e396f 111 void pc_recv()
muyiq 0:0cccdf8e396f 112 {
muyiq 0:0cccdf8e396f 113 char c;
muyiq 0:0cccdf8e396f 114 led4 = !led4;
muyiq 0:0cccdf8e396f 115 while(pc.readable()) {
muyiq 0:0cccdf8e396f 116 c=(char)pc.getc();
muyiq 0:0cccdf8e396f 117 dev.putc(c);
muyiq 0:0cccdf8e396f 118 pc.putc(c);
muyiq 0:0cccdf8e396f 119 if(c==13) {
muyiq 0:0cccdf8e396f 120 dev.putc(10);
muyiq 0:0cccdf8e396f 121 pc.putc(10);
eddytomhall 1:bf4ad12efb64 122 }
eddytomhall 1:bf4ad12efb64 123
muyiq 0:0cccdf8e396f 124 }
muyiq 0:0cccdf8e396f 125 }
eddytomhall 1:bf4ad12efb64 126
muyiq 0:0cccdf8e396f 127 char * OKResponse(char *test, const char *pattern)
muyiq 0:0cccdf8e396f 128 {
muyiq 0:0cccdf8e396f 129 char *p= strstr(test,pattern);
muyiq 0:0cccdf8e396f 130 if (p==NULL) {
muyiq 0:0cccdf8e396f 131 // DBG("Test=<%s> Patter=<%s> NULL [p=%s]",test,pattern,p);
muyiq 0:0cccdf8e396f 132 return NULL;
muyiq 0:0cccdf8e396f 133 } else {
muyiq 0:0cccdf8e396f 134 // DBG("YAY Test=<%s> Patter=<%s> [p=%s]",test,pattern,p);
muyiq 0:0cccdf8e396f 135 }
muyiq 0:0cccdf8e396f 136 return p;
muyiq 0:0cccdf8e396f 137 }
muyiq 0:0cccdf8e396f 138 int main()
muyiq 0:0cccdf8e396f 139 {
eddytomhall 1:bf4ad12efb64 140 MMA8451Q acc(SDA, SCL, MMA8451_I2C_ADDRESS);
muyiq 0:0cccdf8e396f 141 float touch;
muyiq 0:0cccdf8e396f 142 buffer=(char *)calloc(BUFF_SIZE,1);
muyiq 0:0cccdf8e396f 143 reset=0;
muyiq 0:0cccdf8e396f 144 int counter=0;
eddytomhall 1:bf4ad12efb64 145 int zcount;
eddytomhall 1:bf4ad12efb64 146 int xcount;
eddytomhall 1:bf4ad12efb64 147 zcount=0;
eddytomhall 1:bf4ad12efb64 148 xcount=0;
eddytomhall 1:bf4ad12efb64 149 float a;
eddytomhall 1:bf4ad12efb64 150 float b;
eddytomhall 1:bf4ad12efb64 151 b=1.0;
eddytomhall 1:bf4ad12efb64 152 a=1.0;
eddytomhall 1:bf4ad12efb64 153 float x;
eddytomhall 1:bf4ad12efb64 154 float z;
muyiq 0:0cccdf8e396f 155 pc.baud(115200);
muyiq 0:0cccdf8e396f 156 dev.baud(115200);
muyiq 0:0cccdf8e396f 157 pc.attach(&pc_recv, Serial::RxIrq);
muyiq 0:0cccdf8e396f 158 dev.attach(&dev_recv, Serial::RxIrq);
muyiq 0:0cccdf8e396f 159 pc.printf("Start up\n\r");
eddytomhall 1:bf4ad12efb64 160 wait(3.0);
muyiq 0:0cccdf8e396f 161 reset=1;
muyiq 0:0cccdf8e396f 162 char * resp=NULL;
muyiq 0:0cccdf8e396f 163 pc.printf("Here \n\r");
muyiq 0:0cccdf8e396f 164 while(1) {
muyiq 0:0cccdf8e396f 165 if (ready) {
muyiq 0:0cccdf8e396f 166 ready=0;
muyiq 0:0cccdf8e396f 167 bufferPnt=0;
muyiq 0:0cccdf8e396f 168 INFO("[%d],##%s##",state,buffer);
muyiq 0:0cccdf8e396f 169 switch (state) {
muyiq 0:0cccdf8e396f 170 case 0: {
muyiq 0:0cccdf8e396f 171 resp=OKResponse(buffer,"WIFI GOT IP");
muyiq 0:0cccdf8e396f 172 if (resp!=NULL) {
muyiq 0:0cccdf8e396f 173 wait(1);
muyiq 0:0cccdf8e396f 174 dev.printf("AT\r\n");
muyiq 0:0cccdf8e396f 175 state++;
muyiq 0:0cccdf8e396f 176 }
muyiq 0:0cccdf8e396f 177 break;
muyiq 0:0cccdf8e396f 178 }
muyiq 0:0cccdf8e396f 179 case 1:
muyiq 0:0cccdf8e396f 180 case 2: {
muyiq 0:0cccdf8e396f 181 resp=OKResponse(buffer,"OK");
muyiq 0:0cccdf8e396f 182 if (resp!=NULL) {
muyiq 0:0cccdf8e396f 183 dev.printf("AT\r\n");
muyiq 0:0cccdf8e396f 184 state++;
muyiq 0:0cccdf8e396f 185 }
muyiq 0:0cccdf8e396f 186 break;
muyiq 0:0cccdf8e396f 187 }
muyiq 0:0cccdf8e396f 188 case 3: {
muyiq 0:0cccdf8e396f 189 resp=OKResponse(buffer,"OK");
muyiq 0:0cccdf8e396f 190 if (resp!=NULL) {
muyiq 0:0cccdf8e396f 191 dev.printf("AT+RST\r\n");
muyiq 0:0cccdf8e396f 192 state++;
muyiq 0:0cccdf8e396f 193 }
eddytomhall 1:bf4ad12efb64 194
muyiq 0:0cccdf8e396f 195 break;
muyiq 0:0cccdf8e396f 196 }
muyiq 0:0cccdf8e396f 197 case 4: {
muyiq 0:0cccdf8e396f 198 resp=OKResponse(buffer,"WIFI GOT IP");
muyiq 0:0cccdf8e396f 199 if (resp!=NULL) {
muyiq 0:0cccdf8e396f 200 dev.printf("AT+CWMODE=1\r\n");
muyiq 0:0cccdf8e396f 201 state++;
muyiq 0:0cccdf8e396f 202 }
eddytomhall 1:bf4ad12efb64 203
muyiq 0:0cccdf8e396f 204 break;
muyiq 0:0cccdf8e396f 205 }
muyiq 0:0cccdf8e396f 206 case 5: {
muyiq 0:0cccdf8e396f 207 resp=OKResponse(buffer,"OK");
muyiq 0:0cccdf8e396f 208 if (resp!=NULL) {
eddytomhall 1:bf4ad12efb64 209
eddytomhall 1:bf4ad12efb64 210 dev.printf("AT+CWJAP=\"BTHub3-WXWX\",\"fdd6f7c682\"\r\n");
muyiq 0:0cccdf8e396f 211 state++;
muyiq 0:0cccdf8e396f 212 }
eddytomhall 1:bf4ad12efb64 213
muyiq 0:0cccdf8e396f 214 break;
muyiq 0:0cccdf8e396f 215 }
muyiq 0:0cccdf8e396f 216 case 6: {
muyiq 0:0cccdf8e396f 217 resp=OKResponse(buffer,"OK");
muyiq 0:0cccdf8e396f 218 if (resp!=NULL) {
muyiq 0:0cccdf8e396f 219 wait(1);
muyiq 0:0cccdf8e396f 220 dev.printf("AT+CIFSR\r\n");
muyiq 0:0cccdf8e396f 221 state++;
muyiq 0:0cccdf8e396f 222 }
eddytomhall 1:bf4ad12efb64 223
muyiq 0:0cccdf8e396f 224 break;
muyiq 0:0cccdf8e396f 225 }
muyiq 0:0cccdf8e396f 226 case 7: {
muyiq 0:0cccdf8e396f 227 resp=OKResponse(buffer,"+CIFSR:STAIP,");
muyiq 0:0cccdf8e396f 228 if (resp!=NULL) {
muyiq 0:0cccdf8e396f 229 char *strt = strtok(buffer,"\"");
muyiq 0:0cccdf8e396f 230 strcpy(ipAddress,strtok(NULL,"\""));
muyiq 0:0cccdf8e396f 231 strtok(NULL,"\"");
eddytomhall 1:bf4ad12efb64 232 strcpy(macAddress,strtok(NULL,"\""));
muyiq 0:0cccdf8e396f 233 INFO("mac Address = %s", macAddress);
muyiq 0:0cccdf8e396f 234 INFO("IP Address = %s", ipAddress);
eddytomhall 1:bf4ad12efb64 235 dev.printf("AT+CIPMUX=1\r\n");
muyiq 0:0cccdf8e396f 236 state++;
muyiq 0:0cccdf8e396f 237 }
eddytomhall 1:bf4ad12efb64 238
muyiq 0:0cccdf8e396f 239 break;
muyiq 0:0cccdf8e396f 240 }
muyiq 0:0cccdf8e396f 241 case 8: {
muyiq 0:0cccdf8e396f 242 resp=OKResponse(buffer,"OK");
muyiq 0:0cccdf8e396f 243 if (resp!=NULL) {
eddytomhall 1:bf4ad12efb64 244
eddytomhall 1:bf4ad12efb64 245 INFO("Ready 8");
eddytomhall 1:bf4ad12efb64 246 dev.printf("AT+CIPSTART=4,\"TCP\",\"192.168.1.91\",8080\r\n");
eddytomhall 1:bf4ad12efb64 247 state++;
eddytomhall 1:bf4ad12efb64 248 wait(0.1);
eddytomhall 1:bf4ad12efb64 249
muyiq 0:0cccdf8e396f 250 }
eddytomhall 1:bf4ad12efb64 251
eddytomhall 1:bf4ad12efb64 252 break;
eddytomhall 1:bf4ad12efb64 253 }
muyiq 0:0cccdf8e396f 254 case 9: {
eddytomhall 1:bf4ad12efb64 255
muyiq 0:0cccdf8e396f 256 resp=OKResponse(buffer,"OK");
muyiq 0:0cccdf8e396f 257 if (resp!=NULL) {
eddytomhall 1:bf4ad12efb64 258
eddytomhall 1:bf4ad12efb64 259 INFO("Ready 9");
eddytomhall 1:bf4ad12efb64 260 state++;
eddytomhall 1:bf4ad12efb64 261 zcount=0;
eddytomhall 1:bf4ad12efb64 262 a=1.0;
eddytomhall 1:bf4ad12efb64 263
muyiq 0:0cccdf8e396f 264 }
eddytomhall 1:bf4ad12efb64 265
eddytomhall 1:bf4ad12efb64 266 }
eddytomhall 1:bf4ad12efb64 267 case 10: {
eddytomhall 1:bf4ad12efb64 268
eddytomhall 2:b6569bd9af81 269 resp=OKResponse(buffer,"OK");
eddytomhall 2:b6569bd9af81 270 if (resp!=NULL) {
eddytomhall 2:b6569bd9af81 271 INFO("Ready 10");
eddytomhall 2:b6569bd9af81 272 dev.printf("AT+CIPSEND=4,9\r\n");
eddytomhall 2:b6569bd9af81 273 wait(0.1);
eddytomhall 2:b6569bd9af81 274
eddytomhall 2:b6569bd9af81 275 }
eddytomhall 2:b6569bd9af81 276 wait(0.1);
eddytomhall 2:b6569bd9af81 277 // while (OKResponse(buffer,">")!=NULL){
eddytomhall 2:b6569bd9af81 278 // printf(".\r\n");
eddytomhall 2:b6569bd9af81 279 // wait(1);
eddytomhall 2:b6569bd9af81 280 // };
eddytomhall 2:b6569bd9af81 281
eddytomhall 2:b6569bd9af81 282 INFO("SENDING");
eddytomhall 2:b6569bd9af81 283
eddytomhall 2:b6569bd9af81 284 wait(0.2);
eddytomhall 2:b6569bd9af81 285 dev.printf("PEDOMETER");
eddytomhall 2:b6569bd9af81 286
eddytomhall 1:bf4ad12efb64 287 while (true) {
eddytomhall 2:b6569bd9af81 288 z = (acc.getAccX());
eddytomhall 2:b6569bd9af81 289 x = (acc.getAccZ());
eddytomhall 1:bf4ad12efb64 290
eddytomhall 1:bf4ad12efb64 291 if (a==1.0) {
eddytomhall 1:bf4ad12efb64 292
eddytomhall 1:bf4ad12efb64 293 if (z<0.0) {
eddytomhall 1:bf4ad12efb64 294 a=0.0;
eddytomhall 1:bf4ad12efb64 295 zcount++;
eddytomhall 1:bf4ad12efb64 296 pc.printf(".......zc=%02u\r\n",zcount);
eddytomhall 1:bf4ad12efb64 297
eddytomhall 1:bf4ad12efb64 298 resp=OKResponse(buffer,"OK");
eddytomhall 1:bf4ad12efb64 299 if (resp!=NULL) {
eddytomhall 1:bf4ad12efb64 300 INFO("Ready 10");
eddytomhall 2:b6569bd9af81 301 dev.printf("AT+CIPSEND=4,4\r\n");
eddytomhall 1:bf4ad12efb64 302 wait(0.1);
eddytomhall 1:bf4ad12efb64 303
eddytomhall 1:bf4ad12efb64 304 }
eddytomhall 1:bf4ad12efb64 305 wait(0.1);
eddytomhall 1:bf4ad12efb64 306 // while (OKResponse(buffer,">")!=NULL){
eddytomhall 1:bf4ad12efb64 307 // printf(".\r\n");
eddytomhall 1:bf4ad12efb64 308 // wait(1);
eddytomhall 1:bf4ad12efb64 309 // };
eddytomhall 1:bf4ad12efb64 310
eddytomhall 1:bf4ad12efb64 311 INFO("SENDING");
eddytomhall 1:bf4ad12efb64 312
eddytomhall 1:bf4ad12efb64 313 wait(0.2);
eddytomhall 1:bf4ad12efb64 314 dev.printf("%02u\r\n",zcount);
eddytomhall 1:bf4ad12efb64 315
eddytomhall 1:bf4ad12efb64 316
eddytomhall 1:bf4ad12efb64 317
eddytomhall 1:bf4ad12efb64 318
eddytomhall 1:bf4ad12efb64 319 }
eddytomhall 1:bf4ad12efb64 320
eddytomhall 1:bf4ad12efb64 321 }
eddytomhall 1:bf4ad12efb64 322 if (z>0) {
eddytomhall 1:bf4ad12efb64 323 a=1.0;
eddytomhall 1:bf4ad12efb64 324 }
muyiq 0:0cccdf8e396f 325 }
eddytomhall 1:bf4ad12efb64 326 if (a==0) {
eddytomhall 1:bf4ad12efb64 327 if (z<0) {
eddytomhall 1:bf4ad12efb64 328 a=0.0;
eddytomhall 1:bf4ad12efb64 329 }
eddytomhall 1:bf4ad12efb64 330 if (z>0) {
eddytomhall 1:bf4ad12efb64 331 a=1.0;
eddytomhall 1:bf4ad12efb64 332 }
muyiq 0:0cccdf8e396f 333 }
eddytomhall 1:bf4ad12efb64 334 if (b==1) {
eddytomhall 1:bf4ad12efb64 335 if (x<0) {
eddytomhall 1:bf4ad12efb64 336 b=0.0;
eddytomhall 1:bf4ad12efb64 337 xcount=xcount+1;
eddytomhall 1:bf4ad12efb64 338 //printf("Xcount: %u \n\r",xcount);
eddytomhall 1:bf4ad12efb64 339
eddytomhall 1:bf4ad12efb64 340 }
eddytomhall 1:bf4ad12efb64 341 if (x>0) {
eddytomhall 1:bf4ad12efb64 342 b=1.0;
eddytomhall 1:bf4ad12efb64 343 }
eddytomhall 1:bf4ad12efb64 344 }
eddytomhall 2:b6569bd9af81 345
eddytomhall 1:bf4ad12efb64 346 if (b==0) {
eddytomhall 1:bf4ad12efb64 347 if (x<0) {
eddytomhall 1:bf4ad12efb64 348 b=0.0;
eddytomhall 1:bf4ad12efb64 349 }
eddytomhall 1:bf4ad12efb64 350 if (x>0) {
eddytomhall 1:bf4ad12efb64 351 b=1.0;
eddytomhall 1:bf4ad12efb64 352 }
eddytomhall 1:bf4ad12efb64 353 }
eddytomhall 1:bf4ad12efb64 354
muyiq 0:0cccdf8e396f 355 }
eddytomhall 1:bf4ad12efb64 356 break;
muyiq 0:0cccdf8e396f 357 }
muyiq 0:0cccdf8e396f 358 }
muyiq 0:0cccdf8e396f 359 //__WFI(); // DELETED AS IT KILLS THE KL25 RESPONSIVITY
muyiq 0:0cccdf8e396f 360 }
eddytomhall 1:bf4ad12efb64 361
eddytomhall 1:bf4ad12efb64 362 }