CN111388103A - 一种锉刀及打拔器的校准方法 - Google Patents
一种锉刀及打拔器的校准方法 Download PDFInfo
- Publication number
- CN111388103A CN111388103A CN202010351599.9A CN202010351599A CN111388103A CN 111388103 A CN111388103 A CN 111388103A CN 202010351599 A CN202010351599 A CN 202010351599A CN 111388103 A CN111388103 A CN 111388103A
- Authority
- CN
- China
- Prior art keywords
- position information
- file
- pose
- calibrator
- drawer
- 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.)
- Granted
Links
Images
Classifications
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B90/00—Instruments, implements or accessories specially adapted for surgery or diagnosis and not covered by any of the groups A61B1/00 - A61B50/00, e.g. for luxation treatment or for protecting wound edges
- A61B90/08—Accessories or related features not otherwise provided for
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/11—Complex mathematical operations for solving equations, e.g. nonlinear equations, general mathematical optimization problems
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B2560/00—Constructional details of operational features of apparatus; Accessories for medical measuring apparatus
- A61B2560/02—Operational features
- A61B2560/0223—Operational features of calibration, e.g. protocols for calibrating sensors
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Health & Medical Sciences (AREA)
- Mathematical Physics (AREA)
- Pure & Applied Mathematics (AREA)
- Life Sciences & Earth Sciences (AREA)
- Surgery (AREA)
- Mathematical Optimization (AREA)
- Mathematical Analysis (AREA)
- Data Mining & Analysis (AREA)
- Computational Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Veterinary Medicine (AREA)
- Pathology (AREA)
- General Health & Medical Sciences (AREA)
- Animal Behavior & Ethology (AREA)
- Molecular Biology (AREA)
- Medical Informatics (AREA)
- Heart & Thoracic Surgery (AREA)
- Biomedical Technology (AREA)
- Operations Research (AREA)
- Public Health (AREA)
- Algebra (AREA)
- Oral & Maxillofacial Surgery (AREA)
- Databases & Information Systems (AREA)
- Software Systems (AREA)
- General Engineering & Computer Science (AREA)
- Nuclear Medicine, Radiotherapy & Molecular Imaging (AREA)
- Length Measuring Devices With Unspecified Measuring Means (AREA)
Abstract
本公开实施例中提供了一种锉刀及打拔器的校准方法,属于设备校正技术领域,该方法包括:获取锉刀或打拔器和校准器在世界坐标系下的多个位姿信息;对所述多个位姿态信息进行分组处理,得到计算位姿分组和验证位姿分组;基于所述计算位姿分组和验证位姿分组,获取锉刀或打拔器的法线;基于预先测量的校准器上的多个位置点坐标,确定未知点的圆心坐标;基于所述圆心坐标和所述法线,对锉刀及打拔器进行校准。通过本公开的方案,能够有效的对锉刀及打拔器进行校准操作。
Description
技术领域
本公开涉及设备校正技术领域,尤其涉及一种锉刀及打拔器的校准方法。
背景技术
随着科技发展,越来越多的手术台上出现了机器人及相关手术工具,这些工具能够给医生提供额外的技术指导及病人信息。这些额外技术支持和病人信息的准确度都基于前期准备过程中的工具校准。
发明内容
有鉴于此,本公开实施例提供一种锉刀及打拔器的校准方法,以至少部分解决现有技术中存在的问题。
本公开实施例提供了一种锉刀及打拔器的校准方法,包括:
获取锉刀或打拔器和校准器在世界坐标系下的多个位姿信息;
对所述多个位姿态信息进行分组处理,得到计算位姿分组和验证位姿分组;
基于所述计算位姿分组和验证位姿分组,获取锉刀或打拔器的法线;
基于预先测量的校准器上的多个位置点坐标,确定未知点的圆心坐标;
基于所述圆心坐标和所述法线,对锉刀及打拔器进行校准。
根据本公开实施例的一种具体实现方式,所述获取锉刀或打拔器和校准器在世界坐标系下的多个位姿信息,包括:
将校准器装上锉刀或打拔器,根据锉刀或打拔器和校准器在世界坐标系下的位姿信息,计算并记录校准器第一滚动位置信息;
绕锉刀轴或打拔器轴转动校准器,使其世界坐标发生变化,计算并记录校准器在锉刀坐标系下的三个不同位姿下的位姿信息,得到第二滚动位置信息、第三滚动位置信息、第四滚动位置信息。
根据本公开实施例的一种具体实现方式,所述对所述多个位姿态信息进行分组处理,得到计算位姿分组和验证位姿分组,包括:
将位姿信息分成两组[第一滚动位置信息,第二滚动位置信息,第四滚动位置信息]和[第一滚动位置信息,第三滚动位置信息,第四滚动位置信息],其中,[第一滚动位置信息,第二滚动位置信息,第四滚动位置信息]作为计算结果,[第一滚动位置信息,第三滚动位置信息,第四滚动位置信息]作为验证结果。
根据本公开实施例的一种具体实现方式,所述基于所述计算位姿分组和验证位姿分组,获取锉刀或打拔器的法线,包括:
利用第二滚动位置信息与第一滚动位置信息的差值,作为前后位姿变化产生的向量a,利用第四滚动位置信息与第二滚动位置信息的差值,得到向量b,向量a和向量b均垂直于锉刀轴或打拔器轴且向量a和向量b不共线,通过求向量a和向量b的叉积得到沿轴方向的向量,得到法线。
根据本公开实施例的一种具体实现方式,所述基于预先测量的校准器上的多个位置点坐标,确定未知点的圆心坐标,包括:
先用预先设置的针尖在校准器上取一点,得到校准器的第一针点信息,利用所述针尖取校准器上另外四个点以计算法线及拟合圆心;
第一个方程:三点共面
其中,(x,y,z)分别表示未知点的空间坐标(x1,y1,z1)、(x2,y2,z2)、(x3,y3,z3)分别表示已经测量得到的空间点坐标;
将该行列式方程写出后,可以得到一个平面方程,根据该平面方程的系数同样可以得到该平面的法线;
第二及第三个方程:圆半径相等
由此得到三个方程三个未知数(x,y,z),解出(x,y,z)即为圆心坐标。
根据本公开实施例的一种具体实现方式,所述基于所述圆心坐标和所述法线,对锉刀及打拔器进行校准,包括:
得到正确方向的法线后,记圆心坐标为C,与第一个测试点的坐标相减得到修正向量;
计算修正向量在法线方向上的投影长度L,最后将圆心坐标朝法线方向移动长度L即得到最终的顶点坐标。
本公开实施例中的方案,包括获取锉刀或打拔器和校准器在世界坐标系下的多个位姿信息;对所述多个位姿态信息进行分组处理,得到计算位姿分组和验证位姿分组;基于所述计算位姿分组和验证位姿分组,获取锉刀或打拔器的法线;基于预先测量的校准器上的多个位置点坐标,确定未知点的圆心坐标;基于所述圆心坐标和所述法线,对锉刀及打拔器进行校准。通过本公开的方案,提高了设备校准的效率和准确度。
附图说明
为了更清楚地说明本公开实施例的技术方案,下面将对实施例中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本公开的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其它的附图。
图1为本公开实施例提供的锉刀及打拔器的校准方法的流程示意图;
图2为本公开实施例提供的锉刀的结构示意图;
图3为本公开实施例提供的锉刀顶点上可嵌入十字花部位的结构示意图;
图4为本公开实施例提供的校准器结构示意图;
图5为本公开实施例提供的用于获取校准器平面上一点的针的结构示意图。
具体实施方式
下面结合附图对本公开实施例进行详细描述。
以下通过特定的具体实例说明本公开的实施方式,本领域技术人员可由本说明书所揭露的内容轻易地了解本公开的其他优点与功效。显然,所描述的实施例仅仅是本公开一部分实施例,而不是全部的实施例。本公开还可以通过另外不同的具体实施方式加以实施或应用,本说明书中的各项细节也可以基于不同观点与应用,在没有背离本公开的精神下进行各种修饰或改变。需说明的是,在不冲突的情况下,以下实施例及实施例中的特征可以相互组合。基于本公开中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本公开保护的范围。
需要说明的是,下文描述在所附权利要求书的范围内的实施例的各种方面。应显而易见,本文中所描述的方面可体现于广泛多种形式中,且本文中所描述的任何特定结构及/或功能仅为说明性的。基于本公开,所属领域的技术人员应了解,本文中所描述的一个方面可与任何其它方面独立地实施,且可以各种方式组合这些方面中的两者或两者以上。举例来说,可使用本文中所阐述的任何数目个方面来实施设备及/或实践方法。另外,可使用除了本文中所阐述的方面中的一或多者之外的其它结构及/或功能性实施此设备及/或实践此方法。
还需要说明的是,以下实施例中所提供的图示仅以示意方式说明本公开的基本构想,图式中仅显示与本公开中有关的组件而非按照实际实施时的组件数目、形状及尺寸绘制,其实际实施时各组件的型态、数量及比例可为一种随意的改变,且其组件布局型态也可能更为复杂。
另外,在以下描述中,提供具体细节是为了便于透彻理解实例。然而,所属领域的技术人员将理解,可在没有这些特定细节的情况下实践所述方面。
参见图1-5,本公开实施例中的一种锉刀及打拔器的校准方法,包括:
S101,获取锉刀或打拔器和校准器在世界坐标系下的多个位姿信息;
S102,对所述多个位姿态信息进行分组处理,得到计算位姿分组和验证位姿分组;
S103,基于所述计算位姿分组和验证位姿分组,获取锉刀或打拔器的法线;
S104,基于预先测量的校准器上的多个位置点坐标,确定未知点的圆心坐标;
S105,基于所述圆心坐标和所述法线,对锉刀及打拔器进行校准。
参见图2,图3,图4及图5,锉刀(Roller)及锉刀上的位姿传感器,顶部的十字花可旋转。打拔器顶部也有可旋转的螺纹,操作方法与锉刀相同,因此不单独赘述。在实现步骤S101-S105的过程中,先用预先设置的针尖在校准器上取一点,得到校准器的第一针点信息;利用所述针尖取校准器上另外四个点以计算法线及拟合圆心。
将校准器装上锉刀或打拔器,根据锉刀或打拔器和校准器在世界坐标系下的位姿信息,计算并记录校准器第一滚动位置信息;
绕锉刀轴或打拔器轴转动校准器,使其世界坐标发生变化,计算并记录校准器在锉刀坐标系下的三个不同位姿下的位姿信息,得到第二滚动位置信息、第三滚动位置信息、第四滚动位置信息;
将位姿信息分成两组[第一滚动位置信息,第二滚动位置信息,第四滚动位置信息]和[第一滚动位置信息,第三滚动位置信息,第四滚动位置信息],其中,[第一滚动位置信息,第二滚动位置信息,第四滚动位置信息]作为计算结果,[第一滚动位置信息,第三滚动位置信息,第四滚动位置信息]作为验证结果;
利用第二滚动位置信息与第一滚动位置信息的差值,作为前后位姿变化产生的向量a,利用第四滚动位置信息与第二滚动位置信息的差值,得到向量b,向量a和向量b均垂直于锉刀轴或打拔器轴且向量a和向量b不共线,通过求向量a和向量b的叉积得到沿轴方向的向量,得到法线;
计算锉刀及打拔器顶点
第一个方程:三点共面
其中,其中,(x,y,z)分别表示未知点的空间坐标(x1,y1,z1)、(x2,y2,z2)、(x3,y3,z3)分别表示已经测量得到的空间点坐标。
将该行列式方程写出后,可以得到一个平面方程,根据该平面方程的系数同样可以得到该平面的法线。
第二及第三个方程:圆半径相等
由此得到三个方程三个未知数(x,y,z),解出(x,y,z)即为圆心坐标;
得到有正确方向的法线后,记圆心坐标为C,与第一个测试点相减(Point_1-Circle)得到修正向量offset,然后计算修正向量在法线方向上的投影长度L(带正负),最后将圆心坐标朝法线方向移动长度L即得到最终的顶点坐标。
根据本公开实施例的一种具体实现方式,所述获取锉刀或打拔器和校准器在世界坐标系下的多个位姿信息,包括:
将校准器装上锉刀或打拔器,根据锉刀或打拔器和校准器在世界坐标系下的位姿信息,计算并记录校准器第一滚动位置信息;
绕锉刀轴或打拔器轴转动校准器,使其世界坐标发生变化,计算并记录校准器在锉刀坐标系下的三个不同位姿下的位姿信息,得到第二滚动位置信息、第三滚动位置信息、第四滚动位置信息。
根据本公开实施例的一种具体实现方式,所述对所述多个位姿态信息进行分组处理,得到计算位姿分组和验证位姿分组,包括:
将位姿信息分成两组[第一滚动位置信息,第二滚动位置信息,第四滚动位置信息]和[第一滚动位置信息,第三滚动位置信息,第四滚动位置信息],其中,[第一滚动位置信息,第二滚动位置信息,第四滚动位置信息]作为计算结果,[第一滚动位置信息,第三滚动位置信息,第四滚动位置信息]作为验证结果。
根据本公开实施例的一种具体实现方式,所述基于所述计算位姿分组和验证位姿分组,获取锉刀或打拔器的法线,包括:
利用第二滚动位置信息与第一滚动位置信息的差值,作为前后位姿变化产生的向量a,利用第四滚动位置信息与第二滚动位置信息的差值,得到向量b,向量a和向量b均垂直于锉刀轴或打拔器轴且向量a和向量b不共线,通过求向量a和向量b的叉积得到沿轴方向的向量,得到法线。
根据本公开实施例的一种具体实现方式,所述基于预先测量的校准器上的多个位置点坐标,确定未知点的圆心坐标,包括:
先用预先设置的针尖在校准器上取一点,得到校准器的第一针点信息,利用所述针尖取校准器上另外四个点以计算法线及拟合圆心;
第一个方程:三点共面
其中,(x,y,z)分别表示未知点的空间坐标(x1,y1,z1)、(x2,y2,z2)、(x3,y3,z3)分别表示已经测量得到的空间点坐标;
将该行列式方程写出后,可以得到一个平面方程,根据该平面方程的系数同样可以得到该平面的法线;
第二及第三个方程:圆半径相等
由此得到三个方程三个未知数(x,y,z),解出(x,y,z)即为圆心坐标。
根据本公开实施例的一种具体实现方式,所述基于所述圆心坐标和所述法线,对锉刀及打拔器进行校准,包括:
得到正确方向的法线后,记圆心坐标为C,与第一个测试点的坐标相减得到修正向量;
计算修正向量在法线方向上的投影长度L,最后将圆心坐标朝法线方向移动长度L即得到最终的顶点坐标。
以上所述,仅为本公开的具体实施方式,但本公开的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本公开揭露的技术范围内,可轻易想到的变化或替换,都应涵盖在本公开的保护范围之内。因此,本公开的保护范围应以权利要求的保护范围为准。
Claims (6)
1.一种锉刀及打拔器的校准方法,其特征在于,包括:
获取锉刀或打拔器和校准器在世界坐标系下的多个位姿信息;
对所述多个位姿态信息进行分组处理,得到计算位姿分组和验证位姿分组;
基于所述计算位姿分组和验证位姿分组,获取锉刀或打拔器的法线;
基于预先测量的校准器上的多个位置点坐标,确定未知点的圆心坐标;
基于所述圆心坐标和所述法线,对锉刀及打拔器进行校准。
2.根据权利要求1所述的方法,其特征在于,所述获取锉刀或打拔器和校准器在世界坐标系下的多个位姿信息,包括:
将校准器装上锉刀或打拔器,根据锉刀或打拔器和校准器在世界坐标系下的位姿信息,计算并记录校准器第一滚动位置信息;
绕锉刀轴或打拔器轴转动校准器,使其世界坐标发生变化,计算并记录校准器在锉刀坐标系下的三个不同位姿下的位姿信息,得到第二滚动位置信息、第三滚动位置信息、第四滚动位置信息。
3.根据权利要求1所述的方法,其特征在于,所述对所述多个位姿态信息进行分组处理,得到计算位姿分组和验证位姿分组,包括:
将位姿信息分成两组[第一滚动位置信息,第二滚动位置信息,第四滚动位置信息]和[第一滚动位置信息,第三滚动位置信息,第四滚动位置信息],其中,[第一滚动位置信息,第二滚动位置信息,第四滚动位置信息]作为计算结果,[第一滚动位置信息,第三滚动位置信息,第四滚动位置信息]作为验证结果。
4.根据权利要求1所述的方法,其特征在于,所述基于所述计算位姿分组和验证位姿分组,获取锉刀或打拔器的法线,包括:
利用第二滚动位置信息与第一滚动位置信息的差值,作为前后位姿变化产生的向量a,利用第四滚动位置信息与第二滚动位置信息的差值,得到向量b,向量a和向量b均垂直于锉刀轴或打拔器轴且向量a和向量b不共线,通过求向量a和向量b的叉积得到沿轴方向的向量,得到法线。
6.根据权利要求1所述的方法,其特征在于,所述基于所述圆心坐标和所述法线,对锉刀及打拔器进行校准,包括:
得到正确方向的法线后,记圆心坐标为C,与第一个测试点的坐标相减得到修正向量;
计算修正向量在法线方向上的投影长度L,最后将圆心坐标朝法线方向移动长度L即得到最终的顶点坐标。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010351599.9A CN111388103B (zh) | 2020-04-28 | 2020-04-28 | 一种锉刀及打拔器的校准方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010351599.9A CN111388103B (zh) | 2020-04-28 | 2020-04-28 | 一种锉刀及打拔器的校准方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111388103A true CN111388103A (zh) | 2020-07-10 |
CN111388103B CN111388103B (zh) | 2021-03-26 |
Family
ID=71411698
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010351599.9A Active CN111388103B (zh) | 2020-04-28 | 2020-04-28 | 一种锉刀及打拔器的校准方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111388103B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114587583A (zh) * | 2022-03-04 | 2022-06-07 | 杭州湖西云百生科技有限公司 | 膝关节手术导航系统术中假体推荐方法及系统 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20060094958A1 (en) * | 2004-10-28 | 2006-05-04 | Marquart Joel G | Method and apparatus for calibrating non-linear instruments |
CN105055021A (zh) * | 2015-06-30 | 2015-11-18 | 华南理工大学 | 手术导航穿刺针的标定装置及其标定方法 |
CN106767401A (zh) * | 2016-11-26 | 2017-05-31 | 江苏瑞伯特视觉科技股份有限公司 | 一种基于十字激光和机器视觉的轴孔类零件定姿定位方法 |
CN107405170A (zh) * | 2015-03-05 | 2017-11-28 | 思想外科有限公司 | 用于定位和跟踪工具轴线的方法 |
CN109798854A (zh) * | 2017-11-16 | 2019-05-24 | 上海铼钠克数控科技股份有限公司 | 机床摆头的标定方法及系统 |
-
2020
- 2020-04-28 CN CN202010351599.9A patent/CN111388103B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20060094958A1 (en) * | 2004-10-28 | 2006-05-04 | Marquart Joel G | Method and apparatus for calibrating non-linear instruments |
CN107405170A (zh) * | 2015-03-05 | 2017-11-28 | 思想外科有限公司 | 用于定位和跟踪工具轴线的方法 |
CN105055021A (zh) * | 2015-06-30 | 2015-11-18 | 华南理工大学 | 手术导航穿刺针的标定装置及其标定方法 |
CN106767401A (zh) * | 2016-11-26 | 2017-05-31 | 江苏瑞伯特视觉科技股份有限公司 | 一种基于十字激光和机器视觉的轴孔类零件定姿定位方法 |
CN109798854A (zh) * | 2017-11-16 | 2019-05-24 | 上海铼钠克数控科技股份有限公司 | 机床摆头的标定方法及系统 |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114587583A (zh) * | 2022-03-04 | 2022-06-07 | 杭州湖西云百生科技有限公司 | 膝关节手术导航系统术中假体推荐方法及系统 |
Also Published As
Publication number | Publication date |
---|---|
CN111388103B (zh) | 2021-03-26 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP3153101B1 (en) | Identification and registration of multi-marker jig | |
CN110108207B (zh) | 基于探针的旋转轴回转中心线几何误差标定方法 | |
CN110793508B (zh) | 三维控制网中控制点的观测数据处理方法与装置 | |
CN107186548A (zh) | 一种五轴数控机床回转轴几何误差检测方法 | |
CN111981984B (zh) | 一种基于双目视觉的旋转轴标定方法 | |
CN105809702A (zh) | 一种基于Tsai算法的改进位姿估计方法 | |
CN104392476A (zh) | 基于最小包围盒算法提取隧道三维轴线的方法 | |
CN109115191A (zh) | 全站仪多方位坐标测量方法 | |
CN111388103B (zh) | 一种锉刀及打拔器的校准方法 | |
CN107330142B (zh) | 一种基于stl模型的在机检测的测点法矢估算方法 | |
WO2021128614A1 (zh) | 一种基于特征线的弧面凸轮廓面误差测量与评定方法 | |
WO2022127010A1 (zh) | 一种透视图像矫正方法 | |
CN105574884B (zh) | 一种医疗机器人dh参数标定方法 | |
CN108458710B (zh) | 位姿测量方法 | |
CN110645928A (zh) | 一种三维扫描仪空间坐标定位方法 | |
CN111895921B (zh) | 一种提高系统对高度差测量精度的补偿方法 | |
CN117557649A (zh) | 一种基于烟草零售终端平面线框特征的相机标定方法 | |
CN110220474B (zh) | 移动式激光扫描系统事后姿态角校正方法 | |
CN109300194B (zh) | 一种用于虚拟装配的三维零件自动摆放方法 | |
CN107063218B (zh) | 数据处理方法和装置 | |
CN115830092A (zh) | 一种基于旋转视角智能规划的植株叶片三维重建方法 | |
CN109254269A (zh) | 一种机载合成孔径雷达干涉定标方法 | |
CN110866951B (zh) | 一种单目摄像机光轴倾斜的校正方法 | |
CN113808211A (zh) | 一种用于图像引导系统的几何校正模体及制造方法 | |
CN113393507A (zh) | 无人机点云与地面三维激光扫描仪点云配准方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |