一种多圈绝对值编码器及其测量方法

摘要

本发明公开了一种多圈绝对值编码器及其测量方法，该多圈绝对值编码器包括输入轴和壳体，所述壳体内设有主齿轮、从齿轮和控制模块，所述控制模块包括磁角度传感器、存储器、微控制器和通信模块，所述输入轴与所述主齿轮连接，所述从齿轮与主齿轮之间相啮合，所述主齿轮和从齿轮上设有磁铁，所述磁铁的正上方设置所述磁角度传感器，所述磁角度传感器、存储器和通信模块分别与所述微控制器连接；其效果是：能够通过较为简单的测量方法和结构简单的多圈绝对值编码器，实现多圈转角的记录。

权利要求

1.一种多圈绝对值编码器的测量方法，其特征在于,应用于多圈绝对值编码器，所述多圈绝对值编码器，包括输入轴和壳体，所述壳体内设有主齿轮、从齿轮和控制模块，所述控制模块包括磁角度传感器、存储器、微控制器和通信模块，所述输入轴与所述主齿轮连接，所述从齿轮与主齿轮之间相啮合，所述主齿轮和从齿轮上设有磁铁，所述磁铁的正上方设置所述磁角度传感器，所述磁角度传感器、存储器和通信模块分别与所述微控制器连接，所述从齿轮的数量为多个，所述从齿轮的齿数与主齿轮的齿数互质；

所述测量方法包括：

微控制器分别获取所述主齿轮和从齿轮上各磁角度传感器的检测值及所有齿轮的零点偏移量；

微控制器根据所述检测值及零点偏移量进行计算，得出输入轴的角度值和圈数值，具体包括以下步骤：计算ARM；

所述ARM＝(AM+360°-APM)mod 360°；

其中，ARM用于描述输入轴的角度值，AM用于描述主齿轮对应磁角度传感器的检测值，APM用于描述主齿轮的零点偏移量，mod用于描述求余函数；

根据所述ARM计算aSn；

所述aSn＝(ASn+720°-APSn-((ARM×GM÷GSn)mod 360°))mod 360°其中，aSn用于描述主齿轮处于上一个零角度时第n个从齿轮的角度值，ASn用于描述第n个从齿轮对应磁角度传感器的检测值，APSn用于描述第n个从齿轮的零点偏移量，GM用于描述主齿轮齿数，GSn用于描述第n个从齿轮齿数；

根据所述aSn计算出CMn；

其中，所述CMn用于描述第n个从齿轮角度为aSn时对应的主齿轮转动的圈数，当aSn<(180°÷GSn)或者aSn>(360°-180°÷GSn)则CMn的值为0，当CMn不为0，通过下式进行判断，其中，CTn为第一临时循环变量，CTn的取值范围，1≤CTn≤(GSn-1)：|((GM×CTn)mod GSn)×360°÷GSn–aSn|<(180°÷GSn)当满足上式条件时的CTn即为所求CMn；

根据所述CMn计算出CM；

其中，所述CM用于描述输入轴的圈数值；

微控制器将所述输入轴的角度值和圈数值通过通信模块发送给外部设备。

2.根据权利要求1所述的一种多圈绝对值编码器的测量方法，其特征在于,根据所述CMn计算出CM具体包括以下步骤：首先根据第一个从齿轮数GS1与第二个从齿轮数GS2，计算组合后对应的主齿轮圈数CG2；

通过第二临时循环变量CTS2取值从0到(GSS2-1)循环判断下式：CMS2＝(GSL2×CTS2+CML2)mod GSS2；

当上式成立时，CG2的值就是GSL2×CTS2+CML2；

其中，GSS2用于描述GS1和GS2当中值较小的，GSL2用于描述GS1和GS2当中值较大的，CMS2用于描述GS1和GS2当中值较小的所对应的主齿轮圈数，CML2用于描述GS1和GS2当中值较大的所对应的主齿轮圈数，也就是说，如果GS1小于GS2，则GSS2的值为GS1，GSL2的值为GS2，CMS2的值为CM1，CML2的值为CM2，如果GS1大于GS2，则GSS2的值为GS2,GSL2的值为GS1，CMS2的值为CM2，CML2的值为CM1；

然后计算第一个从齿轮与第二个从齿轮与第三个从齿轮组合后对应的主齿轮圈数CG3；

