Rev 1452 | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
| Rev 1452 | Rev 1465 | ||
|---|---|---|---|
| Line 230... | Line 230... | ||
| 230 | Mixer.Motor[3][0] = 64; Mixer.Motor[3][1] = 0; Mixer.Motor[3][2] = +64; Mixer.Motor[3][3] = -64; |
230 | Mixer.Motor[3][0] = 64; Mixer.Motor[3][1] = 0; Mixer.Motor[3][2] = +64; Mixer.Motor[3][3] = -64; |
| 231 | Mixer.Revision = MIXER_REVISION; |
231 | Mixer.Revision = MIXER_REVISION; |
| 232 | memcpy(Mixer.Name, "Quadro\0", 11); |
232 | memcpy(Mixer.Name, "Quadro\0", 11); |
| 233 | eeprom_write_block(&Mixer, &EEPromArray[EEPROM_ADR_MIXER_TABLE], sizeof(Mixer)); |
233 | eeprom_write_block(&Mixer, &EEPromArray[EEPROM_ADR_MIXER_TABLE], sizeof(Mixer)); |
| 234 | } |
234 | } |
| - | 235 | ||
| - | 236 | for(int ii=0;ii<12;ii++) { |
|
| 235 | printf("\n\rMixer-Config: '%s' (%u Motors)",Mixer.Name,RequiredMotors); |
237 | printf("%d %d\n",ii,Mixer.Motor[1][ii]); |
| - | 238 | } |
|
| Line 236... | Line 239... | ||
| 236 | 239 | ||
| 237 | // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
240 | // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| 238 | // + Check Settings |
241 | // + Check Settings |
| 239 | // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
242 | // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| Line 340... | Line 343... | ||
| 340 | { |
343 | { |
| 341 | GPS_Nick = 0; |
344 | GPS_Nick = 0; |
| 342 | GPS_Roll = 0; |
345 | GPS_Roll = 0; |
| 343 | } |
346 | } |
| 344 | } |
347 | } |
| 345 | if(!--I2CTimeout) |
348 | if(!--I2CTimeout || MissingMotor) |
| 346 | { |
349 | { |
| 347 | if(!I2CTimeout) |
350 | if(!I2CTimeout) |
| 348 | { |
351 | { |
| 349 | i2c_reset(); |
352 | i2c_reset(); |
| 350 | I2CTimeout = 5; |
353 | I2CTimeout = 5; |