将输出值融合到四个电机,其中Thr为遥控量。
Motor[0] = (int16_t)(Thr + Pitch + Roll - Yaw ); //M1
Motor[1] = (int16_t)(Thr + Pitch - Roll + Yaw ); //M2
Motor[2] = (int16_t)(Thr - Pitch - Roll - Yaw ); //M3
Motor[3] = (int16_t)(Thr - Pitch + Roll + Yaw ); //M4
算式中的加减法是怎么来的,为什么这么算有什么道理没???
友情提示: 此问题已得到解决,问题已经关闭,关闭后问题禁止继续编辑,回答。
一周热门 更多>