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 |