CN113561188A - 机器人的控制方法、装置、计算机可读存储介质和处理器 - Google Patents
机器人的控制方法、装置、计算机可读存储介质和处理器 Download PDFInfo
- Publication number
- CN113561188A CN113561188A CN202111125886.9A CN202111125886A CN113561188A CN 113561188 A CN113561188 A CN 113561188A CN 202111125886 A CN202111125886 A CN 202111125886A CN 113561188 A CN113561188 A CN 113561188A
- Authority
- CN
- China
- Prior art keywords
- force
- coordinate system
- moment
- axis
- acetabulum
- 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
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/1633—Programme controls characterised by the control loop compliant, force, torque control, e.g. combined with position control
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B17/00—Surgical instruments, devices or methods, e.g. tourniquets
- A61B17/16—Bone cutting, breaking or removal means other than saws, e.g. Osteoclasts; Drills or chisels for bones; Trepans
- A61B17/1659—Surgical rasps, files, planes, or scrapers
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B17/00—Surgical instruments, devices or methods, e.g. tourniquets
- A61B17/16—Bone cutting, breaking or removal means other than saws, e.g. Osteoclasts; Drills or chisels for bones; Trepans
- A61B17/1662—Bone cutting, breaking or removal means other than saws, e.g. Osteoclasts; Drills or chisels for bones; Trepans for particular parts of the body
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B34/00—Computer-aided surgery; Manipulators or robots specially adapted for use in surgery
- A61B34/30—Surgical robots
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1602—Programme controls characterised by the control system, structure, architecture
Landscapes
- Health & Medical Sciences (AREA)
- Engineering & Computer Science (AREA)
- Surgery (AREA)
- Life Sciences & Earth Sciences (AREA)
- Medical Informatics (AREA)
- Molecular Biology (AREA)
- Robotics (AREA)
- Veterinary Medicine (AREA)
- Biomedical Technology (AREA)
- Heart & Thoracic Surgery (AREA)
- Public Health (AREA)
- Nuclear Medicine, Radiotherapy & Molecular Imaging (AREA)
- Animal Behavior & Ethology (AREA)
- General Health & Medical Sciences (AREA)
- Dentistry (AREA)
- Oral & Maxillofacial Surgery (AREA)
- Orthopedic Medicine & Surgery (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Manipulator (AREA)
Abstract
本申请提供了一种机器人的控制方法、装置、计算机可读存储介质和处理器,该方法包括:将施加在髋臼锉上外力转换为力控坐标系下的轴向力和力矩,和/或将施加在髋臼锉上外力矩转换为力控坐标系下的轴向力和力矩,其中,轴向力为平行于力控坐标系的Z轴的力,力矩为绕髋臼锉的中心轴转动的力矩;根据轴向力计算髋臼锉的位移,并根据力矩计算第一偏转角度,第一偏转角度为髋臼锉的中心轴与力控坐标系的Z轴的夹角;根据位移确定反向力,并根据第一偏转角度确定反向力矩,反向力与轴向力的方向相反,反向力矩与力矩的方向相反;控制机器人对髋臼锉施加反向力和反向力矩。该方法解决了现有技术中难以避免过度磨削的问题。
Description
技术领域
本申请涉及髋关节置换技术领域,具体而言,涉及一种机器人的控制方法、装置、计算机可读存储介质和处理器。
背景技术
在医疗髋关节假体置换手术磨削过程中,手术机器人如何自适应判定医生施加主动手术力/力矩,通过调整柔顺参数,匹配医生施加的外部力或力矩,并实时检测机器人运动边界完成手术过程中机器人柔顺运动。
在背景技术部分中公开的以上信息只是用来加强对本文所描述技术的背景技术的理解,因此,背景技术中可能包含某些信息,这些信息对于本领域技术人员来说并未形成在本国已知的现有技术。
发明内容
本申请的主要目的在于提供一种机器人的控制方法、装置、计算机可读存储介质和处理器,以解决现有技术中难以避免过度磨削的问题。
根据本发明实施例的一个方面,提供了一种机器人的控制方法,机器人用于控制髋臼锉对髋臼进行磨削,包括:将施加在髋臼锉上外力转换为力控坐标系下的轴向力和力矩,和/或将施加在髋臼锉上外力矩转换为所述力控坐标系下的所述轴向力和所述力矩,其中,所述轴向力为平行于所述力控坐标系的Z轴的力,所述力矩为绕所述髋臼锉的中心轴转动的力矩,所述力控坐标系的Z轴与髋臼缘平面垂直,所述力控坐标系的X轴与人体冠正面垂直,所述力控坐标系的Y轴与所述力控坐标系的X轴和所述力控坐标系的Z轴分别垂直,所述髋臼缘平面为所述髋臼的杯口外边缘所处的平面;根据所述轴向力计算所述髋臼锉的位移,并根据所述力矩计算第一偏转角度,所述第一偏转角度为所述髋臼锉的中心轴与所述力控坐标系的Z轴的夹角;根据所述位移确定反向力,并根据所述第一偏转角度确定反向力矩,所述反向力与所述轴向力的方向相反,所述反向力矩与所述力矩的方向相反;控制所述机器人对所述髋臼锉施加所述反向力和所述反向力矩。
可选地,在根据外力和/或外力矩转换为力控坐标系下的轴向力和力矩之前,所述方法还包括:建立髋臼坐标系,所述髋臼坐标系的原点位于髋臼的中心位置,所述髋臼坐标系的Z轴与髋臼缘平面垂直,所述髋臼坐标系的X轴与人体冠正面垂直,所述髋臼坐标系的Y轴与所述髋臼坐标系的X轴和所述髋臼坐标系的Z轴分别垂直,所述髋臼缘平面为所述髋臼的杯口外边缘所处的平面;将所述髋臼坐标系沿Z轴的第一方向平移预定距离,得到所述力控坐标系,所述第一方向为远离所述髋臼的方向。
可选地,在将所述髋臼坐标系沿Z轴的第一方向平移预定距离,得到所述力控坐标系之后,在根据外力和/或外力矩转换为力控坐标系下的轴向力和力矩之前,所述方法还包括:获取所述髋臼的第二偏转角度,所述第二偏转角度为第一姿态和第二姿态的变换角度,所述第一姿态为前一检测时刻的所述髋臼的姿态,所述第二姿态为当前检测时刻所述髋臼的姿态,所述前一检测时刻与所述当前检测时刻的时间间隔为姿态传感器的检测周期;根据所述第二偏转角度确定是否更新所述髋臼坐标系和所述力控坐标系;在确定更新所述髋臼坐标系和所述力控坐标系的情况下,重新建立所述髋臼坐标系和所述力控坐标系。
可选地,根据所述第二偏转角度确定是否更新所述髋臼坐标系和所述力控坐标系,包括:在所述第二偏转角度小于第一偏转角度阈值的情况下,确定不更新所述髋臼坐标系和所述力控坐标系;在所述第二偏转角度大于或者等于所述第一偏转角度阈值的情况下,确定更新所述髋臼坐标系和所述力控坐标系。
可选地,根据所述轴向力计算所述髋臼锉的位移,并根据所述力矩计算第一偏转角度,包括:根据传递函数和所述轴向力计算得到所述位移,所述传递函数为外力信息和位置信息的映射函数,所述外力信息包括所述轴向力和所述力矩,所述位置信息包括所述位移和所述第一偏转角度;根据所述传递函数和所述力矩计算得到所述第一偏转角度。
可选地,在根据所述轴向力计算所述髋臼锉的位移,并根据所述力矩计算第一偏转角度之前,所述方法还包括:在所述轴向力大于轴向力阈值的情况下,将所述轴向力更新为所述轴向力阈值;在所述力矩大于力矩阈值的情况下,将所述力矩更新为所述力矩阈值。
可选地,根据所述位移确定反向力,并根据所述第一偏转角度确定反向力矩,包括:根据所述位移确定进入位移缓冲区域的距离,得到缓冲距离,所述移缓冲区域为所述髋臼坐标系的Z轴上的线段;根据所述缓冲距离计算得到所述反向力;根据所述位移确定进入姿态缓冲区域的角度,得到缓冲角度,所述移缓冲区域为所述髋臼坐标系的Z轴绕所述髋臼坐标系的原点旋转形成的扇形区域;根据所述缓冲角度计算得到所述反向力矩。
可选地,控制所述机器人对所述髋臼锉施加所述反向力和所述反向力矩,包括:根据所述轴向力与所述力矩确定主动力,所述主动力为所述轴向力或者所述力矩;控制所述机器人对所述髋臼锉施加所述主动力对应的缓冲力,所述缓冲力包括所述反向力和所述反向力矩。
可选地,根据所述轴向力与所述力矩确定主动力,包括:在第一比值大于第二比值的情况下,确定所述轴向力为所述主动力,所述第一比值为所述轴向力与所述轴向力阈值的比值,所述第二比值为所述力矩与所述力矩阈值的比值;在所述第一比值小于或者等于所述第二比值的情况下,确定所述力矩为所述主动力。
根据本发明实施例的另一方面,还提供了一种机器人的控制装置,机器人用于控制髋臼锉对髋臼进行磨削,包括:处理单元,用于根据外力和/或外力矩转换为力控坐标系下的轴向力和力矩,所述轴向力为平行于所述力控坐标系的Z轴的力,所述力矩为绕所述髋臼锉的中心轴转动的力矩,所述外力和所述外力矩为操作人员对所述髋臼锉施加的,所述力控坐标系的Z轴与髋臼缘平面垂直,所述力控坐标系的X轴与人体冠正面垂直,所述力控坐标系的Y轴与所述力控坐标系的X轴和所述力控坐标系的Z轴分别垂直,所述髋臼缘平面为所述髋臼的杯口外边缘所处的平面;计算单元,用于根据所述轴向力计算所述髋臼锉的位移,并根据所述力矩计算第一偏转角度,所述第一偏转角度为所述髋臼锉的中心轴与所述力控坐标系的Z轴的夹角;确定单元,用于根据所述位移确定反向力,并根据所述第一偏转角度确定反向力矩,所述反向力与所述轴向力的方向相反,所述反向力矩与所述力矩的方向相反;控制单元,用于控制所述机器人对所述髋臼锉施加所述反向力和所述反向力矩。
根据本发明实施例的再一方面,还提供了一种计算机可读存储介质,所述计算机可读存储介质包括存储的程序,其中,所述程序执行任意一种所述的方法。
根据本发明实施例的又一方面,还提供了一种处理器,所述处理器用于运行程序,其中,所述程序运行时执行任意一种所述的方法。
在本发明实施例中,上述机器人的控制方法中,首先,将施加在髋臼锉上外力转换为力控坐标系下的轴向力和力矩,和/或将施加在髋臼锉上外力矩转换为上述力控坐标系下的上述轴向力和上述力矩,其中,上述轴向力为平行于上述力控坐标系的Z轴的力,上述力矩为绕上述髋臼锉的中心轴转动的力矩,上述外力和上述外力矩为操作人员对上述髋臼锉施加的,上述力控坐标系的Z轴与髋臼缘平面垂直,上述力控坐标系的X轴与人体冠正面垂直,上述力控坐标系的Y轴与上述力控坐标系的X轴和上述力控坐标系的Z轴分别垂直,上述髋臼缘平面为上述髋臼的杯口外边缘所处的平面;然后,根据上述轴向力计算上述髋臼锉的位移,并根据上述力矩计算第一偏转角度,上述第一偏转角度为上述髋臼锉的中心轴与上述力控坐标系的Z轴的夹角;之后,根据上述位移确定反向力,并根据上述第一偏转角度确定反向力矩,上述反向力与上述轴向力的方向相反,上述反向力矩与上述力矩的方向相反;最后,控制上述机器人对上述髋臼锉施加上述反向力和上述反向力矩。该控制方法通过将外力和/或外力矩转换为力控坐标系下的轴向力和力矩,以根据上述轴向力计算上述髋臼锉的位移,并根据上述力矩计算第一偏转角度,从而确定上述机器人对上述髋臼锉施加上述反向力和上述反向力矩,以对外力或者外力矩进行缓冲,防止髋臼过度磨损,解决了现有技术中难以避免过度磨削的问题。
附图说明
构成本申请的一部分的说明书附图用来提供对本申请的进一步理解,本申请的示意性实施例及其说明用于解释本申请,并不构成对本申请的不当限定。在附图中:
图1示出了根据本申请一种实施例的机器人的控制方法的流程图;
图2示出了根据本申请一种实施例的髋臼坐标系和力坐标系的示意图;
图3示出了根据本申请一种实施例的姿态缓冲区域和位移缓冲区域的示意图;
图4示出了根据本申请一种实施例的机器人的控制装置的示意图。
具体实施方式
需要说明的是,在不冲突的情况下,本申请中的实施例及实施例中的特征可以相互组合。下面将参考附图并结合实施例来详细说明本申请。
为了使本技术领域的人员更好地理解本申请方案,下面将结合本申请实施例中的附图,对本申请实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本申请一部分的实施例,而不是全部的实施例。基于本申请中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都应当属于本申请保护的范围。
需要说明的是,本申请的说明书和权利要求书及上述附图中的术语“第一”、“第二”等是用于区别类似的对象,而不必用于描述特定的顺序或先后次序。应该理解这样使用的数据在适当情况下可以互换,以便这里描述的本申请的实施例。此外,术语“包括”和“具有”以及他们的任何变形,意图在于覆盖不排他的包含,例如,包含了一系列步骤或单元的过程、方法、系统、产品或设备不必限于清楚地列出的那些步骤或单元,而是可包括没有清楚地列出的或对于这些过程、方法、产品或设备固有的其它步骤或单元。
应该理解的是,当元件(诸如层、膜、区域、或衬底)描述为在另一元件“上”时,该元件可直接在该另一元件上,或者也可存在中间元件。而且,在说明书以及权利要求书中,当描述有元件“连接”至另一元件时,该元件可“直接连接”至该另一元件,或者通过第三元件“连接”至该另一元件。
正如背景技术中所说的,现有技术中难以避免过度磨削,为了解决上述问题,本申请的一种典型的实施方式中,提供了一种机器人的控制方法、装置、计算机可读存储介质和处理器。
根据本申请的实施例,提供了一种机器人的控制方法,机器人用于控制髋臼锉对髋臼进行磨削。
图1是根据本申请实施例的机器人的控制方法的流程图。如图1所示,该方法包括以下步骤:
步骤S101,将施加在髋臼锉上外力转换为力控坐标系下的轴向力和力矩,和/或将施加在髋臼锉上外力矩转换为上述力控坐标系下的上述轴向力和上述力矩,其中,上述轴向力为平行于上述力控坐标系的Z轴的力,上述力矩为绕上述髋臼锉的中心轴转动的力矩,上述力控坐标系的Z轴与髋臼缘平面垂直,上述力控坐标系的X轴与人体冠正面垂直,上述力控坐标系的Y轴与上述力控坐标系的X轴和上述力控坐标系的Z轴分别垂直,上述髋臼缘平面为上述髋臼的杯口外边缘所处的平面;
步骤S102,根据上述轴向力计算上述髋臼锉的位移,并根据上述力矩计算第一偏转角度,上述第一偏转角度为上述髋臼锉的中心轴与上述力控坐标系的Z轴的夹角;
步骤S103,根据上述位移确定反向力,并根据上述第一偏转角度确定反向力矩,上述反向力与上述轴向力的方向相反,上述反向力矩与上述力矩的方向相反;
步骤S104,控制上述机器人对上述髋臼锉施加上述反向力和上述反向力矩。
上述机器人的控制方法中,首先,将施加在髋臼锉上外力转换为力控坐标系下的轴向力和力矩,和/或将施加在髋臼锉上外力矩转换为上述力控坐标系下的上述轴向力和上述力矩,其中,上述轴向力为平行于上述力控坐标系的Z轴的力,上述力矩为绕上述髋臼锉的中心轴转动的力矩,上述外力和上述外力矩为操作人员对上述髋臼锉施加的,上述力控坐标系的Z轴与髋臼缘平面垂直,上述力控坐标系的X轴与人体冠正面垂直,上述力控坐标系的Y轴与上述力控坐标系的X轴和上述力控坐标系的Z轴分别垂直,上述髋臼缘平面为上述髋臼的杯口外边缘所处的平面;然后,根据上述轴向力计算上述髋臼锉的位移,并根据上述力矩计算第一偏转角度,上述第一偏转角度为上述髋臼锉的中心轴与上述力控坐标系的Z轴的夹角;之后,根据上述位移确定反向力,并根据上述第一偏转角度确定反向力矩,上述反向力与上述轴向力的方向相反,上述反向力矩与上述力矩的方向相反;最后,控制上述机器人对上述髋臼锉施加上述反向力和上述反向力矩。该控制方法通过将外力和/或外力矩转换为力控坐标系下的轴向力和力矩,以根据上述轴向力计算上述髋臼锉的位移,并根据上述力矩计算第一偏转角度,从而确定上述机器人对上述髋臼锉施加上述反向力和上述反向力矩,以对外力或者外力矩进行缓冲,防止髋臼过度磨损,解决了现有技术中难以避免过度磨削的问题。
需要说明的是,在附图的流程图示出的步骤可以在诸如一组计算机可执行指令的计算机系统中执行,并且,虽然在流程图中示出了逻辑顺序,但是在某些情况下,可以以不同于此处的顺序执行所示出或描述的步骤。
还需要说明的是,上述机器人为一种串联机器人,用来跟踪患者关节位置,并辅助医生进行手术工具的定位置、定姿态等操作,具体地,上述机器人可以应用于关节置换手术,关节置换手术为通过植入人工关节假体,替代患者病变的骨头,能够有效的缓解疼痛、恢复运动量,改善生活质量,为安装髋关节假体,需对原髋关节骨质进行磨削处理,即上述机器人控制髋臼锉对髋臼进行磨削,如图2所示,上述髋臼锉主要运动形式为沿运动轴线方向的向下运动,绕磨削中心点的姿态变化运动,上述运动轴线为髋臼轴线,上述磨削中心点为髋臼锉的对称轴与连接面的角点,上述连接面为上述髋臼锉的手柄和球形刀壳的连接面,根据医生驱动力来顺应上述运动。
本申请的一种实施例中,在根据外力和/或外力矩转换为力控坐标系下的轴向力和力矩之前,上述方法还包括:建立髋臼坐标系,上述髋臼坐标系的原点位于髋臼的中心位置,上述髋臼坐标系的Z轴与髋臼缘平面垂直,上述髋臼坐标系的X轴与人体冠正面垂直,上述髋臼坐标系的Y轴与上述髋臼坐标系的X轴和上述髋臼坐标系的Z轴分别垂直,上述髋臼缘平面为上述髋臼的杯口外边缘所处的平面;将上述髋臼坐标系沿Z轴的第一方向平移预定距离,得到上述力控坐标系,上述第一方向为远离上述髋臼的方向。具体地,如图2所示,上述髋臼坐标系P_Frame的原点位于髋臼的中心位置,以便于根据髋臼坐标系P_Frame的坐标确定髋臼锉与髋臼的相对位置,建立上述力控坐标系F_Frame以便于磨削过程中的力控柔顺调节,柔顺控制即导纳控制,是通过调节机器人末端位置与力之间的动态特性来实现柔顺性,另外,上述预定距离可以根据实际情况进行选择。
本申请的一种实施例中,在将上述髋臼坐标系沿Z轴的第一方向平移预定距离,得到上述力控坐标系之后,在根据外力和/或外力矩转换为力控坐标系下的轴向力和力矩之前,上述方法还包括:获取上述髋臼的第二偏转角度,上述第二偏转角度为第一姿态和第二姿态的变换角度,上述第一姿态为前一检测时刻的上述髋臼的姿态,上述第二姿态为当前检测时刻上述髋臼的姿态,上述前一检测时刻与上述当前检测时刻的时间间隔为姿态传感器的检测周期;根据上述第二偏转角度确定是否更新上述髋臼坐标系和上述力控坐标系;在确定更新上述髋臼坐标系和上述力控坐标系的情况下,重新建立上述髋臼坐标系和上述力控坐标系。具体地,上述姿态传感器可以为视觉系统,通过视觉系统采集关节上安装的视觉检测特征点,以确定上述髋臼的姿态,根据前后两次姿态检测确定髋臼的第二偏转角度,更为具体地,视觉检测特征点构建髋关节坐标系,前后构建的髋关节坐标系的夹角即为上述第二偏转角度,从而根据上述第二偏转角度确定髋臼位置是否发生变化,髋臼位置发生变化,则更新上述髋臼坐标系和上述力控坐标系,重新建立上述髋臼坐标系和上述力控坐标系,否则不更新。
本申请的一种实施例中,根据上述第二偏转角度确定是否更新上述髋臼坐标系和上述力控坐标系,包括:在上述第二偏转角度小于第一偏转角度阈值的情况下,确定不更新上述髋臼坐标系和上述力控坐标系;在上述第二偏转角度大于或者等于上述第一偏转角度阈值的情况下,确定更新上述髋臼坐标系和上述力控坐标系。具体地,上述第二偏转角度的检测是有误差的,上述第二偏转角度小于第一偏转角度阈值,即在检测误差的允许范围内,则不更新上述髋臼坐标系和上述力控坐标系,上述第二偏转角度大于或者等于上述第一偏转角度阈值,表明髋臼位置发生变化,则需要更新上述髋臼坐标系和上述力控坐标系,上述第一偏转角度阈值可以根基实际情况进行选择,确保上述髋臼坐标系和上述力控坐标系的准确性。
本申请的一种实施例中,根据上述轴向力计算上述髋臼锉的位移,并根据上述力矩计算第一偏转角度,包括:根据传递函数和上述轴向力计算得到上述位移,上述传递函数为外力信息和位置信息的映射函数,上述外力信息包括上述轴向力和上述力矩,上述位置信息包括上述位移和上述第一偏转角度;根据上述传递函数和上述力矩计算得到上述第一偏转角度。具体地,上述传递函数可以为X(M2+B+K)=F,其中,X为位移,F为轴向力,M为惯量矩阵,矩阵中的数值采用固定值,B为阻尼系数矩阵,矩阵中的数值为阻尼参数,低阻尼参数可以提高机器人对操作者交互力的跟随能力,使得操作者可以通过较小的作用力就能使机器人跟随其做柔顺移动,K为刚度系数矩阵,增加刚度系数时,单位作用力上产生的位移就变小,即需要用更大的力才能拉动关节,反之,减少刚度系数时,单位作用力上产生的位移就变大,用很小的力就能使关节产生较大的位移,上述传递函数还可以为(M2+B+K)=τ,其中,为第一偏转角度,τ为力矩。另外,参数M、B、K参数符合以下映射关系,√K/M≈5,B/√MK≈1,以避免产生振荡问题。
本申请的一种实施例中,在根据上述轴向力计算上述髋臼锉的位移,并根据上述力矩计算第一偏转角度之前,上述方法还包括:在上述轴向力大于轴向力阈值的情况下,将上述轴向力更新为上述轴向力阈值;在上述力矩大于力矩阈值的情况下,将上述力矩更新为上述力矩阈值。具体地,上述方法将对髋臼锉施加轴向力和力矩分别限制在轴向力阈值和力矩阈值,防止髋臼过度磨损,另外,上述轴向力阈值和上述力矩阈值可以根据实际情况进行设置,以确保髋臼不会过度磨损。
本申请的一种实施例中,根据上述位移确定反向力,并根据上述第一偏转角度确定反向力矩,包括:根据上述位移确定进入位移缓冲区域的距离,得到缓冲距离,上述移缓冲区域为上述髋臼坐标系的Z轴上的线段,如图3所示;根据上述缓冲距离计算得到上述反向力;根据上述位移确定进入姿态缓冲区域的角度,得到缓冲角度,上述移缓冲区域为上述髋臼坐标系的Z轴绕上述髋臼坐标系的原点旋转形成的扇形区域,如图3所示;根据上述缓冲角度计算得到上述反向力矩。具体地,上述反向力的计算公式为F阻力=Flimit•s/w,其中,F阻力为上述反向力,Flimit为上述轴向力阈值,s 为上述缓冲距离,w为上述位移缓冲区域在Z轴上宽度,上述反向力矩的计算公式为τ阻力=τlimit•a/θ,其中,τ阻力为上述反向力矩,Flimit为上述力矩阈值,a为上述缓冲角度,θ为上述姿态缓冲区域的扇形角度,将上述缓冲距离s和上述缓冲角度a即可计算得到上述反向力F阻力和上述反向力矩τ阻力。
本申请的一种实施例中,控制上述机器人对上述髋臼锉施加上述反向力和上述反向力矩,包括:根据上述轴向力与上述力矩确定主动力,上述主动力为上述轴向力或者上述力矩;控制上述机器人对上述髋臼锉施加上述主动力对应的缓冲力,上述缓冲力包括上述反向力和上述反向力矩。具体地,当主动力为z轴方向进给运动时,即上述主动力为上述轴向力,只允许在z轴方向进行柔顺控制,即控制上述机器人对上述髋臼锉施加上述反向力,当主动力为定点转动时,即上述主动力为上述力矩,只允许机器人绕磨削中心点进行柔顺控制,即控制上述机器人对上述髋臼锉施加上述反向力矩,以保证磨削过程中的便捷以及准确性。
本申请的一种实施例中,根据上述轴向力与上述力矩确定主动力,包括:在第一比值大于第二比值的情况下,确定上述轴向力为上述主动力,上述第一比值为上述轴向力与上述轴向力阈值的比值,上述第二比值为上述力矩与上述力矩阈值的比值;在上述第一比值小于或者等于上述第二比值的情况下,确定上述力矩为上述主动力。具体地,在第一比值大于第二比值的情况下,即F/Flimit > τ/τ limit,则上述轴向力为上述主动力,反之,F/Flimit≤ τ/τ limit,则上述力矩为上述主动力。
本申请实施例还提供了一种机器人的控制装置,需要说明的是,本申请实施例的机器人的控制装置可以用于执行本申请实施例所提供的用于机器人的控制方法。以下对本申请实施例提供的机器人的控制装置进行介绍,机器人用于控制髋臼锉对髋臼进行磨削。
图4是根据本申请实施例的机器人的控制装置的示意图。如图4所示,该装置包括:
处理单元10,用于根据外力和/或外力矩转换为力控坐标系下的轴向力和力矩,上述轴向力为平行于上述力控坐标系的Z轴的力,上述力矩为绕上述髋臼锉的中心轴转动的力矩,上述外力和上述外力矩为操作人员对上述髋臼锉施加的,上述力控坐标系的Z轴与髋臼缘平面垂直,上述力控坐标系的X轴与人体冠正面垂直,上述力控坐标系的Y轴与上述力控坐标系的X轴和上述力控坐标系的Z轴分别垂直,上述髋臼缘平面为上述髋臼的杯口外边缘所处的平面;
计算单元20,用于根据上述轴向力计算上述髋臼锉的位移,并根据上述力矩计算第一偏转角度,上述第一偏转角度为上述髋臼锉的中心轴与上述力控坐标系的Z轴的夹角;
确定单元30,用于根据上述位移确定反向力,并根据上述第一偏转角度确定反向力矩,上述反向力与上述轴向力的方向相反,上述反向力矩与上述力矩的方向相反;
控制单元40,用于控制上述机器人对上述髋臼锉施加上述反向力和上述反向力矩。
上述机器人的控制装置中,处理单元将施加在髋臼锉上外力转换为力控坐标系下的轴向力和力矩,和/或将施加在髋臼锉上外力矩转换为上述力控坐标系下的上述轴向力和上述力矩,其中,上述轴向力为平行于上述力控坐标系的Z轴的力,上述力矩为绕上述髋臼锉的中心轴转动的力矩,上述外力和上述外力矩为操作人员对上述髋臼锉施加的,上述力控坐标系的Z轴与髋臼缘平面垂直,上述力控坐标系的X轴与人体冠正面垂直,上述力控坐标系的Y轴与上述力控坐标系的X轴和上述力控坐标系的Z轴分别垂直,上述髋臼缘平面为上述髋臼的杯口外边缘所处的平面;计算单元根据上述轴向力计算上述髋臼锉的位移,并根据上述力矩计算第一偏转角度,上述第一偏转角度为上述髋臼锉的中心轴与上述力控坐标系的Z轴的夹角;确定单元根据上述位移确定反向力,并根据上述第一偏转角度确定反向力矩,上述反向力与上述轴向力的方向相反,上述反向力矩与上述力矩的方向相反;控制单元控制上述机器人对上述髋臼锉施加上述反向力和上述反向力矩。该控制装置通过将外力和/或外力矩转换为力控坐标系下的轴向力和力矩,以根据上述轴向力计算上述髋臼锉的位移,并根据上述力矩计算第一偏转角度,从而确定上述机器人对上述髋臼锉施加上述反向力和上述反向力矩,以对外力或者外力矩进行缓冲,防止髋臼过度磨损,解决了现有技术中难以避免过度磨削的问题。
还需要说明的是,上述机器人为一种串联机器人,用来跟踪患者关节位置,并辅助医生进行手术工具的定位置、定姿态等操作,具体地,上述机器人可以应用于关节置换手术,关节置换手术为通过植入人工关节假体,替代患者病变的骨头,能够有效的缓解疼痛、恢复运动量,改善生活质量,为安装髋关节假体,需对原髋关节骨质进行磨削处理,即上述机器人控制髋臼锉对髋臼进行磨削,如图2所示,上述髋臼锉主要运动形式为沿运动轴线方向的向下运动,绕磨削中心点的姿态变化运动,上述运动轴线为髋臼轴线,上述磨削中心点为髋臼锉的对称轴与连接面的角点,上述连接面为上述髋臼锉的手柄和球形刀壳的连接面,根据医生驱动力来顺应上述运动。
本申请的一种实施例中,上述装置还包括生成单元,上述生成单元包括第一生成模块和第二生成模块,其中,上述第一生成模块用于在根据外力和/或外力矩转换为力控坐标系下的轴向力和力矩之前,建立髋臼坐标系,上述髋臼坐标系的原点位于髋臼的中心位置,上述髋臼坐标系的Z轴与髋臼缘平面垂直,上述髋臼坐标系的X轴与人体冠正面垂直,上述髋臼坐标系的Y轴与上述髋臼坐标系的X轴和上述髋臼坐标系的Z轴分别垂直,上述髋臼缘平面为上述髋臼的杯口外边缘所处的平面;上述第二生成模块用于将上述髋臼坐标系沿Z轴的第一方向平移预定距离,得到上述力控坐标系,上述第一方向为远离上述髋臼的方向。具体地,上述髋臼坐标系P_Frame的原点位于髋臼的中心位置,以便于根据髋臼坐标系P_Frame的坐标确定髋臼锉与髋臼的相对位置,建立上述力控坐标系F_Frame以便于磨削过程中的力控柔顺调节,柔顺控制即导纳控制,是通过调节机器人末端位置与力之间的动态特性来实现柔顺性,另外,上述预定距离可以根据实际情况进行选择。
本申请的一种实施例中,上述装置还包括重建单元,上述更新单元包括获取模块、第一确定模块和更新模块,其中,上述获取模块用于在将上述髋臼坐标系沿Z轴的第一方向平移预定距离,得到上述力控坐标系之后,在根据外力和/或外力矩转换为力控坐标系下的轴向力和力矩之前,获取上述髋臼的第二偏转角度,上述第二偏转角度为第一姿态和第二姿态的变换角度,上述第一姿态为前一检测时刻的上述髋臼的姿态,上述第二姿态为当前检测时刻上述髋臼的姿态,上述前一检测时刻与上述当前检测时刻的时间间隔为姿态传感器的检测周期;上述第一确定模块用于根据上述第二偏转角度确定是否更新上述髋臼坐标系和上述力控坐标系;上述更新模块用于在确定更新上述髋臼坐标系和上述力控坐标系的情况下,重新建立上述髋臼坐标系和上述力控坐标系。具体地,上述姿态传感器可以为视觉系统,通过视觉系统采集关节上安装的视觉检测特征点,以确定上述髋臼的姿态,根据前后两次姿态检测确定髋臼的第二偏转角度,更为具体地,视觉检测特征点构建髋关节坐标系,前后构建的髋关节坐标系的夹角即为上述第二偏转角度,从而根据上述第二偏转角度确定髋臼位置是否发生变化,髋臼位置发生变化,则更新上述髋臼坐标系和上述力控坐标系,重新建立上述髋臼坐标系和上述力控坐标系,否则不更新。
本申请的一种实施例中,上述第一确定模块包括第一确定子模块和第二确定子模块,其中,上述第一确定子模块用于在上述第二偏转角度小于第一偏转角度阈值的情况下,确定不更新上述髋臼坐标系和上述力控坐标系;上述第二确定子模块用于在上述第二偏转角度大于或者等于上述第一偏转角度阈值的情况下,确定更新上述髋臼坐标系和上述力控坐标系。具体地,上述第二偏转角度的检测是有误差的,上述第二偏转角度小于第一偏转角度阈值,即在检测误差的允许范围内,则不更新上述髋臼坐标系和上述力控坐标系,上述第二偏转角度大于或者等于上述第一偏转角度阈值,表明髋臼位置发生变化,则需要更新上述髋臼坐标系和上述力控坐标系,上述第一偏转角度阈值可以根基实际情况进行选择,确保上述髋臼坐标系和上述力控坐标系的准确性。
本申请的一种实施例中,上述计算单元包括第一计算模块和第二计算模块,其中,上述第一计算模块用于:根据传递函数和上述轴向力计算得到上述位移,上述传递函数为外力信息和位置信息的映射函数,上述外力信息包括上述轴向力和上述力矩,上述位置信息包括上述位移和上述第一偏转角度;上述第二计算模块用于根据上述传递函数和上述力矩计算得到上述第一偏转角度。具体地,上述传递函数可以为X(M2+B+K)=F,其中,X为位移,F为轴向力,M为惯量矩阵,矩阵中的数值采用固定值,B为阻尼系数矩阵,矩阵中的数值为阻尼参数,低阻尼参数可以提高机器人对操作者交互力的跟随能力,使得操作者可以通过较小的作用力就能使机器人跟随其做柔顺移动,K为刚度系数矩阵,增加刚度系数时,单位作用力上产生的位移就变小,即需要用更大的力才能拉动关节,反之,减少刚度系数时,单位作用力上产生的位移就变大,用很小的力就能使关节产生较大的位移,上述传递函数还可以为(M2+B+K)=τ,其中,为第一偏转角度,τ为力矩。另外,参数M、B、K参数符合以下映射关系,√K/M≈5,B/√MK≈1,以避免产生振荡问题。
本申请的一种实施例中,上述装置还包括更新单元,其中,上述更新单元包括第一更新模块和第二更新模块,其中,上述第一更新模块用于在根据上述轴向力计算上述髋臼锉的位移,并根据上述力矩计算第一偏转角度之前,在上述轴向力大于轴向力阈值的情况下,将上述轴向力更新为上述轴向力阈值;上述第二更新模块用于在上述力矩大于力矩阈值的情况下,将上述力矩更新为上述力矩阈值。具体地,上述方法将对髋臼锉施加轴向力和力矩分别限制在轴向力阈值和力矩阈值,防止髋臼过度磨损,另外,上述轴向力阈值和上述力矩阈值可以根据实际情况进行设置,以确保髋臼不会过度磨损。
本申请的一种实施例中,上述确定单元包括第二确定模块、第三确定模块、第三计算模块和第四计算模块,其中,上述第二确定模块用于根据上述位移确定进入位移缓冲区域的距离,得到缓冲距离,上述移缓冲区域为上述髋臼坐标系的Z轴上的线段,如图3所示;上述第三计算模块用于根据上述缓冲距离计算得到上述反向力;上述第三确定模块用于根据上述位移确定进入姿态缓冲区域的角度,得到缓冲角度,上述移缓冲区域为上述髋臼坐标系的Z轴绕上述髋臼坐标系的原点旋转形成的扇形区域,如图3所示;上述第四计算模块用于根据上述缓冲角度计算得到上述反向力矩。具体地,上述反向力的计算公式为F阻力=Flimit•s/w,其中,F阻力为上述反向力,Flimit为上述轴向力阈值,s 为上述缓冲距离,w为上述位移缓冲区域在Z轴上宽度,上述反向力矩的计算公式为τ阻力=τlimit•a/θ,其中,τ阻力为上述反向力矩,Flimit为上述力矩阈值,a为上述缓冲角度,θ为上述姿态缓冲区域的扇形角度,将上述缓冲距离s和上述缓冲角度a即可计算得到上述反向力F阻力和上述反向力矩τ阻力。
本申请的一种实施例中,上述控制单元包括第四确定模块和控制模块,其中,上述第四确定模块用于根据上述轴向力与上述力矩确定主动力,上述主动力为上述轴向力或者上述力矩;上述控制模块用于控制上述机器人对上述髋臼锉施加上述主动力对应的缓冲力,上述缓冲力包括上述反向力和上述反向力矩。具体地,当主动力为z轴方向进给运动时,即上述主动力为上述轴向力,只允许在z轴方向进行柔顺控制,即控制上述机器人对上述髋臼锉施加上述反向力,当主动力为定点转动时,即上述主动力为上述力矩,只允许机器人绕磨削中心点进行柔顺控制,即控制上述机器人对上述髋臼锉施加上述反向力矩,以保证磨削过程中的便捷以及准确性。
本申请的一种实施例中,上述第四确定模块包括第三确定子模块和第四确定子模块,其中,上述第三确定子模块用于在第一比值大于第二比值的情况下,确定上述轴向力为上述主动力,上述第一比值为上述轴向力与上述轴向力阈值的比值,上述第二比值为上述力矩与上述力矩阈值的比值;上述第四确定子模块用于在上述第一比值小于或者等于上述第二比值的情况下,确定上述力矩为上述主动力。具体地,在第一比值大于第二比值的情况下,即F/Flimit > τ/τ limit,则上述轴向力为上述主动力,反之,F/Flimit ≤ τ/τ limit,则上述力矩为上述主动力。
上述机器人的控制装置包括处理器和存储器,上述处理单元、计算单元、确定单元和控制单元等均作为程序单元存储在存储器中,由处理器执行存储在存储器中的上述程序单元来实现相应的功能。
处理器中包含内核,由内核去存储器中调取相应的程序单元。内核可以设置一个或以上,通过调整内核参数来解决现有技术中难以避免过度磨削的问题。
存储器可能包括计算机可读介质中的非永久性存储器,随机存取存储器(RAM)和/或非易失性内存等形式,如只读存储器(ROM)或闪存(flash RAM),存储器包括至少一个存储芯片。
本发明实施例提供了一种计算机可读存储介质,其上存储有程序,该程序被处理器执行时实现上述方法。
本发明实施例提供了一种处理器,上述处理器用于运行程序,其中,上述程序运行时执行上述方法。
本发明实施例提供了一种设备,设备包括处理器、存储器及存储在存储器上并可在处理器上运行的程序,处理器执行程序时实现至少以下步骤:(方法权项步骤,独权+从权)。
步骤S101,将施加在髋臼锉上外力转换为力控坐标系下的轴向力和力矩,和/或将施加在髋臼锉上外力矩转换为上述力控坐标系下的上述轴向力和上述力矩,其中,上述轴向力为平行于上述力控坐标系的Z轴的力,上述力矩为绕上述髋臼锉的中心轴转动的力矩,上述力控坐标系的Z轴与髋臼缘平面垂直,上述力控坐标系的X轴与人体冠正面垂直,上述力控坐标系的Y轴与上述力控坐标系的X轴和上述力控坐标系的Z轴分别垂直,上述髋臼缘平面为上述髋臼的杯口外边缘所处的平面;
步骤S102,根据上述轴向力计算上述髋臼锉的位移,并根据上述力矩计算第一偏转角度,上述第一偏转角度为上述髋臼锉的中心轴与上述力控坐标系的Z轴的夹角;
步骤S103,根据上述位移确定反向力,并根据上述第一偏转角度确定反向力矩,上述反向力与上述轴向力的方向相反,上述反向力矩与上述力矩的方向相反;
步骤S104,控制上述机器人对上述髋臼锉施加上述反向力和上述反向力矩。
本文中的设备可以是服务器、PC、PAD、手机等。
本申请还提供了一种计算机程序产品,当在数据处理设备上执行时,适于执行初始化有至少如下方法步骤的程序:
步骤S101,将施加在髋臼锉上外力转换为力控坐标系下的轴向力和力矩,和/或将施加在髋臼锉上外力矩转换为上述力控坐标系下的上述轴向力和上述力矩,其中,上述轴向力为平行于上述力控坐标系的Z轴的力,上述力矩为绕上述髋臼锉的中心轴转动的力矩,上述力控坐标系的Z轴与髋臼缘平面垂直,上述力控坐标系的X轴与人体冠正面垂直,上述力控坐标系的Y轴与上述力控坐标系的X轴和上述力控坐标系的Z轴分别垂直,上述髋臼缘平面为上述髋臼的杯口外边缘所处的平面;
步骤S102,根据上述轴向力计算上述髋臼锉的位移,并根据上述力矩计算第一偏转角度,上述第一偏转角度为上述髋臼锉的中心轴与上述力控坐标系的Z轴的夹角;
步骤S103,根据上述位移确定反向力,并根据上述第一偏转角度确定反向力矩,上述反向力与上述轴向力的方向相反,上述反向力矩与上述力矩的方向相反;
步骤S104,控制上述机器人对上述髋臼锉施加上述反向力和上述反向力矩。
在本发明的上述实施例中,对各个实施例的描述都各有侧重,某个实施例中没有详述的部分,可以参见其他实施例的相关描述。
在本申请所提供的几个实施例中,应该理解到,所揭露的技术内容,可通过其它的方式实现。其中,以上所描述的装置实施例仅仅是示意性的,例如上述单元的划分,可以为一种逻辑功能划分,实际实现时可以有另外的划分方式,例如多个单元或组件可以结合或者可以集成到另一个系统,或一些特征可以忽略,或不执行。另一点,所显示或讨论的相互之间的耦合或直接耦合或通信连接可以是通过一些接口,单元或模块的间接耦合或通信连接,可以是电性或其它的形式。
上述作为分离部件说明的单元可以是或者也可以不是物理上分开的,作为单元显示的部件可以是或者也可以不是物理单元,即可以位于一个地方,或者也可以分布到多个单元上。可以根据实际的需要选择其中的部分或者全部单元来实现本实施例方案的目的。
另外,在本发明各个实施例中的各功能单元可以集成在一个处理单元中,也可以是各个单元单独物理存在,也可以两个或两个以上单元集成在一个单元中。上述集成的单元既可以采用硬件的形式实现,也可以采用软件功能单元的形式实现。
上述集成的单元如果以软件功能单元的形式实现并作为独立的产品销售或使用时,可以存储在一个计算机可读取计算机可读存储介质中。基于这样的理解,本发明的技术方案本质上或者说对现有技术做出贡献的部分或者该技术方案的全部或部分可以以软件产品的形式体现出来,该计算机软件产品存储在一个计算机可读存储介质中,包括若干指令用以使得一台计算机设备(可为个人计算机、服务器或者网络设备等)执行本发明各个实施例上述方法的全部或部分步骤。而前述的计算机可读存储介质包括:U盘、只读存储器(ROM,Read-Only Memory)、随机存取存储器(RAM,Random Access Memory)、移动硬盘、磁碟或者光盘等各种可以存储程序代码的介质。
从以上的描述中,可以看出,本申请上述的实施例实现了如下技术效果:
1)、本申请的机器人的控制方法中,首先,将施加在髋臼锉上外力转换为力控坐标系下的轴向力和力矩,和/或将施加在髋臼锉上外力矩转换为上述力控坐标系下的上述轴向力和上述力矩,其中,上述轴向力为平行于上述力控坐标系的Z轴的力,上述力矩为绕上述髋臼锉的中心轴转动的力矩,上述外力和上述外力矩为操作人员对上述髋臼锉施加的,上述力控坐标系的Z轴与髋臼缘平面垂直,上述力控坐标系的X轴与人体冠正面垂直,上述力控坐标系的Y轴与上述力控坐标系的X轴和上述力控坐标系的Z轴分别垂直,上述髋臼缘平面为上述髋臼的杯口外边缘所处的平面;然后,根据上述轴向力计算上述髋臼锉的位移,并根据上述力矩计算第一偏转角度,上述第一偏转角度为上述髋臼锉的中心轴与上述力控坐标系的Z轴的夹角;之后,根据上述位移确定反向力,并根据上述第一偏转角度确定反向力矩,上述反向力与上述轴向力的方向相反,上述反向力矩与上述力矩的方向相反;最后,控制上述机器人对上述髋臼锉施加上述反向力和上述反向力矩。该控制方法通过将外力和/或外力矩转换为力控坐标系下的轴向力和力矩,以根据上述轴向力计算上述髋臼锉的位移,并根据上述力矩计算第一偏转角度,从而确定上述机器人对上述髋臼锉施加上述反向力和上述反向力矩,以对外力或者外力矩进行缓冲,防止髋臼过度磨损,解决了现有技术中难以避免过度磨削的问题。
2)、本申请的机器人的控制装置中,处理单元将施加在髋臼锉上外力转换为力控坐标系下的轴向力和力矩,和/或将施加在髋臼锉上外力矩转换为上述力控坐标系下的上述轴向力和上述力矩,其中,上述轴向力为平行于上述力控坐标系的Z轴的力,上述力矩为绕上述髋臼锉的中心轴转动的力矩,上述外力和上述外力矩为操作人员对上述髋臼锉施加的,上述力控坐标系的Z轴与髋臼缘平面垂直,上述力控坐标系的X轴与人体冠正面垂直,上述力控坐标系的Y轴与上述力控坐标系的X轴和上述力控坐标系的Z轴分别垂直,上述髋臼缘平面为上述髋臼的杯口外边缘所处的平面;计算单元根据上述轴向力计算上述髋臼锉的位移,并根据上述力矩计算第一偏转角度,上述第一偏转角度为上述髋臼锉的中心轴与上述力控坐标系的Z轴的夹角;确定单元根据上述位移确定反向力,并根据上述第一偏转角度确定反向力矩,上述反向力与上述轴向力的方向相反,上述反向力矩与上述力矩的方向相反;控制单元控制上述机器人对上述髋臼锉施加上述反向力和上述反向力矩。该控制装置通过将外力和/或外力矩转换为力控坐标系下的轴向力和力矩,以根据上述轴向力计算上述髋臼锉的位移,并根据上述力矩计算第一偏转角度,从而确定上述机器人对上述髋臼锉施加上述反向力和上述反向力矩,以对外力或者外力矩进行缓冲,防止髋臼过度磨损,解决了现有技术中难以避免过度磨削的问题。
以上所述仅为本申请的优选实施例而已,并不用于限制本申请,对于本领域的技术人员来说,本申请可以有各种更改和变化。凡在本申请的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本申请的保护范围之内。
Claims (12)
1.一种机器人的控制方法,机器人用于控制髋臼锉对髋臼进行磨削,其特征在于,包括:
将施加在髋臼锉上外力转换为力控坐标系下的轴向力和力矩,和/或将施加在髋臼锉上外力矩转换为所述力控坐标系下的所述轴向力和所述力矩,其中,所述轴向力为平行于所述力控坐标系的Z轴的力,所述力矩为绕所述髋臼锉的中心轴转动的力矩,所述力控坐标系的Z轴与髋臼缘平面垂直,所述力控坐标系的X轴与人体冠正面垂直,所述力控坐标系的Y轴与所述力控坐标系的X轴和所述力控坐标系的Z轴分别垂直,所述髋臼缘平面为所述髋臼的杯口外边缘所处的平面;
根据所述轴向力计算所述髋臼锉的位移,并根据所述力矩计算第一偏转角度,所述第一偏转角度为所述髋臼锉的中心轴与所述力控坐标系的Z轴的夹角;
根据所述位移确定反向力,并根据所述第一偏转角度确定反向力矩,所述反向力与所述轴向力的方向相反,所述反向力矩与所述力矩的方向相反;
控制所述机器人对所述髋臼锉施加所述反向力和所述反向力矩。
2.根据权利要求1所述的方法,其特征在于,在根据外力和/或外力矩转换为力控坐标系下的轴向力和力矩之前,所述方法还包括:
建立髋臼坐标系,所述髋臼坐标系的原点位于髋臼的中心位置,所述髋臼坐标系的Z轴与髋臼缘平面垂直,所述髋臼坐标系的X轴与人体冠正面垂直,所述髋臼坐标系的Y轴与所述髋臼坐标系的X轴和所述髋臼坐标系的Z轴分别垂直,所述髋臼缘平面为所述髋臼的杯口外边缘所处的平面;
将所述髋臼坐标系沿Z轴的第一方向平移预定距离,得到所述力控坐标系,所述第一方向为远离所述髋臼的方向。
3.根据权利要求2所述的方法,其特征在于,在将所述髋臼坐标系沿Z轴的第一方向平移预定距离,得到所述力控坐标系之后,在根据外力和/或外力矩转换为力控坐标系下的轴向力和力矩之前,所述方法还包括:
获取所述髋臼的第二偏转角度,所述第二偏转角度为第一姿态和第二姿态的变换角度,所述第一姿态为前一检测时刻的所述髋臼的姿态,所述第二姿态为当前检测时刻所述髋臼的姿态,所述前一检测时刻与所述当前检测时刻的时间间隔为姿态传感器的检测周期;
根据所述第二偏转角度确定是否更新所述髋臼坐标系和所述力控坐标系;
在确定更新所述髋臼坐标系和所述力控坐标系的情况下,重新建立所述髋臼坐标系和所述力控坐标系。
4.根据权利要求3所述的方法,其特征在于,根据所述第二偏转角度确定是否更新所述髋臼坐标系和所述力控坐标系,包括:
在所述第二偏转角度小于第一偏转角度阈值的情况下,确定不更新所述髋臼坐标系和所述力控坐标系;
在所述第二偏转角度大于或者等于所述第一偏转角度阈值的情况下,确定更新所述髋臼坐标系和所述力控坐标系。
5.根据权利要求1所述的方法,其特征在于,根据所述轴向力计算所述髋臼锉的位移,并根据所述力矩计算第一偏转角度,包括:
根据传递函数和所述轴向力计算得到所述位移,所述传递函数为外力信息和位置信息的映射函数,所述外力信息包括所述轴向力和所述力矩,所述位置信息包括所述位移和所述第一偏转角度;
根据所述传递函数和所述力矩计算得到所述第一偏转角度。
6.根据权利要求2所述的方法,其特征在于,在根据所述轴向力计算所述髋臼锉的位移,并根据所述力矩计算第一偏转角度之前,所述方法还包括:
在所述轴向力大于轴向力阈值的情况下,将所述轴向力更新为所述轴向力阈值;
在所述力矩大于力矩阈值的情况下,将所述力矩更新为所述力矩阈值。
7.根据权利要求2所述的方法,其特征在于,根据所述位移确定反向力,并根据所述第一偏转角度确定反向力矩,包括:
根据所述位移确定进入位移缓冲区域的距离,得到缓冲距离,所述移缓冲区域为所述髋臼坐标系的Z轴上的线段;
根据所述缓冲距离计算得到所述反向力;
根据所述位移确定进入姿态缓冲区域的角度,得到缓冲角度,所述移缓冲区域为所述髋臼坐标系的Z轴绕所述髋臼坐标系的原点旋转形成的扇形区域;
根据所述缓冲角度计算得到所述反向力矩。
8.根据权利要求6所述的方法,其特征在于,控制所述机器人对所述髋臼锉施加所述反向力和所述反向力矩,包括:
根据所述轴向力与所述力矩确定主动力,所述主动力为所述轴向力或者所述力矩;
控制所述机器人对所述髋臼锉施加所述主动力对应的缓冲力,所述缓冲力包括所述反向力和所述反向力矩。
9.根据权利要求8所述的方法,其特征在于,根据所述轴向力与所述力矩确定主动力,包括:
在第一比值大于第二比值的情况下,确定所述轴向力为所述主动力,所述第一比值为所述轴向力与所述轴向力阈值的比值,所述第二比值为所述力矩与所述力矩阈值的比值;
在所述第一比值小于或者等于所述第二比值的情况下,确定所述力矩为所述主动力。
10.一种机器人的控制装置,机器人用于控制髋臼锉对髋臼进行磨削,其特征在于,包括:
处理单元,用于根据外力和/或外力矩转换为力控坐标系下的轴向力和力矩,所述轴向力为平行于所述力控坐标系的Z轴的力,所述力矩为绕所述髋臼锉的中心轴转动的力矩,所述外力和所述外力矩为操作人员对所述髋臼锉施加的,所述力控坐标系的Z轴与髋臼缘平面垂直,所述力控坐标系的X轴与人体冠正面垂直,所述力控坐标系的Y轴与所述力控坐标系的X轴和所述力控坐标系的Z轴分别垂直,所述髋臼缘平面为所述髋臼的杯口外边缘所处的平面;
计算单元,用于根据所述轴向力计算所述髋臼锉的位移,并根据所述力矩计算第一偏转角度,所述第一偏转角度为所述髋臼锉的中心轴与所述力控坐标系的Z轴的夹角;
确定单元,用于根据所述位移确定反向力,并根据所述第一偏转角度确定反向力矩,所述反向力与所述轴向力的方向相反,所述反向力矩与所述力矩的方向相反;
控制单元,用于控制所述机器人对所述髋臼锉施加所述反向力和所述反向力矩。
11.一种计算机可读存储介质,其特征在于,所述计算机可读存储介质包括存储的程序,其中,所述程序执行权利要求1至9中任意一项所述的方法。
12.一种处理器,其特征在于,所述处理器用于运行程序,其中,所述程序运行时执行权利要求1至9中任意一项所述的方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111125886.9A CN113561188B (zh) | 2021-09-26 | 2021-09-26 | 机器人的控制方法、装置、计算机可读存储介质和处理器 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111125886.9A CN113561188B (zh) | 2021-09-26 | 2021-09-26 | 机器人的控制方法、装置、计算机可读存储介质和处理器 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113561188A true CN113561188A (zh) | 2021-10-29 |
CN113561188B CN113561188B (zh) | 2021-12-07 |
Family
ID=78174507
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111125886.9A Active CN113561188B (zh) | 2021-09-26 | 2021-09-26 | 机器人的控制方法、装置、计算机可读存储介质和处理器 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113561188B (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115300038A (zh) * | 2022-07-15 | 2022-11-08 | 北京和华瑞博医疗科技有限公司 | 控制装置、髋关节置换系统、可读存储介质及电子设备 |
CN115813563A (zh) * | 2023-02-20 | 2023-03-21 | 北京壹点灵动科技有限公司 | 手术机器人控制方法、装置、存储介质以及处理器 |
CN116473678A (zh) * | 2023-06-21 | 2023-07-25 | 杭州键嘉医疗科技股份有限公司 | 一种虚拟墙引导末端执行器移动的方法及装置 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20030220698A1 (en) * | 2000-04-26 | 2003-11-27 | Dana Mears | Method and apparatus for performing a minimally invasive total hip arthroplasty |
US20150245922A1 (en) * | 2013-12-26 | 2015-09-03 | Somersault Orthopedics Inc. | Method for hip resection alignment approximation in hip replacement procedures |
CN109199645A (zh) * | 2018-11-12 | 2019-01-15 | 广州华钛三维材料制造有限公司 | 组配式髋臼假体及其安装方法及与其配套的骨缺损磨锉器 |
CN112914672A (zh) * | 2021-02-26 | 2021-06-08 | 福建省立医院 | 一种分体式髋臼锉系统、控制方法及应用 |
CN113400305A (zh) * | 2021-06-07 | 2021-09-17 | 北京长木谷医疗科技有限公司 | 磨挫工具的控制方法、装置、电子设备及存储介质 |
-
2021
- 2021-09-26 CN CN202111125886.9A patent/CN113561188B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20030220698A1 (en) * | 2000-04-26 | 2003-11-27 | Dana Mears | Method and apparatus for performing a minimally invasive total hip arthroplasty |
US20150245922A1 (en) * | 2013-12-26 | 2015-09-03 | Somersault Orthopedics Inc. | Method for hip resection alignment approximation in hip replacement procedures |
CN109199645A (zh) * | 2018-11-12 | 2019-01-15 | 广州华钛三维材料制造有限公司 | 组配式髋臼假体及其安装方法及与其配套的骨缺损磨锉器 |
CN112914672A (zh) * | 2021-02-26 | 2021-06-08 | 福建省立医院 | 一种分体式髋臼锉系统、控制方法及应用 |
CN113400305A (zh) * | 2021-06-07 | 2021-09-17 | 北京长木谷医疗科技有限公司 | 磨挫工具的控制方法、装置、电子设备及存储介质 |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115300038A (zh) * | 2022-07-15 | 2022-11-08 | 北京和华瑞博医疗科技有限公司 | 控制装置、髋关节置换系统、可读存储介质及电子设备 |
CN115300038B (zh) * | 2022-07-15 | 2023-06-09 | 北京和华瑞博医疗科技有限公司 | 控制装置、髋关节置换系统、可读存储介质及电子设备 |
CN115813563A (zh) * | 2023-02-20 | 2023-03-21 | 北京壹点灵动科技有限公司 | 手术机器人控制方法、装置、存储介质以及处理器 |
CN116473678A (zh) * | 2023-06-21 | 2023-07-25 | 杭州键嘉医疗科技股份有限公司 | 一种虚拟墙引导末端执行器移动的方法及装置 |
CN116473678B (zh) * | 2023-06-21 | 2023-09-29 | 杭州键嘉医疗科技股份有限公司 | 一种虚拟墙引导末端执行器移动的方法及装置 |
Also Published As
Publication number | Publication date |
---|---|
CN113561188B (zh) | 2021-12-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113561188B (zh) | 机器人的控制方法、装置、计算机可读存储介质和处理器 | |
US11042046B2 (en) | Wearable devices such as eyewear customized to individual wearer parameters | |
CN110353806B (zh) | 用于微创全膝关节置换手术的增强现实导航方法及系统 | |
EP3135444B1 (en) | Robot arm apparatus, robot arm control method, and program | |
JP5989784B2 (ja) | 非円形ソフトコンタクトレンズの設計方法 | |
WO2018129234A1 (en) | Improved accuracy of displayed virtual data with optical head mount displays for mixed reality | |
JPH09502541A (ja) | 非対称性非球面コンタクトレンズ | |
US20180064371A1 (en) | Posture detection apparatus, glasses-type electronic device, posture detection method, and program | |
CN107242920A (zh) | 膝关节单髁姿态测量装置及系统 | |
CN113520601A (zh) | 末端工具位姿的实时修正方法、系统以及手术机器人 | |
JP4698908B2 (ja) | 角膜の地形学的分析の新規な方法に基づくソフト・コンタクト・レンズの設計方法 | |
CN109144250A (zh) | 一种位置调节的方法、装置、设备及存储介质 | |
CN117618168B (zh) | 髋臼杯假体植入角度的确定方法和装置及存储介质 | |
CN109523625A (zh) | 一种韧带长度量化方法 | |
JPWO2017094492A1 (ja) | キャリブレーション方法、携帯機器およびプログラム | |
CN116019564B (zh) | 膝关节手术机器人和控制方法 | |
CN108008543A (zh) | 一种柔性胶囊鼻托 | |
Lura | The creation of a robotics based human upper body model for predictive simulation of prostheses performance | |
WO2017150148A1 (ja) | 瞬目検出装置、眼鏡型電子機器、瞬目検出方法およびプログラム | |
JP7170258B2 (ja) | ウェアラブルデバイス対応眼電位データ処理装置、それを備えた眼鏡型ウェアラブルデバイス、及びウェアラブルデバイス対応眼電位データ処理方法 | |
CN213552312U (zh) | 手术导航机器人系统 | |
CN112754656B (zh) | 一种人工耳蜗植入手术机器人及其辅助方法和辅助系统 | |
Abbasimoshaei et al. | Application of Eye-Tracking for a 3-DOF Robot Assisted Medical System | |
CN209827490U (zh) | 一种近视理疗仪用气囊及使用其的近视理疗仪 | |
TWI819942B (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 | ||
TA01 | Transfer of patent application right | ||
TA01 | Transfer of patent application right |
Effective date of registration: 20211123 Address after: 102200 Beijing Changping District science and Technology Park No. 10, two floor, Xingye building, Bai Fu Quan road. Applicant after: Beijing Yidian Lingdong Technology Co.,Ltd. Address before: 102200 Beijing Changping District science and Technology Park No. 10, two floor, Xingye building, Bai Fu Quan road. Applicant before: BEIJING AK MEDICAL Co.,Ltd. |
|
GR01 | Patent grant | ||
GR01 | Patent grant |