一种连续体机器人灵巧性的优化方法与流程

本发明属于人工智能，涉及连续体机器人，具体涉及一种连续体机器人灵巧性的优化方法。

背景技术：

1、连续体机器人的灵感来自于仿生学，通常由具有低弹性模量的柔性材料制成。连续体机器人可以利用材料的灵活性来改变其自然形状，其形状的改变使机器人能够达到狭窄的空间。

2、单孔通路手术(spas)、自然孔腔内内窥镜手术和细胞手术是旨在缩短恢复时间、减少健康组织创伤的现代外科手术，连续体机器人可以很好地满足这一要求。一些应用的例子包括脑出血清除、膀胱癌、喉上呼吸道手术，由于具有较高的灵活性和顺应性，连续体机器人可以绕过障碍，进入封闭的环境。因此，它们可用于检测任务、救灾或外科手术。

3、大多数连续体机器人使用一个单一的主干来通过执行器，肌腱是塑造连续机器人的常见执行器，如象鼻像多节连续机器人。多骨干连续体机器人其中一个骨干被认为是主要骨干，而其它干被视为次级骨干。同心管机器人是另一种连续体机器人，它以管为骨干，具有小型化的潜力。一个连续体机器人的每个部分的长度必须适当地设计，以确保机器人基于操作任务满足几何约束、解剖约束。

4、因此，研究连续体机器人的参数优化，对于提高连续体机器人在手术空间的灵巧性具有着重要意义。

技术实现思路

1、本发明的目的是提供一种连续体机器人灵巧性的优化方法，以提高连续体机器人在手术或检测任务中的灵巧性。

2、为达到上述目的，本发明采用的技术方案是：

3、一种连续体机器人灵巧性的优化方法，包括：

4、s1：建立组织器官的点云地图模型，

5、s2：根据连续体机器人常曲率模型建立连续体机器人正运动学公式，

6、s3：建立连续体机器人可达空间的数学模型，

7、s4：通过计算可达空间在任务空间中的占据比构造连续体机器人的灵巧性指标的数学模型，

8、s5：以连续体机器人的灵巧性指标的数学模型为目标函数对连续体机器人尺寸参数进行优化，使目标函数满足约束条件：连续体机器人末端点(xend,yend)到达目标点ptarget，与组织器官边缘最小距离mindis大于设定的距离阈值。

9、上述技术方案优选地，在s1中，采用python建立组织器官的点云地图模型。

10、进一步优选地，建立组织器官的点云地图模型包括：使用ct文件三维重建构造组织器官stl文件，先将stl文件格式转换称为ply格式，通过open3d库生成组织器官边缘信息点云地图。

11、上述技术方案优选地，在s2中，通过连续体机器人弯曲角度参数代入正运动学公式计算连续体机器人的位姿、连续体机器人头部的位置坐标，常曲率模型为：

12、

13、正运动学模型为：

14、

15、其中：xn和yn为第n节末端点坐标，n∈(1,n),l1为第一节长度，θ1为第一节弯曲角度，rm-1为第m-1节到第m节的旋转变换矩阵，lm为第m节长度，θm′为第m节与第m-1节的弯曲角度差值。

16、上述技术方案优选地，在s3中：可达空间的左侧数学模型为：

17、

18、

19、其中，t1，t2和t3分别为对应关节的变换矩阵，θ1，θ2，θ3和θi分别为对应关节的弯曲角度，t为矩阵转置，右侧空间的数学模型由对称性得出。

20、上述技术方案优选地，在s4中，构造连续体机器人灵巧性的数学模型包括：在点云地图中设定手术任务空间，将处在任务空间中的可达空间面积除以设定的手术任务空间面积，获得的值作为连续体机器人的灵巧性指标，连续体机器人灵巧性指标公式为：

21、dt＝saccessible/st

22、st＝a×b

23、其中：saccessible为连续体机器人在设定手术任务空间中可到达的面积，st为设定手术任务空间的面积，a和b分别为设定手术任务空间的长和宽。

24、上述技术方案优选地，在s5中，目标函数将连续体机器人的每段长度作为设计变量，将连续体机器人的总长度和灵巧性指标分别乘以各自权重之后相加作为目标函数：

25、min f＝1/dt

26、其中：dt为连续体机器人灵巧性指标。

27、进一步优选地，目标函数的优化设计变量为：

28、l＝(l1，l2，...，ln)t

