411,6 → 411,14 |
// Each (pitch, roll, throttle, yaw) term is in the range [0..255 * CONTROL_SCALING]. |
// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
|
debugOut.analog[3] = rate_ATT[PITCH]; |
debugOut.analog[4] = rate_ATT[ROLL]; |
debugOut.analog[5] = yawRate; |
|
debugOut.analog[6] = filteredAcc[PITCH]; |
debugOut.analog[7] = filteredAcc[ROLL]; |
debugOut.analog[8] = filteredAcc[Z]; |
|
debugOut.analog[12] = term[PITCH]; |
debugOut.analog[13] = term[ROLL]; |
debugOut.analog[14] = yawTerm; |