关节模组控制方法、计算机设备和计算机可读存储介质
本申请属于电机控制,特别是涉及一种关节模组控制方法、计算机设备和计算机可读存储介质。
背景技术:
1、关节模组作为机器人关节的核心执行单元,其性能直接影响到整机的运动精度、动态响应和安全性。在机器人运动过程中,关节模组需要频繁启停、变速和换向,对电机的控制精度和响应速度提出了较高要求。因此关节模组传感器的精度与稳定性至关重要。现有技术对于传感器的校准存在无法在线完成、调参困难等问题。如何提高传感器的校准精度,实现在线校准与自适应调整是本领域技术人员亟待解决的技术问题。
2、前面的叙述在于提供一般的背景信息,并不一定构成现有技术。
技术实现思路
1、本申请的目的在于提供一种关节模组控制方法、计算机设备和计算机可读存储介质,能够实现关节模组的在线校准与自适应调整。
2、为达到上述目的:
3、第一方面,本申请实施例提供了一种关节模组控制方法,应用于机器人关节模组,包括如下步骤:确定控制指令,控制指令包括角度校准指令、摩擦力补偿指令和速度观测指令中的至少一种;响应于控制指令,对关节模组执行对应的控制操作。
4、在本申请一可选实施例中,当控制指令包括角度校准指令时,对关节模组执行对应的控制操作,包括:控制电机分别以第一方向和第二方向旋转预设圈数至采样位置,获取采样位置处的正向误差样本和反向误差样本;基于正向误差样本和反向误差样本,计算对应采样位置处的误差序列;根据误差序列生成角度补偿数据,角度补偿数据用于校准关节模组。
5、在本申请一可选实施例中,基于正向误差样本和反向误差样本,计算对应采样位置处的误差序列,包括:对正向误差样本和反向误差样本进行均值处理,得到均值误差;对均值误差进行滑动平均滤波处理,得到误差序列;滑动平均滤波处理中的滤波窗口大小等于电机的每极对采样数。
6、在本申请一可选实施例中,根据误差序列生成角度补偿数据,包括:获取查找表,查找表包含多个采样位置对应的角度补偿值;将误差序列中的误差值映射至查找表中对应采样位置的角度补偿值,得到角度补偿数据。
7、在本申请一可选实施例中,根据误差序列生成角度补偿数据之前,方法还包括:计算误差序列的均值,以作为零位偏移量;将电机的机械角度归一化为预设数量的离散点;根据零位偏移量计算每个离散点对应的角度补偿值;基于角度补偿值,以及角度补偿值与离散点的对应关系,构建查找表。
8、在本申请一可选实施例中,当控制指令包括摩擦力补偿指令时,对关节模组执行对应的控制操作,包括:获取关节速度;以关节速度为输入,基于连续库仑摩擦力模型计算摩擦补偿力矩;连续摩擦模型包括库仑摩擦力分量和关于关节速度的连续切换函数;连续切换函数在零速处连续可导,使摩擦补偿力矩在零速附近平滑过渡;将摩擦补偿力矩作为前馈项叠加至关节模组的驱动控制输出。
9、在本申请一可选实施例中,将摩擦补偿力矩作为前馈项叠加至关节模组的驱动控制输出,包括:判断摩擦补偿力矩控制是否满足预期效果;若不满足,则从候选摩擦模型中选择一种替换连续库仑摩擦力模型再次计算摩擦补偿力矩,直至满足预期效果;候选摩擦模型包括标准库伦摩擦模型、指数拟合模型和斯特里贝克摩擦模型中的一个。
10、在本申请一可选实施例中,当控制指令包括速度观测指令时,对关节模组执行对应的控制操作,包括:将电机的q轴电流分解为加速度电流分量和负载电流分量;构建pi型速度观测器,以原始速度与观测速度之差作为pi型速度观测器的输入,通过比例积分控制估计负载电流分量;基于加速度电流分量和估计的负载电流分量,生成观测速度。
11、第二方面,本申请实施例提供一种计算机设备,包括:处理器和存储有计算机程序的存储器,在所述处理器运行所述计算机程序时,实现上述方法的步骤。
12、第三方面,本申请实施例提供一种计算机可读存储介质,所述计算机可读存储介质中存储有计算机程序,所述计算机程序被处理器执行时实现上述方法的步骤。
13、采用本申请实施例,具有如下有益效果:
14、本申请提供的关节模组控制方法,应用于机器人关节模组,包括如下步骤:确定控制指令,控制指令包括角度校准指令、摩擦力补偿指令和速度观测指令中的至少一种;响应于控制指令,对关节模组执行对应的控制操作。因此,本申请能够实现关节模组的在线校准与自适应调整。通过统一的控制指令框架,将角度校准、摩擦力补偿和速度观测三种控制功能集成于关节模组的控制流程中。控制指令可以由上位控制器下发,也可以由关节模组本地的控制器根据当前工况自主生成。三种控制指令可以独立触发执行,也可以根据实际需要组合执行,从而为关节模组提供灵活、全面的控制能力。在整体层面,三项技术均基于简单的算术运算实现,计算效率高,适合嵌入式控制器实时执行。三项技术可以独立启用,也可以协同工作,为关节模组提供了灵活、全面的控制能力提升方案。
15、上述说明仅是本申请技术方案的概述,为了能够更清楚了解本申请的技术手段,而可依照说明书的内容予以实施,并且为了让本申请的上述和其他目的、特征和优点能够更明显易懂,以下特举较佳实施例,并配合附图,详细说明。应当理解的是,以上的一般描述和后文的细节描述仅是示例性和解释性的,并不能限制本申请。
1.一种关节模组控制方法,应用于机器人关节模组,其特征在于,包括如下步骤:
2.如权利要求1所述的关节模组控制方法,其特征在于,当所述控制指令包括所述角度校准指令时,
3.如权利要求2所述的关节模组控制方法,其特征在于,所述基于所述正向误差样本和反向误差样本,计算对应采样位置处的误差序列,包括:
4.如权利要求2所述的关节模组控制方法,其特征在于,所述根据所述误差序列生成角度补偿数据,包括:
5.如权利要求4所述的关节模组控制方法,其特征在于,所述根据所述误差序列生成角度补偿数据之前,所述方法还包括:
6.如权利要求1所述的关节模组控制方法,其特征在于,当所述控制指令包括所述摩擦力补偿指令时,
7.如权利要求6所述的关节模组控制方法,其特征在于,所述将所述摩擦补偿力矩作为前馈项叠加至所述关节模组的驱动控制输出,包括:
8.如权利要求1所述的关节模组控制方法,其特征在于,当所述控制指令包括所述速度观测指令时,
9.一种计算机设备,其特征在于,包括处理器和存储器;
10.一种计算机可读存储介质,其特征在于,所述计算机可读存储介质存储有计算机程序,所述计算机程序被处理器执行时实现如权利要求1到8中任一项所述方法。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com