CN105827171A - 一种工业机器人增益调整方法 - Google Patents
一种工业机器人增益调整方法 Download PDFInfo
- Publication number
- CN105827171A CN105827171A CN201510003446.4A CN201510003446A CN105827171A CN 105827171 A CN105827171 A CN 105827171A CN 201510003446 A CN201510003446 A CN 201510003446A CN 105827171 A CN105827171 A CN 105827171A
- Authority
- CN
- China
- Prior art keywords
- speed
- speed ring
- transfer function
- formula
- closed loop
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Landscapes
- Feedback Control In General (AREA)
Abstract
本发明提供了一种工业机器人增益调整方法,包括:建立电机控制模型,确定转动惯量与电机控制***的关系公式;根据所述关系公式获取拉氏变换下速度环闭环的传递函数;获取负载在运动过程中的惯量参数;根据惯量参数得到速度环闭环传递函数的拉普拉斯变换公式中的速度环比例系数及速度环积分系数;将速度环比例系数及速度环积分系数代入速度环闭环传递函数的拉普拉斯变换公式获取最终速度环闭环传递函数的值控制机器人运动。该技术方案使得机器人的速度与精度得到保证,提高了工业机器人在高速运转条件下的稳定性。
Description
技术领域
本发明属于机器人技术领域,具体来说,是一种工业机器人增益调整方法。
背景技术
负载惯量识别技术对于电机在高速下保持高精度的运行特质至关重要,该技术用于控制及调整工业机器人各个关节的速度环节部分,以便在高精度的要求下,机器人的各个关节电机能够基于变化的负载惯量,实时的调整速度环的比例参数Kd与积分参数Ki的值,进而保证机器人各个轴完成高精度作业。而对于此项技术国内驱动器产品尚未涉猎,对于负载惯量突然变化后的电机特性仍缺乏深入的研究与成熟的应用。
发明内容
本发明的目的在于,解决工业机器人在应用中需要经过多个中间位姿的问题,并且为了保证工业机器人在运动中负载变化剧烈时的调整时间过长的问题,提出了一种工业机器人增益调整方法。
为实现上述目的,本发明采用以下技术方案:
建立电机控制模型,确定转动惯量与电机控制***的关系公式;
根据所述关系公式获取拉氏变换下速度环闭环的传递函数;
获取负载在运动过程中的惯量参数;
根据惯量参数得到速度环闭环传递函数的拉普拉斯变换公式中的速度环比例系数及速度环积分系数;
将速度环比例系数及速度环积分系数代入速度环闭环传递函数的拉普拉斯变换公式获取最终速度环闭环传递函数的值控制机器人运动。
优选的,所述根据所述关系公式获取拉氏变换下速度环闭环的传递函数具体为:
对所述关系公式进行拉普拉斯变换,得到在初始状态下的近似拉氏方程;
将所述近似拉氏方程等效为速度环闭环传递函数的拉普拉斯变换公式。
优选的,所述获取负载在运动过程中的惯量参数,具体为:
对电机在不同转矩与转速的条件下的进行速度积分,获取积分值的比例系数;
根据积分值的比例系数获取负载在运动过程中的惯量参数。
本发明较现有技术具有如下优点:本发明实现了在机器人不断运行过程中,各个关节实时的进行惯量识别的功能,各个关节的电机速度环控制参数,会根据实时的惯量值进行调整,完成机器人在不同姿态下的最优控制,使得机器人的速度与精度得到保证,提高了工业机器人在高速运转条件下的稳定性。
附图说明
图1是本发明实施例的方法流程图。
具体实施方式
下面将结合附图和具体的实施例,对本发明的技术方案进行详细说明。
如图1所示,为本发明一种工业机器人增益调整方法流程图,具体步骤为:
S10:建立电机控制模型,确定转动惯量与电机控制***的关系公式。
在本实施例中的电机采用三相交流永磁同步电机,其控制模型为:
其中R为绕组等效电阻,L为等效Q轴电感,p为电机磁极对数,ωm为转子机械角速度,ψr为每对磁极磁通,J为折算到电机轴上的总转动惯量(kg*m^2),T为折算到电机总负载的转矩(Nm)。通过该理论模型,建立了负载转动惯量与各个关节电机的电流值,力矩值的函数关系。
S20:根据所述关系公式获取拉氏变换下速度环闭环的传递函数。
S201:对步骤S10中的关系公式进行拉普拉斯变换,得到在初始状态下,即电机转速为零时的近似拉氏方程如公式(2)所示。
其中J为转子的转动惯量,R为电机等效电阻。
S202:将所述近似拉氏方程等效为速度环闭环传递函数的拉普拉斯变换公式。
在工业机器人电机控制中,采用三环控制的方法控制电机,即电流环,速度环与位置环。经过公式(2)的模型变换后,速度环闭环传递函数可以等效为公式(3)的拉普拉斯变换模型:
其中,WB为闭环传递函数,KEP为电流环比例系数,KEI为电流环积分系数,KSP为速度环比例系数,KSI为速度环积分系数。由公式(3)可以得出转动惯量J对整个***稳定性的影响。当负载惯量发生突变后,调整速度环的KSP与KSI就可以让***迅速恢复稳定。
S30:获取负载在运动过程中的惯量参数。
S301:对电机在不同转矩与转速的条件下的进行速度积分,获取积分值的比例系数。
在电机运行时,电机在位置环、速度环以及电流环的控制下,通过上层控制器的信号运动。这时之前设定好的速度控制,电机控制模型同样开始接收位置输入指令,并且进行计算得出速度值为Vcal,实际值为Vreal,获取计算出的速度值和实际速度值各自积分值的比例系数
S302:根据积分值的比例系数获取负载在运动过程中的惯量参数。
上述比例系数与电机空载时的惯量值J的乘积,即为负载在运动过程中的惯量参数J*。如公式(4)所示。
S40:根据惯量参数得到速度环闭环传递函数的拉普拉斯变换公式中的速度环比例系数及速度环积分系数。
根据公式(5)和公式(6)得到速度环比例系数KSP及速度环积分系数KSI。
S50:将速度环比例系数及速度环积分系数代入速度环闭环传递函数的拉普拉斯变换公式获取最终速度环闭环传递函数的值控制机器人运动。
将速度环比例系数KSP及速度环积分系数KSI代入速度环闭环传递函数的拉普拉斯变换公式(3)获取最终速度环闭环传递函数WB的值,根据该值控制机器人运动。
以上所述实施例仅表达了本发明的几种实施方式,其描述较为具体和详细,但并不能因此而理解为对本发明专利范围的限制。应当指出的是,对于本领域的普通技术人员来说,在不脱离本发明构思的前提下,还可以做出若干变形和改进,这些都属于本发明的保护范围。因此,本发明专利的保护范围应以所附权利要求为准。
Claims (3)
1.一种工业机器人增益调整方法,其特征在于,包括以下步骤:
建立电机控制模型,确定转动惯量与电机控制***的关系公式;
根据所述关系公式获取拉氏变换下速度环闭环的传递函数;
获取负载在运动过程中的惯量参数;
根据惯量参数得到速度环闭环传递函数的拉普拉斯变换公式中的速度环比例系数及速度环积分系数;
将速度环比例系数及速度环积分系数代入速度环闭环传递函数的拉普拉斯变换公式获取最终速度环闭环传递函数的值控制机器人运动。
2.如权利要求1所述的一种工业机器人增益调整方法,其特征在于,所述根据所述关系公式获取拉氏变换下速度环闭环的传递函数具体为:
对所述关系公式进行拉普拉斯变换,得到在初始状态下的近似拉氏方程;
将所述近似拉氏方程等效为速度环闭环传递函数的拉普拉斯变换公式。
3.如权利要求1所述的一种工业机器人增益调整方法,其特征在于,所述获取负载在运动过程中的惯量参数,具体为:
对电机在不同转矩与转速的条件下的进行速度积分,获取积分值的比例系数;
根据积分值的比例系数获取负载在运动过程中的惯量参数。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510003446.4A CN105827171B (zh) | 2015-01-05 | 2015-01-05 | 一种工业机器人增益调整方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510003446.4A CN105827171B (zh) | 2015-01-05 | 2015-01-05 | 一种工业机器人增益调整方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105827171A true CN105827171A (zh) | 2016-08-03 |
CN105827171B CN105827171B (zh) | 2019-01-22 |
Family
ID=56513535
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510003446.4A Active CN105827171B (zh) | 2015-01-05 | 2015-01-05 | 一种工业机器人增益调整方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105827171B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110083127A (zh) * | 2019-05-06 | 2019-08-02 | 清能德创电气技术(北京)有限公司 | 一种针对多关节机器人的伺服驱动器控制方法及*** |
CN114407010A (zh) * | 2021-12-31 | 2022-04-29 | 航天科工智能机器人有限责任公司 | 零力控制方法、装置、电子设备及存储介质 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3696385B2 (ja) * | 1997-10-28 | 2005-09-14 | 多摩川精機株式会社 | サーボモータ駆動方法 |
CN101989827A (zh) * | 2010-11-18 | 2011-03-23 | 东南大学 | 基于惯量辨识的交流伺服***速度环控制参数自整定方法 |
CN102497156A (zh) * | 2011-12-27 | 2012-06-13 | 东南大学 | 永磁同步电机速度环的神经网络自校正控制方法 |
CN103166569A (zh) * | 2011-12-16 | 2013-06-19 | 北汽福田汽车股份有限公司 | 电机的驱动*** |
CN104242769A (zh) * | 2014-09-30 | 2014-12-24 | 天津大学 | 基于连续终端滑模技术的永磁同步电机速度复合控制方法 |
-
2015
- 2015-01-05 CN CN201510003446.4A patent/CN105827171B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3696385B2 (ja) * | 1997-10-28 | 2005-09-14 | 多摩川精機株式会社 | サーボモータ駆動方法 |
CN101989827A (zh) * | 2010-11-18 | 2011-03-23 | 东南大学 | 基于惯量辨识的交流伺服***速度环控制参数自整定方法 |
CN103166569A (zh) * | 2011-12-16 | 2013-06-19 | 北汽福田汽车股份有限公司 | 电机的驱动*** |
CN102497156A (zh) * | 2011-12-27 | 2012-06-13 | 东南大学 | 永磁同步电机速度环的神经网络自校正控制方法 |
CN104242769A (zh) * | 2014-09-30 | 2014-12-24 | 天津大学 | 基于连续终端滑模技术的永磁同步电机速度复合控制方法 |
Non-Patent Citations (1)
Title |
---|
王永珍: "基于PMSM速度调节***的设计及稳定性分析", 《机械管理开发》 * |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110083127A (zh) * | 2019-05-06 | 2019-08-02 | 清能德创电气技术(北京)有限公司 | 一种针对多关节机器人的伺服驱动器控制方法及*** |
CN110083127B (zh) * | 2019-05-06 | 2020-09-29 | 清能德创电气技术(北京)有限公司 | 一种针对多关节机器人的伺服驱动器控制方法及*** |
CN114407010A (zh) * | 2021-12-31 | 2022-04-29 | 航天科工智能机器人有限责任公司 | 零力控制方法、装置、电子设备及存储介质 |
CN114407010B (zh) * | 2021-12-31 | 2024-03-19 | 航天科工智能机器人有限责任公司 | 零力控制方法、装置、电子设备及存储介质 |
Also Published As
Publication number | Publication date |
---|---|
CN105827171B (zh) | 2019-01-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN101989827B (zh) | 基于惯量辨识的交流伺服***速度环控制参数自整定方法 | |
CN107017810A (zh) | 永磁同步电机无权值模型预测转矩控制***及方法 | |
CN107370431A (zh) | 一种工业机器人用永磁同步电机模糊自抗扰控制方法 | |
CN105790660B (zh) | 超高速永磁同步电机转速自适应鲁棒控制***及方法 | |
CN101582677B (zh) | 平滑切换复合转速辨识的电机无速度传感器控制方法 | |
CN110138297A (zh) | 一种永磁同步直线电机速度和电流双闭环控制***和控制方法 | |
CN103036500B (zh) | 一种交流异步电动机无速度传感器的矢量控制方法 | |
CN103684182B (zh) | 一种永磁同步电机参数辨识方法 | |
CN108092567A (zh) | 一种永磁同步电动机转速控制***及方法 | |
CN104393814B (zh) | 一种永磁同步电机控制方法 | |
CN109896423B (zh) | 一种时变非线性小车-吊重防摇控制装置及防摇控制方法 | |
CN108306568A (zh) | 电梯用pmsm抗负载扰动的自适应积分反步控制方法 | |
CN105643639A (zh) | 一种工业机器人负载辨识方法 | |
CN109412481B (zh) | 电动汽车永磁同步电机电流前馈-电压反馈弱磁控制方法 | |
CN107612445A (zh) | 具有负载加速度反馈的随动调速***控制方法 | |
CN106059419B (zh) | 一种永磁同步电机并联矢量控制方案 | |
CN108054969B (zh) | 基于模糊控制器的内置式永磁同步电机全速域控制方法 | |
CN107979305A (zh) | 基于滑模变结构控制的双电机速度同步控制方法及*** | |
CN106655938A (zh) | 基于高阶滑模方法的永磁同步电机控制***及控制方法 | |
CN106788054A (zh) | 一种基于旋转高频注入法和模糊pi控制的无速度传感器控制方法 | |
CN110345013B (zh) | 基于神经网络模型预测控制的磁悬浮垂直轴风电机组控制方法 | |
CN106788049A (zh) | 基于级联滑模观测器的无速度传感器转矩控制***及方法 | |
CN104660142A (zh) | 一种电机控制***和方法 | |
CN106330038A (zh) | 一种基于自适应增益滑模观测器的pmlsm无传感器控制方法 | |
CN102739150A (zh) | 无传感器永磁同步电机的参数辨识控制装置及控制方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |