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