CN111238542A - 基于多对极编码器的位置环跨对极连续编码方法 - Google Patents
基于多对极编码器的位置环跨对极连续编码方法 Download PDFInfo
- Publication number
- CN111238542A CN111238542A CN201911400935.8A CN201911400935A CN111238542A CN 111238542 A CN111238542 A CN 111238542A CN 201911400935 A CN201911400935 A CN 201911400935A CN 111238542 A CN111238542 A CN 111238542A
- Authority
- CN
- China
- Prior art keywords
- encoder
- pos
- antipode
- zero
- tmp
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01D—MEASURING NOT SPECIALLY ADAPTED FOR A SPECIFIC VARIABLE; ARRANGEMENTS FOR MEASURING TWO OR MORE VARIABLES NOT COVERED IN A SINGLE OTHER SUBCLASS; TARIFF METERING APPARATUS; MEASURING OR TESTING NOT OTHERWISE PROVIDED FOR
- G01D5/00—Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Transmission And Conversion Of Sensor Element Output (AREA)
Abstract
本发明公开了一种基于多对极编码器的位置环跨对极连续编码方法,获取编码器位置零点;根据编码器当前码字和编码器位置零点,确定编码器正反转及跨对极情况;计算位置环反馈码。本发明位置反馈码字连续,使得多对极编码器可以任意角度安装,一次安装后不需要再检测是否在编码器一个象限中,从而大大简化安装难度,缩短安装时间。
Description
技术领域
本发明属于多对极编码器技术,特别涉及一种基于多对极编码器的位置环跨对极连续编码方法。
背景技术
编码器在现在数控制造、舵机、机器人、航空航天等领域中得到广泛应用。多对极编码器将编码器一圈分成若干个对极(或叫象限),其分辨率非常高,适于对精度要求较高的使用场景。如图1所示的4对极编码器,每个对极对应4096 或者65535个码字,一圈就有4096*4或者65535*4个码字,这为位置环控制的高精度提供了保证。但是多对极编码器有个通病,就是当出现跨对极(或跨象限) 时,编码器码字会出现突变。假设每个对极(象限)最大码字为65535,当出现跨对极(或跨象限)时,编码器码字就会从0突变为65535,或者从65535突变为0,见附图编码器示意图。在位置环使用环境下,为了使位置环的位置反馈数据(编码器码字)不出现突变,安装多对极编码器时要保证负载运动轨迹在其一个象限内,这样位置反馈数据才能保证是连续的。这就对多对极编码器安装工艺提出了较高的要求,每次安装完都要检测一次负载整个运动轨迹是否在编码器其中一个象限里,如果不在还要再调整再安装,整个过程会比较繁琐和漫长。
发明内容
本发明的目的在于提供一种多对极编码器基于位置环出现跨对极时位置环反馈数据仍然连续的方法。
实现本发明目的的技术解决方案为:一种基于多对极编码器的位置环跨对极连续编码方法,包括如下步骤:
获取编码器位置零点;
根据编码器当前码字和编码器位置零点,确定编码器正反转及跨对极情况;
计算位置环反馈码。
进一步的,所述编码器位置零点通过在负载的起始位置读取编码器码字获得。
进一步的,计算位置环反馈码的具体方法为:
设多对极编码器每个对极最大码字为Encmax,编码器当前码字为Pos_Tmp,位置环位置反馈码字为Pos_Fb,位置零点为Zero_Offset;
当Pos_Tmp<Zero_Offset且Zero_Offset-Pos_Tmp>Encmax/2时,说明编码器逆时针转动并且跨对极,利用式(1)计算位置环反馈码:
Pos_Fb=Pos_Tmp-Zero_Offset+Encmax (1)
当Pos_Tmp>Zero_Offset且Pos_Tmp-Zero_Offset>Encmax/2时,说明编码器顺时针转动并且跨对极,利用式(2)计算位置反馈码:
Pos_Fb=Pos_Tmp-Zero_Offset-Encmax (2)
否则,说明编码器在一个象限里转动,没有出现跨象限,利用式(3)计算位置反馈码:
Pos_Fb=Pos_Tmp-Zero_Offset (3)。
本发明与现有技术相比,其显著优点为:本发明位置反馈码字连续,使得多对极编码器可以任意角度安装,一次安装后不需要再检测是否在编码器一个象限中,从而大大简化安装难度,缩短安装时间。
附图说明
图1是2对极编码器码字变化示意图。
图2是4对极编码器码字变化示意图。
图中,每对极最大码字为Encmax,逆时针为每个对极码字增大方向,即0~ Encmax;顺时针为每个对极码字减小方向,即Encmax~0。
具体实施方式
下面结合附图和具体实施例,进一步说明本发明方案。
本发明考虑负载在0~90度范围内的位置环控制情形。由于2对极编码器适用于负载在45度到90度内的位置环控制,4对极编码器适用于负载在45度内的位置环控制。因此,当负载运动角度介于45度到90度时,可以采用2对极编码器,每个对极有180度,见图1;当负载运动角度介于0度到45度时,可以采用4对极编码器,每个对极有90度,以提高位置反馈分辨率,见图2。
以采用4对极编码器为例进行分析。负载运动角度在0~45度之间顺时针转动,当负载位置环零点在大于等于0度且小于45度(45度码字为Encmax/2)位置时(图2中阴影部分),就算极限情况,负载位置环零点在接近45度的地方,负载转动45度也不会超过90度,所以这种情况负载转动不会出现跨象限,位置环反馈数据时连续的。当位置环零点在大于等于45度且小于90度(90度码字为Encmax)位置时(图2空白空分),负载转动45度就会出现跨象限,位置环反馈数据发生突变,当前码字与上一时间间隔的码字相差会很大。负载逆时针转动,分析过程类似。据此本发明提出一种基于多对极编码器的位置环跨对极连续编码方法,适于负载在0~90度范围内的位置环控制,具体步骤如下:
步骤1,在负载的起始位置读取编码器码字,获取编码器位置零点;
先假设位置环相关变量,多对极编码器每个对极(象限)最大码字为Encmax,其为编码器已知参数,当发生跨对极时,码字会从0突变为Encmax或者从Encmax突变为0;编码器当前码字为Pos_Tmp;位置环位置反馈码字为Pos_Fb;位置零点为Zero_Offset。在位置环控制中,通常会标定“位置零点”,即当负载处于起始位置读取编码器码字获得,编码器装好后该值即固定。
步骤2,根据编码器当前码字与编码器位置零点的关系,确定位置环反馈码;
编码器逆时针转动,码字由小变大(0~Encmax),在出现跨对极(象限)前, Pos_Tmp大于Zero_Offset;当遇到跨对极(象限)时,编器码字由Encmax突变为0,Pos_Tmp小于Zero_Offset,并且Zero_Offset和Pos_Tmp之差大于Encmax/2,因此当Pos_Tmp<Zero_Offset且(Zero_Offset-Pos_Tmp)>Encmax/2时,利用下式计算位置环反馈码:
Pos_Fb=Pos_Tmp-Zero_Offset+Encmax;
编码器顺时针转动,码字由大变小(Encmax~0),在出现跨对极(象限)前, Pos_Tmp小于Zero_Offset;当遇到跨对极(象限)时,编器码字由0突变为 Encmax,Pos_Tmp大于Zero_Offset,并且Zero_Offset和Pos_Tmp之差大于 Encmax/2,因此当Pos_Tmp>Zero_Offset且(Pos_Tmp-Zero_Offset)>Encmax/2 时,利用下式计算位置反馈码:
Pos_Fb=Pos_Tmp-Zero_Offset-Encmax;
如果不是上述两种情况,则说明编码器在一个象限里转动,没有出现跨象限。因为反馈数据没有发生突变,编码器当前码字减去零位标定值即为位置环反馈值:
Pos_Fb=Pos_Tmp-Zero_Offset;
通过此方法,负载不管是从位置环零点转动,经过Encmax到0的突变,还是回到零点,经过0到Encmax的突变,计算的位置环的反馈值Pos_Fb是连续的,不会出现数据突变。
Claims (3)
1.基于多对极编码器的位置环跨对极连续编码方法,其特征在于,包括如下步骤:
获取编码器位置零点;
根据编码器当前码字和编码器位置零点,确定编码器正反转及跨对极情况;
计算位置环反馈码。
2.根据权利要求1所述的基于多对极编码器的位置环跨对极连续编码方法,其特征在于,所述编码器位置零点通过在负载的起始位置读取编码器码字获得。
3.根据权利要求1所述的基于多对极编码器的位置环跨对极连续编码方法,其特征在于,计算位置环反馈码的具体方法为:
设多对极编码器每个对极最大码字为Encmax,编码器当前码字为Pos_Tmp,位置环位置反馈码字为Pos_Fb,位置零点为Zero_Offset;
当Pos_Tmp<Zero_Offset且Zero_Offset-Pos_Tmp>Encmax/2时,说明编码器逆时针转动并且跨对极,利用式(1)计算位置环反馈码:
Pos_Fb=Pos_Tmp-Zero_Offset+Encmax (1)
当Pos_Tmp>Zero_Offset且Pos_Tmp-Zero_Offset>Encmax/2时,说明编码器顺时针转动并且跨对极,利用式(2)计算位置反馈码:
Pos_Fb=Pos_Tmp-Zero_Offset-Encmax (2)
否则,说明编码器在一个象限里转动,没有出现跨象限,利用式(3)计算位置反馈码:
Pos_Fb=Pos_Tmp-Zero_Offset (3)。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911400935.8A CN111238542B (zh) | 2019-12-31 | 2019-12-31 | 基于多对极编码器的位置环跨对极连续编码方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911400935.8A CN111238542B (zh) | 2019-12-31 | 2019-12-31 | 基于多对极编码器的位置环跨对极连续编码方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111238542A true CN111238542A (zh) | 2020-06-05 |
CN111238542B CN111238542B (zh) | 2022-12-13 |
Family
ID=70872285
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911400935.8A Active CN111238542B (zh) | 2019-12-31 | 2019-12-31 | 基于多对极编码器的位置环跨对极连续编码方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111238542B (zh) |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CA1229150A (en) * | 1983-03-28 | 1987-11-10 | Calman Gold | Solid state current to pressure transducer |
CN1178577A (zh) * | 1995-03-30 | 1998-04-08 | 西门子公司 | 在尤其串行传输检测的位置实际值的绝对角位置测量发生器中用于旋转方向判定和真实性验证的装置 |
CN103715963A (zh) * | 2013-12-31 | 2014-04-09 | 山东新风光电子科技发展有限公司 | 一种基于绝对位置编码器的速度和位置信号抗干扰处理方法 |
CN105424063A (zh) * | 2014-09-11 | 2016-03-23 | 包米勒公司 | 绝对位置测量系统和方法 |
US20180041231A1 (en) * | 2016-08-04 | 2018-02-08 | Fanuc Corporation | Encoder signal processing device, encoder, and signal processing method and recording medium |
CN111504353A (zh) * | 2020-04-28 | 2020-08-07 | 浙江大学 | 一种编码器零位信号丢失补偿装置及方法 |
-
2019
- 2019-12-31 CN CN201911400935.8A patent/CN111238542B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CA1229150A (en) * | 1983-03-28 | 1987-11-10 | Calman Gold | Solid state current to pressure transducer |
CN1178577A (zh) * | 1995-03-30 | 1998-04-08 | 西门子公司 | 在尤其串行传输检测的位置实际值的绝对角位置测量发生器中用于旋转方向判定和真实性验证的装置 |
CN103715963A (zh) * | 2013-12-31 | 2014-04-09 | 山东新风光电子科技发展有限公司 | 一种基于绝对位置编码器的速度和位置信号抗干扰处理方法 |
CN105424063A (zh) * | 2014-09-11 | 2016-03-23 | 包米勒公司 | 绝对位置测量系统和方法 |
US20180041231A1 (en) * | 2016-08-04 | 2018-02-08 | Fanuc Corporation | Encoder signal processing device, encoder, and signal processing method and recording medium |
CN111504353A (zh) * | 2020-04-28 | 2020-08-07 | 浙江大学 | 一种编码器零位信号丢失补偿装置及方法 |
Non-Patent Citations (1)
Title |
---|
汪诤: "《机电一体化技术》", 30 June 2009 * |
Also Published As
Publication number | Publication date |
---|---|
CN111238542B (zh) | 2022-12-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110380653B (zh) | 基于霍尔位置传感器的矢量控制位置估计补偿方法 | |
CN205175428U (zh) | 一种具有双通道旋转变压器的位置检测及解码电路 | |
CN112362089A (zh) | 一种多对极磁电编码器及其高分辨率高可靠角度解算方法 | |
CN113054882B (zh) | 一种pmsm的磁编码器初始角度识别及矫正方法 | |
He et al. | Nonsingular fast terminal sliding mode control with extended state observer and tracking differentiator for uncertain nonlinear systems | |
CN102520226A (zh) | 一种用于电能计量的小电流补偿方法 | |
CN114200832B (zh) | 非线性系统动态事件触发终端滑模控制方法、设备及介质 | |
CN109600092B (zh) | 一种永磁同步电机转子位置监测和修正方法、系统及电机 | |
CN111238542B (zh) | 基于多对极编码器的位置环跨对极连续编码方法 | |
CN110160560B (zh) | 磁编码器、机器人关节及磁编码器的标定方法 | |
Yu et al. | Adaptive quantized tracking control for a class of nonlinear systems | |
Hu et al. | Relative gain array for MIMO processes containing integrators and/or differentiators | |
CN106773651B (zh) | 舵机临界点锁位方法和装置 | |
CN111089610B (zh) | 一种编码器的信号处理方法、装置及相关组件 | |
CN109520550B (zh) | 一种适用于多极旋变的高精度编码器跳码评估方法 | |
CN108880357B (zh) | 永磁同步电机的自适应非光滑电流跟踪控制方法 | |
US20200218226A1 (en) | Instant correction method for encoder and system thereof | |
CN116317723A (zh) | 基于磁编码器的永磁同步电机初始位置校准方法 | |
CN112665531B (zh) | 一种多对级旋变坐标变换解角方法 | |
CN107544250B (zh) | 一种少保守性的永磁球形电机轨迹跟踪控制方法 | |
CN112202376B (zh) | 一种基于Taylor跟踪微分器的直线电机自抗扰控制设计方法 | |
CN106918802A (zh) | 一种高精度雷达码盘方位的计算方法 | |
RU2308802C1 (ru) | Цифровой преобразователь угла | |
Takeyama et al. | Development of a magnetic absolute encoder using eccentric structure and long short-term memory | |
CN113050699B (zh) | 一种基于磁编码器的控制方法及装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |