Subversion Repositories NaviCtrl

Rev

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

Rev 175 Rev 179
Line 128... Line 128...
128
{
128
{
129
        if(CheckDelay(SPI0_Timeout))
129
        if(CheckDelay(SPI0_Timeout))
130
        {
130
        {
131
                LED_RED_ON;
131
                LED_RED_ON;
132
                sprintf(ErrorMSG,"no FC communication ");
132
                sprintf(ErrorMSG,"no FC communication ");
-
 
133
                TIMER2_Deinit(); // reduce irq load
133
                ErrorCode = 3;
134
                ErrorCode = 3;
134
                StopNavigation = 1;
135
                StopNavigation = 1;
135
        }
136
        }
136
        else if(CheckDelay(I2C1_Timeout))
137
        else if(CheckDelay(I2C1_Timeout))
137
        {
138
        {
Line 178... Line 179...
178
                ErrorCode = 7;
179
                ErrorCode = 7;
179
        }
180
        }
180
        else // no error occured
181
        else // no error occured
181
        {
182
        {
182
                sprintf(ErrorMSG,"No Error               ");
183
                sprintf(ErrorMSG,"No Error               ");
-
 
184
                if(ErrorCode == 3)
-
 
185
                {
-
 
186
                        TIMER2_Init(); // enbable servo outputs
-
 
187
                }
183
                ErrorCode = 0;
188
                ErrorCode = 0;
184
                StopNavigation = 0;
189
                StopNavigation = 0;
185
                LED_RED_OFF;
190
                LED_RED_OFF;
186
        }
191
        }
187
}
192
}