一种基于示教轨迹优化与修正的机器人打磨系统的打磨方法技术方案

本发明专利技术提供一种基于示教轨迹优化与修正的机器人打磨系统的打磨方法，本发明专利技术在打磨之前，根据肌电手环测量的肌电信号和六维力/力矩传感器测量的机器人末端外力，工控机训练神经网络，建立肌电信号到手臂作用力的映射，对示教位姿和力轨迹进行建模，在打磨过程中，根据肌电信号、机器人末端外力和神经网络预测值，工控机向机器人发送控制指令，优化和修正机器人位姿和力轨迹。本发明专利技术使用神经网络避免了打磨中切平面力噪声对手臂作用力的测量干扰，实现了在线优化和修正示教轨迹中不合理的位姿和法向力，提高了示教的效率和鲁棒性以及机器人的打磨柔性作业能力。机器人的打磨柔性作业能力。机器人的打磨柔性作业能力。

【技术实现步骤摘要】
一种基于示教轨迹优化与修正的机器人打磨系统的打磨方法


[0001]本专利技术涉及机器人
，尤其是一种基于示教轨迹优化与修正的机器人打磨系统的打磨方法。

技术介绍

[0002]随着机器人技术的迅速发展，越来越多的工业机器人被应用于打磨作业中，替代人工打磨，以降低人工成本和提高生产效率。
[0003]目前一般不采用对工件模型依赖程度高的离线编程方式，而是采用示教编程方式对机器人进行打磨轨迹的示教，如拖动示教。
[0004]但是，由于打磨具有工件表面形状不确定以及与工件表面持续接触的固有特性，需要同时向机器人示教打磨位姿轨迹和法向力轨迹，以实现机器人在打磨这种受环境约束任务下的稳定性和柔顺性，而且为满足高精度的要求，机器人在打磨过程中需要控制打磨头的方向与工件表面垂直，并以适当法向力对工件进行打磨，否则容易出现过磨等问题，这导致难以一次性地示教出一条高质量的打磨轨迹，一旦在示教过程中出现失误，比如示教了错误的位姿或者不合适的法向力轨迹，往往需要重新示教整条轨迹，这额外消耗了大量时间，同时增加了生产成本，因此需要示教轨迹的优化和修正。
[0005]现有技术中，示教轨迹修正最直观的方法是，使用六维力/力矩传感器测量手臂作用力，通过导纳控制算法对轨迹进行修正，但是在打磨过程中，打磨头与工件剧烈接触，在切平面上产生大量的力噪声，难以从六维力/力矩传感器的测量值中分离出手臂作用力。

技术实现思路

