mDot / Mbed OS Honneywell_Dust_Simple

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Main.cpp@11:00cb0217ce8a, 2017-11-29 (annotated)

Committer:
Roietronics
Date:
Wed Nov 29 21:06:43 2017 +0000
Revision:
11:00cb0217ce8a
Parent:
10:43337cc2ac79
Child:
12:d5f15e5bd256
Version 2.1 Removed redundant code; Added comments

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Roietronics 11:00cb0217ce8a 1 /* Run Honeywell Dust Sensor in continous Sampling Mode on a mDot or
Roietronics 11:00cb0217ce8a 2 Freedom K64 board
Roietronics 11:00cb0217ce8a 3 Version 2.1
Roietronics 11:00cb0217ce8a 4 Steve Mylroie Roitronic November 29 2017
Roietronics 0:8326629a1b97 5 @C Copyright Global Quality Corp
Roietronics 0:8326629a1b97 6 */
Roietronics 0:8326629a1b97 7
Roietronics 0:8326629a1b97 8 #include "mbed.h"
Roietronics 0:8326629a1b97 9 #include "stdlib.h"
Roietronics 0:8326629a1b97 10
Roietronics 11:00cb0217ce8a 11 #define VERSION "2.1"
Roietronics 4:12dfd9a8ee76 12
Roietronics 0:8326629a1b97 13 #define TRACE_MODE
Roietronics 0:8326629a1b97 14
Roietronics 0:8326629a1b97 15 //Turn on trace logging to the PC USB port
Roietronics 0:8326629a1b97 16 #ifdef TRACE_MODE
Roietronics 11:00cb0217ce8a 17 //Log level need to be set one level higher than the highest level to be output
Roietronics 5:7cabc36d4352 18 #define LOG_LEVEL 2
Roietronics 0:8326629a1b97 19 #define DEBUG
Roietronics 0:8326629a1b97 20 #endif
Roietronics 0:8326629a1b97 21
Roietronics 3:1ba96949e2fd 22
Roietronics 0:8326629a1b97 23 const uint8_t* measureCommand = "68014057";
Roietronics 0:8326629a1b97 24 const uint8_t* stopCommand = "68012077";
Roietronics 0:8326629a1b97 25
Roietronics 5:7cabc36d4352 26 //Sensor command response codes
Roietronics 0:8326629a1b97 27 #define OK 0xA5A5
Roietronics 0:8326629a1b97 28 #define BAD 0x9696
Roietronics 0:8326629a1b97 29
Roietronics 5:7cabc36d4352 30 //Auto Mode measurement response lenght
Roietronics 0:8326629a1b97 31 #define MESSAGE_LEN 32
Roietronics 5:7cabc36d4352 32
Roietronics 0:8326629a1b97 33 //sensor measurement cycle in millseconds
Roietronics 0:8326629a1b97 34 #define MEASURE_DELAY 1500
Roietronics 0:8326629a1b97 35
Roietronics 3:1ba96949e2fd 36 Serial pc(USBTX, USBRX, 115200);
Roietronics 3:1ba96949e2fd 37
Roietronics 0:8326629a1b97 38 //Use USB debug pott for the debug stream
Roietronics 0:8326629a1b97 39 #ifdef DEBUG
Roietronics 3:1ba96949e2fd 40 uint32_t debugLevel = LOG_LEVEL;
Roietronics 3:1ba96949e2fd 41 #else
Roietronics 3:1ba96949e2fd 42 uint32_t debugLevel = 0;
Roietronics 0:8326629a1b97 43 #endif
Roietronics 0:8326629a1b97 44
Roietronics 3:1ba96949e2fd 45 void logInfo(char* text) {
Roietronics 3:1ba96949e2fd 46 if ( debugLevel > 0 ) {
Roietronics 3:1ba96949e2fd 47 pc.printf("\n%s\n", text );
Roietronics 3:1ba96949e2fd 48 }
Roietronics 3:1ba96949e2fd 49 return;
Roietronics 5:7cabc36d4352 50 }
Roietronics 3:1ba96949e2fd 51
Roietronics 3:1ba96949e2fd 52 void logTrace(uint8_t data) {
Roietronics 3:1ba96949e2fd 53 if (debugLevel > 2 ){ pc.putc( data );
Roietronics 3:1ba96949e2fd 54 }
Roietronics 3:1ba96949e2fd 55 return;
Roietronics 3:1ba96949e2fd 56 }
Roietronics 3:1ba96949e2fd 57
Roietronics 5:7cabc36d4352 58 //Board specfic serial port pin definitions
Roietronics 3:1ba96949e2fd 59
Roietronics 5:7cabc36d4352 60 #ifdef TARGET_Freescale //Freedom Board
Roietronics 5:7cabc36d4352 61
Roietronics 5:7cabc36d4352 62 #define SENSOR_XMT D1
Roietronics 5:7cabc36d4352 63 #define SENSOR_RCV D0
Roietronics 5:7cabc36d4352 64
Roietronics 5:7cabc36d4352 65 #endif
Roietronics 5:7cabc36d4352 66
Roietronics 5:7cabc36d4352 67 #ifdef TARGET_MTS_MDOT_F411RE //Multi Tech mDot
Roietronics 5:7cabc36d4352 68
Roietronics 5:7cabc36d4352 69 #define SENSOR_XMT PA_2
Roietronics 5:7cabc36d4352 70 #define SENSOR_RCV PA_3
Roietronics 5:7cabc36d4352 71
Roietronics 5:7cabc36d4352 72 #endif
Roietronics 5:7cabc36d4352 73
Roietronics 8:494f6fcecfbc 74 #define RESPONSE_MSG_LEN 2
Roietronics 8:494f6fcecfbc 75 #define AUTO_MSG_LEN 32
Roietronics 8:494f6fcecfbc 76
Roietronics 8:494f6fcecfbc 77 //Time required to receive one character at 9600 baud
Roietronics 8:494f6fcecfbc 78 #define CHAR_TIME 1000/9600 & 10
Roietronics 8:494f6fcecfbc 79
Roietronics 8:494f6fcecfbc 80 enum MSG_TYPE{ UNKNOWN,
Roietronics 8:494f6fcecfbc 81 ACK_MSG,
Roietronics 8:494f6fcecfbc 82 NAK_MSG,
Roietronics 8:494f6fcecfbc 83 AUTO_MSG,
Roietronics 8:494f6fcecfbc 84 READ_ERROR } msgType;
Roietronics 8:494f6fcecfbc 85
Roietronics 8:494f6fcecfbc 86
Roietronics 8:494f6fcecfbc 87 uint8_t dataBuffer[AUTO_MSG_LEN];
Roietronics 8:494f6fcecfbc 88 uint8_t* bufferPtr;
Roietronics 8:494f6fcecfbc 89 uint32_t msgLen;
Roietronics 8:494f6fcecfbc 90
Roietronics 8:494f6fcecfbc 91
Roietronics 5:7cabc36d4352 92 //Use a boards second UART to communicate witb the Honneywell sensor
Roietronics 0:8326629a1b97 93 //Default UART setting are 8,N,1
Roietronics 8:494f6fcecfbc 94 RawSerial sensor( SENSOR_XMT, SENSOR_RCV, 9600);
Roietronics 8:494f6fcecfbc 95
Roietronics 11:00cb0217ce8a 96 //Serial Received chararter interupt handler
Roietronics 8:494f6fcecfbc 97
Roietronics 8:494f6fcecfbc 98 void receiveInterrupt() {
Roietronics 8:494f6fcecfbc 99 uint8_t data;
Roietronics 8:494f6fcecfbc 100 if(sensor.readable()) {
Roietronics 8:494f6fcecfbc 101 data = sensor.getc();
Roietronics 11:00cb0217ce8a 102 if(msgType == UNKNOWN) { //Start of a new message
Roietronics 11:00cb0217ce8a 103 bufferPtr = dataBuffer;
Roietronics 8:494f6fcecfbc 104 switch(data) {
Roietronics 8:494f6fcecfbc 105 case 0x42:
Roietronics 8:494f6fcecfbc 106 msgType = AUTO_MSG;
Roietronics 8:494f6fcecfbc 107 msgLen = AUTO_MSG_LEN;
Roietronics 8:494f6fcecfbc 108 break;
Roietronics 8:494f6fcecfbc 109 case 0xA5:
Roietronics 8:494f6fcecfbc 110 msgType = ACK_MSG;
Roietronics 8:494f6fcecfbc 111 msgLen = RESPONSE_MSG_LEN;
Roietronics 8:494f6fcecfbc 112 break;
Roietronics 8:494f6fcecfbc 113 case 0x69:
Roietronics 8:494f6fcecfbc 114 msgType = NAK_MSG;
Roietronics 8:494f6fcecfbc 115 msgLen = RESPONSE_MSG_LEN;
Roietronics 8:494f6fcecfbc 116 break;
Roietronics 8:494f6fcecfbc 117 }
Roietronics 8:494f6fcecfbc 118 }
Roietronics 11:00cb0217ce8a 119 if(msgLen-- > 0 ) { //Insert Character into type ahead buffer
Roietronics 8:494f6fcecfbc 120 *bufferPtr++ = data;
Roietronics 8:494f6fcecfbc 121 }
Roietronics 8:494f6fcecfbc 122 }
Roietronics 8:494f6fcecfbc 123 return;
Roietronics 8:494f6fcecfbc 124 }
Roietronics 0:8326629a1b97 125
Roietronics 11:00cb0217ce8a 126 //Read last message received from type ahead message buffer
Roietronics 0:8326629a1b97 127 //Mbed 5 Serial class only supports single character read and writes or
Roietronics 10:43337cc2ac79 128 // async buffer reads and wrutes
Roietronics 8:494f6fcecfbc 129 MSG_TYPE readBuffer(uint8_t* buffer, uint16_t count)
Roietronics 0:8326629a1b97 130 {
Roietronics 11:00cb0217ce8a 131 if(buffer == NULL || count > AUTO_MSG_LEN ) { //Calling without buffer or
Roietronics 11:00cb0217ce8a 132 return READ_ERROR; //asking for too many chars
Roietronics 11:00cb0217ce8a 133 } //is an error
Roietronics 8:494f6fcecfbc 134 int counter = 0;
Roietronics 8:494f6fcecfbc 135 uint8_t* inPointer;
Roietronics 8:494f6fcecfbc 136 uint8_t* outPointer;
Roietronics 8:494f6fcecfbc 137 int delay;
Roietronics 11:00cb0217ce8a 138 logInfo( "Reading last message from sensor\n");
Roietronics 11:00cb0217ce8a 139 while(msgType == UNKNOWN ) { //No message received since last read
Roietronics 11:00cb0217ce8a 140 Thread::wait(CHAR_TIME); //Wait for new message
Roietronics 8:494f6fcecfbc 141 counter++;
Roietronics 11:00cb0217ce8a 142 if(counter > 40) { //Timeout exit after 40 character 40 Charcter times
Roietronics 8:494f6fcecfbc 143 break;
Roietronics 0:8326629a1b97 144 }
Roietronics 0:8326629a1b97 145 }
Roietronics 11:00cb0217ce8a 146 counter = 0;
Roietronics 11:00cb0217ce8a 147 while(msgLen > 0 ) { //Wait for complete message to arrive
Roietronics 8:494f6fcecfbc 148 delay = CHAR_TIME * msgLen;
Roietronics 11:00cb0217ce8a 149 Thread::wait(delay);
Roietronics 8:494f6fcecfbc 150 counter++;
Roietronics 11:00cb0217ce8a 151 if(counter > 40) { //Time out exit after 40 character times
Roietronics 8:494f6fcecfbc 152 break;
Roietronics 8:494f6fcecfbc 153 }
Roietronics 8:494f6fcecfbc 154 }
Roietronics 11:00cb0217ce8a 155 if(counter > 40 ) { //Report timeout error
Roietronics 8:494f6fcecfbc 156 msgType = UNKNOWN;
Roietronics 8:494f6fcecfbc 157 return READ_ERROR;
Roietronics 8:494f6fcecfbc 158 }
Roietronics 8:494f6fcecfbc 159 else {
Roietronics 8:494f6fcecfbc 160 //Copy the message to the requesters buffer
Roietronics 8:494f6fcecfbc 161 inPointer = &dataBuffer[1];
Roietronics 8:494f6fcecfbc 162 outPointer = buffer;
Roietronics 8:494f6fcecfbc 163 for(int i = 0; i < count; i++) {
Roietronics 8:494f6fcecfbc 164 *outPointer++ = *inPointer++;
Roietronics 8:494f6fcecfbc 165 }
Roietronics 8:494f6fcecfbc 166 }
Roietronics 8:494f6fcecfbc 167 MSG_TYPE temp = msgType;
Roietronics 8:494f6fcecfbc 168 //Start Search for the next message
Roietronics 8:494f6fcecfbc 169 msgType = UNKNOWN;
Roietronics 8:494f6fcecfbc 170 return temp;
Roietronics 0:8326629a1b97 171 }
Roietronics 0:8326629a1b97 172
Roietronics 8:494f6fcecfbc 173
Roietronics 0:8326629a1b97 174 void writeBuffer(const uint8_t* buffer, uint16_t count)
Roietronics 0:8326629a1b97 175 {
Roietronics 11:00cb0217ce8a 176 logInfo( "Sending Command to sensor\n");
Roietronics 0:8326629a1b97 177 uint8_t* pointer = (uint8_t*)buffer;
Roietronics 0:8326629a1b97 178 uint16_t counter = count;
Roietronics 0:8326629a1b97 179 while(1)
Roietronics 0:8326629a1b97 180 {
Roietronics 0:8326629a1b97 181 if(sensor.writeable())
Roietronics 0:8326629a1b97 182 {
Roietronics 3:1ba96949e2fd 183 logTrace(*pointer);
Roietronics 0:8326629a1b97 184 sensor.putc(*pointer++);
Roietronics 0:8326629a1b97 185 counter--;
Roietronics 0:8326629a1b97 186 }
Roietronics 4:12dfd9a8ee76 187 if(counter == 0) {
Roietronics 0:8326629a1b97 188 return;
Roietronics 0:8326629a1b97 189 }
Roietronics 0:8326629a1b97 190 }
Roietronics 0:8326629a1b97 191 }
Roietronics 0:8326629a1b97 192
Roietronics 4:12dfd9a8ee76 193 //Validate the received mesurements checksum
Roietronics 0:8326629a1b97 194
Roietronics 0:8326629a1b97 195 bool checkValue(uint8_t *thebuf, uint8_t leng)
Roietronics 0:8326629a1b97 196 {
Roietronics 0:8326629a1b97 197 bool receiveflag = false;
Roietronics 7:5f612ed18852 198 uint16_t receiveSum = 0;
Roietronics 0:8326629a1b97 199
Roietronics 6:6aa9d16e27bc 200 //Don't include the checksum bytes in the sum
Roietronics 6:6aa9d16e27bc 201 for(int i=0; i<(leng-3); i++){
Roietronics 0:8326629a1b97 202 receiveSum=receiveSum+thebuf[i];
Roietronics 0:8326629a1b97 203 }
Roietronics 0:8326629a1b97 204 receiveSum=receiveSum + 0x42;
Roietronics 0:8326629a1b97 205
Roietronics 0:8326629a1b97 206 if(receiveSum == ((thebuf[leng-2]<<8)+thebuf[leng-1])) //check the debug data
Roietronics 0:8326629a1b97 207 {
Roietronics 0:8326629a1b97 208 receiveSum = 0;
Roietronics 0:8326629a1b97 209 receiveflag = true;
Roietronics 0:8326629a1b97 210 }
Roietronics 0:8326629a1b97 211 return receiveflag;
Roietronics 0:8326629a1b97 212 }
Roietronics 0:8326629a1b97 213
Roietronics 0:8326629a1b97 214 //Extract the 1 micron particle count from the messaage
Roietronics 0:8326629a1b97 215 uint16_t transmitPM01(uint8_t *thebuf)
Roietronics 0:8326629a1b97 216 {
Roietronics 0:8326629a1b97 217 uint16_t PM01Val;
Roietronics 0:8326629a1b97 218 PM01Val=((thebuf[3]<<8) + thebuf[4]); //count PM1.0 value of the air detector module
Roietronics 0:8326629a1b97 219 return PM01Val;
Roietronics 0:8326629a1b97 220 }
Roietronics 0:8326629a1b97 221
Roietronics 0:8326629a1b97 222 //Extract the 2.5 micron particle count from the messaage
Roietronics 0:8326629a1b97 223 uint16_t transmitPM2_5(uint8_t *thebuf)
Roietronics 0:8326629a1b97 224 {
Roietronics 0:8326629a1b97 225 uint16_t PM2_5Val;
Roietronics 0:8326629a1b97 226 PM2_5Val=((thebuf[5]<<8) + thebuf[6]);//count PM2.5 value of the air detector module
Roietronics 0:8326629a1b97 227 return PM2_5Val;
Roietronics 0:8326629a1b97 228 }
Roietronics 0:8326629a1b97 229
Roietronics 0:8326629a1b97 230 //Extract the 10 micron particle count from the messaage
Roietronics 0:8326629a1b97 231 uint16_t transmitPM10(uint8_t *thebuf)
Roietronics 0:8326629a1b97 232 {
Roietronics 0:8326629a1b97 233 uint16_t PM10Val;
Roietronics 0:8326629a1b97 234 PM10Val=((thebuf[7]<<8) + thebuf[8]); //count PM10 value of the air detector module
Roietronics 0:8326629a1b97 235 return PM10Val;
Roietronics 0:8326629a1b97 236 }
Roietronics 0:8326629a1b97 237
Roietronics 0:8326629a1b97 238 int main()
Roietronics 0:8326629a1b97 239 {
Roietronics 5:7cabc36d4352 240 uint8_t dataBuffer[MESSAGE_LEN];
Roietronics 8:494f6fcecfbc 241 MSG_TYPE mType;
Roietronics 0:8326629a1b97 242 uint16_t PM01Value=0; //define PM1.0 value of the air detector module
Roietronics 0:8326629a1b97 243 uint16_t PM2_5Value=0; //define PM2.5 value of the air detector module
Roietronics 0:8326629a1b97 244 uint16_t PM10Value=0; //define PM10 value of the air detector module
Roietronics 4:12dfd9a8ee76 245
Roietronics 7:5f612ed18852 246 pc.printf("Starting Honeywell Dust Sesor App version %\n", VERSION);
Roietronics 8:494f6fcecfbc 247 //Attach a receive interrupt handler
Roietronics 8:494f6fcecfbc 248 sensor.attach(receiveInterrupt, Serial::RxIrq);
Roietronics 8:494f6fcecfbc 249 msgType = UNKNOWN;
Roietronics 0:8326629a1b97 250 //Send start command to the sensor
Roietronics 0:8326629a1b97 251 writeBuffer(measureCommand, 4);
Roietronics 5:7cabc36d4352 252 /*
Roietronics 5:7cabc36d4352 253 Not geting response from sensor - first characters received are measurement data
Roietronics 0:8326629a1b97 254 //Wait for sensors response
Roietronics 0:8326629a1b97 255 //while(!sensor.readable());
Roietronics 0:8326629a1b97 256 readBuffer(dataBuffer, 2);
Roietronics 0:8326629a1b97 257 response = dataBuffer[0] << 8 || dataBuffer[1];
Roietronics 0:8326629a1b97 258
Roietronics 0:8326629a1b97 259 switch(response) {
Roietronics 0:8326629a1b97 260 case OK:
Roietronics 0:8326629a1b97 261 logInfo("Sensor Auto Measurement Started");
Roietronics 0:8326629a1b97 262 break;
Roietronics 0:8326629a1b97 263 case BAD:
Roietronics 0:8326629a1b97 264 logInfo("Sensor rejected Start Measurement Commmand");
Roietronics 0:8326629a1b97 265 return -1;
Roietronics 0:8326629a1b97 266 default:
Roietronics 0:8326629a1b97 267 logInfo("Communication Error: Invalid Sensor Response");
Roietronics 0:8326629a1b97 268 return -2;
Roietronics 0:8326629a1b97 269 }
Roietronics 5:7cabc36d4352 270 */
Roietronics 4:12dfd9a8ee76 271
Roietronics 0:8326629a1b97 272 //Start continous loop
Roietronics 8:494f6fcecfbc 273 while(1) {
Roietronics 8:494f6fcecfbc 274 if((mType = readBuffer(dataBuffer,MESSAGE_LEN -1)) == AUTO_MSG) {
Roietronics 0:8326629a1b97 275 if(dataBuffer[0] == 0x4d){
Roietronics 6:6aa9d16e27bc 276 if(checkValue(dataBuffer, MESSAGE_LEN-1)){
Roietronics 7:5f612ed18852 277 PM01Value = transmitPM01(dataBuffer); //count PM1.0 value of the air detector module
Roietronics 7:5f612ed18852 278 PM2_5Value = transmitPM2_5(dataBuffer);//count PM2.5 value of the air detector module
Roietronics 7:5f612ed18852 279 PM10Value = transmitPM10(dataBuffer); //count PM10 value of the air detector module
Roietronics 8:494f6fcecfbc 280 }
Roietronics 6:6aa9d16e27bc 281 else {
Roietronics 8:494f6fcecfbc 282 pc.puts("Message checksum error\n");
Roietronics 8:494f6fcecfbc 283 }
Roietronics 6:6aa9d16e27bc 284 }
Roietronics 7:5f612ed18852 285 else {
Roietronics 7:5f612ed18852 286 pc.printf("Second Character was %x\n", dataBuffer[0]);
Roietronics 7:5f612ed18852 287 }
Roietronics 7:5f612ed18852 288 //Check for exit request
Roietronics 7:5f612ed18852 289 if(pc.readable()) {
Roietronics 7:5f612ed18852 290 char input = pc.getc();
Roietronics 7:5f612ed18852 291 if(input == 'Q' || input == 'q')
Roietronics 7:5f612ed18852 292 {
Roietronics 8:494f6fcecfbc 293 //Shutdown the sensor
Roietronics 7:5f612ed18852 294 writeBuffer(stopCommand, 4);
Roietronics 8:494f6fcecfbc 295 //Unlink the receive interrupt handler
Roietronics 8:494f6fcecfbc 296 sensor.attach(0, Serial::RxIrq);
Roietronics 8:494f6fcecfbc 297 pc.puts("Exit request received\n");
Roietronics 7:5f612ed18852 298 return 0;
Roietronics 8:494f6fcecfbc 299 }
Roietronics 7:5f612ed18852 300 }
Roietronics 8:494f6fcecfbc 301 // Use MBed wait function instead of Arduino delay loop
Roietronics 8:494f6fcecfbc 302 wait_ms(1000);
Roietronics 8:494f6fcecfbc 303
Roietronics 8:494f6fcecfbc 304 pc.printf("PM1.0: %d ug/m3\n", PM01Value);
Roietronics 8:494f6fcecfbc 305
Roietronics 8:494f6fcecfbc 306 pc.printf("PM2.5: %d ug/m3\n", PM2_5Value);
Roietronics 8:494f6fcecfbc 307
Roietronics 8:494f6fcecfbc 308 pc.printf("PM10: %d ug/m3\n", PM10Value);
Roietronics 8:494f6fcecfbc 309
Roietronics 8:494f6fcecfbc 310 pc.printf("\n");
Roietronics 5:7cabc36d4352 311 }
Roietronics 8:494f6fcecfbc 312 else {
Roietronics 8:494f6fcecfbc 313 switch(mType) {
Roietronics 8:494f6fcecfbc 314 case ACK_MSG:
Roietronics 8:494f6fcecfbc 315 if(dataBuffer[0] == 0xA5) {
Roietronics 8:494f6fcecfbc 316 pc.puts("Recived ACK response'\n");
Roietronics 8:494f6fcecfbc 317 }
Roietronics 8:494f6fcecfbc 318 else {
Roietronics 8:494f6fcecfbc 319 pc.puts("Received corrupt ACK Response\n");
Roietronics 8:494f6fcecfbc 320 }
Roietronics 8:494f6fcecfbc 321 break;
Roietronics 8:494f6fcecfbc 322 case NAK_MSG:
Roietronics 8:494f6fcecfbc 323 if(dataBuffer[0] == 0x69) {
Roietronics 8:494f6fcecfbc 324 pc.puts("Recived NAK response'\n");
Roietronics 8:494f6fcecfbc 325 }
Roietronics 8:494f6fcecfbc 326 else {
Roietronics 8:494f6fcecfbc 327 pc.puts("Received corrupt NAK Response\n");
Roietronics 8:494f6fcecfbc 328 }
Roietronics 8:494f6fcecfbc 329 break;
Roietronics 8:494f6fcecfbc 330 case READ_ERROR:
Roietronics 8:494f6fcecfbc 331 puts("Data Reading Error");
Roietronics 8:494f6fcecfbc 332 break;
Roietronics 8:494f6fcecfbc 333 }
Roietronics 8:494f6fcecfbc 334 }
Roietronics 8:494f6fcecfbc 335 }
Roietronics 8:494f6fcecfbc 336 }