用于测量工业机器人关节抖动的测量装置及测量方法制造方法及图纸

本发明专利技术公开了一种用于测量工业机器人关节抖动的测量装置及测量方法，工业机器人包括机座、末端和N个关节；测量装置包括分别设于末端和N个关节上的N+1个三向加速度计；所述三向加速度计与PXI控制器电连接，PXI控制器与上位机电连接。本发明专利技术具有测量效率高、测量准确性好的特点，可以准确测量出关节的抖动对末端抖动的贡献系数。动的贡献系数。动的贡献系数。

【技术实现步骤摘要】
用于测量工业机器人关节抖动的测量装置及测量方法


[0001]本专利技术涉及工业机器人
，尤其是涉及一种测量效率高、测量准确性好的用于测量工业机器人关节抖动的测量装置及测量方法。

技术介绍

[0002]工业机器人的工作性能直接决定了生产质量和效率，然而由于减速器等柔性部件的存在，工业机器人在启动或者大负载高速运动时，末端会产生比较大的抖动，严重降低工业机器人的末端精度。为此，要对工业机器人末端的抖动进行准确测量，分析对末端抖动贡献大的关节，然后通过提高对应关节的刚度，减少关节的抖动，降低工业机器人末端的抖动，提高工业机器人的末端精度。

技术实现思路

