机器人的关节运动控制方法、机器人及存储介质与流程
本公开涉及机器人控制,尤其涉及机器人的关节运动控制方法、机器人及存储介质。
背景技术:
1、机器人包括多个关节,这些关节能够支持机器人完成各种动作,例如,行走、跳跃、摆臂及抓取等。关节处设置有驱动电机和关节控制器,关节控制器可以控制驱动电机工作,以使关节做出相应动作。一些机器人中,在关节的输出端还安装有力矩传感器,通过结合力矩传感器的反馈来调整驱动电机的电流,可以使关节输出端的实际的力矩尽可能贴近于目标力矩指令,实现关节的“力矩全闭环控制”。
2、然而,对于采用“力矩全闭环控制”的机器人,关节处的力矩跟随性和运动跟随性之间难以兼顾,导致机器人的运动效果较差。
技术实现思路
1、根据本公开的第一方面,提供了一种机器人的关节运动控制方法,所述关节采用力矩全闭环控制,包括:获取所述关节当前的运动状态参数;以及基于所述运动状态参数调节所述关节的阻尼参数,以使所述关节的实际力矩跟踪目标力矩指令。
2、在示例性实施方式中,所述获取所述关节当前的运动状态参数包括:获取所述关节当前的速度;所述基于所述运动状态参数调节所述关节的阻尼参数,包括:获取所述关节当前的阻尼参数;确定所述阻尼参数与第一阻尼阈值的大小关系;确定所述速度的绝对值与第一速度阈值的大小关系;响应于第一条件将所述关节的阻尼参数调节至第一目标阻尼参数,所述第一条件包括所述速度的绝对值大于或等于所述第一速度阈值且所述关节当前的阻尼参数大于或等于所述第一阻尼阈值,其中所述第一阻尼阈值大于所述第一目标阻尼参数,以及响应于第二条件将所述关节的阻尼参数调节至第二目标阻尼参数,所述第二条件包括所述速度的绝对值小于所述第一速度阈值且所述关节当前的阻尼参数小于所述第一阻尼阈值,其中所述第一阻尼阈值小于或等于所述第二目标阻尼参数。
3、在示例性实施方式中,所述获取所述关节当前的运动状态参数还包括:获取所述关节当前的加速度;所述基于所述运动状态参数调节所述关节的阻尼参数还包括:确定所述加速度的绝对值与第一加速度阈值的大小关系;其中,所述第一条件还包括所述加速度的绝对值大于或等于所述第一加速度阈值,以及所述第二条件还包括所述加速度的绝对值小于所述第一加速度阈值。
4、在示例性实施方式中,所述基于所述运动状态参数调节所述关节的阻尼参数还包括:获取所述关节所在肢体当前的运动相位;确定所述运动相位和所述关节的相位调整区间的关系;其中,所述第一条件还包括所述运动相位位于所述关节的相位调整区间内,以及所述第二条件还包括所述运动相位位于所述关节的相位调整区间外。
5、在示例性实施方式中,所述基于所述运动状态参数调节所述关节的阻尼参数还包括:获取所述关节在其所在肢体的当前运动周期中的位置指令和力矩指令;获取所述关节在其所在肢体的当前运动周期中的位置、速度及力矩的反馈信息;预测所述关节在未来的第一时间段内的运动趋势;所述第一时间段的时间长度小于所述运动周期的时间长度,所述运动趋势包括所述关节在满足所述第一条件或所述第二条件下的预测时间点;基于所述运动趋势,生成所述关节对应于所述预测时间点的多个阻尼参数预测值;每个所述阻尼参数预测值是所述第一目标阻尼参数或所述第二目标阻尼参数;以及在所述预测时间点将所述关节的阻尼参数调节至对应的所述阻尼参数预测值。
6、在示例性实施方式中,所述将所述关节的阻尼参数调节至第一目标阻尼参数,包括在第一响应时间内将所述关节的阻尼参数依次调节至多个第一过渡阻尼参数,以使所述关节的阻尼参数从所述当前的阻尼参数逐渐变化至所述第一目标阻尼参数;以及所述将所述关节的阻尼参数调节至所述第二目标阻尼参数,包括在第二响应时间内将所述关节的阻尼参数依次调节至多个第二过渡阻尼参数,以使所述关节的阻尼参数从所述当前的阻尼参数逐渐变化至所述第二目标阻尼参数。
7、在示例性实施方式中,所述多个第一过渡阻尼参数的值均位于所述当前的阻尼参数和所述第一目标阻尼参数之间,且从所述当前的阻尼参数到所述第一目标阻尼参数呈阶梯性变化;以及所述多个第二过渡阻尼参数的值均位于所述当前的阻尼参数和所述第二目标阻尼参数之间,且从所述当前的阻尼参数到所述第二目标阻尼参数呈阶梯性变化。
8、在示例性实施方式中,所述多个第一过渡阻尼参数中任意相邻的两个所述第一过渡阻尼参数之间的时间间隔相等;以及所述多个第二过渡阻尼参数中任意相邻的两个所述第二过渡阻尼参数之间的时间间隔相等。
9、在示例性实施方式中,所述第一目标阻尼参数是多个第一阻尼参数预设值中的一个,所述多个第一阻尼参数预设值与多个第一速度区间一一对应设置,所述多个第一速度区间相互不交叠;所述将所述关节的阻尼参数调节至第一目标阻尼参数,包括:确定所述关节当前速度的绝对值所在的所述第一速度区间;在所述第一响应时间内将所述关节的阻尼参数依次调节至所述多个第一过渡阻尼参数,以使所述关节的阻尼参数从所述当前的阻尼参数逐渐变化至与所述关节当前速度的绝对值所在的所述第一速度区间相对应的所述第一阻尼参数预设值。
10、在示例性实施方式中,所述基于所述运动状态参数调节所述关节的阻尼参数还包括:响应于第三条件将所述关节的阻尼参数调节至与所述关节当前速度的绝对值所在的所述第一速度区间相对应的所述第一阻尼参数预设值,所述第三条件包括所述速度的绝对值大于或等于所述第一速度阈值、所述关节当前的阻尼参数小于所述第一阻尼阈值,且所述关节当前的阻尼参数与所述关节当前速度的绝对值所在的所述第一速度区间之间不对应。
11、在示例性实施方式中,所述第一响应时间是多个第一预设时间段中的一个,所述多个第一预设时间段与所述多个第一阻尼参数预设值一一对应设置,且所述第一预设时间段的时间长度随对应的所述第一阻尼参数预设值的增大而减小。
12、在示例性实施方式中,所述第二目标阻尼参数是多个第二阻尼参数预设值中的一个,所述多个第二阻尼参数预设值与多个第二速度区间一一对应设置,所述多个第二速度区间相互不交叠;所述将所述关节的阻尼参数调节至第二目标阻尼参数,包括:确定所述关节当前速度的绝对值所在的所述第二速度区间;在第二响应时间内将所述关节的阻尼参数依次调节至多个第二过渡阻尼参数,以使所述关节的阻尼参数从所述当前的阻尼参数逐渐变化至与所述关节当前速度的绝对值所在的所述第二速度区间相对应的所述第二阻尼参数预设值。
13、在示例性实施方式中,所述基于所述运动状态参数调节所述关节的阻尼参数还包括:响应于第四条件将所述关节的阻尼参数调节至与所述关节当前速度的绝对值所在的所述第二速度区间相对应的所述第二阻尼参数预设值,所述第四条件包括所述关节当前速度的绝对值小于所述第一速度阈值、所述关节当前的阻尼参数大于或等于所述第一阻尼阈值,且所述关节当前的阻尼参数与所述关节当前速度的绝对值所在的所述第二速度区间之间不对应。
14、在示例性实施方式中,所述第二响应时间是多个第二预设时间段中的一个,所述多个第二预设时间段与所述多个第二阻尼参数预设值一一对应设置,且所述第二预设时间段的时间长度随对应的所述第二阻尼参数预设值的增大而增大。
15、在示例性实施方式中,所述第一响应时间等于所述第二响应时间。
16、根据本公开的第二个方面,提供了一种机器人,包括:至少一个处理单元;至少一个存储器,所述至少一个存储器被耦合到所述至少一个处理单元并且存储用于由所述至少一个处理单元执行的指令,所述指令在由所述至少一个处理单元执行时使所述机器人执行根据如上所述的机器人的关节运动控制方法。
17、在示例性实施方式中,所述机器人是人形机器人。
18、根据本公开的一个方面,提供了一种计算机可读存储介质,其上存储有计算机程序,所述计算机程序可由处理器执行以实现根据如上所述的机器人的关节运动控制方法。
19、本公开实施例提供的机器人的关节运动控制方法,通过在关节的运动过程中获取关节当前的运动状态参数,并基于运动状态参数实时调节关节的阻尼参数,机器人关节的速度的阻尼项的值不会随关节的动作变化而产生较大波动,使得关节的实际力矩能够实时跟踪目标力矩指令,有助于在保证关节的运动跟随性的同时,也获得较好的力矩跟随性。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com