机器人关节的振动抑制方法、装置、电子设备及存储介质与流程
本申请涉及机器人领域,具体而言,本申请涉及一种机器人关节的振动抑制方法、装置、电子设备及存储介质。
背景技术:
1、在绳驱机器人关节中,钢丝绳传动使关节等效刚度由钢丝绳张力决定,而钢丝绳张力会随负载、温度、磨损及蠕变持续变化,导致关节等效刚度漂移,进而使关节共振频率在运行过程中持续变化。现有振动抑制方案通常采用固定陷波器,或基于离线辨识、全频扫频来设定陷波参数,难以针对绳驱关节等效刚度随张力变化的特点在运行期持续跟踪共振频率;当实际共振频率偏离预设值时,陷波器与真实机械共振失配,振动抑制效果下降甚至失效。
技术实现思路
1、本申请的目的旨在至少能解决上述的技术缺陷之一,本申请实施例所提供的技术方案如下:
2、第一方面,本申请实施例提供了一种绳驱机器人关节的振动抑制方法,关节的等效刚度与钢丝绳张力相关,关节预先标定有振动模态数量n及各振动模态的频率搜索范围;该方法包括:
3、为关节配置n路独立的振动抑制通道,每一振动抑制通道对应一个振动模态;
4、对于每一振动模态,在关节运动期间,同步采集关节的驱动器内部的q轴电流参考与速度误差,对q轴电流参考与速度误差在对应的频率搜索范围内进行频谱分析,得到振动模态当前的共振频率;
5、获取当前的共振频率对应的振动模态的品质因数q值、q轴电流参考与速度误差之间的互相关系数,以及共振频率与速度环穿越频率的频率比;
6、若根据品质因数q值、互相关系数及频率比确定振动模态的振动源为机械共振,则根据振动模态当前的共振频率与振动模态上一次频谱分析得到的共振频率更新振动模态对应的陷波器的陷波参数,并激活陷波器以对振动模态施加陷波抑制。
7、第二方面,本申请实施例提供了一种绳驱机器人关节的振动抑制装置,包括:
8、振动抑制通道配置模块,用于为关节配置n路独立的振动抑制通道,每一振动抑制通道对应一个振动模态;
9、频谱分析模块,用于对于每一振动模态,在关节运动期间,同步采集关节的驱动器内部的q轴电流参考与速度误差,对q轴电流参考与速度误差在对应的频率搜索范围内进行频谱分析,得到振动模态当前的共振频率;
10、相关参数获取模块,用于获取当前的共振频率对应的振动模态的品质因数q值、q轴电流参考与速度误差之间的互相关系数,以及共振频率与速度环穿越频率的频率比;
11、陷波抑制施加模块,用于若根据品质因数q值、互相关系数及频率比确定振动模态的振动源为机械共振,则根据振动模态当前的共振频率与振动模态上一次频谱分析得到的共振频率更新振动模态对应的陷波器的陷波参数,并激活陷波器以对振动模态施加陷波抑制。
12、第三方面,本申请实施例提供了一种电子设备,包括存储器、处理器及存储在存储器上的计算机程序;
13、处理器执行计算机程序以实现第一方面实施例或第一方面任一可选实施例中所提供的方法。
14、第四方面,本申请实施例提供了一种计算机可读存储介质,计算机可读存储介质上存储有计算机程序,计算机程序被处理器执行时实现第一方面实施例或第一方面任一可选实施例中所提供的方法。
15、本申请实施例提供的技术方案带来的有益效果是:
16、通过预先标定振动模态数量n及各振动模态的频率搜索范围,并为关节配置n路分别对应各振动模态的独立振动抑制通道,使得在关节运动期间能够同步采集驱动器内部的q轴电流参考与速度误差,并在各振动模态对应的频率搜索范围内对二者进行频谱分析,从而得到各振动模态当前的共振频率;进一步获取当前共振频率对应振动模态的品质因数q值、q轴电流参考与速度误差之间的互相关系数以及该共振频率与速度环穿越频率的频率比,据此准确判别振动源是否为机械共振,并在判定为机械共振时,根据当前共振频率与上一次频谱分析得到的共振频率更新该振动模态对应陷波器的陷波参数,并激活该陷波器以施加陷波抑制。由此,即使绳驱机器人关节因钢丝绳张力、温度、磨损或蠕变导致等效刚度漂移、共振频率持续变化,也能在运行过程中按模态持续定位真实机械共振并自适应更新陷波参数,避免固定陷波器因频率漂移而失配,同时避免对非机械共振振动源误施加陷波抑制,从而提高绳驱机器人关节振动抑制的准确性和稳定性。
1.一种绳驱机器人关节的振动抑制方法,其特征在于,所述关节的等效刚度与钢丝绳张力相关,所述关节预先标定有振动模态数量n及各振动模态的频率搜索范围;所述方法包括:
2.根据权利要求1所述的方法,其特征在于,所述陷波参数至少包括陷波深度、陷波频率以及陷波带宽;
3.根据权利要求2所述的方法,其特征在于,所述相对变化量为所述振动模态当前的共振频率与所述振动模态上一次频谱分析得到的共振频率之差的绝对值,与所述振动模态上一次频谱分析得到的共振频率之比。
4.根据权利要求1或2所述的方法,其特征在于,所述振动模态的陷波器通过以下方式配置:
5.根据权利要求4所述的方法,其特征在于,所述根据所述品质因数q值和所述比值,判断当前机械共振的类型,包括:
6.根据权利要求1所述的方法,其特征在于,当所述绳驱机器人启动至所述关节首次运动之前,还包括确定用于作为所述振动模态在首次频谱分析前的上一次频谱分析得到的初始共振频率的步骤:
7.根据权利要求1所述的方法,其特征在于,所述关节的振动模态数量通过以下方式确定:
8.根据权利要求1所述的方法,其特征在于,所述激活所述陷波器以对所述振动模态施加陷波抑制之后,还包括对所述机械共振进行进一步验证的步骤:
9.一种绳驱机器人关节的振动抑制装置,其特征在于,包括:
10.一种电子设备,包括存储器、处理器及存储在存储器上的计算机程序,其特征在于,所述处理器执行所述计算机程序以实现权利要求1-8中任一项所述的方法。
11.一种计算机可读存储介质,其上存储有计算机程序,其特征在于,所述计算机程序被处理器执行时实现权利要求1-8中任一项所述的方法。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com