/branches/dongfang_FC_rewrite/flight.c |
---|
256,6 → 256,13 |
debugOut.analog[3] = rate_ATT[PITCH]; |
debugOut.analog[4] = rate_ATT[ROLL]; |
debugOut.analog[5] = yawRate; |
debugOut.analog[6] = getAngleEstimateFromAcc(PITCH) / (int32_t)GYRO_DEG_FACTOR_PITCHROLL; |
debugOut.analog[7] = getAngleEstimateFromAcc(ROLL) / (int32_t)GYRO_DEG_FACTOR_PITCHROLL; |
debugOut.analog[8] = acc[Z]; |
debugOut.analog[9] = controls[CONTROL_PITCH]; |
debugOut.analog[10] = controls[CONTROL_ROLL]; |
} |
/* |