手术机器人末端姿态调整方法、系统、设备和介质与流程

1.本技术涉及机器人控制技术领域，特别是涉及一种手术机器人末端姿态调整方法、系统、设备和介质。


背景技术：

2.随着现代化医疗技术的发展，机器人也广泛应用于各种医疗手术中，如各种微创手术、内窥镜手术或者活检采样手术中等。在活检采样手术中，由于体内采样区域被皮肤包裹，医护人员需要通过穿刺技术进行采样，即通过手术机器人将针插入人体，并到达病灶位置。
3.在传统方式中，手术机器人的姿态调整针对手术机器人的机械结构进行单自由度的闭环调整。由于手术机器人的机械结构必然存在的系统误差，在多次姿态调整后，误差会累计到最终的姿态上，使得最终得到的手术机器人的穿刺姿态的精度不高，影响手术操作的准确性。


技术实现要素：

4.基于此，有必要针对上述技术问题，提供一种提升手术机器人的姿态调整准确性的手术机器人末端姿态调整方法、系统、设备和介质。
5.一种手术机器人末端姿态调整方法，所述方法包括：
6.获取手术机器人执行末端的姿态数据；
7.基于所述姿态数据与所述手术机器人执行末端的目标姿态数据，确定对所述手术机器人执行末端进行调整的调整指令，所述调整指令对控制所述手术机器人执行末端的姿态的机械部件的至少一个自由度进行调整，以调整所述手术机器人执行末端的姿态。
8.在其中一个实施例中，所述基于所述姿态数据与所述手术机器人执行末端的目标姿态数据，确定对所述手术机器人执行末端进行调整的调整指令，包括：
9.对所述姿态数据和所述目标姿态数据进行求差，得到对应的差值数据；
10.将所述差值数据转换为对所述手术机器人执行末端进行调整的调整指令。
11.在其中一个实施例中，所述将所述差值数据转换为对所述手术机器人执行末端进行调整的调整指令，包括：
12.对所述差值数据进行比例和/或积分和/或微分转换，生成对应的调整指令。
13.在其中一个实施例中，所述姿态数据包括所述手术机器人执行末端的滚角和/或俯仰角，所述目标姿态数据包括目标滚角和/或目标俯仰角。
14.在其中一个实施例中，所述调整指令为用于驱动电机运行的驱动指令，所述驱动指令驱动所述电机进行运转，以对控制所述手术机器人执行末端的姿态的机械部件的至少一个自由度进行调整。
15.在其中一个实施例中，所述姿态数据基于对获取到的手术机器人执行末端的加速度数据和/或角速度数据和/或磁场数据进行混合姿态计算生成。
16.在其中一个实施例中，所述目标姿态数据基于扫描数据规划的手术操作路径确定。
17.在其中一个实施例中，基于所述姿态数据与所述手术机器人执行末端的目标姿态数据，确定对所述手术机器人执行末端进行调整的调整指令，包括：
18.获取所述手术机器人执行末端的两个目标姿态数据；
19.分别根据所述姿态数据与两个所述目标姿态数据，确定对所述手术机器人执行末端进行调整的两个调整指令，通过两个所述调整指令在两个闭环内调整所述手术机器人执行末端的姿态，所述两个闭环中对所述手术机器人执行末端进行调整的调整指令还基于所述手术机器人的关节结构的误差生成。
20.一种手术机器人系统，所述系统包括：存储器、处理器、机器人控制模块以及手术机器人执行末端；
21.所述存储器存储有计算机程序，所述处理器在执行所述计算机程序时实现上述任意一个实施例中所述的调整方法的步骤，输出调整指令；
22.所述机器人控制模块用于基于所述调整指令对控制所述手术机器人执行末端的姿态的机械部件的至少一个自由度进行调整。
23.在其中一个实施例中，所述机器人控制模块包括电机驱动器以及电机；
24.所述电机驱动器用于根据所述控制指令驱动所述电机的运转；
25.所述电机用于控制所述手术机器人执行末端的机械部件的至少一个自由度进行调整，以对所述手术机器人执行末端的姿态进行调整。
26.在其中一个实施例中，所述机器人控制模块包括用于调整姿态的两个电机；所述电机分别位于两个闭环中，用于控制所述手术机器人执行末端的机械部件的一个自由度进行调整，以对所述手术机器人执行末端的姿态进行调整，所述两个闭环中对所述手术机器人执行末端进行调整的调整指令还基于所述手术机器人的关节结构的误差生成。
27.在其中一个实施例中，所述系统还包括：
28.姿态检测模块，用于对所述手术机器人执行末端的姿态进行检测，得到姿态数据，并反馈至所述存储器。
29.在其中一个实施例中，所述姿态检测模块包括：
30.三轴加速度传感器和三轴角速度传感器组成的六轴传感器；或者三轴磁场传感器、三轴加速度传感器以及三轴角速度传感器组成的九轴传感器。
31.一种计算机设备，包括存储器和处理器，所述存储器存储有计算机程序，所述处理器执行所述计算机程序时实现上述任意一个实施例中所述方法的步骤。
32.一种计算机可读存储介质，其上存储有计算机程序，所述计算机程序被处理器执行时实现上述任意一个实施例中所述的方法的步骤。
33.一种计算机程序产品，包括计算机程序，该计算机程序被处理器执行时实现上述任意一个实施例中的方法的步骤。
34.上述手术机器人末端姿态调整方法、系统、设备和介质中，通过获取手术机器人执行末端的姿态数据，然后基于姿态数据与手术机器人执行末端的目标姿态数据，确定对手术机器人执行末端进行调整的调整指令，所述调整指令对控制手术机器人执行末端的姿态的机械部件的至少一个自由度进行调整，以调整手术机器人执行末端的姿态。其中，根据姿
态数据和目标姿态数据闭环对手术机器人执行末端的姿态进行调整，从而，获取的手术机器人执行末端的姿态数据中可以包括手术机器人的机械部件的整体误差，在基于生成的调整指令对控制手术机器人执行末端的姿态的机械部件的至少一个自由度进行调整的时候，实质是对手术机器人的机械部件的整体误差进行的调整，相比于传统方式中对各自由度进行闭环调整，本技术方案可以提升手术机器人执行末端的姿态调整的准确性，进而可以提升后续手术操作的准确性。
附图说明
35.图1为一个实施例中手术机器人系统的示意图；
36.图2为另一个实施例中手术机器人系统的示意图；
37.图3为又一个实施例中手术机器人系统的示意图；
38.图4为再一个实施例中手术机器人系统的示意图；
39.图5为一个实施例中手术机器人执行末端自由度的示意图；
40.图6为另一个实施例中手术机器人执行末端自由度的示意图；
41.图7为一个实施例中手术机器人执行末端的示意图；
42.图8为一个实施例中穿刺机器人应用场景的示意图；
43.图9为一个实施例中姿态传感器的坐标与穿刺针坐标之间关系的示意图；
44.图10为一个实施例中姿态传感器的结构示意图；
45.图11为一个实施例中手术机器人执行末端姿态调整的示意图；
46.图12为一个实施例中手术机器人执行末端姿态调整后的示意图；
47.图13为一个实施例中手术机器人系统闭环回路的示意图；
48.图14为一个实施例中手术机器人末端姿态调整方法的流程示意图；
49.图15为一个实施例中pid运算过程的示意图；
50.图16为另一个实施例中pid运算过程的示意图；
51.图17为一个实施例中姿态数据融合过程的示意图；
52.图18为一个实施例中一阶互补算法的示意图；
53.图19为一个实施例中手术机器人执行手术过程的示意图；
54.图20为一个实施例中手术机器人末端姿态调整装置的结构框图；
55.图21为一个实施例中计算机设备的内部结构图。
具体实施方式
56.为了使本技术的目的、技术方案及优点更加清楚明白，以下结合附图及实施例，对本技术进行进一步详细说明。应当理解，此处描述的具体实施例仅仅用以解释本技术，并不用于限定本技术。
57.本技术提供的手术机器人末端姿态调整方法，可以应用于如图1所示的应用环境中，即应用于手术机器人系统中。其中，手术机器人系统包括存储器101、处理器102、机器人控制模块103以及手术机器人执行末端104。存储器101存储有计算机程序，处理器102在执行存储器101存储的计算机程序时实现手术机器人末端姿态调整方法的步骤，输出调整指令，即获取手术机器人执行末端104的姿态数据，然后基于姿态数据与手术机器人执行末端
104的目标姿态数据，确定对手术机器人执行末端104进行调整的调整指令。具体手术机器人末端姿态调整方法的说明书后文将进行详细说明。
58.进一步，机器人控制模块103基于调整指令对控制手术机器人执行末端104的姿态的机械部件的至少一个自由度进行调整。
59.在本实施例中，存储器101和处理器102可以通过服务器实现，如单个的服务器或者是服务器集群等。
60.图2和图3分别示出了另一种手术机器人系统，在图2所示实施例中，存储器与处理器可以通过电脑等控制终端实现，在图3所示实施例中，存储器与处理器可以通过微控制器实现。
61.在其中一个实施例中，参考图2或图3，机器人控制模块103可以是电机系统，具体可以包括电机驱动器以及电机。
62.其中，电机驱动器用于根据控制指令驱动电机的运转。电机用于控制手术机器人执行末端的机械部件的至少一个自由度进行调整，以对手术机器人执行末端的姿态进行调整。
63.例如，如图4所示，示出了另一种手术机器人系统的示意图。在本实施例中，手术机器人系统可以包括：运算机构(即前文所述的电脑或者是微控制器等)、电机系统(即前文所述的电机驱动器和电机)、手术机器人结构体(即包括机械部件的手术机器人执行末端)。
64.在本实施例中，参考图4，运算机构可以电机系统运动，以控制机器人结构体进行运动，进而改变手术机器人执行末端的姿态。
65.图5示出了一种手术机器人执行末端自由度的示意图，手术机器人执行末端可以包括x、y、z三个自由度。图6示出了另一种手术机器人执行末端自由度的示意图，包括x、y、z三个自由度，以及水平自由度和垂直自由度。
66.在本实施例中，z自由度、水平自由度和垂直自由度对手术机器人执行末端的位置变化进行控制，即参考图6，1自由度控制手术机器人执行末端的水平移动，即水平方向的前进和后退，2自由度用于控制手术机器人执行末端的垂直移动，即垂直方向上的上升和下降，3自由度用于控制手术机器人执行末端绕z进行旋转。而x、y自由度对机器人执行末端的姿态进行控制，即图6中，4自由度用于控制手术机器人执行末端绕x进行旋转，5自由度用于控制手术机器人执行末端绕y进行旋转。
67.图7示出了一种手术机器人执行末端的示意图。在本实施例中，手术机器人可以是指穿刺机器人，手术机器人执行末端上装载有持针器，持针器上夹持有穿刺针。图8示出了穿刺机器人应用场景的示意图，穿刺手术一般在ct房进行，病人需要躺在ct床上，手术机器人在床边，通过手术机器人系统控制手术机器人执行末端到达指定位置及指定姿态。
68.在本实施例中，继续参考图7，电机驱动器可以通过驱动电机701以及电机702运转，以实现对手术机器人执行末端的机械部件的至少一个自由度进行调整，即对4自由度和/或5自由度进行调整，以实现对手术机器人执行末端的姿态的调整。
69.在其中一个实施例中，上述手术机器人系统还可以包括：姿态检测模块，用于对手术机器人执行末端的姿态进行检测，得到姿态数据，并反馈至存储器。
70.在本实施例中，继续参考图2、图3或图4，姿态检测模块可以是指姿态传感器，继续参考图7，姿态传感器可以安装于机器人执行末端的持针器上。
71.图9示出了一种姿态传感器的坐标与穿刺针坐标之间的关系。在本实施例中，x1、y1、z1为姿态传感器的坐标系，x2、y2、z2为穿刺针的坐标系。穿刺针的z轴定义在沿穿刺针的方向上，y定义为机器人的机械臂方向，x方向定义为垂直针和机械臂方向。姿态传感器的z轴与穿刺针z轴方向一致，即z1与z2；姿态传感器的x轴与穿刺针x轴方向一致，即x1与x2；姿态传感器的y轴与穿刺针y轴方向一致，即y1与y2。
72.在本实施例中，由于穿刺针的姿态没有绕z轴的旋转姿态，因此，手术机器人执行末端的姿态的焦点的自由度只有绕x与绕y两个，即前文所述的x自由度以及y自由度。其中，绕x轴为滚角，绕y轴为俯仰角。
73.在本实施例中，通过在手术机器人设计上，使姿态传感器的坐标系与穿刺针的坐标系在姿态上一致，从而基于获取到的姿态传感器的姿态数据，即可确定穿刺针的姿态数据，即手术机器人执行末端的姿态数据。
74.在其中一个实施例中，姿态检测模块可以包括：三轴加速度传感器和三轴角速度传感器组成的六轴传感器；或者三轴磁场传感器、三轴加速度传感器以及三轴角速度传感器组成的九轴传感器。
75.其中，三轴加速度传感器用于对手术机器人执行末端的三个坐标轴上的加速度进行检测，三轴角速度传感器用于对手术机器人执行末端的三个坐标轴上的角速度进行检测，三轴磁场传感器用于对手术机器人执行末端的三个坐标轴上的磁场或与磁场相关的信息进行检测。
76.在本实施例中，安装于手术机器人执行末端的姿态检测模块可以是三轴加速度传感器和三轴角速度传感器组成的六轴传感器，或者是三轴磁场传感器、三轴加速度传感器以及三轴角速度传感器组成的九轴传感器，本技术对此不做限制。
77.图10示出了一种姿态传感器的结构示意图，可以包括微控制单元(microcontroller unit，mcu)以及三轴磁场传感器、三轴加速度传感器和三轴角速度传感器。如前文所述，三轴磁场传感器、三轴加速度传感器和三轴角速度传感器可以分别用于采集加速度、角速度以及磁场信息。mcu可以对采集得到的加速度、角速度、磁场信息进行混合姿态计算，以得到姿态数据，并反馈至存储器，并用于进行姿态调整计算。
78.图11示出了一种手术机器人执行末端姿态调整的示意图。其中，111为姿态调整前，112为姿态调整后，通过本方案可以实现对手术机器人的机械部件的整体误差进行的调整，提升姿态调整的准确性。
79.图12示出了一种手术机器人执行末端姿态调整后的示意图。在本实施例中，通过姿态调节，可以达到穿刺针(手术机器人执行末端)的姿态与入针点与病灶点连线的穿刺路径一致，提升手术操作的准确性。
80.继续参考图4，如前文所述手术机器人系统运算机构、电机系统、手术机器人结构体以及姿态传感器。在本实施例中，运算机构可以基于姿态传感器反馈的姿态数据，进行运算，并将计算结果转换为控制命令，发送至电机系统，以使得通过电机系统执行动作，经过电机系统控制手术机器人结构体的改变，以实现手术机器人执行末端的姿态调整。姿态传感器测量手术机器人结构体当前所处的姿态信息，并将信息反馈给运算机构，完成手术机器人系统闭环控制与调整。
81.图13示出了一种手术机器人系统闭环回路的示意图。在本实施例中，通过将姿态
传感器安装于手术机器人执行末端上，将形成的两个闭环，从而可以将手术机器人执行末端的机械部件(关节结构)的误差也包含进闭环内，从而通过闭环的调整，可以将机械部件的误差一并校准，提升了对手术机器人执行末端的姿态调整的准确性，进而可以提升后续手术操作的准确性。
82.其中，机器人控制模块包括用于调整姿态的两个电机；电机分别位于两个闭环中，用于控制手术机器人执行末端的机械部件的一个自由度进行调整，以对手术机器人执行末端的姿态进行调整，两个闭环中对手术机器人执行末端进行调整的调整指令还基于手术机器人的关节结构的误差生成。
83.具体地，两个闭环分别是指对滚角和俯仰角的调整，其中获取到手术机器人末端的姿态数据，该姿态数据包括当前视角和当前俯仰角，然后基于目标视角对当前视角进行闭环控制，基于目标俯仰角对当前俯仰角进行闭环控制。
84.在一个实施例中，如图14所示，提供了一种手术机器人末端姿态调整方法，以该方法应用于前文所述的手术机器人系统为例进行说明，包括以下步骤：
85.步骤s142，获取手术机器人执行末端的姿态数据。
86.其中，姿态数据是指手机器人执行末端的末端姿态。以前文所述的穿刺机器人为例，姿态数据可以是手术机器人执行末端上夹持的穿刺针的姿态数据。
87.在本实施例中，手术机器人执行末端的姿态数据通过安装于手术执行人执行末端的传感器采集，如前文所述的，通过姿态传感器进行采集，并发送至服务器，使得服务器可以获取到姿态数据。
88.步骤s144，基于姿态数据与手术机器人执行末端的目标姿态数据，确定对手术机器人执行末端进行调整的调整指令，调整指令对控制手术机器人执行末端的姿态的机械部件的至少一个自由度进行调整，以调整手术机器人执行末端的姿态。
89.其中，目标姿态数据是指手术机器人执行末端在进行调整后，所期望达到的最终姿态，是进行穿刺手术的初始姿态。
90.在本实施例中，服务器可以预先设置手术机器人执行末端的目标姿态数据，在采集到手术机器人执行末端的姿态数据后，通过对二者进行比较判定，以确定二者姿态是否一致，在确定不一致时，基于姿态数据以及目标姿态数据，确定对手术机器人执行末端进行调整的调整指令，并发送至手术机器人，以对控制手术机器人执行末端的姿态的机械部件的至少一个自由度进行调整，以调整手术机器人执行末端的姿态。具体地调整过程可以参照前文所述，此处不再赘述。
91.上述手术机器人末端姿态调整方法中，通过获取手术机器人执行末端的姿态数据，然后基于姿态数据与手术机器人执行末端的目标姿态数据，确定对手术机器人执行末端进行调整的调整指令，所述调整指令对控制手术机器人执行末端的姿态的机械部件的至少一个自由度进行调整，以调整手术机器人执行末端的姿态。其中，根据姿态数据和目标姿态数据闭环对手术机器人执行末端的姿态进行调整，从而，获取的手术机器人执行末端的姿态数据中可以包括手术机器人的机械部件的整体误差，在基于生成的调整指令对控制手术机器人执行末端的姿态的机械部件的至少一个自由度进行调整的时候，实质是对手术机器人的机械部件的整体误差进行的调整，相比于传统方式中对各自由度进行闭环调整，本技术方案可以提升手术机器人执行末端的姿态调整的准确性，进而可以提升后续手术操作
的准确性。
92.在其中一个实施例中，基于姿态数据与手术机器人执行末端的目标姿态数据，确定对手术机器人执行末端进行调整的调整指令，可以包括：对姿态数据和目标姿态数据进行求差，得到对应的差值数据；将差值数据转换为对手术机器人执行末端进行调整的调整指令。
93.在本实施例中，服务器在得到姿态数据和目标姿态数据后，可以对姿态数据与目标姿态数据进行求差，得到对应的差值数据，即姿态差。
94.进一步，服务器可以通过对得到的差值数据进行转换处理，以得到用于对手术机器人执行末端进行调整的调整指令，即用于驱动手术机器人执行末端的机械部件进行调整的调整指令。
95.在其中一个实施例中，姿态数据可以包括手术机器人执行末端的滚角和/或俯仰角，目标姿态数据可以包括目标滚角和/或目标俯仰角。
96.具体地，基于姿态数据与手术机器人执行末端的目标姿态数据，确定对手术机器人执行末端进行调整的调整指令，包括：获取手术机器人执行末端的两个目标姿态数据；分别根据姿态数据与两个目标姿态数据，确定对手术机器人执行末端进行调整的两个调整指令，通过两个调整指令在两个闭环内调整手术机器人执行末端的姿态，两个闭环中对手术机器人执行末端进行调整的调整指令还基于手术机器人的关节结构的误差生成。
97.在本实施例中，以穿刺机器人为例，服务器基于姿态传感器采集到的姿态数据可以包括对应于x轴滚角以及对应于y轴的俯仰角。
98.在本实施例中，服务器可以分别姿态数据中的俯仰角与目标俯仰角进行求差，以及对滚角与目标滚角进行求差计算，以得到对应角度差，进而在基于角度差进行生成对应的调整指令。
99.在其中一个实施例中，将差值数据转换为对手术机器人执行末端进行调整的调整指令，可以包括：对差值数据进行比例和/或积分和/或微分转换，生成对应的调整指令。
100.在本实施例中，参考图15，服务器在进行差值数据转换的时候，可以通过使用pid算法进行转换，即服务器可以通过pid算法对基于姿态传感器采集到的姿态数据与目标姿态数据之间的差值数据进行比例和/或积分和/或微分转换，生成对应的调整指令。
101.在本实施例中，服务器对手术机器人执行末端进行姿态调整的过程可以是闭环循环调整的过程，姿态传感器采集到当前手术机器人执行末端的姿态数据后，服务器执行pid算法电机调整姿态，并基于姿态传感器反馈的姿态数据，继续进行计算与调整。
102.在本实施例中，如前文所述，姿态数据包括滚角和俯仰角，目标姿态数据包括目标滚角与目标俯仰角，服务器可以通过对滚角和俯仰角分别进行计算，并分别通过pid运算后得到一个调节指令，并进行手术机器人执行末端的姿态的调整。
103.在本实施例中，参考图16，示出了一种pid运算过程的示意图，具体包括如下步骤：
104.首先，服务器可以将目标角度和姿态传感器所提供的测量角度做差处理，得到角度差δr。
105.如前文所述，服务器可以分别将滚角与目标滚角做差，将俯仰角与目标俯仰角做差，以得到滚角差和俯仰角差。
106.进一步，服务器可以将角度差转换成调节参数，调节参数代表了电机运动的速度。
107.具体地，服务器可以通过如下公式(1)进行调节参数的计算。
[0108][0109]
其中，k
p
比例调节常数，ki积分调节常数，kd微分调节常数，δr角度差，t为姿态传感器采样周期，m为调节参数。
[0110]
在本实施例中，调节参数有正负，正数可以代表电机正转，负数就代表电机反转。调节参数会传递给电机驱动器。
[0111]
进一步，驱动器可以根据调节参数调节占空比，调节参数的绝对值越大，占空比越大，电机转动越快，反之调节参数绝对值越小，占空比越小，电机转动越慢。
[0112]
在本实施例中，调节参数的正负在驱动器里解析为电机运转的方向。通过电机的转动调节了手术机器人执行末端的姿态。
[0113]
进一步，姿态传感器重新测量姿态数据并进行反馈，以继续进行计算与调整处理。
[0114]
在其中一个实施例中，姿态数据基于对获取到的手术机器人执行末端的加速度数据和/或角速度数据和/或磁场数据进行混合姿态计算生成。
[0115]
如前文所述，三轴加速度传感器和三轴角速度传感器组成的六轴传感器；或者三轴磁场传感器、三轴加速度传感器以及三轴角速度传感器组成的九轴传感器。姿态传感器可以采集到加速度、角速度以及磁场等数据。
[0116]
在本实施例中，姿态数据可以基于获取到的加速度、角速度以及磁场等数据等生成。
[0117]
参考图17，示出了一种姿态数据融合过程的示意图。具体地，姿态传感器采集到的数据可以包括三轴磁场数据(m
x
，my，mz)、三轴加速度数据(a
x
，ay，az)以及三轴角速度数据(v
x
，vy，vz)。
[0118]
进一步，姿态传感器可以通过四元素法/卡尔曼滤波法/一阶互补算法，将获取到的三轴磁场数据(m
x
，my，mz)、三轴加速度数据(a
x
，ay，az)以及三轴角速度数据(v
x
，vy，vz)转换成欧拉角(滚角、俯仰角、旋转角)并输出，以得到姿态数据。
[0119]
在其中一个实施例中，如前文所述，姿态传感器由6轴与9轴之分，姿态传感器可以对获取到的加速度、角速度，或者是加速度、角速度以及磁场等数据进行混合处理，以得到姿态数据。以下结合图18，通过6轴姿态传感器(三轴加速度和三轴角速度)的数据融合进行说明。
[0120]
具体地，参考图18，数据融合采用的是一阶互补算法，计算x轴角度(滚角)的过程。算法设定了加速度权重k1，采样周期为dt。采集到加速度数据(a
x
，ay，az)和角速度数据(v
x
，vy，vz)后，可分别通过加速度数据与角速度数据各计算一个x轴角度值x1与x2。其中，通过加速度数据计算x轴角度x1＝atan(a
x
/az)，通过角速度计算x轴角度x2＝pitch0 ∫vydt，pitch0为初始通过加速度计算的角度，姿态传感器可以通过公式xreal＝k1*x1 (1-k1)*x2进行计算，得到较准确的角度值。
[0121]
在其中一个实施例中，调整指令为用于驱动电机运行的驱动指令，驱动指令驱动电机进行运转，以对控制手术机器人执行末端的姿态的机械部件的至少一个自由度进行调整。
[0122]
在本实施例中，服务器通过pid运算后得到一个调节指令后，可以将调节指令可以
转换为驱动电机运行的电机驱动器的驱动指令，电机驱动器会根据驱动指令调节驱动电机的电压，从而调节电机的运动，以实现对手术机器人执行末端的姿态的机械部件的自由度的改变。
[0123]
在其中一个实施例中，目标姿态数据基于扫描数据规划的手术操作路径确定。
[0124]
如前文所述，本方案方法可以应用于穿刺手术中。在本实施例中，手术机器人执行末端的目标姿态数据可以基于手术操作路径确定，手术操作路径可以基于扫描数据规划生成。
[0125]
图19示出了一种手术机器人执行手术过程的示意图，以下对图19处理过程进行详细说明。
[0126]
在本实施例中，服务器可以通过扫描装置对病人进行扫描，以得到对应的扫描数据，如通过ct(computed tomography，电子计算机断层扫描)扫描获取到ct扫描数据。
[0127]
在本实施例中，参考图8，ct在进行扫描的时候，其可以是与手术机器人同时进行的扫描，则服务器可以基于获取到的扫描数据，确定手术机器人执行末端与病人或者是病灶之间的位置关系。
[0128]
进一步，服务器可以基于确定的位置关系，进行手术路径的规划，手术规划路径，如穿刺路径等。如图12所示，穿刺路径可以包括入针点等，服务器可以根据入针点以及规划的手术路径，确定对应手术机器人执行末端的末端姿态。
[0129]
进一步，服务器可以通过前文所述的方法进行调整指令的处理，并进行手术机器人执行默算姿态的调整，使得调整后的姿态符合目标姿态数据。
[0130]
在本实施例中，在进行手术机器人执行末端的姿态调整的时候，可以同时对手术机器人执行末端的位置进行调整，如将刺穿针的位置调整至入针点等。
[0131]
进一步，医生可以基于规划的手术路径以及调整后的姿态，执行手术过程。
[0132]
在本实施例中，服务器可以通过ct确定手术过程，如通过ct扫描确认穿刺结果，并进行取样，直至完成手术过程。
[0133]
应该理解的是，虽然图14的流程图中的各个步骤按照箭头的指示依次显示，但是这些步骤并不是必然按照箭头指示的顺序依次执行。除非本文中有明确的说明，这些步骤的执行并没有严格的顺序限制，这些步骤可以以其它的顺序执行。而且，图14中的至少一部分步骤可以包括多个子步骤或者多个阶段，这些子步骤或者阶段并不必然是在同一时刻执行完成，而是可以在不同的时刻执行，这些子步骤或者阶段的执行顺序也不必然是依次进行，而是可以与其它步骤或者其它步骤的子步骤或者阶段的至少一部分轮流或者交替地执行。
[0134]
在一个实施例中，如图20所示，提供了一种手术机器人末端姿态调整装置，包括：姿态数据获取模块100以及调整模块200，其中：
[0135]
姿态数据获取模块100，用于获取手术机器人执行末端的姿态数据。
[0136]
调整模块200，用于基于姿态数据与手术机器人执行末端的目标姿态数据，确定对手术机器人执行末端进行调整的调整指令，调整指令对控制手术机器人执行末端的姿态的机械部件的至少一个自由度进行调整，以调整手术机器人执行末端的姿态。
[0137]
在其中一个实施例中，姿态数据基于对获取到的手术机器人执行末端的加速度数据和/或角速度数据和/或磁场数据进行混合姿态计算生成。
[0138]
在其中一个实施例中，姿态数据包括手术机器人执行末端的滚角和/或俯仰角，目标姿态数据包括目标滚角和/或目标俯仰角。
[0139]
在其中一个实施例中，调整模块200，可以包括：
[0140]
差值子模块，用于对姿态数据和目标姿态数据进行求差，得到对应的差值数据。
[0141]
转换子模块，用于将差值数据转换为对手术机器人执行末端进行调整的调整指令。
[0142]
在其中一个实施例中，转换子模块用于对差值数据进行比例和/或积分和/或微分转换，生成对应的调整指令。
[0143]
在其中一个实施例中，调整指令为用于驱动电机运行的驱动指令，驱动指令驱动电机进行运转，以对控制手术机器人执行末端的姿态的机械部件的至少一个自由度进行调整。
[0144]
在其中一个实施例中，目标姿态数据基于扫描数据规划的手术操作路径确定。
[0145]
在其中一个实施例中，调整模块还用于获取所述手术机器人执行末端的两个目标姿态数据；分别根据所述姿态数据与两个所述目标姿态数据，确定对所述手术机器人执行末端进行调整的两个调整指令，通过两个所述调整指令在两个闭环内调整所述手术机器人执行末端的姿态，所述两个闭环中对所述手术机器人执行末端进行调整的调整指令还基于所述手术机器人的关节结构的误差生成。
[0146]
关于手术机器人末端姿态调整装置的具体限定可以参见上文中对于手术机器人末端姿态调整方法的限定，在此不再赘述。上述手术机器人末端姿态调整装置中的各个模块可全部或部分通过软件、硬件及其组合来实现。上述各模块可以硬件形式内嵌于或独立于计算机设备中的处理器中，也可以以软件形式存储于计算机设备中的存储器中，以便于处理器调用执行以上各个模块对应的操作。
[0147]
在一个实施例中，提供了一种计算机设备，该计算机设备可以是服务器，其内部结构图可以如图21所示。该计算机设备包括通过系统总线连接的处理器、存储器、网络接口和数据库。其中，该计算机设备的处理器用于提供计算和控制能力。该计算机设备的存储器包括非易失性存储介质、内存储器。该非易失性存储介质存储有操作系统、计算机程序和数据库。该内存储器为非易失性存储介质中的操作系统和计算机程序的运行提供环境。该计算机设备的数据库用于存储姿态数据、目标姿态数据以及调整指令等数据。该计算机设备的网络接口用于与外部的终端通过网络连接通信。该计算机程序被处理器执行时以实现一种手术机器人末端姿态调整方法。
[0148]
本领域技术人员可以理解，图21中示出的结构，仅仅是与本技术方案相关的部分结构的框图，并不构成对本技术方案所应用于其上的计算机设备的限定，具体的计算机设备可以包括比图中所示更多或更少的部件，或者组合某些部件，或者具有不同的部件布置。
[0149]
在一个实施例中，提供了一种计算机设备，包括存储器和处理器，该存储器存储有计算机程序，该处理器执行计算机程序时实现以下步骤：获取手术机器人执行末端的姿态数据；基于姿态数据与手术机器人执行末端的目标姿态数据，确定对手术机器人执行末端进行调整的调整指令，调整指令对控制手术机器人执行末端的姿态的机械部件的至少一个自由度进行调整，以调整手术机器人执行末端的姿态。
[0150]
在其中一个实施例中，姿态数据基于对获取到的手术机器人执行末端的加速度数
据和/或角速度数据和/或磁场数据进行混合姿态计算生成。
[0151]
在其中一个实施例中，姿态数据包括手术机器人执行末端的滚角和/或俯仰角，目标姿态数据包括目标滚角和/或目标俯仰角。
[0152]
在其中一个实施例中，处理器执行计算机程序时实现基于姿态数据与手术机器人执行末端的目标姿态数据，确定对手术机器人执行末端进行调整的调整指令，可以包括：对姿态数据和目标姿态数据进行求差，得到对应的差值数据；将差值数据转换为对手术机器人执行末端进行调整的调整指令。
[0153]
在其中一个实施例中，处理器执行计算机程序时实现将差值数据转换为对手术机器人执行末端进行调整的调整指令，可以包括：对差值数据进行比例和/或积分和/或微分转换，生成对应的调整指令。
[0154]
在其中一个实施例中，调整指令为用于驱动电机运行的驱动指令，驱动指令驱动电机进行运转，以对控制手术机器人执行末端的姿态的机械部件的至少一个自由度进行调整。
[0155]
在其中一个实施例中，目标姿态数据基于扫描数据规划的手术操作路径确定。
[0156]
在其中一个实施例中，处理器执行计算机程序时所实现的基于所述姿态数据与所述手术机器人执行末端的目标姿态数据，确定对所述手术机器人执行末端进行调整的调整指令，包括：获取所述手术机器人执行末端的两个目标姿态数据；分别根据所述姿态数据与两个所述目标姿态数据，确定对所述手术机器人执行末端进行调整的两个调整指令，通过两个所述调整指令在两个闭环内调整所述手术机器人执行末端的姿态，所述两个闭环中对所述手术机器人执行末端进行调整的调整指令还基于所述手术机器人的关节结构的误差生成。
[0157]
在一个实施例中，提供了一种计算机可读存储介质，其上存储有计算机程序，计算机程序被处理器执行时实现以下步骤：获取手术机器人执行末端的姿态数据；基于姿态数据与手术机器人执行末端的目标姿态数据，确定对手术机器人执行末端进行调整的调整指令，调整指令对控制手术机器人执行末端的姿态的机械部件的至少一个自由度进行调整，以调整手术机器人执行末端的姿态。
[0158]
在其中一个实施例中，姿态数据基于对获取到的手术机器人执行末端的加速度数据和/或角速度数据和/或磁场数据进行混合姿态计算生成。
[0159]
在其中一个实施例中，姿态数据包括手术机器人执行末端的滚角和/或俯仰角，目标姿态数据包括目标滚角和/或目标俯仰角。
[0160]
在其中一个实施例中，计算机程序被处理器执行时实现基于姿态数据与手术机器人执行末端的目标姿态数据，确定对手术机器人执行末端进行调整的调整指令，可以包括：对姿态数据和目标姿态数据进行求差，得到对应的差值数据；将差值数据转换为对手术机器人执行末端进行调整的调整指令。
[0161]
在其中一个实施例中，计算机程序被处理器执行时实现将差值数据转换为对手术机器人执行末端进行调整的调整指令，可以包括：对差值数据进行比例和/或积分和/或微分转换，生成对应的调整指令。
[0162]
在其中一个实施例中，调整指令为用于驱动电机运行的驱动指令，驱动指令驱动电机进行运转，以对控制手术机器人执行末端的姿态的机械部件的至少一个自由度进行调
整。
[0163]
在其中一个实施例中，目标姿态数据基于扫描数据规划的手术操作路径确定。
[0164]
在其中一个实施例中，计算机程序被处理器执行时所实现的基于所述姿态数据与所述手术机器人执行末端的目标姿态数据，确定对所述手术机器人执行末端进行调整的调整指令，包括：获取所述手术机器人执行末端的两个目标姿态数据；分别根据所述姿态数据与两个所述目标姿态数据，确定对所述手术机器人执行末端进行调整的两个调整指令，通过两个所述调整指令在两个闭环内调整所述手术机器人执行末端的姿态，所述两个闭环中对所述手术机器人执行末端进行调整的调整指令还基于所述手术机器人的关节结构的误差生成。
[0165]
一种计算机程序产品，包括计算机程序，其特征在于，该计算机程序被处理器执行时实现上述任意一个实施例中所述的方法的步骤。
[0166]
本领域普通技术人员可以理解实现上述实施例方法中的全部或部分流程，是可以通过计算机程序来指令相关的硬件来完成，所述的计算机程序可存储于一非易失性计算机可读取存储介质中，该计算机程序在执行时，可包括如上述各方法的实施例的流程。其中，本技术所提供的各实施例中所使用的对存储器、存储、数据库或其它介质的任何引用，均可包括非易失性和/或易失性存储器。非易失性存储器可包括只读存储器(rom)、可编程rom(prom)、电可编程rom(eprom)、电可擦除可编程rom(eeprom)或闪存。易失性存储器可包括随机存取存储器(ram)或者外部高速缓冲存储器。作为说明而非局限，ram以多种形式可得，诸如静态ram(sram)、动态ram(dram)、同步dram(sdram)、双数据率sdram(ddrsdram)、增强型sdram(esdram)、同步链路(synchlink)dram(sldram)、存储器总线(rambus)直接ram(rdram)、直接存储器总线动态ram(drdram)、以及存储器总线动态ram(rdram)等。
[0167]
以上实施例的各技术特征可以进行任意的组合，为使描述简洁，未对上述实施例中的各个技术特征所有可能的组合都进行描述，然而，只要这些技术特征的组合不存在矛盾，都应当认为是本说明书记载的范围。
[0168]
以上所述实施例仅表达了本技术的几种实施方式，其描述较为具体和详细，但并不能因此而理解为对发明专利范围的限制。应当指出的是，对于本领域的普通技术人员来说，在不脱离本技术构思的前提下，还可以做出若干变形和改进，这些都属于本技术的保护范围。因此，本技术专利的保护范围应以所附权利要求为准。