四读数头增量式圆光栅耦合器.pdf

上传人:v**** 文档编号:5220112 上传时间:2018-12-26 格式:PDF 页数:15 大小:1.57MB
返回 下载 相关 举报
摘要
申请专利号:

CN201410734719.8

申请日:

2014.12.04

公开号:

CN104482885A

公开日:

2015.04.01

当前法律状态:

授权

有效性:

有权

法律详情:

授权|||实质审查的生效IPC(主分类):G01B 11/26申请日:20141204|||公开

IPC分类号:

G01B11/26

主分类号:

G01B11/26

申请人:

哈尔滨工业大学

发明人:

周彬彬; 王舰; 王常虹; 程炳坤

地址:

150000黑龙江省哈尔滨市南岗区西大直街92号

优先权:

专利代理机构:

哈尔滨龙科专利代理有限公司23206

代理人:

高媛

PDF下载: PDF下载
内容摘要

四读数头增量式圆光栅耦合器,涉及一种多读数头的耦合器。为了解决现有多读数头圆光栅测角系统测量角度值不准确的问题。本发明包括四个读数头接口模块、四个转换模块、两个滤波模块、四个四倍频计数辨向模块、融合反变换模块、差分转换模块和输出接口模块;通过转换模块和滤波模块将四个读数头的圆光栅信号进行处理后,四倍频计数辨向模块采用有限状态机进行倍频、辨向和计数,融合反变换模块再采用三相状态机以及初始信号校正实现将思路计数值融合成一路信号,再依次经差分转换模块和输出接口模块输出信号。本发明用于圆光栅测角系统。

权利要求书

权利要求书
1.  四读数头增量式圆光栅耦合器,其特征在于,所述耦合器包括四个读数头接口模块、 四个转换模块、FPGA模块、差分转换模块和输出接口模块;
FPGA模块包括两个滤波模块、四个四倍频计数辨向模块和融合反变换模块;
四个读数头接口模块输出的RS422差分信号分别发送至四个转换模块,每个转换模块 输出A、B、Z相的TTL电平信号同时发送至第一滤波模块,第一滤波模块输出的四路TTL 电平滤波信号分别发送至四个四倍频计数辨向模块,每个四倍频计数辨向模块的计数脉冲 值信号同时发送至第二滤波模块,第二滤波模块输出的四路计数脉冲值滤波信号同时输入 至融合反变换模块,融合反变换模块输出的融合信号输入至差分转换模块,差分转换模块 输出RS422差分信号输入至输出接口模块。

2.  根据权利要求1所述的四读数头增量式圆光栅耦合器,其特征在于,所述滤波模块, 用于根据圆光栅的刻线数和细分倍数,计算出最高转速下圆光栅输出信号的脉冲频率,将 频率高于所述脉冲频率的输入信号作为干扰信号滤除。

3.  根据权利要求2所述的四读数头增量式圆光栅耦合器,其特征在于,所述四倍频计 数辨向模块的工作过程包括:
步骤一:判断输入的滤波信号的Z相是否是上升沿,若是,则计数值置零,转入步骤四, 若否,则转入步骤二;
步骤二:比较相邻两个时钟处输入的滤波信号的A相和B相是否发生超前或滞后,若是, 则转入步骤三,若否,则计数的值不变,转入步骤四;
步骤三:若滤波信号的B相滞后A相90°,在一个脉冲周期内,A相和B相发生四次相对 变化A相和B相每发生一次变化,计数值加1,转入步骤四;
若滤波信号的B相超前A相90°,在一个脉冲周期内,A相和B相发生四次相对变化 A相和B相每发生一次变化,计数值减1,转入步骤四;
步骤四:计数值进行锁存,返回步骤一。

4.  根据权利要求3所述的四读数头增量式圆光栅耦合器,其特征在于,融合反变换模 块的工作过程包括:
步骤一:对输入的四路计数脉冲的计数值求平均,获得平均计数脉冲值;
步骤二:判断步骤一得到的平均计数脉冲值的最低位是否出现上升沿或者下降沿,若 是,转入步骤三,若否,则计数脉冲的A相和B相的电平保持不变,转入步骤一;
步骤三:比较所述平均计数脉冲值与上一个时钟的平均计数脉冲值的大小相差是否超 过1,若是,则计数脉冲的A相和B相的电平均置低位,转入步骤一,若否,则转入步骤四;
步骤四:判断所述的平均计数脉冲值和上一个时钟以及上上个时钟的平均计数脉冲值 的大小关系,采用三相状态机对平均计数脉冲的A相、B相和Z相进行相应的状态转换,获 得一路A、B、Z相融合信号,再转入步骤一;
所述三相状态机包括A相、B相和Z相电平的8个状态,分别为000状态、001状态、010 状态、011状态、100状态、101状态、110状态和111状态;
在000状态,当此时平均计数脉冲值大于上一个时钟的计数值时,转入100状态;当此 时平均计数脉冲值为零,且上一个时钟的计数值大于上上个时钟的计数值时,转入101状态; 当此时平均计数脉冲值小于上一个时钟的计数值时,转入010状态;当此时平均计数脉冲值 为零,而且上一个时钟的计数值等于上上个时钟的计数值,转入001状态;当此时平均计数 脉冲值为零,且上一个时钟的计数值小于上上个时钟的计数值,转入011状态;
在001状态,当此时平均计数脉冲值大于上一个时钟的计数值时,转入100状态;当此 时平均计数脉冲值小于上一个时钟的计数值时,转入010状态;
在010状态,当此时平均计数脉冲值大于上一个时钟的计数值时,转入000状态;当此 时平均计数脉冲值为零,且上一个时钟的计数值大于上上个时钟的计数值时,转入001状态; 当此时平均计数脉冲值小于上一个时钟的计数值时,转入110状态;当此时平均计数脉冲值 为零,而且上一个时钟的计数值等于上上个时钟的计数值,转入011状态;当此时平均计数 脉冲值为零,且上一个时钟的计数值小于上上个时钟的计数值,转入111状态;
在011状态,当此时平均计数脉冲值大于上一个时钟的计数值时,转入000状态;当此 时平均计数脉冲值小于上一个时钟的计数值时,转入110状态;
在100状态,当此时平均计数脉冲值大于上一个时钟的计数值时,转入110状态;当此 时平均计数脉冲值为零,且上一个时钟的计数值大于上上个时钟的计数值时,转入111状态; 当此时平均计数脉冲值小于上一个时钟的计数值时,转入000状态;当此时平均计数脉冲值 为零,而且上一个时钟的计数值等于上上个时钟的计数值,转入101状态;当此时平均计数 脉冲值为零,且上一个时钟的计数值小于上上个时钟的计数值,转入001状态;
在101状态,当此时平均计数脉冲值大于上一个时钟的计数值时,转入110状态;当此 时平均计数脉冲值小于上一个时钟的计数值时,转入000状态;在110状态,当此时平均计 数脉冲值大于上一个时钟的计数值时,转入010状态;当此时平均计数脉冲值为零,且上一 个时钟的计数值大于上上个时钟的计数值时,转入011状态;当此时平均计数脉冲值小于上 一个时钟的计数值时,转入100状态;当此时平均计数脉冲值为零,而且上一个时钟的计数 值等于上上个时钟的计数值,转入111状态;当此时平均计数脉冲值为零,且上一个时钟的 计数值小于上上个时钟的计数值,转入101状态;
在111状态,当此时平均计数脉冲值大于上一个时钟的计数值时,转入010状态;当此 时平均计数脉冲值小于上一个时钟的计数值时,转入100状态。

5.  根据权利要求4所述的四读数头增量式圆光栅耦合器,其特征在于,融合反变换模 块的工作过程还包括:
采用三相状态机对平均计数脉冲的A相、B相和Z相进行相应的状态转换,获得一路A、 B、Z相融合信号后,所述Z相融合信号为初步融合信号采用输入至融合反变换模块的原 始四路Z相信号对初步融合信号进行校正:
当所述原始四路Z相信号中不少于两路Z相信号出现零位时,且初步融合信号处于高 电平的零位信号时,输出Z′为高电平,否则为低电平,所述Z′为最终Z相融合信号。

说明书

