[发明专利]一种基于单机器人对工件偏移后误差检测补偿方法

说明书

本发明涉及一种基于单机器人对工件偏移后误差检测补偿方法，建立机器人第一基坐标系和第二基坐标系，在基坐标系下移动激光测距传感器，对基准工件位置进行标定；在第一基坐标系下，激光测距传感器移动至角度基准点，采集角度基准点到目标检测工件的距离值，计算目标检测工件偏移角度，以第二基坐标系原点为中心，按目标检测工件偏移角度，对第二坐标系进行旋转，得到角度补偿后的第二基坐标系；在第二基坐标系下，激光测距传感器采集到目标检测工件的距离值，偏移量，并对第二基坐标系的X轴、Y轴和Z轴进行距离补偿，得到距离补偿后的第二基坐标系。本发明可以使机器人相对于工件的轨迹保持不变，提高精度。

技术领域

本发明涉及工件偏移误差补偿领域，具体地说是一种基于单机器人对工件偏移后误差检测补偿方法。

背景技术

目前对工件进行定位检测的技术为相机或激光传感器，现有的相机定位精度低成本高，现有的激光检测技术过程繁琐，现有的激光检测技术无法精确的配合机器人对整个工件在X,Y,Z和RZ（或RX或RY）方向的偏差进行补偿，其中RX,RY,RZ分别代表沿X轴旋转的角度，沿Y轴旋转的角度，沿Z轴旋转的角度。因此现有技术需要提高。

发明内容

针对现有技术的不足，本发明提供一种基于单机器人对工件偏移后误差检测补偿方法。

本发明为实现上述目的所采用的技术方案是：

一种基于单机器人对工件偏移后误差检测补偿方法，

步骤1：建立机器人第一基坐标系和第二基坐标系，使第一基坐标系和第二基坐标系具有相同的原点、X轴、Y轴和Z轴；

步骤2：在基坐标系下移动激光测距传感器，对基准工件位置进行标定；

步骤3：在第一基坐标系下，激光测距传感器移动至角度基准点，采集角度基准点到目标检测工件的距离值，计算目标检测工件偏移角度，以第二基坐标系原点为中心，按目标检测工件偏移角度，对第二坐标系进行旋转，得到角度补偿后的第二基坐标系；

步骤4：在第二基坐标系下，激光测距传感器分别移动至X轴、Y轴和Z轴的距离基准点，采集该点到目标检测工件的距离值，计算X轴、Y轴和Z轴方向的偏移量，并按照X轴、Y轴和Z轴方向的偏移量对第二基坐标系的X轴、Y轴和Z轴进行距离补偿，得到距离补偿后的第二基坐标系。

所述第一基坐标系为初始坐标系，用于对角度进行标定，且该坐标系的原点、X轴、Y轴和Z轴不变；所述第二基坐标系用于对基准工件在第二基坐标系中，激光测距传感器在X轴、Y轴和Z轴上到基准工件的距离进行标定。

所述激光测距传感器固定于移动机器人的法兰盘。

所述对基准工件进行标定包括角度标定和距离标定，其中

角度标定：在第一基坐标系中，选取非旋转轴上任意两点作为角度基准点，得到两点之间距离值，采集激光测距传感器分别到两点的距离作为基准距离；

距离标定：在第二基坐标系中，分别选取激光测距传感器在X轴、Y轴和Z轴上任意一点作为X轴、Y轴和Z轴的距离基准点，该点到基准工件的距离值作为X轴、Y轴和Z轴的基准距离

目标检测工件在角度补偿和距离补偿后的第二基坐标系的相对位置与基准工件在第二基坐标系的相对位置相同。

所述目标检测工件偏移角度为：

RZ=arctan()