买专利卖专利找龙图腾，真高效！ 查专利查商标用IPTOP,全免费！专利年费监控用IP管家,真方便！

龙图腾网恭喜吉林大学申请的专利螺旋型血管机器人姿轨一体化自适应滑模跟踪控制方法获国家发明授权专利权，本发明授权专利权由国家知识产权局授予，授权公告号为：CN111904486B 。

龙图腾网通过国家知识产权局官网在2025-05-30发布的发明授权授权公告中获悉：该发明授权的专利申请号/专利号为：202010418859.X，技术领域涉及：A61B17/00；该发明授权螺旋型血管机器人姿轨一体化自适应滑模跟踪控制方法是由周淼磊;张晨;张颖;韩志武设计研发完成，并于2020-05-18向国家知识产权局提交的专利申请。

本螺旋型血管机器人姿轨一体化自适应滑模跟踪控制方法在说明书摘要公布了：一种螺旋型血管机器人姿轨一体化自适应滑模跟踪控制方法，属于控制技术领域。本发明的目的是充分考虑血管机器人的姿轨耦合和重力‑浮力的影响，且提高控制精度的螺旋型血管机器人姿轨一体化自适应滑模跟踪控制方法。本发明步骤是：建立螺旋型血管机器人的姿轨一体化运动学和动力学模型；设计重力‑浮力补偿器，对竖直方向重力‑浮力的下沉作用进行补偿；设计基于重力‑浮力补偿的滑模控制器；基于步骤三设计的滑模控制器，设计自适应滑模控制。本发明可以更好的抑制滑模控制的抖动现象，提高姿态轨迹跟踪控制精度。对血管机器人在微创手术中得以应用具有很大的实际价值和理论意义。

