本发明专利技术涉及伺服电机控制技术领域，具体是一种双驱龙门平台高速状态下偏载急停控制方法，包括用于驱动龙门平台的Motor1模块和Motor2模块，Motor1模块和Motor2模块内分别设置有编码器，Motor1模块分别与MCU1模块和FPGA1模块连接，MCU1模块分别与上位机和FPGA1模块连接，FPGA1模块还与第一RS422接口模块连接；Motor2模块分别与MCU2模块和FPGA2模块连接，MCU2模块分别与所述上位机和FPGA2模块连接，FPGA2模块还与第二RS422接口模块连接；第一RS422接口模块与第二RS422接口模块通信连接；包括如下步骤：(1)偏载判断(2)偏载轴急停控制(3)空轴急停控制，本方法可有效增加龙门同步系统在某一轴受到大负载扰动时的快速响应，可有效提高龙门平台的使用寿命，增加工作的安全性。的安全性。的安全性。
【技术实现步骤摘要】
一种双驱龙门平台高速状态下偏载急停控制方法
[0001]本专利技术涉及伺服电机控制
，尤其涉及一种双驱龙门平台高速状态下偏载急停控制方法。
技术介绍
[0002]在制造业中，对设备加工效果要求越来越高，比如压料、激光切割、木工板式家具等加工设备行业，机床行程较长，且速度要求较高，所以机床一般采用龙门双驱的结构。双驱龙门结构机床一般有两个机械传动机构并列于机架两侧，共同带动龙门轴进行无间隙运动，两侧机械传动结构各由一个电机独立控制。
[0003]但是，在高速龙门同步状态下，当某一轴受到大负载扰动时(即撞击刚性材质)，一般龙门同步系统无法快速响应，导致双轴的龙门偏差迅速增大进而损坏龙门机械结构。如图1所示，提供了在该情况下压料机工作的情况，因为轴1受到大负载扰动，进而导致产生异常折弯件。
[0004]因此，急需一种新的技术方案解决上述技术问题。
技术实现思路
[0005]本专利技术的目的在于克服上述现有技术的问题，提供了一种双驱龙门平台高速状态下偏载急停控制方法，使用FPGA实现双轴间的高速数据交互，MCU根据交互的数据确定偏载状态与控制方式，用以解决当某一轴受到大负载扰动时(即撞击刚性材质)，一般龙门同步系统无法快速响应，导致双轴的龙门偏差迅速增大进而损坏龙门机械结构的问题。
[0006]上述目的是通过以下技术方案来实现：
[0007]一种双驱龙门平台高速状态下偏载急停控制方法，包括用于驱动龙门平台的Motor1模块和Motor2模块，所述Motorl模块和所述Motor2模块内分别设置有编码器，所述Motorl模块分别与MCU1模块和FPGA1模块连接，所述MCU1模块分别与上位机和FPGA1模块连接，所述FPGA1模块还与第一RS422接口模块连接；所述Motor2模块分别与MCU2模块和FPGA2模块连接，所述MCU2模块分别与所述上位机和FPGA2模块连接，所述FPGA2模块还与第二RS422接口模块连接；所述第一RS422接口模块与所述第二RS422接口模块通信连接；包括如下步骤：
[0008]步骤(1)偏载判断通过双轴编码器反馈与惯量值计算双轴的估计电流，通过双轴的估计电流与对应的实际电流的差值获取双轴的负载数据；
[0009]设定特定阈值A与特定阈值B，当某轴的负载数据超过特定阈值A且双轴的负载数据差距超过特定阈值B时，即可确定为偏载轴，继续步骤(2)；
[0010]步骤(2)偏载轴急停控制设定偏移值C，并根据当前实际编码器反馈确定新的位置指令值，将模型环中的速度前馈立刻清零，并设定撞击方向的转矩限制为较小值；所述新的位置指令值为当前编码器反馈值
‑
偏移值C；所述偏移值C为自定义设定；
[0011]步骤(3)空轴急停控制根据空轴的一般响应性确定一阶惯性时间，当偏载逻辑判
断满足后，根据偏载轴的编码器反馈和惯量值计算速度前馈与电流前馈并送至模型环中，根据偏载轴的编码器反馈与一阶惯性时间计算补偿后的位置指令。
[0012]进一步地，在所述步骤(1)中双轴通过第一RS422接口模块与第二RS422接口模块之间的通信实现电流速度位置三环同步与数据交互。
[0013]进一步地，当FPGA1模块或FPGA2模块在发送本轴通信时也在接受对方的通信，利用通信的起始帧信号可以确定本轴的通信与对方的通信是否存在时间差异，当有差异时调整超前的FPGA1模块或FPGA2模块即可完成周期同步；通信周期同步后，利用该周期输出电流环、速度环和位置环的控制信号。
[0014]进一步地，步骤(1)中所述负载数据的计算公式如下：
[0015][0016]其中，T
m
表示负载力矩，T
e
表示电机电磁转矩，J表示转动惯量，ω表示角速度。
[0017]进一步地，步骤(3)中所述一阶惯性时间的计算公式如下：
[0018][0019]其中，T表示一阶惯性时间，y表示位置反馈，x表示位置指令；
[0020]根据伺服正常运行的位置指令位置反馈即可计算出大致的一阶惯性时间系数T。
[0021]进一步地，步骤(3)中所述根据偏载轴的编码器反馈和惯量值计算速度前馈，计算公式如下：
[0022][0023]其中，x表示编码器反馈，ω表示角速度。
[0024]进一步地，步骤(3)中所述根据偏载轴的编码器反馈和惯量值计算电流前馈，计算公式如下：
[0025][0026]其中，T
f
表示电流前馈，J表示转动惯量，ω表示角速度。
[0027]进一步地，步骤(3)中所述根据偏载轴的编码器反馈与一阶惯性时间计算补偿后的位置指令，计算公式如下：
[0028]P＝x+ω*T
[0029]其中，P表示位置指令补偿，x表示堵转轴编码器反馈，ω表示角速度，T表示一阶惯性时间。
[0030]有益效果
[0031]本专利技术所提供的一种双驱龙门平台高速状态下偏载急停控制方法，使用FPGA实现双轴间的高速数据交互，MCU根据交互的数据确定偏载状态与控制方式，可有效增加龙门同步系统在某一轴受到大负载扰动时的快速响应，可有效提高龙门平台的使用寿命，增加工作的安全性。
附图说明
[0032]图1为传统技术下压料机异常示意图；
[0033]图2为本专利技术所述一种双驱龙门平台高速状态下偏载急停控制方法中系统拓扑图；
[0034]图3为本专利技术所述一种双驱龙门平台高速状态下偏载急停控制方法的示意图。
具体实施方式
[0035]下面根据附图和实施例对本专利技术作进一步详细说明。所描述的实施例仅仅是本专利技术一部分实施例，而不是全部的实施例。基于本专利技术中的实施例，本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其它实施例，都属于本专利技术保护的范围。
[0036]如图2所示，一种双驱龙门平台高速状态下偏载急停控制方法，包括用于驱动龙门平台的Motor1模块和Motor2模块，所述Motor1模块和所述Motor2模块内分别设置有编码器，所述Motor1模块分别与MCU1模块和FPGA1模块连接，所述MCU1模块分别与上位机和FPGA1模块连接，所述FPGA1模块还与第一RS422接口模块连接；所述Motor2模块分别与MCU2模块和FPGA2模块连接，所述MCU2模块分别与所述上位机和FPGA2模块连接，所述FPGA2模块还与第二RS422接口模块连接；所述第一RS422接口模块与所述第二RS422接口模块通信连接。
[0037]其中，所述MCU1模块与所述FPGA1模块之间通过SPI协议通信，所述FPGA1模块与Motor1模块之间通过485通信协议通信，所述MCU1模块与与Motor1模块之间通过PWM通信协议通信；
[0038]所述MCU2模块与所述FPGA2模块之间通过SPI协议通信，所述FPGA2模块与Motor2模块之间通过485通信协议通信，所述MCU2模块与与Motor2模块之间通本文档来自技高网...
【技术保护点】
【技术特征摘要】
1.一种双驱龙门平台高速状态下偏载急停控制方法，其特征在于，包括用于驱动龙门平台的Motor1模块和Motor2模块，所述Motor1模块和所述Motor2模块内分别设置有编码器，所述Motor1模块分别与MCU1模块和FPGA1模块连接，所述MCU1模块分别与上位机和FPGA1模块连接，所述FPGA1模块还与第一RS422接口模块连接；所述Motor2模块分别与MCU2模块和FPGA2模块连接，所述MCU2模块分别与所述上位机和FPGA2模块连接，所述FPGA2模块还与第二RS422接口模块连接；所述第一RS422接口模块与所述第二RS422接口模块通信连接；包括如下步骤：步骤(1)偏载判断通过双轴编码器反馈与惯量值计算双轴的估计电流，通过双轴的估计电流与对应的实际电流的差值获取双轴的负载数据；设定特定阈值A与特定阈值B，当某轴的负载数据超过特定阈值A且双轴的负载数据差距超过特定阈值B时，即可确定为偏载轴，继续步骤(2)；步骤(2)偏载轴急停控制设定偏移值C，并根据当前实际编码器反馈确定新的位置指令值，将模型环中的速度前馈立刻清零，并设定撞击方向的转矩限制为较小值；所述新的位置指令值为当前编码器反馈值
‑
偏移值C；所述偏移值C为自定义设定；步骤(3)空轴急停控制根据空轴的一般响应性确定一阶惯性时间，当偏载逻辑判断满足后，根据偏载轴的编码器反馈和惯量值计算速度前馈与电流前馈并送至模型环中，根据偏载轴的编码器反馈与一阶惯性时间计算补偿后的位置指令。2.根据权利要求1所述的一种双驱龙门平台高速状态下偏载急停控制方法，其特征在于，在所述步骤(1)中双轴通过第一RS422接口模块与第二RS422接口模块之间的通信实现电流速度位置三环同步与数据交互。3.根据权利要求2所述的一种双驱龙门平台高...
【专利技术属性】
技术研发人员：吕祥，许泽恩，邹骏宇，
申请(专利权)人：无锡信捷电气股份有限公司，
类型：发明
国别省市：
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。