一种基于fpga的嵌入式数字控制器及其控制方法
【技术领域】
[0001]本发明属于数控系统领域，具体是一种基于FPGA的嵌入式数字控制器及其控制方法，属于基于FPGA的嵌入式数字控制器及其控制方法的创新技术。
【背景技术】
[0002]随着用户对数控加工精度要求的提高，以及机器视觉技术在工业领域应用的成熟，使用机器视觉跟踪加工，测量轨迹加工误差，进行在线误差补偿控制的方式正成为提高数控加工精度一种新手段。然而以工业PC机为控制核心的数控系统，其硬件不是针对实时控制设计的，并不能较好地满足实时控制需要，也不能实现在线误差补偿控制。
【发明内容】
[0003]为解决现有技术的不足，本发明的目的是提供一种基于FPGA的嵌入式数字控制器，该控制器能够实现加工过程中通过机器视觉跟踪测量加工轨迹误差进行在线补偿控制，有效地提高数控加工精度，保证加工质量。
[0004]本发明的另一目的是提供一种基于FPGA的嵌入式数字控制器的控制方法。本发明控制简单方便。
[0005]本发明的目的通过采用以下的技术方案来实现:
本发明的基于FPGA的嵌入式数字控制器，包括嵌入式多核控制系统、信号检测模块、视觉跟踪模块、脉冲输出光电隔离模块、模拟控制模块，信号检测模块的输出端及视觉跟踪模块的输出端分别与嵌入式多核控制系统的输入端连接，嵌入式多核控制系统的输出端分别与脉冲输出光电隔离模块的输入端及模拟控制模块的输入端连接，脉冲输出光电隔离模块的输出端与伺服驱动器连接，伺服驱动器驱动伺服电机，模拟控制模块的输出端与气泵连接。
[0006]本发明基于FPGA的嵌入式数字控制器的控制方法，包括如下过程:
1)系统上电后，由嵌入式多核控制系统通过脉冲输出光电隔离模块向伺服驱动器输出插补脉冲控制机床的X，Y轴回原位运动，并通过信号检测模块输入原位信号到32位RISC软核处理器，直到机床的X轴、Y轴移动到原点位置；
2)视觉跟踪模块通过摄像头获取实时加工轨迹视频，视频解码器在完成加工轨迹视频信号模数转换以及RGB、场信号、行信号的分离后通过I2C总线将视频数据送到数据传输接口，然后再将视频数据送到嵌入式多核控制系统内的第一 IP核；
3)嵌入式多核控制系统内的第一IP核获取视觉跟踪模块传输进来的数据后进行加工轨迹图像处理及加工轨迹误差计算，所得误差传给32位RISC软核处理器，32位RISC软核处理器对预加工轨迹进行补偿后向第二 IP核发送预加工轨迹数据，第二 IP核负责预加工轨迹数据插补脉冲生成，并经过脉冲输出光电隔离模块4输出插补脉冲；
4)嵌入式多核控制系统内的32位RISC软核处理器产生模拟PWM信号，经过滤波放大电路输出到电磁阀实现电磁阀的比例控制； 5)加工过程中，嵌入式多核控制系统内的32位RISC软核处理器实时检测信号检测模块输入的限位信号，当机床X轴、Y轴运动超出规定的行程时，限位信号输出高电平，此时32位RISC软核处理器向第二 IP核发出停止加工轨迹插补脉冲输出的指令。
[0007]与现有技术相比，本发明的技术方案的有益效果是:
1)本发明配有视觉跟踪模块，能够对轨迹加工误差进行在线补偿控制，有效提高加工的精度，保证加工质量；
2)本发明的嵌入式多核控制系统采用FPGA芯片，其内在的并行机制决定了它的高速处理能力远远优于传统工控PC机所采用的串行执行架构。因而能大大提高数控系统的响应速度，在保证加工质量的前提下，提高加工效率。
[0008]3)本发明将满足软硬件可裁剪、实时性强等要求的嵌入式技术与数控系统相结合，产生嵌入式数控系统，有效地提高数控加工精度，保证加工质量；
4)本发明的基于FPGA的嵌入式数字控制器的控制方法控制简单方便。
【附图说明】
[0009]图1是本发明基于FPGA的嵌入式数字控制器的系统框图。
【具体实施方式】
[0010]下面结合附图和实施例对本发明的技术方案做进一步的说明，附图用来提供对本发明的进一步理解，并且构成说明书的一部分，与本发明的实施例共同用于解释本发明，并不构成对本发明的限制。
[0011]实施例1
如图1所示，本发明的基于FPGA的嵌入式数字控制器，包括嵌入式多核控制系统1、信号检测模块2、视觉跟踪模块3、脉冲输出光电隔离模块4、模拟控制模块5，信号检测模块2的输出端及视觉跟踪模块3的输出端分别与嵌入式多核控制系统I的输入端连接，嵌入式多核控制系统I的输出端分别与脉冲输出光电隔离模块4的输入端及模拟控制模块5的输入端连接，脉冲输出光电隔离模块4的输出端与伺服驱动器连接，伺服驱动器驱动伺服电机，模拟控制模块5的输出端与气泵连接。
[0012]本实施例中，嵌入式多核控制系统I采用Xilinx FPGA XC4VFX12芯片，包括通过Xilinx xps开发平台定制的嵌入在FPGA XC4VFX12中的32位RISC软核处理器11，以及通过Verilog HDL设计而成第一 IP核12和第二 IP核13。其中32位RISC软核处理器11负责系统任务管理调度，以及检测信号检测模块2所输入的信号和向模拟控制模块5输出PWM信号，第一 IP核12负责视觉跟踪模块3所输入的加工轨迹图像处理及加工轨迹误差计算，第二 IP核13负责生成加工轨迹插补脉冲，第一 IP核12的输出端与32位RISC软核处理器11输入端连接，32位RISC软核处理器11输出端与第二 IP核13的输入端连接。Xilinx FPGA XC4VFX12芯片支持6路TTL电平信号输入，10路0~9000Hz方波信号输出，I路PWM信号输出以及I路视频信号输入。
[0013]本实施例中，上述信号检测模块2包括有霍尔开关21及光电隔离电路22，霍尔开关21输出端与光电隔离电路22的输入端连接，光电隔离电路22的输出端与嵌入式多核控制系统I的输入端连接。
[0014]本实施例中，上述霍尔开关21由6个霍尔传感器组成，分别用于机床X轴、Y轴4路限位信号以及X轴、Y轴两路原位信号的检测，光电隔离电路22输出6路TTL电平信号到32位RISC软核处理器11，光电隔离电路22由3片TLP521-2芯片组成。
[0015]本实施例中，上述视觉跟踪3包括摄像头31、视频解码器32、数据传输接口 33，其中摄像头31的输出端与视频解码器32的输入端连接，视频解码器32的输出端与数据传输接口 33的输入端连接，数据传输接口 33的输出端与嵌入式多核控制系统I的输入端连接。
[0016]本实施例中，上述摄像头31为一般模拟摄像头，用于获取实时加工轨迹视频，视频解码32采用ADV7181C芯片，用于完成加工轨迹视频信号模数转换以及RGB、场信号、行信号的分离，数据传输接口 33采用VK3366芯片，VK3366芯片的主接口为I2C接口。
[0017]本实施例中，上述脉冲输出光电隔离模块4由10片6N136芯片组成，光电隔离模块4的输出端可同时输出10路频率为0~9000Hz的脉冲信号到伺服驱动器。
[0018]本实施例中，上述模拟控制模块5包括滤波放大电路51、电磁阀52，其中滤波放大电路51的输出端与电磁阀52的输入端连接，电磁阀52的输出端与气泵连接。
[0019]本实施例中，上述滤波放大电路51采用运算放大器。上述滤波放大电路51采用