说明书四读数头增量式圆光栅耦合器
技术领域
本发明涉及一种多读数头的耦合器,特别涉及一种四读数头增量式圆光栅耦合器。
背景技术
经济和生产力的迅猛发展也催生了对测角系统新的更多更高的需求,对测试设备的精 度和性能的要求越来越高,圆光栅测角系统具有结构简单、测量范围大、量测精度高和动 态特性好等优势,因而广泛地应用在高精度惯性测试设备中,而随着圆光栅测量仪器中使 用计算机进行信号处理,大大提高了测量的快速性、稳定性和精确性,由于圆光栅传感器 的输出信号的质量基本上决定了信号处理结果的可靠性和准确性,所以可以说圆光栅传感 器的精度很大程度上决定了高精度测角的精度,而且圆光栅便于细分和融合,提高分辨率 和精度,利用圆光栅的多读数头的均化作用,可以有效的消除圆光栅的安装偏心、刻划误 差等对读数精度的影响,而且稳定可靠。
目前使用的多读数头圆光栅测角系统大都是直接将各读数头的信号直接送到控制器 进行信号的采集、解码以及融合处理,得到角度的平均值,控制器根据实时的角度值再完 成后续控制操作。这样一来,首先增加了控制器的负担,使得控制器容易出现误操作,特 别是在复杂系统中,然后由于需要接到控制器,信号的传输距离较远,导致各读数头的信 号的实时性难以保证,造成最终得到的角度值不准确,尤其是在读数头个数较多的情况下, 再者当系统读数头个数发生变化时,由于其信号采集和处理集成到控制器中,因此需要对 控制器进行较大的修改,造成设备的维护难度加大。由于这些问题的存在,使得多读数头 测角系统的消除误差效果大打折扣。
因此需要将多读数头圆光栅信号的采集和融合在接近读数头的位置直接完成,同时也 要使得输出的信号具有较强的抗干扰能力,这就需要在各读数头附近将多路信号耦合成一 路信号,因此需要一种多读数头的耦合器。
发明内容
本发明的目的是为了解决现有多读数头圆光栅测角系统测量角度值不准确的问题,本 发明提供一种四读数头增量式圆光栅耦合器。
本发明的四读数头增量式圆光栅耦合器,
所述耦合器包括四个读数头接口模块、四个转换模块、FPGA模块、差分转换模块和 输出接口模块;
FPGA模块包括两个滤波模块、四个四倍频计数辨向模块和融合反变换模块;
四个读数头接口模块输出的RS422差分信号分别发送至四个转换模块,每个转换模 块输出A、B、Z相的TTL电平信号同时发送至第一滤波模块,第一滤波模块输出的四路 TTL电平滤波信号分别发送至四个四倍频计数辨向模块,每个四倍频计数辨向模块的计 数脉冲值信号同时发送至第二滤波模块,第二滤波模块输出的四路计数脉冲值滤波信号同 时输入至融合反变换模块,融合反变换模块输出的融合信号输入至差分转换模块,差分转 换模块输出RS422差分信号输入至输出接口模块。
所述滤波模块,用于根据圆光栅的刻线数和细分倍数,计算出最高转速下圆光栅输出 信号的脉冲频率,将频率高于所述脉冲频率的输入信号作为干扰信号滤除。
所述四倍频计数辨向模块的工作过程包括:
步骤一:判断输入的滤波信号的Z相是否是上升沿,若是,则计数值置零,转入步 骤四,若否,则转入步骤二;
步骤二:比较相邻两个时钟处输入的滤波信号的A相和B相是否发生超前或滞后, 若是,则转入步骤三,若否,则计数的值不变,转入步骤四;
步骤三:若滤波信号的B相滞后A相90°,在一个脉冲周期内,A相和B相发生四 次相对变化A相和B相每发生一次变化,计数值加1,转入步骤四;
若滤波信号的B相超前A相90°,在一个脉冲周期内,A相和B相发生四次相对变 化A相和B相每发生一次变化,计数值减1,转入步骤四;
步骤四:计数值进行锁存,返回步骤一。
融合反变换模块的工作过程包括:
步骤一:对输入的四路计数脉冲的计数值求平均,获得平均计数脉冲值;
步骤二:判断步骤一得到的平均计数脉冲值的最低位是否出现上升沿或者下降沿,若 是,转入步骤三,若否,则计数脉冲的A相和B相的电平保持不变,转入步骤一;
步骤三:比较所述平均计数脉冲值与上一个时钟的平均计数脉冲值的大小相差是否超 过1,若是,则计数脉冲的A相和B相的电平均置低位,转入步骤一,若否,则转入步 骤四;
步骤四:判断所述的平均计数脉冲值和上一个时钟以及上上个时钟的平均计数脉冲值 的大小关系,采用三相状态机对平均计数脉冲的A相、B相和Z相进行相应的状态转换, 获得一路A、B、Z相融合信号,再转入步骤一;
所述三相状态机包括A相、B相和Z相电平的8个状态,分别为000状态、001状态、 010状态、011状态、100状态、101状态、110状态和111状态;
在000状态,当此时平均计数脉冲值大于上一个时钟的计数值时,转入100状态;当 此时平均计数脉冲值为零,且上一个时钟的计数值大于上上个时钟的计数值时,转入101 状态;当此时平均计数脉冲值小于上一个时钟的计数值时,转入010状态;当此时平均计 数脉冲值为零,而且上一个时钟的计数值等于上上个时钟的计数值,转入001状态;当此 时平均计数脉冲值为零,且上一个时钟的计数值小于上上个时钟的计数值,转入011状态;
在001状态,当此时平均计数脉冲值大于上一个时钟的计数值时,转入100状态;当 此时平均计数脉冲值小于上一个时钟的计数值时,转入010状态;
在010状态,当此时平均计数脉冲值大于上一个时钟的计数值时,转入000状态;当 此时平均计数脉冲值为零,且上一个时钟的计数值大于上上个时钟的计数值时,转入001 状态;当此时平均计数脉冲值小于上一个时钟的计数值时,转入110状态;当此时平均计 数脉冲值为零,而且上一个时钟的计数值等于上上个时钟的计数值,转入011状态;当此 时平均计数脉冲值为零,且上一个时钟的计数值小于上上个时钟的计数值,转入111状态;
在011状态,当此时平均计数脉冲值大于上一个时钟的计数值时,转入000状态;当 此时平均计数脉冲值小于上一个时钟的计数值时,转入110状态;
在100状态,当此时平均计数脉冲值大于上一个时钟的计数值时,转入110状态;当 此时平均计数脉冲值为零,且上一个时钟的计数值大于上上个时钟的计数值时,转入111 状态;当此时平均计数脉冲值小于上一个时钟的计数值时,转入000状态;当此时平均计 数脉冲值为零,而且上一个时钟的计数值等于上上个时钟的计数值,转入101状态;当此 时平均计数脉冲值为零,且上一个时钟的计数值小于上上个时钟的计数值,转入001状态;
在101状态,当此时平均计数脉冲值大于上一个时钟的计数值时,转入110状态;当 此时平均计数脉冲值小于上一个时钟的计数值时,转入000状态;在110状态,当此时平 均计数脉冲值大于上一个时钟的计数值时,转入010状态;当此时平均计数脉冲值为零, 且上一个时钟的计数值大于上上个时钟的计数值时,转入011状态;当此时平均计数脉冲 值小于上一个时钟的计数值时,转入100状态;当此时平均计数脉冲值为零,而且上一个 时钟的计数值等于上上个时钟的计数值,转入111状态;当此时平均计数脉冲值为零,且 上一个时钟的计数值小于上上个时钟的计数值,转入101状态;
在111状态,当此时平均计数脉冲值大于上一个时钟的计数值时,转入010状态;当 此时平均计数脉冲值小于上一个时钟的计数值时,转入100状态。
融合反变换模块的工作过程还包括:
采用三相状态机对平均计数脉冲的A相、B相和Z相进行相应的状态转换,获得一 路A、B、Z相融合信号后,所述Z相融合信号为初步融合信号采用输入至融合反变 换模块的原始四路Z相信号对初步融合信号进行校正:
当所述原始四路Z相信号中不少于两路Z相信号出现零位时,且初步融合信号处 于高电平的零位信号时,输出Z′为高电平,否则为低电平,所述Z′为最终Z相融合信号。
本发明的有益效果在于,本发明的四读数头耦合器除了能够提供耦合后A、B相信号 之外,而且也能提供标准的Z相校正信号。本发明中的四读数头耦合器适用于各种输出 信号为标准的A、B、Z相方波信号的圆光栅读数头,因此,它的广适性和实用性都要更 好。
同时本发明的兼容性和扩展性都非常优秀,单个耦合器适用于不大于四个读数头的圆 光栅的测量,而且可以进行级联,测量多余四个读数头的多读数头圆光栅测量系统的使用。 而且在产品的升级和改进上,本发明采用的核心处理器是FPGA模块而且留有很大的设 计裕度,而且留有可编程的接口,能够比较方便地进行产品的进一步升级和改进,提高测 角的精度、快速性和稳定性。。本发明是针对于四个读数头的方波耦合器,因此能提供更 高的测角精度,并且很容易在此基础上修改成适用于不多于四个读数头的圆光栅多读数头 测角系统。
附图说明
图1为具体实施方式一所述的四读数头增量式圆光栅耦合器的原理示意图。
图2为具体实施方式一所述的FPGA模块的原理示意图。
图3为具体实施方式三所述的四倍频计数辨向模块中有限状态机的状态转换图。
图4为具体实施方式四所述的融合反变换模块的三相状态机的状态转换图。
图5为具体实施方式五所述的Z相融合原理示意图。
具体实施方式
具体实施方式一:结合图1和图2说明本实施方式,本实施方式所述的四读数头增量 式圆光栅耦合器,所述耦合器包括四个读数头接口模块、四个转换模块、FPGA模块、差 分转换模块和输出接口模块;
FPGA模块包括两个滤波模块、四个四倍频计数辨向模块和融合反变换模块; 四个读数头接口模块输出的RS422差分信号分别发送至四个转换模块,每个转换模块输 出A、B、Z相的TTL电平信号同时发送至第一滤波模块,第一滤波模块输出的四路TTL 电平滤波信号分别发送至四个四倍频计数辨向模块,每个四倍频计数辨向模块的计数脉冲 值信号同时发送至第二滤波模块,第二滤波模块输出的四路计数脉冲值滤波信号同时输入 至融合反变换模块,融合反变换模块输出的融合信号输入至差分转换模块,差分转换模块 输出RS422差分信号输入至输出接口模块。
本实施方式主要是实现基于四均布增量式方波输出信号读数头的信号采集,计数,并 且融合成一路信号输出。具体的工作过程如下:安装在光栅圆环上的四个均布读数头将检 测得到的角度信息编码成A、B、Z相的RS422的差分方波脉冲信号,通过分别电平转换, 将RS422差分信号转换为FPGA模块便于处理的TTL电平,然后对各个读数头的脉冲信 号分别进行倍频、计数和辨向,就可以得到各个读数头的计数脉冲数,然后对这四个读数 头的计数脉冲值取平均值,将得到的平均值结合原始的A、B、Z相基准信号变换得到对 应的一组A、B、Z相方波信号,然后将TTL电平转换成RS422接口的差分信号通过输 出接口传输给后续的控制处理器。
读数头接口模块是实现四个读数头输入信号与FPGA模块的连接和将融合得到的信号 进行输出,是整个耦合器的窗口。由于输出接口模块是高密度的26孔DB型插头,包括电 源和A、B、Z相的差分信号以及警示辅助位,为了方便使用,本实施方式的输入输出接口 模块也都采用相同的插头。
本实施方式,读数头由5V供电,供电来自输出的插头,项目中输入的是RS422信号, 为了保持输入输出的一致性,输出的A、B和Z相信号都是RS422接口的方波差分信号。
转换模块主要实现各个读数头输入的RS422差分信号转换成TTL电平和输出信号的 TTL电平转换成RS422差分信号。
由于读数头输出的A、B和Z相信号都是RS422接口的差分信号,而FPGA模块只 能进行TTL电平的相应处理,因此必须将各读数头的信号通过电平转换成TTL电平,为 了本实施方式的高速性要求,这里采用的是高速RS422接收转换芯片MAX3280,芯片速 度可达到52Mbps,而且外围配置电路非常少,3.3V供电,功耗低,稳定性好,为了增大 抗干扰能力,在差分信号接收端之间连接了120欧姆的匹配电阻。
由于RS422差分信号的抗干扰能力强,传输距离远,因此在本实施方式处理得到的 融合信号后,进行TTL-RS422电平转换成差分信号再传输给后续的控制器进行处理。也 要求采用的是使用高速的TTL-RS422转换芯片,本实施方式中采用的是MAX3295,速率 可达20Mbps,将FPGA模块融合得到的A相(AINI)、B相(BINI)和Z相(ZINI)分 别转换成2路RS422差分信号连接输出接口。
信号通过了读数头接口模块的输入处理和转换模块的电平转换后,进入了FPGA模块的外围I/O 口,到达内部的可编程门阵列进行采集,四倍频,计数和辨向以及融合处理,FPGA及其外围配置电 路是系统的核心部分。
本实施方式的FPGA模块采用Altera公司Cyclone II系列的EP2C5T144I8实现。
同时FPGA作为一种可编程逻辑门处理芯片,在处理时序时非常方便,这就要求它 本身的时钟管理功能能提供多种准确稳定的时钟信号,为了达到这个目的,FPGA模块中 采用了PLL,这是一个可以产生各种稳定频率的分频倍频模块。本实施方式采用的 EP2C5T144芯片内部有两个PLL,为了保证PLL的正常工作,在芯片PLL供电管脚都加 入了去耦和滤波电容,确保输入高质量的模拟和数字电源。
本实施方式中的电源模块提供的电源包括:FPGA模块供电需要3.3V和1.2V两种, 读数头接口模块、转换模块块和输出接口模块都需要3.3V供电,而各读数头接口模块需 要的供电电源则是5V,本实施方式通过输出接口模块引入5V直流电平,因此需要将5V 转换成3.3V和1.2V。具体实施方式二:本实施方式是对具体实施方式一所述的四读数头 增量式圆光栅耦合器的进一步限定,所述滤波模块,用于根据圆光栅的刻线数和细分倍数, 计算出最高转速下圆光栅输出信号的脉冲频率,将频率高于所述脉冲频率的输入信号作为 干扰信号滤除。
由于工作现场的机械振动和电磁干扰以及软件逻辑设计中的竞争冒险,导致了输入信 号和中间处理信号出现毛刺尖峰现象,严重影响了测角精度。
存在由于干扰所产生的毛刺脉冲和尖峰的频率一般都远高于圆光栅A、B、Z相的脉 冲频率,因此在输入时采用一种高频保持滤波方法,即:根据圆光栅的刻线数和细分倍数, 计算出最高转速下圆光栅输出信号的脉冲频率,作为系统的最高频率,将频率高于这个最 高频率的信号作为干扰信号滤除。
例如:圆光栅刻线是55400,选用的读数头细分1000倍,最高速度200°/s,最高频 率30.78MHz,然后计数通过4倍频,相当于实际信号的正反转脉冲最高频率为7.69MHz, 而FPGA的时钟频率为100M,也就是说,圆光栅的有效信号脉冲至少持续12个工作时 钟周期,也就是有效圆光栅信号的高低电平至少各持续6个周期以上,那么干扰信号的持 续时间低于6个周期,只有持续时间大于等于6个工作时钟周期的信号才能进入脉冲计数 部分。
由于各路计数脉冲干扰和输出信号的毛刺相对较少,在计数值脉冲值和最终输出信号 的滤波,采用的是多级D触发器实现的信号保持,就可以除去高频的毛刺和干扰。
具体实施方式三:结合图3说明本实施方式,本实施方式是对具体实施方式二所述的 四读数头增量式圆光栅耦合器的进一步限定,所述四倍频计数辨向模块的工作过程包括:
步骤一:判断输入的滤波信号的Z相是否是上升沿,若是,则计数值置零,转入步 骤四,若否,则转入步骤二;
步骤二:比较相邻两个时钟处输入的滤波信号的A相和B相是否发生超前或滞后, 若是,则转入步骤三,若否,则计数的值不变,转入步骤四;
步骤三:若滤波信号的B相滞后A相90°,在一个脉冲周期内,A相和B相发生四 次相对变化A相和B相每发生一次变化,计数值加1,转入步骤四;
若滤波信号的B相超前A相90°,在一个脉冲周期内,A相和B相发生四次相对变 化A相和B相每发生一次变化,计数值减1,转入步骤四;
步骤四:计数值进行锁存,返回步骤一。
在正转或者反转的一个脉冲周期T内,A、B两相信号总共有四次相对状态的变化, 采用这四次变化形成的四倍频信号进行计数就可以提高编码器的精度,采用的方法是基于 FPGA模块的有限状态机的方法实现信号的四倍频,可逆计数和辨向,利用FPGA模块, 实现多路信号的接口采集的芯片化设计,具体过程如下。
当圆光栅顺时钟正转时,读数头输出的B相信号滞后A相90°,而且每个脉冲周期 内,A、B两相信号会有这样的四次相对状态变化关系:每当发生 其中的一次状态变化时,就加计数一次,那么一个周期内可以实现四次加计数,也就实现 顺时钟正转状态下的四倍频计数。
当圆光栅编码器反转时,编码器输出的B相信号超前A相90°,A、B两相信号会有 如此的四次相对相位状态变化:每当发生一次其中的状态变化,就 减计数一次,那么一个周期内可以实现四次减计数,同理在逆时钟反转时也实现了四倍频 计数,只不过状态变化一次,进行一次减计数。
当产生干扰或者其他突发状况时,则有可能出现其他的状态变换过程,此时不进行计 数操作,保持计数值不变。
同时为了保证计数值得稳定,防止尖峰干扰脉冲带来的计数错误,将实时得到的计数 值通过锁存起来,待数据稳定后取出来使用,每次计数值当检测到Z相信号上升沿时, 则光栅盘已经旋转一周,这个时候就需要将置零计数器。
综合上述分析,可以做出基于FPGA模块设计的四倍频计数辨向模块的有限状态机 的状态转换图如图3所示,+1/-1表示计数器进行加/减1计数。然后通过FPGA模块将状 态转换图实现。
除了采用上述介绍的有限状态机的算法方案外,也可以采用简单的组合逻辑实现,采 取的方法是将A相信号与B相信号进行异或运算,然后通过锁存状态之后再进行异或运 算,从而得到A、B信号的四倍频。逻辑表达式如下:
XA = ( Q 1 n + 1 ⊕ Q 3 n + 1 ) · [ ( Q 1 n + 1 ⊕ Q 3 n + 1 ) ⊕ ( Q 2 n + 1 ⊕ Q 6 n + 1 ) ] XB = ( Q 2 n + 1 ⊕ Q 6 n + 1 ) · [ ( Q 1 n + 1 ⊕ Q 3 n + 1 ) ⊕ ( Q 2 n + 1 ⊕ Q 6 n + 1 ) ] ]]>
其中
Q 1 n + 1 = A , Q 2 n + 1 = Q 1 , Q 6 n + 1 = B , Q 3 n + 1 = Q 6 ]]>
AB表示A、B两相输入信号,XA,XB表示四倍频输出的正脉冲和负脉冲,正脉冲 即为正转脉冲,负脉冲即反转脉冲。
然后在对四路XA、XB信号分别进行计数即可得到每个读数头的读数值。
具体实施方式四:结合图4说明本实施方式,本实施方式是对具体实施方式三所述的 四读数头增量式圆光栅耦合器的进一步限定,融合反变换模块的工作过程包括:
步骤一:对输入的四路计数脉冲的计数值求平均,获得平均计数脉冲值;
步骤二:判断步骤一得到的平均计数脉冲值的最低位是否出现上升沿或者下降沿,若 是,转入步骤三,若否,则计数脉冲的A相和B相的电平保持不变,转入步骤一;
步骤三:比较所述平均计数脉冲值与上一个时钟的平均计数脉冲值的大小相差是否超 过1,若是,则计数脉冲的A相和B相的电平均置低位,转入步骤一,若否,则转入步 骤四;
步骤四:判断所述的平均计数脉冲值和上一个时钟以及上上个时钟的平均计数脉冲值 的大小关系,采用三相状态机对平均计数脉冲的A相、B相和Z相进行相应的状态转换, 获得一路A、B、Z相融合信号,再转入步骤一;
所述三相状态机包括A相、B相和Z相电平的8个状态,分别为000状态、001状态、 010状态、011状态、100状态、101状态、110状态和111状态;
在000状态,当此时平均计数脉冲值大于上一个时钟的计数值时,转入100状态;当 此时平均计数脉冲值为零,且上一个时钟的计数值大于上上个时钟的计数值时,转入101 状态;当此时平均计数脉冲值小于上一个时钟的计数值时,转入010状态;当此时平均计 数脉冲值为零,而且上一个时钟的计数值等于上上个时钟的计数值,转入001状态;当此 时平均计数脉冲值为零,且上一个时钟的计数值小于上上个时钟的计数值,转入011状态;
在001状态,当此时平均计数脉冲值大于上一个时钟的计数值时,转入100状态;当 此时平均计数脉冲值小于上一个时钟的计数值时,转入010状态;
在010状态,当此时平均计数脉冲值大于上一个时钟的计数值时,转入000状态;当 此时平均计数脉冲值为零,且上一个时钟的计数值大于上上个时钟的计数值时,转入001 状态;当此时平均计数脉冲值小于上一个时钟的计数值时,转入110状态;当此时平均计 数脉冲值为零,而且上一个时钟的计数值等于上上个时钟的计数值,转入011状态;当此 时平均计数脉冲值为零,且上一个时钟的计数值小于上上个时钟的计数值,转入111状态;
在011状态,当此时平均计数脉冲值大于上一个时钟的计数值时,转入000状态;当 此时平均计数脉冲值小于上一个时钟的计数值时,转入110状态;
在100状态,当此时平均计数脉冲值大于上一个时钟的计数值时,转入110状态;当 此时平均计数脉冲值为零,且上一个时钟的计数值大于上上个时钟的计数值时,转入111 状态;当此时平均计数脉冲值小于上一个时钟的计数值时,转入000状态;当此时平均计 数脉冲值为零,而且上一个时钟的计数值等于上上个时钟的计数值,转入101状态;当此 时平均计数脉冲值为零,且上一个时钟的计数值小于上上个时钟的计数值,转入001状态;
在101状态,当此时平均计数脉冲值大于上一个时钟的计数值时,转入110状态;当 此时平均计数脉冲值小于上一个时钟的计数值时,转入000状态;在110状态,当此时平 均计数脉冲值大于上一个时钟的计数值时,转入010状态;当此时平均计数脉冲值为零, 且上一个时钟的计数值大于上上个时钟的计数值时,转入011状态;当此时平均计数脉冲 值小于上一个时钟的计数值时,转入100状态;当此时平均计数脉冲值为零,而且上一个 时钟的计数值等于上上个时钟的计数值,转入111状态;当此时平均计数脉冲值为零,且 上一个时钟的计数值小于上上个时钟的计数值,转入101状态;
在111状态,当此时平均计数脉冲值大于上一个时钟的计数值时,转入010状态;当此 时平均计数脉冲值小于上一个时钟的计数值时,转入100状态。
本实施方式的融合反变换模块主要是将四路信号得到的计数脉冲值通过平均过程计 算得到平均计数脉冲值,然后由平均计数脉冲计数值反变换得到对应的一路A、B、Z相 方波信号。主要包含平均和融合反变换两个步骤,平均是通过计数得到了四个读数头的脉 冲计数值,然后对四个计数脉冲值进行平均,就得到了平均计数脉冲值。
融合反变换其实就是四倍频、计数和辨向过程的逆过程。先设计A、B两相反变换, 在加入Z相,也就是当正转时,在每次出现正脉冲的时候,根据现在的A、B相状态,对 其中一相的状态进行改变,使得A相超前B相,当反转的时候,也就是出现反脉冲的时 候,根据实时的A、B相的状态,改变其中一相的状态,使得B相超前A相,反复如此, 就得到了最终的A、B相信号,因此也采用有限状态机的思想进行实现。
通过四倍频计数得到的是平均的计数脉冲值,由利用有限状态机实现四倍频计数过程 中可知,发生正转时,每发生一次状态变化,计数器加一,而反转时,则计数器减一,因 此可以通过平均计数脉冲值得变化来判断正转还是反转,而且在没有Z相清零信号使能 时,由于A、B两相相对状态变化一次,计数器变化在+1或者-1之中,因此计数器每相 邻变化值之间差一个计数单位,也就是相邻的一次状态变化只会导致计数器值的最低位发 生变化,因此可以比较相邻的两个平均计数脉冲值的最低位,来判断正转还是反转了一个 分辨率。在Z相清零信号到达时,才会发生计数器值得突变,此时通过判断,强制使输 出信号全为低电平输出。
由于是四倍频计数的逆过程,同样采用状态机的思想,在得知了正转和反转之后,根 据当前的AB状态和正反转信息,就可以得到下一个AB状态,正转时,A、B两相信号 共有四次相对状态变化:反转时,A、B相则发生这样的四次相对 变化:周而复始,就可以得到整个A、B相信号。顺时针方向的箭 头构成了正转时的状态变化,计数值是增加的,+1表示计数值增加1,逆时针箭头构成 的闭环代表反转时,此时的计数值是不断减小的,-1表示计数值减1,构成箭头指向下一 个状态。
融合反变换模块具体实现中采用的是通过判断平均计数值的最低位的变化,也就是捕 捉最低位的上升下降沿,因此反变换的主时钟至少要是计数脉冲频率的两倍,而计数脉冲 的频率与四倍频计数采样的脉冲有关,同时也与A、B相的脉冲周期有关,本实施方式中 计数脉冲的频率至少是采样脉冲频率两倍以上,因此可以直接采用四倍频采样脉冲直接作 为反变换的主时钟,但是为了保证更高的精确和稳定性,这里将反变换的主时钟二倍频得 到的时钟作为四倍频采样的时钟。
为了反变换得到完整的A、B、Z相信号,在A、B两相的状态机基础上,加入Z相, 构成A、B、Z三个状态的状态机,这样就可以得到相对位置准确的A、B、Z相信号,同 时再通过原始输入的三相Z信号进行校准,完整的三相的状态变换图如图4所示:
+1表示相邻两次计数值增加1,-1则表示相邻两次计数值减小1,0表示相邻两次计 数值不变,箭头表示状态变换的方向,正转置零表示是在正转的状态下计数值归的零,反 转置零表示在反转的状态下计数值归的零,不转置零则是置零前两次计数值没有发生变化 的情况下置零的。
具体实施方式五:结合图5说明本实施方式,本实施方式是对具体实施方式四所述的 四读数头增量式圆光栅耦合器的进一步限定,融合反变换模块的工作过程还包括:
采用三相状态机对平均计数脉冲的A相、B相和Z相进行相应的状态转换,获得一 路A、B、Z相融合信号后,所述Z相融合信号为初步融合信号采用输入至融合反变 换模块的原始四路Z相信号对初步融合信号进行校正:
当所述原始四路Z相信号中不少于两路Z相信号出现零位时,且初步融合信号处 于高电平的零位信号时,输出Z′为高电平,否则为低电平,所述Z′为最终Z相融合信号。
为了更加准确的处理置零状态的情况,在判断计数值置零的时候,加入了判断置零前 两次相邻计数数值变化,以此判断其是正转状态置零的还是反转状态下置零的或者是不转 置零,然后分别进行相应的置位,这样就初步得到按照平均计数脉冲值得A、B、Z相信 号,由于其中在处理得到Z相时是以计数值归零的时刻判断,而实际中计数值归零可能 包含没有其他正反转角度值正好相等的情形,由于输入的四路Z相信号具有相当高的准 确性,因此在初步得到的Z相信号之后,结合原始输入的Z信号进行校正,最终就可以 得到与A、B相对位置关系准确而且与输入的各路Z信号相符的准确的Z相融合信号, 具体示意图如图5。
校正的具体算法:在Z相信号的反变换处理时,在通过三相状态机融合反变换过程 得到融合后Z相的初步融合信号以后,然后在输入的四路的Z相的修正下,融合得到 最终的Z相信号Z′,通过检测初步融合信号信号为高电平时,其相邻若干个时钟周期中 四路Z相信号出现高电平的零位校正信号的次数,在实施方式中默认不少于两路Z信号 出现零位时,初步融合信号也处于高电平的零位信号时,最终输出信号Z′才是高电平, 否则均为低电平。

