一种机械臂导航手术中机械臂配准模块误差校准方法技术

本发明专利技术公开了一种机械臂导航手术中机械臂配准模块误差校准方法，通过计算NDI下检测的中心点和工装几何中心点的补偿。提供一种误差解决校准方法，在机械臂点云配准前，计算出一个偏差值，加入系统后，再次进行点云配准；配准效果好，偏移量小甚至无偏移量，具有一定的使用价值和推广价值。使用价值和推广价值。使用价值和推广价值。

【技术实现步骤摘要】
一种机械臂导航手术中机械臂配准模块误差校准方法


[0001]本专利技术涉及医疗设备领域，尤其涉及一种机械臂导航手术中机械臂配准模块误差校准方法。

技术介绍

[0002]目前传统的机械臂与NDI之间的配准方法，主要采用点云配准方式。在整个过程中，依赖机械臂机械结构精度和NDI反光求的精度，不同的器械精度和型号的NDI实际差距比较大。所以在实际配准中存在了比较明显的个体差异，所以点云配准中会产生不小的误差。这个误差会直接导致机械臂的配准偏差，在导航中导致结果无法达到预期。
[0003]综上所述，需要一种机械臂导航手术中机械臂配准模块误差校准方法来解决现有技术中所存在的不足之处。

技术实现思路

