一种工业机器人增益调整方法
【专利摘要】本发明提供了一种工业机器人增益调整方法，包括：建立电机控制模型，确定转动惯量与电机控制系统的关系公式；根据所述关系公式获取拉氏变换下速度环闭环的传递函数；获取负载在运动过程中的惯量参数；根据惯量参数得到速度环闭环传递函数的拉普拉斯变换公式中的速度环比例系数及速度环积分系数；将速度环比例系数及速度环积分系数代入速度环闭环传递函数的拉普拉斯变换公式获取最终速度环闭环传递函数的值控制机器人运动。该技术方案使得机器人的速度与精度得到保证，提高了工业机器人在高速运转条件下的稳定性。
【专利说明】
-种工业机器人増益调整方法
技术领域
[0001] 本发明属于机器人技术领域，具体来说，是一种工业机器人增益调整方法。
【背景技术】
[0002] 负载惯量识别技术对于电机在高速下保持高精度的运行特质至关重要，该技术用 于控制及调整工业机器人各个关节的速度环节部分，W便在高精度的要求下，机器人的各 个关节电机能够基于变化的负载惯量，实时的调整速度环的比例参数Kd与积分参数K 1的 值，进而保证机器人各个轴完成高精度作业。而对于此项技术国内驱动器产品尚未设猎，对 于负载惯量突然变化后的电机特性仍缺乏深入的研究与成熟的应用。
【发明内容】
[0003] 本发明的目的在于，解决工业机器人在应用中需要经过多个中间位姿的问题，并 且为了保证工业机器人在运动中负载变化剧烈时的调整时间过长的问题，提出了一种工业 机器人增益调整方法。
[0004] 为实现上述目的，本发明采用W下技术方案：
[0005] 建立电机控制模型，确定转动惯量与电机控制系统的关系公式；
[0006] 根据所述关系公式获取拉氏变换下速度环闭环的传递函数；
[0007] 获取负载在运动过程中的惯量参数；
[0008] 根据惯量参数得到速度环闭环传递函数的拉普拉斯变换公式中的速度环比例系 数及速度环积分系数；
[0009] 将速度环比例系数及速度环积分系数代入速度环闭环传递函数的拉普拉斯变换 公式获取最终速度环闭环传递函数的值控制机器人运动。
[0010] 优选的，所述根据所述关系公式获取拉氏变换下速度环闭环的传递函数具体为：
[0011] 对所述关系公式进行拉普拉斯变换，得到在初始状态下的近似拉氏方程；
[0012] 将所述近似拉氏方程等效为速度环闭环传递函数的拉普拉斯变换公式。
[0013] 优选的，所述获取负载在运动过程中的惯量参数，具体为：
[0014] 对电机在不同转矩与转速的条件下的进行速度积分，获取积分值的比例系数；
[0015] 根据积分值的比例系数获取负载在运动过程中的惯量参数。
[0016] 本发明较现有技术具有如下优点：本发明实现了在机器人不断运行过程中，各个 关节实时的进行惯量识别的功能，各个关节的电机速度环控制参数，会根据实时的惯量值 进行调整，完成机器人在不同姿态下的最优控制，使得机器人的速度与精度得到保证，提高 了工业机器人在高速运转条件下的稳定性。
【附图说明】
[0017] 图1是本发明实施例的方法流程图。
【具体实施方式】
[0018] 下面将结合附图和具体的实施例，对本发明的技术方案进行详细说明。
[0019] 如图1所示，为本发明一种工业机器人增益调整方法流程图，具体步骤为：
[0020] Sio:建立电机控制模型，确定转动惯量与电机控制系统的关系公式。
[0021] 在本实施例中的电机采用S相交流永磁同步电机，其控制模型为：
[0022] (1)
[002引其中R为绕组等效电阻，L为等效Q轴电感，P为电机磁极对数，为转子机械角 速度，为每对磁极磁通，J为折算到电机轴上的总转动惯量化g*nT2)，T为折算到电机总 负载的转矩（Nm)。通过该理论模型，建立了负载转动惯量与各个关节电机的电流值，力矩值 的函数关系。
[0024] S20 :根据所述关系公式获取拉氏变换下速度环闭环的传递函数。
[00巧]S201 :对步骤Sio中的关系公式进行拉普拉斯变换，得到在初始状态下，即电机转 速为零时的近似拉氏方程如公式（2)所示。
[0026]
C2)
[0027] 其中J为转子的转动惯量，R为电机等效电阻。
[0028] S202 :将所述近似拉氏方程等效为速度环闭环传递函数的拉普拉斯变换公式。
[0029] 在工业机器人电机控制中，采用=环控制的方法控制电机，即电流环，速度环与位 置环。经过公式（2)的模型变换后，速度环闭环传递函数可W等效为公式（3)的拉普拉斯 变换模型：
[0030] (3/ 阳03U 其中，Wb为闭环传递函数，K EP为电流环比例系数，K H为电流环积分系数，K SP为速 度环比例系数，Ksi为速度环积分系数。由公式（3)可W得出转动惯量J对整个系统稳定性 的影响。当负载惯量发生突变后，调整速度环的Ksp与K SI就可W让系统迅速恢复稳定。
[0032] S30 :获取负载在运动过程中的惯量参数。
[0033] S301 :对电机在不同转矩与转速的条件下的进行速度积分，获取积分值的比例系 数。
[0034] 在电机运行时，电机在位置环、速度环W及电流环的控制下，通过上层控制器的信 号运动。运时之前设定好的速度控制，电机控制模型同样开始接收位置输入指令，并且进行 计算得出速度值为￥。。1，实际值为Vagl,获取计算出的速度值和实际速度值各自积分值的比 例系鑽
[0035] S302:根据积分值的比例系数获取负载在运动过程中的惯量参数。
[0036] 上述比例系数与电机空载时的惯量值J的乘积，即为负载在运动过程中的惯量参 数户。如公式（4)所示。
[0037]
C 4)
[0038] S40:根据惯量参数得到速度环闭环传递函数的拉普拉斯变换公式中的速度环比 例系数及速度环积分系数。
[0039] 根据公式（5)和公式（6)得到速度环比例系数Ksp及速度环积分系数K SI。
[0040]
(5)
(技）
[0042] S50 :将速度环比例系数及速度环积分系数代入速度环闭环传递函数的拉普拉斯 变换公式获取最终速度环闭环传递函数的值控制机器人运动。
[0043] 将速度环比例系数Ksp及速度环积分系数Ksi代入速度环闭环传递函数的拉普拉斯 变换公式（3)获取最终速度环闭环传递函数We的值，根据该值控制机器人运动。
[0044] W上所述实施例仅表达了本发明的几种实施方式，其描述较为具体和详细，但并 不能因此而理解为对本发明专利范围的限制。应当指出的是，对于本领域的普通技术人员 来说，在不脱离本发明构思的前提下，还可W做出若干变形和改进，运些都属于本发明的保 护范围。因此，本发明专利的保护范围应W所附权利要求为准。
【主权项】
1. 一种工业机器人增益调整方法，其特征在于，包括以下步骤： 建立电机控制模型，确定转动惯量与电机控制系统的关系公式； 根据所述关系公式获取拉氏变换下速度环闭环的传递函数； 获取负载在运动过程中的惯量参数； 根据惯量参数得到速度环闭环传递函数的拉普拉斯变换公式中的速度环比例系数及 速度环积分系数； 将速度环比例系数及速度环积分系数代入速度环闭环传递函数的拉普拉斯变换公式 获取最终速度环闭环传递函数的值控制机器人运动。2. 如权利要求1所述的一种工业机器人增益调整方法，其特征在于，所述根据所述关 系公式获取拉氏变换下速度环闭环的传递函数具体为： 对所述关系公式进行拉普拉斯变换，得到在初始状态下的近似拉氏方程； 将所述近似拉氏方程等效为速度环闭环传递函数的拉普拉斯变换公式。3. 如权利要求1所述的一种工业机器人增益调整方法，其特征在于，所述获取负载在 运动过程中的惯量参数，具体为： 对电机在不同转矩与转速的条件下的进行速度积分，获取积分值的比例系数； 根据积分值的比例系数获取负载在运动过程中的惯量参数。
【文档编号】H02P23/14GK105827171SQ201510003446
【公开日】2016年8月3日
【申请日】2015年1月5日
【发明人】张勇, 徐方, 宋吉来, 李颖, 张彦超, 沈广通
【申请人】沈阳新松机器人自动化股份有限公司