/branches/dongfang_FC_rewrite/attitude.c |
---|
450,8 → 450,8 |
int32_t correction = (error * staticParams.compassYawCorrection) >> 8; |
//debugOut.analog[30] = correction; |
debugOut.digital[0] = &= ~DEBUG_COMPASS; |
debugOut.digital[1] = &= ~DEBUG_COMPASS; |
debugOut.digital[0] &= ~DEBUG_COMPASS; |
debugOut.digital[1] &= ~DEBUG_COMPASS; |
if (correction > 0) { |
debugOut.digital[0] ^= DEBUG_COMPASS; |