CN105574884B - 一种医疗机器人dh参数标定方法 - Google Patents

一种医疗机器人dh参数标定方法 Download PDF

Info

Publication number
CN105574884B
CN105574884B CN201511031125.1A CN201511031125A CN105574884B CN 105574884 B CN105574884 B CN 105574884B CN 201511031125 A CN201511031125 A CN 201511031125A CN 105574884 B CN105574884 B CN 105574884B
Authority
CN
China
Prior art keywords
camera
parameter
model
robot
medical robot
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN201511031125.1A
Other languages
English (en)
Other versions
CN105574884A (zh
Inventor
刘达
王荣军
赵英含
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beijing Baihui Weikang Technology Co Ltd
Original Assignee
Beijing Baihui Weikang Technology Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Beijing Baihui Weikang Technology Co Ltd filed Critical Beijing Baihui Weikang Technology Co Ltd
Priority to CN201511031125.1A priority Critical patent/CN105574884B/zh
Publication of CN105574884A publication Critical patent/CN105574884A/zh
Application granted granted Critical
Publication of CN105574884B publication Critical patent/CN105574884B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Landscapes

  • Manipulator (AREA)

Abstract

本发明公开了一种医疗机器人DH参数标定方法，包括：建立医疗机器人的运动学模型和相机的成像模型；基于医疗机器人的运动学模型与相机的成像模型确定的***位置信息和姿态信息，来建立误差方程；根据误差方程确定最优化问题的目标函数，通过求解目标函数，来实现医疗机器人DH参数标定。本发明公开的方法，操作简单、成本较低，且可有效提高绝对定位精度。

Description

一种医疗机器人DH参数标定方法
技术领域
本发明涉及机器人技术领域，尤其涉及一种医疗机器人DH参数标定方法。
背景技术
机器人标定技术是机器人领域的重要技术之一，用于校正由于机器人加工与装配过程中带来的误差。
现有的机器人标定技术方法主要基于激光跟踪仪、三维坐标测量仪等设备。一方面，这类设备价格昂贵、操作复杂；另一方面，而且这些方法主要针对工业机器人，旨在提高机器人的重复定位精度，其仅能通过目标点的位置信息建立误差方程，无法使用姿态信息，因而具有局限性而且绝对定位精度有限。
发明内容
本发明的目的是提供一种医疗机器人DH参数标定方法，其操作简单、成本较低，且可有效提高绝对定位精度。
本发明的目的是通过以下技术方案实现的：
一种医疗机器人DH参数标定方法，包括：
建立医疗机器人的运动学模型和相机的成像模型；
基于医疗机器人的运动学模型与相机的成像模型确定的***位置信息和姿态信息，来建立误差方程；
根据误差方程确定最优化问题的目标函数，通过求解目标函数取得最小值时的参数取值，来确定最优的机器人DH参数，即实现机器人参数的标定。
进一步的，所述建立医疗机器人的运动学模型和相机的成像模型包括：
使用DH参数建模方法对医疗机器人建立运动学模型，最终建立一DH模型参数表；
相机的成像模型是基于小孔成像的模型，并加以非线性修正得到；其中，在标定时，以棋盘格标定板作为相机的检测物体，把标定板所在的坐标系作为世界坐标系。
进一步的，所述基于医疗机器人的运动学模型与相机的成像模型确定的***位置信息和姿态信息，来建立误差方程包括：
根据DH参数建模方法对机器人建立运动学模型，获得矩阵与表达式：
式中，c表示余弦函数，s'表示正弦函数，αp-1、θp、dp均为DH参数；
根据建立的医疗机器人的运动学模型和相机的成像模型，获得下式：
其中，中包含了20个未知的DH参数，和已知的关节角增量；是相机坐标系和工具坐标系的转换矩阵；是相机坐标系和世界坐标系的转换矩阵；是机器人坐标系和世界坐标系的转换矩阵；
根据相机的成像模型建模方法，可得出下式，从而计算出相机坐标系和世界坐标系的转换矩阵
其中，(ui，vi)是像素坐标，(Xwi，Ywi，Zwi)是世界坐标系下的坐标，s是比例因子，M1是相机的内部参数，M2是相机的外部参数，i＝1,2...N，表示采集数据的组数；在根据张正友标定法得到M1矩阵后，通过M1和标定板的已知信息计算各组M2，该式中的M2即为相机坐标系和世界坐标系的转换矩阵
在参数均为理想值条件下，等于但是由于***各部分的实际值与理想值存在误差，导致二者并不相等，从而建立误差方程：
设是X是待标定的参数组成的向量，改变N次关节角度，使相机从不同的位姿拍摄标定板，得到机器人关节角度数据；设：
以代替进行计算，得到误差方程组ε，其中第k个误差方程εk表示为：
其中，m＝1,2,3；n＝1,2,3,4；k＝1,2,...,12×N。
进一步的，根据误差方程确定最优化问题的目标函数，通过求解目标函数取得最小值时的参数取值，来确定最优的机器人DH参数包括：
最优化问题的目标函数，通过矩阵表示为：
使用最优化库函数lsqnonlin对目标函数进行求解，根据取得最小值时的参数取值，来确定最优的机器人DH参数。
由上述本发明提供的技术方案可以看出，通过建立标定模型、推导误差方程和最小化目标函数并求解，从而实现医疗机器人DH参数标定；其不仅操作方法简单且成本较低，适合医疗机器人，同时，还可有效提高绝对定位精度。
附图说明
为了更清楚地说明本发明实施例的技术方案，下面将对实施例描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本发明的一些实施例，对于本领域的普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他附图。
图1为本发明实施例提供的一种医疗机器人DH参数标定方法的流程图；
图2为本发明实施例提供的标定前的误差分布示意图；
图3为本发明实施例提供的标定后的误差分布示意图。
具体实施方式
下面结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。基于本发明的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本发明的保护范围。
图1为本发明实施例提供的一种医疗机器人DH参数标定方法的流程图。如图1所示，其主要包括如下步骤：
步骤11、建立医疗机器人的运动学模型和相机的成像模型。
1、医疗机器人的运动学模型。
本发明实施例中，使用DH参数建模方法对医疗机器人建立运动学模型，最终建立一DH模型参数表。DH参数建模是一种通用的机器人建模方法，在每一个连杆上均建立坐标系。
2、相机的成像模型。
相机的成像模型是基于小孔成像的模型，并加以非线性修正得到；其中，在标定时，以棋盘格标定板作为相机的检测物体，把标定板所在的坐标系作为世界坐标系。
在建立了医疗机器人的运动学模型和相机的成像模型后，可以得到两个模型之间的四个坐标系：机器人坐标系、工具坐标系、相机坐标系和世界坐标系；这些模型和坐标系构成了标定***，即是标定模型。
步骤12、基于医疗机器人的运动学模型与相机的成像模型确定的***位置信息和姿态信息，来建立误差方程。
根据DH参数建模方法对机器人建立运动学模型，获得矩阵与表达式：
式中，c表示余弦函数，s'表示正弦函数，αp-1、θp、dp均为DH参数；
根据建立的医疗机器人的运动学模型和相机的成像模型，获得下式：
其中，中包含了20个未知的DH参数，和已知的关节角增量；是相机坐标系和工具坐标系的转换矩阵；是相机坐标系和世界坐标系的转换矩阵；是机器人坐标系和世界坐标系的转换矩阵；
根据相机的成像模型建模方法，可得出下式，从而计算出相机坐标系和世界坐标系的转换矩阵
其中，(ui，vi)是像素坐标，(Xwi，Ywi，Zwi)是世界坐标系下的坐标，s是比例因子，M1是相机的内部参数，M2是相机的外部参数，i＝1,2...N，表示采集数据的组数，N为最大采集数目；再根据张正友标定法得到M1矩阵后，通过M1和标定板的已知信息计算各组M2，该式中的M2即为相机坐标系和世界坐标系的转换矩阵s是一个比例因子；
在参数均为理想值条件下，等于但是由于***各部分的实际值与理想值存在误差，导致二者并不相等；但是当机械臂的参数接近真实值时，通过其计算出的也将趋于接近，我们的误差方程便基于此性质进行推导，即我们希望调整机械臂的参数，使通过其计算出相接近，数学描述如下。
设是X是待标定的参数组成的向量，改变N次关节角度，使相机从不同的位姿拍摄标定板，得到机器人关节角度数据；设：
可以针标定实验做出如下假设：
1)实验组数足够大，能够提供丰富的位姿数量；
2)不同的位姿均布在真实位姿周围；
3)实验过程中的随机误差均匀分布.
基于上述假设，可以以代替进行计算，得到误差方程组ε，其中第k个误差方程εk表示为：
其中，m＝1,2,3；n＝1,2,3,4；k＝1,2,...,12×N。
该误差方程来源于相机坐标系与世界坐标系的转换，因此同时考虑***位置信息和姿态信息，与传统的仅基于距离或位置信息构造的误差方程相比，具有更为丰富的校准数据类型，能够做出更接近真实情况的模型刻画。
步骤13、根据误差方程确定最优化问题的目标函数，通过求解目标函数取得最小值时的参数取值，来确定最优的机器人DH参数，即实现机器人参数的标定。
最优化问题的目标函数，通过矩阵表示为：
使用最优化库函数lsqnonlin对目标函数进行求解(函数使用LM算法对目标函数进行求解)，从而实现医疗机器人DH参数标定。
本发明实施例所提供标定方法可以显著提高医疗机器人的绝对定位精度；如表1所示为医疗机器人标定前后定位误差。
表1 医疗机器人标定前后定位误差
经过计算，标定前后的误差的分布如图2-3所示。
从图表中可以看出，机器人的绝对定位精度得到了有效的提高。同时，整套定标方案所涉及的设备简单、成本较低且操作方法简单，适用于医疗机器人。
通过以上的实施方式的描述，本领域的技术人员可以清楚地了解到上述实施例可以通过软件实现，也可以借助软件加必要的通用硬件平台的方式来实现。基于这样的理解，上述实施例的技术方案可以以软件产品的形式体现出来，该软件产品可以存储在一个非易失性存储介质(可以是CD-ROM，U盘，移动硬盘等)中，包括若干指令用以使得一台计算机设备(可以是个人计算机，服务器，或者网络设备等)执行本发明各个实施例所述的方法。
以上所述，仅为本发明较佳的具体实施方式，但本发明的保护范围并不局限于此，任何熟悉本技术领域的技术人员在本发明披露的技术范围内，可轻易想到的变化或替换，都应涵盖在本发明的保护范围之内。因此，本发明的保护范围应该以权利要求书的保护范围为准。