[0006]针对现有技术的不足，本专利技术提供一种基于示教轨迹优化与修正的机器人打磨系统的打磨方法，本专利技术通过训练数据采集与处理，神经网络设计与训练，轨迹示教与建模以及轨迹在线优化与修正，实现了一次性示教，缩短了机器人的示教时间，提高了示教的效率和鲁棒性，增强了机器人的柔性打磨作业能力，对操作人员更加安全友好。
[0007]本专利技术的技术方案为：一种基于示教轨迹优化与修正的机器人打磨系统，包括机器人、六维力/力矩传感器、打磨头、肌电手环和工控机，所述的机器人为具有位置控制功能的六轴机械臂；
[0008]所述六维力/力矩传感器安装于所述机器人的末端，用于测量打磨过程中环境或操作人员对所述机器人末端施加的外力，所述打磨头安装于所述六维力/力矩传感器的另一端，与工件直接接触进行打磨，所述肌电手环佩戴于操作人员的右前臂，用于采集手臂的肌电信号，所述工控机与所述机器人和所述六维力/力矩传感器均电连接，与所述的肌电手环通过蓝牙连接，根据六维力/力矩传感器获取到的外力和肌电手环获取的肌电信号向所述机器人发送控制指令，控制机器人带动打磨头在工件表面移动，完成打磨作业。
[0009]本专利技术还提供一种基于示教轨迹优化与修正的机器人的打磨方法，包括以下步骤：
[0010]S1)、训练数据采集与处理，操作人员用手拖动机器人末端分别沿x轴，y轴和z轴进行周期移动，同时，利用工控机读取肌电手环测量得到的手臂八通道原始肌电信号和六维力/力矩传感器测量得到的力信号对这两组信号进行时间戳同步，同时对肌电信号u(k)进行预处理得到扩展肌电信号方阵
[0011]S2)、构建神经网络模型，并利用步骤S1)中处理的对应时间戳的扩展肌电信号方阵U
*
(k)和三维力信号F
*
(k)组成数据对使用反向传播算法对神经网络进行训练，训练好的神经网络模型表示手臂肌电信号和预测机器人末端所受手臂力的映射关系为
[0012]式中，Γ(U
*
)表示表示神经网络映射函数；
[0013]S3)、轨迹示教与建模，在拖动示教模式下，对机器人示教在工件表面进行打磨的位姿轨迹β
s
(t)和垂直于工件表面的法向力轨迹f
zs
(t)，工控机记录示教位姿和法向力轨迹，使用动态运动原语对机器人轨迹从正向和反向进行建模，得到位姿模型和力模型；
[0014]S4)、在线优化，用力控算法和姿态导纳控制算法在线优化机器人的位姿轨迹，
[0015]经过姿态导纳控制算法对机器人姿态进行优化，机器人末端会自动地根据环境外力矩调整姿态，从而实现在打磨过程中打磨头方向与工件表面垂直；
[0016]S5)、在线修正，使用神经网络模型预测手臂对机器人末端作用力，调整位姿和力模型执行速度，通过位置导纳控制，工控机向机器人发送控制指令，在线修正优化后的机器人位置和力轨迹；
[0017]S6)、循环执行步骤S4)和S5)，直到完成完成示教轨迹的在线优化和修正。
[0018]作为优选的，步骤S1)中，对所述的肌电信号u(k)进行预处理，具体如下：
[0019]S11)、对原始肌电信号u(k)进行整流滤波处理，得到肌电信号包络u
env
(k)，计算式为：
[0020][0021]式中，k表示当前时间戳，m表示预先设计的滤波参数；
[0022]S12)、对肌电信号包络u
env
(k)进行标准化处理，得到标准化肌电信号u
*
(k)，计算式如下：
[0023][0024]式中，表示肌电信号包络u
env
(k)的平均值，σ(u
env
)表示肌电信号包络u
env
(k)的标准差；
[0025]S13)、使用滑动窗口截取标准化肌电信号u
*
(k)，得到扩展肌电信号方阵具体为：
[0026]U
*
(k)＝[u
*
(k
‑
w)，u
*
(k
‑
w+1)，
…
，u
*
(k)]；
[0027]式中，u
*
(k)为标准化肌电信号，w表示滑动窗口长度。
[0028]作为优选的，步骤S2)中，所述的神经网络模型包括一个输入层，四个卷积模块和一个输出层，所述的神经网络模型以扩展肌电信号方阵U
*
(k)作为输入，以预测三维力信号作为输出。
[0029]作为优选的，步骤S2)中，每个卷积模块包括一个2D卷积层，批标准化层BN和20％的dropout层，并使用整流线性单元ReLU进行激活，卷积层的卷积核数量依次设计为4，8，16和32，卷积核大小均设计为2x2，输出层设计为两个单元个数分别为6和3的全连接层，对每个全连接层使用ReLU进行激活。
[0030]作为优选的，步骤S2)中，使用反向传播算法对神经网络进行训练，训练得到的最优权重θ
*
满足最小化损失函数L：
[0031][0032]其中，θ
*
表示训练得到的最优权重，N表示训练集数据个数，F
*
(k)表示三维力信号，表示预测三维力信号。
[0033]作为优选的，步骤S3)中，所述的位姿轨迹为：
[0034]β
s
(t)＝[β
xs
(t)，β
ys
(t)本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种基于示教轨迹优化与修正的机器人打磨系统的打磨方法，所述的打磨系统包括机器人(1)、六维力/力矩传感器(2)、打磨头(3)、肌电手环(4)和工控机(5)，所述的机器人(1)为具有位置控制功能的六轴机械臂；所述六维力/力矩传感器(2)安装于所述机器人(1)的末端，用于测量打磨过程中环境或操作人员对所述机器人(1)末端施加的外力，所述打磨头(3)安装于所述六维力/力矩传感器(2)的另一端，与工件直接接触进行打磨，所述肌电手环(4)佩戴于操作人员的右前臂，用于采集手臂的八通道肌电信号，所述工控机(5)与所述机器人(1)和所述六维力/力矩传感器(2)均电连接，与所述的肌电手环(4)通过蓝牙连接，根据六维力/力矩传感器(2)获取到的外力和肌电手环(4)获取的肌电信号向所述机器人(1)发送控制指令，控制机器人(1)带动打磨头(3)在工件表面移动，完成打磨作业；其特征在于，所述的打磨方法包括以下步骤：S1)、训练数据采集与处理，操作人员用手拖动机器人(1)末端分别沿x轴，y轴和z轴进行周期移动，同时，利用工控机(5)读取肌电手环(4)测量得到的手臂八通道原始肌电信号和六维力/力矩传感器(2)测量得到的力信号对这两组信号进行时间戳同步，同时对肌电信号u(k)进行预处理得到扩展肌电信号方阵S2)、模型构建与训练，构建神经网络模型，并利用步骤S1)中处理的对应时间戳的扩展肌电信号方阵U
*
(k)和三维力信号F
*
(k)组成数据对使用反向传播算法对神经网络进行训练，训练得到的最优权重θ
*
满足最小化损失函数L：其中，θ
*
表示训练得到的最优权重，N表示训练集数据个数，F
*
(k)表示三维力信号，表示预测三维力信号；训练好的神经网络模型表示手臂肌电信号和预测机器人(1)末端所受手臂力的映射关系为式中，Γ(U
*
)表示表示神经网络映射函数；S3)、轨迹示教与建模，在拖动示教模式下，对机器人(1)示教在工件表面进行打磨的位姿轨迹β
s
(t)和垂直于工件表面的法向力轨迹f
zs
(t)，工控机(5)记录示教位姿和法向力轨迹，使用动态运动原语对机器人(1)轨迹从正向和反向进行建模，得到位姿模型和力模型；其中，所述的位姿轨迹为：β
s
(t)＝[β
xs
(t),β
ys
(t),β
zs
(t),β
rs
(t),β
ps
(t),β
ys
(t)]；其中，β
xs
(t),β
ys
(t),β
zs
(t)代表所述机器人(1)末端位置，β
rs
(t),β
ps
(t),β
ys
(t)代表所述机器人(1)末端姿态，以RPY旋转角的形式给出；S4)、在线优化，用力控算法和姿态导纳控制算法在线优化机器人(1)的位姿轨迹，经过姿态导纳控制算法对机器人(1)姿态进行优化，机器人(1)末端会自动地根据环境外力矩调整姿态，从而实现在打磨过程中打磨头(3)方向与工件表面垂直；S5)、在线修正，使用神经网络模型预测手臂对机器人(1)末端作用力，调整位姿和力模型执行速度，通过位置导纳控制，工控机(5)向机器人(1)发送控制指令，在线修正优化后的机器人(1)位置和力轨迹；
S6)、循环执行步骤S4)和S5)，直到完成示教轨迹的在线优化和修正。2.根据权利要求1所述的一种基于示教轨迹优化与修正的机器人打磨系统的打磨方法，其特征在于：步骤S1)中，对所述的肌电信号u(k)进行预处理，具体如下：S11)、对原始肌电信号u(k)进行整流滤波处理，得到肌电信号包络u
env
(k)，计算式为：式中，k表示当前时间戳，m表示预先设计的滤波参数；S12)、对肌电信号包络u
env
(k)进行标准化处理，得到标准化肌电信号u
*
(k)，计算式如下：式中，表示肌电信号包络u
env
(k)的平均值，σ(u
env
)表示肌电信号包络u
env
(k)的标准差；S13)、使用滑动窗口截取标准化肌电信号u
*
(k)，得到扩展肌电信号方阵具体为：U
*
(k)＝[u
*
(k
‑
w),u
*
(k
‑
w+1),
…
,u
*
(k)]；式中，u
*
(k)为标准化肌电信号，w表示滑动窗口长度。3.根据权利要求1所述的一种基于示教轨迹优化与修正的机器人打磨系统的打磨方法，其特征在于：步骤S2)中，所述的神经网络模型包括一个输入层，四个卷积模块和一个输出层，所述的神经网络模型以扩展肌电信号方阵U
*
(k)作为输入，以预测三维力信号作为输出；每个卷积模块包括一个2D卷积层，批标准化层BN和20％的dropout层，并使用整流线性单元ReLU进行激活，卷积层的卷积核数量依次设计为4，8，16和32，卷积核大小均设计为2x2，输出层设计为两个单元个数分别为6和3的全连接层，对每个全连接层使用ReLU进行激活。4.根据权利要求1所述的一种基于示教轨迹优化与修正的机器人打磨系统的打磨方法，其特征在于：步骤S3)中，使用动态运动原语对机器人(1)末端位姿轨迹从时间轴正向和反向进行建模，得到位姿模型：反向进行建模，得到位姿模型：反向进行建模，得到位姿模型：反向进行建模，得到位姿模型：φ
i
＝exp(
‑
d
i
(s
‑
c
i
)2)；式中，a和b分别表示位姿模型刚度系数和阻尼系数，g和β0分别表示位姿轨迹的目标值和初始值；τ表示模型时间放缩系数；β1＝[β
1x
,β
1y
,β
1z
,β
1r
,β
1p
,β
1y
]和β2＝[β
2x
,β
2y
,β
2z
,β
2r
,β
2p
,β
2y
]分别表示机器人(1)末端位姿和速度；ω
i
，d
i
，c
i
分别表示第i个高斯基函数φ
i
的权
重，宽度和中心；M表示选取的高斯基函数数量，s表示模型相位变量，α表示预设的正参数；表示机器人末端加速度、表示机器人末端速度、f(s；ω)表示模型非线性项、表示模型相位变量的一阶导数；使用动态运动原语对机器人(1)z轴的法向力轨迹从时间轴正向和反向进行建模，得到力模型：力模型：力模型：其中τ模型时间放缩系数，c和d分别表示力模型的刚度系数和阻尼系数，f
g
和f0分别表示力轨迹的目标值和初始值，f1＝f
1z
和f2＝f
2z
分别表示机器人(1)末端z轴力和力的导数，γ
i
表示第i个高斯基函数φ
i
的权重；位姿和力模型由同一个相位变量s驱动，以实现在时间轴上的同步；表示机器人末端z轴力的二阶导数、表示机器人末端z轴力的一阶导数。5.根据权利要求1所述的一种基于示教轨迹优化与修正的机器人打磨系统的打磨方法，其特征在于：步骤S4)中，所述的姿态导纳控制算法为：定义R＝H(r,p,y)为从RPY旋转角到对应旋转矩阵的变换，r＝G(R)为从旋转矩阵到对应旋转矢量的变换，H
‑1和G
‑1为相应的逆变换，则以旋转矢量表示的姿态偏移r
e
为：R0(t)＝H(β
1r
(t),β
1p
(t),β
1y
(t))；r
e
(t)＝G(R
e
(t))；其中，R
d
表示期望姿...

【专利技术属性】
技术研发人员：叶德禧，黄浩晖，杨辰光，
申请(专利权)人：佛山纽欣肯智能科技有限公司，
类型：发明
国别省市：