没有用过陀螺仪, 不知道其性能如何, 下面仅供参考:
1. 你PWM的条件条件是什么(一般是占空比), PID的输出直接和改变量关联自然就能控制PWM, 但是占空比代表什么, 取决于你的电机的控制方法是什么.
1.2. 电机的速度可以通过陀螺仪的变化计算得到, 例如 控制x轴的电机, x轴转动的角度的变化量就是陀螺仪x轴分量上的dθ/dt就是转动速度. 但是这也取决于你的陀螺仪的安装点与电机轴的机械结构上的相对关系.
这样电机的转速就可以得到了, 此转速可以作为PID的反馈输入. --- 但是我不知道陀螺仪的检测会不会有很大滞后, 是否适于做为速度反馈, 这个要你自己计算评估.
2. 手的干扰可以认为电机负载发生变化, 可以通过电路检测电机的电流得到, 当你检测到电机的负载变大时, 就加大输出, 负载减少时, 就减少输出, 这样手一松开, 就会立即相应减少输出, 也就不会突然冲过头了.
我对陀螺仪也不是很了解, 希望以上对你有方向上的帮助. |