导管弯曲转向控制方法、导管系统及存储介质与流程

1.本技术属于医疗器械技术领域，具体涉及一种导管弯曲转向控制方法、导管系统及其控制系统，以及计算机可读存储介质。
2.

背景技术：

3.微创医疗技术意图减少在医疗程序期间损害的组织量，以减少患者恢复时间、不适感以及有害副作用。在微创医疗技术中经常需要通过患者解剖结构中的自然孔口或通过外科手术切口插入导管至目标组织方位。为了使导管到达目标组织方位，需要对导管的转向进行精确控制。
4.相关技术中一般通过建立导管运动学模型，即到控制导管的各驱动轮的角度位置和导管末端位姿之间的映射关系，再将导管的目标位姿代入运动学模型求解驱动轮的角度位置的方式来实现对导管的精确控制。由于导管是柔性连续体结构，在实际应用中，导管的材料特性、装配工艺、温度变化、外力扰动和作业空间，对运动学描述产生很大的干扰，导致建立的运动学模型和实际运动状态偏差很大，难以满足实时精确控制导管转向的需求。
5.

技术实现要素：

6.本技术提出一种导管弯曲转向控制方法、导管系统及其控制系统，以及计算机可读存储介质，能够解决相关技术中难以满足实时精确控制导管转向的需求的问题。
7.本技术第一方面实施例提出了一种导管系统。该导管系统包括机械臂，与机械臂的动力部可拆卸连接的导管器械，与机械臂通讯连接的主控器以及处理器。导管器械包括与动力部可拆卸连接的器械盒以及与器械盒连接的导管，器械盒包括被动力部驱动的驱动轮以及一端缠绕于驱动轮上、另一端沿导管延伸并固定于导管末端的驱动丝。动力部包括多个驱动电机，驱动电机、驱动轮与驱动丝一一对应。处理器被配置成执行以下步骤：根据来自于主控器的导管转向指令，获取导管末端的位置变化量，位置变化量包括方向角和弯曲角；根据位置变化量确定驱动轮中的主动轮和从动轮，并计算主动轮的角位置变化量；若导管末端满足预设条件，则控制主动轮对应的驱动电机驱动主动轮按照角位置变化量转动，同时按照从动轮对应的驱动丝零受力的目标计算从动轮对应的驱动电机的规划力，并控制从动轮对应的驱动电机按照规划力输出，预设条件包括导管末端的当前弯曲角和目标弯曲角中的至少一种属于预设范围，目标弯曲角为当前弯曲角与位置变化量中的弯曲角之和。
8.其中，在驱动主动轮转动的初始阶段，规划力被设为初始值；随后在驱动主动轮转动的过程中规划力为初始值、阻尼力与弹簧力之和，其中阻尼力是根据从动轮的速度计算得到的，弹簧力是根据从动轮的位置计算得到的。
9.其中，阻尼力的大小与速度正相关；弹簧力的大小与位置正相关。
10.其中，规划力是根据从动轮对应的驱动丝的反馈力得到的。
11.其中，处理器被配置成执行以下步骤：若从动轮的位置属于超限区，则将超限区对应的反向最大力作为规划力。
12.其中，处理器被配置成执行以下步骤：若从动轮的速度超出限速范围，则调整规划力以控制从动轮的速度回到限速范围。
13.其中，处理器被配置成执行以下步骤：若导管末端不满足预设条件，则根据主动轮的角位置变化量以及对应的从动轮的当前位置比例分配系数，计算从动轮的角位置变化量，控制从动轮对应的驱动电机驱动从动轮按照角位置变化量转动，当前位置比例分配系数用于表示在当前状态下主动轮的收线长度与对应的从动轮的放线长度的比例。
14.其中，预设范围的边界包括弯曲角最大阈值。
15.其中，驱动丝的数量为n，n为大于2的整数，n个驱动丝将导管转动段的前端平面在角度上划分为n个区间，方向角所属的区间的两端对应的驱动丝为主动驱动丝，主动驱动丝连接的驱动轮为主动轮，剩余的驱动轮中的部分或全部为从动轮。
16.本技术第二方面实施例提出了一种导管弯曲转向控制方法。该方法包括：根据来自于主控器的导管转向指令，获取导管末端的位置变化量，位置变化量包括方向角和弯曲角；根据位置变化量确定多个驱动轮中的主动轮和从动轮，并计算主动轮的角位置变化量，驱动轮与驱动电机、驱动丝一一对应设置，驱动轮上缠绕有对应的驱动丝并被对应的驱动电机驱动，驱动丝的另一端沿导管延伸并固定于导管末端；若导管末端满足预设条件，则控制主动轮对应的驱动电机驱动主动轮按照角位置变化量转动，同时按照从动轮对应的驱动丝零受力的目标计算从动轮对应的驱动电机的规划力，并控制从动轮对应的驱动电机按照规划力输出，预设条件包括导管末端的当前弯曲角和目标弯曲角中的至少一种属于预设范围，目标弯曲角为当前弯曲角与位置变化量中的弯曲角之和。
17.本技术第三方面实施例提出了一种导管系统的控制系统。该控制系统包括：存储器，用于存储计算机程序指令；及处理器，用于加载并执行计算机程序指令；其中，计算机程序指令被配置为由处理器加载并执行实现本技术第二方面所述的方法。
18.本技术第四方面实施例提出了一种计算机可读存储介质，其上存储有计算机程序指令，所述计算机程序指令被处理器执行实现本技术第二方面所述的方法。
19.本技术实施例中提供的技术方案，至少具有如下技术效果或优点：在本技术实施例中，根据来自于主控器的导管转向指令，获取导管末端的位置变化量，位置变化量包括方向角和弯曲角；根据位置变化量确定驱动轮中的主动轮和从动轮，并计算主动轮的角位置变化量；若导管末端的当前弯曲角属于预设范围，则控制主动轮对应的驱动电机驱动主动轮按照角位置变化量转动，同时按照从动轮对应的驱动丝零受力的目标计算从动轮对应的驱动电机的规划力，并控制从动轮对应的驱动电机按照规划力输出从动轮。采用导管转向指令作用下的位置变化量而非目标位置来进行控制，并且将驱动轮划分为主动轮和从动轮，根据位置变化量直接计算主动轮的角位置变化量，若导管末端满足预设条件，在控制主动轮按照角位置变化量的过程中，按照从动轮对应的驱动丝零受力的目标控制从动轮跟随转动，更适应导管末端在转动过程表现出的非线性变化，实现导管的弯曲转向，同时减少从动轮对应的驱动丝出现松紧状态异常的情况。
20.本技术附加的方面和优点将在下面的描述中部分给出，部分将从下面的描述中变
的明显，或通过本技术的实践了解到。
21.附图说明
22.通过阅读下文优选实施方式的详细描述，各种其他的优点和益处对于本领域普通技术人员将变得清楚明了。附图仅用于示出优选实施方式的目的，而并不认为是对本技术的限制。而且在整个附图中，用相同的参考符号表示相同的部件。在附图中：图1示出了本技术一实施例提供的导管系统的示意图；图2示出了本技术一实施例提供的导管器械与动力部的示意图；图3示出了本技术一实施例提供的导管器械的示意图；图4示出了本技术一实施例提供的导管弯曲转向控制方法的流程示意图；图5示出了本技术一实施例中n=3并且驱动丝均匀分布的情况下根据方向角确定主动轮及从动轮的示意图；图6示出了本技术一实施例中n=4并且驱动丝均匀分布的情况下根据方向角确定主动轮及从动轮的示意图；图7示出了本技术一具体实施例中计算主动轮的角位置变化量的流程示意图；图8示出了本技术一实施例中为转动段建立的一种运动学模型的示意图；图9示出了本技术另一具体实施例中计算主动轮的角位置变化量的流程示意图；图10示出了本技术又一具体实施例中计算主动轮的角位置变化量的流程示意图；图11示出了本技术又一具体实施例中驱动轮的关节空间划分以及对应的控制策略的示意图；图12示出了本技术一实施例提供的导管系统的控制系统的结构示意图；图13示出了本技术一实施例提供的一种计算机可读存储介质的示意图。
23.具体实施方式
24.下面将参照附图更详细地描述本技术的示例性实施方式。虽然附图中显示了本技术的示例性实施方式，然而应当理解，可以以各种形式实现本技术而不应被这里阐述的实施方式所限制。相反，提供这些实施方式是为了能够更透彻地理解本技术，并且能够将本技术的范围完整的传达给本领域的技术人员。
25.需要注意的是，除非另有说明，本技术使用的技术术语或者科学术语应当为本技术所属领域技术人员所理解的通常意义。
26.下面结合附图来描述根据本技术实施例提出的导管弯曲转向控制方法、导管系统及其控制系统，以及计算机可读存储介质。
27.图1示出了本技术一实施例提供的导管系统1000。导管系统1000包括影像车100、分别与所述影像车100连接的台车200和主控器300，可以被接合（即可拆卸地连接）至所述台车200上的导管器械400，与所述台车200连接的传感器系统500，以及用于在所述导管器械400、所述主控器300、所述传感器系统500以及所述影像车100之间实现控制的控制系统600等。其中，所述主控器300可以与所述台车200有线连接或无线连接。操作者对台车200旁
的患者执行各种程序时，可以通过操作所述主控器300触发控制指令，经所述台车200的驱动而控制所述导管器械400前进、缩回以及弯曲转向等。
28.所述台车200通常可以被移动至手术床旁，用于接合所述导管器械400，并在控制指令下控制所述导管器械400沿竖直方向进行升降，或沿水平方向平移，或非竖直以及非水平方向移动，从而为所述导管器械400的操作提供一个较好的术前准备角度。其中，该控制指令可以是来自操作者通过操作所述主控器300而触发的指令，也可以是来自操作者直接通过点击或按压所述台车200上设置的按键而触发的指令。当然，在其他实施例中，所述控制指令还可以是语音控制或通过力反馈机制而触发的指令。
29.如图1所示，进一步地，所述台车200可以包括底座210、可以沿着所述底座210进行升降移动的滑动座体220，以及与所述滑动座体220固定连接的2个机械臂230。所述机械臂230可以包括在关节处联接的多个臂分段，所述多个臂分段为所述机械臂230提供多个自由度，例如，与七个臂分段相对应的七个自由度。所述机械臂230的末端装设有动力部（图中未示出），所述机械臂230的动力部用于接合所述导管器械400，并在所述动力部的驱动作用下控制所述导管器械400的末端相应发生弯曲转向。其中，所述2个机械臂230可以是结构完全相同或部分相同的结构，一个机械臂230用于接合内导管器械410，另一个机械臂230用于接合外导管器械420。装设时，可以先安装所述外导管器械420，待所述外导管器械420安装完毕时，将所述内导管器械410的导管插入所述外导管器械420的导管内。
30.所述传感器系统500具有用于接收关于所述导管器械400的信息的一个或多个子系统。所述子系统可以包括：位置传感器系统；用于确定所述导管器械400的末端和/或沿着可构成所述导管器械400的导管的一个或多个部段的位置、取向、速度、速率、位姿和/或形状的形状传感器系统；和/或用于从所述导管器械400的末端捕获图像的可视化系统。
31.所述影像车100可以设置显示系统110以及冲洗系统（图中未示出）等。所述显示系统110用于显示由传感器系统500的子系统生成的手术部位和导管器械400的图像或表示。还可以显示由可视化系统捕获的手术部位和导管器械400的实时图像。还可以使用来自成像技术的图像数据来呈现术前或术中记录的手术部位的图像，所述成像技术诸如计算机断层扫描(ct)、磁共振成像(mri)、光学相干断层扫描(oct)、以及超声等。术前或术中图像数据可以被呈现为二维、三维或四维(如基于时间或基于速率的信息)图像和/或被呈现为来自根据术前或术中图像数据集创建的模型的图像，还可以显示虚拟导航图像。在所述虚拟导航图像中，所述导管器械400的实际位置与术前图像配准，以从外部向操作者呈现手术部位内的导管器械400的虚拟图像。
32.所述控制系统600包括至少一个存储器和至少一个处理器。可以理解的是，所述控制系统600可以集成于所述台车200或所述影像车100中，也可以独立设置。所述控制系统600可以支持无线通信协议，诸如ieee 802 .11、irda、蓝牙、homerf、dect和无线遥测等。所述控制系统600可以传输指示所述导管器械400移动的一个或多个由所述动力部移动所述导管器械400的信号。所述导管器械400可以经由所述患者的自然腔道的开口或手术切口延伸至体内的手术位置。
33.进一步地，所述控制系统600可以包括机械控制系统（图中未示出）和图像处理系统（图中未示出），所述机械控制系统用于控制所述导管器械400的移动，因此，可以集成于所述台车200中。所述图像处理系统用于虚拟导航路径规划，因此，可以集成于所述影像车
100中。当然，所述控制系统600的各个子系统并不限于上述列举的具体情况，还可以根据实际情况合理设置。其中，所述图像处理系统可以基于术前或术中记录的手术部位的图像，使用上述成像技术对手术部位进行成像。还可以与手动输入结合使用的软件将记录的图像转换成部分或整个解剖器官或区段的二维或三维合成图像。在虚拟导航程序期间，所述传感器系统500可用于计算导管器械400相对于患者的解剖结构的位置，该位置可用于产生患者的解剖结构的外部跟踪图像和内部虚拟图像，实现导管器械400的实际位置与术前图像配准，从而可以从外部向操作者呈现手术部位内的导管器械400的虚拟图像。
34.所述内导管器械410和所述外导管器械420的结构组成大体相同，分别具有细长柔性的内导管41和外导管42，其中，所述外导管42的直径略大于所述内导管41，以使所述内导管41可以穿过所述外导管42，并为所述内导管41提供一定的支撑性，从而可以使得所述内导管41可以到达患者体内的目标位置，以便于从目标位置处进行组织或细胞取样等操作。
35.所述主控器300的某些运动可以引起导管器械400的对应移动。例如，操作者操作主控器300的方向拨杆向上或向下移动时，所述主控器300的方向拨杆的运动可以被映射到所述导管器械400的末端相应的俯仰运动；当操作者操作主控器300的方向拨杆向左或向右移动时，所述主控器300的方向拨杆的运动可以被映射到所述导管器械400的末端相应的横摆运动。在本实施例中，所述主控器300可以控制所述导管器械400的末端在360
°
空间范围内进行移动。
36.图2和图3示出了本技术一实施例提供的导管器械400。所述导管器械400与机械臂230的动力部240可拆卸连接，所述导管器械400包括与所述动力部240可拆卸连接的器械盒45以及与所述器械盒45连接的导管48。其中，所述器械盒45安装至所述动力部240时，所述动力部240的驱动力可以传递至所述器械盒45内、并能使所述导管48发生正常移动的状态。例如，在所述动力部240的驱动力作用下，所述导管48的末端可以发生弯曲转向等。
37.器械盒45包括多个被动力部240驱动的驱动轮451以及多根驱动丝452，动力部240包括多个驱动电机241，驱动电机241、驱动轮451与驱动丝452一一对应设置。每个驱动轮451与对应的驱动电机241可拆卸连接，所述器械盒45安装至所述动力部240时，对应的驱动电机241可以带动该驱动轮451旋转，并且该驱动轮451上缠绕有对应的驱动丝452，对应的驱动丝452的活动部分，即未缠绕在该驱动轮451上的部分伸入导管48，沿导管48的长度方向延伸并最终固定于导管末端。
38.本技术中的末端，也可以被称为远端或头部，是指远离器械盒45的一端；前端，也可以被称为近端或尾部，是指靠近器械盒45的一端。
39.导管48的包括末端在内的一部分为转动段49，转动段49的末端即为导管48的末端。转动段49可以为关节组件，该关节组件在伸缩方向上具有高刚度，在弯曲方向上具有低刚度，可在驱动丝452的控制下弯曲，从而实现导管48的转向。在某些实施例中，该关节组件可以被称为蛇骨。
40.在转动段49的垂直于长度方向的平面内，各驱动丝452的位置可以认为是固定不变的，同时驱动丝452可以沿着转动段49的长度方向伸长或缩短。驱动丝452末端固定于转动段49的末端，并不一定意味着驱动丝452末端固定的位置位于转动段49的末端平面内。实际应用中，为更好的保护导管48可能搭载的器件（如内窥镜、手术器械等），驱动丝452末端可以固定在从转动段49的末端平面向近端移动一小段距离的位置。这种情况下，若这段距
离与转动段49长度的比值小于一阈值，在驱动导管48末端转向的过程中可以视为驱动丝452末端固定的位置就在转动段49的末端平面内。
41.驱动轮451可以在对应的驱动电机241的驱动下顺时针或逆时针旋转。若驱动轮451朝一个方向旋转会使得对应的驱动丝452的更多部分缠绕在驱动轮451上，即部分原本属于活动部分的驱动丝452进入缠绕状态，导致活动部分的长度缩短，这个过程也可以被称为拉动驱动丝452或者说拉线/收线，为便于描述，该方向被称为正向。若驱动轮451朝一个方向旋转会使得驱动丝452的更少部分缠绕在驱动轮451上，即部分原本缠绕在驱动轮451上的驱动丝452变为活动部分，导致活动部分的长度变长，这个过程也可以被称为放线，为便于描述，该方向被称为反向。可以根据对应驱动丝452的缠绕方向决定顺时针和逆时针中哪一个是正向哪一个是反向。
42.控制系统600的处理器被配置为执行以下步骤以实现本技术一实施例提供的导管弯曲转向控制方法。如图4所示，本方法包括：步骤s11：根据来自于主控器的导管转向指令，获取导管末端的位置变化量。
43.位置变化量可以包括用于控制导管弯曲转向的方向角α和弯曲角θ。用户可以操作主控器上的方向拨杆、按键等输入设备中的至少一种来输入导管转向指令。
44.以方向拨杆为例说明，用户可以向操作平面内的任意方向拨动方向拨杆，这一操作在主控器内传感器的作用下转换为电信号，即为导管转向指令，具体包括在主控器的两条相互垂直的轴（即操作平面的轴）上采集到的第一电压和第二电压。根据第一电压和第二电压的比值计算用户操作的方向角度，具体的，可以计算该比值的反正切函数或反余切函数得到用户操作的方向角度。
45.计算第一电压和第二电压的平方和的算术平方根作为第一电压和第二电压的合成值。合成值反映了用户操作的力度，根据合成值可以计算得到导管末端转向的弯曲速度，例如可以计算合成值与预设系数的乘积作为弯曲速度。用户操作的弯曲角是计算弯曲速度对命令保持时间的积分得到的，命令保持时间是指同样的用户操作持续的时间。
46.控制间隔，即相邻两次导管末端的转向控制之间的间隔。在某些实施例中，每个控制间隔之内只会存在一个导管转向指令，并且主控器的采样间隔固定，此时可以省去积分的过程，而直接将弯曲速度作为用户操作的弯曲角θ。
47.为减少操作者的抖动、主控器的噪声等带来的影响，可以对采集到的第一电压和第二电压平滑滤波之后再计算用户操作的方向角和弯曲角。
48.可以直接将用户操作的弯曲角作为位置变化量中的弯曲角θ。并且，若操作平面的坐标系与导管转动段的前端平面的坐标系方向一致，即二者之间的旋转角度为0，那么可以直接采用用户操作的方向角度作为位置变化量中的方向角α，否则可以根据两个坐标系之间的映射关系对用户操作的方向角度进行变换，得到方向角α。
49.或者，除了必要的角度变换之外，为了使转向更平滑，减少跳变，可以对计算得到用户操作的方向角和弯曲角分割为多份之后得到位置变化量中的方向角α和弯曲角θ。例如，用户操作的弯曲角是30
°
，可以将本次用户输入的导管转向指令分10次完成，每次使用的位置变化量中的弯曲角θ为3
°
。
50.步骤s12：根据位置变化量确定驱动轮中的主动轮和从动轮，并计算主动轮的角位置变化量。
51.为简化描述，之后的位置变化量中的方向角α简称为方向角变化量α，位置变化量中的弯曲角θ简称为弯曲角变化量θ，与用户操作输入的方向角和弯曲角不一定相同。
52.为便于描述转动段的姿态，分别为转动段的前端平面和末端平面建立坐标系，为简化计算，坐标系的重点均为平面的中心。某根驱动丝在前端/末端平面内的坐标是指该驱动丝在前端/末端平面内的固定位置的坐标，角度是指从原点指向该驱动丝的坐标的矢量与前端/末端平面的x轴正向之间的夹角。同一根驱动丝在这两个坐标系中的坐标和角度一致。
53.装配好的导管处于自然状态时，即末端未转向的状态时，转动段的末端平面的坐标系一般与前端平面的坐标系方向一致。在控制导管末端弯曲/转向的过程中，可以认为转动段前端平面的坐标系维持不变，末端平面的坐标系会在驱动丝的作用下发生变化。
54.装配好的导管处于自然状态时，各个驱动轮上的驱动丝可以维持在一个合适的松紧状态。若对某根驱动丝进行拉线，该驱动丝会带动导管末端朝其固定的方位弯曲转向，导管末端的弯曲会拉扯其他驱动丝中的部分或全部。如果驱动丝受到的由导管末端弯曲带来的拉力足够大，那么会带动对应的驱动轮反向转动一小段距离，这段距离一般受到驱动丝的松紧状态和弹性模量影响。在反向转动的过程中，由于拉力的变化是不连续的，力的跳变会导致对应的驱动轮的速度跳变，可能导致松线。转完这段距离后，驱动丝被拉紧，如果对应的电机不带动驱动轮跟随转动，会导致导管卡住。如果驱动丝受到的由导管末端弯曲带来的拉力不足以克服阻力让其带动对应的驱动轮反向转动，那么驱动丝被拉紧到系统参数（例如机械结构与尺寸、材料特性等）决定的极限之后也会导致导管卡住。导管卡住意味着主动轮无法继续收线，往往导致主动轮无法转动到角位置变化量指示的位置，导管末端无法正常弯曲到目标位置。因此，为使得主动轮能够正常收线，被拉扯的驱动丝对应的驱动轮中的部分或全部需要作为从动轮跟随放线。
55.以一对相对设置的驱动轮为例说明，相对设置是指两个驱动轮对应的驱动丝在导管末端固定的位置的连线经过导管末端平面的中心，即驱动丝之间的角度差为π，其中一个驱动轮作为主动轮正向旋转拉线时，另一个驱动轮作为从动轮需要跟随放线。
56.驱动丝的数量为n，n为大于2的整数，n个驱动丝将导管转动段的前端平面在角度上划分为n个区间。可以将方向角变化量α所属的区间的两端对应的驱动丝作为主动驱动丝，主动驱动丝连接的驱动轮为主动轮。剩余的驱动轮中的部分或全部为从动轮。这里判断方向角变化量α所属的区间时，不包括区间的端点。若方向角变化量α落在某个端点上，即与某个驱动丝的角度相同时，可以只选择该驱动丝作为主动驱动丝。在某些实施例中，若驱动丝的数量和位置支持，主动轮的数量可以大于2。在确定主动轮的情况下，可以根据驱动丝的数量和位置分布，从除主动轮之外的驱动轮中选择部分或全部作为从动轮。
57.下面结合附图举例说明主动轮和从动轮的具体确认方式。为简化描述，在下面的示例中，对应的驱动丝、驱动轮和电机的序号均相同，实际可能不同；驱动丝均为均匀分布，实际可能不是均匀分布。
58.示例一：在本示例中，n=3并且驱动丝均匀分布，驱动丝1，2，3在转动段的前端平面坐标系中的角度分别为0,2π/3,4π/3。
59.若方向角变化量为0,2π/3,4π/3中的一个，则角度与方向角变化量相同的驱动丝
连接的驱动轮为主动轮，剩余的两个驱动轮为从动轮。
60.若方向角变化量，即落入图5中a部分的阴影，则驱动轮1和2为主动轮，驱动轮3为从动轮。
61.若方向角变化量，即落入图5中b部分的阴影，则驱动轮2和3为主动轮，驱动轮1为从动轮。
62.若方向角变化量，即落入图5中c部分的阴影，则驱动轮3和1为主动轮，驱动轮2为从动轮。
63.示例二：在本示例中，n=4并且驱动丝均匀分布，驱动丝5，6，7，8在转动段的前端平面坐标系中的角度分别为0,π/2，π，3π/2。
64.若方向角变化量为0,π/2，π，3π/2中的一个，则角度与方向角变化量相同的驱动丝连接的驱动轮为主动轮，与主动轮相对设置的驱动轮为从动轮。例如，若方向角变化量为π/2，则驱动轮6为主动轮，驱动轮8为从动轮，驱动轮5和7既不是主动轮也不是从动轮，即无需转动。
65.若方向角变化量，即落入图6中a部分的阴影，则驱动轮5和6为主动轮，驱动轮7和8为从动轮。
66.若方向角变化量，即落入图6中b部分的阴影，则驱动轮6和7为主动轮，驱动轮8和5为从动轮。
67.若方向角变化量，即落入图6中c部分的阴影，则驱动轮7和8为主动轮，驱动轮5和6为从动轮。
68.若方向角变化量，即落入图6中d部分的阴影，则驱动轮8和5为主动轮，驱动轮6和7为从动轮。
69.以此类推，n为大于4的奇数且驱动丝均匀分布的情况下，若方向角变化量与某根驱动丝的角度相同，则可以选择该驱动丝对应的驱动轮作为主动轮，角度与方向角变化量的反向角最接近的两条驱动丝对应的驱动轮作为从动轮；若方向角变化量与某根驱动丝的角度相同，则可以选择该驱动丝对应的驱动轮作为从动轮，角度与方向角变化量最接近的两条驱动丝对应的驱动轮作为主动轮；若方向角变化量及其与任意驱动丝的角度均不相同，则可以选择角度与方向角变化量最接近的两条驱动丝对应的驱动轮作为主动轮，角度与方向角变化量的反向角最接近的两条驱动丝对应的驱动轮作为从动轮。未被选中的驱动轮无需运动。
70.n为大于4的偶数且驱动丝均匀分布的情况下，若方向角变化量与某根驱动丝的角度相同，则可以选择该驱动丝对应的驱动轮作为主动轮，角度与方向角变化量的反向角相同的驱动丝对应的驱动轮作为从动轮；若方向角变化量与任意驱动丝的角度均不相同，则可以选择角度与方向角变化量最接近的两条驱动丝对应的驱动轮作为主动轮，角
度与方向角变化量的反向角最接近的两条驱动丝对应的驱动轮作为从动轮。未被选中的驱动轮无需运动。
71.此外，存在一种特殊的n=2的情况，即两根驱动丝相对设置，这种情况下驱动丝控制导管末端转动的方向角变化量实际仅可以为两根驱动丝其中之一的角度，与方向角变化量相同的驱动丝对应的驱动轮为主动轮，另一个驱动轮为从动轮。
72.一般来说，在驱动丝的作用下，转动段/导管末端可以以两个自由度进行弯曲，转动段/导管末端的状态/位姿可以用两个联合变量——弯曲角和方向角来描述。通常的，方向角用于描述转动段/导管末端朝哪个方向弯曲，其取值范围大小可以为2π，具体范围可以根据实际需要而定，例如为[0, 2π]，[-π,π]等；弯曲角用于描述转动段/导管末端的弯曲程度，其取值范围的下限可以为0，表示未弯曲的自然状态，上限可以根据实际情况而定，一般不超过π，例如可以为π/2，2π/3等。
[0073]
在位置变化量的作用下，导管末端从当前状态变换到目标状态，也就是从当前位姿变换至目标位姿。在导管转向控制中，主要关注导管末端从当前位置到目标位置的变换，并据此计算主动驱动丝的长度变化，也就是主动轮的收线长度，再计算主动轮的角位置变化量。以下结合附图举例说明主动轮的角位置变化量的具体计算过程。
[0074]
如图7所示，在本技术一具体实施例中，计算所述主动轮的角位置变化量包括以下子步骤：s101：计算导管末端在位置变化量作用下的位置增量偏移。
[0075]
由于转动段的结构设计，在弯曲转向的过程中，转动段可以近似作为圆弧来处理。可以基于这一特性为转动段建立运动学模型，并基于该运动学模型计算位置增量偏移。
[0076]
举例说明，可以为转动段建立如图8所示的运动学模型，其中，转动段的长度为l，在垂直于长度方向上转动段被抽象为半径为r的圆。转动段的前端坐标系为，xoy平面即为前端平面且原点为前端平面的圆心，在转动过程中可以按照固定不动来处理，起到类似于世界坐标系的作用。当前状态下转动段的末端坐标系为，xoy平面即为末端平面且原点为末端平面的圆心。当前状态下转动段的末端坐标系相对于前端坐标系的变换可以用当前方向角和当前弯曲角来描述。更具体地，当前弯曲角为当前状态下前端平面的圆心到末端平面的圆心形成的长度为l圆弧的圆弧角，当前方向角为当前状态下末端坐标系的xoy平面相对于前端坐标系的xoy平面的旋转角度。基于该模型，在笛卡尔坐标系中，当前状态下末端坐标系相对于前端坐标系的变换矩阵可以表示为：其中表示当前状态下末端坐标系相对于前端坐标系的姿态变换；表示当前状态下末端坐标系相对于前端坐标系的位置变换，可以用当前状态下前端平面的圆心指向末端平面的圆心的矢量来表示。
[0077]
计算当前方向角与位置变化量中的方向角之和作为目标方向角，计算当前弯曲角与位置变化量中的弯曲角之和作为目标弯曲角。实际应用中，若计算得到的目标方向角超出设定的取值范围，则可以将其加上2π或减去2π以回到取值范围内；若计算得到的目标弯曲角大于弯曲角取值范围的上限，则可以将其修正为弯曲角取值范围的上限；若计算得到的目标弯曲角为负数，则根据方向角的取值范围将目标方向角加
上π或减去π以变为其反向，并将目标弯曲角修改为其绝对值。
[0078]
在笛卡尔坐标系中，目标状态下末端坐标系相对于前端坐标系的变换矩阵可以表示为：其中表示目标状态下末端坐标系相对于前端坐标系的姿态变换；表示目标状态下末端坐标系相对于前端坐标系的位置变换，可以用目标状态下前端平面的圆心指向末端平面的圆心的矢量来表示。
[0079]
根据当前状态下的位置变换和目标状态下的位置变换可以计算得到位置增量偏移，可以用当前状态下末端平面的圆心指向目标状态下末端平面的圆心的矢量来表示。
[0080]
s102：根据位置增量偏移计算各个主动轮的收线长度。
[0081]
位置增量偏移描述的是导管末端从当前位置到目标位置的变换。可以在上述运动学模型中加入驱动丝，每根驱动丝的固定位置设定在垂直于长度方向的圆上，驱动丝在长度方向上可以作为直线、圆弧、多段折线、或多段弧线来处理。在讨论运动学模型相关的内容时，除特意指出的部分之外，所提到的驱动丝一般是指转动段内的驱动丝。根据运动学模型，可以计算出位置增量偏移与主动轮收线长度（即主动驱动丝的缩短量）之间的映射函数，再代入s101得到的位置增量偏移即可计算得到各主动轮的收线长度。
[0082]
映射函数可以为根据运动学模型算出来的解析解，或者是为了简化计算用近似、拟合等方式对解析解处理得到的函数。
[0083]
s103：根据主动轮的收线长度计算对应的主动轮的角位置变化量。
[0084]
具体的，结合驱动轮的几何参数（例如驱动丝的缠绕半径）以及主动轮的收线长度可以计算得到角位置变化量的数值，再根据驱动丝的缠绕方向可以确定主动轮的转动方向（顺时针或逆时针），二者结合，即可得到主动轮的角位置变化量。
[0085]
如图9所示，在本技术另一具体实施例中，计算所述主动轮的角位置变化量包括以下子步骤：s111：获取转动段的运动学模型。
[0086]
s112：根据运动学模型计算当前状态下与在位置变化量作用的目标状态下的主动驱动丝的长度差值作为主动轮的收线长度。
[0087]
仍以图8所示的运动学模型来举例说明，驱动丝的数量为4且均匀分布，每根驱动丝被抽象为直线进行处理。图8中下方的平面为前端平面，用i-1表示，b1，b2，b3，b4分别为驱动丝1，2，3，4在前端平面的固定点，o为前端平面的中心，为便于计算，定义ob1为前端坐标系的x轴正向，ob2为前端坐标系的y轴正向，前端坐标系的z轴垂直于前端平面且指向末端平面。图8中上方的平面为末端平面，用i表示，p1，p2，p3，p4分别为驱动丝1，2，3，4在末端平面的固定点，c为末端平面的中心，为便于计算，定义cp1为末端坐标系的x轴正向，cp2为末端坐标系的y轴正向，末端坐标系的z轴垂直于末端平面且指向远离前端平面的一侧。
[0088]
根据该模型，可得当前状态下第j根驱动丝的长度：
其中j=1,2,3,4。
[0089]
将目标状态代入上述公式，可以得到目标状态下第j根驱动丝的长度：的长度：根据前面确定的主动轮的编号，计算主动驱动丝在当前状态与目标状态之间的长度变化量作为主动轮的收线长度。若编号为j的驱动轮为主动轮，根据运动学模型直接计算得到的收线长度为：可以用近似、拟合等方式对上述公式进行处理以简化计算。
[0090]
s113：根据主动轮的收线长度计算主动轮的角位置变化量。
[0091]
具体的，结合驱动轮的几何参数（例如驱动丝的缠绕半径）以及主动轮的收线长度可以计算得到角位置变化量的数值，再根据驱动丝的缠绕方向可以确定主动轮的转动方向（顺时针或逆时针），二者结合，即可得到主动轮的角位置变化量。
[0092]
如图10所示，在本技术又一具体实施例中，计算所述主动轮的角位置变化量包括以下子步骤：s121：至少根据弯曲角计算单轮收线长度。
[0093]
在本实施例中对收线长度的计算进行了进一步的分解。若方向角变化量与某根驱动丝的角度一致，则只会选择该根驱动丝对应的驱动轮作为主动轮，这种情况下该主动轮的收线长度即为单轮收线长度。单轮收线长度不受实际的方向角变化量影响，由转动段末端的当前弯曲角和弯曲角变化量即可确定。
[0094]
仍以图8所示的运动模型来举例说明，该运动模型的具体描述可参考前述实施例的相关内容。根据模型直接计算得到的单轮收线长度为：可以用近似、拟合等方式对上述公式进行处理以简化计算。
[0095]
s122：根据单轮收线长度以及方向角计算各个主动轮的收线长度。
[0096]
实际控制过程中方向角变化量往往与驱动丝的角度均不相同，需要两个驱动轮协作拉线才能控制导管末端按照方向角变化量转向。可以按照方向角变化量与各主动驱动丝之间的夹角，将单轮收线长度映射为各主动轮的收线长度。
[0097]
s123：根据主动轮的收线长度计算对应的主动轮的角位置变化量。
[0098]
具体的，结合驱动轮的几何参数（例如驱动丝的缠绕半径）以及主动轮的收线长度可以计算得到角位置变化量的数值，再根据驱动丝的缠绕方向可以确定主动轮的转动方向（顺时针或逆时针），二者结合，即可得到主动轮的角位置变化量。
[0099]
在上述给出的运动学模型的例子中将驱动丝作为直线处理，然而该模型与实际情况存在误差，并且随着转动段/导管末端的弯曲角的增大误差会呈现非线性的扩大。为提高转向控制的准确性，可以选择更复杂但更准确的运动学模型，例如将驱动丝作为多段折线/多段弧线来处理，将转动段作为多段圆弧来处理等。此外，可以根据需要引入除运动学模型之外的其他计算方式来修改收线长度的计算公式和/或修正模型计算的结果。
[0100]
上述给出的计算方式可以择一使用，也可以结合使用，例如根据弯曲角分段式的选择其中一种计算方式，可以通过实验来确定如何对弯曲角分段和/或各段对应的计算方式，以满足对转向控制的准确性和/或实时性的要求。
[0101]
步骤s13：若导管末端满足预设条件，则控制主动轮对应的驱动电机驱动主动轮按照角位置变化量转动，同时按照从动轮对应的驱动丝零受力的目标计算从动轮对应的驱动电机的规划力，并控制从动轮对应的驱动电机按照规划力输出。
[0102]
可以基于驱动轮与对应的驱动电机之间接合的方式，根据s12中得到的主动轮的角位置变化量计算对应的驱动电机的角位置变化量。
[0103]
驱动电机可以具有三种基础的控制模式：位置控制、速度控制、和电流控制（也可以被称为力矩控制或者扭矩控制）。可以选择位置控制，此时驱动电机的控制量为角位置，可以计算驱动电机的当前角位置与角位置变化量之和作为目标角位置，并发给驱动电机的控制器；或者可以直接将驱动电机的角位置变化量发送给驱动电机的控制器，由控制器计算目标角位置。或者可以选择速度控制，此时驱动电机的控制量为角速度，将驱动电机的角位置变化量除以控制间隔可以得到角速度，并发给驱动电机的控制器。
[0104]
此外，驱动电机一般使用三环控制，从内向外依次为电流环、速度环和位置环，外部环的输出是其内部相邻的环的输入。驱动电机的控制器可以自行完成三环控制，也可以将3个环中的部分或全部交由上位机（本技术中为控制系统600的处理器）来处理。例如，原本使用角位置作为控制量的情况下，可以选择将电机控制的位置环由上位机来处理，此时处理器将位置环处理后的角速度发送给驱动电机的控制器。
[0105]
对于从动轮，可以采用和主动轮一样的位置控制，即计算从动轮的角位置变化量，并据此控制从动轮对应的驱动电机驱动从动轮按照角位置变化量转动。为此引入一个参数：位置比例分配系数，用于表示主动轮的收线长度与对应的从动轮的放线长度的比例，使用某个从动轮的位置比例分配系数以及s12中计算得到的对应的主动轮的收线长度，可以计算出该从动轮的放线长度，对于配有n个驱动轮的导管，理论上每个驱动轮可以具有n-1个位置比例分配系数，分别用于表示除自身外其他各驱动轮作为主动轮时自身作为从动轮的位置比例分配系数。对于第i个驱动轮，其位置比例分配系数可以表示为集合[k
ij
]，i,j=1,
…
,n且i≠j。实际应用中，根据驱动轮的数量和对应驱动丝的位置分布，某些位置比例分配系数可以固定作为0来处理，这种情况下这些位置比例分配系数可以从集合中省去。例如，n=4且驱动丝均匀分布的情况下，相邻的两根驱动丝对应的驱动轮彼此之间的位置比例分配系数可以固定作为0处理，只保留两对相对设置的驱动轮之间的位置比例分配系数。
[0106]
若转动段可以当作刚体来处理，那么位置比例分配系数是一个常数。然而转动段在运动过程中的形变往往是不可忽略的，实际位置比例分配系数是非线性变化的。为更准确的描述位置比例分配系数，定义当前位置比例分配系数，用于表示在当前状态下主动轮
的收线长度与对应的从动轮的放线长度的比例。
[0107]
若当前位置比例分配系数为对应的从动轮放线长度与主动轮收线长度的比值，从动轮的角位置变化量可以为从动轮对应的主动轮的角位置变化量与当前位置比例分配系数的乘积之和。
[0108]
从动轮的角位置变化量的计算函数可以是独立的，也可以与主动轮的角位置变化量的计算函数组合在一起。例如，若采用位置增量偏移进行计算，可以为所有的驱动轮设定一组合函数——角度增量分配函数，该函数的输入可以包括当前位置比例分配系数、位置变化量中的方向角以及位置增量偏移，根据输入，该函数可以确定主动轮与从动轮，计算主动轮的角位置变化量，并以及从动轮的角位置变化量，最后输出各驱动轮的角位置变化量。
[0109]
在本步骤之前，可以先获取当前位置比例分配系数。将导管末端的当前弯曲角输入预存的映射关系，得到从动轮的当前位置比例分配系数。映射关系的输出包括当前位置比例分配系数，输入至少包括当前弯曲角。
[0110]
可以预先采集多组测试样本，对样本进行分段函数、曲线（例如多项式）拟合、神经网络训练等方式的处理，得到映射关系。样本的采集过程中可以采用手动控制的方式调整从动轮到合适的位置，即满足放线条件的位置，再记录从动轮的角位置以计算放线长度/角位置变化量，放线条件可以包括主动轮本次运动到目标位置且从动轮上缠绕的从动驱动丝维持合适的松紧状态。
[0111]
根据转动段的结构设计，位置比例分配系数的非线性变化至少对弯曲角敏感，每组样本至少包括当前弯曲角，本次运动的弯曲角变化量和目标弯曲角中的至少一种，主动轮的收线长度、角位置变化量和角位置中的至少一种，从动轮的放线长度、角位置变化量和角位置中的至少一种。当然，可以在映射关系的自变量中引入方向角，此时样本可以进一步包括当前方向角，本次运动的方向角变化量和目标方向角中的至少一种。
[0112]
例如，n=4且驱动丝均匀分布的情况下，可以选择一根驱动丝，从自然状态开始单独拉伸该驱动丝直至达到设定的弯曲角最大范围，这个过程中采集多组样本，每组样本包括主动轮的角位置、从动轮的角位置以及当前弯曲角。对第m组样本，可以计算其与第m-1组样本中的主动轮和从动轮的角位置之差，再计算从动轮角位置之差与主动轮角位置之差的比值，作为第m组样本的当前位置比例分配系数。映射关系可以选择高阶多项式的形式，输入为当前弯曲角，输出为当前位置比例分配系数，采用多组样本进行拟合确定多项式中各项的系数，得到最终的映射关系以供后续控制中使用。
[0113]
可以看出，上述从动轮的位置控制方案中，控制效果的好坏与位置比例分配系数的准确度直接相关，而位置比例分配系数的非线性变化来自于转动段的结构设计，导管末端的弯曲角越大，即越远离未弯曲状态的位置，位置比例分配系数的非线性变化表现的越明显。
[0114]
为了改善控制效果，上述位置控制方案中，预先采集多组样本处理得到映射关系以计算当前位置比例分配系数。然而，由于导管的材料特性和装配工艺不一致，不同的导管采集到的样本不同，甚至可能需要使用不同的模型来构建映射关系，这就要求在使用每一套导管之前都需要为其采集样本并处理得到该导管的映射关系，这需要耗费大量的时间。此外，在导管末端弯曲程度较大的区域，若采集到的样本不够多或者选择的模型不合适，可
能导致使用映射关系计算出的当前位置比例分配系数存在较大误差，导致在导管弯曲转向过程中卡住或者从动轮松线，影响控制效果。
[0115]
为至少部分解决上述问题，至少在导管末端满足预设条件的情况下，采用力模式控制从动轮对应的驱动电机，控制目标为从动轮对应的驱动丝零受力，就是让从动轮对应的驱动丝可以顺应外力（这里是指导管弯曲带来的拉力）而动仿佛它处在一个受力为零的环境下，这种控制方式也可以被称为对从动轮对应的驱动丝的零力控制。
[0116]
预设条件包括导管末端的当前弯曲角和目标弯曲角中的至少一种属于预设范围。具体的，预设条件可以为当前弯曲角属于预设范围，或者目标弯曲角属于预设范围，或者当前弯曲角和目标弯曲角中的任意一种属于预设范围，或者当前弯曲角和目标弯曲角均属于预设范围。
[0117]
若导管末端不满足预设条件，可以仍旧采用力模式对从动轮对应的驱动丝进行零力控制，或者可以采用和主动轮一样的位置控制。如果采用力模式，则可以省去采集样本和构建映射关系的过程。如果采用位置控制，由于预设范围外位置比例分配系数的非线性变化更不明显，较少的样本和简单的模型即可构建出足够精确的映射关系，甚至可以将位置比例分配系数的变化视为线性来处理。
[0118]
由于从动轮的位置控制在导管末端弯曲程度较大的区域效果较差，预设范围一般包括远离弯曲角的初始值（即未弯曲状态下的弯曲角）的范围。具体的，预设范围的边界可以包括弯曲角最大阈值，除弯曲角最大阈值之外，预设范围的另一个边界可以被称为弯曲角过渡阈值。导管末端的弯曲角最大阈值为tm，弯曲角过渡阈值为tg，那么预设范围可以表示为[tg, tm]。
[0119]
弯曲角过渡阈值tg的取值范围为[0, tm)，可以根据需求来设定弯曲角过渡阈值tg的值，例如，以预设范围外位置比例分配系数的变化可以视为线性为目标，根据系统参数（如机械结构与尺寸、材料特性等）估算弯曲角过渡阈值tg或者采集样本来拟合弯曲角与位置比例分配系数之间的映射关系从而确定弯曲角过渡阈值tg。
[0120]
为实现从动轮对应的驱动丝零受力的目标，可以在控制主动轮转动的过程中，实时获取从动轮对应的驱动丝受到的力，并据此设置从动轮对应的驱动电机的规划力，例如规划力可以与从动轮对应的驱动丝受到的力相同，实现从动轮对主动轮的跟随放线。为便于描述，在本技术中，各个力具有方向和大小两个属性，其中方向被简化为正向和反向。正向可以是指向远离导管末端的方向，正向的力起到带动收线或者阻碍放线的作用；反向可以是指向导管末端的方向，反向的力起到带动放线或者阻碍收线的作用。当然也可以反过来，正向是指向导管末端的方向，正向的力起到带动放线或者阻碍收线的作用；反向可以是指向远离导管末端的方向，反向的力起到带动收线或者阻碍放线的作用。以下以正向是指向远离导管末端的方向，反向是指向导管末端的方向为例进行说明。
[0121]
在某些实施例中，驱动轮和/或驱动丝上可以设有力/力矩传感器，根据从动轮和/或其对应的驱动丝上设置的力/力矩传感器的反馈值可以直接或间接得到从动轮对应的驱动丝上受到的力，即反馈力。然后可以根据从动轮对应的驱动丝的反馈力设置规划力，例如可以设置规划力等于反馈力。
[0122]
若驱动轮和驱动丝上均未设置力/力矩传感器，则需要借助位置传感器来间接获取从动轮对应的驱动丝所受的力。位置传感器可以是设置在驱动电机上的或者是设置在驱
动轮/驱动丝上的，直接测量的对象可以是角位置或是直线位置。例如，位置传感器可以是驱动电机的编码器。
[0123]
在放线过程中，驱动丝可以被视为一个弹簧-阻尼系统，根据弹簧-阻尼系统的模型，驱动丝所受的阻力为弹簧力和阻尼力之和，弹簧力的大小与驱动丝的位置成正比，方向与位置的方向相反，可以用位置传感器反馈的位置计算得到驱动丝的位置；阻尼力的大小与速度成正比，方向与速度相反，驱动丝的速度可以是计算驱动丝的位置对时间的微分得到的。
[0124]
使用位置传感器正确的得到从动轮对应的驱动丝所受的力的前提是驱动丝在外力（驱动电机输出的力和/或导管末端弯曲带来的拉力）的作用下能够转动起来。在控制主动轮对应的电机驱动主动轮转动的初始阶段，导管末端在主动轮收线的作用下开始弯曲转向，给从动轮对应的驱动丝带来拉力，从动轮对应的驱动丝实际受力发生了变化。如果这一拉力不足以克服阻力，从动轮就不会转动，从传感器得到的位置和速度都保持不变，计算出的驱动丝受力保持不变，与实际情况不符，无法准确的控制从动轮的转动，仍旧可能导致导管卡住。
[0125]
为至少部分解决上述问题，在驱动主动轮转动的初始阶段，可以给驱动丝一个初始的力来协助克服阻力，即将规划力设为初始值。初始值的大小可以是根据实验测到的，也可以是根据系统参数（如机械结构与尺寸、材料特性等）估算得到的，方向为反向。在初始值的作用下，从动轮会直接开始转动放线，或者暂时不转动，随后在导管末端带来的拉力的作用下开始转动放线。
[0126]
不同驱动轮对应的初始值可以相同，也可以不同。对于某个驱动轮，初始值可以是单个固定值；或者是将预设范围进一步划分为至少两个部分，每个部分对应一个初始值；或者是预先通过实验/建模等方式得到自变量包括弯曲角的用于计算初始值的函数，再使用该函数计算得到初始值。一般来说，合适的初始值应该满足在对应的驱动丝被导管末端拉紧到系统参数（例如机械结构与尺寸、材料特性等）决定的极限之前，能够协助从动轮开始转动。
[0127]
随后在驱动主动轮转动的过程中，规划力等于初始值、阻尼力与弹簧力之和，导管末端带来的拉力变化会影响驱动轮的速度和位置，进而影响阻尼力和弹簧力，进而影响计算出的规划力。
[0128]
除初始阶段之外，规划力的计算公式可以表示为：f
prf
=f0+fv+f
p
其中f
prf
为规划力，f0为初始值，fv为阻尼力，f
p
为弹簧力。
[0129]
举例说明，位置传感器是设置在驱动电机上的编码器，可以反馈电机的当前角位置，根据电机和驱动轮的尺寸信息及装配关系，可以换算得到驱动轮的位置。或者，在驱动轮上设置有编码器，从该编码器的反馈信号可以直接得到驱动轮的位置。计算驱动轮的位置对速度的微分可以得到驱动轮的速度，例如，将驱动轮的当前位置减去前一位置得到二者之差，再除以两次编码器反馈时刻之间的时间间隔，即可得到驱动轮的当前速度。
[0130]
阻尼力是根据从动轮的速度计算得到的，具体的，阻尼力的大小与速度正相关。如果严格按照弹簧-阻尼系统的模型，阻尼力的大小与速度成正比，比例系数可以被称为阻尼系数。然而实际应用中，出于实际需要，可以在模型的基础上对阻尼力的计算公式进行调
整，调整之后的阻尼力与速度不一定能始终维持正比的关系。但总体而言，随着当前的速度的大小的增大，阻尼力的大小随之增大或保持不变，将这种关系定义为阻尼力与速度正相关。
[0131]
弹簧力是根据从动轮的位置计算得到的，具体的，弹簧力的大小与位置正相关。如果严格按照弹簧-阻尼系统的模型，弹簧力的大小与位置成正比，比例系数可以被称为弹簧系数。然而实际应用中，出于实际需要，可以在模型的基础上对弹簧力的计算公式进行调整，调整之后的弹簧力与位置不一定能始终维持正比的关系。但总体而言，随着当前的位置的大小的增大，弹簧力的大小随之增大或保持不变，将这种关系定义为弹簧力与位置正相关。
[0132]
可选的，为了使得力模式下的控制更加平稳，可以为阻尼力和/或弹簧力设置最大值，若计算出的阻尼力和/或弹簧力大于最大值则可以将其修正为最大值。若阻尼力和弹簧力均设置了最大值，则二者的大小可以相同，也可以不同。
[0133]
采用力模式的情况下，计算得到的驱动电机的控制量为力，若在控制过程中出现电机失控的情况，例如位置和/或超出允许范围，采用上述公式计算的规划力不一定能及时解决失控，可能导致电机较长时间处于失控的状态，电机出现故障甚至损坏电机。为及时解决驱动电机可能出现的失控，可以在力控制的基础上添加位置和/或速度限制。
[0134]
可选地，若从动轮的位置属于超限区，则将超限区对应的反向最大力作为规划力，以控制从动轮快速回到位置的允许范围内。超限区是指驱动轮的在关节空间的限制区域之外的区域，限制区域是指驱动轮可以自由活动的区域。超限区包括两个子区域，正向超限区和反向超限区，其中正向超限区更接近限制区域的正向边界，反向超限区更接近限制区域的反向边界。超限区对应的反向最大力的方向从超限区指向限制区域，大小为系统参数（例如驱动电机的参数）允许的最大值。例如，如果位置属于正向超限区，那么规划力为驱动电机能够输出的反向最大力；如果位置属于反向超限区，那么规划力为驱动电机能够输出的正向最大力。这里的正向和反向可以是根据收线和放线来定义的，例如正向对应收线以及反向对应放线，或者正向和反向是跟随驱动轮的旋转方向来定义的，例如正向对应顺时针反向对应逆时针。
[0135]
具体的，可以预先在多个方向角上将导管拉动到弯曲角的取值范围边界并记录各驱动轮对应的位置，这些方向角一般包括单个驱动轮作为主动轮/从动轮时对应的方向角，这个过程中可以使用手工协助调整或者引入力/力矩传感器以使得各驱动丝维持在合适的松紧状态。然后统计所有记录的位置得到各驱动轮的最大运动范围。可以直接将最大运动范围作为限制区域，也可以对其进行适当的调整（例如适当扩大或者适当缩小）之后作为限制区域。
[0136]
由于驱动轮一般在单独作为主动轮/从动轮时位置变化最大，可以据此对确定驱动轮最大运动范围的过程进行简化。具体的，对于在前端/末端平面内的角度为γ的驱动丝，可以控制导管弯曲到(γ, )的位置，其中表示弯曲角取值范围的最大值，记录下此时该驱动丝对应的驱动轮的位置作为其正向最大值，另外控制导管弯曲到(γ+π, )的位置，记录下此时该驱动丝对应的驱动轮的位置作为其反向最大值。对每根驱动丝执行上述过程，即可得到各驱动轮的最大运动范围。此外，若存在相对设置的驱动轮对，则获取其中一个驱动轮的位置正向最大值时另一个驱动轮的位置为其反向最大值，弯曲到两个位置即
可获取一对相对设置的驱动轮的最大运动范围。
[0137]
具体的，若从动轮的速度超出限速范围，则调整规划力以控制从动轮的速度回到限速范围。可以调整规划力使得驱动电机输出的力的方向即刻或者快速变为与速度的方向相反，从而降低从动轮的速度，使得从动轮的速度回到限速范围。
[0138]
此外，可以将驱动轮的在关节空间的限制区域进一步划分为自由区和过渡区，过渡区位于自由区和超限区之间。在过渡区内的控制策略可以与自由区相同，也可以不同。
[0139]
下面结合附图举例说明具体的控制策略，驱动轮的关节空间被划分为负向超限区，负向过渡区，自由区，正向过渡区，和正向超限区。若从动轮的当前位置在负向超限区，规划力为正向最大力。若从动轮的当前位置在负向过渡区，则按照速度为0的目标计算规划力，以使得驱动轮尽量在负向过渡区停下来而不进入负向超限区。若从动轮的当前位置在自由区，则判断当前速度是否超出限速范围，若超出，则按照速度回到限速范围的目标计算规划力，否则采用常规的公式计算规划力以控制从动轮跟随主动轮的收线而放线。若从动轮的当前位置在正向过渡区，则按照速度为0的目标计算规划力，以使得驱动轮尽量在正向过渡区停下来而不进入正向超限区。若从动轮的当前位置在正向超限区，规划力为反向最大力。
[0140]
常规状态下，规划力的采用常规的计算公式，即f
prf =f0+fv+f
p
。在非常规状态下，有了新的控制目标，例如速度为0或速度回到限速范围或离开超限区，此时可以将规划力设置为预设值，或者采用与常规状态下不同的规划力的计算公式。非常规状态下的计算公式的直接表现形式可以与常规公式不同，例如引入新的变量；或者非常规状态下的计算公式仍为f
prf =f0+fv+f
p
，但阻尼力和/或弹簧力的计算公式与常规状态下不同，以实现新的控制目标。
[0141]
此外，为了使从动轮的控制更平滑，减少跳变，可以对计算出的规划力进行分割、平滑滤波等至少一种处理之后再发送给从动轮对应的驱动电机。
[0142]
由于驱动电机的基础控制模式中没有力，也就是驱动电机的控制器无法直接按照力来控制驱动电机，因此需要将规划力转换为驱动电机能够处理的控制量再发送给驱动电机的控制器。
[0143]
例如，可以按照以下公式将规划力转换为控制驱动电机的电流：fcurrent= f
prf
*faxisradius/(fdecratio*ftrqcon)其中，fcurrent为控制电流，f
prf
为经过必要的处理之后的规划力，faxisradius为驱动轮的半径，ftrqcon为电机的电流力矩常数，fdecratio为电机减速比，即驱动轮和对应的驱动电机之间的传动比。由于可以认为驱动电机的力矩/扭矩与控制电流之间成正比，计算控制电流与相应系数的乘积可以得到控制力矩/扭矩。
[0144]
由于规划力影响了驱动轮转动的加速度，加速度的积分为速度，速度的积分为位置，可以根据规划力和从动轮的当前速度/位置计算出从动轮的目标速度/位置作为对应驱动电机的控制量。
[0145]
通过本实施例的实施，采用导管转向指令作用下的位置变化量而非目标位置来进行控制，并且将驱动轮划分为主动轮和从动轮，根据位置变化量直接计算主动轮的角位置变化量，若导管末端满足预设条件，在控制主动轮按照角位置变化量的过程中，按照从动轮对应的驱动丝零受力的目标控制从动轮跟随转动，更适应导管末端在转动过程表现出的非
线性变化，实现导管的弯曲转向，同时减少从动轮对应的驱动丝出现松紧状态异常的情况。
[0146]
本技术实施方式还提供一种导管系统的控制系统。请参考图12，其示出了本技术一实施例提供的导管系统的控制系统的结构示意图。如图11所示，控制系统600包括：处理器60，存储器61，总线62和通信接口63，所述处理器60、通信接口63和存储器61通过总线62连接；所述存储器61中存储有可被所述处理器60执行的计算机程序指令，所述处理器60执行所述计算机程序指令时执行本技术前述任一实施方式所提供的导管弯曲转向控制方法。
[0147]
其中，存储器61可能包含高速随机存取存储器（ram：random access memory），也可能还包括非不稳定的存储器（non-volatile memory），例如至少一个磁盘存储器。通过至少一个通信接口63（可以是有线或者无线）实现该装置网元与至少一个其他网元之间的通信连接，可以使用互联网、广域网、本地网、城域网等。
[0148]
总线62可以是isa总线、pci总线或eisa总线等。所述总线可以分为地址总线、数据总线、控制总线等。其中，存储器61用于存储程序，所述处理器60在接收到执行指令后，执行所述程序，前述本技术实施例任一实施方式揭示的所述导管弯曲转向控制方法可以应用于处理器60中，或者由处理器60实现。
[0149]
处理器60可能是一种集成电路芯片，具有信号的处理能力。在实现过程中，上述方法的各步骤可以通过处理器60中的硬件的集成逻辑电路或者软件形式的指令完成。上述的处理器60可以是通用处理器，包括中央处理器(central processing unit，简称cpu)、网络处理器(network processor，简称np)等；还可以是数字信号处理器(dsp)、专用集成电路(asic)、现成可编程门阵列(fpga)或者其他可编程逻辑器件、分立门或者晶体管逻辑器件、分立硬件组件。可以实现或者执行本技术实施例中的公开的各方法、步骤及逻辑框图。通用处理器可以是微处理器或者该处理器也可以是任何常规的处理器等。结合本技术实施例所公开的方法的步骤可以直接体现为硬件译码处理器执行完成，或者用译码处理器中的硬件及软件模块组合执行完成。软件模块可以位于随机存储器，闪存、只读存储器，可编程只读存储器或者电可擦写可编程存储器、寄存器等本领域成熟的存储介质中。该存储介质位于存储器61，处理器60读取存储器61中的信息，结合其硬件完成上述方法的步骤。
[0150]
本技术实施例提供的电子设备与本技术实施例提供的导管弯曲转向控制方法出于相同的发明构思，具有与其采用、运行或实现的方法相同的有益效果。
[0151]
本技术实施方式还提供一种与前述实施方式所提供的导管弯曲转向控制方法对应的计算机可读存储介质，请参考图13，其示出的计算机可读存储介质6，其上存储有计算机程序指令，所述计算机程序指令在被处理器执行时，会实现前述任意实施方式所提供的导管弯曲转向控制方法。
[0152]
需要说明的是，所述计算机可读存储介质的例子可以包括，但不限于光盘、相变内存 (pram)、静态随机存取存储器 (sram)、动态随机存取存储器 (dram)、其他类型的随机存取存储器 (ram)、只读存储器 (rom)、电可擦除可编程只读存储器 (eeprom)、快闪记忆体或其他光学、磁性存储介质，在此不再一一赘述。
[0153]
本技术的上述实施例提供的计算机可读存储介质与本技术实施例提供的导管弯曲转向控制方法出于相同的发明构思，具有与其存储的应用程序所采用、运行或实现的方法相同的有益效果。
[0154]
需要说明的是：
在此处所提供的说明书中，说明了大量具体细节。然而，能够理解，本技术的实施例可以在没有这些具体细节的情况下实践。在一些实例中，并未详细示出公知的结构和技术，以便不模糊对本说明书的理解。
[0155]
类似地，应当理解，为了精简本技术并帮助理解各个发明方面中的一个或多个，在上面对本技术的示例性实施例的描述中，本技术的各个特征有时被一起分组到单个实施例、图、或者对其的描述中。然而，并不应将该公开的方法解释成反映如下示意图：即所要求保护的本技术要求比在每个权利要求中所明确记载的特征更多的特征。更确切地说，如下面的权利要求书所反映的那样，发明方面在于少于前面公开的单个实施例的所有特征。因此，遵循具体实施方式的权利要求书由此明确地并入该具体实施方式，其中每个权利要求本身都作为本技术的单独实施例。
[0156]
此外，本领域的技术人员能够理解，尽管在此所述的一些实施例包括其它实施例中所包括的某些特征而不是其它特征，但是不同实施例的特征的组合意味着处于本技术的范围之内并且形成不同的实施例。例如，在下面的权利要求书中，所要求保护的实施例的任意之一都可以以任意的组合方式来使用。
[0157]
以上所述，仅为本技术较佳的具体实施方式，但本技术的保护范围并不局限于此，任何熟悉本技术领域的技术人员在本技术揭露的技术范围内，可轻易想到的变化或替换，都应涵盖在本技术的保护范围之内。因此，本技术的保护范围应以所述权利要求的保护范围为准。

