root / Version 1.2 / RS232_MUX.X / main.c @ master
Historique | Voir | Annoter | Télécharger (17,439 ko)
1 |
/*
|
---|---|
2 |
* File: main.c
|
3 |
* Author: eniro
|
4 |
* Version : 0.9
|
5 |
*
|
6 |
* Created on March 25, 2024, 3:51 PM
|
7 |
*/
|
8 |
|
9 |
|
10 |
|
11 |
/*
|
12 |
|
13 |
TODO LIST :
|
14 |
*
|
15 |
*
|
16 |
* Remap all pins !!!
|
17 |
*
|
18 |
* Select UART1 as master port
|
19 |
*
|
20 |
* Rename VCOMA/2/3/4 as VCOMA/B/C/D ?
|
21 |
|
22 |
*/
|
23 |
|
24 |
#define F_CPU 24000000UL |
25 |
|
26 |
#include <xc.h> |
27 |
#include <math.h> |
28 |
#include <stdlib.h> |
29 |
#include <util/delay.h> |
30 |
#include <avr/interrupt.h> |
31 |
#include <avr/eeprom.h> |
32 |
|
33 |
#include "hardware_uart.h" |
34 |
#include "hardware_timer.h" |
35 |
#include "hardware_TL16C754C.h" |
36 |
#include "hardware_config.h" |
37 |
#include "frame_definitions.h" |
38 |
#include "parameters.h" |
39 |
|
40 |
//USART setup
|
41 |
|
42 |
//To calculate BAUD value register -> BAUD = 64*FCLK/(16*FBAUDS)
|
43 |
#define UART_BAUD_VALUE 833 // 10000 is equivalent as 9600 bauds (on 24MHz clock) according to datasheet |
44 |
#define USART0_REG 0x3 |
45 |
#define BOOT_MSG "RS232-MUX\r\n" |
46 |
|
47 |
|
48 |
|
49 |
//OSC. setup
|
50 |
#define FREQSEL 0x9 |
51 |
#define _FREQSEL_REG_WR ((FREQSEL) << 2) |
52 |
#define _USART0_REG_WR (USART0_REG & 0x7) |
53 |
|
54 |
|
55 |
|
56 |
|
57 |
|
58 |
|
59 |
enum portIndex {
|
60 |
PORT_VCOMA_INDEX = 0,
|
61 |
PORT_VCOMB_INDEX, |
62 |
PORT_VCOMC_INDEX, |
63 |
PORT_VCOMD_INDEX, |
64 |
PORT_MCOM_INDEX, |
65 |
}; |
66 |
|
67 |
|
68 |
//////////////////////////////////////////////////////////////
|
69 |
//Prototypes
|
70 |
|
71 |
void bootSequence(void); |
72 |
void MCOM_sendframe(uint8_t *data, uint8_t n, uint8_t port);
|
73 |
void VCOM_sendframe(uint8_t *data, uint8_t n);
|
74 |
void senseDebugLeds(bool *hasWritten, bool *hasRead); |
75 |
uint8_t getPriority(uint8_t chosen_com, uint8_t *ports_list, uint8_t n); |
76 |
|
77 |
//reset watchdog counter
|
78 |
#define WATCHDOG_RESET asm("WDR") |
79 |
|
80 |
uint8_t global_debugBuffer[256];
|
81 |
uint8_t global_n = 0;
|
82 |
uint8_t global_parity; |
83 |
|
84 |
|
85 |
|
86 |
|
87 |
|
88 |
|
89 |
#ifdef USE_PORT_1
|
90 |
#define INIT_PORT(w,x,y,z) initPort1(w,x,y,z)
|
91 |
#define TX_WRITE(x) txWrite1(x)
|
92 |
#define RX_READ rxRead1()
|
93 |
#define PORT_AVAILABLE portAvailable1()
|
94 |
#else
|
95 |
#ifdef USE_PORT_2
|
96 |
#define INIT_PORT(w,x,y,z) initPort2(w,x,y,z)
|
97 |
#define TX_WRITE(x) txWrite2(x)
|
98 |
#define RX_READ rxRead2()
|
99 |
#define PORT_AVAILABLE portAvailable2()
|
100 |
#else
|
101 |
#ifdef USE_PORT_3
|
102 |
#define INIT_PORT(w,x,y,z) initPort3(w,x,y,z)
|
103 |
#define TX_WRITE(x) txWrite3(x)
|
104 |
#define RX_READ rxRead3()
|
105 |
#define PORT_AVAILABLE portAvailable3()
|
106 |
#else
|
107 |
#ifdef USE_PORT_4
|
108 |
#define INIT_PORT(w,x,y,z) initPort4(w,x,y,z)
|
109 |
#define TX_WRITE(x) txWrite4(x)
|
110 |
#define RX_READ rxRead4()
|
111 |
#define PORT_AVAILABLE portAvailable4()
|
112 |
#else
|
113 |
#error "Please choose an uart port..." |
114 |
#endif
|
115 |
#endif
|
116 |
#endif
|
117 |
#endif
|
118 |
|
119 |
|
120 |
int main(void) { |
121 |
|
122 |
|
123 |
uint8_t ctrlReg; |
124 |
uint8_t masterBuffer[64], bufferA[64], bufferB[64], bufferC[64], bufferD[64]; |
125 |
uint8_t VCOMAIndex = 0, VCOMBIndex = 0, VCOMCIndex = 0, VCOMDIndex = 0, MCOMIndex; |
126 |
uint16_t MCOM_counter = 0;
|
127 |
uint16_t VCOMA_counter = 0;
|
128 |
uint16_t VCOMB_counter = 0;
|
129 |
uint16_t VCOMC_counter = 0;
|
130 |
uint16_t VCOMD_counter = 0;
|
131 |
uint8_t debug; |
132 |
|
133 |
bool writtenStatus = false; |
134 |
bool readStatus[] = {false, false, false, false, false}; |
135 |
//local timer counter for local process (blink led, ect...)
|
136 |
|
137 |
uint8_t vcom_priority[] = {0, 0, 0, 0}; //VCOM priority to send on master port |
138 |
uint8_t vcom_choose = PORT_VCOMA_INDEX; |
139 |
|
140 |
setWait(5000);
|
141 |
|
142 |
|
143 |
for(int i = 0; i < 64; i++) |
144 |
{ |
145 |
bufferA[i] = 0;
|
146 |
} |
147 |
for(int i = 0; i < 64; i++) |
148 |
{ |
149 |
bufferB[i] = 0;
|
150 |
} |
151 |
for(int i = 0; i < 64; i++) |
152 |
{ |
153 |
bufferC[i] = 0;
|
154 |
} |
155 |
for(int i = 0; i < 64; i++) |
156 |
{ |
157 |
bufferD[i] = 0;
|
158 |
} |
159 |
|
160 |
_PROTECTED_WRITE(CLKCTRL.OSCHFCTRLA, _FREQSEL_REG_WR); //switch to 24 MHz
|
161 |
|
162 |
|
163 |
|
164 |
//Enable pins (Port direction)
|
165 |
ADDR_ENABLE; //Address pins
|
166 |
ENABLE_WR_RD_PINS; //Read and Write pins
|
167 |
ENABLE_CS_PINS; //Chip select pins
|
168 |
ENABLE_RESET_PIN; //Reset pin
|
169 |
|
170 |
//////////////////////////////////////////////////////////////
|
171 |
//Remember to put high level on cs pins to disable devices...
|
172 |
SETCSA; |
173 |
SETCSB; |
174 |
SETCSC; |
175 |
SETCSD; |
176 |
//Also don't forget IOR and IOW
|
177 |
SETWR; |
178 |
SETRD; |
179 |
//////////////////////////////////////////////////////////////
|
180 |
|
181 |
|
182 |
////////////////////////////////////////
|
183 |
//init TL16C IC
|
184 |
SETRST; |
185 |
//_delay_ms(10);
|
186 |
setWait(100);
|
187 |
CLRRST; |
188 |
setWait(5);
|
189 |
////////////////////////////////////////
|
190 |
|
191 |
//Init virtual COM ports
|
192 |
//TODO : Set EEPROM CFG here
|
193 |
initPortA(DL_9600_BAUDS, F8BIT_MODE, TL16C_NO_PARITY, ONE_STOPBIT); |
194 |
initPortB(DL_9600_BAUDS, F8BIT_MODE, TL16C_NO_PARITY, ONE_STOPBIT); |
195 |
initPortC(DL_9600_BAUDS, F8BIT_MODE, TL16C_NO_PARITY, ONE_STOPBIT); |
196 |
initPortD(DL_9600_BAUDS, F8BIT_MODE, TL16C_NO_PARITY, ONE_STOPBIT); |
197 |
|
198 |
//Master Port
|
199 |
INIT_PORT(UART_BAUD_VALUE, F8BIT_MODE, ONE_STOPBIT, AVR32_NO_PARITY); |
200 |
|
201 |
setWait(500);
|
202 |
ctrlReg = 0;
|
203 |
|
204 |
|
205 |
timerInit(60000); //10 ms interrupt |
206 |
sei(); //never forget to enable global interrupt mask !
|
207 |
|
208 |
PORTA.DIR = 0x3F;
|
209 |
|
210 |
|
211 |
|
212 |
while(1) |
213 |
{ |
214 |
if(vcom_choose > 3) |
215 |
{ |
216 |
asm("nop"); |
217 |
asm("nop"); |
218 |
asm("nop"); |
219 |
asm("nop"); |
220 |
} |
221 |
debug++; |
222 |
|
223 |
if(debug == 0x07) |
224 |
asm("nop"); |
225 |
|
226 |
////////////////////////////////////////////////////////
|
227 |
//Read UART A
|
228 |
|
229 |
|
230 |
if(portA_available()) //Check if one byte available |
231 |
{ |
232 |
readStatus[PORT_VCOMA_INDEX] = true;
|
233 |
bufferA[VCOMAIndex] = rxReadA(); |
234 |
VCOMAIndex++; |
235 |
//if(VCOMAIndex > 64)
|
236 |
// VCOMAIndex = 0;
|
237 |
VCOMA_counter = 0; //for frame timeout |
238 |
} |
239 |
|
240 |
////////////////////////////////////////////////////////
|
241 |
//Read UART B
|
242 |
|
243 |
|
244 |
if(portB_available()) //Check if one byte available |
245 |
{ |
246 |
readStatus[PORT_VCOMB_INDEX] = true;
|
247 |
bufferB[VCOMBIndex] = rxReadB(); |
248 |
VCOMBIndex++; |
249 |
//if(VCOMBIndex > 64)
|
250 |
// VCOMBIndex = 0;
|
251 |
VCOMB_counter = 0; //for frame timeout |
252 |
} |
253 |
|
254 |
|
255 |
////////////////////////////////////////////////////////
|
256 |
//Read UART C
|
257 |
|
258 |
|
259 |
if(portC_available()) //Check if one byte available |
260 |
{ |
261 |
readStatus[PORT_VCOMC_INDEX] = true;
|
262 |
bufferC[VCOMCIndex] = rxReadC(); |
263 |
VCOMCIndex++; |
264 |
//if(VCOMCIndex > 64)
|
265 |
// VCOMCIndex = 0;
|
266 |
VCOMC_counter = 0; //for frame timeout |
267 |
} |
268 |
|
269 |
|
270 |
|
271 |
////////////////////////////////////////////////////////
|
272 |
//Read UART D
|
273 |
|
274 |
|
275 |
if(portD_available()) //Check if one byte available |
276 |
{ |
277 |
readStatus[PORT_VCOMD_INDEX] = true;
|
278 |
bufferD[VCOMDIndex] = rxReadD(); |
279 |
VCOMDIndex++; |
280 |
//if(VCOMDIndex > 64)
|
281 |
// VCOMDIndex = 0;
|
282 |
VCOMD_counter = 0; //for frame timeout |
283 |
} |
284 |
|
285 |
|
286 |
////////////////////////////////////////////////////////
|
287 |
//Read UART Master
|
288 |
|
289 |
|
290 |
if(PORT_AVAILABLE > 0) //check if we have bytes to read |
291 |
{ |
292 |
readStatus[PORT_MCOM_INDEX] = true;
|
293 |
masterBuffer[MCOMIndex] = RX_READ; //store byte into buffer
|
294 |
MCOMIndex++; //increment to next byte
|
295 |
//if(MCOMIndex > 64)
|
296 |
// MCOMIndex = 0;
|
297 |
MCOM_counter = 0; //refresh timeout counter |
298 |
} |
299 |
|
300 |
|
301 |
|
302 |
|
303 |
//Timed process (for leds, etc...)
|
304 |
if(getTimerFlag())
|
305 |
{ |
306 |
/////////////////////////////////////////////////////////
|
307 |
//Timeout process
|
308 |
|
309 |
//For master port
|
310 |
if(MCOMIndex > 0) |
311 |
MCOM_counter++; |
312 |
|
313 |
//For virtual port 1
|
314 |
if(VCOMAIndex > 0) |
315 |
VCOMA_counter++; |
316 |
|
317 |
//For virtual port 2
|
318 |
if(VCOMBIndex > 0) |
319 |
VCOMB_counter++; |
320 |
|
321 |
//For virtual port 3
|
322 |
if(VCOMCIndex > 0) |
323 |
VCOMC_counter++; |
324 |
|
325 |
//For virtual port 4
|
326 |
if(VCOMDIndex > 0) |
327 |
VCOMD_counter++; |
328 |
|
329 |
|
330 |
senseDebugLeds(&writtenStatus, readStatus); |
331 |
clearTimerFlag(); |
332 |
} |
333 |
|
334 |
|
335 |
|
336 |
|
337 |
|
338 |
///////////////////////////////////////
|
339 |
//When buf is ready from master
|
340 |
if(MCOM_counter > SERIAL_PORT_TIMEOUT_COUNT || MCOMIndex >= 64) |
341 |
{ |
342 |
|
343 |
|
344 |
|
345 |
//Send buffer to VCOM
|
346 |
VCOM_sendframe(masterBuffer, MCOMIndex); |
347 |
MCOMIndex = 0; //reset index buffer |
348 |
MCOM_counter = 0; //reset counter |
349 |
} |
350 |
|
351 |
|
352 |
///////////////////////////////////////
|
353 |
//When buf is ready from VCOMA
|
354 |
|
355 |
if(vcom_choose == PORT_VCOMA_INDEX)
|
356 |
{ |
357 |
if(VCOMA_counter > SERIAL_PORT_TIMEOUT_COUNT || VCOMAIndex >= 64) |
358 |
{ |
359 |
|
360 |
vcom_choose = getPriority(vcom_choose, vcom_priority, MAX_VCOM_PORTS); //Calculate next port to send
|
361 |
|
362 |
if(vcom_choose > 3) |
363 |
{ |
364 |
asm("nop"); |
365 |
asm("nop"); |
366 |
asm("nop"); |
367 |
asm("nop"); |
368 |
} |
369 |
|
370 |
writtenStatus = true;//Say a wrote has been made |
371 |
//Send buffer to VCOM
|
372 |
MCOM_sendframe(bufferA, VCOMAIndex, PORT_VCOMA_INDEX); |
373 |
VCOMAIndex = 0; //reset index buffer |
374 |
VCOMA_counter = 0; //reset counter |
375 |
} |
376 |
} |
377 |
|
378 |
|
379 |
|
380 |
///////////////////////////////////////
|
381 |
//When buf is ready from VCOMB
|
382 |
if(vcom_choose == PORT_VCOMB_INDEX)
|
383 |
{ |
384 |
if(VCOMB_counter > SERIAL_PORT_TIMEOUT_COUNT || VCOMBIndex >= 64) |
385 |
{ |
386 |
|
387 |
vcom_choose = getPriority(vcom_choose, vcom_priority, MAX_VCOM_PORTS); //Calculate next port to send
|
388 |
|
389 |
if(vcom_choose > 3) |
390 |
{ |
391 |
asm("nop"); |
392 |
asm("nop"); |
393 |
asm("nop"); |
394 |
asm("nop"); |
395 |
} |
396 |
|
397 |
writtenStatus = true;//Say a wrote has been made |
398 |
//Send buffer to VCOM
|
399 |
MCOM_sendframe(bufferB, VCOMBIndex, PORT_VCOMB_INDEX); |
400 |
VCOMBIndex = 0; //reset index buffer |
401 |
VCOMB_counter = 0; //reset counter |
402 |
} |
403 |
} |
404 |
|
405 |
|
406 |
///////////////////////////////////////
|
407 |
//When buf is ready from VCOMC
|
408 |
if(vcom_choose == PORT_VCOMC_INDEX)
|
409 |
{ |
410 |
if(VCOMC_counter > SERIAL_PORT_TIMEOUT_COUNT || VCOMCIndex >= 64) |
411 |
{ |
412 |
|
413 |
vcom_choose = getPriority(vcom_choose, vcom_priority, MAX_VCOM_PORTS); //Calculate next port to send
|
414 |
if(vcom_choose > 3) |
415 |
{ |
416 |
asm("nop"); |
417 |
asm("nop"); |
418 |
asm("nop"); |
419 |
asm("nop"); |
420 |
} |
421 |
|
422 |
writtenStatus = true;//Say a wrote has been made |
423 |
//Send buffer to VCOM
|
424 |
MCOM_sendframe(bufferC, VCOMCIndex, PORT_VCOMC_INDEX); |
425 |
VCOMCIndex = 0; //reset index buffer |
426 |
VCOMC_counter = 0; //reset counter |
427 |
} |
428 |
} |
429 |
|
430 |
|
431 |
///////////////////////////////////////
|
432 |
//When buf is ready from VCOMD
|
433 |
if(vcom_choose == PORT_VCOMD_INDEX)
|
434 |
{ |
435 |
if(VCOMD_counter > SERIAL_PORT_TIMEOUT_COUNT || VCOMDIndex >= 64) |
436 |
{ |
437 |
|
438 |
vcom_choose = getPriority(vcom_choose, vcom_priority, MAX_VCOM_PORTS); //Calculate next port to send
|
439 |
if(vcom_choose > 3) |
440 |
{ |
441 |
asm("nop"); |
442 |
asm("nop"); |
443 |
asm("nop"); |
444 |
asm("nop"); |
445 |
} |
446 |
|
447 |
writtenStatus = true; //Say a wrote has been made |
448 |
//Send buffer to VCOM
|
449 |
MCOM_sendframe(bufferD, VCOMDIndex, PORT_VCOMD_INDEX); |
450 |
VCOMDIndex = 0; //reset index buffer |
451 |
VCOMD_counter = 0; //reset counter |
452 |
} |
453 |
} |
454 |
|
455 |
///////////////////////////////////////////////////////////
|
456 |
//Priority check
|
457 |
|
458 |
//Check if buffer is empty, then put port at lowest priority !
|
459 |
|
460 |
if(VCOMAIndex == 0) //no buffer ? |
461 |
{ |
462 |
vcom_priority[PORT_VCOMA_INDEX] = 0; //no priority |
463 |
} |
464 |
|
465 |
|
466 |
if(VCOMBIndex == 0) //no buffer ? |
467 |
{ |
468 |
vcom_priority[PORT_VCOMB_INDEX] = 0; //no priority |
469 |
} |
470 |
|
471 |
|
472 |
if(VCOMCIndex == 0) //no buffer ? |
473 |
{ |
474 |
vcom_priority[PORT_VCOMC_INDEX] = 0; //no priority |
475 |
} |
476 |
|
477 |
|
478 |
if(VCOMDIndex == 0) //no buffer ? |
479 |
{ |
480 |
vcom_priority[PORT_VCOMD_INDEX] = 0; //no priority |
481 |
} |
482 |
|
483 |
|
484 |
} |
485 |
|
486 |
|
487 |
|
488 |
return 0; |
489 |
} |
490 |
|
491 |
|
492 |
|
493 |
|
494 |
///////////////////////////////////////////////////////////
|
495 |
//Functions / macros
|
496 |
|
497 |
//Send a frame from virtual port to master port
|
498 |
|
499 |
void MCOM_sendframe(uint8_t *data, uint8_t n, uint8_t port)
|
500 |
{ |
501 |
//////////////////////////
|
502 |
//Send frame
|
503 |
|
504 |
TX_WRITE(0x02); //STX |
505 |
TX_WRITE(port + CESAR_SHIFT); //Which virtual port called master port ?
|
506 |
TX_WRITE(FRAME_ADDR_1); //ADDR
|
507 |
TX_WRITE(FRAME_ADDR_2); //ADDR
|
508 |
|
509 |
for(uint8_t i = 0; i < n; i++) //DATA |
510 |
TX_WRITE(data[i]); |
511 |
|
512 |
TX_WRITE(LF_CHAR); //End of frame
|
513 |
TX_WRITE(CR_CHAR); //End of frame
|
514 |
//////////////////////////
|
515 |
} |
516 |
|
517 |
//////////////////////////////////////////////////////////////////////////////////////////
|
518 |
//Send a frame from master port to virtual port (that calculate whose port to send ?)
|
519 |
|
520 |
void VCOM_sendframe(uint8_t *data, uint8_t n)
|
521 |
{ |
522 |
uint16_t addrFunctions[] = {&txWriteA, &txWriteB, &txWriteC, &txWriteD }; //list of available functions addresses
|
523 |
void (*localTxWrite)(); //function pointer |
524 |
|
525 |
////////////////////////////////
|
526 |
//To debugger read section
|
527 |
|
528 |
|
529 |
|
530 |
for(int i = 0; i < 256; i++) |
531 |
global_debugBuffer[i] = data[i]; |
532 |
|
533 |
if(global_n == 0x02) |
534 |
{ |
535 |
asm("nop"); |
536 |
} |
537 |
if(global_debugBuffer[1] == 0x03) |
538 |
{ |
539 |
asm("nop"); |
540 |
} |
541 |
////////////////////////////////
|
542 |
|
543 |
//At first, check if first byte is the start of text
|
544 |
if(data[0] == STX) |
545 |
{ |
546 |
if(data[2] == FRAME_ADDR_1 && data[3] == FRAME_ADDR_2) //check if we have the MUX address identifier |
547 |
{ |
548 |
if(data[n-1] == CR_CHAR) //check the end of text (second byte) |
549 |
{ |
550 |
if(data[n-2] == LF_CHAR) //check the end of text (first byte) |
551 |
{ |
552 |
data[1]-=CESAR_SHIFT; //convert port index to buffer equivalent |
553 |
localTxWrite = addrFunctions[(data[1] < 3) ? data[1] : 3 ]; //data[3] |
554 |
for(int i = 4; i < n-2; i++) //send frame without (STX + FRAME_ADDR_B1 + FRAME_ADDR_B2 + LF_CHAR + CR_CHAR) |
555 |
{ |
556 |
localTxWrite(data[i]); |
557 |
} |
558 |
|
559 |
} |
560 |
} |
561 |
} |
562 |
} |
563 |
} |
564 |
|
565 |
|
566 |
|
567 |
|
568 |
//////////////////////////////////////////////////////////////////////////////////////////
|
569 |
//Get VCOM port priority to avoid filling hardware buffer and lost data...
|
570 |
|
571 |
uint8_t getPriority(uint8_t chosen_com, uint8_t *ports_list, uint8_t n) |
572 |
{ |
573 |
uint8_t i = 0; //a little bit useful for timing |
574 |
|
575 |
for(i = 0; i < n; i++) //at first increment priority |
576 |
ports_list[i]++; |
577 |
|
578 |
ports_list[chosen_com] = 0; //reset priority on this port |
579 |
|
580 |
chosen_com = 0; //load first port |
581 |
for(i = 1; i < n; i++) //calculate priority |
582 |
{ |
583 |
if(ports_list[i] > ports_list[chosen_com]) //priority level larger than actual port ? |
584 |
chosen_com = i; //then choose this port
|
585 |
} |
586 |
|
587 |
|
588 |
|
589 |
return chosen_com; //port result according to priority |
590 |
} |
591 |
|
592 |
|
593 |
|
594 |
|
595 |
void bootSequence(void) |
596 |
{ |
597 |
debugLedsTest(); |
598 |
} |
599 |
|
600 |
|
601 |
|
602 |
|
603 |
/**
|
604 |
<p><b>void debugLedsTest(void)</b></p>
|
605 |
<p><b>Debug leds test sequence</b></p>
|
606 |
*/
|
607 |
void debugLedsTest(void) |
608 |
{ |
609 |
|
610 |
PORTA.OUT = 1;
|
611 |
for(int i = 0; i < 6; i++) |
612 |
{ |
613 |
PORTA.OUT <<= 1;
|
614 |
_delay_ms(125);
|
615 |
} |
616 |
PORTA.OUT = 0;
|
617 |
} |
618 |
|
619 |
/**
|
620 |
<p><b>void senseDebugLeds(void)</b></p>
|
621 |
<p><b>Call this to update leds status</b></p>
|
622 |
*/
|
623 |
void senseDebugLeds(bool *hasWritten, bool *hasRead) |
624 |
{ |
625 |
|
626 |
|
627 |
|
628 |
///////////////////////////
|
629 |
//Check Master Port
|
630 |
if(*hasWritten)
|
631 |
{ |
632 |
PORTA.OUT |= 0x20;
|
633 |
*hasWritten = false;
|
634 |
} |
635 |
else
|
636 |
PORTA.OUT &= ~(0x20);
|
637 |
|
638 |
if(hasRead[PORT_MCOM_INDEX])
|
639 |
{ |
640 |
PORTA.OUT |= 0x10;
|
641 |
hasRead[PORT_MCOM_INDEX] = false;
|
642 |
} |
643 |
else
|
644 |
PORTA.OUT &= ~(0x10);
|
645 |
|
646 |
///////////////////////////
|
647 |
//Check VCOMA
|
648 |
if(hasRead[PORT_VCOMA_INDEX])
|
649 |
{ |
650 |
PORTA.OUT |= 0x01;
|
651 |
hasRead[PORT_VCOMA_INDEX] = false;
|
652 |
} |
653 |
else
|
654 |
PORTA.OUT &= ~(0x01);
|
655 |
|
656 |
///////////////////////////
|
657 |
//Check VCOMB
|
658 |
if(hasRead[PORT_VCOMB_INDEX])
|
659 |
{ |
660 |
PORTA.OUT |= 0x02;
|
661 |
hasRead[PORT_VCOMB_INDEX] = false;
|
662 |
} |
663 |
else
|
664 |
PORTA.OUT &= ~(0x02);
|
665 |
|
666 |
///////////////////////////
|
667 |
//Check VCOMC
|
668 |
if(hasRead[PORT_VCOMC_INDEX])
|
669 |
{ |
670 |
PORTA.OUT |= 0x04;
|
671 |
hasRead[PORT_VCOMC_INDEX] = false;
|
672 |
} |
673 |
else
|
674 |
PORTA.OUT &= ~(0x04);
|
675 |
|
676 |
|
677 |
///////////////////////////
|
678 |
//Check VCOMD
|
679 |
if(hasRead[PORT_VCOMD_INDEX])
|
680 |
{ |
681 |
PORTA.OUT |= 0x08;
|
682 |
hasRead[PORT_VCOMD_INDEX] = false;
|
683 |
} |
684 |
else
|
685 |
PORTA.OUT &= ~(0x08);
|
686 |
} |
687 |
|
688 |
|
689 |
|
690 |
|
691 |
|
692 |
|
693 |
|
694 |
|