[原创]移动相机九点标定工具原理及实现(包涵部分源码)

1. 移动相机标定与固定相机的标定有什么差异?

  • 书接上文 [原创]一种自动化九点标定工具原理(包涵部分源码)
  • 移动相机(眼在手上):相机安装在龙门架的Z轴上
  • 相机拍照得出来来的位置与当前龙门架实际点位有关系,有什么关系呢?答案:平移关系,只比固定相机多了一个平移关系
  • 怎么理解呢?假如以相机中心点作为坐标系T1原点,坐标系T1和龙门架坐标系G1只有平移关系。 而坐标系T1内的图像坐标系C1与龙门架坐标系G1存在一个固定的仿射变换矩阵

2. 解决办法?

  • 假如龙门架在G1点位,在此点位使用相机拍到一个mark点的图像坐标为P1;放射变换矩阵为M1,而此mark点对应的真实龙门架坐标为R1
  • 四者之间的关系为R1=P1*M1+G1
  • 通过上一篇文章描述方法,同样利用旋转方式获取P1,只是操作方式稍微不同。

3. 详细操作步骤?

  • 龙门架先吸取标定板到R1位置,放下标定板
  • 龙门架到达G1位置,拍照获取到mark点位置P1.1
  • 龙门架再次到R1位置,吸取标定板,旋转180度后放下标定板
  • 龙门架再次到达G1位置,拍照获取到mark点位置P1.2
  • P1的图像坐标为P1.1和P1.2的中心点
  • 到此,公式R1=P1*M1+G1的参数已经拿到R1,P1,G1。按照上述方式操作9次就可以计算出仿射变换矩阵M1了

4. 适用范围

  • 此标定方式只适合类似于龙门架的头部相机标定,不适合机械手设备的头部相机标定
  • 机械手头部相机的标定除了平移关系外,还有旋转关系。具体标定方式见下回分解

5. 源码

[原创]移动相机九点标定工具原理及实现(包涵部分源码)

        private void updatePoiMatrix(Position pcbPoi,Position poi1, Position poi2,Position takePhotoPoi)         {             //更新对应的数组             imagePoiList.Add(new Position() { X = (poi1.X + poi2.X) / 2, Y = (poi1.Y + poi2.Y) / 2 });             System.Windows.Point p1=new System.Windows.Point();             p1.X = pcbPoi.X - takePhotoPoi.X;             p1.Y = pcbPoi.Y - takePhotoPoi.Y;              Position newDstPoi = new Position();             newDstPoi.X = p1.X;             newDstPoi.Y = p1.Y;             robotPoiList.Add(newDstPoi);         }         private void btnSaveCalibration_Click(object sender, EventArgs e)         {             try             {                 NcHelper.GetInstance().SaveMat(imagePoiList, robotPoiList, this.matPath);             }             catch (Exception ex)             {                 this.printException(ex);             }         }                  public void SaveMat(List<Position> imageList, List<Position> robotPoiList, string path)         {             HTuple imageXList = new HTuple(), imageYList = new HTuple();             HTuple robotXList = new HTuple(), robotYList = new HTuple();              for (int i = 0; i < imageList.Count; i++)             {                 imageXList[i] = imageList[i].X;                 imageYList[i] = imageList[i].Y;                 robotXList[i] = robotPoiList[i].X;                 robotYList[i] = robotPoiList[i].Y;             }              HTuple hv_HomMat2D = new HTuple(), hv_SerializedItemHandle = new HTuple();             HTuple hv_FileHandle = new HTuple();             ////标定             hv_HomMat2D.Dispose();             HOperatorSet.VectorToHomMat2d(imageXList, imageYList, robotXList, robotYList, out hv_HomMat2D);              //保存变换矩阵             hv_SerializedItemHandle.Dispose();             HOperatorSet.SerializeHomMat2d(hv_HomMat2D, out hv_SerializedItemHandle);             hv_FileHandle.Dispose();             HOperatorSet.OpenFile(path, "output_binary", out hv_FileHandle);             HOperatorSet.FwriteSerializedItem(hv_FileHandle, hv_SerializedItemHandle);             HOperatorSet.CloseFile(hv_FileHandle);              imageXList.Dispose();             imageYList.Dispose();             robotXList.Dispose();             robotYList.Dispose();             hv_HomMat2D.Dispose();             hv_SerializedItemHandle.Dispose();             hv_FileHandle.Dispose();         } 

6. 后续计划[敬请期待],如需完整代码请微信联系

  • 机械手头部相机标定工具
  • 下相机定位算法
  • 基于头部相机的载具定位算法
  • 基于顶部相机的塑盘取料算法
  • 基于头部相机的检测算法实现
  • 一种面向接口接口、依赖注入的运控框架的总体介绍及分层实现
发表评论

相关文章