一种视觉自适应全伺服折盒控制系统及控制方法与流程

摘要: 本发明涉及折盒机伺服控制,具体地说,涉及一种视觉自适应全伺服折盒控制系统及控制方法。背景技术:1、折盒机通过伺服驱动的折叠执行机构将模切压痕后的纸板沿压痕线弯折...
一种视觉自适应全伺服折盒控制系统及控制方法与流程

本发明涉及折盒机伺服控制,具体地说,涉及一种视觉自适应全伺服折盒控制系统及控制方法。

背景技术:

1、折盒机通过伺服驱动的折叠执行机构将模切压痕后的纸板沿压痕线弯折至预定角度,在现有折盒机中折叠伺服轴按照预先设定的电子凸轮轨迹运动,轨迹参数在盒型换型时设定后在批量生产过程中保持不变,纸板在模切压痕工序中形成压痕线,受纸板含水率波动和压痕刀具磨损以及纸板批次差异等因素影响,不同纸板的压痕深度和压痕线连续度以及压痕对称性存在个体差异,压痕深度较浅的纸板在折叠时弯折阻力增大,压痕线存在断裂的纸板在启折阶段阻力突增,压痕不对称的纸板在折叠过程中两侧受力不均衡,这些个体差异使得相同折叠轨迹作用于不同纸板时实际成型角度不一致,部分纸板出现过折或欠折,导致纸盒成型角存在偏差,为了解决这一问题,我们提供了一种视觉自适应全伺服折盒控制系统及控制方法。

技术实现思路

1、本发明的目的在于提供一种视觉自适应全伺服折盒控制系统及控制方法,以解决上述背景技术中提出的问题。

2、为实现上述目的,提供了一种视觉自适应全伺服折盒控制系统,包括:

3、压痕视觉前馈单元在折叠前采集压痕线图像,提取压痕线连续度、压痕宽度均匀度和压痕对称性偏差作为压痕质量前馈量;

4、电流基准曲线生成单元根据压痕质量前馈量从电流基准曲线库插值生成预期转矩电流基准曲线;

5、折叠伺服驱动单元按电子凸轮轨迹生成位置指令驱动折叠伺服轴从零位向目标折叠角运动,预设中途折叠角;

6、电流残差实时观测单元采集实际转矩电流,根据中途折叠角划分初始弯折段和持续弯折段,分别计算实际转矩电流相对预期转矩电流基准曲线两段内残差积分,输出初始弯折残差积分值和持续弯折残差积分值;

7、中途折叠角视觉校正单元在折叠伺服轴到达中途折叠角时采集侧面单帧图像,提取实际折叠角;

8、成型角偏差预测单元将压痕线连续度、压痕宽度均匀度、压痕对称性偏差、初始弯折残差积分值、持续弯折残差积分值和实际折叠角输入预测模型,输出成型角偏差预估值;

9、剩余行程轨迹微修正单元在成型角偏差预估值超过设定阈值时,根据成型角偏差预估值于中途折叠角至目标折叠角剩余行程内生成反向修正量,并叠加至折叠伺服轴位置指令。

10、更进一步的,所述压痕视觉前馈单元内置面阵工业相机和条形组合光源,在折叠前触发面阵工业相机采集待折纸板表面压痕区域的压痕线图像,对压痕线图像依次进行灰度化、高斯滤波去噪和canny边缘检测得到压痕线边缘二值图,对压痕线边缘二值图进行形态学细化提取压痕线骨架,将压痕线骨架中最长连续段的像素长度与压痕线理论长度的比值作为压痕线连续度,压痕线理论长度是盒型换型时导入压痕视觉前馈单元的纸盒展开图电子样稿中压痕线的几何长度,沿压痕线骨架等间距设置若干压痕宽度采样点,在每个压痕宽度采样点处沿压痕线骨架法线方向测量压痕线两侧边缘之间的像素距离并按像素当量换算为压痕宽度实测值,像素当量是压痕视觉前馈单元在标定阶段通过标准标定板获取的单个像素对应的物理尺寸,计算全部压痕宽度采样点对应压痕宽度实测值的标准差与压痕宽度实测值均值,以一减去标准差与压痕宽度实测值均值的比值作为压痕宽度均匀度,在每个压痕宽度采样点处沿法线方向将压痕线骨架两侧边缘分别记为压痕线左侧边缘和压痕线右侧边缘,测量压痕线左侧边缘至压痕线骨架的像素距离和压痕线右侧边缘至压痕线骨架的像素距离,取全部压痕宽度采样点处左侧像素距离均值与右侧像素距离均值的差值作为压痕对称性偏差,将压痕线连续度、压痕宽度均匀度和压痕对称性偏差分别归一化至零至一区间后拼接为三维特征向量,作为压痕质量前馈量输出。

