1. 为什么要标定旋转中心

在机器视觉实际应用过程中，有这样的案例：机械手要抓取物料，物料每次的角度不一样，机械手的末端工具中心与其自身的旋转中心不重合，如果想完成这个抓取的工作，有两种解决方案：

TCP标定（Tool Center Point）

一般机械手都会有建立新工具坐标系的功能，比如EPSON。TCP标定的本质就是求旧的工具坐标系与新的工具坐标系的旋转平移矩阵。一般是定义新的工具编号，放一个参考点，多次旋转U轴（旋转轴）（4次），然后移动X，Y（base下）使新工具坐标末端对准参考点，
对完之后点击示教就行了。以上使EPOSN的简单流程。

标定旋转中心和旋转半径

如果机器人没有TCP标定的功能怎么办呢？其实这种概率比较低，因为市场上几乎所有的机器人都会有这种功能了，大部分是由于操作机器人的工程师业务不够熟练，所以就把这个任务交给机器视觉工程师了。
还有另外一种情况，如果你使用的运动机构是运动控制卡控制的，这里我们讨论的是有旋转轴的机构，而且旋转轴上的工具末端中心又和旋转轴不重合，这时候就不得不标定旋转中心和旋转半径了。
其实一般带有旋转轴的机构，我们都会标定旋转中心的，因为靠机械定位误差比较大，机器视觉工程师要对最终的精度负责，标定旋转中心是必要的，要不然我们要旋转轴干嘛呢？

2. 如何标定旋转中心

2.1 标定旋转中心的操作步骤

如下图，在旋转轴工具上放置一个Mark点，旋转角度，获得三个点，三点拟合圆，获得圆心坐标和旋转半径（默认已经做完九点标定，这三个点转为世界坐标后再计算圆心坐标和旋转半径）。

2.2 三点拟合圆心代码：

通过下面的计算，我们能得到旋转中心和旋转半径。

