专利名称:位置信号处理装置的制作方法
技术领域:
本发明涉及一种处理位置传感器(包括码盘、光栅尺等)信号的处理装置;它可用于检测机床、半导体装备、机械人等的位置状况信号的处理。
背景技术:
在对机床、半导体装备、机械人等进行位置控制时,一般要在利用位置传感器(包括码盘、光栅尺等)对它们的位置状况进行检测后,对位置传感器的输出信号进行处理。图1是现行的位置信号处理装置的结构图。位置传感器1是诸如码盘、光栅尺等,它可用于检测机床、半导体装备、机械人等的位置状况,由它提供A相模拟信号Sa和B相模拟信号Sb。而A相模拟信号Sa和B相模拟信号Sb的基波分别为正弦波和余弦波,其频率正比于被检测对象的速度,可以用公式(1)、(2)近似表示。Sa=sin(X)……(1),Sb=cos(X)……(2)。第一整形电路5是利用A/D变换器对A相模拟信号Sa进行变换处理,提供A相数字信号Xda。第二整形电路6是利用A/D变换器对B相模拟信号Sb进行变换处理,提供B相数字信号Xdb。位置合成器7是利用A相数字信号Xda和B相数字信号Xdb,通过反正切运算得出位置信号X。如果(1)、(2)式能精确表示从位置传感器1得到的A相模拟信号Sa和B相模拟信号Sb的话,利用上述装置就可以比较精确地得出位置信号X。但是,从位置传感器1得到的A相模拟信号Sa和B相模拟信号Sb,一般都含有高次谐波和噪声,可以用(3)、(4)式来更精确地表示。
Sa=sin(X)+Na+Σi=1MAisin((2i+1)X)···(3)]]>Sb=cos(X)+Nb+Σi=1MBicos((2i+1)X)···(4),]]>式中Na、Nb为白色噪声,Ai、Bi为从1到M次的高次谐波的幅值。这与(1)、(2)式之间有很大的误差。对于白色噪声Na、Nb一般可以用低通滤波器进行抑制。但是,对于高次谐波,由于受到被测对象的速度dX/dt的影响,利用上述装置就不可避免的要受到(3)、(4)式中的高次谐波和噪声分量的影响,不能得出精确的位置信号X。
发明内容
本发明的目的就是要有效地消除高次谐波和噪声分量的影响,得出更加精确的位置信号X。本发明的技术方案是,它包含有位置传感器1和位置检测器4,通过对位置传感器1所输出的A相模拟信号Sa和B相模拟信号Sb经位置检测器4进行处理后,提供位置信号X的信号处理装置。该装置还包括利用位置传感器1所输出的A相模拟信号Sa和B相模拟信号Sb,提供模拟速度信号Wa的模拟速度观测器2;利用上述模拟速度信号Wa、上述A相模拟信号Sa和上述B相模拟信号Sb提供A相信号Xa和B相信号Xb的时变滤波器3;利用上述A相信号Xa和上述B相信号Xb,提供位置信号X的位置检测器4。本发明的信号处理装置,由于引入了模拟速度观测器2和时变滤波器3,有效地消除了A相模拟信号Sa和B相模拟信号Sb中的高次谐波和噪声分量的影响,使得位置检测器4在对A相信号Xa和B相信号Xb进行信号处理后,就能达到提供更加精确的位置信号X的目的。
图1为现有信号处理装置的结构示意图,图2为本发明技术方案的信号处理装置的结构示意图,图3为具体实施方式
中模拟速度观测器2的结构示意图。
具体实施例方式本发明的实施方式如图2、图3所示,一种位置信号处理装置,它利用位置传感器1所输出的A相模拟信号Sa和B相模拟信号Sb,提供模拟速度信号Wa的模拟速度观测器2;利用上述模拟速度信号Wa,上述A相模拟信号Sa和上述B相模拟信号Sb,提供A相信号Xa和B相信号Xb的时变滤波器3;利用上述A相信号Xa和上述B相信号Xb,提供位置信号X的位置检测器4。位置传感器1、位置检测器4与现行结构相同。模拟速度观测器2是利用位置传感器1所输出的A相模拟信号Sa和B相模拟信号Sb,提供模拟速度信号Wa。模拟速度观测器2的详细结构如图3所示。微分器8是利用A相模拟信号Sa提供信号Vaa;微分器9是利用B相模拟信号Sb提供信号Vab;用(5)、(6)式表示如下Vaa=dSa/dt……(5);Vab=dSb/dt……(6)。乘法运算器10是利用A相模拟信号Sa和上述的信号Vab提供信号Paa;乘法运算器11是利用B相模拟信号Sb和上述的信号Vaa提供信号Pab。用(7)、(8)式表示如下Paa=Sa*Vab……(7);Pab=Sb*Vaa……(8)。加减法运算器12是利用上述信号Paa和上述信号Pab提供信号Wb。用(9)式表示如下Wb=Pab-Paa……(9)。低通滤波器13是利用上述信号Wb,提供模拟速度信号Wa。用(10)式表示如下Wa=Wb/(Ts+1)……(10)。
(10)式中T为滤波器的时间常数,s为微分算子。如果忽略高次谐波和噪声分量的影响,下式成立。其中,W为被检测对象的速度。
Vaa=W*cos(W*t)……(11)Vab=-W*sin(W*t)……(12)Paa=-W*cos(W*t)*cos(W*t)……(13)Pab=W*sin(W*t)*sin(W*t)……(14)Wb=W……(15)Wa=Wb/(Ts+1)……(16)由于高次谐波和噪声分量在Wb中将表现为高频交流分量,而相对一定的被检测对象的速度W将表现为直流分量。所以,Wa能将较为精确地表现被检测对象的速度W。时变滤波器3是利用上述模拟速度信号Wa,上述A相模拟信号Sa和上述B相模拟信号Sb,提供A相信号Xa和B相信号Xb。
Xa=G(s)Sa……(17)Xb=G(s)Sb……(18)G(s)=1TGs+1Πi=1Ms2+Wci2s2+QWcis+Wci2···(19)]]>Wci=(2*i+1)*Wa……(20)由于G(s)能根据被检测对象的速度W的变化,调整其带通频率,从而可以有效地消除A相模拟信号Sa和B相模拟信号Sb中的高次谐波和噪声分量的影响。本实施方式的位置信号处理装置,由于引入了时变滤波器3和模拟速度观测器2,有效地消除了A相模拟信号Sa和B相模拟信号Sb中的高次谐波和噪声分量的影响,使得位置检测器4在对A相信号Xa和B相信号Xb进行信号处理后,就能达到提供更加精确的位置信号X的效果。
权利要求
1.一种位置信号处理装置,它包含有位置传感器(1)和位置检测器(4),通过对位置传感器(1)所输出的A相模拟信号Sa和B相模拟信号Sb经位置检测器(4)进行处理提供位置信号X,其特征是该装置还包括利用位置传感器(1)所输出的A相模拟信号Sa和B相模拟信号Sb,提供模拟速度信号Wa的模拟速度观测器(2);利用上述模拟速度信号Wa、上述A相模拟信号Sa和上述B相模拟信号Sb提供A相信号Xa和B相信号Xb的时变滤波器(3);利用上述A相信号Xa和上述B相信号Xb,提供位置信号X的位置检测器(4)。
2.根据权利要求1所述的位置信号处理装置,其特征在于模拟速度观测器(2)是采用微分器(8)利用A相模拟信号Sa提供信号Vaa,采用微分器(9)利用B相模拟信号Sb提供信号Vab,采用乘法运算器(10)利用A相模拟信号Sa和上述的信号Vab提供信号Paa,采用乘法运算器(11)利用B相模拟信号Sb和上述的信号Vaa提供信号Pab,采用加减法运算器(12)利用上述信号Paa和上述信号Pab提供信号Wb,采用低通滤波器(13)利用上述信号Wb提供模拟速度信号Wa。
全文摘要
一种信号处理装置,本发明涉及一种处理位置传感器信号的处理装置。该装置还包括利用位置传感器(1)所输出的A相模拟信号Sa和B相模拟信号Sb,提供模拟速度信号Wa的模拟速度观测器(2);利用上述模拟速度信号Wa、上述A相模拟信号Sa和上述B相模拟信号Sb提供A相信号Xa和B相信号Xb的时变滤波器(3);利用上述A相信号Xa和上述B相信号Xb,提供位置信号X的位置检测器(4)。本发明的信号处理装置,由于引入了模拟速度观测器(2)和时变滤波器(3),有效地消除了A相模拟信号Sa和B相模拟信号Sb中的高次谐波和噪声分量的影响,使得位置检测器(4)在对A相信号Xa和B相信号Xb进行信号处理后,就能达到提供更加精确的位置信号X的目的。
文档编号G01D5/12GK1529130SQ0313264
公开日2004年9月15日 申请日期2003年9月27日 优先权日2003年9月27日
发明者郝双晖, 郝明晖 申请人:哈尔滨工业大学