ID_ROL.OUT + 
ID_PIT.OUT - 
ID_YAW.OUT;
ID_ROL.OUT + 
ID_PIT.OUT + 
ID_YAW.OUT;
ID_ROL.OUT - 
ID_PIT.OUT - 
ID_YAW.OUT;
ID_ROL.OUT - PID_PIT.OUT + PID_YAW.OUT;
ID_PIT.P = tmp_buf_RX[1];
ID_PIT.I = tmp_buf_RX[2]
ID_PIT.D = tmp_buf_RX[3];
ID_ROL.D * (error_rol_temp[0]-error_rol_temp[1])/0.0007/3000;
ID_PIT.D * (error_pit_temp[0]-error_pit_temp[1])/0.0007/3000;
ID_YAW.D * (error_yaw_temp[0]-error_yaw_temp[1])/0.0007/3000;
ID_ROL.OUT + 
ID_PIT.OUT - 
ID_YAW.OUT;
ID_ROL.OUT + 
ID_PIT.OUT + 
ID_YAW.OUT;
ID_ROL.OUT - 
ID_PIT.OUT - 
ID_YAW.OUT;
ID_ROL.OUT - PID_PIT.OUT + PID_YAW.OUT;
| 欢迎光临 OpenEdv-开源电子网 (https://www.openedv.com/) | Powered by Discuz! X3.4 |