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