suparit tunkham / Mbed 2 deprecated SCH_DIOSerial_VISON

test

Dependencies:   MINI8I8O5A000 mbed EEPROM_P4 IICLCD_LOWCOST

main.cpp@5:a693866be4b3, 2015-11-10 (annotated)

Committer:
tsuparit
Date:
Tue Nov 10 07:15:01 2015 +0000
Revision:
5:a693866be4b3
Parent:
4:c08d713f8cfc
Child:
6:96d89c2f4bf9
Release LABEL for Blackbox Test

Who changed what in which revision?

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