Subversion Repositories NaviCtrl

Rev

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