Rev 397 | Rev 400 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
| Rev 397 | Rev 398 | ||
|---|---|---|---|
| Line 356... | Line 356... | ||
| 356 | LED_RED_ON; |
356 | LED_RED_ON; |
| 357 | sprintf(ErrorMSG,"ERR:Max Altitude "); |
357 | sprintf(ErrorMSG,"ERR:Max Altitude "); |
| 358 | newErrorCode = 29; |
358 | newErrorCode = 29; |
| 359 | DebugOut.StatusRed |= AMPEL_NC; |
359 | DebugOut.StatusRed |= AMPEL_NC; |
| 360 | } |
360 | } |
| - | 361 | else if(Parameter.GlobalConfig3 & CFG3_NO_GPSFIX_NO_START && !(NCFlags & NC_FLAG_GPS_OK) && (FC.StatusFlags & (FC_STATUS_START | FC_STATUS_MOTOR_RUN))) |
|
| - | 362 | { |
|
| - | 363 | LED_RED_ON; |
|
| - | 364 | sprintf(ErrorMSG,"No GPS Fix "); |
|
| - | 365 | newErrorCode = 30; |
|
| - | 366 | } |
|
| 361 | else // no error occured |
367 | else // no error occured |
| 362 | { |
368 | { |
| 363 | StopNavigation = 0; |
369 | StopNavigation = 0; |
| 364 | LED_RED_OFF; |
370 | LED_RED_OFF; |
| 365 | if(no_error_delay) { no_error_delay--; } |
371 | if(no_error_delay) { no_error_delay--; } |
| Line 385... | Line 391... | ||
| 385 | 391 | ||
| 386 | 392 | ||
| 387 | 393 | ||
| 388 | void Polling(void) |
394 | void Polling(void) |
| 389 | { |
395 | { |
| 390 | static u8 running = 0; |
396 | static u8 running = 0, oldFcFlags = 0; |
| 391 | if(running) return; |
397 | if(running) return; |
| 392 | running = 1; |
398 | running = 1; |
| 393 | SPI0_UpdateBuffer(); // also calls the GPS-functions |
399 | SPI0_UpdateBuffer(); // also calls the GPS-functions |
| 394 | UART0_ProcessRxData(); // GPS process request |
400 | UART0_ProcessRxData(); // GPS process request |
| 395 | UART0_TransmitTxData(); // GPS send answer |
401 | UART0_TransmitTxData(); // GPS send answer |
| 396 | UART1_ProcessRxData(); // PC process request |
402 | UART1_ProcessRxData(); // PC process request |
| 397 | UART1_TransmitTxData(); // PC send answer |
403 | UART1_TransmitTxData(); // PC send answer |
| 398 | UART2_TransmitTxData(); // FC send answer |
404 | UART2_TransmitTxData(); // FC send answer |
| 399 | CalcHeadFree(); |
405 | CalcHeadFree(); |
| 400 | // ---------------- Error Check Timing ---------------------------- |
406 | // ---------------- Error Check Timing ---------------------------- |
| - | 407 | if(CheckDelay(TimerCheckError) || (FC.StatusFlags & FC_STATUS_START && !(oldFcFlags & FC_STATUS_START))) // Timer or FY wants to start |
|
| 401 | if(CheckDelay(TimerCheckError)) |
408 | { |
| Line 402... | Line 409... | ||
| 402 | { |
409 | TimerCheckError = SetDelay(1000); |
| Line 403... | Line 410... | ||
| 403 | TimerCheckError = SetDelay(1000); |
410 | oldFcFlags = FC.StatusFlags; |