操作臂的控制方法和手术机器人系统

技术领域

本公开属于控制技术领域，尤其涉及一种操作臂的控制方法和手术机器人系统。

背景技术

随着技术的发展，由人工或者计算机控制相关机器设备执行期望的动作以辅助或者替代操作人员变得越来越普及。例如，使用物流机器人进行快递的分拣，使用手术机器人辅助医生执行手术等。

上述应用中，需要对操作臂进行控制，从而实现机器设备的控制。

发明内容

在一些实施例中，本公开提供一种操作臂的控制方法，包括：获取定位图像；在定位图像中，识别位于操作臂上的多个位姿标识，多个位姿标识包括不同的位姿标识图案；基于多个位姿标识，确定操作臂相对参考坐标系的当前相对位姿；以及基于当前相对位姿和操作臂的目标位姿，确定操作臂的驱动信号。

在一些实施例中，本公开提供了一种计算机设备，计算机设备包括：存储器，用于存储有至少一条指令；以及处理器，与存储器耦合，用于执行至少一条指令以执行本公开一些实施例中任一项的控制方法。

在一些实施例中，本公开提供了一种计算机可读存储介质，存储介质中存储有至少一条指令，至少一条指令由处理器执行以使计算机执行本公开一些实施例中任一项的控制方法。

在一些实施例中，本公开提供了一种手术机器人系统，包括：手术工具，手术工具包括操作臂、设置在操作臂远端的执行器以及设置在操作臂的末端上的多个位姿标识，多个位姿标识包括不同的位姿标识图案；图像采集器，用于采集操作臂的定位图像；以及处理器，与图像采集器连接，用于执行本公开一些实施例中任一项的控制方法以确定操作臂的驱动信号。

附图说明

图1示出根据本公开一些实施例的操作臂控制系统的示意图；

图2示出根据本公开一些实施例的操作臂的构节示意图；

图3示出根据本公开一些实施例的操作臂的结构示意图；

图4示出根据本公开一些实施例的包括多个位姿标识的标签的示意图；

图5示出根据本公开一些实施例设置在操作臂末端周侧并形成圆筒形的标签的示意图；

图6示出根据本公开一些实施例的操作臂控制系统的控制方法的流程图；

图7示出根据本公开一些实施例的用于确定驱动信号的方法的流程图；

图8示出根据本公开一些实施例的确定多个位姿标识相对操作臂坐标系的三维坐标的方法的流程图；

图9示出根据本公开另一些实施例的确定多个位姿标识相对；作臂坐标系的三维坐标的方法的流程图；

图10示出根据本公开一些实施例的识别位姿标识的方法的流程图；

图11示出根据本公开一些实施例的位姿标识图案的示意图；

图12示出根据本公开一些实施例的用于搜索位姿标识的方法的流程图；

图13示出根据本公开一些实施例的搜索位姿标识的示意图；

图14示出根据本公开一些实施例的用于搜索第二位姿标识的方法的流程图；

图15示出根据本公开一些实施例的用于搜索位姿标识的方法的流程图；

图16示出根据本公开一些实施例的计算机设备的示意框图；

图17示出根据本公开一些实施例的手术机器人系统的示意图。

具体实施方式

下面结合附图描述本公开的示例性实施例，本领域技术人员可以理解，本公开的范围并不仅限于这些实施方案。本公开可以在下述实施方案的基础上作出各种改进和变化。这些改进和变化都包括在本公开的范围之内。在本公开的附图所示的各个实施方案之间，相似附图标记指示相似部件。

在本公开中，术语“位置”指物体或物体的一部分在三维空间中的定位(例如，可使用笛卡尔X、Y和Z坐标方面的变化描述三个平移自由度，例如分别沿笛卡尔X轴、Y轴和Z轴的三个平移自由度)。在本公开中，术语“姿态”指物体或物体的一部分的旋转设置(例如三个旋转自由度，可使用滚转、俯仰和偏转来描述这三个旋转自由度)。在本公开中，术语“位姿”指物体或物体的一部分的位置和姿态的组合，例如可使用以上提到的六个自由度中的六个参数来描述。

在本公开中，参考坐标系可以理解为能够描述物体位姿的坐标系。根据实际的定位需求，参考坐标系可以选择以虚拟参照物的原点或实体参照物的原点为坐标系原点。在一些实施例中，参考坐标系可以为世界坐标系或者相机坐标系或者操作人员自身的感知坐标系等。在本公开中，物体可以理解为需要被定位的对象或目标，例如操作臂或者操作臂末端或者设置在操作臂末端的远端的执行器。

在本公开中，操作臂或其一部分的位姿是指操作臂或其一部分定义的操作臂坐标系相对于参考坐标系的位姿。

图1示出根据本公开一些实施例的操作臂控制系统100的示意图。如图1所示，操作臂控制系统100可以包括图像采集设备110、至少一个操作臂140和控制装置120。图像采集设备110和至少一个操作臂140分别与控制装置120通信连接。在一些实施例中，如图1所示，控制装置120可以用于控制至少一个操作臂140的运动，以调整至少一个操作臂140的位姿、相互协调等。在一些实施例中，至少一个操作臂140在末端或远端处可以包括操作臂末端130。控制装置120可以控制至少一个操作臂140运动，以使操作臂末端130运动至期望的位置和姿态。本领域的技术人应理解，操作臂控制系统100可以应用于手术机器人系统，例如腔镜手术机器人系统。例如，操作臂末端130的远端处可以设置手术执行器160，如图1所示。应当理解，操作臂控制系统100还可以应用于其他领域(例如，制造、机械等等)的专用或通用机器人系统。

在本公开中，控制装置120可以与至少一个操作臂140的驱动单元150(例如电机)通信连接并向驱动单元150发送驱动信号，从而使驱动单元150基于驱动信号控制至少一个操作臂140运动到相应的目标位姿。例如，控制操作臂140运动的驱动单元150可以为伺服电机，可以接受控制装置的指令以控制操作臂140运动。控制装置120还可例如通过通信接口与驱动单元150耦合的传感器通信连接，以接收操作臂140的运动数据，实现对操作臂140的运动状态监控。在本公开的一个示例中，该通信接口可以为CAN(Controller AreaNetwork)总线通信接口，其使得控制装置120能够通过CAN总线与驱动单元150以及传感器连接通信。

在一些实施例中，操作臂140可以包括连续体可形变臂，例如由多个关节构成的具有多自由度的操作臂，诸如可以实现6个自由度运动的操作臂。图像采集设备110可以包括但不限于双镜头图像采集设备或单镜头图像采集设备，例如双目或单目相机。