四读数头增量式圆光栅耦合器.pdf_第1页
第1页 / 共15页
四读数头增量式圆光栅耦合器.pdf_第2页
第2页 / 共15页
四读数头增量式圆光栅耦合器.pdf_第3页
第3页 / 共15页
点击查看更多>>
资源描述

《四读数头增量式圆光栅耦合器.pdf》由会员分享,可在线阅读,更多相关《四读数头增量式圆光栅耦合器.pdf(15页珍藏版)》请在专利查询网上搜索。

1、(10)申请公布号 (43)申请公布日 (21)申请号 201410734719.8 (22)申请日 2014.12.04 G01B 11/26(2006.01) (71)申请人 哈尔滨工业大学 地址 150000 黑龙江省哈尔滨市南岗区西大 直街 92 号 (72)发明人 周彬彬 王舰 王常虹 程炳坤 (74)专利代理机构 哈尔滨龙科专利代理有限公 司 23206 代理人 高媛 (54) 发明名称 四读数头增量式圆光栅耦合器 (57) 摘要 四读数头增量式圆光栅耦合器, 涉及一种多 读数头的耦合器。为了解决现有多读数头圆光栅 测角系统测量角度值不准确的问题。本发明包括 四个读数头接口模块、 。

2、四个转换模块、 两个滤波模 块、 四个四倍频计数辨向模块、 融合反变换模块、 差分转换模块和输出接口模块 ; 通过转换模块和 滤波模块将四个读数头的圆光栅信号进行处理 后, 四倍频计数辨向模块采用有限状态机进行倍 频、 辨向和计数, 融合反变换模块再采用三相状态 机以及初始信号校正实现将思路计数值融合成一 路信号, 再依次经差分转换模块和输出接口模块 输出信号。本发明用于圆光栅测角系统。 (51)Int.Cl. (19)中华人民共和国国家知识产权局 (12)发明专利申请 权利要求书2页 说明书9页 附图3页 (10)申请公布号 CN 104482885 A (43)申请公布日 2015.04.。