[0003]本专利技术的专利技术目的是为了克服现有技术中的工业机器人在启动或者大负载高速运动时，末端会产生比较大的抖动的不足，提供了一种测量效率高、测量准确性好的用于测量工业机器人关节抖动的测量装置及测量方法。
[0004]为了实现上述目的，本专利技术采用以下技术方案：
[0005]一种用于测量工业机器人关节抖动的测量装置，工业机器人包括机座、末端和N个关节；测量装置包括分别设于末端和N个关节上的N+1个三向加速度计；所述三向加速度计与PXI控制器电连接，PXI控制器与上位机电连接，N≥2；机座与底座连接，底座下部设有若干个滚轮，底座包括下部减震结构和上部抖动机构；上部抖动机构包括与下部减震结构连接的竖杆，套设于竖杆上的弹簧，通过圆孔与竖杆上部的外周面滑动连接的水平板，与下部减震结构连接的限位竖筒，设于限位竖筒上的用于控制钢珠落到水平板上的钢珠下落机构；机座下表面上设有凹槽，竖杆插入凹槽中，竖杆上端和凹槽顶部之间设有弹性垫；水平板外侧面与限位竖筒内侧壁滑动连接，机座与水平板固定连接。
[0006]下部减震结构用于隔离地面的震动，防止地面的震动对检测产生干扰，确保检测的准确性，上部抖动机构用于给工业机器人的机座提供冲击力，使检测到的抖动幅值变大，从而进一步提高检测的准确定。
[0007]在工业机器人零位状态下，将N+1个三向加速度计通过螺纹刚性连接在工业机器人的末端中心以及N个关节中心处，并使三向加速度计的X、Y、Z方向与工业机器人机座坐标系重合，所述三向加速度计用于采集所述工业机器人末端和各关节的抖动信号。每个三向加速度计将采集到的抖动信号传递给信号调理电路进行放大和模拟滤波，放大和滤波后的模拟信号经过A/D转换模块变成数字信号，所述数字信号经PXI总线传递给PXI控制器中的RAM模块进行存储，PXI控制器用于保证N+1个三向加速度计可以同步采集并传输抖动数据，PXI控制器通过USB接口将抖动数据传递给上位机进行数据分析与处理，得到工业机器人末端和各关节的抖动特性。在进行工业机器人抖动测量前，需对工业机器人进行校准。
[0008]作为优选，所述钢珠下落机构包括横向延伸的壳体，设于壳体左侧的气缸；气缸的
伸缩杆伸入壳体中，壳体左上部和右下部均设有钢珠过孔，伸缩杆右端与推板连接。
[0009]作为优选，所述下部减震结构包括与各个滚轮连接的水平下钢板，设于水平下钢板上表面的水平聚四氟乙烯板，和与水平聚四氟乙烯板上表面连接的水平上钢板。
[0010]水平聚四氟乙烯板一定柔韧性，能够隔离地面的震动，避免检测过程中，地面的震动对检测产生干扰。
[0011]作为优选，机座外侧设有圆环，圆环通过若干个螺钉与水平板固定连接；所述限位筒包括圆形围板和设于圆形围板上端的环形挡板。
[0012]作为优选，圆形围板的内侧壁上设有L条竖向滑槽，水平板的外侧面上设有L个滑块，各个滑块分别与各条竖向滑槽滑动连接，L≥2。
[0013]一种用于测量工业机器人关节抖动的测量装置的测量方法，包括如下步骤：
[0014]步骤1，使工业机器人各个关节保持不动，从设定的试验路径的起点开始，工业机器人以设定的速度沿试验路径运行至试验路径的终点后，使工业机器人停止运行若干秒；
[0015]然后，工业机器人从设定的试验路径的终点开始，以设定的速度沿试验路径运行至试验路径的起点后，使工业机器人停止运行若干秒，上述过程为1个测试循环；
[0016]在工业机器人沿试验路径往复运行的过程中，钢珠下落机构控制若干个钢珠等间隔的落到水平板上；
[0017]在终点和起点停顿的目的是，使被校工业机器人有足够的时间达到静止状态；
[0018]步骤2，重复步骤1，等到上位机采集了完整的3个测试循环的数据后，使工业机器人停止运行；
[0019]步骤3，对于每个三向加速度计，上位机取一个测试循环的FFT信号，进行FFT分析：
[0020]将FFT信号以线性幅值谱显示，观察谱图的幅值分布，在幅值分布频率的基础上增加2Hz至3Hz作为高通滤波截止频率，对FFT信号进行高通滤波；对FFT信号进行二次积分，获得抖动信号；
[0021]步骤4，对于每个关节的三向加速度计获得的抖动信号，上位机利用峰峰值计算方法，计算抖动信号的最大抖动峰峰值；
[0022]步骤5，上位机读取每个测试循环的末端和各个关节点的最大抖动峰峰值，计算得到每个关节抖动对末端抖动的贡献系数。
[0023]如果得到某几个关节的抖动对末端抖动贡献系数较大，研发人员通过改变关节的材料来提高关节的刚度，降低关节的抖动，从而降低工业机器人末端的抖动，提高工业机器人的末端精度。
[0024]作为优选，所述步骤4包括如下步骤：
[0025]步骤4
‑
1，在抖动信号中选取一个时间周期T的数据段，找出数据段内抖动信号的各个交零点，得到交零点的总数M2；设定s为交零点的序号，s的初始值为1；
[0026]步骤4
‑
2，找出第s个交零点和第s+2个交零点之间的最大正信号值和最大负信号值；
[0027]步骤4
‑
3，计算最大正信号值和最大负信号值的绝对值的和，得到峰峰值P
s(s+1)(s+2)
；
[0028]步骤4
‑
4，当s＜(M2
‑
2)，使s的值增加1，返回步骤2；当s＝(M2
‑
2)，得到数据段内抖动信号所有的峰峰值；
[0029]步骤4
‑
5，计算所有的峰峰值的最大值P
max
，将P
max
作为抖动信号的最大抖动峰峰值。
[0030]作为优选，所述步骤5包括如下步骤：
[0031]步骤5
‑
1，各个关节的抖动引起工业机器人末端的抖动，设定末端抖动值与各关节抖动值之间的关系如下：
[0032][0033]其中，F
m
(ω)表示工业机器人末端抖动的理论频谱，F
i
(ω)表示第i个关节抖动的理论频谱，A
i
表示第i个关节的抖动对末端抖动的贡献系数预估值，ω为抖动信号的角频率；
[0034][0035][0036]其中，y(t)
m<本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种用于测量工业机器人关节抖动的测量装置，工业机器人包括机座(10)、末端(11)和N个关节(12)；其特征是，测量装置包括分别设于末端和N个关节上的N+1个三向加速度计(13)；所述三向加速度计与PXI控制器电连接，PXI控制器与上位机电连接，N≥2；机座与底座(2)连接，底座下部设有若干个滚轮(21)，底座包括下部减震结构(22)和上部抖动机构(23)；上部抖动机构包括与下部减震结构连接的竖杆(231)，套设于竖杆上的弹簧(232)，通过圆孔与竖杆上部的外周面滑动连接的水平板(233)，与下部减震结构连接的限位竖筒(234)，设于限位竖筒上的用于控制钢珠落到水平板上的钢珠下落机构(235)；机座下表面上设有凹槽(101)，竖杆插入凹槽中，竖杆上端和凹槽顶部之间设有弹性垫(1011)；水平板外侧面与限位竖筒内侧壁滑动连接，机座与水平板固定连接。2.根据权利要求1所述的用于测量工业机器人关节抖动的测量装置，其特征是，所述钢珠下落机构包括横向延伸的壳体(2351)，设于壳体左侧的气缸(2352)；气缸的伸缩杆(2353)伸入壳体中，壳体左上部和右下部均设有钢珠过孔(2354)，伸缩杆右端与推板连接。3.根据权利要求1所述的用于测量工业机器人关节抖动的测量装置，其特征是，所述下部减震结构包括与各个滚轮连接的水平下钢板(221)，设于水平下钢板上表面的水平聚四氟乙烯板(222)，和与水平聚四氟乙烯板上表面连接的水平上钢板(223)。4.根据权利要求1所述的用于测量工业机器人关节抖动的测量装置，其特征是，机座外侧设有圆环(102)，圆环通过若干个螺钉与水平板固定连接；所述限位筒包括圆形围板(2341)和设于圆形围板上端的环形挡板(2342)。5.根据权利要求4所述的用于测量工业机器人关节抖动的测量装置，其特征是，圆形围板的内侧壁上设有L条竖向滑槽(23411)，水平板的外侧面上设有L个滑块(2331)，各个滑块分别与各条竖向滑槽滑动连接，L≥2。6.一种基于权利要求1所述的用于测量工业机器人关节抖动的测量装置的测量方法，其特征是，包括如下步骤：步骤1，使工业机器人各个关节保持不动，从设定的试验路径的起点开始，工业机器人以设定的速度沿试验路径运行至试验路径的终点后，使工业机器人停止运行若干秒；然后，工业机器人从设定的试验路径的终点开始，以设定的速度沿试验路径运行至试验路径的起点后，使工业机器人停止运行若干秒，上述过程为1个测试循环；在工业机器人沿试验路径往复运行的过程中，钢珠下落机构控制若干个钢珠等间隔的落到水平板上；步骤2，重复步骤1，等到上位机采集了完整的3个测试循环的数据后，使工业机器人停止运行；步骤3，对于每个三向加速度计，上位机取一个测试循环的FFT信号，进行FFT分析：将FFT信号以线性幅值谱显示，观察谱图的幅值分布，在幅值分布频率的基础上增加2Hz至3Hz作为高通滤波截止频率，对FFT信号进行高通滤波；对FFT信号进行二次积分，获得抖动信号；步骤4，对于每个关节的三向加速度计获得的抖动信号，上位机利用峰峰值计算方法，计算抖动信号的最大抖动峰峰值；步骤5，上位机读取每个测试循环的末端和各个关节点的最大抖动峰峰值，计算得到每个关节抖动对末端抖动的贡献系数。
7.根据权利要求6所述的用于测量工业机器人关节抖动的测量装置的测量方法，其特征是，所述步骤4包括如下步骤：步骤4
‑
1，在抖动信号中选取一个时间周期T的数据段，找出数据段内抖动信号的各个交零点，得到交...

【专利技术属性】
技术研发人员：陈旭雯，
申请(专利权)人：浙江谱麦科技有限公司，
类型：发明
国别省市：