[发明专利]一种考虑摩擦的六自由度工业机器人动力学参数辨识方法有效
申请号: | 202210551540.3 | 申请日: | 2022-05-20 |
公开(公告)号: | CN114800519B | 公开(公告)日: | 2023-09-26 |
发明(设计)人: | 牛文铁;邵长虹;边乐鹏;郭永豪 | 申请(专利权)人: | 天津大学 |
主分类号: | B25J9/16 | 分类号: | B25J9/16 |
代理公司: | 天津市北洋有限责任专利代理事务所 12201 | 代理人: | 李素兰 |
地址: | 300350 天津市津南区海*** | 国省代码: | 天津;12 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 考虑 摩擦 自由度 工业 机器人 动力学 参数 辨识 方法 | ||
1.一种考虑摩擦的六自由度工业机器人动力学参数辨识方法,其特征在于包括以下步骤:
步骤一、建立考虑摩擦的六自由度工业机器人动力学模型,动力学方程表示如下:
其中采用Makkar模型,式中,分别为六自由度工业机器人的各个关节位移向量、速度向量和加速度向量,Rb为b维实数集,M(q)∈Rb×b,为六自由度工业机器人正定对称的惯性矩阵,为六自由度工业机器人的离心力与哥氏力矩阵,G(q)∈Rb为六自由度工业机器人的重力矩阵,为各个关节摩擦力矩向量,τ∈Rb为各个关节驱动力矩向量;
步骤二、对六自由度工业机器人动力学模型进行线性化和参数重组,得到如下公式:
其中,Kmin为六自由度工业机器人待辨识的最小动力学参数集,包含六自由度工业机器人各连杆基本惯性参数和各关节摩擦系数,为六自由度工业机器人系统观测矩阵;
步骤三、采用基于傅里叶级数展开的Freudenstein 1-3-5模型
设计并优化六自由度工业机器人各个关节的激励轨迹,Freudenstein 1-3-5模型中边界条件设定为:
为观测矩阵最小条件数;qmin、qmax分别为六自由度工业机器人各个关节可转动位置的下限、上限,分别为六自由度工业机器人各个关节的速度上限和加速度上限,分别为0时刻六自由度工业机器人关节位置、速度和加速度,分别为时刻tf时的六自由度工业机器人各个关节的位置、速度和加速度;
步骤四、采集六自由度工业机器人的各个关节的位置信息q和各个关节的驱动电流im,计算六自由度工业机器人的各个关节的速度加速度和采样力矩τc,以及观测矩阵
第一步,在机器人控制器中完成对步骤三获取的六自由度工业机器人各个关节的激励轨迹速度规划与插补,将插补后的六自由度工业机器人各个关节的激励轨迹输入到机器人驱动器中,驱动机器人关节转动;
第二步,在六自由度工业机器人按激励轨迹运行过程中采集六自由度工业机器人的各个关节的位置信息q和各个关节的驱动电流im,生成各个关节的位置曲线和驱动电流曲线,然后对位置曲线和驱动电流进行平滑滤波;
第三步,对滤波后的关节位置曲线拟合为改进的傅里叶级数,然后,对改进的傅里叶级数进行微分获得六自由度工业机器人的各个关节的速度和加速度
第四步,各个关节的采样力矩τc用下式估计得到:
τc=kaim
ka为驱动电机转矩常数;
第五步,将本步骤第三步获得的六自由度工业机器人的各个关节的位置q、速度和加速度代入观测矩阵的具体表达式中,求解得到观测矩阵的结果;
步骤五、选用基于改进的哈里斯鹰优化算法进行动力学参数辨识,对公式进行求解得到Kmin,其中理论力矩τ采用采样力矩τc代替。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于天津大学,未经天津大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202210551540.3/1.html,转载请声明来源钻瓜专利网。
- 上一篇:一种调度信令的检测方法及装置
- 下一篇:生态护坡及其施工方法