3、01 CN 104482885 A 1/2 页 2 1.四读数头增量式圆光栅耦合器, 其特征在于, 所述耦合器包括四个读数头接口模块、 四个转换模块、 FPGA 模块、 差分转换模块和输出接口模块 ; FPGA 模块包括两个滤波模块、 四个四倍频计数辨向模块和融合反变换模块 ; 四个读数头接口模块输出的 RS422 差分信号分别发送至四个转换模块, 每个转换模块 输出 A、 B、 Z 相的 TTL 电平信号同时发送至第一滤波模块, 第一滤波模块输出的四路 TTL 电 平滤波信号分别发送至四个四倍频计数辨向模块, 每个四倍频计数辨向模块的计数脉冲值 信号同时发送至第二滤波模块, 第二滤波模块输出。

4、的四路计数脉冲值滤波信号同时输入至 融合反变换模块, 融合反变换模块输出的融合信号输入至差分转换模块, 差分转换模块输 出 RS422 差分信号输入至输出接口模块。 2.根据权利要求 1 所述的四读数头增量式圆光栅耦合器, 其特征在于, 所述滤波模块, 用于根据圆光栅的刻线数和细分倍数, 计算出最高转速下圆光栅输出信号的脉冲频率, 将 频率高于所述脉冲频率的输入信号作为干扰信号滤除。 3.根据权利要求 2 所述的四读数头增量式圆光栅耦合器, 其特征在于, 所述四倍频计 数辨向模块的工作过程包括 : 步骤一 : 判断输入的滤波信号的 Z 相是否是上升沿, 若是, 则计数值置零, 转入步骤四, 若。

