一种基于力反馈的复杂曲面机器人贴合方法与流程

1.本发明涉及机器人控制技术领域，具体是一种基于力反馈的复杂曲面机器人贴合方法。


背景技术：

2.目前机器人应用于工业、医疗行业，如机器人打磨、机器人b超系统，机器人面向的贴合面均为复杂曲面。机器人力控技术是保证贴合有效性以及安全性的前提，传统的pid控制不能使机器人表现出一定的柔性，无法保证复杂曲面贴合的有效性；力/位混合控制能够实现对每个轴的力控与位控，但方法复杂。在力反馈方面，现阶段大部分机器人不能反馈力信息，目前在机器人末端加装力传感器是广泛应用的一种方法，通过力传感器实时反馈接触力，但其测量精度未得到验证。所以，人们需要一种基于力反馈的复杂曲面机器人贴合方法来解决上述问题。


技术实现要素：

3.发明目的：本发明目的在于针对现有技术，提供一种基于力反馈的复杂曲面机器人贴合方法解决机器人对于复杂曲面无法有效贴合的问题。
4.技术方案：本发明所述一种基于力反馈的复杂曲面机器人贴合方法，用于拟合机器人运动的参考轨迹，包括以下步骤：
5.s10、基于机器人对复杂曲面的实际贴合轨迹需求，通过示教手动获得若干个曲面关键点；
6.s20、将各曲面关键点作为贝兹曲线拟合的控制顶点，通过轨迹规划算法初步拟合出机器人运动参考轨迹；
7.s30、基于机器人与复杂曲面的贴合效果，根据经验给出期望力；
8.s40、建立阻抗模型并设定参数数值，需设定的参数包括惯性参数、刚度参数、阻尼参数；
9.s50、通过安装在机器人上的传感器实时反馈当前时刻接触力数据；将当前时刻接触力数据同机器人当前速度、当前加速度代入建立的阻抗模型，求得位置修正量；将位置修正量与机器人上一时刻的实际位置叠加，求得机器人当前位置并对机器人下发指令；
10.s60、重复步骤s40、s50直至机器人运动至最后一个曲面关键点，停止下发运动指令，机器人完成整个曲面贴合过程，运动结束。
11.优选的，所述s20中，轨迹规划算法具体步骤如下：
12.s2001、选取n 1个控制顶点，将各控制顶点代入n次贝兹曲线公式：
13.14.其中，p
i
为控制顶点，为伯恩斯坦基函数，n为贝兹曲线次数，i为控制顶点的下表索引；
15.s2002、将n次贝兹曲线公式如下递归表达：
[0016][0017]
其中，为n次曲线上的点，t为比例系数，为由控制顶点递推出的点；
[0018]
s2003、将各控制顶点代入贝兹曲线的递推表达式，初步拟合机器人运动参考轨迹；贝兹曲线的递推表达式如下：
[0019][0020]
其中，为k次贝兹曲线上、第i段曲线上的点，t为比例系数。
[0021]
优选的，所述s50中，阻抗模型如下：
[0022][0023]
其中，m为惯性系数，b为阻尼系数，k为刚度系数；为实际加速度，为参考轨迹加速度；为实际速度，为参考轨迹速度；x为实际轨迹，x
r
为参考轨迹；f为实际接触力，f
r
为期望接触力。
[0024]
优选的，当前加速度求解过程如下：
[0025][0026]
其中，为t时刻加速度，即当前加速度；f
(t
‑
1)
为t
‑
1时刻真实接触力(由传感器测得)，f
r
为期望接触力；x
(t
‑
1)
为t
‑
1时刻机器人实际轨迹，x
r(t
‑
1)
为t
‑
1时刻机器人参考轨迹；为t
‑
1时刻机器人实际速度，为t
‑
1时刻参考轨迹速度；为t
‑
1时刻参考轨迹加速度。
[0027]
优选的，当前速度求解过程如下：
[0028][0029]
其中，为t时刻速度，即当前速度；为t
‑
1时刻机器人实际速度，为t时刻加速度，t为运动指令时间间隔。
[0030]
优选的，位置修正量求解过程如下：
[0031][0032]
其中，δx
(t)
为t时刻位置修正量，为t时刻速度，t为运动指令时间间隔。优选的，机器人当前位置求解过程如下：
[0033]
x
(t)
＝x
(t
‑
1)
δx
[0034]
其中，x
(t)
为t时刻机器人实际位置，即当前位置；x
(t
‑
1)
为t
‑
1时刻机器人实际位置，δx
(t)
为t时刻位置修正量。
[0035]
有益效果：本发明采用轨迹规划算法初步拟合出机器人参考轨迹，有利于减小机器人位置修正量，使得机器人运动更加平稳，贴合效率更高；当机器人面对不同环境时，可以调整自身的惯性参数、刚度参数、阻尼参数来适应环境；本发明还通过安装在机器人上的力传感器实时读取真实接触力数据，并利用此数据对机器人位置修正量进行求解，力传感器反馈数据以及下发指令实时性高，保证了贴合的有效性，提高了机器人运动过程的安全性，有效避免接触力过大而导致机器人及曲面受到损伤。
附图说明
[0036]
图1为本发明一种基于力反馈的复杂曲面机器人贴合方法的总流程图；
[0037]
图2为本发明一种基于力反馈的复杂曲面机器人贴合方法的贝兹拟合曲线；
[0038]
图3为本发明一种基于力反馈的复杂曲面机器人贴合方法的位置修正示意图。
具体实施方式
[0039]
下面通过附图对本发明技术方案进行详细说明，但是本发明的保护范围不局限于实施例。
[0040]
实施例1：如图1
‑
3所示，一种基于力反馈的复杂曲面机器人贴合方法，用于拟合机器人运动的参考轨迹，包括以下步骤：
[0041]
步骤10、基于机器人对复杂曲面的实际贴合轨迹需求，通过示教手动获得十个曲面关键点；
[0042]
步骤20、将各曲面关键点作为贝兹曲线拟合的控制顶点，通过轨迹规划算法初步拟合出机器人运动参考轨迹；贝塞尔曲线递推式用matlab程序实现；
[0043]
步骤30、基于机器人与复杂曲面的贴合效果，根据经验给出期望力，给出的期望力为10n；
[0044]
步骤40、建立阻抗模型并设定参数数值，需设定的参数包括惯性参数、刚度参数、阻尼参数，惯性参数、刚度参数、阻尼参数分别设定1、5、50；
[0045]
步骤50、通过安装在机器人上的传感器实时反馈当前时刻接触力数据；将当前时刻接触力数据同机器人当前速度、当前加速度代入建立的阻抗模型，求得位置修正量；将位置修正量与机器人上一时刻的实际位置叠加，求得机器人当前位置并对机器人下发指令；
[0046]
步骤60、重复步骤步骤40、步骤50直至机器人运动至最后一个曲面关键点，停止下发运动指令，机器人完成整个曲面贴合过程，运动结束。
[0047]
步骤20中，轨迹规划算法具体步骤如下：
[0048]
步骤2001、选取n 1个控制顶点，将各控制顶点代入n次贝兹曲线公式：
[0049][0050]
其中，p
i
为控制顶点，为伯恩斯坦基函数，n为贝兹曲线次数，i为控制顶点的下表索引；
[0051]
步骤2002、将n次贝兹曲线公式如下递归表达：
[0052][0053]
其中，为n次曲线上的点，t为比例系数，为由控制顶点递推出的点；
[0054]
步骤2003、将各控制顶点代入贝兹曲线的递推表达式，初步拟合机器人运动参考轨迹；贝兹曲线的递推表达式如下：
[0055][0056]
其中，为k次贝兹曲线上、第i段曲线上的点，t为比例系数。
[0057]
步骤50中，阻抗模型如下：
[0058][0059]
其中，m为惯性系数，b为阻尼系数，k为刚度系数；为实际加速度，为参考轨迹加速度；为实际速度，为参考轨迹速度；x为实际轨迹，x
r
为参考轨迹；f为实际接触力，f
r
为期望接触力。
[0060]
当前加速度求解过程如下：
[0061][0062]
其中，为t时刻加速度，即当前加速度；f
(t
‑
1)
为t
‑
1时刻真实接触力(由传感器测得)，f
r
为期望接触力；x
(t
‑
1)
为t
‑
1时刻机器人实际轨迹，x
r(t
‑
1)
为t
‑
1时刻机器人参考轨迹；为t
‑
1时刻机器人实际速度，为t
‑
1时刻参考轨迹速度；为t
‑
1时刻参考轨迹加速度；
[0063]
t
‑
1时刻参考轨迹速度和t
‑
1时刻参考轨迹加速度求解方法如下：
[0064][0065][0066]
其中，δt为下发运动指令的时间间隔。
[0067]
当前速度求解过程如下：
[0068][0069]
其中，为t时刻速度，即当前速度；为t
‑
1时刻机器人实际速度，为t时刻加速度，t为运动指令时间间隔。
[0070]
位置修正量求解过程如下：
[0071][0072]
其中，δx
(t)
为t时刻位置修正量，为t时刻速度，t为运动指令时间间隔。机器人当前位置求解过程如下：
[0073]
x
(t)
＝x
(t
‑
1)
δx
[0074]
其中，x
(t)
为t时刻机器人实际位置，即当前位置；x
(t
‑
1)
为t
‑
1时刻机器人实际位置，δx
(t)
为t时刻位置修正量。
[0075]
如上，尽管参照特定的优选实施例已经表示和表述了本发明，但其不得解释为对本发明自身的限制。在不脱离所附权利要求定义的本发明的精神和范围前提下，可对其在形式上和细节上作出各种变化。