通过第三临时循环变量CTS3取值从0到(GSS3-1)循环判断下式：CMS3＝(GSL3×CTS3+CML3)mod GSS3；

当上式成立时，CG3的值就是GSL3×CTS3+CML3；

其中，GSS3用于描述(GS1×GS2)和GS3当中值较小的，GSL3用于描述(GS1×GS2)和GS3当中值较大的，CMS3用于描述(GS1×GS2)和GS3当中值较小的所对应的主齿轮圈数，CML3用于描述(GS1×GS2)和GS3当中值较大的所对应的主齿轮圈数，也就是说，如果(GS1×GS2)小于GS3，则GSS3的值为(GS1×GS2)，GSL3的值为GS3，CMS3的值为CG2，CML3的值为CM3,如果(GS1×GS2)大于GS3，则GSS3的值为GS3,GSL3的值为(GS1×GS2)，CMS3的值为CM3，CML3的值为CG2；

依次类推可求得所有从齿轮组合后对应的主齿轮圈数CGn；

通过第n临时循环变量CTSn取值从0到(GSSn-1)循环判断下式：CMSn＝(GSLn×CTSn+CMLn)mod GSSn；

当上式成立时，CGn的值就是GSLn×CTSn+CMLn；

其中，GSSn用于描述(GS1*GS2*……*GS(n-1))和GSn当中值较小的，GSLn用于描述(GS1*GS2*……*GS(n-1))和GSn当中值较大的，CMSn用于描述(GS1*GS2*……*GS(n-1))和GSn当中值较小的所对应的主齿轮圈数，CMLn用于描述(GS1*GS2*……*GS(n-1))和GSn当中值较大的所对应的主齿轮圈数，也就是说，如果(GS1*GS2*……*GS(n-1))小于GSn，则GSSn的值为GS1*GS2*……*GS(n-1)，GSLn的值为GSn，CMSn的值为CG(n-1)，CMLn的值为CMn，如果(GS1*GS2*……*GS(n-1))大于GSn，则GSSn的值为GSn，GSLn的值为GS1*GS2*……*GS(n-1)，CMSn的值为CMn，CMLn的值为CG(n-1)，所计算出的CGn就是CM。

说明书

一种多圈绝对值编码器及其测量方法

技术领域

[0001] 本发明属于编码器技术领域，具体涉及到一种多圈绝对值编码器及其测量方法。

背景技术

[0002] 绝对编码器在其光码盘上设置有许多道光通道刻线，每道刻线依次以2线、4线、8线、16线编排，这样在编码器的每一个位置，通过读取每道刻线的通、暗，获得一组从2的零次方到2的n-1次方的唯一的2进制编码(格雷码)，这就称为n位绝对编码器。

[0003] 绝对编码器由机械位置确定编码，它无需记忆，无需找参考点，而且不用一直计数，需要获取对应位置的时候，通过读取光码盘的编码信息便可获知。可见绝对值编码器的抗干扰特性、掉电信息保存性、数据的可靠性大大提高了。

[0004] 从单圈绝对值编码器只能记录旋转范围360度以内的测量，而多圈绝对值编码器则能够记录多圈旋转的角度，现有技术中，多圈绝对值编码器实现方式有行星齿轮箱、钟表式齿轮结构、内置电池数据保持三种；

[0005] 行星齿轮箱如果做到128圈以上体积会很庞大，或者要求加工精度极高，而且由于采用一个角度传感器，所以圈数较多时计量精度会大打折扣。

[0006] 钟表式齿轮结构可以实现较多的圈数计量，结构比较复杂，对制造精度要求很高。

[0007] 内置电池的编码器计量圈数理论上无限制，但是电池有使用寿命，而且一旦电池电量不足可能造成计量错误。很多应用场所不方便更换编码器的电池。

发明内容

[0008] 为了解决上述问题，本发明提供一种多圈绝对值编码器及其测量方法，解决现有技术中多圈绝对值编码器结构复杂的缺陷。

[0009] 本发明采取的一种技术方案为：一种多圈绝对值编码器，包括输入轴和壳体，所述壳体内设有主齿轮、从齿轮和控制模块，所述控制模块包括磁角度传感器、存储器、微控制器和通信模块，所述输入轴与所述主齿轮连接，所述从齿轮与主齿轮之间相啮合，所述主齿轮和从齿轮上设有磁铁，所述磁铁的正上方设置所述磁角度传感器，所述磁角度传感器、存储器和通信模块分别与所述微控制器连接。

