/branches/dongfang_FC_rewrite/flight.c |
---|
135,8 → 135,6 |
else if (headingError > YAW_I_LIMIT) |
headingError = YAW_I_LIMIT; |
debugOut.analog[29] = headingError / 100; |
PDPart = (int32_t) (headingError * yawIFactor) / (GYRO_DEG_FACTOR_YAW << 4); |
// Ehhhhh here is something with desired yaw rate, not?? Ahh OK it gets added in later on. |
PDPart += (int32_t) (yawRate * yawPFactor) / (GYRO_DEG_FACTOR_YAW >> 5); |