suparit tunkham / Mbed 2 deprecated SCH_DIOSerial_VISON

test

Dependencies:   MINI8I8O5A000 mbed EEPROM_P4 IICLCD_LOWCOST

main.cpp@6:96d89c2f4bf9, 2016-02-04 (annotated)

Committer:
tsuparit
Date:
Thu Feb 04 09:14:48 2016 +0000
Revision:
6:96d89c2f4bf9
Parent:
5:a693866be4b3
Child:
7:3cb877cb7393
Add P7 with Buzzer Option.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
tsuparit 6:96d89c2f4bf9 1 float firmware_version = 1.20;
tsuparit 0:5e60f85d6c26 2
tsuparit 0:5e60f85d6c26 3 #include "mbed.h"
tsuparit 2:82dbbbff7518 4
tsuparit 6:96d89c2f4bf9 5 #define BUZZVSP7 // Enable P7 for Buzzer..
tsuparit 2:82dbbbff7518 6 //#include "USBSerial.h"
tsuparit 2:82dbbbff7518 7 //SBSerial pc;
tsuparit 2:82dbbbff7518 8
tsuparit 2:82dbbbff7518 9
tsuparit 2:82dbbbff7518 10
tsuparit 2:82dbbbff7518 11 //#define USBSerialOption
tsuparit 2:82dbbbff7518 12
tsuparit 2:82dbbbff7518 13 #ifdef USBSerialOption
tsuparit 2:82dbbbff7518 14 #include "USBSerial.h"
tsuparit 2:82dbbbff7518 15 USBSerial pc;
tsuparit 2:82dbbbff7518 16 not work??
tsuparit 2:82dbbbff7518 17 #else
tsuparit 2:82dbbbff7518 18
tsuparit 4:c08d713f8cfc 19 //Serial pc(USBTX, USBRX); // SDA serail port
tsuparit 4:c08d713f8cfc 20 Serial pc(PTE0, PTE1); // tx, rx
tsuparit 2:82dbbbff7518 21 #endif
tsuparit 2:82dbbbff7518 22
tsuparit 2:82dbbbff7518 23
tsuparit 2:82dbbbff7518 24
tsuparit 0:5e60f85d6c26 25 #include "LiquidCrystal_I2C.h"
tsuparit 0:5e60f85d6c26 26 #include "mini8i8o5a.h"
tsuparit 0:5e60f85d6c26 27 #define EEPROMBUFFERSIZE 16
tsuparit 0:5e60f85d6c26 28 #include "eepromlib.h"
tsuparit 0:5e60f85d6c26 29
tsuparit 0:5e60f85d6c26 30
tsuparit 0:5e60f85d6c26 31 DigitalOut myled(LED1);
tsuparit 0:5e60f85d6c26 32
tsuparit 5:a693866be4b3 33 int loopinilcd=0;
tsuparit 0:5e60f85d6c26 34
tsuparit 0:5e60f85d6c26 35 char str[50];
tsuparit 0:5e60f85d6c26 36 char strbuf[50];
tsuparit 0:5e60f85d6c26 37
tsuparit 0:5e60f85d6c26 38
tsuparit 0:5e60f85d6c26 39 int rxchar_count=0;
tsuparit 0:5e60f85d6c26 40 #define RXBUFFERSIZE 100
tsuparit 0:5e60f85d6c26 41 char rx_buffer[RXBUFFERSIZE];
tsuparit 0:5e60f85d6c26 42 char rx_buffer_CMD[RXBUFFERSIZE];
tsuparit 0:5e60f85d6c26 43 char rx_buffer_ARG[RXBUFFERSIZE];
tsuparit 0:5e60f85d6c26 44 char rx_pointer=0;
tsuparit 0:5e60f85d6c26 45 char inchar=0;
tsuparit 0:5e60f85d6c26 46
tsuparit 0:5e60f85d6c26 47 char remote_control=0;
tsuparit 0:5e60f85d6c26 48
tsuparit 0:5e60f85d6c26 49 float ser_para_reset=0;
tsuparit 0:5e60f85d6c26 50 //float ser_para_stab=3.25;
tsuparit 0:5e60f85d6c26 51 float ser_para_time=1.19;
tsuparit 0:5e60f85d6c26 52 float ser_para_result=0.0;
tsuparit 0:5e60f85d6c26 53
tsuparit 0:5e60f85d6c26 54 char ser_para_state=0;
tsuparit 0:5e60f85d6c26 55 char ser_para_err=0;
tsuparit 0:5e60f85d6c26 56 char ser_para_range=0;
tsuparit 0:5e60f85d6c26 57
tsuparit 0:5e60f85d6c26 58 char ser_trigger=0;
tsuparit 0:5e60f85d6c26 59 char ser_para_cont_mode=1; //serial continue print out
tsuparit 0:5e60f85d6c26 60
tsuparit 0:5e60f85d6c26 61 Timer com_timer;
tsuparit 0:5e60f85d6c26 62
tsuparit 0:5e60f85d6c26 63
tsuparit 0:5e60f85d6c26 64 char boardaddress =1;
tsuparit 0:5e60f85d6c26 65
tsuparit 0:5e60f85d6c26 66 void serial_pc_rx_services()
tsuparit 0:5e60f85d6c26 67 {
tsuparit 0:5e60f85d6c26 68 int i,j;
tsuparit 0:5e60f85d6c26 69
tsuparit 2:82dbbbff7518 70
tsuparit 2:82dbbbff7518 71 #ifdef USBSerialOption
tsuparit 2:82dbbbff7518 72 while (pc.available())
tsuparit 2:82dbbbff7518 73 #else
tsuparit 2:82dbbbff7518 74 while(pc.readable())
tsuparit 2:82dbbbff7518 75 #endif
tsuparit 3:e658376f6e27 76 {
tsuparit 3:e658376f6e27 77 inchar =pc.getc();
tsuparit 2:82dbbbff7518 78 if ( rx_pointer==0) //first incoming character clear old buffer
tsuparit 0:5e60f85d6c26 79 {
tsuparit 0:5e60f85d6c26 80 for (i=0;i<RXBUFFERSIZE;i++) rx_buffer[i]=0; //clear old buffer
tsuparit 3:e658376f6e27 81 com_timer.reset();
tsuparit 3:e658376f6e27 82 com_timer.start();
tsuparit 0:5e60f85d6c26 83 }
tsuparit 0:5e60f85d6c26 84
tsuparit 5:a693866be4b3 85 loopinilcd=0;
tsuparit 2:82dbbbff7518 86
tsuparit 3:e658376f6e27 87 rx_buffer[rx_pointer]=inchar; //keep char in buffer...
tsuparit 0:5e60f85d6c26 88 rx_pointer++;
tsuparit 0:5e60f85d6c26 89
tsuparit 0:5e60f85d6c26 90
tsuparit 0:5e60f85d6c26 91 if (rx_pointer>=(RXBUFFERSIZE-10))
tsuparit 0:5e60f85d6c26 92 {
tsuparit 0:5e60f85d6c26 93 rx_pointer=0;//Error buffer overflow
tsuparit 2:82dbbbff7518 94 pc.printf("ERR:buffer overflow\n");
tsuparit 0:5e60f85d6c26 95 }
tsuparit 0:5e60f85d6c26 96
tsuparit 2:82dbbbff7518 97
tsuparit 2:82dbbbff7518 98
tsuparit 0:5e60f85d6c26 99 if ((inchar=='\r')|(inchar=='\n'))
tsuparit 0:5e60f85d6c26 100 {
tsuparit 2:82dbbbff7518 101
tsuparit 0:5e60f85d6c26 102 rx_buffer[rx_pointer-1]=0;//mark end of string, remove terminate char
tsuparit 0:5e60f85d6c26 103
tsuparit 0:5e60f85d6c26 104 i=0;
tsuparit 0:5e60f85d6c26 105 j=0;
tsuparit 0:5e60f85d6c26 106 char cmd_done=0;
tsuparit 0:5e60f85d6c26 107 while (rx_buffer[i]!=0)
tsuparit 0:5e60f85d6c26 108 {
tsuparit 0:5e60f85d6c26 109 if (cmd_done==0)
tsuparit 0:5e60f85d6c26 110 {
tsuparit 0:5e60f85d6c26 111 rx_buffer_CMD[i]=rx_buffer[i];//copy cmd part
tsuparit 0:5e60f85d6c26 112 if (rx_buffer_CMD[i]==' ')
tsuparit 0:5e60f85d6c26 113 {
tsuparit 0:5e60f85d6c26 114 cmd_done=1;
tsuparit 0:5e60f85d6c26 115 rx_buffer_CMD[i+1]=0;
tsuparit 0:5e60f85d6c26 116 }
tsuparit 0:5e60f85d6c26 117 }
tsuparit 0:5e60f85d6c26 118 else
tsuparit 0:5e60f85d6c26 119 {
tsuparit 0:5e60f85d6c26 120 rx_buffer_ARG[j]=rx_buffer[i];//copy cmd part
tsuparit 0:5e60f85d6c26 121 j++;
tsuparit 0:5e60f85d6c26 122 }
tsuparit 0:5e60f85d6c26 123 i++;
tsuparit 0:5e60f85d6c26 124
tsuparit 0:5e60f85d6c26 125 }
tsuparit 1:d9ab13cdf377 126 rx_buffer_ARG[j]=0; //end of string ++++
tsuparit 0:5e60f85d6c26 127
tsuparit 2:82dbbbff7518 128 //pc.printf("rxbuffer: %s",rx_buffer); //test direct echo
tsuparit 0:5e60f85d6c26 129
tsuparit 0:5e60f85d6c26 130 if (strcmp(rx_buffer,"*IDN?")==0)
tsuparit 0:5e60f85d6c26 131 {
tsuparit 0:5e60f85d6c26 132 pc.printf("Schaffner SerIO, ver %.1f\n",firmware_version);
tsuparit 0:5e60f85d6c26 133 }
tsuparit 0:5e60f85d6c26 134 else if (strcmp(rx_buffer,"*RST")==0)
tsuparit 0:5e60f85d6c26 135 {
tsuparit 0:5e60f85d6c26 136 pc.printf("Instrumnet Reset\n");
tsuparit 0:5e60f85d6c26 137 ser_para_reset=1; //pass flag stop all operation
tsuparit 0:5e60f85d6c26 138 //LCDI2C4Bit_init();
tsuparit 0:5e60f85d6c26 139 LiquidCrystal_I2Cinit();
tsuparit 0:5e60f85d6c26 140 LCDI2C4Bit_clear();
tsuparit 0:5e60f85d6c26 141 //LCDI2C4Bit_backLight(true);
tsuparit 0:5e60f85d6c26 142 LiquidCrystal_I2Cbacklight();
tsuparit 0:5e60f85d6c26 143
tsuparit 0:5e60f85d6c26 144 LCDI2C4Bit_cursorTo(0,0);
tsuparit 0:5e60f85d6c26 145 sprintf (str," --- RESET ----");
tsuparit 0:5e60f85d6c26 146 LCDI2C4Bit_printIn(str);
tsuparit 0:5e60f85d6c26 147 wait(0.25);
tsuparit 3:e658376f6e27 148 NVIC_SystemReset();//softreser
tsuparit 0:5e60f85d6c26 149 }
tsuparit 0:5e60f85d6c26 150 else if (strcmp(rx_buffer,":SYS:VER")==0)
tsuparit 0:5e60f85d6c26 151 {
tsuparit 0:5e60f85d6c26 152 pc.printf("%.1f\n",firmware_version);
tsuparit 0:5e60f85d6c26 153 }
tsuparit 0:5e60f85d6c26 154 else if (strcmp(rx_buffer,":SYST:ERR")==0)
tsuparit 0:5e60f85d6c26 155 {
tsuparit 0:5e60f85d6c26 156 pc.printf("0\n");
tsuparit 0:5e60f85d6c26 157 }
tsuparit 0:5e60f85d6c26 158 //else if (strcmp(rx_buffer,"a11000")==0) //Read Input "aX1"
tsuparit 0:5e60f85d6c26 159 else if ( (rx_buffer[0]=='a') & (rx_buffer[1]==('0'+boardaddress)) & (rx_buffer[2]=='1')) // Write Output "aX1"
tsuparit 0:5e60f85d6c26 160 {
tsuparit 3:e658376f6e27 161 pc.printf("%dOK\n",INPUT);
tsuparit 0:5e60f85d6c26 162 }
tsuparit 0:5e60f85d6c26 163 else if ( (rx_buffer[0]=='a') & (rx_buffer[1]==('0'+boardaddress)) & (rx_buffer[2]=='2')) // Write Output "aX2"
tsuparit 0:5e60f85d6c26 164 {
tsuparit 2:82dbbbff7518 165 //writer
tsuparit 2:82dbbbff7518 166 unsigned char b3,b2,b1;
tsuparit 2:82dbbbff7518 167 unsigned int outdata=0;
tsuparit 2:82dbbbff7518 168
tsuparit 2:82dbbbff7518 169 if (rx_buffer[3]!=0)
tsuparit 2:82dbbbff7518 170 {
tsuparit 2:82dbbbff7518 171 outdata=rx_buffer[3]-'0';
tsuparit 2:82dbbbff7518 172 }
tsuparit 2:82dbbbff7518 173 if (rx_buffer[4]!=0)
tsuparit 2:82dbbbff7518 174 {
tsuparit 2:82dbbbff7518 175 outdata=outdata*10+rx_buffer[4]-'0';
tsuparit 2:82dbbbff7518 176 }
tsuparit 2:82dbbbff7518 177 if (rx_buffer[5]!=0)
tsuparit 2:82dbbbff7518 178 {
tsuparit 2:82dbbbff7518 179 outdata=outdata*10+rx_buffer[5]-'0';
tsuparit 2:82dbbbff7518 180 }
tsuparit 3:e658376f6e27 181 int OUTBUF=0;
tsuparit 3:e658376f6e27 182 if bitchk(outdata,0) {OUT0=ON;OUTBUF=OUTBUF+1;} else OUT0=OFF;
tsuparit 3:e658376f6e27 183 if bitchk(outdata,1) {OUT1=ON;OUTBUF=OUTBUF+2;} else OUT1=OFF;
tsuparit 3:e658376f6e27 184 if bitchk(outdata,2) {OUT2=ON;OUTBUF=OUTBUF+4;} else OUT2=OFF;
tsuparit 3:e658376f6e27 185 if bitchk(outdata,3) {OUT3=ON;OUTBUF=OUTBUF+8;} else OUT3=OFF;
tsuparit 2:82dbbbff7518 186
tsuparit 3:e658376f6e27 187 if bitchk(outdata,4) {OUT4=ON;OUTBUF=OUTBUF+16;} else OUT4=OFF;
tsuparit 3:e658376f6e27 188 if bitchk(outdata,5) {OUT5=ON;OUTBUF=OUTBUF+32;} else OUT5=OFF;
tsuparit 3:e658376f6e27 189 if bitchk(outdata,6) {OUT6=ON;OUTBUF=OUTBUF+64;} else OUT6=OFF;
tsuparit 6:96d89c2f4bf9 190 if bitchk(outdata,7)
tsuparit 6:96d89c2f4bf9 191 {OUT7=ON;OUTBUF=OUTBUF+128;
tsuparit 6:96d89c2f4bf9 192 #ifdef BUZZVSP7
tsuparit 6:96d89c2f4bf9 193 BUZZER=1;
tsuparit 6:96d89c2f4bf9 194 #endif
tsuparit 6:96d89c2f4bf9 195
tsuparit 6:96d89c2f4bf9 196 }
tsuparit 6:96d89c2f4bf9 197 else
tsuparit 6:96d89c2f4bf9 198 {
tsuparit 6:96d89c2f4bf9 199 #ifdef BUZZVSP7
tsuparit 6:96d89c2f4bf9 200 BUZZER=1;
tsuparit 6:96d89c2f4bf9 201 #endif
tsuparit 6:96d89c2f4bf9 202
tsuparit 6:96d89c2f4bf9 203
tsuparit 6:96d89c2f4bf9 204 OUT7=OFF;
tsuparit 6:96d89c2f4bf9 205 }
tsuparit 3:e658376f6e27 206 OUTPUT=OUTBUF;
tsuparit 3:e658376f6e27 207 pc.printf("%dOK\n",outdata);
tsuparit 0:5e60f85d6c26 208 }
tsuparit 0:5e60f85d6c26 209 else if ( (rx_buffer[0]=='a') & (rx_buffer[1]==('0'+boardaddress)) & (rx_buffer[2]=='3')) // Write Output "aX2"
tsuparit 0:5e60f85d6c26 210 {
tsuparit 3:e658376f6e27 211 pc.printf("%dOK\n",OUTPUT);
tsuparit 0:5e60f85d6c26 212 }
tsuparit 0:5e60f85d6c26 213 else
tsuparit 0:5e60f85d6c26 214 {//unknow / handle comand
tsuparit 2:82dbbbff7518 215 //pc.printf( "UNKNOWN %s=>%s,%s\n",rx_buffer,rx_buffer_CMD,rx_buffer_ARG);
tsuparit 2:82dbbbff7518 216 pc.printf( "UNKNOWN %s=>%s,%s\n",rx_buffer);
tsuparit 2:82dbbbff7518 217 }
tsuparit 0:5e60f85d6c26 218 rx_pointer=0;//Reset at the end
tsuparit 0:5e60f85d6c26 219 com_timer.stop();
tsuparit 2:82dbbbff7518 220 break;//exit while
tsuparit 2:82dbbbff7518 221 } //end foud "terminal of command//
tsuparit 2:82dbbbff7518 222
tsuparit 0:5e60f85d6c26 223
tsuparit 2:82dbbbff7518 224
tsuparit 2:82dbbbff7518 225 } //end while data read aviable
tsuparit 3:e658376f6e27 226
tsuparit 2:82dbbbff7518 227
tsuparit 0:5e60f85d6c26 228
tsuparit 0:5e60f85d6c26 229 }
tsuparit 0:5e60f85d6c26 230
tsuparit 0:5e60f85d6c26 231
tsuparit 0:5e60f85d6c26 232 int main()
tsuparit 0:5e60f85d6c26 233 {
tsuparit 0:5e60f85d6c26 234
tsuparit 0:5e60f85d6c26 235
tsuparit 0:5e60f85d6c26 236
tsuparit 0:5e60f85d6c26 237
tsuparit 5:a693866be4b3 238 LiquidCrystal_I2C_SETUP(0x27,20,4);
tsuparit 0:5e60f85d6c26 239 LiquidCrystal_I2Cinit();
tsuparit 0:5e60f85d6c26 240 LiquidCrystal_I2Cbacklight();
tsuparit 0:5e60f85d6c26 241
tsuparit 0:5e60f85d6c26 242 LiquidCrystal_I2CsetCursor(0,1);
tsuparit 0:5e60f85d6c26 243 sprintf (str, " SCHAFFNER ");
tsuparit 0:5e60f85d6c26 244 LCDI2C4Bit_printIn(str);
tsuparit 0:5e60f85d6c26 245 LiquidCrystal_I2CsetCursor(0,0);
tsuparit 0:5e60f85d6c26 246 sprintf (str, "SerailDIO v:%.2f ",1.00) ;
tsuparit 0:5e60f85d6c26 247 LCDI2C4Bit_printIn(str);
tsuparit 0:5e60f85d6c26 248
tsuparit 2:82dbbbff7518 249 #ifdef USBSerialOption
tsuparit 2:82dbbbff7518 250
tsuparit 2:82dbbbff7518 251 #else
tsuparit 2:82dbbbff7518 252 pc.baud(9600); // set what you want here depending on your terminal program speed
tsuparit 2:82dbbbff7518 253 #endif
tsuparit 2:82dbbbff7518 254
tsuparit 0:5e60f85d6c26 255
tsuparit 0:5e60f85d6c26 256 com_timer.start();
tsuparit 0:5e60f85d6c26 257 com_timer.stop();
tsuparit 0:5e60f85d6c26 258 com_timer.reset();
tsuparit 0:5e60f85d6c26 259
tsuparit 3:e658376f6e27 260 wait(0.1);
tsuparit 3:e658376f6e27 261
tsuparit 3:e658376f6e27 262 pc.attach(&serial_pc_rx_services); // Use interrupt services !!
tsuparit 5:a693866be4b3 263
tsuparit 0:5e60f85d6c26 264 while(1)
tsuparit 0:5e60f85d6c26 265 {
tsuparit 5:a693866be4b3 266
tsuparit 5:a693866be4b3 267 if (loopinilcd++>100)
tsuparit 5:a693866be4b3 268 {
tsuparit 5:a693866be4b3 269 loopinilcd=0;
tsuparit 5:a693866be4b3 270 LiquidCrystal_I2Cinit();
tsuparit 5:a693866be4b3 271 LiquidCrystal_I2Cbacklight();
tsuparit 5:a693866be4b3 272 }
tsuparit 5:a693866be4b3 273
tsuparit 3:e658376f6e27 274 Input_sampling(512);
tsuparit 0:5e60f85d6c26 275 LiquidCrystal_I2CsetCursor(0,0);
tsuparit 5:a693866be4b3 276 sprintf (str, "IN:%d OUT:%d ",INPUT,OUTPUT);
tsuparit 3:e658376f6e27 277 LCDI2C4Bit_printIn(str);
tsuparit 0:5e60f85d6c26 278 LiquidCrystal_I2CsetCursor(0,1);
tsuparit 5:a693866be4b3 279
tsuparit 5:a693866be4b3 280
tsuparit 3:e658376f6e27 281 float processtime=1000.0*com_timer.read();
tsuparit 3:e658376f6e27 282 if (processtime<10.0)
tsuparit 3:e658376f6e27 283 {
tsuparit 3:e658376f6e27 284 sprintf (str, "%.1f ms:%s ",processtime,rx_buffer);
tsuparit 3:e658376f6e27 285 }
tsuparit 3:e658376f6e27 286 else
tsuparit 3:e658376f6e27 287 {
tsuparit 3:e658376f6e27 288 sprintf (str, " %.1f ms:%s ",processtime,rx_buffer);
tsuparit 5:a693866be4b3 289 }
tsuparit 5:a693866be4b3 290
tsuparit 0:5e60f85d6c26 291 LCDI2C4Bit_printIn(str);
tsuparit 5:a693866be4b3 292
tsuparit 5:a693866be4b3 293
tsuparit 5:a693866be4b3 294
tsuparit 5:a693866be4b3 295 char strbuf[50];
tsuparit 5:a693866be4b3 296
tsuparit 5:a693866be4b3 297
tsuparit 5:a693866be4b3 298 LiquidCrystal_I2CsetCursor(0,3);
tsuparit 5:a693866be4b3 299 sprintf (str, "#");
tsuparit 5:a693866be4b3 300 sprintf (strbuf, " ");
tsuparit 5:a693866be4b3 301
tsuparit 5:a693866be4b3 302 if (OUT0)
tsuparit 5:a693866be4b3 303 {
tsuparit 5:a693866be4b3 304 sprintf (strbuf, "K1 ");
tsuparit 5:a693866be4b3 305 strcat(str,strbuf);
tsuparit 5:a693866be4b3 306 }
tsuparit 5:a693866be4b3 307
tsuparit 5:a693866be4b3 308 if (OUT1)
tsuparit 5:a693866be4b3 309 {
tsuparit 5:a693866be4b3 310 sprintf (strbuf, "K2 ");
tsuparit 5:a693866be4b3 311 strcat(str,strbuf);
tsuparit 5:a693866be4b3 312 }
tsuparit 5:a693866be4b3 313
tsuparit 5:a693866be4b3 314 if (OUT2)
tsuparit 5:a693866be4b3 315 {
tsuparit 5:a693866be4b3 316 sprintf (strbuf, "K3 ");
tsuparit 5:a693866be4b3 317 strcat(str,strbuf);
tsuparit 5:a693866be4b3 318 }
tsuparit 5:a693866be4b3 319
tsuparit 5:a693866be4b3 320 if (OUT3)
tsuparit 5:a693866be4b3 321 {
tsuparit 5:a693866be4b3 322 sprintf (strbuf, "K4 ");
tsuparit 5:a693866be4b3 323 strcat(str,strbuf);
tsuparit 5:a693866be4b3 324 }
tsuparit 5:a693866be4b3 325
tsuparit 5:a693866be4b3 326
tsuparit 5:a693866be4b3 327
tsuparit 5:a693866be4b3 328
tsuparit 5:a693866be4b3 329
tsuparit 5:a693866be4b3 330 if (OUT4)
tsuparit 5:a693866be4b3 331 {
tsuparit 5:a693866be4b3 332 sprintf (strbuf, "RE ");
tsuparit 5:a693866be4b3 333 }
tsuparit 5:a693866be4b3 334 else
tsuparit 5:a693866be4b3 335 {
tsuparit 5:a693866be4b3 336 sprintf (strbuf, "V.");
tsuparit 5:a693866be4b3 337 }
tsuparit 5:a693866be4b3 338 strcat(str,strbuf);
tsuparit 5:a693866be4b3 339
tsuparit 5:a693866be4b3 340 if (OUT5)
tsuparit 5:a693866be4b3 341 {
tsuparit 5:a693866be4b3 342 sprintf (strbuf, "AC ");
tsuparit 5:a693866be4b3 343 }
tsuparit 5:a693866be4b3 344 else
tsuparit 5:a693866be4b3 345 {
tsuparit 5:a693866be4b3 346 sprintf (strbuf, "DC ");
tsuparit 5:a693866be4b3 347 }
tsuparit 5:a693866be4b3 348 strcat(str,strbuf);
tsuparit 5:a693866be4b3 349
tsuparit 5:a693866be4b3 350 if (OUT6)
tsuparit 5:a693866be4b3 351 {
tsuparit 5:a693866be4b3 352 sprintf (strbuf, "Di ");
tsuparit 5:a693866be4b3 353 strcat(str,strbuf);
tsuparit 5:a693866be4b3 354 }
tsuparit 5:a693866be4b3 355
tsuparit 5:a693866be4b3 356 if (OUT7)
tsuparit 5:a693866be4b3 357 {
tsuparit 5:a693866be4b3 358 sprintf (strbuf, "POW ");
tsuparit 5:a693866be4b3 359 strcat(str,strbuf);
tsuparit 5:a693866be4b3 360 }
tsuparit 5:a693866be4b3 361 sprintf (strbuf, " ");
tsuparit 5:a693866be4b3 362 strcat(str,strbuf);
tsuparit 5:a693866be4b3 363
tsuparit 5:a693866be4b3 364
tsuparit 5:a693866be4b3 365 LCDI2C4Bit_printIn(str);
tsuparit 5:a693866be4b3 366
tsuparit 5:a693866be4b3 367
tsuparit 5:a693866be4b3 368
tsuparit 5:a693866be4b3 369
tsuparit 0:5e60f85d6c26 370 if (com_timer.read()>5.0)
tsuparit 0:5e60f85d6c26 371 {
tsuparit 5:a693866be4b3 372 rx_pointer=0;//Reset at the end
tsuparit 5:a693866be4b3 373 com_timer.stop();
tsuparit 0:5e60f85d6c26 374 }
tsuparit 0:5e60f85d6c26 375
tsuparit 0:5e60f85d6c26 376 }
tsuparit 0:5e60f85d6c26 377
tsuparit 0:5e60f85d6c26 378
tsuparit 0:5e60f85d6c26 379 }