[0010] 更进一步的方案是，所述从齿轮的数量为多个，所述从齿轮的齿数与主齿轮的齿数互质。

[0011] 由上述方案可见，通过简单的磁角度传感器分别对主齿轮和从齿轮的转动角度进行检测，通过微控制器计算出输入轴的角度值和圈数值，即通过结构简单的齿轮结构，构成整体结构也较为简单的多圈绝对值编码器，实现多圈转角的记录。

[0012] 本发明采取的另一种技术方案为：一种多圈绝对值编码器的测量方法，应用于上述方案中所述的多圈绝对值编码器；

[0013] 所述测量方法包括：

[0014] 微控制器分别获取所述主齿轮和从齿轮上各磁角度传感器的检测值及所有齿轮的零点偏移量；

[0015] 微控制器根据所述检测值及零点偏移量进行计算，得出输入轴的角度值和圈数值；

[0016] 微控制器将所述输入轴的角度值和圈数值通过通信模块发送给外部设备。

[0017] 更进一步的方案是，得出所述输入轴的角度值，具体包括以下步骤：

[0018] 计算ARM

[0019] 所述ARM＝(AM+360°-APM)mod 360°

[0020] 其中，ARM用于描述输入轴的角度值，AM用于描述主齿轮对应磁角度传感器的检测值，APM用于描述主齿轮的零点偏移量，mod用于描述求余函数。

[0021] 更进一步的方案是：

[0022] 根据所述ARM计算aSn；

[0023] 所述aSn＝(ASn+720°-APSn-((ARM×GM÷GSn)mod 360°))mod 360°

[0024] 其中，aSn用于描述主齿轮处于上一个零角度时第n个从齿轮的角度值，ASn用于描述第n个从齿轮对应磁角度传感器的检测值，APSn用于描述第n个从齿轮的零点偏移量，GM用于描述主齿轮齿数，GSn用于描述第n个从齿轮齿数；

[0025] 根据所述aSn计算出CMn；

[0026] 其中，所述CMn用于描述第n个从齿轮角度为aSn时对应的主齿轮转动的圈数，当aSn<(180°÷GSn)或者aSn>(360°-180°÷GSn)则CMn的值为0，当CMn不为0，通过下式进行判断，其中，CTn为第一临时循环变量，CTn的取值范围，1≤CTn≤(GSn-1)：

[0027] |((GM×CTn)mod GSn)×360°÷GSn–aSn|<(180°÷GSn)

[0028] 当满足上式条件时的CTn即为所求CMn；

[0029] 根据所述CMn计算出CM；

[0030] 其中，所述CM用于描述输入轴的圈数值。

[0031] 更进一步的方案是：

[0032] 根据所述CMn计算出CM具体包括以下步骤：

[0033] 首先根据第一个从齿轮数GS1与第二个从齿轮数GS2，计算组合后对应的主齿轮圈数CG2；

[0034] 通过第二临时循环变量CTS2取值从0到(GSS2-1)循环判断下式：

[0035] CMS2＝(GSL2×CTS2+CML2)mod GSS2；

[0036] 当上式成立时，CG2的值就是GSL2×CTS2+CML2；

[0037] 其中，GSS2用于描述GS1和GS2当中值较小的，GSL2用于描述GS1和GS2当中值较大的，CMS2用于描述GS1和GS2当中值较小的所对应的主齿轮圈数，CML2用于描述GS1和GS2当中值较大的所对应的主齿轮圈数，也就是说，如果GS1小于GS2，则GSS2的值为GS1，GSL2的值为GS2，CMS2的值为CM1，CML2的值为CM2，如果GS1大于GS2，则GSS2的值为GS2,GSL2的值为GS1，CMS2的值为CM2，CML2的值为CM1；

[0038] 然后计算第一个从齿轮与第二个从齿轮与第三个从齿轮组合后对应的主齿轮圈数CG3；

[0039] 通过第三临时循环变量CTS3取值从0到(GSS3-1)循环判断下式：

[0040] CMS3＝(GSL3×CTS3+CML3)mod GSS3；

[0041] 当上式成立时，CG3的值就是GSL3×CTS3+CML3；

