[fix] Yaw command was overwritten by trim.