一种集成光纤布拉格光栅的绳驱连续体机械臂

摘要: 本发明涉及软体机器人及医疗器械,具体而言,涉及一种集成光纤布拉格光栅(fbg)的绳驱连续体机械臂。背景技术:1、绳驱连续体机械臂因其结构紧凑、无刚性关节、柔顺性...
一种集成光纤布拉格光栅的绳驱连续体机械臂

本发明涉及软体机器人及医疗器械,具体而言,涉及一种集成光纤布拉格光栅(fbg)的绳驱连续体机械臂。

背景技术:

1、绳驱连续体机械臂因其结构紧凑、无刚性关节、柔顺性好等特点,在狭小空间作业、微创手术及人机交互领域具有广阔的应用前景。然而,现有的绳驱连续体机械臂在实际应用中仍面临诸多挑战:

2、1. 感知能力不足:传统机械臂多依赖外部视觉或末端传感器,难以实时获取臂身的三维形态和受力情况,导致控制精度受限。

3、2. 刚度固定:大多数连续体机械臂在工作过程中刚度不可调或调节范围有限,难以在“柔性避障”与“刚性作业”两种模式间灵活切换。

4、3. 运动耦合:绳索传动存在非线性摩擦和迟滞效应,且近端关节的运动往往会牵连远端关节,导致运动解耦困难。

技术实现思路

1、本发明的目的在于提供一种集成光纤布拉格光栅的绳驱连续体机械臂,通过内嵌式fbg传感网络与形状记忆合金(sma)协同作用,实现机械臂的实时形态重构与局部刚度主动调节。

2、为实现上述目的,本发明提供如下技术方案:一种集成光纤布拉格光栅的绳驱连续体机械臂,包括:驱动基座单元、串联关节单元、绳索传动系统、可调导向单元、内嵌式形状感知系统、刚度调节系统和控制系统。

3、所述串联关节单元包括多个依次串联的关节段,每个关节段包括多个同轴排列的支撑件及设置于相邻支撑件之间的主体骨架。所述主体骨架为沿轴向延伸的柱状体,其外壁开设有驱动绳索通道,其内部开设有传感光纤通道,所述传感光纤通道与所述驱动绳索通道在空间上互不连通。相邻所述支撑件之间设有预紧弹簧,所述预紧弹簧套设于所述主体骨架的外周,构成复合柔顺回正机构。

4、所述绳索传动系统包括驱动绳索,所述驱动绳索穿过所述驱动绳索通道。

5、所述内嵌式形状感知系统包括传感光纤,所述传感光纤嵌入所述传感光纤通道。

6、所述支撑件上设有可调导向单元,所述可调导向单元包括多组导向孔,所述驱动绳索通过选择不同的导向孔,形成贯穿机械臂全长的第一牵引路径和仅贯穿近基座段的第二牵引路径,所述近基座段为靠近基座的至少一个关节段。

7、所述刚度调节系统包括形状记忆合金丝,所述传感光纤贴附于所述形状记忆合金丝表面并与所述形状记忆合金丝共同嵌入所述传感光纤通道。

8、所述控制系统包括分别与所述第一牵引路径和所述第二牵引路径对应连接的第一控制通道和第二控制通道,所述第一控制通道和所述第二控制通道独立输出控制信号,以分别调节所述第一牵引路径和所述第二牵引路径的绳索张力或位移。

9、进一步地,所述驱动基座单元采用四电机方形布局,四个具备高分辨率绝对式编码器的直流无刷伺服电机固定安装在基座安装板的四个角;每个驱动电机的输出轴上安装有主动同步带轮,通过聚氨酯同步带独立驱动两根驱动绳索,四个驱动电机共驱动八根驱动绳索,其中四根驱动绳索对应所述第一牵引路径,另外四根驱动绳索对应所述第二牵引路径;各所述驱动绳索的始端固定于对应的所述同步带上。

10、进一步地,所述支撑件为环状固定盘,所述主体骨架为聚氨酯棒;各固定盘中心设有通孔,边缘设有绳索导向槽,其内表面设有凸起卡齿;所述聚氨酯棒外壁开设有与所述卡齿相匹配的凹槽,通过旋入固定盘侧壁的锁紧螺钉,使关节盘内周抵接聚氨酯棒外壁,实现聚氨酯棒的轴向定位与周向防转;所述聚氨酯棒内部沿轴向开设有贯通的中心凹槽,所述中心凹槽构成所述传感光纤通道,所述传感光纤贯穿所述中心通孔;所述聚氨酯棒的所述凹槽截面为矩形,聚氨酯材料硬度为邵氏a70~90。

11、进一步地,所述传感光纤通道的横截面尺寸小于所述驱动绳索通道的横截面尺寸,且所述传感光纤通道位于所述聚氨酯棒的中心区域,所述驱动绳索通道位于所述聚氨酯棒的外周区域。

