- 专利标题: 四自由度圆柱坐标型码垛机器人末端残余振动抑制方法
-
申请号: CN201710146810.1申请日: 2017-03-13
-
公开(公告)号: CN107053257B公开(公告)日: 2018-09-14
- 发明人: 于清洋 , 黄梁松 , 吕新荣
- 申请人: 中国石油大学(华东)
- 申请人地址: 山东省青岛市经济技术开发区长江西路66号
- 专利权人: 中国石油大学(华东)
- 当前专利权人: 中国石油大学(华东)
- 当前专利权人地址: 山东省青岛市经济技术开发区长江西路66号
- 代理机构: 青岛智地领创专利代理有限公司
- 代理商 陈海滨
- 主分类号: B25J19/00
- IPC分类号: B25J19/00
摘要:
本发明提出一种四自由度圆柱坐标型码垛机器人末端残余振动抑制方法,采集安装在四自由度圆柱坐标型码垛机器人大臂和末端的两个加速度传感器信号aB(t)和aT(t),将aB(t)和aT(t)进行离散傅立叶变换得到aB(jω)和aT(jω),将aT(jω)进行截止频率计算并得到截止频率ωc,通过aB(jω)、aT(jω)和ωc计算求得速度因子s和位置因子p,然后,通过s、p和ωc计算求得补偿力矩的参数,并得到补偿力矩F,将F作为码垛机器人腰部关节伺服电机的前馈补偿力矩对末端残余振动进行抑制。本发明的有益效果:针对四自由度圆柱坐标型码垛机器人高速定位时末端容易产生残余振动的问题,基于加速度传感器信号建立机器人腰部伺服电机补偿力矩进行振动抑制,该补偿力矩的参数通过在线整定方式进行快速优化。
公开/授权文献
- CN107053257A 用于四自由度圆柱坐标型码垛机器人的末端残余振动抑制的方法 公开/授权日:2017-08-18
IPC分类: