应用于运动控制器的高速位置捕捉实现方法及装置的制造方法
【技术领域】
[0001]本发明涉及运动控制设备技术领域，尤其涉及应用于运动控制器的高速位置捕捉实现方法及装置。
【背景技术】
[0002]在自动控制系统中，经常需要用外部信号实时触发、捕捉及存储伺服位置，特别是印刷和包装设备的控制中，需要用色标信号实时跟踪印刷位置，来完成模切、冲孔及封口等操作。在目前运动控制器中，运动控制器在控制目标运动时，目标一般以预定的轨迹进行运动；ARM计算出目标运行的位置，再向伺服驱动器发送控制信号，伺服驱动器控制伺服电机以某种运转方式运行一定的转数，使得目标到达预定位置。然而这种开环控制不能准确得到高速运行中目标的实际位置。无法精确捕捉伺服电机的位置，捕捉误差大。
【发明内容】
[0003]本发明的目的在于解决现有市场的不足，提供应用于运动控制器的高速位置捕捉实现方法和装置，该方法和装置均可以准确获得高速运动中的物体位置。可以满足高速、高精度的应用，运动控制器可实时接收和解析伺服电机的编码器的差分信号，用硬件逻辑电路来完成位置的实时捕捉。
[0004]为达到上述目的，本发明采用的技术方案为:
应用于运动控制器的高速位置捕捉实现方法:
所述运动控制器包括FPGA和ARM，目标在伺服电机的运转带动下改变位置；
编码器将目标的移动信息以编码器差分信号的形式发送给GP1模块，其中，编码器差分信号包括A、B、Z信号；GP10模块将A、B信号发送给FPGA的编码信号解码模块，Z信号发送给编码触发寄存器，编码计数模块根据编码信号解码模块的解码信息进行计数，计数的数值信息存储于编码触发寄存器；编码触发寄存器根据Z信号对数值信息进行锁存；
FPGA将单时钟周期内存入编码触发寄存器的数值信息传输给ARM，ARM根据数值信息对目标位置进行计算。
[0005]为了进一步提尚捕捉精度；还包括:
设置有用于感应目标位置的传感器；
FPGA接收来自ARM的控制信号，FPGA根据控制信号计算出伺服电机需要旋转到的位置点(即伺服电机需要旋转到哪个位置)，并控制脉冲发送模块向伺服电机的伺服驱动器发送脉冲信号，脉冲发送模块设有脉冲计数模块和脉冲触发寄存器，脉冲计数模块根据脉冲信号进行计数，并将该计数的数值信息存储于脉冲触发寄存器；
当传感器感应到目标时，传感器向GP1模块发送感应信号，GP1发送触发信号给编码触发寄存器和脉冲触发寄存器；编码触发寄存器、脉冲触发寄存器根据触发信号分别对数值信息进行锁存；FPGA将两个锁存的数值信息发送给ARM，ARM根据两个数值信息计算出目标位置，实现目标的高速位置捕捉。
[0006]进一步地，计数过程中，伺服电机正转时，脉冲计数模块、编码计数模块均以加的方式计数，伺服电机反转时，脉冲计数模块、编码计数模块均以减的方式计数。
[0007]即脉冲信号中，控制伺服电机正转的信号在计数时，以加的方式增加计数，控制伺服电机反转的信号在计数时，以减的方式减少计数。编码计数模块根据编码器差分信号的解码信息进行计数，反馈伺服电机正转的信息在计数时，以加的方式增加计数，反馈伺服电机反转的信息在计数时，以减的方式减少计数。
[0008]在进行锁存时，以触发信号的上升沿或下降沿有效，即当触发信号从低电平变为高电平时，或者从高电平变为低电平时，编码触发寄存器、脉冲触发寄存器进行锁存。在没有外部触发信号时，编码触发寄存器根据Z信号进行锁存，如通过Z信号的上升沿或下降沿进行锁存。
[0009]锁存之后，当触发信号再次反转时，解除锁存，更新相应寄存器的值。即:如果锁存在上升沿进行，则在下降沿解除锁存。从而使得计数、锁存的连续。
[0010]应用于运动控制器的高速位置捕捉实现装置，其包括:
用于将伺服电机的运转信息以编码器差分信号的形式对外发送的编码器，其中，编码器差分信号包括A、B、Z信号；
FPGA，FPGA设有用于解码A、B信号的编码信号解码模块、用于根据编码信号解码模块的解码信息进行计数的编码计数模块以及用于存储编码计数模块计数的数值信息的编码触发寄存器；
用于将A、B信号发送给FPGA的编码信号解码模块、Z信号发送给编码触发寄存器接收编码器信号的GP1模块；
用于将单时钟周期内存入编码触发寄存器的数值信息读取、并计算目标位置的ARM。
[0011]应用于运动控制器的高速位置捕捉实现装置，还包括:
用于感应目标位置、并向GP1模块发送感应信号的传感器；
FPGA设有根据ARM的控制信号向伺服驱动器发送脉冲信号的脉冲发送模块，脉冲模块设有用于根据脉冲信号进行计数的脉冲计数模块以及用于存储该计数的数值信息的脉冲触发寄存器。
[0012]本发明取得的有益效果为:本发明通过实时接收和解析伺服电机的编码器的差分信号，对编码计数模块的计数信息进行锁存，用硬件逻辑电路来完成位置的实时捕捉，从而实现高速运转的目标捕捉。
【附图说明】
[0013]图1为本发明的工作原理示意图。
【具体实施方式】
[0014]下面结合【具体实施方式】对本发明做进一步地说明。
[0015]实施例:参见图1。
[0016]运动控制器中用FPGA作为控制模块、ARM作为运算处理模块，FPGA采用verilog编写IP核，用来完成伺服驱动的差分信号的解码和实时计数。目标通过伺服电机的运转改变其位置，伺服电机在运转过程中，通过编码器反馈其位置信号；当寄存器有触发信号输入时，利用其上升沿或者下降沿完成位置锁存，同时在单时钟周期内存入锁存寄存器，方便ARM通过总线读取和位置修正。FPGA为逻辑电路。伺服电机通过传动机构(如皮带传动机构)带动目标移动，传动机构同时与编码器连接，带动编码器，编码器感应传动机构的位移或转动角度，从而获得目标的位移或转动角度。
[0017]FPGA接收来自ARM的控制信号，根据控制信号计算出伺服电机需要旋转的位置点，并控制脉冲发送模块向伺服驱动器发送脉冲信号，脉冲发送模块设有脉冲计数模块和脉冲触发寄存器，脉冲计数模块根据脉冲信号进行计数，并存储于脉冲触发寄存器；
GP1模块接收编码器反馈的编码器差分信号和触发信号，编码器差分信号包括A、B、Z信号；触发信号由传感器等产生，当传感器感应到目标后，传感器向GP1模块发送感应信号，GP1模块向脉冲触发寄存器、编码触发寄存器发送触发信号；其中编码器的差分信号(A、B信号)发送给编码信号解码模块；编码计数模块根据编码信号