using System;
using System.Collections.Generic;
using System.ComponentModel;
using System.Data;
using System.Drawing;
using System.Linq;
using System.Text;
using System.Threading.Tasks;
using System.Windows.Forms;namespace 求圆心
{public partial class Form1 : Form{public Form1(){InitializeComponent();}private void button1_Click(object sender, EventArgs e){double[] xy = new double[3];xy = RotateCenter(double.Parse(txtX1.Text),double.Parse(txtY1.Text),double.Parse(txtX2.Text),double.Parse(txtY2.Text),double.Parse(txtX3.Text),double.Parse(txtY3.Text));txtxcen.Text = xy[0].ToString();//Xtxtycen.Text = xy[1].ToString();//Ytxtrcen.Text = xy[2].ToString();//R}public double[] RotateCenter(double x1,double y1,double x2,double y2,double x3,double y3){double a, b, c, d, e, f;a = 2 * (x2-x1);b = 2 * (y2-y1);c = x2 * x2 + y2 * y2 - x1 * x1 - y1 * y1;d = 2 * (x3 - x2);e = 2 * (y3 - y2);f = x3 * x3 + y3 * y3 - x2 * x2 - y2 * y2;double x = (b * f - e * c) / (b*d-e*a);double y = (d*c-a*f) / (b*d-e*a);double r = Math.Sqrt((x1 - x) * (x1 - x) + (y1 - x) * (y1 - x));double[] xyr = new double[3];xyr[0] = x;xyr[1] = y;xyr[2] = r;return xyr;}}
}

3. halcon多点拟合圆的方法

如果你使用的算法库是halcon，那么我将给您提供一个更方便的多点拟合圆的方法：

博客链接：https://blog.csdn.net/weixin_38566632/article/details/118580370?spm=1001.2014.3001.5501
这种方法更灵活，您可以自由增加点数而不受限制。

halcon代码：

Row := [0,100.5,100,3]
Col := [4,0,100,99.4]gen_contour_polygon_xld (Contour, Row, Col)
fit_circle_contour_xld (Contour, 'geotukey', -1, 0, 0, 3, 2, Row_C, Column_C, Radius_C, StartPhi_C, EndPhi_C, PointOrder_C)dev_set_color ('blue')
gen_circle_contour_xld (ContCircle, Row_C, Column_C, Radius_C, 0, 4 * acos(0), 'positive', 1)

4. 如何使用旋转中心计算偏移量

这一步就是最重要的一步了，如何使用旋转中心和旋转半径来确定偏移量呢？

已知：旋转中心坐标和旋转半径R

设：

因为
三角形BAC 和三角形 OAD是相似三角形
所以

求解上面方程：

5. 计算一点绕另一点旋转一定角度后新点的坐标

第4节主要是为了讲清楚这个推导过程，接下来我们直接给出代码：
博客链接：https://blog.csdn.net/weixin_38566632/article/details/118580534?spm=1001.2014.3001.5501

using System;namespace RotatePoint
{class Program{static void Main(string[] args){double X = 0;double Y = 0;//顺时针角度为负数RotateAngle(1, 1, -45, 2, 2, ref X, ref Y);Console.WriteLine(X+","+Y);Console.ReadKey();}public static string RotateAngle(double XRotation, double YRotation, double ARotate, double XBefore, double YBefore, ref double XAfter, ref double YAfter){try{double Rad = 0;Rad = ARotate * Math.Acos(-1) / 180;XAfter = (XBefore - XRotation) * Math.Cos(Rad) - (YBefore - YRotation) * Math.Sin(Rad) + XRotation;YAfter = (YBefore - YRotation) * Math.Cos(Rad) + (XBefore - XRotation) * Math.Sin(Rad) + YRotation;return "OK";}catch (Exception ex){return ex.Message;}}}
}

标定旋转中心的目的就是，计算旋转一定角度后新点的坐标；

X,Y和角度纠偏的步骤：

X,Y和角度的偏差，在机械动作上是同时进行纠偏的，但是在算法中却不是，我们往往是先转正角度，然后算出转正角度后新位置的坐标；
此时新位置和模板角度是相同的，只需要平移就能重合，这个平移量就是9点标定时算出并保存的仿射变换矩阵来计算的了。

对我的文章感兴趣的小伙伴，可以关注我，我会一直更新这类的文章，和大家一起探讨学习。如果您觉得文章写的还不错的话，就帮我点个赞吧。

机器视觉——旋转中心的标定相关推荐

机器视觉的相机标定到底是什么？
转载:https://www.zhihu.com/question/29448299 之前做识别算法现在开始学习标定.用matlab. 刚开始看标定,先从单个相机开始看.标定板为何需要在不同角度拍20 ...
相机计算坐标公式_机器视觉系统坐标标定与计算方法
介绍了摄像机标定的概念和重要性 , 并介绍了摄像机传统的标定方法 . 自标定方法 . 线性标定方法和非线性标定方法 , 结合 ZF D - 900 TFT - LCD 玻璃自动分断机为例具体讲解了坐标 ...
机器视觉--使用halcon标定助手进行相机标定
一.点击选项卡:---助手--创建新的calibration,可以设置自己的摄相机参数. 二.选择描述文件,cpd文件,就是选择你所需要的标定板的尺寸样式. 如果没有你想使用的标定板,可以通过生成标定 ...
halocn标定找旋转中心_一种利用旋转中心进行手眼标定的原理性介绍
首先,我们要了解一下常规的手眼标定流程是怎么样的. (一)如果吸嘴中心就是法兰盘的中心则是下面这样的:按九宫格走九个点,取得九组吸嘴的像素坐标与法兰盘的机械坐标 (图1) 进行标定 (二)如果吸嘴位 ...
机器视觉标定（calibration）关键尝试（标定的重要意义度量衡）（A）
learning opencv开篇便谈视觉病态畸变的问题,我们人类世界的进步和度量衡有莫大的关系,而工业自动化以及人工智能(AI)的度量衡又是什么呢?那就是标定,其意义是非凡的,也可以说是伟大的,人工 ...
相机标定：PNP基于单应面解决多点透视问题
利用二维视野内的图像,求出三维图像在场景中的位姿,这是一个三维透视投影的反向求解问题.常用方法是PNP方法,需要已知三维点集的原始模型. 本文做了大量修改,如有不适,请移步原文: ...
我的Qt作品（14）基于机器视觉+运动控制的LED数码管套板机软件（双相机贴合）
开发环境 Windows7/10 x64,VS2019,Qt5.12.11 x64,OpenCV4.5.5 x64 LED数码管贴合软件的总体目标: 是控制自动化设备,把LED线路板精准得贴合(套入) ...
matlab单目相机标定步骤,matlab相机标定
本文是一篇关于相机标定意义和原理的个人总结,包含了 OpenCV 和 Matlab 中常用的相机标定函数的注解. 相机标定是机器视觉的基础, 标定结果的好坏直接决定了机器...... 图片数量一定程 ...
机器视觉运动控制一体机应用例程|轮廓在线提取与轮廓轨迹加工（下）
应用背景在实际的机器视觉应用项目中,常常需要提取在相机视野下不同形状的样品,根据样品的轮廓轨迹位置进行轮廓轨迹加工处理. 上期课程中我们讲述了轮廓在线提取与轮廓轨迹加工中视觉的轮廓提取部分.本期课程 ...

机器视觉——旋转中心的标定

旋转中心的计算和使用