[发明专利]一种基于干扰观测器的机械系统无力传感触觉力估计方法

说明书

本发明涉及一种基于干扰观测器的机械系统无力传感触觉力估计方法，建立配备电机位置传感器的机械系统动力学模型，合外干扰包含已知频率周期振动干扰与低频非周期干扰两部分，低频非周期干扰中的建模不确定性表示成乘积摄动模型的形式；根据干扰中的非周期部分及高频噪声频段特性，在标准H_∞控制问题框架下给定优化策略，在连续域中得到最优的鲁棒干扰观测器，分离外干扰中的低频慢变外力信号；在离散域中设计指定频率陷波器，结合设计的鲁棒干扰观测器，设计复合鲁棒周期干扰观测器；建立机械系统触觉力模型，实现末端触觉力的估计与分离。本发明保证系统的鲁棒稳定，且过滤高频噪声和周期性振动干扰，提升触觉力传感的带宽及精度。

技术领域

本发明涉及一种基于干扰观测器的机械系统无力传感触觉力估计 (SensorlessHaptic Force Estimation)方法，可用于康复机器人、远程高空作业、 远程医疗手术机器人等，作为触觉传感器估计机械系统末端的外触觉力。

背景技术

自1987年法国医师Philippe Mouret完成首例腹腔镜胆囊切除手术以来， 微创手术因其创伤小、减轻患者手术疼痛、缩短患者住院时间等优点在越来越 多的传统手术中获得了革命性的成功，包括胆囊切除术、前列腺切除术、阑尾 切除术、子宫切除术、肾切除术、冠状动脉旁路移植术等。然而，微创手术却 在感知和运动方面存在着固有的缺陷，医生不能直接接近操作区域，因此就会 失去直接接触带来的触觉感知，同样的，手术器械与患者组织之间的力觉信息 也会受到限制或产生扭曲。这些都对医生开展组织触摸手术来鉴别组织属性(例 如刚度和弹性模量)和组织异变带来了困难。如前所述，由于难以获得与患者组 织之间的接触信息，医生在执行组织牵拉、分离、缝合等精细手术操作时想要 施加精确的作用力就会变得很困难。最近几年来，有关人机接触交互和微创手 术机器人触觉再现的研究可以为医生提供力觉和触觉反馈，辅助医生执行手术， 增强医生手术灵活性。

专利202011528330.X中设计了一种基于振动阵列的触觉刺激系统及方法， 采用振动阵列指令生成装置将原始数据点阵中的信息数据转换成控制指令后发 送给触觉刺激装置；触觉刺激装置的控制器根据控制指令使振动阵列相应的刺 激阵子起振；刺激阵子对原始传达数据轮廓进行展示；振动阵列为单组或多组， 根据原始传达数据和初始化参数自动生成控制指令实时用振动来显示相对应的 轮廓点阵图像，进而与使用者进行信息传递，但是该方法限制了触觉信息再现 的应用场景，由于振动机制本身会带来额外扰动，对于触觉信息测量的精确性 有待商榷，也无法滤除系统本身的外干扰。

专利202110030892.X中提出了一种基于超声波相控阵技术的非接触式触 觉反馈系统，该方法将利用超声波换能器阵列向特定区域发射超声波，根据特 定区域的超声波反馈坐标参数，计算各个通道的控制信号，实现超声波换能器 相位的精确控制，实现基于超声波相控阵的非接触式触觉反馈，增强了触觉反 馈的应用范围，减少了接触式触觉固有的摩擦等外部干扰。但该方法局限于近 距离的非接触式触觉信号测量，对于稍远距离的触觉信号则适应性不强，且对 发射超声信号的特定区域环境要求较为苛刻，测量结果不稳定扰动较大。

文献1(E.Sariyildiz and K.Ohnishi,“An adaptive reaction force observerdesign.”IEEE Transactions on Mechatronics,vol.20,pp.750-760,2015.)提出了一 种自适应力反馈观测器，该方法通过自适应的方法自动设计最优力观测器，而 不依赖设计者自身经验，具有更高的力控制带宽，更好的稳定性，并可实现无 外加力传感器的力控制。然而，该算法没有考虑模型中的可建模误差和干扰， 无法将触觉外力从混杂有摩擦等其他低通信号的干扰中分离出来。