/branches/dongfang_FC_rewrite/attitudeControl.c |
---|
15,7 → 15,7 |
// With static MINPROJECTION: 220 usec. |
uint16_t AC_getThrottle(uint16_t throttle) { |
int32_t projection; |
uint8_t effect = dynamicParams.UserParams[2]; // Userparam 3 |
uint8_t effect = dynamicParams.attitudeControl; // Userparam 3 |
int16_t deltaThrottle, y; |
projection = (int32_t) int_cos(angle[PITCH]) * (int32_t) int_cos(angle[ROLL]); |