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; |