一种六轴机器人伺服电机参数自动调整的方法
【技术领域】
[0001] 本发明设及机器人控制领域，尤其是一种六轴机器人伺服电机参数自动调整的方 法。
【背景技术】
[0002] 随着电机控制技术和现代电力电子技术的快速发展，交流伺服电机W其高精度、 高动态响应等特性越来越多的应用于工业机器人场合，常见的交流伺服系统采用=环控制 系统，内环为电流环，中间环节为速度环，外环为位置控制环。在工程实际中，其调试环节 一般为速度环和位置环，具体参数包括位置环增益KPP，速度环增益KVP，速度环积分时间 TVI，负载惯量比JRAT，扭矩指令陷波滤波器中屯、频率B。
[0003] 在当前机器人伺服参数调试过程中，参数的调整与负载、摩擦力、机械共振等很多 因素有关，调试时需要专业人员具备丰富的伺服调试经验W及大量的时间去调试伺服参 数，运不但提高了对伺服调试人员的要求，也大大增加了产品生产周期。
【发明内容】
[0004] 本发明所要解决的技术问题在于，提供一种六轴机器人伺服电机参数自动调整的 方法，操作简便快速，效果优良，能够极大的减少相关人员的调试时间。 阳〇化]为解决上述技术问题，本发明提供一种六轴机器人伺服电机参数自动调整的方 法，包括如下步骤：
[0006] (1)将该六轴机器人分为转动TR、弯曲BN、旋转RT、肘邸、肩甜、腰WS六个轴，从 对多轴动作的机械特性影响最小的控制轴TR开始调整，其调整顺序为TR、BN、RT、EB、SH、 WS ；
[0007] 似在对每一轴进行调整时，分别在连续V t2、tsS个时刻采集电机的电磁转矩 Ti、T2、T3和运行速度V 1、V2、V3,将其带入常用伺服运动方程并对其进行处理后得总惯量公式
:由系统总惯量和已知的电机惯量就可W得出负载惯量，按照惯量 比公式可W得到惯量比，若惯量比稳定，则继续下一步骤，否则退出自调整；
[000引 做对电机发送测试信号并测定其频率特性，频率测定完成后，选择201ogiuV。。,/ Vw积分值最大的位置环比例增益KPP、速度环比例增益KVP、速度环积分时间常数TVI的值 作为系统参数值；
[0009] (4)采集编码器信息并进行分析W获得振幅和频率，如果振幅超过设定值，则系统 发生共振，当前频率为共振频率，共振抑制采用二阶陷波滤波器，设定当前频率为扭矩指令 陷波滤波器中屯、频率B，继续检测是否还存在共振，若共振继续存在则增加陷波滤波器深 度，直到共振消失；
[0010] (5)机器人的轴会进行最后运动，W检测枪头是否还存在抖动，若枪头部位安装振 动传感器检测到枪头发生抖动，则先降低KPP、KVP的值，若抖动依然存在则调整TVI的值直 到振动消失。
[0011] 优选的，步骤（2)中，根据总惯量J和电机惯量Jm,可得系统负载转矩Ji,根据惯量 比公式，
可得该轴惯量比，判断惯量是否满足要求，不满足要求则退出自 动进行调整。
[0012] 优选的，步骤（3)中，根据电机频率特性依次调整=个参数时，当输出越趋近于输 入，且未检测到共振和枪头抖动时，选择此时的KPP、KVP、TVI作为最佳参数。
[0013] 优选的，步骤（4)中，振动检测包括硬件检测和软件检测两种，硬件检测在枪头安 装振动传感器，若枪头发生振动，则发送振动信号给伺服系统，判断枪头发生振动；软件检 测对编码器信号进行分析获得该轴振幅W及频率，若振幅超过设定值，则判断该轴发生共 振。
[0014] 本发明的有益效果为：操作简便快速，效果优良，能够极大的减少相关人员的调试 时间。
【附图说明】
[0015] 图1是本发明的六轴机器人伺服电机参数自调整流程图。
[0016] 图2是本发明的六轴机器人某一轴伺服电机参数自调整流程图。
[0017] 图3是本发明的通过频率特性图。
【具体实施方式】 阳01引如图1所示，该六轴机器人包括TR、BN、RT、EB、SH、WS六个轴，从对多轴动作的机 械特性如位置的精度影响最小的控制轴TR开始调整，其调整顺序为TR、BN、RT、EB、甜、WS， 其中每一个轴的调整方法均相同。
[0019] 如图2所示，每一个轴的调整方法包括如下步骤：
[0020] (1)计算电机惯量比
[0021] 分别在连续ti、t2、tsS个时刻采集电机的电磁转矩T1、T2、Ts和运行速度V1、V2、 V3,将其带入常用伺服运动方程并对其进行处理后得总惯量公式
由系统总惯量和已知的电机惯量就可W得出负载惯量，根据总惯量J和电机惯量Jm,可得系 统负载转矩Ji,根据惯量比公式
可得该轴惯量比，判断惯量是否满足要 求，不满足要求则退出自动进行调整，此时可能电机或者减速机的选择存在问题。
[0022] (2)分析频率特性决定参数
[0023] 如图3所示，对电机发送测试信号并测定其频率特性，频率范围为10化到2000化， 横轴为频率的对数刻度，纵轴为201ogwVwt/Viw。频率特性分析就是调查输入不同频率Vw 频率范围为10化到2000化时，输出Vwt的相位和幅值会如何变化。对输出进行处理，当 输出越趋向于输入时，201ogieV"ut/Viw的值越趋向于0,此时图3中曲线和横轴重合。对 2〇l〇giJuutAw进行积分处理，频率测定完成后，选取积分值最大时的KPP、KVP、TVI的值作 为系统参数值。
[0024] 做共振抑制
[00巧]采集编码器信息并进行分析W获得振幅和频率，如果振幅超过设定值，则系统发 生共振，当前频率为共振频率，共振抑制采用二阶陷波滤波器，设定当前频率为扭矩指令陷 波滤波器中屯、频率B，继续检测是否还存在共振，若共振继续存在则增加陷波滤波器深度， 直到共振消失。振动检测包括硬件检测和软件检测两种，硬件检测在枪头安装振动传感器， 若枪头发生振动，则发送振动信号给伺服系统，判断枪头发生振动；软件检测对编码器信号 进行分析获得该轴振幅W及频率，若振幅超过设定值，则判断该轴发生共振。
[0026] (4)抖动抑制
[0027] 机器人轴会进行最后运动，W检测枪头是否还存在抖动，若枪头部位安装振动传 感器检测到枪头发生抖动，则先降低KPP、KVP的值，若抖动依然存在则调整TVI的值直到振 动消失。
[0028] 尽管本发明就优选实施方式进行了示意和描述，但本领域的技术人员应当理解， 只要不超出本发明的权利要求所限定的范围，可W对本发明进行各种变化和修改。
【主权项】
1. 一种六轴机器人伺服电机参数自动调整的方法，其特征在于，包括如下步骤： (1)将该六轴机器人分为TR、BN、RT、EB、SH、WS六个轴，从对多轴动作的机械特性影响 最小的控制轴TR开始调整，其调整顺序为TR、BN、RT、EB、SH、WS; ⑵在对每一轴进行调整时，分别在连续Vt2、个时刻采集电机的电磁转矩Tr T2、T3和运行速度Vl、v2、V3，将其带入常用伺服运动方程并对其进行处理后得总惯量公式由系统总惯量和已知的电机惯量就可以得出负载惯量，按照惯量 比公式可以得到惯量比，若惯量比稳定，则继续下一步骤，否则退出自调整； ⑶对电机发送测试信号并测定其频率特性，频率测定完成后，选取201〇&。^/&积 分值最大时的位置环比例增益KPP、速度环比例增益KVP、速度环积分时间常数TVI的值作 为系统参数值； (4) 采集编码器信息并进行分析以获得振幅和频率，如果振幅超过设定值，则系统发生 共振，当前频率为共振频率，共振抑制采用二阶陷波滤波器，设定当前频率为扭矩指令陷波 滤波器中心频率B，继续检测是否还存在共振，若共振继续存在则增加陷波滤波器深度，直 到共振消失； (5) 机器人的轴会进行最后运动，以检测枪头是否还存在抖动，若枪头部位安装振动传 感器检测到枪头发生抖动，则先降低KPP、KVP的值，若抖动依然存在则调整TVI的值直到振 动消失。2. 如权利要求1所述的六轴机器人伺服电机参数自动调整的方法，其特征在 于，步骤⑵中，根据总惯量J和电机惯量JM，可得系统负载转矩J1，根据惯量比公式可得该轴惯量比，判断惯量是否满足要求，不满足要求则退出自动进行 调整。3. 如权利要求1所述的六轴机器人伺服电机参数自动调整的方法，其特征在于，步骤 (3) 中，根据电机频率特性依次调整三个参数时，当输出越趋近于输入，且未检测到共振和 枪头抖动时，选择此时的KPP、KVP、TVI作为最佳参数。4. 如权利要求1所述的六轴机器人伺服电机参数自动调整的方法，其特征在于，步骤 (4) 中，振动检测包括硬件检测和软件检测两种，硬件检测在枪头安装振动传感器，若枪头 发生振动，则发送振动信号给伺服系统，判断枪头发生振动；软件检测对编码器信号进行分 析获得该轴振幅以及频率，若振幅超过设定值，则判断该轴发生共振。
【专利摘要】本发明公开了一种六轴机器人伺服电机参数自动调整的方法，将该六轴机器人分为TR、BN、RT、EB、SH、WS六个轴，从对多轴动作的机械特性影响最小的控制轴TR开始调整，其调整顺序为TR、BN、RT、EB、SH、WS；在对每一轴进行调整时，让该轴转动一周，采集伺服系统输入输出信号，根据其频率特性依次调整位置环比例增益KPP、速度环比例增益KVP和速度环积分时间常数TVI；若振动传感器检测到振动，则先降低KPP、KVP的值，若降低到一定值后，枪头振动依然存在则逐步提高TVI的值直到振动消失。本发明的有益效果为：操作简便快速，效果优良，能够极大的减少相关人员的调试时间。
【IPC分类】H02P21/14
【公开号】CN105391361
【申请号】CN201510947140
【发明人】何莉鹏, 陈小波, 何杏兴, 王富林
【申请人】南京熊猫电子股份有限公司, 南京熊猫电子装备有限公司, 南京熊猫仪器仪表有限公司
【公开日】2016年3月9日
【申请日】2015年12月16日