12、进一步地,所述可调导向单元设于每个固定盘上,包括多组沿径向呈十字形分布的导向孔组,每组导向孔组自固定盘中心向外辐射,包含三个沿同心圆排列的孔位,不同同心圆上的孔位对应不同的有效力臂。

13、进一步地,所述绳索传动系统包括两组牵引索组,第一牵引索组的四根第一牵引索穿过各固定盘外侧圈层的导向孔并锚固于机械臂远端,形成所述第一牵引路径;第二牵引索组的四根第二牵引索仅穿过与近基座段对应的各固定盘的内侧圈层导向孔,并锚固于近基座段与远基座段之间的过渡位置,形成所述第二牵引路径;通过将所述驱动绳索穿设于不同同心圆的孔位,在装配阶段重构所述第一牵引路径和所述第二牵引路径的力传递特性。

14、进一步地,所述传感光纤为刻写有多个fbg传感器的光纤,三根所述传感光纤通过定制夹具拉直后,以相隔120°的角度分布并黏贴在所述形状记忆合金丝的表面;所述形状记忆合金丝嵌入所述中心凹槽中,随后将所述形状记忆合金丝及贴附于其表面的三根传感光纤共同嵌入所述中心凹槽内,并采用环氧树脂ab胶进行固定,共同构成传感光纤通道;所述中心凹槽的至少部分轴向区域未填充封装胶,以与所述固定盘内表面的凸起卡齿配合;所述传感光纤通道贯穿所有固定盘的中心通孔;在所述聚氨酯棒的横截面上,所述形状记忆合金丝位于中心区域,三根所述传感光纤环绕所述形状记忆合金丝,所述驱动绳索通道位于所述传感光纤的外周区域;所述形状记忆合金丝在通电受热时发生相变产生回复力,所述回复力通过所述传感光纤的黏贴界面传递至所述聚氨酯棒,与所述驱动绳索的张力在所述聚氨酯棒的径向上形成梯度刚度调节。

15、进一步地,所述三根传感光纤上的准分布式fbg传感器的数量共为12~27个,以8~15 cm的间距分布在各传感光纤上;所述形状记忆合金丝的尺寸为0.8~1.2 mm。

16、进一步地,所述控制系统还包括信号解调模块、形状重构模块、运动控制模块、解耦控制模块和多物理场补偿模块;所述信号解调模块与所述内嵌式形状感知系统连接,用于采集光纤布拉格光栅传感器的波长数据;所述形状重构模块预存有传感器波长-应变-空间位置映射模型,用于将波长数据转换为机械臂的三维形状和接触力信息;所述运动控制模块内嵌针对驱动架构的运动学模型,用于根据目标指令和反馈信息生成电机控制指令;所述解耦控制模块内嵌解耦控制算法,所述解耦控制算法基于所述传感光纤实时反馈的各关节段曲率数据,计算所述第一牵引路径与所述第二牵引路径之间的运动学耦合系数;当所述近基座段发生弯曲时,所述解耦控制算法根据所述耦合系数对所述第一牵引路径的绳索位移进行前馈补偿,以消除所述近基座段弯曲对远基座段位姿的牵连影响;所述多物理场补偿模块利用刻写1个fbg的传感光纤作为温度基准,实时分离所述fbg传感器的波长漂移中的温度分量和应变分量;同时,所述多物理场补偿模块根据所述第一控制通道和第二控制通道输出的绳索张力数据,建立绳索张力对所述传感光纤的侧向挤压误差模型,并从所述应变分量中扣除所述侧向挤压引起的伪应变,以获得所述聚氨酯棒的真实曲率数据。

17、进一步地,所述控制系统还包括协同控制时序模块;在需要增大局部弯曲刚度的工况下,所述协同控制时序模块先控制所述形状记忆合金丝通电升温至相变温度以上,待所述回复力达到稳态值后,再同步增大对应位置所述驱动绳索的张力;在需要减小局部弯曲刚度的工况下,所述协同控制时序模块先减小所述驱动绳索的张力,再控制所述形状记忆合金丝断电冷却;所述时序控制避免了所述回复力与所述驱动绳索张力在相变瞬态期间的非线性耦合振荡。

18、与现有技术相比,本发明的有益效果是:

19、1. 实现了高精度、抗干扰的实时形状感知。 通过在机械臂主体内部集成fbg传感网络,并结合多物理场补偿算法,能够精确重构机械臂的三维形态,为闭环控制提供了可靠的状态反馈。

20、2. 具备主动、宽范围的刚度调节能力。 创新性地利用形状记忆合金(sma)丝的相变回复力与绳索张力协同作用,使机械臂能够在“柔性”与“刚性”模式间灵活切换,适应不同作业需求。

21、3. 有效解决了多段绳驱的运动耦合问题。 通过分段牵引路径设计和解耦控制算法,显著降低了近端关节运动对远端关节的牵连影响,提高了末端执行器的控制精度和灵活性。

22、4. 结构紧凑,模块化程度高。 采用集成化的驱动基座和标准化的关节单元,不仅提高了系统的集成度和可靠性,也便于装配、维护和功能扩展。