一种scara机器人关节扰动补偿方法

基本信息

申请号 CN202110361239.1 申请日 -
公开(公告)号 CN113059567A 公开(公告)日 2021-07-02
申请公布号 CN113059567A 申请公布日 2021-07-02
分类号 B25J9/16;B25J9/04 分类 手动工具;轻便机动工具;手动器械的手柄;车间设备;机械手;
发明人 韩峰涛;庹华;刘超丛;曹华;张航;韩建欢;雷鸿;于文进;钱鹏 申请(专利权)人 珞石(山东)智能科技有限公司
代理机构 北京瑞盛铭杰知识产权代理事务所(普通合伙) 代理人 李绩
地址 273512 山东省济宁市邹城市中心店镇机电产业园恒丰路888号
法律状态 -

摘要

摘要 本发明提出了一种scara机器人关节扰动补偿方法,包括:建立scara机器人关节电机端拉格朗日动力学方程;在scara机器人的第一关节第二关节输出端分别安装角速度传感器,根据两个角速度传感器获取两个关节减速器输出端旋转速度及位移;计算出电机端扰动补偿项;获取当前关节位置与期望关节位置误差;将位置误差送入到补偿增益ILC模块,更新补偿增益;将对应载波周期的补偿增益和计算出来的力矩补偿量进行乘法运算,补偿到力矩环中。本发明通过动力学模型计算扰动补偿量通;通过补偿量乘以可变补偿增益进一步优化扰动补偿效果;补偿增益通过ILC迭代学习进行优化,对负载变化具有学习适应能力。