Step 4: Stabilize the Yaw Angular Velocity
P Gain Adjustment
Parameter: MC_YAWRATE_P
Set MC_YAWRATE_P to a relatively small value, for example, 0.1.
Firmly hold the multirotor by hand and push the throttle to approximately 50% so that the weight of the aircraft is almost zero. Rotate the aircraft in the yaw direction by hand and observe its response. The sound of the motors should change, and the aircraft should resist this yaw rotation. The response of the aircraft will generally be weaker than that of the roll and pitch movements, which is normal. If the aircraft oscillates or trembles, the RATE_P needs to be turned down. If the response of the aircraft is very intense even for very small movements (full throttle vs idling propellers), continue to reduce RATE_P. Typical values are approximately between 0.2 and 0.3.
If the yaw angular velocity control is very sensitive or oscillates, it may worsen the roll and pitch responses. The overall response of the system can be checked through steering, rolling, pitching, and yawing.
Step 5: Stabilize the Yaw Angle
P Gain Adjustment
Parameter: MC_YAW_P
Set MC_YAW_P to a relatively low value, for example, 1.
Feedforward Adjustment
Parameter: MC_YAW_FF