11、更进一步的,所述电流基准曲线生成单元在盒型换型或纸板批次更换时执行自标定流程,自标定流程为选取标准纸板,由压痕视觉前馈单元提取标准纸板的压痕线连续度、压痕宽度均匀度和压痕对称性偏差作为标定压痕质量前馈量,由折叠伺服驱动单元按电子凸轮轨迹驱动折叠伺服轴携带标准纸板完成多次试折叠,电流残差实时观测单元以固定电流采样周期采集每次试折叠过程中折叠伺服轴的实际转矩电流,对多次试折叠的实际转矩电流按采样时刻取均值得到样本转矩电流曲线,将标定压痕质量前馈量与样本转矩电流曲线关联存入电流基准曲线库,电流基准曲线库中存储有若干组标定压痕质量前馈量及关联的样本转矩电流曲线;

12、在压痕视觉前馈单元输出压痕质量前馈量之后,电流基准曲线生成单元计算压痕质量前馈量与电流基准曲线库中各组标定压痕质量前馈量之间的欧氏距离,选取欧氏距离最小的两组标定压痕质量前馈量作为相邻标定节点,以欧氏距离的倒数作为距离权重,对两组相邻标定节点关联的样本转矩电流曲线按采样时刻进行加权插值,在每个采样时刻将两条样本转矩电流曲线的电流值分别乘以对应距离权重后求和并除以距离权重之和,得到预期转矩电流基准曲线。

13、更进一步的,所述折叠伺服驱动单元以虚拟主轴位置为自变量生成电子凸轮轨迹,虚拟主轴位置由折叠伺服驱动单元内部的虚拟主轴发生器按照固定周期自增产生,电子凸轮轨迹上设置有三个凸轮关键点,三个凸轮关键点分别对应折叠伺服轴处于零位、中途折叠角和目标折叠角,相邻凸轮关键点之间采用五次多项式曲线连接,五次多项式曲线的边界速度约束和边界加速度约束均取零,使折叠伺服轴在零位、中途折叠角和目标折叠角处的速度和加速度均为零,折叠伺服驱动单元内存储有凸轮关键点表,凸轮关键点表记录每个凸轮关键点对应的虚拟主轴位置和折叠伺服轴角度,折叠伺服驱动单元在每个运行周期读取当前虚拟主轴位置,在凸轮关键点表中查找当前虚拟主轴位置所在区间的两个相邻凸轮关键点,对两个相邻凸轮关键点之间的五次多项式曲线进行插值计算得到折叠伺服轴的从轴目标位置,将从轴目标位置作为位置指令输出至折叠伺服轴。

14、更进一步的,所述折叠伺服驱动单元通过ethercat总线将位置指令发送至伺服驱动器,伺服驱动器与折叠伺服轴连接并内置位置环、速度环和转矩环,位置环接收位置指令并采集折叠伺服轴的编码器反馈位置,计算位置指令与编码器反馈位置的差值得到位置偏差,位置环根据位置偏差输出速度指令至速度环,速度环根据速度指令输出转矩指令至转矩环,转矩环根据转矩指令驱动折叠伺服轴运动,折叠伺服轴从零位启动后按电子凸轮轨迹向目标折叠角运动,折叠伺服驱动单元实时读取编码器反馈位置,当编码器反馈位置达到中途折叠角时生成中途到达信号,将中途到达信号发送至中途折叠角视觉校正单元触发采集侧面单帧图像,当编码器反馈位置达到目标折叠角时折叠伺服轴停止运动。

