机器宠物微型关节控制方法、系统及仿生机器宠物与流程
本发明涉及仿生机器人关节控制,具体涉及一种机器宠物微型关节控制方法、系统及仿生机器宠物。
背景技术:
1、仿生机器宠物通过分布于躯干、四肢及面部末梢的多个关节协同动作,实现步态行走、姿态调整与表情交互。随着交互细腻度要求提升,其关节体系分化为承担肢体运动的主力驱动大关节和设置于耳廓、眉眼、指尖、尾梢等部位的微型柔性小关节。微型柔性小关节通常内置微型空心杯电机、微型霍尔编码器和减速微传动模组,并接入三级can fd分层通信矩阵进行报文调度与时序管理。
2、现有技术对微型柔性小关节的控制存在不足。微型柔性小关节的减速微传动模组体积小、传动阻尼非线性、正反转摩擦不对称且回程间隙较大,零位附近及换向位置易形成非线性摩擦死区,同等驱动电压下正反转转角不对称,微动控位产生漂移;现有控制方式多采用固定补偿参数,难以适配温度变化及使用磨损引起的摩擦参数变化。同时,微动报文与主力驱动大关节的大功率报文共用总线通道时,易受电磁干扰和带宽挤占,导致微动指令下发滞后。此外,主力驱动大关节与微型柔性小关节因负载力矩和响应速度差异,共用时序指令时动作不同步,微型柔性小关节易因受力形变导致减速微传动模组齿轮磨损;长期运行后受温度、磨损及装配公差影响,零位偏移逐渐累积。
3、综上,现有技术中微型柔性小关节存在微动控位精度较低、微动指令传输滞后、大小关节动作同步偏差较大以及减速微传动模组使用寿命较短等问题,难以满足仿生机器宠物高细腻度交互对微型关节控制准确性与稳定性的要求。
技术实现思路
1、有鉴于此,有必要提供一种机器宠物微型关节控制方法、系统及仿生机器宠物,用以解决现有技术中微型柔性小关节因摩擦死区补偿不准确、力矩耦合缺失,导致微动控位精度低、指令传输滞后、大小关节同步偏差大的技术问题。
2、为了解决上述技术问题,第一方面,本发明提供了一种机器宠物微型关节控制方法,用于仿生机器宠物,所述仿生机器宠物搭载三级can fd分层通信矩阵,并区分主力驱动大关节和微型柔性小关节,所述微型柔性小关节内置微型空心杯电机、微型霍尔编码器和减速微传动模组,所述机器宠物微型关节控制方法包括:
3、通过所述微型柔性小关节对应的节点子矩阵专属微动报文组,获取所述微型霍尔编码器采样的微动角度以及总线回传的微母线电流数据;
4、根据所述微动角度和所述微母线电流数据,辨识所述减速微传动模组的静摩擦系数和回程间隙参数;
5、根据所述静摩擦系数和所述回程间隙参数,建立所述微型柔性小关节的非线性死区模型,并根据所述非线性死区模型在正反转切换的微小转角区间确定动态电流前馈补偿量;
6、采用位置环、速度环和电流环的三环闭环调节,并将所述动态电流前馈补偿量叠加至所述三环闭环调节中,输出分级pwm驱动信号,其中,所述位置环以所述微动角度作为位置反馈量并采用微分自适应pid调控,所述电流环以所述微母线电流数据作为电流反馈量并采用负载电流限幅调控,所述分级pwm驱动信号用于驱动所述微型空心杯电机。
7、在一种可能的实现方式中,所述节点子矩阵专属微动报文组采用11位标准can fdid独立段位、帧长8byte且承载目标微角度和补偿系数双数据位的报文格式,所述节点子矩阵专属微动报文组的优先级高于常规姿态反馈报文且低于故障告警报文。
8、在一种可能的实现方式中,所述根据所述微动角度和所述微母线电流数据,辨识所述减速微传动模组的静摩擦系数和回程间隙参数,包括:
9、通过所述微型霍尔编码器,以预设采样频率采样所述微动角度,得到多组增量角度采样值,所述多组增量角度采样值通过单帧can fd微动报文传输;
10、根据所述微型柔性小关节的工况类型,以空载工况对应的第一辨识周期和触碰负载工况对应的第二辨识周期,对所述多组增量角度采样值和所述微母线电流数据进行参数辨识,得到所述减速微传动模组的静摩擦系数和回程间隙参数,并将所述静摩擦系数和所述回程间隙参数同步存储至节点子矩阵,所述第一辨识周期大于所述第二辨识周期。
11、在一种可能的实现方式中,所述根据所述非线性死区模型在正反转切换的微小转角区间确定动态电流前馈补偿量,包括:
12、根据所述非线性死区模型,在所述正反转切换的微小转角区间启用非线性变系数补偿,所述非线性变系数补偿对应的补偿系数随转角变化;
13、在正反转换向瞬间,将所述非线性变系数补偿对应的补偿量瞬时提升,以抵消所述减速微传动模组的转角空程。
14、在一种可能的实现方式中,所述根据所述非线性死区模型在正反转切换的微小转角区间确定动态电流前馈补偿量,还包括:
15、根据所述非线性死区模型,在转角超出所述微小转角区间的大幅偏转区间启用固定常量补偿,所述固定常量补偿对应的补偿系数不随转角变化。
16、在一种可能的实现方式中,所述位置环以所述微动角度作为位置反馈量并采用微分自适应pid调控,包括:
17、对所述微动角度进行微动阈值滤波,剔除霍尔编码器电磁杂波微脉冲,确定最小有效微动角度;
18、根据所述最小有效微动角度滤除无效抖动转角,使常态微动位置稳态误差小于所述最小有效微动角度。
19、在一种可能的实现方式中,所述采用位置环、速度环和电流环的三环闭环调节,并将所述动态电流前馈补偿量叠加至所述三环闭环调节中,输出分级pwm驱动信号之后,还包括:
20、获取同侧联动的所述主力驱动大关节与所述微型柔性小关节的动作时序;
21、根据所述动作时序,对所述主力驱动大关节与所述微型柔性小关节进行力矩耦合校正,使所述主力驱动大关节与所述微型柔性小关节的动作时序偏差小于等于第一时序阈值;
22、对校正后的所述动作时序进行时延自适应补偿,使整机中各所述主力驱动大关节与各所述微型柔性小关节的综合同步偏差小于等于第二时序阈值,所述第二时序阈值大于所述第一时序阈值。
23、在一种可能的实现方式中,所述通过所述微型柔性小关节对应的节点子矩阵专属微动报文组,获取所述微型霍尔编码器采样的微动角度以及总线回传的微母线电流数据之前,还包括:
24、响应于所述仿生机器宠物上电,通过can fd全域时钟同步帧触发所述微型柔性小关节以低速运行至零位;
25、获取所述微型柔性小关节在所述零位处的零位摩擦偏移值,并根据所述零位摩擦偏移值修正报文零位偏移参数。
26、另一方面,本发明还提供了一种机器宠物微型关节控制系统,用于仿生机器宠物,所述仿生机器宠物搭载三级can fd分层通信矩阵,并区分主力驱动大关节和微型柔性小关节,所述微型柔性小关节内置微型空心杯电机、微型霍尔编码器和减速微传动模组,所述机器宠物微型关节控制系统包括:
27、报文调度单元,用于通过所述微型柔性小关节对应的节点子矩阵专属微动报文组,获取所述微型霍尔编码器采样的微动角度以及总线回传的微母线电流数据;
28、参数辨识单元,用于根据所述微动角度和所述微母线电流数据,辨识所述减速微传动模组的静摩擦系数和回程间隙参数;
29、前馈补偿单元,用于根据所述静摩擦系数和所述回程间隙参数,建立所述微型柔性小关节的非线性死区模型,并根据所述非线性死区模型在正反转切换的微小转角区间确定动态电流前馈补偿量;
30、闭环调节单元,用于采用位置环、速度环和电流环的三环闭环调节,并将所述动态电流前馈补偿量叠加至所述三环闭环调节中,输出分级pwm驱动信号,其中,所述位置环以所述微动角度作为位置反馈量并采用微分自适应pid调控,所述电流环以所述微母线电流数据作为电流反馈量并采用负载电流限幅调控,所述分级pwm驱动信号用于驱动所述微型空心杯电机。
31、第三方面,本发明还提供了一种仿生机器宠物,包括躯干、主力驱动大关节、微型柔性小关节和控制器;
32、所述微型柔性小关节设置于所述仿生机器宠物的耳廓、眉眼、指尖或尾梢,所述微型柔性小关节内置微型空心杯电机、微型霍尔编码器和减速微传动模组;
33、所述控制器搭载三级can fd分层通信矩阵,并执行上述任意实现方式中所述的机器宠物微型关节控制方法的步骤。
34、本发明的有益效果是:本发明提供的机器宠物微型关节控制方法,通过节点子矩阵专属微动报文组获取微动角度和微母线电流数据,使微型柔性小关节的数据获取与主力驱动大关节的大功率报文相互隔离,有助于提高微动角度和微母线电流数据获取的稳定性;根据微动角度和微母线电流数据辨识减速微传动模组的静摩擦系数和回程间隙参数,使摩擦参数能够随工况变化实时更新,有利于适应温度变化和使用磨损引起的参数漂移;根据静摩擦系数和回程间隙参数建立非线性死区模型,并在正反转切换的微小转角区间确定动态电流前馈补偿量,使前馈补偿量与当前摩擦死区状态相匹配,有助于抵消减速微传动模组的转角空程;采用位置环、速度环和电流环的三环闭环调节,将动态电流前馈补偿量叠加至三环闭环调节中,位置环以微动角度作为位置反馈量并采用微分自适应pid调控,电流环以微母线电流数据作为电流反馈量并采用负载电流限幅调控,输出分级pwm驱动信号驱动微型空心杯电机,使前馈补偿与闭环反馈协同作用于微型空心杯电机,有利于抑制微动超调并限制瞬时启动电流,提高了微型柔性小关节的微动控位精度。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com