多级并联手术机械臂的控制方法及多级并联手术机械臂与流程

文档序号:25304910发布日期:2021-06-04 14:15阅读:来源:国知局

技术特征:
1.一种多级并联手术机械臂的控制方法,其特征在于,所述多级并联手术机械臂包括第一并联平台、第二并联平台和执行组件,所述执行组件包括执行杆和手术器具;所述执行组件与所述第一并联平台连接,所述第一并联平台与所述第二并联平台连接;所述方法包括:获取所述执行杆上的远心不动点坐标,并获取所述手术器具的末端坐标;根据所述远心不动点坐标和所述末端坐标,确定所述第一并联平台的位置偏移量和第一姿态向量,并确定所述第二并联平台的第二姿态向量;根据所述位置偏移量、所述第一姿态向量和所述第二姿态向量,控制所述第一并联平台移动至第一指定位姿;根据所述第一姿态向量和所述第二姿态向量,控制所述第二并联平台移动至第二指定位姿。2.根据权利要求1所述的控制方法,其特征在于,控制所述第一并联平台和所述第二并联平台移动包括:在所述手术器具的运动范围小于或等于第一区域的情况下,将所述第二并联平台设置为锁住状态,并控制所述第一并联平台移动至所述第一指定位姿;在所述运动范围大于所述第一区域,且所述运动范围小于或等于第二区域的情况下,将所述第二并联平台设置为解锁状态,并控制所述第二并联平台移动移动至所述第二指定位姿。3.根据权利要求1所述的控制方法,其特征在于,所述根据所述位置偏移量、所述第一姿态向量和所述第二姿态向量,控制所述第一并联平台移动至第一指定位姿包括:根据所述远心不动点坐标和所述末端坐标,获取所述第一并联平台的第一动平台在绝对坐标系下的第一动原点坐标;并根据所述第一动原点坐标获取所述第一并联平台的位置偏移量;根据所述位置偏移量、所述第一姿态向量和所述第二姿态向量,确定第一转换矩阵;根据所述第一转换矩阵,并根据所述第一并联平台的第一铰接点在所述绝对坐标系下的坐标,计算得到所述第一并联平台的第一伸缩元件长度;根据所述第一动原点坐标和所述第一伸缩元件长度,控制所述第一动平台移动至所述第一指定位姿。4.根据权利要求3所述的控制方法,其特征在于,所述根据所述第一动原点坐标获取所述第一并联平台的位置偏移量包括:根据所述远心不动点坐标、所述末端坐标和所述第一动原点坐标,确定第一比例;其中,所述第一比例为所述远心不动点坐标到第一静原点坐标的距离相对所述第二姿态向量的比例;所述第一静原点坐标为所述第一并联平台的第一静平台在绝对坐标系下的原点坐标;根据所述第一比例、所述远心不动点和所述第二姿态向量,确定所述第一静平台的第一静原点坐标;根据所述第一动原点坐标和所述第一静原点坐标,获取所述位置偏移量。5.根据权利要求4所述的控制方法,其特征在于,所述根据所述位置偏移量、所述第一姿态向量和所述第二姿态向量,确定第一转换矩阵包括:
根据所述第一姿态向量和所述第二姿态向量,获取第一旋转角度,并获取第二旋转角度;其中,所述第一旋转角度为所述第一并联平台绕第一动坐标系的第一坐标轴旋转的角度,所述第二旋转角度为所述第一并联平台绕所述第一动坐标系的第二坐标轴旋转的角度;根据所述第一并联平台的位置偏移量、所述第一旋转角度、所述第二旋转角度和所述第二姿态向量,确定所述第一转换矩阵。6.根据权利要求3所述的控制方法,其特征在于,所述根据所述第一姿态向量和所述第二姿态向量,控制所述第二并联平台移动至第二指定位姿包括:根据所述远心不动点坐标和所述第二姿态向量,获取所述第二并联平台的第二动平台在绝对坐标系下的第二动原点坐标;根据所述绝对坐标系的第三坐标轴、所述第二姿态向量和所述第二动原点坐标,确定第二转换矩阵;根据所述第二转换矩阵,并根据所述第二并联平台的第二铰接点在所述绝对坐标系下的坐标,计算得到所述第二并联平台的第二伸缩元件长度;根据所述第二动原点坐标和所述第二伸缩元件长度,控制所述第二动平台移动至所述第二指定位姿。7.根据权利要求6所述的控制方法,其特征在于,所述根据所述远心不动点坐标和所述第二姿态向量,获取所述第二并联平台的第二动平台在绝对坐标系下的第二动原点坐标包括:根据所述远心不动点坐标、所述末端坐标和所述第一动原点坐标,确定第二比例;其中,所述第二比例为所述远心不动点坐标到第二动原点坐标的距离相对所述第二姿态向量的比例;根据所述第二比例、所述远心不动点和所述第二姿态向量,确定所述第二动原点坐标。8.根据权利要求6所述的控制方法,其特征在于,所述根据所述绝对坐标系的第三坐标轴、所述第二姿态向量和所述第二动原点坐标,确定第二转换矩阵包括:根据所述第三坐标轴和第二姿态向量,获取第三旋转角度,并获取第四旋转角度;其中,所述第三旋转角度为所述第二并联平台绕第二动坐标系的第一坐标轴旋转的角度,所述第四旋转角度为所述第二并联平台绕所述第二动坐标系的第二坐标轴旋转的角度;根据所述第三旋转角度、所述第四旋转角度和所述第二动原点坐标,确定所述第二转换矩阵。9.根据权利要求1所述的控制方法,其特征在于,所述控制所述第二并联平台移动至第二指定位姿之后,所述方法还包括:根据所述第一姿态向量和所述第二姿态向量,控制所述第一并联平台移动至第三指定位姿。10.根据权利要求9所述的控制方法,其特征在于,所述控制所述第一并联平台移动至第三指定位置之前,所述方法还包括:根据所述远心不动点坐标和所述末端坐标,控制所述执行杆相对于所述远心不动点的伸长运动。11.根据权利要求1所述的控制方法,其特征在于,所述方法还包括:
第一虚拟轴和第二虚拟轴均通过所述远心不动点;其中,所述第一虚拟轴为固连在所述第一并联平台中心,且垂直与所述第一并联平台的直线;所述第二虚拟轴为固连在所述第二并联平台中心,且垂直与所述第二并联平台的直线。12.根据权利要求11所述的控制方法,其特征在于,所述方法还包括:所述第一虚拟轴和所述第二虚拟轴处于同一平面内。13.根据权利要求1所述的控制方法,其特征在于,所述方法还包括:在将所述执行杆的摆动角度由第一阈值遍历至第二阈值的情况下,确定所述第一并联平台和所述第二并联平台的最大参数值。14.一种多级并联手术机械臂,其特征在于,包括控制系统、第一并联平台、第二并联平台和执行组件,所述执行组件包括执行杆和手术器具;所述执行组件与所述第一并联平台连接,所述第一并联平台与所述第二并联平台连接;所述控制系统用于实现如权利要求1至13中任一项所述的控制方法。15.根据权利要求14所述的多级并联手术机械臂,其特征在于,所述第一并联平台的第一平台半径小于所述第二并联平台的第二平台半径,且所述第一并联平台的第一平台间距小于所述第二并联平台的第二平台间距。16.根据权利要求14所述的多级并联手术机械臂,其特征在于,所述执行组件的摆动空间设置为球形工作空间。17.根据权利要求14所述的多级并联手术机械臂,其特征在于,所述第一并联平台的第一最大偏角,以及所述第二并联平台的第二最大偏角设置为20
°
。18.一种计算机设备,包括存储器、处理器以及存储在所述存储器上并可在所述处理器上运行的计算机程序,其特征在于,所述处理器执行所述计算机程序时实现如权利要求1至13中任一项所述的控制方法。19.一种计算机可读存储介质,其上存储有计算机程序,其特征在于,该程序被处理器执行时实现如权利要求1至13中任一项所述的控制方法。
当前第2页1 2 3 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1