在一些实施例中，图像采集设备110可以用于采集定位图像。定位图像中可以包括操作臂140的部分或全部的图像。在一些实施例中，图像采集设备110可以用于采集操作臂末端130的图像，操作臂末端130上可以设置有多个不同的位姿标识，这些位姿标识包括不同的位姿标识图案。例如，操作臂末端130上可以设置有定位标签170(定位标签170例如可以是图4所示的标签400)。定位标签170可以包括多个位姿标识，多个位姿标识包括不同的位姿标识图案(如下详述)。

如图1所示，操作臂末端130处于图像采集设备110的观测视野之内，则采集的定位图像中可以包括操作臂末端130的图像。在一些实施例中，图像采集设备110可以包括但不限于双镜头图像采集设备或单镜头图像采集设备，例如双目或单目相机。根据不同的应用场景，图像采集模块110可以是工业相机、水下相机、微型电子相机、内窥镜相机等。在一些实施例中，图像采集模块110可以是位置固定的或者位置变化的，例如，固定在监控位置的工业相机或者位置或姿态可调节的内窥镜相机。在一些实施例中，图像采集模块110可以实现可见光波段成像、红外波段成像、CT(Computed Tomography，电子计算机断层扫描)成像和声波成像等中的至少一种。根据采集的图像的种类不同，本领域技术人员可以选择不同的图像采集设备作为图像采集模块110。

在一些实施例中，控制装置120可以接收来自图像采集设备110的定位图像，并且对定位图像进行处理。例如，控制装置120可以在定位图像中，识别位于操作臂140上的多个位姿标识，并且确定操作臂140或者执行器160相对参考坐标系(例如世界坐标系)的当前相对位姿。控制装置120还可以基于操作臂140或者执行器160的当前相对位姿和目标位姿，确定操作臂140的驱动信号。驱动信号可以发送到驱动单元150，以对操作臂140进行运动控制。

图2示出根据本公开一些实施例的操作臂的构节200的示意图。操作臂(例如操作臂140)可以包括至少一个可形变的构节200。如图2所示，可形变的构节200包括固定盘210和多根结构骨220。多根结构骨220的第一端与固定盘210固定连接，第二端与驱动单元(未示出)连接。在一些实施例中，固定盘210可以是包括但不限于环状结构、盘状结构等，而且横截面可以是圆形、矩形、多边形等等各种形状。

驱动单元通过驱动结构骨220使构节200发生形变。例如，驱动单元通过驱动结构骨220使构节200处于如图2所示的弯曲状态。在一些实施例中，多根结构骨220的第二端穿过基盘230与驱动单元连接。在一些实施例中，与固定盘210类似，基盘230可以是包括但不限于环状结构、盘状结构等，而且横截面可以是圆形、矩形、多边形等等各种形状。驱动单元可以包括线性运动机构、驱动构节或两者的组合。线性运动机构可以与结构骨220连接，以推动或拉动结构骨220，进而驱动构节200弯曲。驱动构节可以包括固定盘和多根结构骨，其中多根结构骨的一端固定连接到固定盘。驱动构节的多根结构骨的另一端与多根结构骨220连接或一体成型，以通过驱动构节的弯曲来驱动构节200的弯曲。

在一些实施例中，在固定盘210与基盘230之间还包括间隔盘240，多根结构骨220穿过间隔盘240。类似地，驱动构节也可以包括间隔盘。

图3示出根据本公开一些实施例的操作臂300的结构示意图。如图3所示，操作臂300为可形变的操作臂，操作臂300可以包括操作臂末端310和操作臂主体320。操作臂主体320可以包括一个或多个构节，例如第一构节3201和第二构节3202。在一些实施例中，第一构节3201和第二构节3202的结构可以与图2所示的构节200类似。在一些实施中，如图3所示，操作臂主体320还包括位于第一构节3201和第二构节3202之间的第一直杆段3203。第一直杆段3203的第一端与第二构节3202的基盘连接，第二端与第一构节3201的固定盘连接。在一些实施中，如图3所示，操作臂主体320还包括第二直杆段3204，第二直杆段3204的第一端与第一构节3201的基盘连接。

在一些实施例中，操作臂(例如，图1所示的操作臂140或操作臂末端130，图3所示的操作臂主体320或操作臂末端310上)上分布有多个位姿标识。在一些实施例中，多个位姿标识设置在操作臂的柱状部分的外表面上。例如，多个位姿标识沿周向分布在操作臂末端310上。例如，多个位姿标识设置在操作臂末端310的柱状部分的外表面上。在一些实施例中，操作臂的柱状部分的外表面上设置有包括多个位姿标识的定位标签(例如，图4所示的标签400，图5所示的标签500)，多个位姿标识包括沿柱状部分的周向分布在定位标签上的多个不同的位姿标识图案以及在位姿标识图案中的位姿标识图案角点。

在一些实施例中，位姿标识可以包括位姿标识图案和在位姿标识图案中的位姿标识图案角点。在一些实施例中，位姿标识图案可以设置在操作臂末端上的标签上，或者可以印刷在操作臂末端上，或者可以是由操作臂末端自身的物理构造形成的图案，例如，可以包括凹陷或凸起及其组合。在一些实施例中，位姿标识图案可以包括以亮度、灰度、色彩等形成的图案。在一些实施例中，位姿标识图案可以包括主动(例如，自发光)或被动(例如，反射光线)提供被图像采集设备探测的信息的图案。本领域技术人员可以理解，在一些实施例中，位姿标识的位姿或者位姿标识图案的位姿可以由位姿标识图案角点坐标系的位姿来表示。在一些实施例中，位姿标识图案设置在操作臂末端上适于被图像采集设备采集图像的区域，例如，在工作过程中可以被图像采集设备的视场覆盖的区域或者在工作过程中不容易被干扰或遮挡的区域。

图4示出根据一些实施例的包括多个位姿标识的标签400的示意图。图5示出设置在操作臂末端周侧并形成圆筒形的标签500的示意图。可以理解，简单起见，标签400可以与标签500包括相同的位姿标识图案。

参看图4，多个位姿标识可以包括多个不同的位姿标识图案410。多个位姿标识还可以包括在多个不同的位姿标识图案410中的多个位姿标识图案角点P

参看图5，在周向设置状态下，标签400变为空间构造为圆筒形的标签500。在一些实施例中，位姿标识的绕轴角度或者滚转角可以通过位姿标识图案或位姿标识图案角点的绕轴角度表示。每个位姿标识图案或位姿标识图案角点标识的绕轴角度是已知的或预先确定的。在一些实施例中，基于多个位姿标识(例如位姿标识图案或位姿标识图案角点)的分布，可以确定每个位姿标识所标识的绕轴角度。在一些实施例中，多个位姿标识可以均匀分布(例如，标签400中的位姿标识图案角点等间距分布，标签500中的位姿标识图案角点等分布角分布)。另一些实施例中，多个位姿标识可以非均匀分布。在一些实施例中，基于多个位姿标识的分布，每个位姿标识图案可以用于标识特定的绕轴角度，每个位姿标识图案与所标识的绕轴角度具有一一对应关系。在本公开中，绕轴角度或者滚转角是指绕Z轴(例如，操作臂坐标系{wm}的Z轴)的角度。在一些实施例中，操作臂是可形变的操作臂，Z轴是沿操作臂的切线方向。

