防碰撞控制方法、装置、介质及设备制造方法及图纸

本文是关于一种机械臂的防碰撞控制方法、装置、介质及设备。机械臂的防碰撞控制方法包括：构建机械臂工作区域的安全区曲面；抽取机械臂末端及执行装置的多个轮廓点；以机械臂末端中心为原点建立第一坐标系，确定多个轮廓点的坐标；以机械臂底座中心为原点建立第二坐标系，确定第一坐标系在第二坐标系中的位置和姿态矩阵；根据机械臂底座与工作区域的相对位置，及位置和姿态矩阵，确定多个轮廓点在工作区域中的位置。通过实时检测机械臂轮廓点在工作区域中的位置，及时控制机械臂的运动，防止机械臂与工作区域对应的装置或设备发生碰撞，保障设备安全。保障设备安全。保障设备安全。

【技术实现步骤摘要】
防碰撞控制方法、装置、介质及设备


[0001]本文涉及机器人控制领域，尤其涉及一种机械臂的防碰撞控制方法、装置、介质及设备。

技术介绍

[0002]主从式机器人操作的时候，主端操控端一般距离从端机器人有一定距离，或者在不同房间，特别在医疗机器人的一些特殊应用领域，从端机器人一般是在带有辐射的危险区域，例如CT扫描室等，主端操控端一般位于无辐射的操控间，因此对于从端机器人操作的安全性要求很高。特别是应用在CT下的从端机器人，机器人需要将机械臂及其持有的特殊执行器械运动到CT扫描孔洞内，该孔洞一般直径不超过900mm，在这么一个狭小的空间内，机器人还需要完成各种旋转、平移、穿刺等动作，怎么保证机械臂及其执行器械能够灵活快速准确的运动，又不与CT机器发生碰撞，是CT引导的手术机器人必须要解决的一个问题。
[0003]相关技术中传统判断机械臂碰撞的方法是把机械臂及需要判断物体(例如CT机)的数字模型按实际空间位置关系进行计算，判断出两个模型是否有空间重叠。这种方法精准直接，但是花费时间较长，所以通常运用在机械臂的运动轨迹已知并且固定的条件下，事本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种机械臂的防碰撞控制方法，其特征在于，包括：构建机械臂工作区域的安全区曲面；抽取所述机械臂末端及执行装置的多个轮廓点；以所述机械臂末端中心为原点建立第一坐标系，确定所述多个轮廓点的坐标；以所述机械臂底座中心为原点建立第二坐标系，确定所述第一坐标系在第二坐标系中的位置和姿态矩阵；根据所述机械臂底座与所述工作区域的相对位置，及所述位置和姿态矩阵，确定所述多个轮廓点在所述工作区域中的位置。2.如权利要求1所述的机械臂的防碰撞控制方法，其特征在于，还包括：接收用户的操控指令，如系统状态为安全状态，沿所述操控指令指示的运动方向移动所述机械臂；当检测到所述多个轮廓点中任一轮廓点与所述安全区曲面相交或越过，停止所述机械臂的运动。3.如权利要求2所述的机械臂的防碰撞控制方法，其特征在于，所述停止所述机械臂的运动后，还包括：标记系统状态为越界状态。4.如权利要求3所述的机械臂的防碰撞控制方法，其特征在于，还包括：在标记系统状态为越界状态后，计算所述轮廓点与所述安全区曲面相交点的切面，将指向安全区外侧的法向作为第一方向；当所述机械臂再次接收用户的操控指令时，确定所述操控指令指示的第二方向，如果所述第二方向与所述第一方向的夹角小于等于90度，发出告警信息并拒绝所述机械臂向所述第二方向运动。5.如权利要求4所述的机械臂的防碰撞控制方法，其特征在于，如果所述第二方向与所述第一方向的夹角大于90度，控制所述机械臂向所述第二方向运动；当所述多个轮廓点与所述安全区曲面既不相交也不越过时，标记系统状态为安全状态。6.如权利要求2所述的机械臂的防碰撞控制方法，其特征在于，所述工作区域为CT扫描孔洞，所述安全区曲面为圆柱曲面与圆锥曲面的组合曲面，所述组合曲面的内径小于所述CT扫描孔洞的内径...

【专利技术属性】
技术研发人员：刘华根，赵磊，
申请(专利权)人：生一健康科技发展上海有限公司，
类型：发明
国别省市：