Rev 2616 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
| Rev 2616 | Rev 2627 | ||
|---|---|---|---|
| Line 438... | Line 438... | ||
| 438 | SenderOkay = 100; |
438 | SenderOkay = 100; |
| Line 439... | Line 439... | ||
| 439 | 439 | ||
| 440 | if(ServoActive) DDRD |=0x80; // enable J7 -> Servo signal |
440 | if(ServoActive) DDRD |=0x80; // enable J7 -> Servo signal |
| 441 | else |
441 | else |
| 442 | { |
- | |
| 443 | if((EE_Parameter.ServoCompInvert & SERVO_NICK_INV) && (EE_Parameter.ServoCompInvert & SERVO_RELATIVE)) NickServoValue = 12000;//((128 + 60) * 4 * 16); // neutral position = upper 1/4// else |
- | |
| 444 | else NickServoValue = ((128 - 60) * 4 * 16); // neutral position = lower 1/4 |
442 | { |
| - | 443 | CalculateServoSignals = 1; |
|
| 445 | CalculateServoSignals = 1; |
444 | CalcNickServoValue(); |
| 446 | CalculateServo(); // nick |
445 | CalculateServo(1); // nick |
| 447 | CalculateServo(); // roll |
446 | CalculateServo(1); // roll |
| Line 448... | Line 447... | ||
| 448 | } |
447 | } |
| 449 | 448 | ||
| 450 | #if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__)) |
449 | #if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__)) |