本发明授权螺旋型血管机器人姿轨一体化自适应滑模跟踪控制方法在权利要求书中公布了：1.一种螺旋型血管机器人姿轨一体化自适应滑模跟踪控制方法，其特征在于：其步骤是：步骤一：采用对偶四元数对螺旋型血管机器人的姿态和轨迹运动同时进行描述，建立螺旋型血管机器人的姿轨一体化运动学和动力学模型；步骤二：针对螺旋型血管机器人在血液中运动时，会受到重力-浮力的影响，导致实际运动轨迹下沉偏移，而脱离期望轨迹，设计重力-浮力补偿器，对竖直方向重力-浮力的下沉作用进行补偿；步骤三：基于步骤一建立的螺旋型血管机器人模型和步骤二设计的重力-浮力补偿器，设计基于重力-浮力补偿的滑模控制器；步骤四：基于步骤三设计的滑模控制器，设计自适应滑模控制器；步骤一所述的姿轨一体化运动学和动力学模型建立的具体过程为：单位对偶四元数描述的血管机器人本体坐标系ObXbYbZb相对于期望坐标系OdXdYdZd的姿轨误差为： 其中，和分别为利用单位对偶四元数表示的血管机器人期望坐标系OdXdYdZd和本体坐标系ObXbYbZb分别相对于惯性坐标系OXYZ的姿轨，“*”表示对偶四元数的乘法，表示对偶四元数的共轭；血管机器人本体坐标系ObXbYbZb相对于期望坐标系OdXdYdZd的速度旋量误差在坐标系ObXbYbZb下表示为： 其中，为血管机器人本体坐标系ObXbYbZb相对于惯性坐标系OXYZ的速度旋量在机器人本体坐标系ObXbYbZb中的表示，为血管机器人期望坐标系OdXdYdZd相对于惯性坐标系OXYZ的速度旋量在期望坐标系OdXdYdZd中的表示，·*表示对偶四元数的共轭；进而通过推导可以得到基于的姿轨一体化运动学及动力学方程： 其中，Mb为对偶质量特性惯性矩阵，表示坐标系ObXbYbZb中作用点为血管机器人质心的对偶力旋量，“×”表示对偶四元数的叉乘运算，表示矩阵和对偶四元数的一种运算，对于对偶四元数定义的运算为ε表示对偶单位；定义的运算为为任一对偶四元数；步骤二所述的重力-浮力补偿器具体设计过程为：当血管机器人在血液中运动时，定义血管机器人的期望运动速度为在血液中的血管机器人主要受到总驱动力机器人的重力-浮力流体阻力的作用；总驱动力的表达式为： 其中，表示在三维旋转磁场作用下血管机器人螺旋尾部旋转产生的驱动力，为磁梯度产生的磁拉力，n为血管机器人螺旋尾部的旋转圈数，d为血管机器人磁性球形头部直径，α1为血管机器人尾部螺旋升角，为血管机器人旋转角速度，V为血管机器人体积，M为磁化强度，为磁场梯度，ζ⊥为垂直于螺旋尾部的轴向阻力系数，且ζ11为平行于螺旋尾部的轴向阻力系数，且η为血液粘度系数，κ为血管机器人螺旋尾部直径；流体阻力由血管机器人头部和螺旋尾部受血流冲击所产生的流体阻力组成，表示为：机器人重力-浮力是重力G和浮力作用在竖直方向上的合力，其表达式为： 其中，ρ为血管机器人的密度，ρf为血液的密度，为重力加速度；抵消重力-浮力对血管机器人的作用效果，需要流体阻力和总驱动力的共同作用，即：其中为设计重力-浮力补偿器，建立血管机器人的姿态坐标系p，坐标系的原点Op位于血管机器人重心，坐标系xp轴与血管机器人实际指向相重合，zp轴垂直于血管机器人实际指向为血管机器人为抵消重力-浮力影响的运动速度，根据式8得： 将血管机器人期望运动速度分解为水平分量和竖直分量可知血管机器人期望运动速度的水平分量与的水平分量相等，即有血管机器人旋转角速度和三维旋转磁场的旋转角速度Ω1有如下关系： 根据上述分析可得： 其中，为单位矢量；当时，根据式9和10可得： 当时，将分解为两个力，即平行于xp轴的分量与垂直于xp轴的分量在方向没有分量，又由于磁场梯度方向的不确定性和多变性，假设作用xpzp平面上且方向与血管机器人期望运动速度关于xp轴对称，则类似于的受力分析，可以分解为平行于xp轴的分量与垂直于xp轴的分量在方向没有分量，则有： 其中，和分别表示在zp轴与xp轴投影的数量值，和在zp轴与xp轴投影的数量值，分别表示zp轴方向与xp轴方向的单位向量；将式10和13代入到式9，可得： 由于定义血管机器人期望俯仰角为将速度投影到xp轴，zp轴方向，并根据式14可得： 通过分析血管机器人姿态坐标系p的力学几何关系可得： 其中，β为血管机器人期望俯仰角向上倾斜的角度；类似于式16中对于的分析，同样可得到以下关系： 根据式15，式16和式17，得到： 根据cosθ+β＝cosθcosβ-sinθsinβ，则由式18可得重力-浮力补偿器输出的血管机器人相比于理想俯仰角向上倾斜的角度β为： 通过式15，式16和式17可得，重力-浮力补偿器输出的三维旋转磁场的旋转角速度Ω1为：步骤三所述的基于重力-浮力补偿的滑模控制器为：记血管机器人期望运动轨迹为[xdt,ydt,zdt]T，设机器人初始滚转角速度则血管机器人期望偏航角ψ与期望俯仰角θ分别为： 假设血管机器人的滚转角速度与三维旋转磁场旋转角速度Ω1一致，则在重力-浮力补偿器作用下血管机器人的偏航角ψs、俯仰角θs、滚转角速度为： 最后将上述血管机器人期望运动轨迹[xdt,ydt,zdt]T与血管机器人经过重力-浮力补偿后的姿态角进行对偶四元数变换，得到对偶四元数框架下的运动描述从而将血管机器人期望坐标系的对偶四元数运动作为控制系统的输入；血管机器人的控制目标为：通过控制血管机器人本体坐标系ObXbYbZb相对于期望坐标系OdXdYdZd的姿轨误差使血管机器人的实际运动状态渐进收敛到期望坐标系下的运动状态基于步骤一中建立的血管机器人姿轨一体化运动学和动力学方程式3和式4，设计如下滑模面： 其中，为对偶数的积运算，为控制器参数，且ksi＞0， 设计滑模控制律为： 其中，为滑模变量，sgn·为符号函数，且为控制器参数，且kεi＞0，为控制器参数，且kui＞0，为对偶矢量的一种积运算，为对偶干扰力；步骤四所述的自适应滑模控制器为：为便于设计自适应滑模控制器，将式27中带有Mb的项用下式表示： 其中，为对偶质量特性惯性矩阵Mb的另一种表达方式；且Π∈R3×1，通过对偶极子运算的特殊性质ε2＝0可以进一步得到为三维对偶向量；由于对偶质量特性惯性矩阵Mb的特殊性可知Π易得，而关于的计算，可由式29-31推导得出：对于任意x∈R3×1,y∈R3×1，有： 其中，δx,y＝δ1x+δ2y，且δ1x，δ2y的计算方式如下： 由于血管机器人复杂的工作环境及多变的工作内容，在血管机器人建模过程中，其质量与惯量往往具有不确定性与多变性，因此为对偶质量特性惯性矩阵和对偶干扰力的估计值设计参数自适应律如下： 其中，为控制器参数，为控制器参数，且： 将式32和式33带入式27的滑模控制律，则可得到自适应滑模控制律为：

如需购买、转让、实施、许可或投资类似专利技术，可联系本专利的申请人或专利权人吉林大学，其通讯地址为：130012 吉林省长春市人民大街5988号；或者联系龙图腾网官方客服，联系龙图腾网可拨打电话0551-65771310或微信搜索“龙图腾网”。