重力补偿方法及装置

基本信息

申请号 CN202011586561.6 申请日 -
公开(公告)号 CN112757296A 公开(公告)日 2021-05-07
申请公布号 CN112757296A 申请公布日 2021-05-07
分类号 G06F17/15(2006.01)I;B25J18/00(2006.01)I;G06F30/23(2020.01)I;B25J9/16(2006.01)I;G06F17/13(2006.01)I 分类 -
发明人 辜纪文;林嘉;辜正涛 申请(专利权)人 南昌嘉研科技有限公司
代理机构 北京清亦华知识产权代理事务所(普通合伙) 代理人 彭琰
地址 330000江西省南昌市红谷滩新区红谷中大道1568号红谷凯旋商业办公综合楼及商业六806室(第8层)
法律状态 -

摘要

摘要 一种力反馈机械臂的重力补偿方法及装置,该重力补偿方法包括:实时获取所述每个旋转电机中电机编码器的输出值,并根据旋转电机中编码器的当前输出值确定对应的当前转角;根据每个旋转电机的当前转角计算与其输出轴连接的连杆与水平方向的当前夹角;获取每个连杆的长度和重量,以及每个连杆的重心到其基部转轴的距离,并根据每个连杆的当前夹角、每个连杆的长度和每个连杆的重量,以及每个连杆的重心到其基部转轴的距离计算各个旋转电机的重力补偿力矩;将各个补偿力矩分别发送至对应的旋转电机,以使各个旋转电机根据接收到的补偿力矩进行输出力矩补偿。