Rev 2426 | Rev 2437 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 2426 | Rev 2427 | ||
---|---|---|---|
Line 200... | Line 200... | ||
200 | if(PlatinenVersion < 20) |
200 | if(PlatinenVersion < 20) |
201 | { |
201 | { |
202 | wdt_enable(WDTO_250MS); // Reset-Commando |
202 | wdt_enable(WDTO_250MS); // Reset-Commando |
203 | while(1) printf("\n\rFlightControl not supported!"); |
203 | while(1) printf("\n\rFlightControl not supported!"); |
204 | } |
204 | } |
- | 205 | #ifndef REDUNDANT_FC_SLAVE |
|
205 | // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
206 | // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
206 | // + Check connected BL-Ctrls |
207 | // + Check connected BL-Ctrls |
207 | // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
208 | // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
208 | // Check connected BL-Ctrls |
209 | // Check connected BL-Ctrls |
209 | BLFlags |= BLFLAG_READ_VERSION; |
210 | BLFlags |= BLFLAG_READ_VERSION; |
Line 242... | Line 243... | ||
242 | ServoActive = 2; // just in case the FC would be used as camera-stabilizer |
243 | ServoActive = 2; // just in case the FC would be used as camera-stabilizer |
243 | } |
244 | } |
244 | Motor[i].State &= ~MOTOR_STATE_ERROR_MASK; // clear error counter |
245 | Motor[i].State &= ~MOTOR_STATE_ERROR_MASK; // clear error counter |
245 | } |
246 | } |
246 | PrintLine();// ("\n\r==================================="); |
247 | PrintLine();// ("\n\r==================================="); |
247 | - | ||
248 | - | ||
249 | if(RequiredMotors < FoundMotors) VersionInfo.HardwareError[1] |= FC_ERROR1_MIXER; |
248 | if(RequiredMotors < FoundMotors) VersionInfo.HardwareError[1] |= FC_ERROR1_MIXER; |
250 | if(RequiredMotors > 8) Max_I2C_Packets = 8; else Max_I2C_Packets = RequiredMotors; |
249 | if(RequiredMotors > 8) Max_I2C_Packets = 8; else Max_I2C_Packets = RequiredMotors; |
- | 250 | // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
|
- | 251 | // Calibrating altitude sensor |
|
- | 252 | // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
|
- | 253 | #endif |
|
251 | //if(EE_Parameter.GlobalConfig & CFG_HOEHENREGELUNG) |
254 | //if(EE_Parameter.GlobalConfig & CFG_HOEHENREGELUNG) |
252 | { |
255 | { |
253 | printf("\n\rCalibrating pressure sensor.."); |
256 | printf("\n\rCalibrating pressure sensor.."); |
254 | timer = SetDelay(1000); |
257 | timer = SetDelay(1000); |
255 | SucheLuftruckOffset(); |
258 | SucheLuftruckOffset(); |
256 | while (!CheckDelay(timer)); |
259 | while (!CheckDelay(timer)); |
257 | printf("OK\n\r"); |
260 | printf("OK\n\r"); |
258 | } |
261 | } |
Line 259... | Line 262... | ||
259 | 262 | ||
260 | #ifdef REDUNDANT_FC |
263 | #ifdef REDUNDANT_FC_SLAVE |
261 | VersionInfo.HardwareError[0] = 0; |
264 | VersionInfo.HardwareError[0] = 0; |
262 | VersionInfo.HardwareError[1] = 0; |
265 | VersionInfo.HardwareError[1] = 0; |
Line 263... | Line 266... | ||
263 | #endif |
266 | #endif |