【技术实现步骤摘要】
X光机控制方法、装置、X光机及可读存储介质
[0001]本申请实施例涉及机械设备及通信
,尤其涉及一种X光机控制方法、装置、X光机及可读存储介质。
技术介绍
[0002]X光影像系统是手术中定位的常用方式,被广泛应用于骨科、妇科及外科植介入手术中。X光影像系统可设置在手术机器人系统中,医生可以远程操控手术机器人系统中的X光影像机器。
[0003]现有的多臂机器人协同操作,在控制机器人时需要考虑速度加速度等多项参数,算法复杂,实时性差,协作范围窄。
技术实现思路
[0004]本申请实施例提供一种X光机控制方法、装置、X光机及可读存储介质,可通过针对机器人的位置进行控制,对X光机的控制具有较高的实时性,以及将基于X对射平台主动端的运动映射到从动端的并联平台和滑轨上,增大协作范围。
[0005]本申请实施例一方面提供了一种X光机控制方法,应用于X光机,所述 X光机具有接收端平台和发射端平台,所述发射端平台上设有X射线发射器,所述接收端平台上设有X射线接收器,所述方法包括:
[0006]响应于主操作手的控制,根据预先计算得到的所述主操作手和所述发射端平台的映射关系,解算所述发射端平台的运动位姿,并基于所述运动位姿控制所述发射端平台运动;
[0007]根据所述发射端平台与所述接收端平台的映射关系,以及所述发射端平台的运动姿态,解算所述接收端平台的运动位姿,并基于所述运动位姿控制所述接收端平台运动,以使得所述X射线接收器接收到所述X射线发射器发射的X射线。
[0008 ...
【技术保护点】
【技术特征摘要】
1.一种X光机控制方法,应用于X光机,其特征在于,所述X光机具有接收端平台和发射端平台,所述发射端平台上设有X射线发射器,所述接收端平台上设有X射线接收器,所述方法包括:响应于主操作手的控制,根据预先计算得到的所述主操作手和所述发射端平台的映射关系,解算所述发射端平台的运动位姿,并基于所述运动位姿控制所述发射端平台运动;根据所述发射端平台与所述接收端平台的映射关系,以及所述发射端平台的运动姿态,解算所述接收端平台的运动位姿,并基于所述运动位姿控制所述接收端平台运动,以使得所述X射线接收器接收到所述X射线发射器发射的X射线。2.根据权利要求1所述的方法,其特征在于,所述根据所述发射端平台与所述接收端平台的映射关系,以及所述发射端平台的运动位姿,解算所述接收端平台的运动位姿,包括:根据所述发射端平台与所述接收端平台的姿态对应关系,以及所述发射端平台的运动姿态,解算所述接收端平台的运动姿态;根据所述发射端平台与所述接收端平台的位置对应关系,以及所述发射端平台的运动位置,解算所述接收端平台的运动位置。3.根据权利要求2所述的方法,其特征在于,所述基于所述运动位姿控制所述接收端平台运动,包括:基于解算得到的所述接收端平台的运动姿态,将所述接收端平台调整为所述运动姿态,以使得所述接收端平台与所述发射端平台姿态对应;基于解算得到的所述接收端平台的运动位置,调整所述接收端平台在滑轨上的位置,以使得所述接收端平台与所述发射端平台位置对应。4.根据权利要求1所述的方法,其特征在于,所述发射端平台包括静平台和动平台,所述X射线发射机设于所述发射端动平台上,且随所述发射端动平台运动;所述接收端平台包括静平台和动平台,所述X射线接收机设于所述接收端动平台上,且随所述接收端动平台运动;所述方法还包括:将所述接收端平台的静平台坐标系的原点设置在所述静平台的中心,且各轴的方向均各自与预设的机械坐标系的各轴平行;将所述接收端平台的动平台坐标系的原点设置在所述动平台的中心,且初始状态下各轴的方向均各自与所述机械坐标系的各轴平行;计算所述接收端平台的坐标系,以及,预设的所述发射端平台的坐标系、所述X光机的机械坐标系和预设的用户坐标系之间的各转换矩阵。5.根据权利要求4所述的方法,其特征在于,所述计算所述接收端平台的坐标系,以及,预设的所述发射端平台的坐标系、所述X光机的机械坐标系和预设的用户坐标系之间的各转换矩阵包括:基于所述接收端平台的坐标系的建立规则,解算得到所述接收端平台的静平台的坐标系与所述机械坐标系之间的转换矩阵根据所述接收端平台的静平台的坐标系与所述机械坐标系之间的转换矩阵预先计算得到的所述机械坐标系与所述发射端平台的静平台的坐标系之间的转换矩阵
所述机械坐标系与用户坐标系之间的转换矩阵计算得到所述接收端平台的静平台的坐标系与所述发射端平台的静平台的坐标系之间的转换矩阵以及,所述接收端平台的静平台的坐标系与所述用户坐标系之间的转换矩阵根据预设算法,计算得到所述发射端平台的动平台的坐标系和静平台的坐标系之间的转换矩阵以及所述接收端平台的动平台的坐标系和静平台的坐标系之间的转换矩阵根据所述发射端平台的静平台的坐标系与所述机械坐标系之间的转换矩阵以及,所述发射端平台的动平台的坐标系和静平台的坐标系之间的转换矩阵计算得到所述发射端平台的动平台的坐标系与所述机械坐标系的转换矩阵根据所述发射端平台的静平台的坐标系与所述机械坐标系之间的转换矩阵和所述机械坐标系与用户坐标系之间的转换矩阵计算得到所述用户坐标系到所述发射端平台的静平台的坐标系的转换矩阵根据所述用户坐标系到所述发射端平台的静平台的坐标系的转换矩阵以及,所述发射端平台的动平台的坐标系和静平台的坐标系之间的转换矩阵计算得到所述发射端平台的动平台的坐标系与所述用户坐标系之间的转换矩阵根据所述接收端平台的静平台的坐标系与所述机械坐标系之间的转换矩阵以及,所述接收端平台的动平台的坐标系和静平台的坐标系之间的转换矩阵计算得到所述接收端平台的动平台的坐标系与所述机械坐标系的转换矩阵根据所述接收端平台的静平台的坐标系与所述用户坐标系之间的转换矩阵以及,所述所述接收端平台的动平台的坐标系和静平台的坐标系之间的转换矩阵计算得到所述接收端平台的动平台的坐标系与所述用户坐标系之间的转换矩阵6.根据权利要求1所述的方法,其特征在于,所述主操作手和所述发射端平台的映射关系,通过如下方法确定:设置初始时刻的主操作手末端点在所述用户坐标系下的位姿矩阵T
M0
,计算得到初始时刻的所述发射端平台的动平台的坐标系在所述用户坐标系下的位姿矩阵根据所述初始时刻的主操作手末端点在所述用户坐标系下的位姿矩阵T
M0
,计算得到单位周期后的所述主操作手末端点在所述用户坐标系下的位姿矩阵T
Mt
;将所述主操作手的平移运动用预设的位移比例系数缩放,以及,将所述主操作手的旋转角度按照指定比例映射至所述发射端的动平台上,得到所述主操作手和所述发射端平台的映射矩阵T
Map
。7.根据权利要求6所述的方法,其特征在于,所述根据预先计算得到的所述主操作手和
所述发射端平台的映射关系,解算所述发射端平台的运动位姿,包括:将所述单位周期后的所述主操作手末端点在所述用户坐标系下的位姿矩阵乘以所述映射矩阵T
Map
【专利技术属性】
技术研发人员:潘鲁锋,柳建飞,胡润晨,周高峰,
申请(专利权)人:诺创智能医疗科技杭州有限公司,
类型:发明
国别省市:
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。