5、否, 则转入步骤二 ; 步骤二 : 比较相邻两个时钟处输入的滤波信号的 A 相和 B 相是否发生超前或滞后, 若 是, 则转入步骤三, 若否, 则计数的值不变, 转入步骤四 ; 步骤三 : 若滤波信号的 B 相滞后 A 相 90, 在一个脉冲周期内, A 相和 B 相发生四次相 对变化A 相和 B 相每发生一次变化, 计数值加 1, 转入步骤四 ; 若滤波信号的 B 相超前 A 相 90, 在一个脉冲周期内, A 相和 B 相发生四次相对变化 A 相和 B 相每发生一次变化, 计数值减 1, 转入步骤四 ; 步骤四 : 计数值进行锁存, 返回步骤一。 4.根据权利要求 3 所述的四读数头增量式。

6、圆光栅耦合器, 其特征在于, 融合反变换模 块的工作过程包括 : 步骤一 : 对输入的四路计数脉冲的计数值求平均, 获得平均计数脉冲值 ; 步骤二 : 判断步骤一得到的平均计数脉冲值的最低位是否出现上升沿或者下降沿, 若 是, 转入步骤三, 若否, 则计数脉冲的 A 相和 B 相的电平保持不变, 转入步骤一 ; 步骤三 : 比较所述平均计数脉冲值与上一个时钟的平均计数脉冲值的大小相差是否超 过 1, 若是, 则计数脉冲的 A 相和 B 相的电平均置低位, 转入步骤一, 若否, 则转入步骤四 ; 步骤四 : 判断所述的平均计数脉冲值和上一个时钟以及上上个时钟的平均计数脉冲值 的大小关系, 采用三。

7、相状态机对平均计数脉冲的 A 相、 B 相和 Z 相进行相应的状态转换, 获 得一路 A、 B、 Z 相融合信号, 再转入步骤一 ; 所述三相状态机包括 A 相、 B 相和 Z 相电平的 8 个状态, 分别为 000 状态、 001 状态、 010 状态、 011 状态、 100 状态、 101 状态、 110 状态和 111 状态 ; 在 000 状态, 当此时平均计数脉冲值大于上一个时钟的计数值时, 转入 100 状态 ; 当此 时平均计数脉冲值为零, 且上一个时钟的计数值大于上上个时钟的计数值时, 转入 101 状 态 ; 当此时平均计数脉冲值小于上一个时钟的计数值时, 转入 010 状。

8、态 ; 当此时平均计数脉 权 利 要 求 书 CN 104482885 A 2 2/2 页 3 冲值为零, 而且上一个时钟的计数值等于上上个时钟的计数值, 转入 001 状态 ; 当此时平均 计数脉冲值为零, 且上一个时钟的计数值小于上上个时钟的计数值, 转入 011 状态 ; 在 001 状态, 当此时平均计数脉冲值大于上一个时钟的计数值时, 转入 100 状态 ; 当此 时平均计数脉冲值小于上一个时钟的计数值时, 转入 010 状态 ; 在 010 状态, 当此时平均计数脉冲值大于上一个时钟的计数值时, 转入 000 状态 ; 当此 时平均计数脉冲值为零, 且上一个时钟的计数值大于上上个时。

9、钟的计数值时, 转入 001 状 态 ; 当此时平均计数脉冲值小于上一个时钟的计数值时, 转入 110 状态 ; 当此时平均计数脉 冲值为零, 而且上一个时钟的计数值等于上上个时钟的计数值, 转入 011 状态 ; 当此时平均 计数脉冲值为零, 且上一个时钟的计数值小于上上个时钟的计数值, 转入 111 状态 ; 在 011 状态, 当此时平均计数脉冲值大于上一个时钟的计数值时, 转入 000 状态 ; 当此 时平均计数脉冲值小于上一个时钟的计数值时, 转入 110 状态 ; 在 100 状态, 当此时平均计数脉冲值大于上一个时钟的计数值时, 转入 110 状态 ; 当此 时平均计数脉冲值为零。

10、, 且上一个时钟的计数值大于上上个时钟的计数值时, 转入 111 状 态 ; 当此时平均计数脉冲值小于上一个时钟的计数值时, 转入 000 状态 ; 当此时平均计数脉 冲值为零, 而且上一个时钟的计数值等于上上个时钟的计数值, 转入 101 状态 ; 当此时平均 计数脉冲值为零, 且上一个时钟的计数值小于上上个时钟的计数值, 转入 001 状态 ; 在 101 状态, 当此时平均计数脉冲值大于上一个时钟的计数值时, 转入 110 状态 ; 当此 时平均计数脉冲值小于上一个时钟的计数值时, 转入 000 状态 ; 在 110 状态, 当此时平均计 数脉冲值大于上一个时钟的计数值时, 转入 010。

11、 状态 ; 当此时平均计数脉冲值为零, 且上一 个时钟的计数值大于上上个时钟的计数值时, 转入 011 状态 ; 当此时平均计数脉冲值小于 上一个时钟的计数值时, 转入 100 状态 ; 当此时平均计数脉冲值为零, 而且上一个时钟的计 数值等于上上个时钟的计数值, 转入 111 状态 ; 当此时平均计数脉冲值为零, 且上一个时钟 的计数值小于上上个时钟的计数值, 转入 101 状态 ; 在 111 状态, 当此时平均计数脉冲值大于上一个时钟的计数值时, 转入 010 状态 ; 当此 时平均计数脉冲值小于上一个时钟的计数值时, 转入 100 状态。 5.根据权利要求 4 所述的四读数头增量式圆光。

12、栅耦合器, 其特征在于, 融合反变换模 块的工作过程还包括 : 采用三相状态机对平均计数脉冲的 A 相、 B 相和 Z 相进行相应的状态转换, 获得一路 A、 B、 Z 相融合信号后, 所述 Z 相融合信号为初步融合信号采用输入至融合反变换模块的原 始四路 Z 相信号对初步融合信号进行校正 : 当所述原始四路 Z 相信号中不少于两路 Z 相信号出现零位时, 且初步融合信号处于 高电平的零位信号时, 输出 Z为高电平, 否则为低电平, 所述 Z为最终 Z 相融合信号。 权 利 要 求 书 CN 104482885 A 3 1/9 页 4 四读数头增量式圆光栅耦合器 技术领域 0001 本发明涉及。

13、一种多读数头的耦合器, 特别涉及一种四读数头增量式圆光栅耦合 器。 背景技术 0002 经济和生产力的迅猛发展也催生了对测角系统新的更多更高的需求, 对测试设备 的精度和性能的要求越来越高, 圆光栅测角系统具有结构简单、 测量范围大、 量测精度高和 动态特性好等优势, 因而广泛地应用在高精度惯性测试设备中, 而随着圆光栅测量仪器中 使用计算机进行信号处理, 大大提高了测量的快速性、 稳定性和精确性, 由于圆光栅传感器 的输出信号的质量基本上决定了信号处理结果的可靠性和准确性, 所以可以说圆光栅传感 器的精度很大程度上决定了高精度测角的精度, 而且圆光栅便于细分和融合, 提高分辨率 和精度, 利。

