一种工业机器人弹性体包覆轨迹补偿控制系统的制作方法

摘要: 本技术涉及工业机器人程序控制,更具体地说,本技术涉及一种工业机器人弹性体包覆轨迹补偿控制系统。背景技术:1、弹性体预成型件在机械手抓取、搬运和包覆过程中会同时受...
一种工业机器人弹性体包覆轨迹补偿控制系统的制作方法

本技术涉及工业机器人程序控制,更具体地说,本技术涉及一种工业机器人弹性体包覆轨迹补偿控制系统。

背景技术:

1、弹性体预成型件在机械手抓取、搬运和包覆过程中会同时受到夹持约束、运动载荷及环境条件影响,橡胶、硅橡胶等黏弹性材料在受载后产生的形变并不会在载荷建立完成后保持固定,而会随应力松弛和材料恢复过程继续发生时间相关变化,因此机械手开始执行包覆轨迹时观察到的预成型件形状,与机械手随后运行至不同包覆位置时的实际材料形状可能不同,尤其在包覆轨迹持续时间与材料松弛时间处于相近时间尺度时,同一预成型件不同位置对应的实际加工时刻不同,材料形变状态也会随执行时间发生变化。

2、现有技术已经提出利用工件状态感知、材料参数辨识和未来变形预测辅助柔性工件控制,公开号为cn120595686a的中国专利申请公开了一种柔性工件变形控制系统,通过视觉、力和位置等多模态传感器形成同步状态数据,并基于材料参数和变形预测模型预测工件的未来变形状态序列,再根据预测结果求解控制序列并通过前馈和反馈方式执行柔性工件变形控制,说明现有技术已经认识到柔性工件的未来形变需要进行预测,而不能仅根据当前测量状态进行控制。

3、但是,在机械手沿空间轨迹依次处理弹性体预成型件的场景中,现有的未来变形预测仍存在一个具体问题,即预测得到的材料未来状态与机械手实际到达各材料位置的执行时刻之间可能缺少准确的时间对应关系,例如机械手在时刻开始包覆,第一个包覆位置可能在秒到达,而后续包覆位置可能在秒到达,弹性体在两个时刻对应的松弛和恢复程度并不相同,如果按照当前形变状态、统一预测时刻或者统一未来形变结果对整条轨迹进行处理,后续位置所采用的形变状态可能已经与机械手实际到达时的材料状态不一致,并且轨迹调整后路径长度、运动速度或者路径段执行时间发生变化时,上述时间偏差还可能进一步改变,从而使预先依据某一预测时刻确定的材料位置与机械手实际执行时刻对应的材料位置发生偏离,导致弹性体时间相关形变与机械手空间轨迹之间出现时序失配。

4、鉴于此,本技术提出一种工业机器人弹性体包覆轨迹补偿控制系统以解决上述问题。

技术实现思路

1、针对现有技术存在的不足,本技术的目的在于提供一种工业机器人弹性体包覆轨迹补偿控制系统,通过获取弹性体预成型件的点云数据、抓取数据、环境数据、存放状态数据、材料标定数据和标准包覆轨迹数据,建立抓取历史状态和广义麦克斯韦内部状态,并根据机械手路径执行数据预测各路径点对应执行时刻的弹性体应变状态,在补偿路径重新规划后继续更新路径执行数据和预测应变数据,直至满足时间一致条件,达到使弹性体时间相关形变状态与机械手实际路径执行时序相对应,并据此生成补偿后包覆轨迹的目的。

2、本技术提供如下技术方案:一种工业机器人弹性体包覆轨迹补偿控制系统,包括:

3、数据处理模块:获取点云数据、抓取数据、环境数据、存放状态数据、材料标定数据和标准包覆轨迹数据,对点云数据、抓取数据和环境数据进行预处理,并对标准包覆轨迹数据进行规划,获得标准化点云数据、时间关联抓取数据、有效环境状态数据和路径执行数据;

4、特征提取模块:根据标准化点云数据、时间关联抓取数据和存放状态数据获得静态状态数据、夹持增量应变数据和抓取历史状态数据;

5、变形预测模块:根据材料标定数据和有效环境状态数据确定广义麦克斯韦模型参数数据,根据夹持增量应变数据更新广义麦克斯韦内部状态数据,根据路径执行数据获得预测时间间隔数据和未来广义麦克斯韦内部状态数据,将抓取历史状态数据、静态状态数据、预测时间间隔数据和未来广义麦克斯韦内部状态数据输入形变预测模型,获得预测应变数据;

6、决策控制模块:根据标准包覆轨迹数据和预测应变数据获得补偿路径数据,根据补偿路径数据更新路径执行数据并重新获得未来广义麦克斯韦内部状态数据和预测应变数据,直至预计执行时刻变化满足时间一致条件,获得补偿后包覆轨迹数据并发送至机械手控制器。

7、进一步地,获得静态状态数据的方法包括:将抓取前标准化点云数据与标准点云模板进行刚性配准,获得工件坐标关系和抓取前尺寸数据,将抓取后标准化点云数据与抓取前标准化点云数据进行刚性配准,获得抓取轮廓偏差数据和抓取姿态变化角数据,根据抓取前尺寸数据获得尺寸变异数据,将抓取前尺寸数据、尺寸变异数据、抓取轮廓偏差数据、抓取姿态变化角数据和存放状态数据组合,获得静态状态数据。

8、进一步地,获得时间关联抓取数据的方法包括:对六维力/力矩传感器输出进行静态校准,读取预先记录的夹持器质量数据、质心位置数据和转动惯量数据以及机械手控制器输出的末端运动数据,根据前述数据计算重力载荷和惯性载荷并从校准后的六维载荷中扣除,将补偿后六维外载荷数据与夹持器开口数据按照统一时间轴进行关联,获得时间关联抓取数据。