15、更进一步的,所述电流残差实时观测单元以固定电流采样周期采集实际转矩电流,固定电流采样周期是电流残差实时观测单元采集实际转矩电流的时间间隔,同时从折叠伺服驱动单元获取折叠伺服轴角度,折叠伺服轴角度是位置指令所指示的折叠伺服轴当前角度位置;

16、电流残差实时观测单元将折叠伺服轴角度从零位至中途折叠角的区间划分为初始弯折段,将折叠伺服轴角度从中途折叠角至目标折叠角的区间划分为持续弯折段;

17、每次采集实际转矩电流时,电流残差实时观测单元根据当前折叠伺服轴角度从预期转矩电流基准曲线中索引出对应预期转矩电流值,计算实际转矩电流与对应预期转矩电流值的差值得到瞬时残差,在初始弯折段内对瞬时残差取绝对值并乘以固定电流采样周期后累加得到初始弯折残差积分值,在持续弯折段内对瞬时残差取绝对值并乘以固定电流采样周期后累加得到持续弯折残差积分值。

18、更进一步的,所述电流残差实时观测单元以固定电流采样周期在初始弯折段和持续弯折段内分别采集实际转矩电流,固定电流采样周期是相邻两次采集实际转矩电流的时间间隔,每次采集实际转矩电流时根据折叠伺服轴角度从预期转矩电流基准曲线中索引出对应预期转矩电流值,折叠伺服轴角度是位置指令所指示的折叠伺服轴当前角度位置,计算实际转矩电流与对应预期转矩电流值的差值得到瞬时残差;

19、电流残差实时观测单元内预设有残差上限阈值,当瞬时残差的绝对值超过残差上限阈值时将该瞬时残差判定为干扰值,并用与干扰值相邻的两个瞬时残差的均值替换干扰值;

20、电流残差实时观测单元对初始弯折段和持续弯折段内替换后的全部瞬时残差分别采用梯形积分法计算,梯形积分法为将每两个相邻瞬时残差取均值后乘以固定电流采样周期并逐对累加,将初始弯折段的累加结果除以初始弯折段采样点数得到初始弯折残差积分值,将持续弯折段的累加结果除以持续弯折段采样点数得到持续弯折残差积分值,初始弯折段采样点数是初始弯折段内采集实际转矩电流的总次数,持续弯折段采样点数是持续弯折段内采集实际转矩电流的总次数;

21、电流残差实时观测单元通过ethercat过程数据对象将初始弯折残差积分值和持续弯折残差积分值发送至成型角偏差预测单元,ethercat过程数据对象是折叠伺服驱动单元与成型角偏差预测单元之间周期性交换数据的通信报文。

22、更进一步的,所述预测模型为梯度提升决策树回归模型,梯度提升决策树回归模型包括若干棵回归树和归一化参数,归一化参数在梯度提升决策树回归模型离线训练时从历史样本中统计得到,归一化参数包括压痕对称性偏差最小值、压痕对称性偏差最大值、初始弯折残差积分值最小值、初始弯折残差积分值最大值、持续弯折残差积分值最小值和持续弯折残差积分值最大值;

23、成型角偏差预测单元将压痕线连续度和压痕宽度均匀度直接作为输入特征向量的分量,将压痕对称性偏差减去压痕对称性偏差最小值后除以压痕对称性偏差最大值与压痕对称性偏差最小值的差值映射至零至一区间,将初始弯折残差积分值减去初始弯折残差积分值最小值后除以初始弯折残差积分值最大值与初始弯折残差积分值最小值的差值映射至零至一区间,将持续弯折残差积分值减去持续弯折残差积分值最小值后除以持续弯折残差积分值最大值与持续弯折残差积分值最小值的差值映射至零至一区间,将实际折叠角除以目标折叠角映射至零至一区间,六个映射后的值共同组成输入特征向量;

24、成型角偏差预测单元将输入特征向量输入梯度提升决策树回归模型,输入特征向量依次经过每棵回归树的分裂节点判断后落入对应叶子节点,取每棵回归树对应叶子节点的叶子节点值并将全部叶子节点值累加得到成型角偏差预估值;

