欢迎来到知嘟嘟! 联系电话:13336804447 卖家免费入驻,海量在线求购! 卖家免费入驻,海量在线求购!
知嘟嘟
我要发布
联系电话:13336804447
知嘟嘟经纪人
收藏
专利号: 2025112735844
申请人: 湖南大学
专利类型:发明专利
专利状态:已下证
专利领域: 手动工具;轻便机动工具;手动器械的手柄;车间设备;机械手
更新日期:2026-11-16
缴费截止日期: 暂无
价格&联系人
年费信息
委托购买

摘要:

权利要求书:

1.一种手术机器人自适应主从力跟踪控制系统,其特征在于,包括:主从系统构建模块,用于由Omega7力反馈操作手作为主手,由Franka-R3七自由度机械臂作为从手,并在从手的末端装配手术器械,构建主从系统,并建立主手与从手之间的映射关系;

接触力反推模块,用于基于主手动作驱动从手运动,基于机械臂与手术器械的扩展动力学模型,以及Franka-R3七自由度机械臂中关节力矩传感器测得的关节力矩,反推出末端接触力;

环境刚度在线辨识模块,用于基于实时辨识的环境刚度实时校正末端接触力,并基于递归最小二乘法实时更新环境刚度;

接触力反馈模块,用于基于校正后的末端接触力、以及主手与从手之间的映射关系,计算主手接收的力;并将添加重力补偿后主手接收的力反馈给操作者,实现末端力的跟踪与控制;

安全保护模块,用于监测校正后的末端接触力或延迟是否超出对应的预设范围,超出则触发对应的保护机制,否则继续监测末端接触力。

2.根据权利要求1所述的手术机器人自适应主从力跟踪控制系统,其特征在于,主从系统构建模块包括主从映射关系构建子模块,用于建立主手与从手之间的映射关系:将主手的位置映射为从手末端的目标位置,

在主手坐标系下主手的位置表示为:,其中,表示主手的位置;表示主手坐标系下主手的横坐标;表示主手坐标系下主手的纵坐标;表示主手坐标系下主手的竖坐标;表示转置;

从手末端的目标位置表示为:,其中,表示从手末端的目标位置;表示旋转矩阵;表示缩放因子;表示平移向量。

3.根据权利要求2所述的手术机器人自适应主从力跟踪控制系统,其特征在于,主从系统构建模块还包括关节角优化子模块,用于基于从手末端的目标位置优化从手上各关节的关节角:基于从手末端的目标位置,通过机械臂正运动学函数,得到任意一个关节的关节角,表示为:;

其中,表示机械臂正运动学函数;表示第个关节的关节角;表示从手末端的目标位置;

为各关节的关节角设定约束条件,约束条件为:;

其中,表示第个关节的最小关节角;表示第个关节的最大关节角;

基于关节的安全中性位姿为各关节的关节角构建目标函数,并最小化目标函数,得到各关节的最优关节角;

目标函数为:

;

其中,表示目标函数;表示关节的安全中性位姿;表示关节权重矩阵;表示转置。

4.根据权利要求3所述的手术机器人自适应主从力跟踪控制系统,其特征在于,接触力反推模块还包括关节角更新子模块,用于在从手运动时,基于从手的实时关节角与从手末端的目标位置更新从手上各关节的关节角:基于从手的实时关节角与从手末端的目标位置,利用伪逆求解关节角增量,计算式为:;

;

其中,表示第个关节的关节角增量;表示阻尼加权伪逆;表示从手末端的目标位置;表示机械臂正运动学函数;表示第个关节的实时关节角;表示关节权重矩阵;表示转置;表示从手的几何雅可比矩阵;表示阻尼系数;表示单位矩阵;

基于阻尼加权伪逆和几何雅可比矩阵计算关节角运动平滑度,计算式为:;

;

其中,表示第个关节的关节角运动平滑度;表示关节的安全中性位姿;表示模;表示目标函数对关节角的梯度;

基于关节角增量和关节角运动平滑度更新实时关节角,更新公式为:;

其中,表示第个关节实时更新后的关节角;表示步长系数;表示零空间优化权重。

5.根据权利要求1所述的手术机器人自适应主从力跟踪控制系统,其特征在于,接触力反推模块中,机械臂与手术器械的扩展动力学模型表示为:;