14、用圆光栅的多读数头的均化作用, 可以有效的消除圆光栅的安装偏心、 刻划误差 等对读数精度的影响, 而且稳定可靠。 0003 目前使用的多读数头圆光栅测角系统大都是直接将各读数头的信号直接送到控 制器进行信号的采集、 解码以及融合处理, 得到角度的平均值, 控制器根据实时的角度值再 完成后续控制操作。这样一来, 首先增加了控制器的负担, 使得控制器容易出现误操作, 特 别是在复杂系统中, 然后由于需要接到控制器, 信号的传输距离较远, 导致各读数头的信号 的实时性难以保证, 造成最终得到的角度值不准确, 尤其是在读数头个数较多的情况下, 再 者当系统读数头个数发生变化时, 由于其信号采集和处理集。

15、成到控制器中, 因此需要对控 制器进行较大的修改, 造成设备的维护难度加大。 由于这些问题的存在, 使得多读数头测角 系统的消除误差效果大打折扣。 0004 因此需要将多读数头圆光栅信号的采集和融合在接近读数头的位置直接完成, 同 时也要使得输出的信号具有较强的抗干扰能力, 这就需要在各读数头附近将多路信号耦合 成一路信号, 因此需要一种多读数头的耦合器。 发明内容 0005 本发明的目的是为了解决现有多读数头圆光栅测角系统测量角度值不准确的问 题, 本发明提供一种四读数头增量式圆光栅耦合器。 0006 本发明的四读数头增量式圆光栅耦合器, 0007 所述耦合器包括四个读数头接口模块、 四个转。

16、换模块、 FPGA 模块、 差分转换模块和 输出接口模块 ; 0008 FPGA 模块包括两个滤波模块、 四个四倍频计数辨向模块和融合反变换模块 ; 0009 四个读数头接口模块输出的 RS422 差分信号分别发送至四个转换模块, 每个转换 模块输出A、 B、 Z相的TTL电平信号同时发送至第一滤波模块, 第一滤波模块输出的四路TTL 电平滤波信号分别发送至四个四倍频计数辨向模块, 每个四倍频计数辨向模块的计数脉冲 值信号同时发送至第二滤波模块, 第二滤波模块输出的四路计数脉冲值滤波信号同时输入 说 明 书 CN 104482885 A 4 2/9 页 5 至融合反变换模块, 融合反变换模块输。

17、出的融合信号输入至差分转换模块, 差分转换模块 输出 RS422 差分信号输入至输出接口模块。 0010 所述滤波模块, 用于根据圆光栅的刻线数和细分倍数, 计算出最高转速下圆光栅 输出信号的脉冲频率, 将频率高于所述脉冲频率的输入信号作为干扰信号滤除。 0011 所述四倍频计数辨向模块的工作过程包括 : 0012 步骤一 : 判断输入的滤波信号的 Z 相是否是上升沿, 若是, 则计数值置零, 转入步 骤四, 若否, 则转入步骤二 ; 0013 步骤二 : 比较相邻两个时钟处输入的滤波信号的A相和B相是否发生超前或滞后, 若是, 则转入步骤三, 若否, 则计数的值不变, 转入步骤四 ; 001。

18、4 步骤三 : 若滤波信号的 B 相滞后 A 相 90, 在一个脉冲周期内, A 相和 B 相发生四 次相对变化A 相和 B 相每发生一次变化, 计数值加 1, 转入步骤四 ; 0015 若滤波信号的 B 相超前 A 相 90, 在一个脉冲周期内, A 相和 B 相发生四次相对变 化A 相和 B 相每发生一次变化, 计数值减 1, 转入步骤四 ; 0016 步骤四 : 计数值进行锁存, 返回步骤一。 0017 融合反变换模块的工作过程包括 : 0018 步骤一 : 对输入的四路计数脉冲的计数值求平均, 获得平均计数脉冲值 ; 0019 步骤二 : 判断步骤一得到的平均计数脉冲值的最低位是否出现。

19、上升沿或者下降 沿, 若是, 转入步骤三, 若否, 则计数脉冲的 A 相和 B 相的电平保持不变, 转入步骤一 ; 0020 步骤三 : 比较所述平均计数脉冲值与上一个时钟的平均计数脉冲值的大小相差是 否超过 1, 若是, 则计数脉冲的 A 相和 B 相的电平均置低位, 转入步骤一, 若否, 则转入步骤 四 ; 0021 步骤四 : 判断所述的平均计数脉冲值和上一个时钟以及上上个时钟的平均计数脉 冲值的大小关系, 采用三相状态机对平均计数脉冲的A相、 B相和Z相进行相应的状态转换, 获得一路 A、 B、 Z 相融合信号, 再转入步骤一 ; 0022 所述三相状态机包括 A 相、 B 相和 Z 。

20、相电平的 8 个状态, 分别为 000 状态、 001 状 态、 010 状态、 011 状态、 100 状态、 101 状态、 110 状态和 111 状态 ; 0023 在 000 状态, 当此时平均计数脉冲值大于上一个时钟的计数值时, 转入 100 状态 ; 当此时平均计数脉冲值为零, 且上一个时钟的计数值大于上上个时钟的计数值时, 转入 101 状态 ; 当此时平均计数脉冲值小于上一个时钟的计数值时, 转入 010 状态 ; 当此时平均计数 脉冲值为零, 而且上一个时钟的计数值等于上上个时钟的计数值, 转入 001 状态 ; 当此时平 均计数脉冲值为零, 且上一个时钟的计数值小于上上个。

21、时钟的计数值, 转入 011 状态 ; 0024 在 001 状态, 当此时平均计数脉冲值大于上一个时钟的计数值时, 转入 100 状态 ; 当此时平均计数脉冲值小于上一个时钟的计数值时, 转入 010 状态 ; 0025 在 010 状态, 当此时平均计数脉冲值大于上一个时钟的计数值时, 转入 000 状态 ; 当此时平均计数脉冲值为零, 且上一个时钟的计数值大于上上个时钟的计数值时, 转入 001 状态 ; 当此时平均计数脉冲值小于上一个时钟的计数值时, 转入 110 状态 ; 当此时平均计数 脉冲值为零, 而且上一个时钟的计数值等于上上个时钟的计数值, 转入 011 状态 ; 当此时平 。

22、均计数脉冲值为零, 且上一个时钟的计数值小于上上个时钟的计数值, 转入 111 状态 ; 0026 在 011 状态, 当此时平均计数脉冲值大于上一个时钟的计数值时, 转入 000 状态 ; 说 明 书 CN 104482885 A 5 3/9 页 6 当此时平均计数脉冲值小于上一个时钟的计数值时, 转入 110 状态 ; 0027 在 100 状态, 当此时平均计数脉冲值大于上一个时钟的计数值时, 转入 110 状态 ; 当此时平均计数脉冲值为零, 且上一个时钟的计数值大于上上个时钟的计数值时, 转入 111 状态 ; 当此时平均计数脉冲值小于上一个时钟的计数值时, 转入 000 状态 ; 。

23、当此时平均计数 脉冲值为零, 而且上一个时钟的计数值等于上上个时钟的计数值, 转入 101 状态 ; 当此时平 均计数脉冲值为零, 且上一个时钟的计数值小于上上个时钟的计数值, 转入 001 状态 ; 0028 在 101 状态, 当此时平均计数脉冲值大于上一个时钟的计数值时, 转入 110 状态 ; 当此时平均计数脉冲值小于上一个时钟的计数值时, 转入 000 状态 ; 在 110 状态, 当此时平 均计数脉冲值大于上一个时钟的计数值时, 转入 010 状态 ; 当此时平均计数脉冲值为零, 且 上一个时钟的计数值大于上上个时钟的计数值时, 转入 011 状态 ; 当此时平均计数脉冲值 小于上。

24、一个时钟的计数值时, 转入 100 状态 ; 当此时平均计数脉冲值为零, 而且上一个时钟 的计数值等于上上个时钟的计数值, 转入 111 状态 ; 当此时平均计数脉冲值为零, 且上一个 时钟的计数值小于上上个时钟的计数值, 转入 101 状态 ; 0029 在 111 状态, 当此时平均计数脉冲值大于上一个时钟的计数值时, 转入 010 状态 ; 当此时平均计数脉冲值小于上一个时钟的计数值时, 转入 100 状态。 0030 融合反变换模块的工作过程还包括 : 0031 采用三相状态机对平均计数脉冲的 A 相、 B 相和 Z 相进行相应的状态转换, 获得一 路 A、 B、 Z 相融合信号后, 。

25、所述 Z 相融合信号为初步融合信号采用输入至融合反变换模块 的原始四路 Z 相信号对初步融合信号 进行校正 : 0032 当所述原始四路 Z 相信号中不少于两路 Z 相信号出现零位时, 且初步融合信号 处于高电平的零位信号时, 输出 Z为高电平, 否则为低电平, 所述 Z为最终 Z 相融合信 号。 0033 本发明的有益效果在于, 本发明的四读数头耦合器除了能够提供耦合后 A、 B 相信 号之外, 而且也能提供标准的 Z 相校正信号。本发明中的四读数头耦合器适用于各种输出 信号为标准的 A、 B、 Z 相方波信号的圆光栅读数头, 因此, 它的广适性和实用性都要更好。 0034 同时本发明的兼容。

