请问,代码中的 static const float Q_angle=0.001, Q_gyro=0.004, R_angle=0.5,dt=0.01;
这些Q_angle,Q_gyro,R_angle,是什么意思啊?这些值是如何得来的?
还有这里:
float K_angle=4.0;
float K_angle_dot=0.2; //换算系数:256/10 =25.6;
float K_position=0.1; //换算系数:(256/10) * (2*pi/(64*12))=0.20944;//256/10:电压换算至PWM,256对应10V;
float K_position_dot=5;
//float K_position=0.8 * 0.209; //换算系数:(256/10) * (2*pi/(64*12))=0.20944;//256/10:电压换算至PWM,256对应10V;
//float K_angle=34 * 25.6; //换算系数:256/10 =25.6;
//float K_position_dot=1.09 * 20.9; //换算系数:(256/10) * (25*2*pi/(64*12))=20.944;
//float K_angle_dot=2 * 25.6; //换算系数:256/10 =25.6;
这两块又是什么意思啊?是不是一个是用编码器,另一个按PWM值来算的啊?
谢谢,哪位大哥会的话,友情提醒一下吧! |