一种基于TCP法的截骨机器人系统中刀具坐标系标定方法技术方案

本发明专利技术公开了一种基于TCP法的截骨机器人系统中刀具坐标系标定方法，步骤包括，基于刀具尖点、刀具左侧点和刀具右侧点，建立刀具坐标系；计算所述刀具尖点、刀具左侧点、刀具右侧点及刀具垂足点在机器人末端坐标系中的坐标；根据所述刀具尖点、刀具左侧点、刀具右侧点及刀具垂足点在机器人末端坐标系中的坐标，计算出刀具坐标系相对机器人末端坐标系的齐次变换矩阵；本发明专利技术实现了刀具平面在机器人末端坐标系下的姿态的标定，在机器人夹持刀具的工作中，有助于对刀具姿态进行准确控制。有助于对刀具姿态进行准确控制。有助于对刀具姿态进行准确控制。

【技术实现步骤摘要】
一种基于TCP法的截骨机器人系统中刀具坐标系标定方法


[0001]本专利技术涉及机器人工具标定
，更具体的说是涉及一种基于TCP法的截骨机器人系统中刀具坐标系标定方法。

技术介绍

[0002]在机器人把持刀具执行切割过程中，刀具的切割位置和刀具平面必须与医生术前规划的切割位置和切割平面重合。刀具的切割运动会形成切割缝平面，随着切割的深入，刀具平面会进入切割缝。由于骨组织具有一定刚度，因此机器人控制刀具的切割运动，必须保持刀具平面与切割缝平面的重合，否则刀具受到垂直于刀具平面的力，会使切割轨迹变形，或者使刀具崩断。因此，在机器人辅助截骨成型手术中，需要准确标定截骨刀具在机器人坐标系中的位姿参数，这样才能使刀具精准到达切割位置并完成切割。
[0003]目前已有的机器人工具标定方法中，主要可分为两类。第一类主要面向对工具的姿态没有特别要求的弧焊机器人，仅需要标定末端工具的TCP(Tool Center Point)在机器人工具坐标系中位置。第二类是面向类似钻孔机器人进行标定，除了获取钻头TCP参数，还需要标定钻头钻轴在机器人末端工具坐标本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种基于TCP法的截骨机器人系统中刀具坐标系标定方法，其特征在于，步骤包括，基于刀具尖点、刀具左侧点和刀具右侧点，建立刀具坐标系；计算所述刀具尖点、刀具左侧点、刀具右侧点及刀具垂足点在机器人末端坐标系中的坐标；根据所述刀具尖点、刀具左侧点、刀具右侧点及刀具垂足点在机器人末端坐标系中的坐标，计算出刀具坐标系相对机器人末端坐标系的齐次变换矩阵。2.根据权利要求1所述的一种基于TCP法的截骨机器人系统中刀具坐标系标定方法，其特征在于，所述基于刀具尖点、刀具左侧点和刀具右侧点，建立刀具坐标系包括，标记刀具尖点、刀具左侧点及刀具右侧点，并以刀具左侧点指向刀具右侧点的向量作为刀具坐标系的X轴，以刀具左侧点及刀具右侧点连线上的一点指向刀具尖点作为刀具坐标系的Z轴；所述Z轴和X轴保持垂直，建立刀具坐标系。3.根据权利要求1所述的一种基于TCP法的截骨机器人系统中刀具坐标系标定方法，其特征在于，计算所述刀具尖点、刀具左侧点、刀具右侧点及刀具垂足点在机器人末端坐标系中的坐标，包括：获取机器人末端坐标系相对于机器人基坐标系的齐次变换矩阵；确认所述刀具坐标系、机器人基坐标系和机器人末端坐标系的坐标转换关系：根据所述机器人末端坐标系相对于机器人基坐标系的齐次变换矩阵以及坐标转换关系得到刀具尖点、刀具左侧点和刀具右侧点在机器人末端坐标系下的坐标，并计算垂足点在机器人末端坐标系中的坐标。4.根据权利要求3所述的一种基于TCP法的截骨机器人系统中刀具坐标系标定方法，其特征在于，所述获取机器人末端坐标系相对于机器人基坐标系的齐次变换矩阵包括，在机器人的工作空间内放置一个固定点；依次使所述刀具尖点、所述刀具左侧点和所述刀具右侧点与所述固定点重合；对于每次重合，调整机器人的四个不同姿态得到机器人末端坐标系相对于机器人基坐标系的齐次变换矩阵5.根据权利要求4所述的一种基于TCP法的截骨机器人系统中刀具坐标系标定方法，其特征在于，所述刀具坐标系、机器人基坐标系和机器人末端坐标系的坐标转换关系为：则则其中，为刀具坐标系相对机器人基坐标系的齐次变换矩阵；为机器人末端坐标系相对于机器人基坐标系的齐次变换矩阵；为刀具坐标...

【专利技术属性】
技术研发人员：孟偲，李定哲，吴凯，
申请(专利权)人：北京航空航天大学，
类型：发明
国别省市：