[0042] 其中，GSS3用于描述(GS1×GS2)和GS3当中值较小的，GSL3用于描述(GS1×GS2)和GS3当中值较大的，CMS3用于描述(GS1×GS2)和GS3当中值较小的所对应的主齿轮圈数，CML3用于描述(GS1×GS2)和GS3当中值较大的所对应的主齿轮圈数，也就是说，如果(GS1×GS2)小于GS3，则GSS3的值为(GS1×GS2)，GSL3的值为GS3，CMS3的值为CG2，CML3的值为CM3,如果(GS1×GS2)大于GS3，则GSS3的值为GS3,GSL3的值为(GS1×GS2)，CMS3的值为CM3，CML3的值为CG2；

[0043] 依次类推可求得所有从齿轮组合后对应的主齿轮圈数CGn；

[0044] 通过第n临时循环变量CTSn取值从0到(GSSn-1)循环判断下式：

[0045] CMSn＝(GSLn×CTSn+CMLn)mod GSSn；

[0046] 当上式成立时，CGn的值就是GSLn×CTSn+CMLn；

[0047] 其中，GSSn用于描述(GS1*GS2*……*GS(n-1))和GSn当中值较小的，GSLn用于描述(GS1*GS2*……*GS(n-1))和GSn当中值较大的，CMSn用于描述(GS1*GS2*……*GS(n-1))和GSn当中值较小的所对应的主齿轮圈数，CMLn用于描述(GS1*GS2*……*GS(n-1))和GSn当中值较大的所对应的主齿轮圈数，也就是说，如果(GS1*GS2*……*GS(n-1))小于GSn，则GSSn的值为GS1*GS2*……*GS(n-1)，GSLn的值为GSn，CMSn的值为CG(n-1)，CMLn的值为CMn，如果(GS1*GS2*……*GS(n-1))大于GSn，则GSSn的值为GSn，GSLn的值为GS1*GS2*……*GS(n-1)，CMSn的值为CMn，CMLn的值为CG(n-1)，所计算出的CGn就是CM。

[0048] 由上述方案可见，通过上述的一种多圈绝对值编码器及其测量方法，能够通过较为简单的测量方法和结构简单的多圈绝对值编码器，实现多圈转角的记录。

附图说明

[0049] 图1为本发明实施例中的一种多圈绝对值编码器的结构原理图；

[0050] 图2为本发明实施例中的一种从齿轮与主齿轮相啮合的结构示意图；

[0051] 图3为本发明实施例中的一种多圈绝对值编码器的测量方法的方法流程图。

具体实施方式

[0052] 为了使本发明要解决的技术问题、技术方案和优点更加清楚，下面将结合附图及具体实施例进行详细描述，这里的描述不意味着对应于实施例中陈述的具体实例的所有主题都在权利要求中引用了。

[0053] 参考图1、图2所示，一种多圈绝对值编码器，包括输入轴和壳体，所述壳体内设有主齿轮、从齿轮和控制模块，主齿轮和从齿轮组成齿轮组，所述控制模块包括磁角度传感器、存储器、微控制器和通信模块，所述输入轴与所述主齿轮连接，所述从齿轮与主齿轮之间相啮合，所述主齿轮和从齿轮上设有磁铁，所述磁铁的正上方设置所述磁角度传感器，通过磁信号与各齿轮进行磁耦合，磁角度传感器利用磁信号感应非接触的特点获取相应的检测值，所述磁角度传感器、存储器和通信模块分别与所述微控制器连接。

[0054] 进一步地，所述从齿轮的数量为多个，所述从齿轮的齿数与主齿轮的齿数互质。

[0055] 通过上述方案，通过简单的磁角度传感器分别对主齿轮和从齿轮的转动角度进行检测，通过多个从齿轮与主齿轮相啮合以及各个齿轮上的齿数均为质数的结构，微控制器计算出从齿轮的多圈转角，即通过结构简单的齿轮结构，构成整体结构也较为简单的多圈绝对值编码器，实现多圈转角的记录。

[0056] 参考图3所示，一种多圈绝对值编码器的测量方法，应用于上述方案中所述的多圈绝对值编码器；所述测量方法包括：

[0057] S101，微控制器分别获取所述主齿轮和从齿轮上各磁角度传感器的检测值及所有齿轮的零点偏移量；

[0058] S102，微控制器根据所述检测值及零点偏移量进行计算，得出输入轴的角度值和圈数值；