技术特征：

1.一种导管系统，其特征在于，所述导管系统包括机械臂，与所述机械臂的动力部可拆卸连接的导管器械，与所述机械臂通讯连接的主控器以及处理器，所述导管器械包括与所述动力部可拆卸连接的器械盒以及与所述器械盒连接的导管，所述器械盒包括被所述动力部驱动的驱动轮以及一端缠绕于所述驱动轮上、另一端沿所述导管延伸并固定于所述导管末端的驱动丝，所述动力部包括多个驱动电机，所述驱动电机、所述驱动轮与所述驱动丝一一对应，所述处理器被配置成执行以下步骤：根据来自于所述主控器的导管转向指令，获取所述导管末端的位置变化量，所述位置变化量包括方向角和弯曲角；根据所述位置变化量确定所述驱动轮中的主动轮和从动轮，并计算所述主动轮的角位置变化量；若所述导管末端满足预设条件，则控制所述主动轮对应的驱动电机驱动所述主动轮按照所述角位置变化量转动，同时按照所述从动轮对应的驱动丝零受力的目标计算所述从动轮对应的驱动电机的规划力，并控制所述从动轮对应的驱动电机按照所述规划力输出，所述预设条件包括所述导管末端的当前弯曲角和目标弯曲角中的至少一种属于预设范围，所述目标弯曲角为所述当前弯曲角与所述位置变化量中的弯曲角之和。2.根据权利要求1所述的导管系统，其特征在于，在驱动所述主动轮转动的初始阶段，所述规划力被设为初始值；随后在驱动所述主动轮转动的过程中所述规划力为所述初始值、阻尼力与弹簧力之和，其中所述阻尼力是根据所述从动轮的速度计算得到的，所述弹簧力是根据所述从动轮的位置计算得到的。3.根据权利要求2所述的导管系统，其特征在于，所述阻尼力的大小与所述速度正相关；所述弹簧力的大小与所述位置正相关。4.根据权利要求1所述的导管系统，其特征在于，所述规划力是根据所述从动轮对应的驱动丝的反馈力得到的。5.根据权利要求1-4中任一项所述的导管系统，其特征在于，所述处理器被配置成执行以下步骤：若所述从动轮的位置属于超限区，则将所述超限区对应的反向最大力作为所述规划力。6.根据权利要求1-4中任一项所述的导管系统，其特征在于，所述处理器被配置成执行以下步骤：若所述从动轮的速度超出限速范围，则调整所述规划力以控制所述从动轮的速度回到所述限速范围。7.根据权利要求1所述的导管系统，其特征在于，所述处理器被配置成执行以下步骤：若所述导管末端不满足所述预设条件，则根据所述主动轮的角位置变化量以及对应的从动轮的当前位置比例分配系数，计算所述从动轮的角位置变化量，控制所述从动轮对应的驱动电机驱动所述从动轮按照所述角位置变化量转动，所述当前位置比例分配系数用于表示在当前状态下所述主动轮的收线长度与对应的所述从动轮的放线长度的比例。8.根据权利要求1所述的导管系统，其特征在于，所述预设范围的边界包括弯曲角最大阈值。9.根据权利要求1所述的导管系统，其特征在于，所述驱动丝的数量为n，n为大于2的整
数，n个所述驱动丝将导管转动段的前端平面在角度上划分为n个区间，所述方向角所属的区间的两端对应的所述驱动丝为主动驱动丝，所述主动驱动丝连接的驱动轮为所述主动轮，剩余的驱动轮中的部分或全部为所述从动轮。10.一种导管弯曲转向控制方法，其特征在于，包括：根据来自于主控器的导管转向指令，获取导管末端的位置变化量，所述位置变化量包括方向角和弯曲角；根据所述位置变化量确定多个驱动轮中的主动轮和从动轮，并计算所述主动轮的角位置变化量，所述驱动轮与驱动电机、驱动丝一一对应设置，所述驱动轮上缠绕有对应的驱动丝并被对应的所述驱动电机驱动，所述驱动丝的另一端沿所述导管延伸并固定于所述导管末端；若所述导管末端满足预设条件，则控制所述主动轮对应的驱动电机驱动所述主动轮按照所述角位置变化量转动，同时按照所述从动轮对应的驱动丝零受力的目标计算所述从动轮对应的驱动电机的规划力，并控制所述从动轮对应的驱动电机按照所述规划力输出，所述预设条件包括所述导管末端的当前弯曲角和目标弯曲角中的至少一种属于预设范围，所述目标弯曲角为所述当前弯曲角与所述位置变化量中的弯曲角之和。11.一种计算机可读存储介质，所述计算机可读存储介质存储有计算机程序指令，所述计算机程序指令被配置为由处理器加载并执行实现如权利要求10所述的方法的步骤。

技术总结

本申请提出一种导管弯曲转向控制方法、导管系统及可读存储介质，该方法包括：根据来自于主控器的导管转向指令，获取导管末端的位置变化量，位置变化量包括方向角和弯曲角；根据位置变化量确定多个驱动轮中的主动轮和从动轮，并计算主动轮的角位置变化量；若导管末端满足预设条件，则控制主动轮对应的驱动电机驱动主动轮按照角位置变化量转动，同时按照从动轮对应的驱动丝零受力的目标计算从动轮对应的驱动电机的规划力，并控制从动轮对应的驱动电机按照规划力输出。通过上述方式，本申请能够实现导管的弯曲转向控制，并通过对从动轮对应的驱动丝进行“零力控制”，减少从动轮对应的驱动丝出现松紧状态异常的情况。驱动丝出现松紧状态异常的情况。驱动丝出现松紧状态异常的情况。