| /trunk/timer0.c |
|---|
| 306,7 → 306,8 |
| } |
| else |
| { |
| roll = (cosinus * IntegralRoll) / 128L + (sinus * IntegralNick) / 128L; |
| if(EE_Parameter.GlobalConfig3 & CFG3_SERVO_NICK_COMP_OFF) roll = 0; |
| else roll = (cosinus * IntegralRoll) / 128L + (sinus * IntegralNick) / 128L; |
| roll = ((long)Parameter_ServoRollComp * roll) / 512L; |
| ServoRollOffset += ((int16_t)Parameter_ServoRollControl * (MULTIPLYER*16) - ServoRollOffset) / EE_Parameter.ServoManualControlSpeed; |
| if(EE_Parameter.ServoCompInvert & SERVO_ROLL_INV) |