[0059] S103，微控制器将所述主齿轮的角度值和从动轮的圈数值通过通信模块发送给外部设备。

[0060] 进一步地，步骤S102，具体包括以下步骤：

[0061] 计算ARM

[0062] 所述ARM＝(AM+360°-APM)mod 360°

[0063] 其中，ARM用于描述输入轴的角度值，AM用于描述主齿轮对应磁角度传感器的检测值，APM用于描述主齿轮的零点偏移量，mod用于描述求余函数；

[0064] 根据所述ARM计算aSn；

[0065] 所述aSn＝(ASn+720°-APSn-((ARM×GM÷GSn)mod 360°))mod 360°

[0066] 其中，aSn用于描述主齿轮处于上一个零角度时第n个从齿轮的角度值，ASn用于描述第n个从齿轮对应磁角度传感器的检测值，APSn用于描述第n个从齿轮的零点偏移量，GM用于描述主齿轮齿数，GSn用于描述第n个从齿轮齿数；

[0067] 根据所述aSn计算出CMn；

[0068] 其中，所述CMn用于描述第n个从齿轮角度为aSn时对应的主齿轮转动的圈数，当aSn<(180°÷GSn)或者aSn>(360°-180°÷GSn)则CMn的值为0，当CMn不为0，通过下式进行判断，其中，CTn为第一临时循环变量，CTn的取值范围，1≤CTn≤(GSn-1)：

[0069] |((GM×CTn)mod GSn)×360°÷GSn–aSn|<(180°÷GSn)

[0070] 当满足上式条件时的CTn即为所求CMn；

[0071] 根据所述CMn计算出CM；

[0072] 其中，所述CM用于描述输入轴的圈数值；

[0073] 根据所述CMn计算出CM具体包括以下步骤：

[0074] 首先根据第一个从齿轮数GS1与第二个从齿轮数GS2，计算组合后对应的主齿轮圈数CG2；

[0075] 通过第二临时循环变量CTS2取值从0到(GSS2-1)循环判断下式：

[0076] CMS2＝(GSL2×CTS2+CML2)mod GSS2；

[0077] 当上式成立时，CG2的值就是GSL2×CTS2+CML2；

[0078] 其中，GSS2用于描述GS1和GS2当中值较小的，GSL2用于描述GS1和GS2当中值较大的，CMS2用于描述GS1和GS2当中值较小的所对应的主齿轮圈数，CML2用于描述GS1和GS2当中值较大的所对应的主齿轮圈数，也就是说，如果GS1小于GS2，则GSS2的值为GS1，GSL2的值为GS2，CMS2的值为CM1，CML2的值为CM2，如果GS1大于GS2，则GSS2的值为GS2,GSL2的值为GS1，CMS2的值为CM2，CML2的值为CM1；

[0079] 然后计算第一个从齿轮与第二个从齿轮与第三个从齿轮组合后对应的主齿轮圈数CG3；

[0080] 通过第三临时循环变量CTS3取值从0到(GSS3-1)循环判断下式：

[0081] CMS3＝(GSL3×CTS3+CML3)mod GSS3；

[0082] 当上式成立时，CG3的值就是GSL3×CTS3+CML3；

[0083] 其中，GSS3用于描述(GS1×GS2)和GS3当中值较小的，GSL3用于描述(GS1×GS2)和GS3当中值较大的，CMS3用于描述(GS1×GS2)和GS3当中值较小的所对应的主齿轮圈数，CML3用于描述(GS1×GS2)和GS3当中值较大的所对应的主齿轮圈数，也就是说，如果(GS1×GS2)小于GS3，则GSS3的值为(GS1×GS2)，GSL3的值为GS3，CMS3的值为CG2，CML3的值为CM3,如果(GS1×GS2)大于GS3，则GSS3的值为GS3,GSL3的值为(GS1×GS2)，CMS3的值为CM3，CML3的值为CG2；

[0084] 依次类推可求得所有从齿轮组合后对应的主齿轮圈数CGn；

[0085] 通过第n临时循环变量CTSn取值从0到(GSSn-1)循环判断下式：

[0086] CMSn＝(GSLn×CTSn+CMLn)mod GSSn；

[0087] 当上式成立时，CGn的值就是GSLn×CTSn+CMLn；

