Rev 1478 | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
| Rev 1478 | Rev 1568 | ||
|---|---|---|---|
| Line 266... | Line 266... | ||
| 266 | Poti1 = PPM_in[EE_Parameter.Kanalbelegung[K_POTI1]] + 110; |
266 | Poti1 = PPM_in[EE_Parameter.Kanalbelegung[K_POTI1]] + 110; |
| 267 | Poti2 = PPM_in[EE_Parameter.Kanalbelegung[K_POTI2]] + 110; |
267 | Poti2 = PPM_in[EE_Parameter.Kanalbelegung[K_POTI2]] + 110; |
| 268 | Poti3 = PPM_in[EE_Parameter.Kanalbelegung[K_POTI3]] + 110; |
268 | Poti3 = PPM_in[EE_Parameter.Kanalbelegung[K_POTI3]] + 110; |
| 269 | Poti4 = PPM_in[EE_Parameter.Kanalbelegung[K_POTI4]] + 110; |
269 | Poti4 = PPM_in[EE_Parameter.Kanalbelegung[K_POTI4]] + 110; |
| 270 | SenderOkay = 100; |
270 | SenderOkay = 100; |
| 271 | if(ServoActive) |
- | |
| 272 | { |
271 | { |
| 273 | HEF4017R_ON; |
272 | HEF4017R_ON; |
| 274 | DDRD |=0x80; // enable J7 -> Servo signal |
273 | DDRD |=0x80; // enable J7 -> Servo signal |
| 275 | } |
274 | } |
| 276 | } |
275 | } |
| Line 485... | Line 484... | ||
| 485 | /* DebugOut.Analog[12] = Motor[0]; |
484 | /* DebugOut.Analog[12] = Motor[0]; |
| 486 | DebugOut.Analog[13] = Motor[1]; |
485 | DebugOut.Analog[13] = Motor[1]; |
| 487 | DebugOut.Analog[14] = Motor[3]; |
486 | DebugOut.Analog[14] = Motor[3]; |
| 488 | DebugOut.Analog[15] = Motor[2];*/ |
487 | DebugOut.Analog[15] = Motor[2];*/ |
| Line -... | Line 488... | ||
| - | 488 | ||
| 489 | 489 | #if USE_SERVOBOARD |
|
| 490 | //Start I2C Interrupt Mode |
490 | //Start I2C Interrupt Mode |
| 491 | twi_state = 0; |
491 | twi_state = 0; |
| 492 | motor = 0; |
492 | motor = 0; |
| - | 493 | i2c_start(); |
|
| 493 | i2c_start(); |
494 | #endif |
| Line 494... | Line 495... | ||
| 494 | } |
495 | } |
| Line 650... | Line 651... | ||
| 650 | ReadParameterSet(GetActiveParamSetNumber(), (unsigned char *) &EE_Parameter.Kanalbelegung[0], STRUCT_PARAM_LAENGE); |
651 | ReadParameterSet(GetActiveParamSetNumber(), (unsigned char *) &EE_Parameter.Kanalbelegung[0], STRUCT_PARAM_LAENGE); |
| 651 | if((EE_Parameter.GlobalConfig & CFG_HOEHENREGELUNG)) // Höhenregelung aktiviert? |
652 | if((EE_Parameter.GlobalConfig & CFG_HOEHENREGELUNG)) // Höhenregelung aktiviert? |
| 652 | { |
653 | { |
| 653 | if((MessLuftdruck > 950) || (MessLuftdruck < 750)) SucheLuftruckOffset(); |
654 | if((MessLuftdruck > 950) || (MessLuftdruck < 750)) SucheLuftruckOffset(); |
| 654 | } |
655 | } |
| 655 | ServoActive = 0; |
- | |
| 656 | SetNeutral(); |
656 | SetNeutral(); |
| 657 | ServoActive = 1; |
- | |
| 658 | DDRD |=0x80; // enable J7 -> Servo signal |
657 | DDRD |=0x80; // enable J7 -> Servo signal |
| 659 | Piep(GetActiveParamSetNumber(),120); |
658 | Piep(GetActiveParamSetNumber(),120); |
| 660 | } |
659 | } |
| 661 | } |
660 | } |
| 662 | } |
661 | } |