Claims (3)

1.一种医疗机器人DH参数标定方法，其特征在于，包括：
建立医疗机器人的运动学模型和相机的成像模型；
基于医疗机器人的运动学模型与相机的成像模型确定的***位置信息和姿态信息，来建立误差方程；
根据误差方程确定最优化问题的目标函数，通过求解目标函数取得最小值时的参数取值，来确定机器人DH参数，即实现机器人参数的标定；
其中，所述基于医疗机器人的运动学模型与相机的成像模型确定的***位置信息和姿态信息，来建立误差方程包括：
根据DH参数建模方法对机器人建立运动学模型，获得矩阵与表达式：
式中，c表示余弦函数，s'表示正弦函数，αp-1、θp、dp均为DH参数；
根据建立的医疗机器人的运动学模型和相机的成像模型，获得下式：
其中，中包含了20个未知的DH参数，和已知的关节角增量；是相机坐标系和工具坐标系的转换矩阵；是相机坐标系和世界坐标系的转换矩阵；是机器人坐标系和世界坐标系的转换矩阵；
根据相机的成像模型建模方法，可得出下式，从而计算出相机坐标系和世界坐标系的转换矩阵
其中，(ul，vl)是像素坐标，(Xwl，Ywl，Zwl)是世界坐标系下的坐标，s是比例因子，M1是相机的内部参数，M2是相机的外部参数，l＝1,2...L，L表示采集数据的组数；在根据张正友标定法得到M1矩阵后，通过M1和标定板的已知信息计算各组M2，该式中的M2即为相机坐标系和世界坐标系的转换矩阵
在参数均为理想值条件下，等于但是由于***各部分的实际值与理想值存在误差，导致二者并不相等，从而建立误差方程：
设X是待标定的参数组成的向量，改变N次关节角度，使相机从不同的位姿拍摄标定板，得到机器人关节角度数据；设：
以代替进行计算，得到误差方程组ε，其中第k个误差方程εk表示为：
其中，m＝1,2,3；n＝1,2,3,4；k＝1,2,...,12×N。
2.根据权利要求1所述的方法，其特征在于，所述建立医疗机器人的运动学模型和相机的成像模型包括：
使用DH参数建模方法对医疗机器人建立运动学模型，最终建立一DH模型参数表；
相机的成像模型是基于小孔成像的模型，并加以非线性修正得到；其中，在标定时，以棋盘格标定板作为相机的检测物体，把标定板所在的坐标系作为世界坐标系。
3.根据权利要求1所述的方法，其特征在于，根据误差方程确定最优化问题的目标函数，通过求解目标函数取得最小值时的参数取值，来确定机器人DH参数包括：
最优化问题的目标函数，通过矩阵表示为：
使用最优化库函数lsqnonlin对目标函数进行求解，根据取得最小值时的参数取值，来确定机器人DH参数。
CN201511031125.1A 2015-12-31 2015-12-31 一种医疗机器人dh参数标定方法 Active CN105574884B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201511031125.1A CN105574884B (zh) 2015-12-31 2015-12-31 一种医疗机器人dh参数标定方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201511031125.1A CN105574884B (zh) 2015-12-31 2015-12-31 一种医疗机器人dh参数标定方法

