/branches/dongfang_FC_rewrite/heightControl.c |
---|
181,10 → 181,6 |
debugOut.analog[12] = dThrottleD; |
debugOut.analog[13] = heightError/10; |
//debugOut.analog[27] = dynamicParams.heightP; |
//debugOut.analog[28] = dynamicParams.heightI; |
//debugOut.analog[29] = dynamicParams.heightD; |
int16_t dThrottle = dThrottleI + dThrottleP - dThrottleD; |
if (dThrottle > staticParams.heightControlMaxThrottleChange) |