;

=;

其中,表示Franka-R3七自由度机械臂中关节力矩传感器测得的关节力矩;表示从手在各关节角下的质量矩阵;表示所有关节的关节加速度;表示科里奥利和离心力项;表示所有关节的关节角;表示所有关节的关节速度;表示重力项;表示转置;表示从手的几何雅可比矩阵;表示末端接触力;表示手术器械的附加力矩;表示回归矩阵;表示在线辨识的参数向量;表示手术器械的质量;表示手术器械的惯性矩;表示第一摩擦参数;表示第二摩擦参数。

6.根据权利要求5所述的手术机器人自适应主从力跟踪控制系统,其特征在于,还包括参数更新模块,用于在末端力的实时跟踪与控制过程中,采用递归最小二乘法实时更新参数向量:基于第一遗忘因子和回归矩阵计算第一增益,计算式为:;

其中,表示第一增益;表示更新前的第一协方差矩阵;表示回归矩阵;表示转置;表示第一遗忘因子;

基于第一增益、关节力矩传感器测得的关节力矩以及回归矩阵更新参数向量,参数向量更新公式为:;

其中,表示更新后的参数向量;表示更新前的参数向量;表示Franka-R3七自由度机械臂中关节力矩传感器测得的关节力矩;

同步更新第一协方差矩阵,为下次更新时计算第一增益提供基础,第一协方差矩阵更新公式为:;

其中,表示更新后的第一协方差矩阵。

7.根据权利要求1所述的手术机器人自适应主从力跟踪控制系统,其特征在于,环境刚度在线辨识模块包括接触力校正子模块,用于基于实时辨识的环境刚度实时校正末端接触力,计算公式为:;

;

;

其中,表示第一导纳控制参数,其值为从手的惯性矩阵;表示从手的期望加速度;表示第二导纳控制参数;表示从手的期望速度;表示第三导纳控制参数;表示从手末端的期望位置;表示从手末端的初始位置;表示末端接触力;表示期望接触力;表示恒定常数;表示安全系数。

8.根据权利要求1所述的手术机器人自适应主从力跟踪控制系统,其特征在于,环境刚度在线辨识模块包括环境刚度更新子模块,用于基于递归最小二乘法实时更新环境刚度:基于第二遗忘因子、第二协方差矩阵以及位移变化量计算第二增益,计算式为:;

其中,表示第时刻的第二增益;表示第时刻的第二协方差矩阵;表示第时刻的位移变化量;表示转置;表示第时刻的第二遗忘因子;

基于第二增益、接触力测量值以及位移变化量更新环境刚度,环境刚度更新公式为:;

其中,表示第时刻的环境刚度;表示第时刻的环境刚度;表示第时刻的接触力测量值;

同步更新第二协方差矩阵,为下次更新时计算第二增益提供基础,第二协方差矩阵更新公式为:;

其中,表示第时刻的第二协方差矩阵;表示单位矩阵。

9.根据权利要求1所述的手术机器人自适应主从力跟踪控制系统,其特征在于,接触力反馈模块中,添加重力补偿后主手接收的力的计算式为:;

;

其中,表示添加重力补偿后主手接收的力;表示主手接收的力;表示手术器械的质量;表示重力加速度;表示旋转矩阵;表示平移向量;表示末端接触力的原始扭矩分量;表示校正后的末端接触力。

10.根据权利要求1所述的手术机器人自适应主从力跟踪控制系统,其特征在于,保护机制设置于从手上,保护机制包括柔顺阻尼模式、运动冻结、紧急回退;

柔顺阻尼模式的触发条件为末端接触力大于0.5倍预设接触力,触发后将当前时刻的第二导纳控制参数设置为上一时刻的第二导纳控制参数的2倍;

运动冻结机制的触发条件为末端接触力大于0.8倍预设接触力,触发后将从手末端的当前位置赋值给指令位置;

紧急回退机制的触发条件为延迟超过100ms的时间大于预设时间,触发后基于从手末端的实时位置和末端接触力进行位置回退,位置回退的计算式为:;

其中,表示指令位置;表示从手末端的实时位置;表示末端接触力;表示模。