[0088] 其中，GSSn用于描述(GS1*GS2*……*GS(n-1))和GSn当中值较小的，GSLn用于描述(GS1*GS2*……*GS(n-1))和GSn当中值较大的，CMSn用于描述(GS1*GS2*……*GS(n-1))和GSn当中值较小的所对应的主齿轮圈数，CMLn用于描述(GS1*GS2*……*GS(n-1))和GSn当中值较大的所对应的主齿轮圈数，也就是说，如果(GS1*GS2*……*GS(n-1))小于GSn，则GSSn的值为GS1*GS2*……*GS(n-1)，GSLn的值为GSn，CMSn的值为CG(n-1)，CMLn的值为CMn，如果(GS1*GS2*……*GS(n-1))大于GSn，则GSSn的值为GSn，GSLn的值为GS1*GS2*……*GS(n-1)，CMSn的值为CMn，CMLn的值为CG(n-1)，所计算出的CGn就是CM。

[0089] 下面以一个主齿轮和四个从齿轮为例进行说明：

[0090] 本实施例中主齿轮齿数GM为31，从齿轮1齿数GS1为47，从齿轮2齿数GS2为37，从齿轮3齿数GS3为41，从齿轮4齿数GS4为43。主齿轮与从齿轮的零点偏移量APM和APS1、APS2、APS3、APS4都为0。

[0091] AM、AS1、AS2、AS3、AS4表示主齿轮、从齿轮1、从齿轮2、从齿轮3、从齿轮4对应磁角度传感器的检测值，由于此实施例中所有从齿轮都与主齿轮直接啮合，所以AS1、AS2、AS3、AS4分别取值360°-AS1、360°-AS2、360°-AS3、360°-AS4。

[0092] aS1、aS2、aS3、aS4表示主齿轮上一个零角度时从齿轮1、从齿轮2、从齿轮3、从齿轮4的角度值。

[0093] ARM表示输入轴的角度值。

[0094] CM表示输入轴的圈数值。

[0095] CM1、CM2、CM3、CM4表示从齿轮1、从齿轮2、从齿轮3、从齿轮4角度分别为aS1、aS2、aS3、aS4时对应的主齿轮转动的圈数。

[0096] GSSn表示(GS1*GS2*……*GS(n-1))与GSn中较小的值，GSLn表示(GS1*GS2*……*GS(n-1))与GSn中较大的值。

[0097] 第一步计算ARM

[0098] ARM＝(AM+360°-APM)mod 360°

[0099] 其中，ARM用于描述输入轴的角度值，AM用于描述主齿轮对应磁角度传感器的检测值，APM用于描述主齿轮的零点偏移量，mod用于描述求余函数；

[0100] 第二步根据第一步计算得到的ARM计算aS1、aS2、aS3、aS4；

[0101] aS1＝(AS1+720°-((AM×31÷47)mod 360°))mod 360°

[0102] aS2＝(AS2+720°-((AM×31÷37)mod 360°))mod 360°

[0103] aS3＝(AS3+720°-((AM×31÷41)mod 360°))mod 360°

[0104] aS4＝(AS4+720°-((AM×31÷43)mod 360°))mod 360°

[0105] 其中，AM、AS1、AS2、AS3、AS4用于描述主齿轮、从齿轮1、从齿轮2、从齿轮3、从齿轮4对应磁角度传感器的检测值，aS1、aS2、aS3、aS4用于描述主齿轮上一个零角度时从齿轮1、从齿轮2、从齿轮3、从齿轮4的角度值，由于此实施例中所有从齿轮都与主齿轮直接啮合，所以AS1、AS2、AS3、AS4分别取值360°-AS1、360°-AS2、360°-AS3、360°-AS4。

[0106] 第三步根据第二步计算得到的aS1、aS2、aS3、aS4计算出CM1、CM2、CM3、CM4；

[0107] 如果aS1<(180°÷47)或者aS1>(360°-180°÷47)则CM1的值为0。

[0108] 如果CM1不为0，则通过第一临时循环变CTn的第一次取值CT1，取值从1到46循环判断是否满足下式条件：

[0109] |((31×CT1)mod 47)×360°÷47–aS1|<(180°÷47)

[0110] 当满足上式条件时的CT1即为所求CM1。

[0111] 其中，CM1用于描述从齿轮1的角度值为aS1时对应的主齿轮转动的圈数。

[0112] 如果aS2<(180°÷37)或者aS2>(360°-180°÷37)则CM2的值为0。

