ENC03的使用

陀螺仪ENC03使用心得

上次做小平衡车的时候用了个陀螺仪（ENC03），我把测角度串口调试视屏放网上分享了，几天前有朋友看过想要那个算法，我就把自己的心得分享下吧！

首先看datasheet，ENC03是个角速度传感器，out管脚输出的电压大小是和它的旋转速度成正比的，知道了速度求路程那就好办了。

设角度为D，平均角速度为V，时间为T。现在如果V和T是已知的要求D，想必读过初中物理的人都会吧？不会也没关系，我写出来给力看，呵呵：

D=V*T

T是可以自己设定的，通过单片机或其他芯片的定时器即可设定，T要尽量设定小点，如果太大的话下不求平均速度的误差会很大，我设定为100微妙，还可以再小。

那么V怎么办呢？看ENC03的datasheet可知out管脚的静态电压（就是角速度为0时候电压）为1.35v，角速度每增加1°/s电压增加或减小（有正向速度和反向速度）0.67mv，如图1所示。

图1

现在知道out管脚的电压就能算出当时的速度了。设out管脚电压为U，当时速度为V，那么

V?（U?1.35）（/0.67*10-3）

但是实际应用中角速度可能是随时变化的，没有一个定值，我们可以算它的平均速度，

假设求时间点A和B之间陀螺仪转过的角度大小，首先要知道A和B之间陀螺仪的平均速度V，要求解V我们可以测出A时间点的速度VA和B时间点速度VB，那么：

V?（VA?VB）/2

当A和B之间时间很短时V就可以很准确。 由上面3个公式可得出：

D?V*T?VA?VBU?UB?2.7*T?A*T ?322*0.67*10上面公式中的U是out管脚上的电压，因为它太小，实际应用电路不会直接用AD转换

器测量out管脚上的电压，一般会根据实际需要加个一定放大倍数的放大器，AD转换出来的是放大器输出的电压U?，这样要先由U?求出U才能用上面的公式计算。

假如使用如下电路：

所以放大器输出Out2的静态电压要经过测量确定。Vref管脚的电压范围一般是1.25到1.35，

设放大器放大倍数为?，放大器输出管脚Out2静态电压为V0，放大器输出管脚电压为U?，可得：

U?A?U?B?2U0VA?VBD?V*T?*T?*T

22?*0.67*10?3当然实际应用时还要注意温漂等因数对放大器的静态电压和放大倍数的影响等等，我是

在开机初始化程序中加入重测放大器静态电压解决静态点漂移的。

本文来源：https://www.bwwdw.com/article/y6wo.html