A与B组件自动对齐与组装，无映射直接补偿。

网上针对组装的从视觉到控制动作，要不就是收费，要不就是简单介绍。这么详细的比较难找～ 手下留情，不喜勿喷！

Show time～

分步解决方案： 标定阶段（Calibration）

9点张氏标定（每个位置A1、A2、B1、B2）：

使用机械手在相机视野内沿Z字形路径移动，覆盖9个点（XY方向间距根据视野范围设定）。

通过图像识别每个点的像素坐标，结合机械手的实际坐标，计算相机到机械手的变换矩阵（包含旋转和平移）。

输出每个位置的独立标定矩阵（如Mat_A1, Mat_A2, Mat_B1, Mat_B2）。

5点旋转中心标定（每个位置）：

固定机械手在当前位置（如A1），绕Z轴以0.1度为步进旋转，拍摄5个角度（例如0°, 0.1°, 0.2°, 0.3°, 0.4°），记录每个角度下的特征点坐标。

通过最小二乘法拟合旋转中心坐标（机械坐标系下的点），并生成旋转补偿矩阵。

存储每个位置的旋转中心坐标（如RotCenter_A1）及角度-坐标映射关系。

基准点设定（Reference Setup）

拍摄基准图像：

机械手携带标准产品依次到达A1、A2、B1、B2，各位置拍摄图像。

提取图像特征点（如边缘、孔位等）的像素坐标，通过对应标定矩阵转换为机械坐标（如Ref_A1_X, Ref_A1_Y）。

建立基准线段与中心点：

对A1和A2的基准坐标，计算基准线段的端点（如线段Ref_A1A2）及其中点（Center_A）。

同理处理B1和B2，得到Ref_B1B2线段及中点Center_B。

实时角度计算（Angle Calculation）

实时数据采集：

机械手携带产品到达A1、A2，拍摄实时图像，提取特征点并转换为机械坐标（Real_A1, Real_A2）。

同样获取B1、B2的实时坐标（Real_B1, Real_B2）。

平移补偿：

计算实时线段（Real_A1A2）的中点，与基准中点（Center_A）的偏差（ΔX, ΔY）。

控制机械手移动，使实时中点与基准中点重合。

旋转角度计算：

通过基准线段Ref_A1A2与实时线段Real_A1A2的方向向量，计算夹角θ（使用反正切或向量点积公式）。

结合旋转中心坐标（RotCenter_A1），调整机械手绕该中心旋转θ角，使线段对齐。

同步更新B的位置数据：

重复上述步骤处理B1、B2，得到B的实时角度θ_B。

AB组装补偿（Assembly Compensation）

位置偏差补偿：

检测B的实时位置与基准的偏差（如ΔB_X = -5），则A需补偿+5（ΔA_X = 5），使得ΔA_X + ΔB_X = 0。

同样处理Y方向，确保A移动后总偏差归零。

角度同步：

计算A与B的实时角度差Δθ = θ_A - θ_B。

保持B不动，调整A的旋转角度Δθ，使两者角度一致。

最终组装：

在位置和角度补偿完成后，机械手控制A与B进行精密组装，确保接触点零误差。

关键公式与示例： 标定矩阵转换：

( X 机械 Y 机械 ) = Mat 位置 × ( u 像素 v 像素 1 ) ( X 机械 ​

Y 机械 ​

​ )=Mat 位置 ​ × ​

u 像素 ​

v 像素 ​

1 ​

​

旋转角度计算：

θ = arctan ⁡ ( Real_A2 Y − Real_A1 Y Real_A2 X − Real_A1 X ) − arctan ⁡ ( Ref_A2 Y − Ref_A1 Y Ref_A2 X − Ref_A1 X ) θ=arctan( Real_A2 X ​ −Real_A1 X ​

Real_A2 Y ​ −Real_A1 Y ​

​ )−arctan( Ref_A2 X ​ −Ref_A1 X ​

Ref_A2 Y ​ −Ref_A1 Y ​

​ ) 平移补偿量：

Δ X = Center_A X − Real_A1 X + Real_A2 X 2 ΔX=Center_A X ​ − 2 Real_A1 X ​ +Real_A2 X ​

​

注意事项： 确保标定环境稳定，避免振动或光照变化影响标定精度。

定期复检标定参数，防止机械结构磨损导致偏差。

采用滤波算法（如卡尔曼滤波）处理实时数据中的噪声，提高系统鲁棒性。

通过以上步骤ÿ