[发明专利]工业机器人定位精度标定方法

摘要

本发明涉及一种工业机器人定位精度的标定方法，用于提高机器人的绝对定位精度。通过建立机器人的运动学模型；用圆周法建立旋转关节方程，计算关节扭转角参数值；运用激光跟踪仪对机器人末端实际位姿的精确测量；对D-H算法求逆运动学方程进行改进，求得几何结构参数，实现对关节距离参数值、关节偏移量的标定，从而完成第一次标定。将第一次标定后的结果对D-H参数进行误差修正，如定位精度未达到要求，可将参数修正值代替理论参数值代入运动学方程进行二次标定。实验证明，该标定方法提高了机器人的绝对定位精度。本发明中的标定方法具有简单，实用，引入外界误差小的优点。

主权项

1.一种工业机器人定位精度的标定方法，其特征在于：具体步骤是： （1）建立机器人的运动学模型用D-H连接变换齐次坐标模型来建立机器人的运动学模型，把每个变换定义为，在机器人的基座和手之间的总变换为：（2）关节扭转角参数值的标定采用圆周法计算出机器人各关节旋转轴线的方程，设求出的相邻关节电动机的轴线方程为、，根据空间两条直线的位置关系方程求得、之间的夹角；设的方向矢量为，的方向矢量为，按下式计算两直线的夹角：从而确定机器人运动学模型中的关节扭转角修正参数值；（3）机器人末端实际位姿的测量在关节活动范围内，任意指定n组不同的关节转角值，操作机器人，每组关节转角值转到位时，用激光跟踪仪测量出对应的机器人的末端执行器的位姿；（4）关节距离参数值、关节偏移量的标定通过逆运动学的变形式，利用逆变换矩阵左乘运动学方程两边，利用对应元素相等，由等式左右两边的元素，依次得出含有待修正参数的方程，通过多次运用三角代换和矩阵乘法、加法运算，求得多个含有待修正参数的方程，组成方程组，方程个数要足以解出待修正参数；（5）将步骤（3）中指定的关节转角值及其对应的由激光跟踪仪测量得到的机器人末端执行器的实际位姿坐标值代入到（4）中所求得的方程组，解此方程租，得到关节距离参数值，关节偏移量的标定修正值。