Rev 739 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 739 | Rev 746 | ||
---|---|---|---|
Line 675... | Line 675... | ||
675 | UART1_PutString("\r\n++++++++++++++++++++++++++++++++++++++++++"); |
675 | UART1_PutString("\r\n++++++++++++++++++++++++++++++++++++++++++"); |
676 | UART1_PutString("\n\r FOLLOW-ME Transmitter only!"); |
676 | UART1_PutString("\n\r FOLLOW-ME Transmitter only!"); |
677 | UART1_PutString("\r\n++++++++++++++++++++++++++++++++++++++++++\r\n\r\n"); |
677 | UART1_PutString("\r\n++++++++++++++++++++++++++++++++++++++++++\r\n\r\n"); |
678 | TransmitAlsoToFC = 0; |
678 | TransmitAlsoToFC = 0; |
679 | #else |
679 | #else |
680 | if(UBX_Setup() == 0) UBX_Setup(); // inits the GPS-Module via ubx -> try twice |
680 | // if(UBX_Setup() == 0) UBX_Setup(); // inits the GPS-Module via ubx -> try twice |
681 | - | ||
682 | SPI0_GetFlightCtrlVersion(); |
681 | SPI0_GetFlightCtrlVersion(); |
- | 682 | if(IamMaster == SLAVE) UART1_PutString(" SLAVE\r\n"); |
|
- | 683 | if(IamMaster == MASTER) UART1_PutString(" MASTER\r\n"); |
|
683 | if(FC_Version.Compatible != FC_SPI_COMPATIBLE) |
684 | if(FC_Version.Compatible != FC_SPI_COMPATIBLE) |
684 | { |
685 | { |
685 | UART1_PutString("\n\r Flight-Ctrl not compatible\n\r"); |
686 | UART1_PutString("\n\r Flight-Ctrl not compatible\n\r"); |
686 | LED_RED_ON; |
687 | LED_RED_ON; |
687 | } |
688 | } |
688 | #endif |
689 | #endif |
689 | if(IamMaster == SLAVE) UART1_PutString(" SLAVE\r\n"); |
690 | if(UBX_Setup() == 0) UBX_Setup(); // inits the GPS-Module via ubx -> try twice |
690 | if(IamMaster == MASTER) UART1_PutString(" MASTER\r\n"); |
- | |
691 | - | ||
692 | // +++++++++++++++++++++++++++++++++++++++ |
691 | // +++++++++++++++++++++++++++++++++++++++ |
693 | // ++ check CamCtrl version (if connected) |
692 | // ++ check CamCtrl version (if connected) |
694 | if(Compass_I2CPort == NCMAG_PORT_INTERN) |
693 | if(Compass_I2CPort == NCMAG_PORT_INTERN) |
695 | { |
694 | { |
696 | if(I2CBus_LockBuffer(I2C0,3)) I2CBus_Transmission(I2C0, CAM_SLAVE_ADDRESS, &ToCamCtrl, 4, &CamCtrl_UpdateData, sizeof(FromCamCtrl)); |
695 | if(I2CBus_LockBuffer(I2C0,3)) I2CBus_Transmission(I2C0, CAM_SLAVE_ADDRESS, &ToCamCtrl, 4, &CamCtrl_UpdateData, sizeof(FromCamCtrl)); |