SCARA 机器人工具标定方法

一、标定目标

确定工具中心点(TCP)相对于末端法兰的偏移向量:

d = {x_t, y_t, z_t}

二、四点法(4-Point Method)标定 TCP 位置

让工具尖端接触一个固定空间点 C,从四个不同姿态接近,记录每次末端法兰在基坐标系中的位置和姿态角。

设第 i 次测量时:

  • 法兰中心位置:P_i = {x_i, y_i, z_i}
  • 工具绕 Z 轴旋转角:θ_i
  • 工具局部 TCP 偏移:d = {x_t, y_t, z_t}

则 TCP 在基坐标系中的位置为:

P_TCP: i = P_i + R_z(θ_i)·d

其中 R_z(θ_i) 是绕 Z 轴的旋转矩阵:

R_z(θ_i) = [cos θ_i -sin θ_i 0;sin θ_i cos θ_i 0; 0 0 1]

展开后:

x_TCP,i = x_i + x_t cos θ_i - y_t sin θ_i

y_TCP,i = y_i + x_t sin θ_i + y_t cos θ_i

z_TCP,i = z_i + z_t

由于所有 P_TCP,i 都应等于同一个固定点 C = {x_c, y_c, z_c},因此有:

x_i + x_t cos θ_i - y_t sin θ_i = x_c

y_i + x_t sin θ_i + y_t cos θ_i = y_c

z_i + z_t = z_c

移项得误差方程(用于最小二乘求解):

x_t cos θ_i - y_t sin θ_i - x_c = -x_i

x_t sin θ_i + y_t cos θ_i - y_c = -y_i

z_t - z_c = -z_i

三、最小二乘法求解(推荐 ≥4 组数据)

将 n 组测量数据代入,构建线性方程组:

A x = b

其中未知数向量 x 为:

x = {x_t, y_t, z_t, x_c, y_c, z_c}

矩阵 A 的每一行(对应第 i 次测量)为:

A_i = [cos θ_i, -sin θ_i, 0, -1, 0, 0] → 对应 x 方程

sin θ_i, cos θ_i, 0, 0, -1, 0\] → 对应 y 方程 \[ 0 , 0 , 1, 0, 0, -1\] → 对应 z 方程 向量 b 的每一行为: b_i = \[-x_i, -y_i, -z_i

求解最小二乘解:

x = (A^T A)^(-1) A^T b

最终,工具偏移量为:

x_t = x[1]

y_t = x[2]

z_t = x[3]

这样通过采集点位建立线性方程组,通过解最小二乘方程组实现了机器人工具坐标标定的全过程。

相关推荐
科士威传动3 小时前
滚珠导轨在半导体制造中如何实现高精度效率
科技·机器人·自动化·制造
铮铭7 小时前
【论文阅读】GR00T N1:面向通用人形机器人的开放基础模型
人工智能·机器人
强化学习与机器人控制仿真10 小时前
LeRobot 入门教程(九)使用 Android、iOS 手机控制机械臂
开发语言·人工智能·stm32·深度学习·神经网络·算法·机器人
蒙帕智能运维10 小时前
FunASR:面向产业落地的端到端语音识别系统
人工智能·机器人·语音识别
zskj_zhyl11 小时前
七彩喜智慧养老:科技向善,让晚年生活绽放“喜”悦之光
人工智能·科技·物联网·机器人
每天进步一大步15 小时前
ACP(八):用插件扩展答疑机器人的能力边界
机器人·acp
资源开发与学习8 天前
机器人运动规划源码解析
机器人
hi0_610 天前
机器学习实战(一): 什么是机器学习
人工智能·机器学习·机器人·机器学习实战
大视码垛机10 天前
速度与安全双突破:大视码垛机重构工业自动化新范式
大数据·数据库·人工智能·机器人·自动化·制造
WWZZ202510 天前
视觉SLAM第10讲:后端2(滑动窗口与位子图优化)
c++·人工智能·后端·算法·ubuntu·机器人·自动驾驶