9、进一步地,获得抓取历史状态数据的方法包括:根据抓取前标准化点云数据沿夹持器闭合方向的投影尺寸和夹持器开口数据获得夹持增量应变数据,将夹持增量应变数据、时间关联抓取数据中的补偿后六维外载荷数据、有效环境状态数据和自有效接触开始的经过时间数据按照统一时间轴组合,并在有效接触开始时刻至当前状态评价时刻之间进行等间隔重采样,获得抓取历史状态数据。

10、进一步地,获得材料标定数据的方法包括:在生产夹持应变范围和多个温湿度标定工况下执行重复压缩应力松弛试验,根据不同应变水平的松弛模量曲线差异和重复试验差异确定线性黏弹适用范围,对多个候选maxwell支路数量在全部温湿度标定工况下进行参数拟合,根据跨工况赤池信息准则确定统一支路数量,建立温湿度与广义麦克斯韦模型参数数据之间的映射,获得材料标定数据。

11、进一步地,获得未来广义麦克斯韦内部状态数据的方法包括:根据材料标定数据和有效环境状态数据获得广义麦克斯韦模型参数数据,以有效接触开始时刻建立本次抓取新增内部状态,根据夹持增量应变数据递推至当前状态评价时刻,获得当前广义麦克斯韦内部状态数据;根据路径执行数据中的预计执行时刻获得预测时间间隔数据,根据路径执行数据中的计划夹持器开口数据获得未来计划增量应变数据,并根据广义麦克斯韦模型参数数据、当前广义麦克斯韦内部状态数据和未来计划增量应变数据继续递推,获得未来广义麦克斯韦内部状态数据。

12、进一步地,获得预测应变数据的方法包括:将抓取历史状态数据输入形变预测模型的lstm时序编码层获得抓取历史编码数据,根据广义麦克斯韦模型参数数据、未来计划增量应变数据和未来广义麦克斯韦内部状态数据获得预测物理应力状态数据,将抓取历史编码数据、静态状态数据、预测时间间隔数据、未来广义麦克斯韦内部状态数据和预测物理应力状态数据输入预测输出层,获得对应材料参考点预计执行时刻的x、y和z方向的预测应变数据。

13、进一步地,获得预测应变数据后,还判断对应预测应变数据是否为有效预测应变数据,包括:根据形变预测模型的测试集中的预测应变数据获得材料参考点预测位置数据,根据模型训练和测试过程中设置于预成型件表面的临时视觉标记获得材料参考点实测位置数据,根据材料参考点预测位置数据和材料参考点实测位置数据获得位置预测误差数据,并根据所述位置预测误差数据获得模型位置预测误差评价值;根据产品工艺文件中的产品允许位置误差数据、三维视觉标定数据中的视觉测量误差数据和机械手技术参数中的重复定位误差数据获得模型位置误差预算;所述模型位置预测误差评价值不超过模型位置误差预算时,将对应形变预测模型确定为有效形变预测模型;采用所述有效形变预测模型在线运行时,输入数据处于模型输入有效范围且预测应变数据处于模型输出有效范围时,将对应预测应变数据确定为有效预测应变数据。

14、进一步地,获得补偿路径数据的方法包括:根据有效预测应变数据获得材料参考点预测位置数据和预测表面法向数据,根据标准包覆轨迹数据中的相邻材料参考点关系和材料参考点预测位置数据获得路径切向数据,根据材料参考点预测位置数据、预测表面法向数据、路径切向数据和标准包覆轨迹数据中的工具工作距离数据获得补偿相对控制位姿数据,根据预先标定的固定包覆工具位姿数据及工件坐标系与夹持器坐标系之间的固定转换关系获得机械手夹持器目标位姿数据,按照材料参考点顺序组合机械手夹持器目标位姿数据,获得补偿路径数据。

15、进一步地,获得补偿后包覆轨迹数据的方法包括:对补偿路径数据进行机械手轨迹规划,获得更新后的路径执行数据,根据更新后的路径执行数据重新获得未来广义麦克斯韦内部状态数据、有效预测应变数据和补偿路径数据,根据形变预测模型的验证集和测试集中材料参考点在相邻未来监督时刻的实测位置数据获得材料位置时间变化率数据,根据所述模型位置误差预算和所述模型位置预测误差评价值获得剩余位置误差预算,根据材料位置时间变化率数据和剩余位置误差预算获得时间一致边界,迭代至预计执行时刻变化数据满足时间一致边界,并对补偿路径数据执行逆运动学检查和碰撞检查,获得补偿后包覆轨迹数据。

16、本技术一种工业机器人弹性体包覆轨迹补偿控制系统的技术效果和优点:

17、本技术通过对弹性体预成型件的点云数据、抓取数据、环境数据和存放状态数据进行处理,建立当前抓取过程对应的夹持增量应变和抓取历史状态,并利用材料标定数据更新广义麦克斯韦内部状态,再依据机械手标准包覆轨迹中各路径点的预计执行时刻预测对应未来内部状态和预测应变,使不同路径点分别对应机械手实际到达时刻的材料形变状态;在生成补偿路径后,根据重新规划得到的路径执行时刻再次更新未来内部状态和预测应变,直至预计执行时刻变化满足时间一致条件,从而使弹性体的时间相关形变状态与机械手路径执行时序建立对应关系,减少因材料松弛过程与路径实际执行时刻不一致造成的材料位置预测偏差,并使补偿后包覆轨迹与各材料参考点在对应执行时刻的位置相匹配。