Publications (2)

Publication Number Publication Date
CN105574884A CN105574884A (zh) 2016-05-11
CN105574884B true CN105574884B (zh) 2018-10-19

Family

ID=55884973

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201511031125.1A Active CN105574884B (zh) 2015-12-31 2015-12-31 一种医疗机器人dh参数标定方法

Country Status (1)

Country Link
CN (1) CN105574884B (zh)

Families Citing this family (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108044651A (zh) * 2017-10-19 2018-05-18 北京航空航天大学 一种基于双目视觉的空间机械臂运动学参数在轨标定方法
CN109591010A (zh) * 2018-11-27 2019-04-09 西北工业大学 基于空间向量法的工业机器人运动学参数获取及校验方法
CN112277002B (zh) * 2020-10-19 2021-11-02 南京工程学院 基于非完整位姿信息的机器人运动学标定装置及标定方法
CN113340198A (zh) * 2021-06-09 2021-09-03 配天机器人技术有限公司 一种机器人姿态测量方法及机器人姿态测量***
CN117788604A (zh) * 2023-12-29 2024-03-29 珠海广浩捷科技股份有限公司 一种通过已标定机器人进行相机标定的方法

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102818524A (zh) * 2012-07-31 2012-12-12 华南理工大学 一种基于视觉测量的在线机器人参数校准方法
CN104608129A (zh) * 2014-11-28 2015-05-13 江南大学 基于平面约束的机器人标定方法
CN104858870A (zh) * 2015-05-15 2015-08-26 江南大学 基于末端编号靶球的工业机器人测量方法

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103231375A (zh) * 2013-04-28 2013-08-07 苏州大学 基于距离误差模型的工业机器人标定方法
CN103720514B (zh) * 2013-12-13 2016-03-23 北京柏惠维康科技有限公司 针对手术空间的医疗外科机器人的参数优化方法
CN104833324A (zh) * 2015-01-28 2015-08-12 江南大学 一种基于测量头的机器人标定方法

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102818524A (zh) * 2012-07-31 2012-12-12 华南理工大学 一种基于视觉测量的在线机器人参数校准方法
CN104608129A (zh) * 2014-11-28 2015-05-13 江南大学 基于平面约束的机器人标定方法
CN104858870A (zh) * 2015-05-15 2015-08-26 江南大学 基于末端编号靶球的工业机器人测量方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
医用机器人运动学参数最优化设计;王荣军 等;《机器人》;20070731;第29卷(第4期);第368-373页 *

Also Published As

Publication number Publication date
CN105574884A (zh) 2016-05-11

Similar Documents

Publication Publication Date Title
CN105574884B (zh) 一种医疗机器人dh参数标定方法
CN107564069B (zh) 标定参数的确定方法、装置及计算机可读存储介质
JP5746477B2 (ja) モデル生成装置、３次元計測装置、それらの制御方法及びプログラム
CN107194974B (zh) 一种基于多次识别标定板图像的多目相机外参标定精度的提高方法
JP5924862B2 (ja) 情報処理装置、情報処理方法及びプログラム
JP5627325B2 (ja) 位置姿勢計測装置、位置姿勢計測方法、およびプログラム
CN107358633A (zh) 一种基于三点标定物的多相机内外参标定方法
CN110443879B (zh) 一种基于神经网络的透视误差补偿方法
CN108818540B (zh) 补偿参数的方法及装置、处理器和存储介质
CN109493389B (zh) 一种基于深度学习的相机标定方法及***
CN109523595A (zh) 一种建筑工程直线棱角间距视觉测量方法
CN110095089B (zh) 一种飞行器旋转角度的测量方法及***
WO2019173808A1 (en) Real-time quality control during manufacturing using augmented reality
CN111562563A (zh) 激光雷达转台标定方法、装置和计算机可读存储介质
CN114758005B (zh) 激光雷达与相机外参标定方法及装置
Wang et al. An improved measurement model of binocular vision using geometrical approximation
CN113814987B (zh) 多相机机器人手眼标定方法、装置、电子设备及存储介质
CN112967347B (zh) 位姿标定方法、装置、机器人及计算机可读存储介质
CN105046691A (zh) 一种基于正交消失点的相机自标定方法
CN109909999B (zh) 一种获取机器人tcp坐标的方法和装置
CN114049401A (zh) 双目相机标定方法、装置、设备及介质
Cerveri et al. Combined evolution strategies for dynamic calibration of video-based measurement systems
CN109785393B (zh) 一种基于平面运动约束的相机自标定方法
CN112631200A (zh) 一种机床轴线测量方法以及装置
Kurillo et al. Framework for hierarchical calibration of multi-camera systems for teleimmersion

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant
CP03 Change of name, title or address
CP03 Change of name, title or address

Address after: 100191 Room 501, floor 5, building 9, No. 35 Huayuan North Road, Haidian District, Beijing

Patentee after: Beijing Baihui Weikang Technology Co.,Ltd.

Address before: 100191 Room 303, building 3, No.9 Huayuan East Road, Haidian District, Beijing

Patentee before: Beijing Baihui Wei Kang Technology Co.,Ltd.