29、其中：li为连续体机器人第i段的长度，n为连续体机器人总节数，t为矩阵转置，优化设计变量决定了目标函数中的变量数量。

30、上述技术方案优选地，在s5中，约束条件为：

31、

32、其中：θi为第i节的弯曲角度，li为第i节的长度。

33、上述技术方案优选地，在s5中，最小距离检测使用点云地图数据建立kd树，通过最邻近搜索法得到最小距离，判断连续体机器人与组织器官是否发生碰撞接触，若连续体机器人与组织器官距离符合阈值要求，且优化函数结果满足要求，则满足最优尺寸参数；若与组织器官发生碰撞接触，或者优化函数结果未达到要求，则当前设定的连续体机器人节数不符合要求，需要增加节数，在目标函数中对应增加变量数量。

34、由于上述技术方案运用，本发明与现有技术相比具有下列优点：

35、本发明使用连续体机器人正运动学，通过建立目标函数对连续体机器人的参数进行优化，确保机器人基于操作任务满足几何约束、解剖约束，提高了连续体机器人的灵巧性，避免了连续体机器人与组织器官的碰撞接触，减少了病患的痛苦。

技术特征：

1.一种连续体机器人灵巧性的优化方法，其特征在于：包括：

2.根据权利要求1所述的连续体机器人灵巧性的优化方法，其特征在于：在s1中，采用python建立组织器官的点云地图模型。

3.根据权利要求2所述的连续体机器人灵巧性的优化方法，其特征在于：建立组织器官的点云地图模型包括：使用ct文件三维重建构造组织器官stl文件，先将stl文件格式转换称为ply格式，通过open3d库生成组织器官边缘信息点云地图。

4.根据权利要求1所述的连续体机器人灵巧性的优化方法，其特征在于：在s2中，通过连续体机器人弯曲角度参数代入正运动学公式计算连续体机器人的位姿、连续体机器人头部的位置坐标，常曲率模型为：

5.根据权利要求1所述的连续体机器人灵巧性的优化方法，其特征在于：在s3中：可达空间的左侧数学模型为：

6.根据权利要求1所述的连续体机器人灵巧性的优化方法，其特征在于：在s4中，构造连续体机器人灵巧性的数学模型包括：在点云地图中设定手术任务空间，将处在任务空间中的可达空间面积除以设定的手术任务空间面积，获得的值作为连续体机器人的灵巧性指标，连续体机器人灵巧性指标公式为：

7.根据权利要求1所述的连续体机器人灵巧性的优化方法，其特征在于：在s5中，目标函数将连续体机器人的每段长度作为设计变量，将连续体机器人的总长度和灵巧性指标分别乘以各自权重之后相加作为目标函数：

8.根据权利要求7所述的连续体机器人灵巧性的优化方法，其特征在于：目标函数的优化设计变量决定了目标函数中的变量数量，其为：

9.根据权利要求1所述的连续体机器人灵巧性的优化方法，其特征在于：在s5中，约束条件为：

10.根据权利要求1所述的连续体机器人灵巧性的优化方法，其特征在于：在s5中，最小距离检测使用点云地图数据建立kd树，通过最邻近搜索法得到最小距离，判断连续体机器人与组织器官是否发生碰撞接触，若连续体机器人与组织器官距离符合阈值要求，且优化函数结果满足要求，则满足最优尺寸参数；若与组织器官发生碰撞接触，或者优化函数结果未达到要求，则当前设定的连续体机器人节数不符合要求，需要增加节数，在目标函数中对应增加变量数量。

技术总结
本发明涉及一种连续体机器人灵巧性的优化方法，包括建立组织器官的点云地图模型，根据连续体机器人常曲率模型建立连续体机器人正运动学公式，建立连续体机器人可达空间的数学模型，通过计算可达空间在任务空间中的占据比构造连续体机器人的灵巧性指标的数学模型，以连续体机器人的灵巧性指标的数学模型为目标函数对连续体机器人尺寸参数进行优化，使目标函数满足约束条件：连续体机器人末端点到达目标点，与组织器官边缘最小距离大于设定的距离阈值。本发明确保机器人基于操作任务满足几何约束、解剖约束，提高了连续体机器人的灵巧性，避免了连续体机器人与组织器官的碰撞接触，减少了病患的痛苦。

技术研发人员：邓若愚,胡尚薇
受保护的技术使用者：同济人工智能研究院（苏州）有限公司
技术研发日：
技术公布日：2024/1/12