如图5所示，标签500中多个不同的位姿标识图案510沿圆柱形结构周向均匀分布，多个位姿标识图案角点均匀分布在操作臂坐标系{wm}的XY平面的截面圆520上，则任意相邻的位姿标识图案角点的分布角(例如，角度α

α

其中，α

本公开一些实施例提供了一种用于操作臂的控制方法。图6示出根据本公开一些实施例的操作臂控制系统的控制方法600的流程图。方法600中的部分或全部步骤可以由控制系统100的控制装置(例如控制装置120)来执行。控制装置120可以配置在计算设备上。方法600可以由软件、固件和/或硬件来实现。在一些实施例中，方法600可以实现为计算机可读的指令。这些指令可以由通用处理器或专用处理器(例如，图17所示的处理器1720)读取并执行。在一些实施例中，这些指令可以存储在计算机可读介质上。

参看图6，在步骤601，获取定位图像。在一些实施例中，定位图像中包含操作臂上的多个位姿标识。在一些实施例中，可以从如图1所示的图像采集设备110接收定位图像。例如，控制装置120可以接收图像采集设备110主动发送的定位图像。或者，控制装置120可以向图像采集设备110发送图像请求指令，图像采集设备110响应图像请求指令向控制装置120发送定位图像。

继续参看图6，在步骤603，在定位图像中，识别位于操作臂上的多个位姿标识，多个位姿标识包括不同的位姿标识图案。例如，识别位于操作臂上的多个位姿标识的示例性方法可以包括如图10、图12、图14和图15所示的方法。在一些实施例中，控制装置120可以通过图像处理算法识别定位图像中的部分或全部的位姿标识。在一些实施例中，图像处理算法可以包括特征识别算法，图像处理算法可以提取或识别位姿标识的特征。例如，图像处理算法可以包括角点检测算法，用于检测位姿标识图案角点。该角点检测算法可以是包括但不限于基于灰度图的角点检测、基于二值图像的角点检测、基于轮廓曲线的角点检测中的一种。例如，图像处理算法可以是颜色特征提取算法，用于检测位姿标识图案中的颜色特征。再例如，图像处理算法可以是轮廓检测算法，用于检测位姿标识图案的轮廓特征。在一些实施例中，控制装置可以通过识别模型识别定位图像中的部分或全部的位姿标识。

继续参看图6，在步骤605，基于多个位姿标识，确定操作臂相对参考坐标系的当前相对位姿。在一些实施例中，方法600还包括：确定多个位姿标识在定位图像中的二维坐标；以及基于多个位姿标识在定位图像中的二维坐标和多个位姿标识相对操作臂坐标系的三维坐标，确定操作臂相对参考坐标系的当前相对位姿。在一些实施例中，位姿标识的坐标可以通过位姿标识图案角点的坐标表示。例如，位姿标识在定位图像中的二维坐标和在操作臂坐标系中的三维坐标可以通过位姿标识图案角点的坐标表示。在一些实施例中，可以基于多个位姿标识图案角点在定位图像中的二维坐标和在操作臂坐标系中的三维坐标，确定操作臂坐标系相对参考坐标系的位姿作为操作臂相对参考坐标系的当前相对位姿。

继续参看图6，在步骤607，基于当前相对位姿和操作臂的目标位姿，确定操作臂的驱动信号。在一些实施例中，方法600还可以包括以预定周期，确定操作臂的驱动信号，以通过多个运动控制循环实现实时控制。

在一些实施例中，方法600还可以包括：基于操作臂的当前相对位姿和操作臂的目标位姿，确定位姿差；以及基于位姿差和操作臂的逆运动学模型，确定操作臂的驱动信号。例如，基于操作臂末端在世界坐标系中的目标位姿和当前位姿的差值，通过操作臂运动学模型的逆运动学数值迭代算法，可以确定操作臂所包括的多个关节在当前运动控制循环内的驱动值(或者控制操作臂运动的对应多个电机的驱动值)。应当理解，运动学模型可以表示操作臂的关节空间和任务空间的运动关系的数学模型。例如，运动学模型可以通过DH(Denavit-Hartenberg)参数法和指数积表示法等方法建立。

在一些实施例中，操作臂的目标位姿为操作臂在世界坐标系中的目标位姿。方法600还可以包括：基于当前相对位姿，确定操作臂在世界坐标系中的当前位姿；以及基于操作臂的目标位姿和所述操作臂在世界坐标系中的当前位姿，确定位姿差。在一些实施例中，位姿差包括位置差和姿态差。

在第k次运动控制循环中，位姿差可以基于以下公式(2)确定：

其中，

在一些实施例中，以预定周期，在每个运动控制循环之前或过程中，更新操作臂的目标位姿。在一些实施例中，迭代地执行多个运动控制循环，在每个运动控制循环，可以执行根据本公开一些实施例的方法，例如步骤601-607，以控制操作臂运动到目标位姿。通过迭代地执行多个运动控制循环，可以实现操作臂末端位姿的实时闭环控制，可以提高操作臂的位姿控制精度。应理解，经本公开的方法实现操作臂的位姿控制，能改进操作臂(例如连续体可形变臂)的轨迹跟踪误差。

在一些实施例中，方法600还可以包括接收控制命令；以及基于控制命令，确定操作臂的目标位姿。在一些实施例中，操作臂末端在世界坐标系中的目标位姿可以由用户通过输入装置输入。通过比较计算，可以确定操作臂末端的目标位姿和当前位姿的差值。在一些实施例中，可以基于主从运动的控制方式接收控制命令。例如，通过在每个运动控制循环中，获取主操作器的位姿或者主操作器的关节信息，确定操作臂的目标位姿。通过多个运动控制循环，可以进行实时主从运动的控制。

图7示出根据本公开一些实施例的用于确定驱动信号的方法700的流程图。如图7所示，该方法700中的部分或全部步骤可以由操作臂控制系统100的控制装置(例如控制装置120)来执行。控制装置120可以配置在计算设备上。方法700可以由软件、固件和/或硬件来实现。在一些实施例中，方法700可以实现为计算机可读的指令。这些指令可以由通用处理器或专用处理器(例如，图17所示的处理器1720)读取并执行。在一些实施例中，这些指令可以存储在计算机可读介质上。

参看图7，在步骤701，基于位姿差，确定笛卡尔空间速度。在一些实施例中，笛卡尔空间速度包括笛卡尔空间线速度和笛卡尔空间角速度。方法700还可以包括：基于位置差，确定笛卡尔空间线速度，以及基于姿态差，确定笛卡尔空间角速度。在一些实施例中，可以基于姿态差，通过比例-积分-微分控制器或者比例-微分控制器确定笛卡尔空间角速度。在一些实施例中，第k次运动控制循环的笛卡尔空间速度

其中，v

参看图7，在步骤703，基于笛卡尔空间速度，确定关节参数空间速度。第k次运动控制循环的关节参数空间速度

J

参看图7，在步骤705，基于关节参数空间速度和当前关节参数，确定目标关节参数。第k次运动控制循环的目标关节参数

其中，

应理解，当操作臂具有多个构节(例如，图3所示的操作臂300)，操作臂的目标关节参数可以是全部的构节的目标关节参数，也可以是多个构节中的一个或一些构节的目标关节参数。

参看图7，在步骤707，基于目标关节参数，确定驱动信号。例如，基于目标关节参数与驱动量的映射关系，可以确定操作臂所包括的多个关节在当前运动控制循环内的驱动量，进而基于驱动量确定驱动单元(例如，电机)的驱动信号。在一些实施例中，单个构节的关节参数与驱动量的映射关系可以是基于公式(14)的映射关系。

在一些实施例中，以操作臂为可形变运动臂(例如连续体可形变臂)作为示例。连续体可形变臂可以是如图3所示的操作臂300。如图3所示，每个构节(第一构节3201和第二构节3202)可以包括基座盘、固定盘以及贯穿基座盘和固定盘的多根结构骨，多根结构骨可以与固定盘固定连接，与基座盘滑动连接。连续体可形变臂及其包含的构节可以通过运动学模型描述。在一些实施例中，每个构节的结构具体可如图2所示的构节200。如图2所示，基座盘坐标系

如图2所示的单个构节200可以通过运动学模型表示。第t节构节末端(固定盘坐标系{te})相对于基座盘坐标系{tb}的位置

tb

其中，L

tb

其中，δ

如图2所示的单个构节200的关节参数Ψ

ψ

关节参数Ψ

其中，

如图2所示的单个构节200的末端笛卡尔空间速度

其中，J

在一些实施例中，多根结构骨的驱动量与关节参数具有已知的映射关系。基于构节的目标关节参数和映射关系，可以确定多根结构骨的驱动量。多根结构骨的驱动量可以理解为将单个构节从初始状态(例如，θ

q

其中，r

在一些实施例中，基于公式(2)和公式(3)可以确定单个构节的末端笛卡尔空间速度，基于公式(4)可以确定单个构节的关节参数空间速度，基于公式(5)可以确定单个构节的目标关节参数，基于公式(14)可以确定每根结构骨的驱动量，进而基于驱动量确定驱动单元(例如，电机)的驱动信号。

在一些实施例中，整个可形变臂可以通过运动学模型来描述。如图3所示，位于可形变臂多个位置处的多个坐标系之间可以进行变换。例如，连续体可形变臂的末端执行器在世界坐标系{w}中可基于以下公式(15)确定：

W

其中，

应理解，可变形臂在不同的工作状态具有不同的关节参数。例如，图3所示的操作臂300至少包括四种工作状态。操作臂300的四种工作状态如下所述：

第一工作状态：只有第二构节3202参与执行器的位姿控制(例如，只有第二构节3202进入工作空间)，此时操作臂300的关节参数可以基于以下公式(16)确定：

其中，ψ

第二工作状态：第二构节3202和第一直线段3203参与执行器的位姿控制(例如，第二构节3202全部进入工作空间，第一直线段3203部分进入工作空间)，此时操作臂300的关节参数可以基于以下公式(17)确定：

其中，ψ

第三工作状态：第二构节3202、第一直线段3203和第一构节3201参与执行器的位姿控制(例如，第二构节3202全部进入工作空间，第一直线段3203全部进入工作空间，第一构节3201部分进入工作空间)，此时操作臂300的关节参数可以基于以下公式(18)确定：

其中，ψ

第四工作状态：第二构节3202、第一直线段3203、第一构节3201和第二直线段3204参与执行器的位姿控制(例如，第二构节3202全部进入工作空间，第一直线段3203全部进入工作空间，第一构节3201全部进入工作空间，第二直线段3204部分进入工作空间)，此时操作臂300的关节参数可以基于以下公式(19)确定：

其中，ψ

在一些实施例中，与单个构节类似，基于公式(2)和公式(3)可以确定可形变臂的末端笛卡尔空间速度，基于公式(4)可以确定可形变臂的关节参数空间速度，基于公式(5)可以确定可形变臂的目标关节参数，其中公式(4)中的关节参数空间速度和公式(5)中的目标关节参数中包含的具体参数可以基于公式(16)、(17)、(18)或(19)确定，基于公式(14)可以确定每个构节的每根结构骨的驱动量，进而基于驱动量确定驱动单元(例如，电机)的驱动信号。

在一些实施例中，方法600还可以包括：基于多个位姿标识图案角点在定位图像中的二维坐标、多个位姿标识图案角点在操作臂坐标系中的三维坐标和相机坐标系相对参考坐标系的变换关系，确定操作臂坐标系相对参考坐标系的位姿。在一些实施例中，相机坐标系相对参考坐标系的变换关系可以是已知的。例如，参考坐标系为世界坐标系，相机坐标系相对世界坐标系的变换关系可以根据相机摆放的位姿确定。另一些实施例中，根据实际的需求，参考坐标系也可以是相机坐标系本身。在一些实施例中，基于相机成像原理与投影模型，基于多个位姿标识图案角点在定位图像中的二维坐标和多个位姿标识图案角点在操作臂坐标系中的三维坐标，确定操作臂坐标系相对相机坐标系的位姿。基于操作臂坐标系相对相机坐标系的位姿和相机坐标系相对参考坐标系的变换关系，可以得到操作臂坐标系相对参考坐标系的位姿。在一些实施例中，还可以考虑相机的内参。例如，相机的内参可以是如图1所示的图像采集设备110的相机内参。相机的内参可以是已知的或者经过标定而得到的。在一些实施例中，相机坐标系可以理解为以相机原点建立的坐标系。例如，以相机的光心为原点建立的坐标系或者以相机的镜头中心为原点建立的坐标系。当相机为双目相机时，相机坐标系的原点可以是相机左镜头的中心，或者右镜头的中心，或者左右镜头中心连线上的任意一点(例如该连线的中点)。

在一些实施例中，操作臂坐标系{wm}相对参考坐标系(例如，世界坐标系)的位姿可以基于以下公式(20)确定：

其中，

本公开一些实施例提供了确定多个位姿标识相对操作臂坐标系的三维坐标的方法。在一些实施例中，基于多个位姿标识的分布，确定多个位姿标识相对操作臂坐标系的三维坐标。例如，基于多个位姿标识图案角点的分布，确定多个位姿标识图案角点在操作臂坐标系中的三维坐标。

图8示出根据本公开一些实施例的确定多个位姿标识相对操作臂坐标系的三维坐标的方法800的流程图。方法800中的部分或全部步骤可以由控制系统100的控制装置(例如控制装置120)来执行。控制装置120可以配置在计算设备上。方法800可以由软件、固件和/或硬件来实现。在一些实施例中，方法800可以实现为计算机可读的指令。这些指令可以由通用处理器或专用处理器(例如，图17所示的处理器1720)读取并执行。在一些实施例中，这些指令可以存储在计算机可读介质上。

参看图8，在步骤801，基于多个位姿标识的分布，确定多个位姿标识相对操作臂坐标系的Z轴的绕轴角度。在一些实施例中，可以基于多个位姿标识图案，确定多个位姿标识相对操作臂坐标系的Z轴的绕轴角度。例如，每个位姿标识图案可以标识特定的绕轴角度，不同的位姿标识图案与所标识的绕轴角度一一对应。基于识别出位姿标识图案以及位姿标识图案与绕轴角度的对应关系，可以确定被识别出的位姿标识图案所标识的绕轴角度。应理解，每个位姿标识图案的分布是已知的或预先确定的。在一些实施例中，多个位姿标识图案或者多个位姿标识图案角点的分布可以是如图3所示的分布。在一些实施例中，每个位姿标识图案角点标识的绕轴角度还可以基于公式(1)确定。

参看图8，在步骤803，基于多个位姿标识的绕轴角度，确定多个位姿标识相对操作臂坐标系的三维坐标。在一些实施例中，如图5所示，每个位姿标识图案角点均位于在截面圆520的圆周上，截面圆520的圆心与半径r均是已知的。以位姿标识图案角点P

C

其中，C

在一些实施例中，基于公式(1)确定第m个位姿标识图案角点标识的绕轴角度α

图9示出根据本公开另一些实施例的确定多个位姿标识相对操作臂坐标系的三维坐标的方法900的流程图。方法900可以是方法800的替换实施例。方法900中的部分或全部步骤可以由控制系统100的控制装置(例如控制装置120)来执行。控制装置120可以配置在计算设备上。方法900可以由软件、固件和/或硬件来实现。在一些实施例中，方法900可以实现为计算机可读的指令。这些指令可以由通用处理器或专用处理器(例如，图17所示的处理器1720)读取并执行。在一些实施例中，这些指令可以存储在计算机可读介质上。

参看图9，在步骤901，基于多个位姿标识中的至少两个，确定多个位姿标识的排布顺序。在一些实施例中，多个位姿标识的排布顺序可以通过多个位姿标识图案的排布顺序表示。在一些实施例中，通过识别任意两个位姿标识图案确定多个位姿标识的排布顺序。应理解，多个位姿标识包括不同的位姿标识图案，在已知任意两个位姿标识图案的情况下，可以基于多个位姿标识图案已知的分布(例如，图4所示标签400中不同位姿标识图案的分布，或者图5所示标签500中不同位姿标识图案的分布)，确定定位图像中多个位姿标识的排布顺序，例如顺时针排布或逆时针排布。

参看图9，在步骤903，基于多个位姿标识的排布顺序，确定多个位姿标识的三维坐标。在一些实施例中，基于多个位姿标识已知的分布，可以确定每个位姿标识在操作臂坐标系中的三维坐标，每个位姿标识的三维坐标可以通过位姿标识图案角点在操作臂坐标系中的三维坐标表示，每个位姿标识图案对应操作臂坐标系中的一个坐标点。在确定多个位姿标识图案的排布顺序的之后，基于识别出的位姿标识图案可以确定其余的位姿标识图案，进而可以确定每个位姿标识图案在操作臂坐标系中的三维坐标。在一些实施例中，识别定位图像中的多个位姿标识角点，确定多个位姿标识角点中的任意两个对应的位姿标识图案。基于识别出的两个位姿标识图案确定多个位姿标识图案角点的排布顺序，进而可以确定每个位姿标识图案角点在操作臂坐标系中的三维坐标。此外，基于排布顺序，可以确定所有位姿标识图案的分布，从而以特定位姿图案匹配模板与定位图像上对应位置处的位姿标识图案进行匹配，提高了数据处理速度。在一些实施例中，位姿图案匹配模板与位姿标识图案角点处的图案匹配可以与方法1000中的步骤1003类似地实现。

在一些实施例中，方法600还包括：基于操作臂相对参考坐标系的当前相对位姿，确定操作臂的末端器械相对参考坐标系的当前相对位姿；以及基于操作臂的末端器械的当前相对位姿和目标位姿，确定操作臂的驱动信号。在一些实施例中，可以基于操作臂的目标位姿确定操作臂的末端器械的目标位姿，以及基于末端器械相对参考坐标系的当前相对位姿和末端器械的目标位姿，确定操作臂的驱动信号。或者，可以接收用户输入的控制命令，以确定末端器械的目标位姿。例如，在每个运动控制循环中，获取主操作器的位姿或者主操作器的关节信息，确定末端器械的目标位姿。在一些实施例中，末端器械(例如，图1所示的执行器160)设置在操作臂的末端，因此末端器械的位置是已知的或者可以确定的。末端器械相对操作臂坐标系的位姿变换关系也是已知的或者预先确定的。在一些实施例中，以参考坐标系为世界坐标系为例，操作臂的末端器械相对参考坐标系的位姿可以基于以下公式(22)确定：

其中，

在一些实施例中，基于公式(20)确定操作臂坐标系相对世界坐标系的姿态

本公开一些实施例提供了识别位姿标识的方法。图10示出根据本公开一些实施例的识别位姿标识的方法1000的流程图。方法1000中的部分或全部步骤可以由控制系统100的控制装置(例如控制装置120)来执行。控制装置120可以配置在计算设备上。方法1000可以由软件、固件和/或硬件来实现。在一些实施例中，方法1000可以实现为计算机可读的指令。这些指令可以由通用处理器或专用处理器(例如，图17所示的处理器1720)读取并执行。在一些实施例中，这些指令可以存储在计算机可读介质上。

参考图10，在步骤1001，从定位图像中确定多个候选位姿标识。在一些实施例中，位姿标识可以包括在位姿标识图案中的位姿标识图案角点。候选位姿标识的坐标或坐标系原点可以通过候选位姿标识图案角点表示。在一些实施例中，候选位姿标识图案角点可以是指经过对定位图像进行初步处理或者初步识别得到的可能的位姿标识图案角点。

在一些实施例中，方法1000还可以包括在定位图像中确定感兴趣区域(Region ofInterest，ROI)。例如，可以先从定位图像中截取ROI，从ROI中确定多个候选位姿标识。其中，ROI可以是定位图像的全图像，也可以是部分区域。例如，可以基于上一帧图像(例如，上一图像处理周期的定位图像)确定的多个位姿标识图案角点一定范围内的区域截取当前帧的ROI。对非第一帧的定位图像，ROI可以为上一图像处理周期的多个位姿标识图案角点的坐标构成的虚点为中心的一定距离范围内的区域。一定距离范围可以是位姿标识图案角点平均间隔距离的固定倍数，例如两倍。应理解，预定倍数还可以是上一图像处理周期中多个候选位姿标识图案角点平均间隔距离的可变倍数。

在一些实施例中，方法1000还可以包括确定定位图像中各像素点的角点似然值(Corner Likelihood,CL)。在一些实施例中，像素点的角点似然值可以是表征像素点作为特征点(例如，角点)的可能性的数值。在一些实施例中，在计算各像素点的角点似然值之前可以对定位图像进行预处理，之后确定预处理之后的图像中各像素点的角点似然值。图像的预处理例如可以包括：图像灰度化、图像去噪、图像增强中的至少一种。例如，图像预处理可以包括：从定位图像中截取ROI，将ROI转为相应的灰度图像。

在一些实施例中，确定ROI中的每个像素点的角点似然值的方式例如可以包括对ROI范围内每一个像素点进行卷积操作，得到每个像素点的一阶和/或二阶导数。利用ROI范围内每个像素点的一阶和/或二阶导数求出每个像素点的角点似然值。示例性地，各像素的角点似然值可以基于以下公式(23)确定：

其中，τ为设定的常数，例如设定为2；I

在一些实施例中，方法1000还可以包括将ROI划分成多个子区域。例如，可以采用非极大抑制法在一个ROI范围中平均分割出多个子图像。在一些实施例中，可以将ROI平均分割成5×5像素的多个子图像。上述实施例为示例性的，并非限制性的，应当理解，还可以将定位图像或ROI分割成其他尺寸大小的多个子图像，例如，分割成9×9像素的多个子图像。

在一些实施例中，方法1000还可以包括确定每个子区域中角点似然值最大的像素以形成像素集合。在一些实施例中，像素集合作为从定位图像中确定的多个候选标识。例如，可以确定每个子图像中的CL值最大的像素点，将每个子图像中的CL值最大的像素点与第一阈值进行比较，确定CL值大于第一阈值的像素的集合。在一些实施例中，第一阈值可以设定为0.06。应当理解，第一阈值还可以设定为其他值。

参看图10，步骤1003，基于多个不同的位姿图案匹配模板，从候选位姿标识中识别第一位姿标识。在一些实施例中，将多个不同的位姿图案匹配模板分别与候选位姿标识图案角点处的图案进行匹配，以识别第一位姿标识。例如，确定达到预设位姿图案匹配度标准的候选位姿标识图案角点为第一位姿标识图案角点。在一些实施例中，位姿图案匹配模板与位姿标识图案角点附近区域的图案具有相同或相似的特征。若位姿图案匹配模板与候选位姿标识图案角点附近区域的图案的匹配度达到预设位姿图案匹配度标准(例如，匹配度高于阈值)，则可以认为候选位姿标识图案角点附近区域的图案与位姿图案匹配模板具有相同或相似的特征，进而可认为当前的候选位姿标识图案角点为位姿标识图案角点。

在一些实施例中，确定像素集合中CL值最大的像素点，作为候选位姿标识图案角点。例如，可以将该像素集合中的所有像素按CL值从大到小的顺序排序，并将CL值最大的像素作为候选位姿标识图案角点。在一些实施例中，在确定了候选位姿标识图案角点之后，将位姿图案匹配模板与候选位姿标识图案角点处的图案进行匹配，如果达到了预设位姿图案匹配度标准，则确定候选位姿标识图案角点为识别出的第一位姿标识图案角点。

在一些实施例中，方法1000还可以包括响应于匹配失败，确定像素集合中剩余像素的角点似然值最大的像素作为候选位姿标识图案角点。例如，如果候选位姿标识图案角点未达到预设的匹配度标准，则选择次级CL值的像素点(CL值第二大的像素点)作为候选位姿标识图案角点，将位姿图案匹配模板与该候选位姿标识图案角点处的图案进行匹配，依次类推，直至识别出第一位姿标识图案角点。

在一些实施例中，位姿标识图案可以为黑白相间的图形(例如，棋盘格图形)，因此位姿图案匹配模板可以为相同的图形，利用位姿图案匹配模板的灰度分布G

其中，Var()为方差函数，Cov()为协方差函数。在一些实施例中，当相关性系数小于0.8时，像素领域内的灰度分布与位姿图案匹配模板相关性较低，则判定该角点似然值最大的候选位姿标识图案角点不是位姿标识图案角点，否则认为该角点似然值最大的候选位姿标识图案角点是位姿标识图案角点。

在一些实施例中，方法1000还可以包括确定候选位姿标识图案角点的边缘方向。例如，如图11所示，候选位姿标识图案角点为位姿标识图案1100中的角点P

在一些实施例中，边缘方向可以通过对以候选位姿标识图案角点为中心的一定范围邻域(例如10×10像素)的每个像素在平面坐标系的X方向和Y方向的一阶导数值(I

其中，一阶导数(I

在一些实施例中，聚类计算所用的方法可以是K均值方法、BIRCH(BalancedIterative Reducing and Clustering using Hierarchies，基于层次结构的平衡迭代聚类方法)方法、DBSCAN(Density-Based Spatial Clustering of Applications withNoise，具有噪声的基于密度的聚类方法)方法、GMM(Gaussian Mixed Model，高斯混合模型)方法中的任意一种。

在一些实施例中，方法1000还可以包括基于边缘方向旋转位姿图案匹配模板。根据边缘方向旋转位姿图案匹配模板，可以将位姿图案匹配模板与候选位姿标识图案角点处的图像对齐。候选位姿标识图案角点的边缘方向可以用于确定该候选标识图案角点处的图像在定位图像中的设置方向。在一些实施例中，根据边缘方向旋转位姿图案匹配模板，可以将位姿图案匹配模板调整至与候选位姿标识图案角点处的图像方向相同或接近相同以便于进行图像匹配。

参看图10，步骤1005，以第一位姿标识作为起点，搜索位姿标识。例如，图12示出根据本公开一些实施例的用于搜索位姿标识的方法1200的流程图。如图12所示，该方法1200中的部分或全部步骤可以由数据处理装置(例如，图1所示的控制装置120，图17所示的处理器1720)来执行。方法1200中的部分或全部步骤可以由软件、固件和/或硬件来实现。在一些实施例中，方法1200可以由机器人系统(例如，图17所示的手术机器人系统1700)执行。在一些实施例中，方法1200可以实现为计算机可读的指令。这些指令可以由通用处理器或专用处理器(例如，图17所示的处理器1720)读取并执行。在一些实施例中，这些指令可以存储在计算机可读介质上。

参看图12，在步骤1201，以第一位姿标识作为起点，搜索第二位姿标识。在一些实施例中，以第一位姿标识图案角点作为起点，在设定的搜索方向上搜索第二位姿标识图案角点。在一些实施例中，设定的搜索方向可以包括：第一位姿标识图案角点的正前方(对应0°角度方向)、正后方(对应120°角度方向)、正上方(90°角度方向)、正下方(-90°角度方向)和斜向(例如±45°角度方向)中的至少一个方向。

在一些实施例中，设定的搜索方向为n个，例如在8个方向进行搜索，每个搜索方向v

v

在一些实施例中，当前步骤中设定的搜索方向可以根据上一帧确定的多个位姿标识图案角点中相邻位姿标识图案角点之间的偏差角度确定。示例性地，预定的搜索方向基于以下公式(27)确定：

其中，(x

在一些实施例中，如图13所示，以第一位姿标识图案角点P

在一些实施例中，继续参看图13，搜索框的大小可以逐步增大，从而搜索范围逐步增大。搜索步长可与搜索框的边长同步变化。其他实施方式中，搜索框的大小也可以为固定的大小。

在一些实施例中，位姿标识图案可以为黑白相间的棋盘格图形，可以基于公式(24)中的相关性系数来进行图案匹配。如果相关性系数大于阈值，则认为该角点似然值最大的候选位姿标识图案角点是位姿标识图案角点，记为第二位姿标识图案角点。

图14示出根据本公开一些实施例的用于搜索第二位姿标识的方法1400的流程图。如图14所示，该方法1400中的部分或全部步骤可以由数据处理装置(例如，图1所示的控制装置120，图17所示的处理器1720)来执行。方法1400中的部分或全部步骤可以由软件、固件和/或硬件来实现。在一些实施例中，方法1400可以由机器人系统(例如，图17所示的手术机器人系统1700)执行。在一些实施例中，方法1400可以实现为计算机可读的指令。这些指令可以由通用处理器或专用处理器(例如，图17所示的处理器1720)读取并执行。在一些实施例中，这些指令可以存储在计算机可读介质上。在一些实施例中，方法1200中的步骤1201可以与方法1400类似地实现。

参看图14，在步骤1401，以第一位姿标识作为起点，搜索第二位姿标识的候选位姿标识图案角点。在一些实施例中，搜索第二位姿标识的候选位姿标识图案角点可以与图13所示搜索第二位姿标识图案角点P

在步骤1403，基于多个位姿标识的分布，确定第一位姿图案匹配模板和第二位姿图案匹配模板，第一位姿图案匹配模板和第二位姿图案匹配模板对应于与第一位姿标识相邻的位姿标识。在一些实施例中，步骤1403可以在步骤1401之前或者之后执行，步骤1403也可以与步骤1401同步执行。在一些实施例中，可以基于第一位姿标识包括的位姿标识图案以及多个位姿标识图案的分布，确定第一位姿标识相邻的位姿标识包括的位姿标识图案，进而确定第一位姿图案匹配模板和第二位姿图案匹配模板。

在步骤1405，将第一位姿图案匹配模板和/或第二位姿图案匹配模板与第二位姿标识的候选位姿标识图案角点位置处的图案进行匹配，以识别第二位姿标识。在一些实施例中，可以基于公式(24)中的相关性系数将第一位姿图案匹配模板和/或第二位姿图案匹配模板与第二位姿标识的候选位姿标识图案角点位置处的图案进行匹配。如果相关性系数大于阈值，则确定第二位姿标识的候选位姿标识图案角点作为第二位姿标识的位姿标识图案角点，并且确定相关性系数大于阈值的位姿图案匹配模板(第一位姿图案匹配模板或第二位姿图案匹配模板)对应的图案为第二位姿标识的位姿标识图案。

参看图12，在步骤1203，基于第一位姿标识、第二位姿标识，确定搜索方向。在一些实施例中，搜索方向包括：第一搜索方向和第二搜索方向。第一搜索方向可以是以第一位姿标识图案角点的坐标位置为起点，且远离第二位姿标识图案角点的方向。第二搜索方向可以是以第二位姿标识图案角点的坐标位置为起点，且远离第一位姿标识图案角点的方向。例如，图13中所示的搜索方向V

参看图12，在步骤1205，以第一位姿标识或第二位姿标识作为起点，在搜索方向上搜索位姿标识。在一些实施例中，若以第一位姿标识图案角点为新的起点，则可以以上述实施例中的第一搜索方向作为搜索方向进行位姿标识图案角点的搜索。若以第二位姿标识图案角点为新的搜索起点，则可以以上述实施例中的第二搜索方向作为搜索方向进行位姿标识图案角点的搜索。在一些实施例中，搜索新的位姿标识图案角点(例如，图13中的第三位姿标识图案角点P

图15示出根据本公开一些实施例的用于搜索位姿标识的方法1500的流程图。如图15所示，该方法1500中的部分或全部步骤可以由数据处理装置(例如，图1所示的控制装置120，图17所示的处理器1720)来执行。方法1500中的部分或全部步骤可以由软件、固件和/或硬件来实现。在一些实施例中，方法1500可以由机器人系统(例如，图17所示的手术机器人系统1700)执行。在一些实施例中，方法1500可以实现为计算机可读的指令。这些指令可以由通用处理器或专用处理器(例如，图17所示的处理器1720)读取并执行。在一些实施例中，这些指令可以存储在计算机可读介质上。在一些实施例中，方法1200中的步骤1205可以与方法1500类似地实现。

参看图15，在步骤1501，以第一位姿标识或第二位姿标识作为起点，搜索第三位姿标识的候选位姿标识图案角点。在一些实施例中，搜索第三位姿标识的候选位姿标识图案角点可以与图13所示搜索第三位姿标识图案角点P

在步骤1503，基于多个位姿标识的分布，确定第三位姿图案匹配模板，第三位姿图案匹配模板对应于与第一位姿标识相邻或与第二位姿标识相邻的位姿标识。在一些实施例中，可以基于第一位姿标识或第二位姿标识包括的位姿标识图案以及多个位姿标识图案的分布，确定第一位姿标识或第二位姿标识相邻的位姿标识包括的位姿标识图案，进而确定第三位姿图案匹配模板。

在步骤1505，将第三位姿图案匹配模板与第三位姿标识的候选位姿标识图案角点位置处的图案进行匹配，以识别第三位姿标识。在一些实施例中，步骤1505可以与步骤1405类似地实现。

在一些实施例中，响应于搜索距离大于搜索距离阈值，确定像素集合中剩余像素的角点似然值最大的像素作为候选位姿标识图案角点；以及将多个不同的位姿图案匹配模板分别与候选位姿标识图案角点位置处的图案进行匹配，以识别第一位姿标识。在一些实施例中，在确定像素集合中剩余像素的角点似然值最大的像素作为新的候选位姿标识图案角点之后，可以基于与步骤1003类似地方法识别新的第一位姿标识。在一些实施例中，搜索距离大于搜索距离阈值可以理解为在部分或者全部的搜索方向上的搜索距离大于搜索距离阈值。在一些实施例中，搜索距离阈值可以包括第N-1个位姿标识图案角点和第N-2个位姿标识图案角点的距离的设定倍数，其中N≥3。

例如，搜索距离阈值为两倍的前两个位姿标识图案角点的距离。这样，搜索第三个位姿标识图案角点的最大搜索距离是第一位姿标识图案角点和第二位姿标识图案角点的距离的两倍，若在搜索方向上达到该搜索距离还未搜索到位姿标识图案角点，则确定像素集合中剩余像素的角点似然值最大的像素作为新的候选位姿标识图案角点，以及识别新的第一位姿标识，并且当前搜索过程也相应停止。在一些实施例中，与方法1000类似，可以重新确定新的第一位姿标识图案角点，并且与方法1200类似，可以以新的位姿标识图案角点为搜索起点，搜索其余的位姿标识图案角点。

在一些实施例中，响应于识别到的位姿标识图案角点数量大于或等于位姿标识数量阈值，可以基于搜索到的位姿标识的搜索，确定操作臂相对参考坐标系的当前相对位姿，对位姿标识图案角点的搜索也相应停止。例如，当识别到四个位姿标识图案角点，停止对位姿标识图案角点的搜索。

在一些实施例中，响应于识别到的位姿标识数量小于位姿标识数量阈值，确定像素集合中剩余像素的角点似然值最大的像素作为候选位姿标识图案角点；以及将多个不同的位姿图案匹配模板分别与候选位姿标识图案角点位置处的图案进行匹配，以识别第一位姿标识。在一些实施例中，若识别到的位姿标识(例如，位姿标识图案角点)总数小于设定的位姿标识数量阈值，则认为上述步骤中基于第一位姿标识的搜索失败。在一些实施例中，在搜索失败的情况下，确定像素集合中剩余像素的角点似然值最大的像素作为新的候选位姿标识图案角点，之后可以基于与步骤1003类似地方法识别新的第一位姿标识。在一些实施例中，与方法1000类似，可以重新确定新的第一位姿标识图案角点，并且与方法1200类似，可以以新的位姿标识图案角点为搜索起点，搜索其余的位姿标识图案角点。

在一些实施例中，在搜索到或者识别到位姿标识图案角点之后，还可以对已确定的位姿标识图案角点进行亚像素定位，以提高位姿标识图案角点的位置精度。

在一些实施例中，可以对像素点的CL值基于模型进行拟合，以确定经亚像素定位后的位姿标识图案角点的坐标。例如，ROI中每个像素点的CL值的拟合函数可以为二次曲面函数，该函数的极值点为亚像素点。拟合函数可以基于以下公式(28)和(29)确定：

S(x，y)＝ax

其中，S(x，y)为每个ROI中的所有像素点的CL值拟合函数，a、b、c、d、e、f为系数；x

本公开一些实施例中，本公开还提供了一种计算机设备，计算机设备包括存储器和处理器。存储器可以用于存储有至少一条指令，处理器与存储器耦合，用于执行至少一条指令以执行本公开的方法中的部分步骤或全部步骤，如图6、图7、图8、图9、图10、图12、图14和图15中公开的方法中的部分步骤或全部步骤。

图16示出根据本公开一些实施例的计算机设备1600的示意框图。参看图16，该计算机设备1600可以包括中央处理单元(CPU)1601、包括随机存取存储器(RAM)1602和只读存储器(ROM)1603的系统存储器1604，以及连接各部件的系统总线1605。计算机设备1600还可以包括输入/输出设备1606，和用于存储操作系统1613、应用程序1614和其他程序模块1615的大容量存储设备1607。输入/输出设备1606包括主要由显示器1608和输入设备1609组成的输入/输出控制器1610。

大容量存储设备1607通过连接到系统总线1605的大容量存储控制器(未示出)连接到中央处理单元1601。大容量存储设备1607或者计算机可读介质为计算机设备提供非易失性存储。大容量存储设备1607可以包括诸如硬盘或者光盘只读存储器(Compact DiscRead-Only Memory，CD-ROM)驱动器之类的计算机可读介质(未示出)。

不失一般性，计算机可读介质可以包括计算机存储介质和通信介质。计算机存储介质包括以用于存储诸如计算机可读指令、数据结构、程序模块或其他数据等信息的任何方法或技术实现的易失性和非易失性、可移动和不可移动介质。计算机存储介质包括RAM、ROM、闪存或其他固态存储其技术，CD-ROM、或其他光学存储、磁带盒、磁带、磁盘存储或其他磁性存储设备。当然，本领域技术人员可知计算机存储介质不局限于上述几种。上述的系统存储器和大容量存储设备可以统称为存储器。

计算机设备1600可以通过连接在系统总线1605上的网络接口单元1611连接到网络1612。

系统存储器1604或大容量存储设备1607还用于存储一个或者一个以上的指令。中央处理单元1601通过执行该一个或一个以上指令来实现本公开一些实施例中的方法的全部或者部分步骤。

本公开一些实施例中，本公开还提供一种计算机可读存储介质，存储介质中存储有至少一条指令，该至少一条指令由处理器执行以使计算机执行本公开一些实施例的方法中的部分步骤或全部步骤，如图6、图7、图8、图9、图10、图12、图14和图15中公开的方法中的部分步骤或全部步骤。计算机可读存储介质的示例包括计算机程序(指令)的存储器，例如，只读存储器(Read-Only Memory，ROM)、随机存取存储器(Random Access Memory，RAM)、只读光盘(Compact Disc Read-Only Memory，CD-ROM)、磁带、软盘和光数据存储设备等。

图17示出根据本公开一些实施例的手术机器人系统1700的示意图。本公开一些实施例中，参看图17，手术机器人系统1700可以包括：手术器械1750、图像采集器1710以及处理器1720。手术器械1750可以包括操作臂1740、设置在操作臂1740末端的远端的执行器1730以及设置在操作臂1740的末端上的多个位姿标识，多个位姿标识包括不同的位姿标识图案。图像采集器1710可以用于采集操作臂1740的定位图像。处理器1720与图像采集器1710连接，用于执行本公开一些实施例的方法中的部分步骤或全部步骤，如图6、图7、图8、图9、图10、图12、图14和图15中公开的方法中的部分步骤或全部步骤。

虽然已经举例说明和描述了本公开的具体实施方案，但是对于本领域技术人员来说显而易见的是，在不脱离本公开实质和范围的情况下可以做出多种其他改变和变型。因此，在随附的权利要求书中包括属于本公开范围内的所有这些改变和变型。