Rev 150 | Rev 160 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 150 | Rev 154 | ||
---|---|---|---|
Line 428... | Line 428... | ||
428 | } |
428 | } |
Line 429... | Line 429... | ||
429 | 429 | ||
430 | //------------------------------------------------------ |
430 | //------------------------------------------------------ |
431 | void SPI0_GetFlightCtrlVersion(void) |
431 | void SPI0_GetFlightCtrlVersion(void) |
432 | { |
432 | { |
- | 433 | u32 timeout; |
|
433 | u16 timeout; |
434 | u8 repeat; |
Line -... | Line 435... | ||
- | 435 | u8 msg[64]; |
|
434 | u8 msg[64]; |
436 | |
435 | 437 | UART1_PutString("\r\n Getting Version from FC"); |
|
436 | FC_Version.Major = 0xFF; |
438 | FC_Version.Major = 0xFF; |
437 | FC_Version.Minor = 0xFF; |
439 | FC_Version.Minor = 0xFF; |
Line 438... | Line 440... | ||
438 | FC_Version.Patch = 0xFF; |
440 | FC_Version.Patch = 0xFF; |
439 | FC_Version.Compatible = 0xFF; |
441 | FC_Version.Compatible = 0xFF; |
440 | 442 | ||
441 | // polling FC version info for 3 second |
443 | // polling FC versioni info |
- | 444 | repeat = 0; |
|
- | 445 | do |
|
- | 446 | { |
|
442 | timeout = SetDelay(3000); |
447 | timeout = SetDelay(250); |
443 | do |
448 | do |
444 | { |
449 | { |
- | 450 | SPI0_UpdateBuffer(); |
|
- | 451 | if (FC_Version.Major != 0xFF) break; |
|
- | 452 | }while (!CheckDelay(timeout)); |
|
445 | SPI0_UpdateBuffer(); |
453 | UART1_PutString("."); |
446 | if (FC_Version.Major != 0xFF) break; |
454 | repeat++; |
447 | }while (!CheckDelay(timeout)); |
455 | }while((FC_Version.Major == 0xFF) && (repeat < 12)); // 12*250ms = 3s |
448 | // if we got it |
456 | // if we got it |
449 | if (FC_Version.Major != 0xFF) |
457 | if (FC_Version.Major != 0xFF) |