Subversion Repositories NaviCtrl

Rev

Rev 473 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 473 Rev 480
Line 155... Line 155...
155 
        else DebugOut.StatusRed &= ~AMPEL_BL; // BL-Ctrl green status
 155 
        else DebugOut.StatusRed &= ~AMPEL_BL; // BL-Ctrl green status
Line 156... Line 156...
156 
 
 156 
 
157 
        if(UART_VersionInfo.HardwareError[0] || UART_VersionInfo.HardwareError[1]) DebugOut.StatusRed |= AMPEL_NC;
 157 
        if(UART_VersionInfo.HardwareError[0] || UART_VersionInfo.HardwareError[1]) DebugOut.StatusRed |= AMPEL_NC;
Line -... Line 158...
- 
 
 158 
        else DebugOut.StatusRed &= ~AMPEL_NC;
- 
 
 159 
 
158 
        else DebugOut.StatusRed &= ~AMPEL_NC;
 160 
if(I2C_CompassPort == I2C_EXTERN_0) LED_RED_OFF_T;
159 
 
 161 
 
160 
    if((FCCalibActive || CompassCalState) && FC_Version.Hardware)
 162 
    if((FCCalibActive || CompassCalState) && FC_Version.Hardware)
161 
     {
 163 
     {
162 
                sprintf(ErrorMSG,"Calibrate... ");
 164 
                sprintf(ErrorMSG,"Calibrate... ");
Line 177... Line 179...
177 
                DebugOut.StatusRed |= AMPEL_COMPASS;
 179 
                DebugOut.StatusRed |= AMPEL_COMPASS;
178 
        }
 180 
        }
179 
        else if(CheckDelay(I2C0_Timeout) && (I2C_CompassPort == I2C_EXTERN_0))
 181 
        else if(CheckDelay(I2C0_Timeout) && (I2C_CompassPort == I2C_EXTERN_0))
180 
        {
 182 
        {
181 
                LED_RED_ON;              
 183 
                LED_RED_ON;              
- 
 
 184 
LED_RED_ON_T;
182 
                sprintf(ErrorMSG,"no ext. compass ");
 185 
                sprintf(ErrorMSG,"no ext. compass ");
183 
                //Reset I2CBus
 186 
                //Reset I2CBus
184 
                I2C0_Deinit();
 187 
                I2C0_Deinit();
185 
                I2C0_Init();
 188 
                I2C0_Init();
- 
 
 189 
                NCMAG_Update(1);
186 
                newErrorCode = 4;
 190 
                newErrorCode = 33;
187 
                StopNavigation = 1;
 191 
                StopNavigation = 1;
188 
                UART_VersionInfo.HardwareError[0] |= NC_ERROR0_COMPASS_RX;
 192 
                UART_VersionInfo.HardwareError[0] |= NC_ERROR0_COMPASS_RX;
189 
                DebugOut.StatusRed |= AMPEL_COMPASS;
 193 
                DebugOut.StatusRed |= AMPEL_COMPASS;
190 
        }
 194 
        }
191 
        else
 195 
        else