Eric Monjalon / X2D

X2D.cpp@6:e373216c80bf, 2019-11-10 (annotated)

Committer:
sev2000
Date:
Sun Nov 10 18:11:53 2019 +0000
Revision:
6:e373216c80bf
Parent:
5:dcbebd42186a
Child:
7:eaa973daaf58
fix write_crtl_reg

Who changed what in which revision?

UserRevisionLine numberNew contents of line
sev2000 0:9ef8edfe21bc 1 #include "mbed.h"
sev2000 0:9ef8edfe21bc 2 #include "X2D.h"
sev2000 0:9ef8edfe21bc 3
sev2000 0:9ef8edfe21bc 4 #define BUF_SIZE 1000
sev2000 0:9ef8edfe21bc 5 #define BIT_SIZE 145
sev2000 0:9ef8edfe21bc 6
sev2000 0:9ef8edfe21bc 7 int processData(void);
sev2000 0:9ef8edfe21bc 8
sev2000 0:9ef8edfe21bc 9 DigitalOut Reg_Data(PC_1);
sev2000 0:9ef8edfe21bc 10 DigitalOut RxTx(PB_0);
sev2000 0:9ef8edfe21bc 11 DigitalOut Tx(PA_9);
sev2000 0:9ef8edfe21bc 12 DigitalOut UART(PA_0, 1);
sev2000 0:9ef8edfe21bc 13
sev2000 0:9ef8edfe21bc 14 DigitalIn CD(PC_0);
sev2000 0:9ef8edfe21bc 15 //DigitalIn Rx(PB_7);
sev2000 0:9ef8edfe21bc 16 DigitalIn BU(PA_4);
sev2000 0:9ef8edfe21bc 17 DigitalIn CLR(PA_1);
sev2000 0:9ef8edfe21bc 18 DigitalIn RSTO(PC_2);
sev2000 0:9ef8edfe21bc 19
sev2000 4:844c00dd0366 20 InterruptIn Rx(PB_7, PullUp);
sev2000 0:9ef8edfe21bc 21
sev2000 0:9ef8edfe21bc 22 pulse_t timeDiff;
sev2000 0:9ef8edfe21bc 23 CircularBuffer<pulse_t, BUF_SIZE> PulseWidth;
sev2000 0:9ef8edfe21bc 24 bool dataBits[BIT_SIZE]={0}; // 18 Nibbles +1
sev2000 0:9ef8edfe21bc 25
sev2000 0:9ef8edfe21bc 26
sev2000 0:9ef8edfe21bc 27 long startedAt=0;
sev2000 0:9ef8edfe21bc 28 long endedAt=0;
sev2000 0:9ef8edfe21bc 29
sev2000 0:9ef8edfe21bc 30 Timer xTime;
sev2000 0:9ef8edfe21bc 31
sev2000 0:9ef8edfe21bc 32 void getPulseF(void)
sev2000 0:9ef8edfe21bc 33 {
sev2000 0:9ef8edfe21bc 34 endedAt = xTime.read_us(); // set timer end for last pin
sev2000 0:9ef8edfe21bc 35 timeDiff.v = endedAt - startedAt;
sev2000 0:9ef8edfe21bc 36 timeDiff.pin = 1;
sev2000 0:9ef8edfe21bc 37 PulseWidth.push(timeDiff);
sev2000 0:9ef8edfe21bc 38 startedAt= endedAt; // set timer start for this pin
sev2000 0:9ef8edfe21bc 39 }
sev2000 0:9ef8edfe21bc 40
sev2000 0:9ef8edfe21bc 41 void getPulseR(void)
sev2000 0:9ef8edfe21bc 42 {
sev2000 0:9ef8edfe21bc 43 endedAt = xTime.read_us(); // set timer end for last pin
sev2000 0:9ef8edfe21bc 44 timeDiff.v = endedAt - startedAt;
sev2000 0:9ef8edfe21bc 45 timeDiff.pin = 0;
sev2000 0:9ef8edfe21bc 46 PulseWidth.push(timeDiff);
sev2000 0:9ef8edfe21bc 47 startedAt= endedAt; // set timer start for this pin
sev2000 0:9ef8edfe21bc 48 }
sev2000 0:9ef8edfe21bc 49
sev2000 4:844c00dd0366 50 void wait_posedge(void)
sev2000 4:844c00dd0366 51 {
sev2000 4:844c00dd0366 52 if(CLR != 0)
sev2000 4:844c00dd0366 53 {
sev2000 4:844c00dd0366 54 while(CLR != 0) ;
sev2000 4:844c00dd0366 55 }
sev2000 4:844c00dd0366 56 else ;
sev2000 4:844c00dd0366 57 while(CLR == 0) ;
sev2000 4:844c00dd0366 58 }
sev2000 4:844c00dd0366 59
sev2000 4:844c00dd0366 60 void wait_negedge(void)
sev2000 4:844c00dd0366 61 {
sev2000 4:844c00dd0366 62 if(CLR == 0)
sev2000 4:844c00dd0366 63 {
sev2000 4:844c00dd0366 64 while(CLR == 0) ;
sev2000 4:844c00dd0366 65 }
sev2000 4:844c00dd0366 66 else ;
sev2000 4:844c00dd0366 67 while(CLR != 0) ;
sev2000 4:844c00dd0366 68 }
sev2000 4:844c00dd0366 69
sev2000 4:844c00dd0366 70 unsigned long read_ctrl_reg(void)
sev2000 4:844c00dd0366 71 {
sev2000 4:844c00dd0366 72 unsigned long return_value = 0;
sev2000 4:844c00dd0366 73 unsigned long curr_bit = 0 ;
sev2000 4:844c00dd0366 74 int i ;
sev2000 4:844c00dd0366 75
sev2000 4:844c00dd0366 76 RxTx = 1;
sev2000 4:844c00dd0366 77 //Reg_Data = 0;
sev2000 4:844c00dd0366 78 wait_posedge();
sev2000 4:844c00dd0366 79 //wait_ms(10);
sev2000 4:844c00dd0366 80 Reg_Data = 1;
sev2000 4:844c00dd0366 81 RxTx = 1;
sev2000 4:844c00dd0366 82
sev2000 4:844c00dd0366 83 for(i=0;i<=23;i++)
sev2000 4:844c00dd0366 84 {
sev2000 4:844c00dd0366 85 //DBG("i= %d", i);
sev2000 4:844c00dd0366 86 wait_posedge();
sev2000 4:844c00dd0366 87 curr_bit = Rx ;
sev2000 4:844c00dd0366 88 return_value |= ((curr_bit) << (23-i)) ;
sev2000 4:844c00dd0366 89 }
sev2000 4:844c00dd0366 90 //wait_negedge();
sev2000 4:844c00dd0366 91
sev2000 4:844c00dd0366 92 Reg_Data = 0; //clr pin reg_data
sev2000 4:844c00dd0366 93
sev2000 4:844c00dd0366 94 wait(1) ;
sev2000 4:844c00dd0366 95 return return_value ;
sev2000 4:844c00dd0366 96 }
sev2000 4:844c00dd0366 97
sev2000 4:844c00dd0366 98 void write_ctrl_reg(unsigned long write_data)
sev2000 4:844c00dd0366 99 {
sev2000 4:844c00dd0366 100 int i ;
sev2000 4:844c00dd0366 101
sev2000 5:dcbebd42186a 102 Reg_Data = 1; //set pin reg_data to Register mode
sev2000 5:dcbebd42186a 103 RxTx = 0; //set pin rxtx to Tx mode
sev2000 6:e373216c80bf 104 wait_posedge(); //find posedge for Tcr
sev2000 4:844c00dd0366 105
sev2000 4:844c00dd0366 106 for(i=0;i<=23;i++) //low code effciency may result in wrong writing
sev2000 4:844c00dd0366 107 {
sev2000 4:844c00dd0366 108 if(((write_data >> (23-i)) & 0x1) == 0)
sev2000 4:844c00dd0366 109 {
sev2000 4:844c00dd0366 110 Tx = 0;
sev2000 4:844c00dd0366 111 }
sev2000 4:844c00dd0366 112 else
sev2000 4:844c00dd0366 113 {
sev2000 4:844c00dd0366 114 Tx = 1;
sev2000 4:844c00dd0366 115 }
sev2000 4:844c00dd0366 116 wait_posedge();
sev2000 4:844c00dd0366 117 }
sev2000 5:dcbebd42186a 118 RxTx = 1; //set pin rxtx to Rx
sev2000 4:844c00dd0366 119 Reg_Data = 0; //set pin reg_data
sev2000 4:844c00dd0366 120 Tx = 0;
sev2000 4:844c00dd0366 121 wait(0.1);
sev2000 4:844c00dd0366 122 }
sev2000 4:844c00dd0366 123
sev2000 1:265edb6bdd52 124 void SendBit(bool value)
sev2000 1:265edb6bdd52 125 {
sev2000 5:dcbebd42186a 126 // DBG("%d ", value);
sev2000 1:265edb6bdd52 127 Tx = !Tx;
sev2000 1:265edb6bdd52 128 if(value)
sev2000 1:265edb6bdd52 129 {
sev2000 1:265edb6bdd52 130 wait_us(800);
sev2000 1:265edb6bdd52 131 Tx = !Tx;
sev2000 1:265edb6bdd52 132 wait_us(800);
sev2000 1:265edb6bdd52 133 }
sev2000 1:265edb6bdd52 134 else
sev2000 1:265edb6bdd52 135 {
sev2000 1:265edb6bdd52 136 wait_us(1600);
sev2000 1:265edb6bdd52 137 }
sev2000 1:265edb6bdd52 138 }
sev2000 1:265edb6bdd52 139
sev2000 1:265edb6bdd52 140 void SendByte(char value)
sev2000 1:265edb6bdd52 141 {
sev2000 1:265edb6bdd52 142 int i=0;
sev2000 1:265edb6bdd52 143 bool bit;
sev2000 1:265edb6bdd52 144 static char cnt=0;
sev2000 1:265edb6bdd52 145
sev2000 1:265edb6bdd52 146 pc.printf("%0.2X ", value);
sev2000 1:265edb6bdd52 147 for(i=0; i<8; i++)
sev2000 1:265edb6bdd52 148 {
sev2000 1:265edb6bdd52 149 bit = (bool)(0x01 & (value>>i)); // LSB first
sev2000 1:265edb6bdd52 150 SendBit(bit);
sev2000 1:265edb6bdd52 151 if(bit)
sev2000 1:265edb6bdd52 152 cnt++;
sev2000 1:265edb6bdd52 153 else
sev2000 1:265edb6bdd52 154 cnt=0;
sev2000 1:265edb6bdd52 155 if(cnt == 5)
sev2000 1:265edb6bdd52 156 SendBit(0);
sev2000 1:265edb6bdd52 157 }
sev2000 1:265edb6bdd52 158 }
sev2000 1:265edb6bdd52 159
sev2000 1:265edb6bdd52 160 void SendPreamble(void)
sev2000 1:265edb6bdd52 161 {
sev2000 1:265edb6bdd52 162 int i;
sev2000 1:265edb6bdd52 163
sev2000 1:265edb6bdd52 164 pc.printf("\r\n");
sev2000 1:265edb6bdd52 165 Tx=1;
sev2000 1:265edb6bdd52 166 for(i=0; i<17; i++)
sev2000 1:265edb6bdd52 167 SendBit(0);
sev2000 1:265edb6bdd52 168 for(i=0; i<6; i++)
sev2000 1:265edb6bdd52 169 SendBit(1);
sev2000 1:265edb6bdd52 170 SendBit(0);
sev2000 1:265edb6bdd52 171
sev2000 1:265edb6bdd52 172 }
sev2000 1:265edb6bdd52 173
sev2000 1:265edb6bdd52 174 void SendPostamble(void)
sev2000 1:265edb6bdd52 175 {
sev2000 1:265edb6bdd52 176 int i;
sev2000 1:265edb6bdd52 177
sev2000 1:265edb6bdd52 178 for(i=0; i<8; i++) // Send 0xFF
sev2000 1:265edb6bdd52 179 SendBit(1);
sev2000 1:265edb6bdd52 180 for(i=0; i<8; i++)
sev2000 1:265edb6bdd52 181 SendBit(0);
sev2000 1:265edb6bdd52 182
sev2000 1:265edb6bdd52 183 }
sev2000 1:265edb6bdd52 184
sev2000 1:265edb6bdd52 185 void SendFrame(char *data, int length)
sev2000 1:265edb6bdd52 186 {
sev2000 1:265edb6bdd52 187
sev2000 1:265edb6bdd52 188 int i, chksum=0;
sev2000 1:265edb6bdd52 189
sev2000 1:265edb6bdd52 190 RxTx = 0; //set pin rxtx to Tx
sev2000 1:265edb6bdd52 191 wait_ms(1);
sev2000 1:265edb6bdd52 192
sev2000 1:265edb6bdd52 193 SendPreamble();
sev2000 1:265edb6bdd52 194
sev2000 1:265edb6bdd52 195 for(i=0; i<length; i++)
sev2000 1:265edb6bdd52 196 {
sev2000 1:265edb6bdd52 197 SendByte(data[i]);
sev2000 1:265edb6bdd52 198 chksum += data[i];
sev2000 1:265edb6bdd52 199 }
sev2000 1:265edb6bdd52 200 chksum = ~chksum +1;
sev2000 1:265edb6bdd52 201
sev2000 1:265edb6bdd52 202 SendByte((char)(chksum>>8));
sev2000 1:265edb6bdd52 203 SendByte((char)chksum);
sev2000 1:265edb6bdd52 204 SendPostamble();
sev2000 1:265edb6bdd52 205
sev2000 1:265edb6bdd52 206 RxTx = 1; //set pin rxtx to Rx
sev2000 1:265edb6bdd52 207 }
sev2000 1:265edb6bdd52 208
sev2000 1:265edb6bdd52 209 void SendCmd(prog prog, int zone)
sev2000 1:265edb6bdd52 210 {
sev2000 1:265edb6bdd52 211 char tab[8]={0xF1,0xE6,0x01,0x10,0x01,0x00,0x03,0x64}; // Zone1 Sun
sev2000 1:265edb6bdd52 212 char maison[2]={0xF1,0xE6};
sev2000 1:265edb6bdd52 213 char source = 0x01;
sev2000 1:265edb6bdd52 214 char dest = 0;
sev2000 1:265edb6bdd52 215 char trans = 0x01;
sev2000 1:265edb6bdd52 216 int i;
sev2000 1:265edb6bdd52 217
sev2000 1:265edb6bdd52 218 dest = 0x10 + zone-1;
sev2000 1:265edb6bdd52 219 tab[3] = dest;
sev2000 1:265edb6bdd52 220 tab[6] = prog;
sev2000 1:265edb6bdd52 221
sev2000 1:265edb6bdd52 222 for(i=0; i<3; i++)
sev2000 1:265edb6bdd52 223 {
sev2000 1:265edb6bdd52 224 tab[5]=i; //message count
sev2000 1:265edb6bdd52 225 SendFrame(tab, 8);
sev2000 1:265edb6bdd52 226 wait_ms(30);
sev2000 1:265edb6bdd52 227 }
sev2000 1:265edb6bdd52 228 }
sev2000 1:265edb6bdd52 229
sev2000 0:9ef8edfe21bc 230 int detectPreamble(void)
sev2000 0:9ef8edfe21bc 231 {
sev2000 0:9ef8edfe21bc 232 pulse_t pulse;
sev2000 0:9ef8edfe21bc 233 int cnt = 0;
sev2000 0:9ef8edfe21bc 234 char tmp[32]={0};
sev2000 0:9ef8edfe21bc 235 char timing[8*1024]={0};
sev2000 0:9ef8edfe21bc 236 char state=0;
sev2000 0:9ef8edfe21bc 237 char s=0, l=0, bit_ptr=0;
sev2000 0:9ef8edfe21bc 238
sev2000 0:9ef8edfe21bc 239 while (!PulseWidth.empty())
sev2000 0:9ef8edfe21bc 240 {
sev2000 0:9ef8edfe21bc 241 PulseWidth.pop(pulse);
sev2000 0:9ef8edfe21bc 242 sprintf(tmp, "%d, %ld|", pulse.pin, pulse.v);
sev2000 0:9ef8edfe21bc 243 strcat(timing, tmp);
sev2000 0:9ef8edfe21bc 244
sev2000 0:9ef8edfe21bc 245 if ((pulse.v > 700) && (pulse.v < 1000))
sev2000 0:9ef8edfe21bc 246 { // short off detected
sev2000 0:9ef8edfe21bc 247 s++;
sev2000 0:9ef8edfe21bc 248 l=0;
sev2000 0:9ef8edfe21bc 249 }
sev2000 0:9ef8edfe21bc 250 else if ((pulse.v > 1500) && (pulse.v < 1800))
sev2000 0:9ef8edfe21bc 251 { // long off detected
sev2000 0:9ef8edfe21bc 252 l++;
sev2000 0:9ef8edfe21bc 253 s=0;
sev2000 0:9ef8edfe21bc 254 }
sev2000 0:9ef8edfe21bc 255 else
sev2000 0:9ef8edfe21bc 256 {
sev2000 0:9ef8edfe21bc 257 l=0;
sev2000 0:9ef8edfe21bc 258 s=0;
sev2000 0:9ef8edfe21bc 259 bit_ptr=0;
sev2000 0:9ef8edfe21bc 260 state=0;
sev2000 0:9ef8edfe21bc 261 }
sev2000 0:9ef8edfe21bc 262 switch(state)
sev2000 0:9ef8edfe21bc 263 {
sev2000 0:9ef8edfe21bc 264 case 0: // Detect preamble
sev2000 0:9ef8edfe21bc 265 if(s >= 12) // out of 12
sev2000 0:9ef8edfe21bc 266 state=1;
sev2000 0:9ef8edfe21bc 267 //pc.printf("%d ", s);
sev2000 0:9ef8edfe21bc 268 break;
sev2000 0:9ef8edfe21bc 269 case 1: // wait start bit (first long)
sev2000 0:9ef8edfe21bc 270 //pc.printf("OK2");
sev2000 0:9ef8edfe21bc 271 s=0;
sev2000 0:9ef8edfe21bc 272 if (l==1)
sev2000 0:9ef8edfe21bc 273 {
sev2000 0:9ef8edfe21bc 274 state = 2;
sev2000 0:9ef8edfe21bc 275 //bit_ptr++; inculde start bit in payload
sev2000 0:9ef8edfe21bc 276 }
sev2000 0:9ef8edfe21bc 277 l=0;
sev2000 0:9ef8edfe21bc 278 break;
sev2000 0:9ef8edfe21bc 279 case 2:
sev2000 0:9ef8edfe21bc 280 //pc.printf(" %d", pulse.v);
sev2000 0:9ef8edfe21bc 281
sev2000 0:9ef8edfe21bc 282 if (s == 2)
sev2000 0:9ef8edfe21bc 283 {
sev2000 0:9ef8edfe21bc 284 dataBits[bit_ptr] = 1;
sev2000 0:9ef8edfe21bc 285 l=0;
sev2000 0:9ef8edfe21bc 286 s=0;
sev2000 0:9ef8edfe21bc 287 bit_ptr++;
sev2000 0:9ef8edfe21bc 288 }
sev2000 0:9ef8edfe21bc 289 if (l == 1 && s==0)
sev2000 0:9ef8edfe21bc 290 {
sev2000 0:9ef8edfe21bc 291 dataBits[bit_ptr] = 0;
sev2000 0:9ef8edfe21bc 292 l=0;
sev2000 0:9ef8edfe21bc 293 s=0;
sev2000 0:9ef8edfe21bc 294 bit_ptr++;
sev2000 0:9ef8edfe21bc 295 }
sev2000 0:9ef8edfe21bc 296 if(bit_ptr > BIT_SIZE)
sev2000 0:9ef8edfe21bc 297 {
sev2000 0:9ef8edfe21bc 298 state=0;
sev2000 0:9ef8edfe21bc 299 bit_ptr=0;
sev2000 0:9ef8edfe21bc 300 printf("Frame too long ; dropped");
sev2000 0:9ef8edfe21bc 301 }
sev2000 0:9ef8edfe21bc 302
sev2000 0:9ef8edfe21bc 303 break;
sev2000 0:9ef8edfe21bc 304 }
sev2000 0:9ef8edfe21bc 305
sev2000 0:9ef8edfe21bc 306 if(pulse.v > 30000 && cnt>0) // End of frame
sev2000 0:9ef8edfe21bc 307 {
sev2000 0:9ef8edfe21bc 308 processData();
sev2000 0:9ef8edfe21bc 309 //timing[0]=0;
sev2000 0:9ef8edfe21bc 310 state=0;
sev2000 0:9ef8edfe21bc 311 bit_ptr=0;
sev2000 0:9ef8edfe21bc 312 //PulseWidth.reset();
sev2000 0:9ef8edfe21bc 313 // WARN(" Waiting...");
sev2000 0:9ef8edfe21bc 314 }
sev2000 0:9ef8edfe21bc 315
sev2000 0:9ef8edfe21bc 316 cnt++;
sev2000 0:9ef8edfe21bc 317 }
sev2000 0:9ef8edfe21bc 318 if (cnt>0) // if buffer wasn't empty
sev2000 0:9ef8edfe21bc 319 {
sev2000 0:9ef8edfe21bc 320 processData();
sev2000 0:9ef8edfe21bc 321 //pc.printf("%s\r\n", timing);
sev2000 0:9ef8edfe21bc 322 }
sev2000 0:9ef8edfe21bc 323
sev2000 0:9ef8edfe21bc 324 return(0);
sev2000 0:9ef8edfe21bc 325 }
sev2000 0:9ef8edfe21bc 326
sev2000 0:9ef8edfe21bc 327 int processData(void)
sev2000 0:9ef8edfe21bc 328 {
sev2000 0:9ef8edfe21bc 329 int x=0;
sev2000 0:9ef8edfe21bc 330 int i = 0;
sev2000 0:9ef8edfe21bc 331 int j= 0;
sev2000 0:9ef8edfe21bc 332 char nibble[18]={0}, cnt=0;
sev2000 0:9ef8edfe21bc 333 int chksum=0, etx_ptr=16;
sev2000 0:9ef8edfe21bc 334
sev2000 0:9ef8edfe21bc 335 /* pc.printf("\r\n");
sev2000 0:9ef8edfe21bc 336 for (x=0;x<128;x++)
sev2000 0:9ef8edfe21bc 337 {
sev2000 0:9ef8edfe21bc 338 if(x%8==0)
sev2000 0:9ef8edfe21bc 339 pc.printf(" ");
sev2000 0:9ef8edfe21bc 340 pc.printf("%d", dataBits[x]);
sev2000 0:9ef8edfe21bc 341 }
sev2000 0:9ef8edfe21bc 342 */
sev2000 0:9ef8edfe21bc 343 x=0;
sev2000 0:9ef8edfe21bc 344
sev2000 0:9ef8edfe21bc 345 for (i=0; i<etx_ptr; i++)
sev2000 0:9ef8edfe21bc 346 {
sev2000 0:9ef8edfe21bc 347 for (j=0;j<8;j++)
sev2000 0:9ef8edfe21bc 348 {
sev2000 0:9ef8edfe21bc 349 if ( dataBits[x])
sev2000 0:9ef8edfe21bc 350 {
sev2000 0:9ef8edfe21bc 351 nibble[i] |= 1<<j;
sev2000 0:9ef8edfe21bc 352 cnt++;
sev2000 0:9ef8edfe21bc 353 }
sev2000 0:9ef8edfe21bc 354 else
sev2000 0:9ef8edfe21bc 355 {
sev2000 0:9ef8edfe21bc 356 if (cnt == 5)
sev2000 0:9ef8edfe21bc 357 j--;
sev2000 0:9ef8edfe21bc 358 cnt=0;
sev2000 0:9ef8edfe21bc 359 }
sev2000 0:9ef8edfe21bc 360 dataBits[x] =0; // clean variable
sev2000 0:9ef8edfe21bc 361 x++;
sev2000 0:9ef8edfe21bc 362 }
sev2000 0:9ef8edfe21bc 363 if (cnt >= 8) // End of Frame detection
sev2000 0:9ef8edfe21bc 364 etx_ptr=i;
sev2000 0:9ef8edfe21bc 365 }
sev2000 0:9ef8edfe21bc 366
sev2000 0:9ef8edfe21bc 367
sev2000 0:9ef8edfe21bc 368 for (i=0; i<etx_ptr-2; i++) // Calculate Checksum
sev2000 0:9ef8edfe21bc 369 chksum += nibble[i];
sev2000 0:9ef8edfe21bc 370 chksum = ~chksum +1;
sev2000 0:9ef8edfe21bc 371
sev2000 0:9ef8edfe21bc 372 #ifdef __DEBUG__
sev2000 0:9ef8edfe21bc 373 for (i=0; i<etx_ptr; i++)
sev2000 0:9ef8edfe21bc 374 pc.printf("%0.2X ",nibble[i]);
sev2000 0:9ef8edfe21bc 375 if ( (char)(chksum>>8) != nibble[etx_ptr-2] || (char)chksum != nibble[etx_ptr-1] )
sev2000 0:9ef8edfe21bc 376 pc.printf(" CRC Error");
sev2000 0:9ef8edfe21bc 377 pc.printf("\r\n");
sev2000 0:9ef8edfe21bc 378 #endif
sev2000 0:9ef8edfe21bc 379
sev2000 0:9ef8edfe21bc 380 return 0;
sev2000 0:9ef8edfe21bc 381 }
sev2000 0:9ef8edfe21bc 382
sev2000 0:9ef8edfe21bc 383
sev2000 0:9ef8edfe21bc 384 void Init_X2D()
sev2000 0:9ef8edfe21bc 385 {
sev2000 6:e373216c80bf 386 unsigned long Ctrl_Reg = 0;
sev2000 5:dcbebd42186a 387
sev2000 4:844c00dd0366 388 Rx.fall(&getPulseF);
sev2000 4:844c00dd0366 389 Rx.rise(&getPulseR);
sev2000 0:9ef8edfe21bc 390 UART = 1;
sev2000 5:dcbebd42186a 391
sev2000 5:dcbebd42186a 392 write_ctrl_reg(0x01E22F); // 1200 baud, deviation =1, Asynchrone
sev2000 5:dcbebd42186a 393 Ctrl_Reg = read_ctrl_reg();
sev2000 5:dcbebd42186a 394 DBG("Ctrl_reg = %X", Ctrl_Reg);
sev2000 5:dcbebd42186a 395
sev2000 0:9ef8edfe21bc 396 RxTx = 1; //set pin rxtx to Rx
sev2000 0:9ef8edfe21bc 397 Reg_Data = 0; //set pin reg_data
sev2000 0:9ef8edfe21bc 398 Tx = 0;
sev2000 0:9ef8edfe21bc 399
sev2000 0:9ef8edfe21bc 400 xTime.start();
sev2000 0:9ef8edfe21bc 401 xTime.reset();
sev2000 0:9ef8edfe21bc 402 startedAt = xTime.read_us(); // set initial timer end
sev2000 0:9ef8edfe21bc 403
sev2000 0:9ef8edfe21bc 404 //thread.start(getData);
sev2000 0:9ef8edfe21bc 405 }