26、性和扩展性都非常优秀, 单个耦合器适用于不大于四个读数头 的圆光栅的测量, 而且可以进行级联, 测量多余四个读数头的多读数头圆光栅测量系统的 使用。而且在产品的升级和改进上, 本发明采用的核心处理器是 FPGA 模块而且留有很大的 设计裕度, 而且留有可编程的接口, 能够比较方便地进行产品的进一步升级和改进, 提高测 角的精度、 快速性和稳定性。 。本发明是针对于四个读数头的方波耦合器, 因此能提供更高 的测角精度, 并且很容易在此基础上修改成适用于不多于四个读数头的圆光栅多读数头测 角系统。 附图说明 0035 图 1 为具体实施方式一所述的四读数头增量式圆光栅耦合器的原理示意图。 0036。

27、 图 2 为具体实施方式一所述的 FPGA 模块的原理示意图。 0037 图 3 为具体实施方式三所述的四倍频计数辨向模块中有限状态机的状态转换图。 0038 图 4 为具体实施方式四所述的融合反变换模块的三相状态机的状态转换图。 0039 图 5 为具体实施方式五所述的 Z 相融合原理示意图。 说 明 书 CN 104482885 A 6 4/9 页 7 具体实施方式 0040 具体实施方式一 : 结合图1和图2说明本实施方式, 本实施方式所述的四读数头增 量式圆光栅耦合器, 所述耦合器包括四个读数头接口模块、 四个转换模块、 FPGA 模块、 差分 转换模块和输出接口模块 ; 0041 F。

28、PGA 模块包括两个滤波模块、 四个四倍频计数辨向模块和融合反变换模块 ; 四个 读数头接口模块输出的 RS422 差分信号分别发送至四个转换模块, 每个转换模块输出 A、 B、 Z相的TTL电平信号同时发送至第一滤波模块, 第一滤波模块输出的四路TTL电平滤波信号 分别发送至四个四倍频计数辨向模块, 每个四倍频计数辨向模块的计数脉冲值信号同时发 送至第二滤波模块, 第二滤波模块输出的四路计数脉冲值滤波信号同时输入至融合反变换 模块, 融合反变换模块输出的融合信号输入至差分转换模块, 差分转换模块输出 RS422 差 分信号输入至输出接口模块。 0042 本实施方式主要是实现基于四均布增量式方。

29、波输出信号读数头的信号采集, 计 数, 并且融合成一路信号输出。具体的工作过程如下 : 安装在光栅圆环上的四个均布读数 头将检测得到的角度信息编码成 A、 B、 Z 相的 RS422 的差分方波脉冲信号, 通过分别电平转 换, 将 RS422 差分信号转换为 FPGA 模块便于处理的 TTL 电平, 然后对各个读数头的脉冲信 号分别进行倍频、 计数和辨向, 就可以得到各个读数头的计数脉冲数, 然后对这四个读数头 的计数脉冲值取平均值, 将得到的平均值结合原始的 A、 B、 Z 相基准信号变换得到对应的一 组 A、 B、 Z 相方波信号, 然后将 TTL 电平转换成 RS422 接口的差分信号通。

30、过输出接口传输给 后续的控制处理器。 0043 读数头接口模块是实现四个读数头输入信号与 FPGA 模块的连接和将融合得到的 信号进行输出, 是整个耦合器的窗口。由于输出接口模块是高密度的 26 孔 DB 型插头, 包括 电源和 A、 B、 Z 相的差分信号以及警示辅助位, 为了方便使用, 本实施方式的输入输出接口 模块也都采用相同的插头。 0044 本实施方式, 读数头由 5V 供电, 供电来自输出的插头, 项目中输入的是 RS422 信 号, 为了保持输入输出的一致性, 输出的 A、 B 和 Z 相信号都是 RS422 接口的方波差分信号。 0045 转换模块主要实现各个读数头输入的RS4。

31、22差分信号转换成TTL电平和输出信号 的 TTL 电平转换成 RS422 差分信号。 0046 由于读数头输出的 A、 B 和 Z 相信号都是 RS422 接口的差分信号, 而 FPGA 模块只 能进行TTL电平的相应处理, 因此必须将各读数头的信号通过电平转换成TTL电平, 为了本 实施方式的高速性要求, 这里采用的是高速 RS422 接收转换芯片 MAX3280, 芯片速度可达到 52Mbps, 而且外围配置电路非常少, 3.3V 供电, 功耗低, 稳定性好, 为了增大抗干扰能力, 在 差分信号接收端之间连接了 120 欧姆的匹配电阻。 0047 由于 RS422 差分信号的抗干扰能力强。

32、, 传输距离远, 因此在本实施方式处理得到 的融合信号后, 进行 TTL-RS422 电平转换成差分信号再传输给后续的控制器进行处理。也 要求采用的是使用高速的 TTL-RS422 转换芯片, 本实施方式中采用的是 MAX3295, 速率可达 20Mbps, 将 FPGA 模块融合得到的 A 相 (AINI)、 B 相 (BINI) 和 Z 相 (ZINI) 分别转换成 2 路 RS422 差分信号连接输出接口。 0048 信号通过了读数头接口模块的输入处理和转换模块的电平转换后, 进入了 FPGA 说 明 书 CN 104482885 A 7 5/9 页 8 模块的外围 I/O 口, 到达内。

33、部的可编程门阵列进行采集, 四倍频, 计数和辨向以及融合处 理, FPGA 及其外围配置电路是系统的核心部分。 0049 本实施方式的 FPGA 模块采用 Altera 公司 Cyclone II 系列的 EP2C5T144I8 实现。 0050 同时 FPGA 作为一种可编程逻辑门处理芯片, 在处理时序时非常方便, 这就要求它 本身的时钟管理功能能提供多种准确稳定的时钟信号, 为了达到这个目的, FPGA 模块中采 用了 PLL, 这是一个可以产生各种稳定频率的分频倍频模块。本实施方式采用的 EP2C5T144 芯片内部有两个 PLL, 为了保证 PLL 的正常工作, 在芯片 PLL 供电管。

34、脚都加入了去耦和滤波 电容, 确保输入高质量的模拟和数字电源。 0051 本实施方式中的电源模块提供的电源包括 : FPGA 模块供电需要 3.3V 和 1.2V 两 种, 读数头接口模块、 转换模块块和输出接口模块都需要 3.3V 供电, 而各读数头接口模块 需要的供电电源则是5V, 本实施方式通过输出接口模块引入5V直流电平, 因此需要将5V转 换成 3.3V 和 1.2V。具体实施方式二 : 本实施方式是对具体实施方式一所述的四读数头增 量式圆光栅耦合器的进一步限定, 所述滤波模块, 用于根据圆光栅的刻线数和细分倍数, 计 算出最高转速下圆光栅输出信号的脉冲频率, 将频率高于所述脉冲频率。

35、的输入信号作为干 扰信号滤除。 0052 由于工作现场的机械振动和电磁干扰以及软件逻辑设计中的竞争冒险, 导致了输 入信号和中间处理信号出现毛刺尖峰现象, 严重影响了测角精度。 0053 存在由于干扰所产生的毛刺脉冲和尖峰的频率一般都远高于圆光栅 A、 B、 Z 相的 脉冲频率, 因此在输入时采用一种高频保持滤波方法, 即 : 根据圆光栅的刻线数和细分倍 数, 计算出最高转速下圆光栅输出信号的脉冲频率, 作为系统的最高频率, 将频率高于这个 最高频率的信号作为干扰信号滤除。 0054 例如 : 圆光栅刻线是 55400, 选用的读数头细分 1000 倍, 最高速度 200 /s, 最高 频率 。

36、30.78MHz, 然后计数通过 4 倍频, 相当于实际信号的正反转脉冲最高频率为 7.69MHz, 而 FPGA 的时钟频率为 100M, 也就是说, 圆光栅的有效信号脉冲至少持续 12 个工作时钟周 期, 也就是有效圆光栅信号的高低电平至少各持续 6 个周期以上, 那么干扰信号的持续时 间低于6个周期, 只有持续时间大于等于6个工作时钟周期的信号才能进入脉冲计数部分。 0055 由于各路计数脉冲干扰和输出信号的毛刺相对较少, 在计数值脉冲值和最终输出 信号的滤波, 采用的是多级 D 触发器实现的信号保持, 就可以除去高频的毛刺和干扰。 0056 具体实施方式三 : 结合图 3 说明本实施方。

37、式, 本实施方式是对具体实施方式二所 述的四读数头增量式圆光栅耦合器的进一步限定, 所述四倍频计数辨向模块的工作过程包 括 : 0057 步骤一 : 判断输入的滤波信号的 Z 相是否是上升沿, 若是, 则计数值置零, 转入步 骤四, 若否, 则转入步骤二 ; 0058 步骤二 : 比较相邻两个时钟处输入的滤波信号的A相和B相是否发生超前或滞后, 若是, 则转入步骤三, 若否, 则计数的值不变, 转入步骤四 ; 0059 步骤三 : 若滤波信号的 B 相滞后 A 相 90, 在一个脉冲周期内, A 相和 B 相发生四 次相对变化A 相和 B 相每发生一次变化, 计数值加 1, 转入步骤四 ; 0。

