四轴的PID数据和电机的PWM是怎么融合的

2019-08-14 01:18发布

将输出值融合到四个电机,其中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 
算式中的加减法是怎么来的,为什么这么算有什么道理没???




友情提示: 此问题已得到解决,问题已经关闭,关闭后问题禁止继续编辑,回答。