光电编码器是通过光电转换将输出轴上的机械几何位移量转换成一串脉冲或数字量的传感器。在电机伺服控制系统中,它与电机同轴连接,常用来测量电机转子的速度和位置[1]。近年来,随着研究室小批量军工生产的开展,需要批量采购部分绝对值编码器等外协器件。为方便检验采购的编码器,保障生产任务的按时完成,设计了一个单圈绝对值编码器实时读出电路板,其结构如图1所示。基于此电路板,开发出了一个程序,它能够实现将绝对值编码器的数据读入FPGA,并将数据转换为角度值,最终驱动液晶显示屏实时输出角度值。这使得不需要将编码器数据输入到计算机就可以处理转化为角度值,使用更加方便。程序中用到了线性变换思想,可以应用到其他程序中。电路板中用到的绝对值编码器是BEI-IDEACOD公司的CHO5系列。液晶显示屏为3.3 V供电的1602型LCD,FPGA采用的是Xilinx的Spartan-6系列。
1 数据读入及去抖动
本文所采用的绝对值编码器是BEI-IDEACOD公司的CHO5系列,它采用并行输出模式,有13 bit数据(Data[0]~Data[12]),读出速度快。由于电动机的旋转或机械设备的震动,会使编码器输出脉冲抖动[2],因此首先对编码器脉冲进行了去抖动处理。下面的程序实现了数据读入,并在去抖动后被锁存在Gray_data中。
always@(posedge clk_50M)
begin
D0《={D0[1:0],Data[0]};
D1《={D1[1:0],Data[1]};
。。.。。.
D11《={D11[1:0],Data[11]};
D12《={D12[1:0],Data[12]};
end
always@(posedge clk_50M)
begin
Gray_data[0]《=D0[2]&D[1]&D[0];
Gray_data[1]《=D1[2]&D[1]&D[0];
。。.。。.
Gray_data[11]《=D11[2]&D[1]&D[0];
Gray_data[12]《=D12[2]&D[1]&D[0];
end
2 二进制格雷码转普通格雷码上面得到数据Gray_data还是格雷码,因为绝对值编码器(并行输出)采用的是格雷码二进制输出。格雷码的特点是任意两个相邻位其输出格雷码值只有一位不同[3],这提高了数据输出的稳定性。假设二进制格雷码为Gn-1 Gn-2…G2G1G0,其所对应的普通二进制为Bn-1Bn-2…B2B1B0。那么它们最高位之间的对应关系如式(1)所示,其他各位的对应关系如式(2)所示。
Bn-1=Gn-1(1)
Bi-1=Gi-1^Bi, i=1,2,…,n-1(2)
根据式(1)和式(2),格雷码二进制转化为普通二进制的Verilog HDL代码如下:
always@(posedge Clk_50M)
begin
Binary_data[12]=Gray_data[12];
Binary_data[11]=Binary_data[12]^Gray_data[11];
Binary_data[10]=Binary_data[11]^Gray_data[10];
。。.。。.
Binary_data[1]=Binary_data[2]^Gray_data[1];
Binary_data[0]=Binary_data[1]^Gray_data[0];
end
该程序实现了由格雷码二进制Gray_data向普通二进制Binary_data的转换。
3 将二进制转为角度值绝对值编码器的最小精度是由最低位决定的。因为所用的绝对值器是13 bit数据输出,绝对值编码器的最低位为1时,对应的角度值如式(3)所示:
因此,绝对值编码器的最小精度为min=0.043 945 312 5°。也就是说二进制编码每加1,度数就应该增加0.043 945 312 5°。为方便在Verilog HDL中进行处理,对这种十进制数进行一个线性变换,将其最小精度值对应二进制min_degree=2′b000000000000011010001100011000010111000101,其实就是十进制数439 453 125对应的二进制数。相对于编码器输出的二进制数,将这个二进制数称为编码二进制。这样就对每一个编码器输出的13 bit二进制进行了一个线性变化,转化为对应的编码二进制Now_degree。其对应关系如式(4)所示,其中的“《《”是左移位运算符。
Now_degree=Binary_data[0]min_degree+Binary_data[1](min_degree《《1)++Binary_data[11](min_degree《《11)+ Binary_data[12](min_degree《《12) (4)
为了得出在每一数据位(百位、十位、一直到小数点后10位)上需要输出什么数据,需要求出每个数据位权值(即次位数据为1时的值)对应的编码二进制,数据位权值对应的编码二进制如表1所示。其中Decimal10_degree指的是小数点后第10位权值所对应的编码二进制,以此类推,Hundred_degree是百位上权值所对应的编码二进制。
欢迎分享,转载请注明来源:内存溢出
评论列表(0条)