38、060 若滤波信号的 B 相超前 A 相 90, 在一个脉冲周期内, A 相和 B 相发生四次相对变 化A 相和 B 相每发生一次变化, 计数值减 1, 转入步骤四 ; 说 明 书 CN 104482885 A 8 6/9 页 9 0061 步骤四 : 计数值进行锁存, 返回步骤一。 0062 在正转或者反转的一个脉冲周期 T 内, A、 B 两相信号总共有四次相对状态的变化, 采用这四次变化形成的四倍频信号进行计数就可以提高编码器的精度, 采用的方法是基于 FPGA 模块的有限状态机的方法实现信号的四倍频, 可逆计数和辨向, 利用 FPGA 模块, 实现 多路信号的接口采集的芯片化设计, 具。

39、体过程如下。 0063 当圆光栅顺时钟正转时, 读数头输出的B相信号滞后A相90, 而且每个脉冲周期 内, A、 B 两相信号会有这样的四次相对状态变化关系 :每当发生其中的 一次状态变化时, 就加计数一次, 那么一个周期内可以实现四次加计数, 也就实现顺时钟正 转状态下的四倍频计数。 0064 当圆光栅编码器反转时, 编码器输出的 B 相信号超前 A 相 90, A、 B 两相信号会有 如此的四次相对相位状态变化 :每当发生一次其中的状态变化, 就减计 数一次, 那么一个周期内可以实现四次减计数, 同理在逆时钟反转时也实现了四倍频计数, 只不过状态变化一次, 进行一次减计数。 0065 当产。

40、生干扰或者其他突发状况时, 则有可能出现其他的状态变换过程, 此时不进 行计数操作, 保持计数值不变。 0066 同时为了保证计数值得稳定, 防止尖峰干扰脉冲带来的计数错误, 将实时得到的 计数值通过锁存起来, 待数据稳定后取出来使用, 每次计数值当检测到 Z 相信号上升沿时, 则光栅盘已经旋转一周, 这个时候就需要将置零计数器。 0067 综合上述分析, 可以做出基于 FPGA 模块设计的四倍频计数辨向模块的有限状态 机的状态转换图如图 3 所示, +1/-1 表示计数器进行加 / 减 1 计数。然后通过 FPGA 模块将 状态转换图实现。 0068 除了采用上述介绍的有限状态机的算法方案外。

41、, 也可以采用简单的组合逻辑实 现, 采取的方法是将A相信号与B相信号进行异或运算, 然后通过锁存状态之后再进行异或 运算, 从而得到 A、 B 信号的四倍频。逻辑表达式如下 : 0069 0070 其中 0071 0072 AB 表示 A、 B 两相输入信号, XA, XB 表示四倍频输出的正脉冲和负脉冲, 正脉冲即 为正转脉冲, 负脉冲即反转脉冲。 0073 然后在对四路 XA、 XB 信号分别进行计数即可得到每个读数头的读数值。 0074 具体实施方式四 : 结合图 4 说明本实施方式, 本实施方式是对具体实施方式三所 述的四读数头增量式圆光栅耦合器的进一步限定, 融合反变换模块的工作过。

42、程包括 : 0075 步骤一 : 对输入的四路计数脉冲的计数值求平均, 获得平均计数脉冲值 ; 0076 步骤二 : 判断步骤一得到的平均计数脉冲值的最低位是否出现上升沿或者下降 沿, 若是, 转入步骤三, 若否, 则计数脉冲的 A 相和 B 相的电平保持不变, 转入步骤一 ; 0077 步骤三 : 比较所述平均计数脉冲值与上一个时钟的平均计数脉冲值的大小相差是 说 明 书 CN 104482885 A 9 7/9 页 10 否超过 1, 若是, 则计数脉冲的 A 相和 B 相的电平均置低位, 转入步骤一, 若否, 则转入步骤 四 ; 0078 步骤四 : 判断所述的平均计数脉冲值和上一个时钟。

43、以及上上个时钟的平均计数脉 冲值的大小关系, 采用三相状态机对平均计数脉冲的A相、 B相和Z相进行相应的状态转换, 获得一路 A、 B、 Z 相融合信号, 再转入步骤一 ; 0079 所述三相状态机包括 A 相、 B 相和 Z 相电平的 8 个状态, 分别为 000 状态、 001 状 态、 010 状态、 011 状态、 100 状态、 101 状态、 110 状态和 111 状态 ; 0080 在 000 状态, 当此时平均计数脉冲值大于上一个时钟的计数值时, 转入 100 状态 ; 当此时平均计数脉冲值为零, 且上一个时钟的计数值大于上上个时钟的计数值时, 转入 101 状态 ; 当此时。

44、平均计数脉冲值小于上一个时钟的计数值时, 转入 010 状态 ; 当此时平均计数 脉冲值为零, 而且上一个时钟的计数值等于上上个时钟的计数值, 转入 001 状态 ; 当此时平 均计数脉冲值为零, 且上一个时钟的计数值小于上上个时钟的计数值, 转入 011 状态 ; 0081 在 001 状态, 当此时平均计数脉冲值大于上一个时钟的计数值时, 转入 100 状态 ; 当此时平均计数脉冲值小于上一个时钟的计数值时, 转入 010 状态 ; 0082 在 010 状态, 当此时平均计数脉冲值大于上一个时钟的计数值时, 转入 000 状态 ; 当此时平均计数脉冲值为零, 且上一个时钟的计数值大于上上。

45、个时钟的计数值时, 转入 001 状态 ; 当此时平均计数脉冲值小于上一个时钟的计数值时, 转入 110 状态 ; 当此时平均计数 脉冲值为零, 而且上一个时钟的计数值等于上上个时钟的计数值, 转入 011 状态 ; 当此时平 均计数脉冲值为零, 且上一个时钟的计数值小于上上个时钟的计数值, 转入 111 状态 ; 0083 在 011 状态, 当此时平均计数脉冲值大于上一个时钟的计数值时, 转入 000 状态 ; 当此时平均计数脉冲值小于上一个时钟的计数值时, 转入 110 状态 ; 0084 在 100 状态, 当此时平均计数脉冲值大于上一个时钟的计数值时, 转入 110 状态 ; 当此时。

46、平均计数脉冲值为零, 且上一个时钟的计数值大于上上个时钟的计数值时, 转入 111 状态 ; 当此时平均计数脉冲值小于上一个时钟的计数值时, 转入 000 状态 ; 当此时平均计数 脉冲值为零, 而且上一个时钟的计数值等于上上个时钟的计数值, 转入 101 状态 ; 当此时平 均计数脉冲值为零, 且上一个时钟的计数值小于上上个时钟的计数值, 转入 001 状态 ; 0085 在 101 状态, 当此时平均计数脉冲值大于上一个时钟的计数值时, 转入 110 状态 ; 当此时平均计数脉冲值小于上一个时钟的计数值时, 转入 000 状态 ; 在 110 状态, 当此时平 均计数脉冲值大于上一个时钟的。

47、计数值时, 转入 010 状态 ; 当此时平均计数脉冲值为零, 且 上一个时钟的计数值大于上上个时钟的计数值时, 转入 011 状态 ; 当此时平均计数脉冲值 小于上一个时钟的计数值时, 转入 100 状态 ; 当此时平均计数脉冲值为零, 而且上一个时钟 的计数值等于上上个时钟的计数值, 转入 111 状态 ; 当此时平均计数脉冲值为零, 且上一个 时钟的计数值小于上上个时钟的计数值, 转入 101 状态 ; 0086 在 111 状态, 当此时平均计数脉冲值大于上一个时钟的计数值时, 转入 010 状态 ; 当此时平均计数脉冲值小于上一个时钟的计数值时, 转入 100 状态。 0087 本实。

48、施方式的融合反变换模块主要是将四路信号得到的计数脉冲值通过平均过 程计算得到平均计数脉冲值, 然后由平均计数脉冲计数值反变换得到对应的一路 A、 B、 Z 相 方波信号。主要包含平均和融合反变换两个步骤, 平均是通过计数得到了四个读数头的脉 冲计数值, 然后对四个计数脉冲值进行平均, 就得到了平均计数脉冲值。 说 明 书 CN 104482885 A 10 8/9 页 11 0088 融合反变换其实就是四倍频、 计数和辨向过程的逆过程。先设计 A、 B 两相反变换, 在加入Z相, 也就是当正转时, 在每次出现正脉冲的时候, 根据现在的A、 B相状态, 对其中一 相的状态进行改变, 使得A相超前。

49、B相, 当反转的时候, 也就是出现反脉冲的时候, 根据实时 的 A、 B 相的状态, 改变其中一相的状态, 使得 B 相超前 A 相, 反复如此, 就得到了最终的 A、 B 相信号, 因此也采用有限状态机的思想进行实现。 0089 通过四倍频计数得到的是平均的计数脉冲值, 由利用有限状态机实现四倍频计 数过程中可知, 发生正转时, 每发生一次状态变化, 计数器加一, 而反转时, 则计数器减一, 因此可以通过平均计数脉冲值得变化来判断正转还是反转, 而且在没有 Z 相清零信号使能 时, 由于 A、 B 两相相对状态变化一次, 计数器变化在 +1 或者 -1 之中, 因此计数器每相邻变 化值之间差一个计数单位, 也就是相邻的一次状态变化只会导致计数器值的最低位发生变 化, 因此可以比较相邻的两个平均计数脉冲值的最低位, 来判断正转还是反转了一个分辨 率。在 Z 相清零信号到达时, 才会发生计数器值。

展开阅读全文
相关资源
猜你喜欢
相关搜索

当前位置:首页 > 物理 > 测量;测试


copyright@ 2017-2020 zhuanlichaxun.net网站版权所有
经营许可证编号:粤ICP备2021068784号-1