激光位移传感器测试机器人主从距离准确度方法及系统技术方案

本发明专利技术属于遥操作机器人技术领域，具体涉及一种激光位移传感器测试机器人主从距离准确度方法及系统。本发明专利技术的方法包括以下步骤：将激光接收板安装在从端设备所在的遥操作机器人机械臂上，并设置激光位移传感器，使激光位移传感器所射出激光被激光接收板接收；通过采集激光位移传感器的激光在激光接收板上的位移数据，获得遥操作机器人机械臂的实际位移数据，同时通过记录主端设备发送给遥操作机器人机械臂的读数和激光位移传感器的读数，获得遥操作机器人在X轴和Y轴方向上的主从距离准确度。本发明专利技术的方法可实现遥操作机器人主从距离准确度测试，并确保测试过程的简洁化和效率化，同时可大幅降低测试成本，性价比更高。性价比更高。性价比更高。

【技术实现步骤摘要】
激光位移传感器测试机器人主从距离准确度方法及系统


[0001]本专利技术属于遥操作机器人
，具体涉及一种激光位移传感器测试机器人主从距离准确度方法及系统。

技术介绍

[0002]遥操作，是指操作者通过手控器、手柄等人机交互装置和设备控制远端的机器人完成作业任务的行为。操作者通过主机器人向从机器人发送指令，同时感受到从机器人和外界的交互信息，从而完成遥操作任务。当机器人处理复杂的感知和大量任务时，在快速做出决策和处理极端情况时，遥操作远远优于智能编程。目前遥操作已广泛应用在医疗领域、极端环境探索如太空与深海场景、防恐防暴应用场景，以及基于工业机械臂的自动化生产中。
[0003]为了确保检测过程的安全，遥操作机器人的性能检测至关重要，其绝对定位精度是机械臂的重要性能指标，定位精度更是直接关系着超声扫查的效果。目前，测试机械臂位移精度的获取，主要采用拉线编码器测量、双目视觉测量及激光跟踪仪测量等；但是，拉线编码器机构复杂，测量时标定步骤繁琐；双目视觉测量价格较高，精度较低；激光跟踪仪精度很高，但是价格昂贵，一般测量又无法承受，因此人们也一直在寻求一套性价比更高的机械臂位移精度获取方式。而针对机械臂位移精度的获取只是主从距离准确度的其中一个拦路因素；另一方面，当前针对遥操作机器人的主从距离准确度的测试，也仍然没有一套系列化的系统和方法，方法各不相同而又彼此保密，已知的碎片化的系统和方法又多较为复杂。因此，设计一种操作简单、成本低、精度达到遥操作机器人性能检测标准的主从距离准确度方法显然十分重要。
专利技术内容
[0004]本专利技术的目的是克服上述现有技术的不足，提供一种遥操作机器人主从距离准确度方法，该方法可以实现遥操作机器人主从距离准确度测试，并确保测试过程的简洁化和效率化，同时可大幅降低测试成本，性价比更高。
[0005]为实现上述目的，本专利技术采用了以下技术方案：一种激光位移传感器测试机器人主从距离准确度方法，其特征在于包括以下步骤：S1、将激光接收板安装在从端设备所在的遥操作机器人机械臂上，并设置激光位移传感器，使激光位移传感器所射出激光被激光接收板接收；该激光接收板的面朝激光位移传感器的一侧设置彼此相交的第一表面和第二表面，相交处形成棱边，且第一表面在测试时垂直于激光位移传感器激光射出方向；第二表面在测试时作为激光位移传感器射出激光的受光面并提供一个位移数据采集点，所述棱边作为激光位移传感器射出激光的另一个位移数据采集点；S2、通过采集激光位移传感器的激光在激光接收板上的位移数据，获得遥操作机
器人机械臂在X轴和Y轴方向上的实际位移数据，同时通过记录主端设备发送给遥操作机器人机械臂的读数和激光位移传感器的读数，获得遥操作机器人在X轴和Y轴方向上的主从距离准确度。
[0006]优选的，所述步骤S2包括以下子步骤：S21、测量起始点确认：根据遥操作机器人机械臂需要测量位移的范围，选择遥操作机器人机械臂对应的水平位移，控制遥操作机器人机械臂沿水平方向移动至起始位置，将此时激光位移传感器在激光接收板第二表面上的激光照射位置标记为起始点；S22、移动测量：控制遥操作机器人机械臂沿水平方向移动，使激光位移传感器射出激光移动经过激光接收板的第二表面和第一表面；S23、遥操作机器人机械臂位移数据采样与结果计算：采集激光位移传感器的激光在起始点和棱边上时的位移数据，采用下式计算遥操作机器人机械臂在X轴和Y轴方向上的实际位移数据：
[0007]式中：α1分别为激光接收板的第二表面和X轴方向的实际夹角；α2分别为激光接收板的第二表面和Y轴方向的实际夹角；x1为激光位移传感器在X轴方向上起始点的读数；y1为激光位移传感器在Y轴方向上起始点的读数；x
b
为激光位移传感器在X轴方向上从起始点移动到棱边上时的读数；y
b
为激光位移传感器在Y轴方向上从起始点移动到棱边上时的读数；x
i
为激光位移传感器在X轴方向上的第i次移动的读数；y
i
为激光位移传感器在Y轴方向上的第i次移动的读数；x
i+1
为激光位移传感器在X轴方向上的第i+1次移动的读数；y
i+1
为激光位移传感器在Y轴方向上的第i+1次移动的读数；i表示为单次测量时，激光从起始点到测试完成过程中的第i次移动；i
xb
为激光在X轴方向上从起始点移动到棱边上时的移动次数；i
yb
为激光在Y轴方向上从起始点移动到棱边上时的移动次数；
x
k
为在X轴方向上对遥操作机器人机械臂发送的位移数据；y
k
为在Y轴方向上对遥操作机器人机械臂发送的位移数据；P
xi
为遥操作机器人机械臂在X轴方向上的实际位移数据；P
yi
为遥操作机器人机械臂在Y轴方向上的实际位移数据；P
x
’
为在X轴方向上，激光经过激光接收板第一表面时经补偿后的实际位移数据；P
y
’
为在Y轴方向上，激光经过激光接收板第一表面时经补偿后的实际位移数据；I为激光接收板第一表面的水平方向长度，为常数；S24、主从距离准确度数据采样与结果计算：启动遥操作机器人，使其处于主从控制模式，将主端设备沿Y轴方向移动指定距离，记录主端设备发送给遥操作机器人机械臂的读数和激光位移传感器的读数，并采用下式计算在X轴和Y轴方向上的主从距离准确度：
[0008]式中：x
m
为主端设备沿X轴方向的实际位移值；y
m
为主端设备沿Y轴方向的实际位移值；x
j
为每次移动后主端设备发送给遥操作机器人机械臂沿X轴方向的移动距离；y
j
为每次移动后主端设备发送给遥操作机器人机械臂沿Y轴方向的移动距离；AP
x
为遥操作机器人机械臂在X轴方向上的主从距离准确度；AP
y
为遥操作机器人机械臂在Y轴方向上的主从距离准确度；n为单次测量时，激光从测量开始到测量结束总共移动的次数。
[0009]优选的，子步骤S21之前，首先进行遥操作机器人机械臂工具坐标系与激光位移传感器的标定工作，包括对遥操作机器人机械臂Y轴和激光位移传感器射出激光方向进行标定、对遥操作机器人机械臂X轴和激光位移传感器射出激光的垂直方向进行标定以及对激
光位移传感器射出激光落在激光接收板的棱边上进行标定。
[0010]优选的，对遥操作机器人机械臂Y轴和激光位移传感器射出激光方向进行标定的具体过程为：控制遥操作机器人机械臂沿其工具坐标系Y轴方向前后移动，移动过程中激光位移传感器射出激光始终落在激光接收板的第一表面中心位置，则完成标定；否则，控制遥操作机器人机械臂重新运动到起点位置，再绕工具坐标系的X轴和Z轴旋转指定角度后，重复沿遥操作机器人机械臂工具坐标系Y轴方向的前后移动及确认激光落点位置的操作，反复调节直至遥操作机器人机械臂沿工具坐标系Y轴方向前后移动时，激光始终落在激光接收板的第一表面本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.激光位移传感器测试机器人主从距离准确度方法，其特征在于包括以下步骤：S1、将激光接收板（10）安装在从端设备所在的遥操作机器人机械臂上，并设置激光位移传感器（20），使激光位移传感器（20）所射出激光被激光接收板（10）接收；该激光接收板（10）的面朝激光位移传感器（20）的一侧设置彼此相交的第一表面（11）和第二表面（12），相交处形成棱边（13），且第一表面（11）在测试时垂直于激光位移传感器（20）激光射出方向；第二表面（12）在测试时作为激光位移传感器（20）射出激光的受光面并提供一个位移数据采集点，所述棱边（13）作为激光位移传感器（20）射出激光的另一个位移数据采集点；S2、通过采集激光位移传感器（20）的激光在激光接收板（10）上的位移数据，计算遥操作机器人机械臂在X轴和Y轴方向上的实际位移数据，同时通过记录主端设备发送给遥操作机器人机械臂的读数和激光位移传感器（20）的读数，获得遥操作机器人在X轴和Y轴方向上的主从距离准确度。2.根据权利要求1所述的激光位移传感器测试机器人主从距离准确度方法，其特征在于：所述步骤S2包括以下子步骤：S21、测量起始点确认：根据遥操作机器人机械臂需要测量位移的范围，选择遥操作机器人机械臂对应的水平位移，控制遥操作机器人机械臂沿水平方向移动至起始位置，将此时激光位移传感器（20）在激光接收板（10）第二表面（12）上的激光照射位置标记为起始点；S22、移动测量：控制遥操作机器人机械臂沿水平方向移动，使激光位移传感器（20）射出激光移动经过激光接收板（10）的第二表面（12）和第一表面（11）；S23、遥操作机器人机械臂位移数据采样与结果计算：采集激光位移传感器（20）的激光在起始点和棱边（13）上时的位移数据，采用下式计算遥操作机器人机械臂在X轴和Y轴方向上的实际位移数据：式中：α1分别为激光接收板（10）的第二表面（12）和X轴方向的实际夹角；α2分别为激光接收板（10）的第二表面（12）和Y轴方向的实际夹角；x1为激光位移传感器（20）在X轴方向上起始点的读数；y1为激光位移传感器（20）在Y轴方向上起始点的读数；
x
b
为激光位移传感器（20）在X轴方向上从起始点移动到棱边（13）上时的读数；y
b
为激光位移传感器（20）在Y轴方向上从起始点移动到棱边（13）上时的读数；x
i
为激光位移传感器（20）在X轴方向上的第i次移动的读数；y
i
为激光位移传感器（20）在Y轴方向上的第i次移动的读数；x
i+1
为激光位移传感器（20）在X轴方向上的第i+1次移动的读数；y
i+1
为激光位移传感器（20）在Y轴方向上的第i+1次移动的读数；i表示为单次测量时，激光从起始点到测试完成过程中的第i次移动；i
xb
为激光在X轴方向上从起始点移动到棱边（13）上时的移动次数；i
yb
为激光在Y轴方向上从起始点移动到棱边（13）上时的移动次数；x
k
为在X轴方向上对遥操作机器人机械臂发送的位移数据；y
k
为在Y轴方向上对遥操作机器人机械臂发送的位移数据；P
xi
为遥操作机器人机械臂在X轴方向上的实际位移数据；P
yi
为遥操作机器人机械臂在Y轴方向上的实际位移数据；P
x
’
为在X轴方向上，激光经过激光接收板（10）第一表面（11）时经补偿后的实际位移数据；P
y
’
为在Y轴方向上，激光经过激光接收板（10）第一表面（11）时经补偿后的实际位移数据；I为激光接收板（10）第一表面（11）的水平方向长度，为常数；S24、主从距离准确度数据采样与结果计算：启动遥操作机器人，使其处于主从控制模式，将主端设备沿Y轴方向移动指定距离，记录主端设备发送给遥操作机器人机械臂的读数和激光位移传感器（20）的读数，并采用下式计算在X轴和Y轴方向上的主从距离准确度：式中：x
m
为主端设备沿X轴方向的实际位移值；
y
m
为主端设备沿Y轴方向的实际位移值；x
j
为每次移动后主端设备发送给遥操作机器人机械臂沿X轴方向的移动距离；y
j
为每次移动后主端设备发送给遥操作机器人机械臂沿Y轴方向的移动距...

【专利技术属性】
技术研发人员：刘振，朱蓉军，黄琦，程栋梁，周世宁，邵超，
申请(专利权)人：合肥合滨智能机器人有限公司，
类型：发明
国别省市：