[0004]针对现有技术的不足，本专利技术提供了一种机械臂导航手术中机械臂配准模块误差校准方法，旨在解决上述问题。
[0005]为实现上述目的，本专利技术提供如下技术方案：一种机械臂导航手术中机械臂配准模块误差校准方法，包括以下步骤：
[0006]步骤一：安装机械臂台车和双目视觉设备，设定机械臂基坐标系B，机械臂末端杆坐标系E，双目视觉设备坐标系W，末端配准双目视觉标记物MARK的工具中心点TCP点P；
[0007]步骤二：在机械臂基坐标系B内给定机械臂空间某一个点，让机械臂在这个位置的双目视觉标记物正对着双目视觉设备NDI，记录Pc；
[0008]步骤三：通过机械臂获取当前机械臂的姿态，记录为Rc；
[0009]步骤四：以当位置和姿态作为开始姿态，把矩阵绕X轴旋转θ度，保持机械臂Pc点不变，需要保持双目视觉标记物Mark在双目视觉设备NDI下可见，通过矩阵旋转公式后得到第一个计算位置R0；
[0010]步骤五：机械臂末端器械坐标系Z轴为旋转轴，将R0进行5度为间隔绕机械臂末端Z旋转；将第四步得到的R0通过变化矩阵得到每间隔5度的新矩阵，直至Rn得到120个变化矩阵；
[0011]步骤六：指定机械臂定位120个矩阵，在每个姿态定位后保持一定时间，让NDI检测到稳定的数据并返回，得到机械臂120个位置下配准MARK在NDI下的姿态和位置；
[0012]步骤七：将所有的矩阵所有4*4矩阵分为姿态部分3*3，即r0到rn，和坐标t0到tn；
[0013]步骤八：设定指向标准的姿态矩阵org，使用Eigen::JacobiSVD模块，做最小二乘解，得到中心点X0，即偏离预设TCP坐标的偏移量；
[0014]步骤九：把X加入初始TCP，继续步骤二到步骤八操作，得出偏移量X1，判断X1是否小于设定阈值。
[0015]可选的，所述步骤1中相对于机械臂末端杆坐标系的位置偏移量为Pe＝[x，y，z]。
[0016]可选的，所述步骤1中{B}与{E}的转换关系为：
[0017]T
EB
＝A1*A2*An
[0018]式中n表示机器人总的自由度，Ai表示机器人相邻关节(i
‑
1关节与i关节)之间的转换关系。
[0019]可选的，所述步骤四中的矩阵旋转公式为：
[0020][0021]可选的，所述步骤五中矩阵公式为：
[0022][0023]可选的，所述步骤八姿态矩阵为：
[0024][0025]可选的，所述步骤八中X计算具体为：
[0026]定义一个6列n行矩阵，前3列设置旋转后获取的到3*3矩阵，每个旋转矩阵对应一个目标姿态矩阵(正位，使用A矩阵数据初始化计算库，需要计算薄矩阵U；计算薄矩阵V Eigen::ComputeThinV)；，使用150组数据中空间坐标信息合计b去解出实际中心点，x＝svdA.solve(b)。
[0027]本专利技术的有益效果：
[0028]1、本专利技术中，通过计算NDI下检测的中心点和工装几何中心点的补偿。提供一种误差解决校准方法，在机械臂点云配准前，计算出一个偏差值，加入系统后，再次进行点云配准；配准效果好，偏移量小甚至无偏移量，具有一定的使用价值和推广价值。
附图说明
[0029]图1为本专利技术机械臂坐标系的一种结构示意图。
[0030]图2为本专利技术的一种流程结构示意图。
具体实施方式
[0031]如图1、2所示，一种机械臂导航手术中机械臂配准模块误差校准方法，包括以下步骤：
[0032]步骤一：安装机械臂台车和双目视觉设备，设定机械臂基坐标系B，机械臂末端杆坐标系E，双目视觉设备坐标系W，末端配准双目视觉标记物MARK的工具中心点TCP点P，相对
于机械臂末端杆坐标系的位置偏移量为Pe＝[x，y，z]，步骤1中{B}与{E}的转换关系为：
[0033]T
EB
＝A1*A2*An
[0034]式中n表示机器人总的自由度，Ai表示机器人相邻关节(i
‑
1关节与i关节)之间的转换关系；
[0035]步骤二：在机械臂基坐标系B内给定机械臂空间某一个点，让机械臂在这个位置的双目视觉标记物正对着双目视觉设备NDI，记录Pc；
[0036]步骤三：通过机械臂获取当前机械臂的姿态，记录为Rc；
[0037]步骤四：以当位置和姿态作为开始姿态，把矩阵绕X轴旋转θ度，保持机械臂Pc点不变，需要保持双目视觉标记物Mark在双目视觉设备NDI下可见，通过矩阵旋转公式后得到第一个计算位置R0，矩阵旋转公式为：
[0038][0039]步骤五：机械臂末端器械坐标系Z轴为旋转轴，将R0进行5度为间隔绕机械臂末端Z旋转；将第四步得到的R0通过变化矩阵得到每间隔5度的新矩阵，直至Rn得到120个变化矩阵，矩阵公式为：
[0040][0041]步骤六：指定机械臂定位120个矩阵，在每个姿态定位后保持一定时间，让NDI检测到稳定的数据并返回，得到机械臂120个位置下配准MARK在NDI下的姿态和位置；
[0042]步骤七：将所有的矩阵所有4*4矩阵分为姿态部分3*3，即r0到rn，和坐标t0到tn；
[0043]步骤八：设定指向标准的姿态矩阵org，姿态矩阵为：
[0044][0045]使用Eigen::JacobiSVD模块，做最小二乘解，得到中心点X，即偏离预设TCP坐标的偏移量，具体计算为：
[0046]Eigen::MatrixXd A(rows,6)；定义一个6列n行矩阵；
[0047]A.block<3,3>(currentRow,0)＝R；前3列设置旋转后获取的到3*3矩阵；
[0048]A.block<3,3>(currentRow,3)＝org；每个旋转矩阵对应一个目标姿态矩阵(正位)；
[0049]Eigen::JacobiSVD<Eigen::MatrixXd>svdA(A,Eigen::ComputeThinU|；使用A矩阵数据初始化计算库，需要计算薄矩阵U；计算薄矩阵V 本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种机械臂导航手术中机械臂配准模块误差校准方法，其特征在于，包括以下步骤：步骤一：安装机械臂台车和双目视觉设备，设定机械臂基坐标系B，机械臂末端杆坐标系E，双目视觉设备坐标系W，末端配准双目视觉标记物MARK的工具中心点TCP点P；步骤二：在机械臂基坐标系B内给定机械臂空间某一个点，让机械臂在这个位置的双目视觉标记物正对着双目视觉设备NDI，记录Pc；步骤三：通过机械臂获取当前机械臂的姿态，记录为Rc；步骤四：以当位置和姿态作为开始姿态，把矩阵绕X轴旋转θ度，保持机械臂Pc点不变，需要保持双目视觉标记物Mark在双目视觉设备NDI下可见，通过矩阵旋转公式后得到第一个计算位置R0；步骤五：机械臂末端器械坐标系Z轴为旋转轴，将R0进行5度为间隔绕机械臂末端Z旋转；将第四步得到的R0通过变化矩阵得到每间隔5度的新矩阵，直至Rn得到120个变化矩阵；步骤六：指定机械臂定位120个矩阵，在每个姿态定位后保持一定时间，让NDI检测到稳定的数据并返回，得到机械臂120个位置下配准MARK在NDI下的姿态和位置；步骤七：将所有的矩阵所有4*4矩阵分为姿态部分3*3，即r0到rn，和坐标t0到tn；步骤八：设定指向标准的姿态矩阵org，使用Eigen：：JacobiSVD模块，做最小二乘解，得到中心点X，即偏离预设TCP坐标的偏移量；步骤九：把X加入初始TCP，继续步骤二到步骤八操作，得出偏移量X1，判断...

【专利技术属性】
技术研发人员：叶君，杨旸，陈超，
申请(专利权)人：杭州邦杰星医疗科技有限公司，
类型：发明
国别省市：