手眼标定得到手眼矩阵到底该咋用?

大家好,我是小鱼。上几期给大家分享了关于手眼标定的方法,如果还有不清楚如何让进行手眼标定的同学可以参考下面的文章:

​机器人手眼标定都能搞不定?快戳,最好用的手眼标定库!!!​

很多同学做完了手眼标定之后得到了手眼矩阵,但是不知道怎么用于程序当中去,还有很多同学搞不清楚各个坐标系之间的关系,今天小智就给大家讲讲手眼矩阵的使用问题。

一、手眼矩阵为什么会长的不一样?

做完手眼标定,得到的手眼矩阵,有可能会长的不一样,这是因为旋转变换是有很多种表示方法的。

1.旋转的表示方式

1.1三个数字

欧拉角(就是欧拉他家的墙角),欧拉角又分角度制和弧度制。通常使用英文:rx,ry,rz表示

1.2四个数字

四元数,三个数字的欧拉角表示其实是有奇异性的(后面再和大家讲一讲旋转)所以四元数可以避免这个问题。四元数的常用英文符号:qx,qy,qz,qw


一定要注意四元数的顺序,qw在第一位还是最后一位,小智是吃过亏的。


1.3九个数字的

旋转矩阵,使用九个数字表示旋转,是一个3×3的方阵。

2.手眼矩阵=机械臂末端到相机的平移+机械臂的末端到相机的旋转

上面小智讲了如何表示旋转,那么手眼矩阵是到底是什么呢?

大家可以知道的是平移变换一定是3个数字,分表表示沿着原来的x,y,z轴进行的平移长度。

所以常见的手眼矩阵有三种表现形式:

2.1欧拉角版

​  [x,y,z,rx,ry,rz]​

2.2四元数版

​   [x,y,z,qx,qy,qz,qw]​

2.3旋转矩阵版本

​[​

​ [r11,r12,r13,x],​

​ [r21,r22,r23,y],​

​ [r31,r32,r33,z]​

​]​

2.4齐次矩阵

为了方便运算,我们在旋转矩阵版本上增加一行[0,0,0,1]构成齐次矩阵,这个也是传说中的齐次矩阵

​[​

​ [r11,r12,r13,x],​

​ [r21,r22,r23,y],​

​ [r31,r32,r33,z],​

​ [0, 0, 0, 1]​

​]​

二、手眼矩阵有哪些运算法则,对应的物理意义是什么?

手眼矩阵有了,那么该怎么进行运算呢?

其实我们只需要用到两个运算即可,一个叫做乘法,一个叫做求逆

1.乘法

乘法运算其实就是转换变换:

比如:末端到相机的位姿矩阵表示为Tgc,相机识别到的工件位姿为Tct,那么末端到工件的位姿该如何计算呢?很简单,对他们做乘法运算

  1. ​Tgt = Tgc*Tct​

大家放心,一个4x4的矩阵乘以4x4的矩阵,最终结果还是一个4x4的矩阵。

2.求逆

求逆运算是最神奇的,求逆其实就是置换坐标系

已知相机中标记物的坐标系Tcm,那么标记物中相机的坐标系Tmc是多少呢?

其实很简单:

  1. ​Tmc = Tcm.inverse() //就是求个逆即可​

逆矩阵也是4X4的,且 ​​Tmc*Tcm=I,I是单位矩阵​​秀一波线性代数,回头给大家推荐一本书,讲线性代数的,后台回复线性代数即可获取哈~

三、自己写计算太麻烦,有什么好用的库进行矩阵运算和坐标转换?

1.C++推荐库

C++版本当然推荐小智自己的开源库啦,详细请戳链接:

​开源库推荐:C++坐标转换库TransForms3d_Cpp​

输入base@grapper、grapper@camera、camera@marker,乘一下就完成了~

这个库有多牛我就不吹了,自己看下代码是多么的流畅

手眼标定搞定了,手眼矩阵不知道怎么用?快戳!!_四元数


2.Python推荐库 

Python版本的推荐的是transforms3d,这个是小智最喜欢的库了,安装使用都很简单,今天太晚了,明天给大家讲解一下。先留个小尾巴~

最后欢迎大家关注小鱼,后期将会有更多机器人相关的干货输出~