25、梯度提升决策树回归模型通过历史样本离线训练得到,历史样本包含压痕线连续度、压痕宽度均匀度、压痕对称性偏差、初始弯折残差积分值、持续弯折残差积分值、实际折叠角以及实际成型角偏差,实际成型角偏差是纸板折叠完成后由视觉测量得到的实际成型角度与目标折叠角的差值。

26、更进一步的,所述剩余行程轨迹微修正单元在成型角偏差预估值超过设定阈值时,实时读取折叠伺服轴角度,折叠伺服轴角度是折叠伺服轴当前的实际角度位置,根据折叠伺服轴角度计算行程进度,行程进度为折叠伺服轴角度减去中途折叠角后除以目标折叠角与中途折叠角的差值;

27、剩余行程轨迹微修正单元将行程进度输入s型权重函数得到权重值,s型权重函数是以行程进度为自变量且在行程进度等于零时权重值等于零、在行程进度等于一时权重值等于一、在行程进度等于零和行程进度等于一处一阶导数均为零的五次多项式函数;

28、剩余行程轨迹微修正单元将成型角偏差预估值取反后乘以权重值得到反向修正量,反向修正量的绝对值不超过剩余行程轨迹微修正单元内预设的最大修正量限幅值,剩余行程轨迹微修正单元将反向修正量叠加至位置指令得到修正后位置指令,并将修正后位置指令发送至折叠伺服轴。

29、本发明目的之二在于,提供了用于实现一种视觉自适应全伺服折盒控制系统的方法,包括以下步骤:

30、s1、在折叠前采集待折纸板的压痕线图像,从压痕线图像中提取压痕线连续度、压痕宽度均匀度和压痕对称性偏差作为压痕质量前馈量;

31、s2、根据压痕质量前馈量从电流基准曲线库中插值生成预期转矩电流基准曲线;

32、s3、按电子凸轮轨迹生成位置指令驱动折叠伺服轴从零位向目标折叠角运动,并预设中途折叠角;

33、s4、在折叠伺服轴运动过程中采集实际转矩电流,根据中途折叠角将运动过程划分为初始弯折段和持续弯折段,分别计算实际转矩电流相对预期转矩电流基准曲线在初始弯折段和持续弯折段内的残差积分,输出初始弯折残差积分值和持续弯折残差积分值;

34、s5、在折叠伺服轴到达中途折叠角时采集侧面单帧图像,从侧面单帧图像中提取实际折叠角;

35、s6、将压痕线连续度、压痕宽度均匀度、压痕对称性偏差、初始弯折残差积分值、持续弯折残差积分值和实际折叠角输入预测模型,通过预测模型输出成型角偏差预估值;

36、s7、在成型角偏差预估值超过设定阈值时,根据成型角偏差预估值在中途折叠角至目标折叠角的剩余行程内生成反向修正量,并将反向修正量叠加至折叠伺服轴的位置指令。

37、与现有技术相比,本发明的有益效果:

38、本发明通过压痕视觉前馈单元在折叠前提取压痕线连续度和压痕宽度均匀度以及压痕对称性偏差作为压痕质量前馈量,由电流基准曲线生成单元根据压痕质量前馈量从电流基准曲线库插值生成与单张纸板压痕状态匹配的预期转矩电流基准曲线,电流残差实时观测单元将折叠过程划分为初始弯折段和持续弯折段并分别计算初始弯折残差积分值和持续弯折残差积分值,成型角偏差预测单元融合压痕质量前馈量和初始弯折残差积分值以及持续弯折残差积分值和中途折叠角处实际折叠角输出成型角偏差预估值,剩余行程轨迹微修正单元在中途折叠角至目标折叠角剩余行程内以s型权重函数渐增反向修正量并叠加至位置指令,在折叠完成前根据单张纸板的压痕质量和实际弯折阻力预测成型角偏差并实时修正折叠轨迹,提高了成型角偏差预测的准确性,提高了纸盒成型角的一致性,降低了过折和欠折的发生率,提高了折盒机对纸板批次差异和压痕质量波动的适应性。