223,6 → 223,7 |
#endif |
|
|
|
// set up Atmega162 Ports |
DDRA |= (1 << PA1); // PA1 output (/CS) |
MAX_CS_HIGH |
295,9 → 296,6 |
// init usart |
usart1_init(); |
|
// keep serial port clean |
usart1_DisableTXD(); |
|
// set up timer |
// CTC, Prescaler /64 |
TCCR0 = (1 << WGM01) | (0 << WGM00) | (0 << CS02) | (1 << CS01) | (1 << CS00); |
340,6 → 338,17 |
//usart1_puts("\x1B[2J\x1B[H"); |
//usart1_puts("hello world!123\r\n"); |
|
#if FCONLY |
// request data ever 100ms from FC; |
usart1_request_mk_data(0, 'd', 100); |
#else |
// request OSD Data from NC every 100ms |
usart1_request_mk_data(1, 'o', 100); |
|
// and disable debug... |
usart1_request_mk_data(0, 'd', 0); |
#endif |
|
while (1) { |
// in case SPI is ready and there is nothing to send right now |
if (!icnt && spi_ready) { |
379,7 → 388,6 |
} else { |
osd_fcmode(); |
} |
seconds_since_last_data = 0; |
} |
#else |
if (rxd_buffer[2] == 'O') { // NC OSD Data |
397,7 → 405,6 |
} else { |
osd_ncmode(); |
} |
//seconds_since_last_data = 0; |
} |
#endif |
rxd_buffer_locked = 0; |
406,24 → 413,20 |
if (s1_pressed()) { |
config_menu(); |
} |
if (seconds_since_last_data > 0) { |
usart1_EnableTXD(); |
//usart1_puts_pgm(PSTR("zu alt\r\n")); |
if (seconds_since_last_data > 2) { |
#if FCONLY |
// request data ever 100ms from FC; |
//usart1_request_mk_data(0, 'd', 100); |
usart1_puts_pgm(PSTR(REQUEST_DBG_DATA)); |
usart1_request_mk_data(0, 'd', 100); |
#else |
// request OSD Data from NC every 100ms |
//usart1_request_mk_data(1, 'o', 100); |
usart1_puts_pgm(PSTR(REQUEST_OSD_DATA)); |
usart1_request_mk_data(1, 'o', 100); |
|
// and disable debug... |
//usart1_request_mk_data(0, 'd', 0); |
#endif |
usart1_request_mk_data(0, 'd', 0); |
|
// reset last time counter |
seconds_since_last_data = 0; |
usart1_DisableTXD(); |
#endif |
} |
} |
#endif |