[0113] 如果CM2不为0，则通过第一临时循环变CTn的第二次取值CT2，取值从1到36循环判断是否满足下式条件：

[0114] |((31×CT2)mod 37)×360°÷37–aS2|<(180°÷37)

[0115] 当满足上式条件时的CT2即为所求CM2。

[0116] 其中，CM2用于描述从齿轮2的角度值为aS2时对应的主齿轮转动的圈数。

[0117] 如果aS3<(180°÷41)或者aS3>(360°-180°÷41)则CM3的值为0。

[0118] 如果CM3不为0，则通过第一临时循环变CTn的第三次取值，CT3取值从1到40循环判断是否满足下式条件：

[0119] |((31×CT3)mod 41)×360°÷41–aS3|<(180°÷41)

[0120] 当满足上式条件时的CT3即为所求CM3。

[0121] 其中，CM3用于描述从齿轮3的角度值为aS3时对应的主齿轮转动的圈数。

[0122] 如果aS4<(180°÷43)或者aS4>(360°-180°÷43)则CM4的值为0。

[0123] 如果CM4不为0，则通过第一临时循环变CTn的第四次取值，CT4取值从1到42循环判断是否满足下式条件：

[0124] |((31×CT4)mod 43)×360°÷43–aS4|<(180°÷43)

[0125] 当满足上式条件时的CT4即为所求CM4。

[0126] 其中，CM4用于描述从齿轮4的角度值为aS4时对应的主齿轮转动的圈数。

[0127] 第四步根据第三步计算得到的CM1、CM2、CM3、CM4计算出CM。

[0128] 通过第二临时循环变量CTS2取值从0到36循环判断下式：

[0129] CM2＝(47×CTS2+CM1)mod 37

[0130] 当上式成立时，CG2的值就是47×CTS2+CM1；

[0131] 其中，CG2用于描述从齿轮1和从齿轮2组合后对应的主齿轮转动的圈数[0132] 通过第三临时循环变量CTS3取值从0到(GSS3-1)循环判断下式：

[0133] CMS3＝(GSL3×CTS3+CML3)mod GSS3

[0134] 当上式成立时，CG3的值就是GSL3×CTS3+CML3；

[0135] 其中，CG3用于描述从齿轮1和从齿轮2和从齿轮3组合后对应的主齿轮转动的圈数，GSS3用于描述(GS1×GS2)和GS3当中值较小的，GSL3用于描述(GS1×GS2)和GS3当中值较大的，CMS3用于描述(GS1×GS2)和GS3当中值较小的所对应的主齿轮圈数，CML3用于描述(GS1×GS2)和GS3当中值较大的所对应的主齿轮圈数，因为(GS1×GS2)大于GS3，所以GSS3的值为GS3，GSL3的值为(GS1×GS2)，CMS3的值为CM3，CML3的值为CG2。

[0136] 通过第四临时循环变量CTS4取值从0到(GSS4-1)循环判断下式：

[0137] CMS4＝(GSL4×CTS4+CML4)mod GSS4

[0138] 当上式成立时，CG4的值就是GSL4×CTS4+CML4

[0139] 其中，CG4用于描述从齿轮1和从齿轮2和从齿轮3和从齿轮4组合后对应的主齿轮转动的圈数，GSS4用于描述(GS1×GS2×GS3)和GS4当中值较小的，GSL4用于描述(GS1×GS2×GS3)和GS4当中值较大的，CMS4用于描述(GS1×GS2×GS3)和GS4当中值较小的所对应的主齿轮圈数，CML4用于描述(GS1×GS2×GS3)和GS4当中值较大的所对应的主齿轮圈数，因为(GS1×GS2×GS3)大于GS4，所以GSS4的值为GS4,GSL4的值为(GS1×GS2×GS3)，CMS4的值为CM4，CML4的值为CG3。

[0140] 通过上述方法可求得CG4的值就是CM。

[0141] 其中，CM用于描述输入轴的圈数。

[0142] 最后计算出输入轴的圈数为CM，输入轴的角度值为AM，此实施例的输入轴圈数的计量范围为0-3065856。

[0143] 最后需要说明的是，上述描述为本发明的优选实施例，本领域的普通技术人员在本发明的启示下，在不违背本发明宗旨及权利要求的前提下，可以做出多种类似的表示，这样的变换均落入本发明的保护范围之内。