Rev 457 | Rev 461 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
| Rev 457 | Rev 460 | ||
|---|---|---|---|
| Line 417... | Line 417... | ||
| 417 | UART2_TransmitTxData(); // FC send answer |
417 | UART2_TransmitTxData(); // FC send answer |
| 418 | CalcHeadFree(); |
418 | CalcHeadFree(); |
| 419 | // ---------------- Error Check Timing ---------------------------- |
419 | // ---------------- Error Check Timing ---------------------------- |
| 420 | if(CheckDelay(TimerCheckError) || (FC.StatusFlags & FC_STATUS_START && !(oldFcFlags & FC_STATUS_START))) // Timer or FY wants to start |
420 | if(CheckDelay(TimerCheckError) || (FC.StatusFlags & FC_STATUS_START && !(oldFcFlags & FC_STATUS_START))) // Timer or FY wants to start |
| 421 | { |
421 | { |
| - | 422 | //CreateNmeaGGA(); |
|
| 422 | if(CheckDelay(TimerCheckError)) |
423 | if(CheckDelay(TimerCheckError)) |
| 423 | { |
424 | { |
| 424 | TimerCheckError = SetDelay(1000); |
425 | TimerCheckError = SetDelay(1000); |
| 425 | if(++count5sec == 5) |
426 | if(++count5sec == 5) |
| 426 | { |
427 | { |
| Line 552... | Line 553... | ||
| 552 | Debug_OK("START"); |
553 | Debug_OK("START"); |
| 553 | UART1_PutString("\r\n"); |
554 | UART1_PutString("\r\n"); |
| 554 | fifo_purge(&UART1_rx_fifo); // flush the whole fifo init buffer |
555 | fifo_purge(&UART1_rx_fifo); // flush the whole fifo init buffer |
| 555 | LED_GRN_ON; |
556 | LED_GRN_ON; |
| 556 | LED_RED_OFF; |
557 | LED_RED_OFF; |
| - | 558 | Settings_GetParamValue(PID_SEND_NMEA, &NMEA_Interval); |
|
| - | 559 | ||
| 557 | for (;;) // the endless main loop |
560 | for (;;) // the endless main loop |
| 558 | { |
561 | { |
| 559 | Polling(); |
562 | Polling(); |
| 560 | PollingTimeout = 15; |
563 | PollingTimeout = 15; |
| 561 | // ---------------- Logging --------------------------------------- |
564 | // ---------------- Logging --------------------------------------- |