[发明专利]一种基于视觉反馈的并联机器人位置闭环校准算法

摘要

一种基于视觉反馈的并联机器人位置闭环校准算法。本发明涉及一种基于视觉反馈的并联机器人位置闭环校准算法。步骤一：基于用户输入的校准和矫正周期量T，强制要求动平台在每个矫正时间点到来时，基于现有释放位完成后，进入校准模式，并基于现有坐标体系，移动至规定位置C0（x0，y0，z0），并在进入视界边界线的同时开始依照固定时间戳间隔将动平台运动的运动学解算位置（即运动体系中的理论位置）记录为校对数据包存入校对缓冲区；步骤二：并在进入视界边界线的同时开始依照固定时间戳间隔将动平台运动的运动学解算位置（即运动体系中的理论位置）记录为校对数据包存入校对缓冲区。本发明用于并联机器人位置闭环校准算法。

主权项

1.一种基于视觉反馈的并联机器人位置闭环校准算法，其特征是：通过以下步骤实现：步骤一：基于用户输入的校准和矫正周期量T，强制要求动平台在每个矫正时间点到来时，基于现有释放位完成后，进入校准模式，并基于现有坐标体系，移动至规定位置C0（x0，y0，z0），并在进入视界边界线的同时开始依照固定时间戳间隔将动平台运动的运动学解算位置记录为校对数据包存入校对缓冲区；步骤二：并在进入视界边界线的同时开始依照固定时间戳间隔将动平台运动的运动学解算位置记录为校对数据包存入校对缓冲区；步骤三：运动控制模块在获取第一个UDP包后，开始以时间戳为匹配主键读取理论位置缓冲区中的对应位置数据对，假设捕获的第一个有效UDP视觉位置包解析后位置对为Ck（xk，yk，z0），则动平台理论位置与实际位置的变动量为Δ(xk - x0，yk - y0，0)，以Δ遍历和修正运动控制模块所有坐标变量值，完成校准模式，退出恢复为运动控制模式。