[发明专利]一种快速定位补偿方法

说明书

技术领域

本发明涉及机器人定位领域，尤其涉及一种快速定位补偿方法。

背景技术

当机器人围绕第四轴旋转时，不是围绕物体中心旋转，而是以物体中心之外的一个点为轴进行旋转，所以当机器人旋转时，物体中心会发生偏移，如果没有采用工具坐标系，则机器人调整后还需要重新获取偏差在水平面内进行平移调整。

发明内容

本发明的目的在于提出一种快速定位补偿方法，能够对机器人和相机之间的坐标进行快速补偿，实现方式简单。

为达此目的，本发明采用以下技术方案：

一种快速定位补偿方法，包括

步骤110、机器人移动到拍照点，建立标准模板；

步骤120、机器人沿预设的轴进行旋转，采集旋转过程中的相机的旋转角度及所述旋转角度对应的相机中心的偏移坐标；

步骤130、根据所述旋转角度、所述偏移坐标和所述标准模板，计算所述偏移坐标和所述标准模板的偏差，建立所述旋转角度和所述偏差的对应关系；

步骤140、采用插值法建立所述旋转角度和偏差的补偿表格，对相机和机器人的定位进行补偿。

其中，所述标准模板包括：拍照点的坐标。

其中，所述预设的轴为过拍照点的一条直线，所述相机的旋转圆心坐标为拍照点坐标，所述相机的旋转半径为相机到拍照点的距离。

其中，所述步骤130包括：

步骤131、采集五个偏移坐标，分别计算五个偏移坐标与所述拍照点的坐标的偏差，所述五个偏移坐标对应的旋转角度为-2度、-1度、0度、1度和2度；

步骤132、从所述五个偏移坐标中任取三个坐标点，计算得到所述旋转圆心和旋转半径；

步骤133、得到所述旋转角度和所述偏差的对应关系。

其中，所述步骤140包括：

步骤141、建立一个旋转角度从-2度到2度的补偿表格；

步骤142、采用插值法在所述补偿表格中插入若干个等分点；

步骤143、当机器人旋转时，根据相机的旋转角度读取所述补偿表格中的数据进行补偿。

其中，所述等分点的个数为100，则所述补偿表格的精度为0.01度。

其中，所述等分点的个数为1000，则所述补偿表格的精度为0.001度。

其中，所述步骤140之后还包括：

步骤150、当所述标准模板的圆心发生偏心时，计算偏心坐标与所述旋转圆心之间的距离作为第二旋转半径，将所述旋转半径与所述第二旋转半径的比值作为补偿表格的加权系数，得到偏心时的补偿表格。

本发明的有益效果为：一种快速定位补偿方法，包括机器人移动到拍照点，建立标准模板；机器人沿预设的轴进行旋转，采集旋转过程中的相机的旋转角度及所述旋转角度对应的相机中心的偏移坐标；根据所述旋转角度、所述偏移坐标和所述标准模板，计算所述偏移坐标和所述标准模板的偏差，建立所述旋转角度和所述偏差的对应关系；采用插值法建立所述旋转角度和偏差的补偿表格，对相机和机器人的定位进行补偿，能够对机器人和相机之间的坐标进行快速补偿，实现方式简单。

附图说明

图1是本发明具体实施方式提供的一种快速定位补偿方法流程图。

具体实施方式

下面结合图1并通过具体实施方式来进一步说明本发明的技术方案。

图1是本发明具体实施方式提供的一种快速定位补偿方法流程图。

一种快速定位补偿方法，包括

步骤110、机器人移动到拍照点，建立标准模板；

步骤120、机器人沿预设的轴进行旋转，采集旋转过程中的相机的旋转角度及所述旋转角度对应的相机中心的偏移坐标；

步骤130、根据所述旋转角度、所述偏移坐标和所述标准模板，计算所述偏移坐标和所述标准模板的偏差，建立所述旋转角度和所述偏差的对应关系；

步骤140、采用插值法建立所述旋转角度和偏差的补偿表格，对相机和机器人的定位进行补偿。

在本实施例中，能够对机器人的机械手和相机之间的坐标进行快速转换，且不需要校正板，实现方式简单，且属于用表格方式补偿，比现有技术中的相机参数演算法准确，可以解决非线性的数学计算。

在本实施例中，所述标准模板包括：拍照点的坐标。

在本实施例中，所述预设的轴为过拍照点的一条直线，所述相机的旋转圆心坐标为拍照点坐标，所述相机的旋转半径为相机到拍照点的距离。

在本实施例中，所述步骤130包括：