CN111740669B - 一种机器人关节伺服电机控制方法 - Google Patents
一种机器人关节伺服电机控制方法 Download PDFInfo
- Publication number
- CN111740669B CN111740669B CN202010754690.5A CN202010754690A CN111740669B CN 111740669 B CN111740669 B CN 111740669B CN 202010754690 A CN202010754690 A CN 202010754690A CN 111740669 B CN111740669 B CN 111740669B
- Authority
- CN
- China
- Prior art keywords
- interference
- permanent magnet
- magnet synchronous
- synchronous motor
- observer
- 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.)
- Active
Links
Images
Classifications
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P21/00—Arrangements or methods for the control of electric machines by vector control, e.g. by control of field orientation
- H02P21/13—Observer control, e.g. using Luenberger observers or Kalman filters
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P21/00—Arrangements or methods for the control of electric machines by vector control, e.g. by control of field orientation
- H02P21/14—Estimation or adaptation of machine parameters, e.g. flux, current or voltage
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P21/00—Arrangements or methods for the control of electric machines by vector control, e.g. by control of field orientation
- H02P21/14—Estimation or adaptation of machine parameters, e.g. flux, current or voltage
- H02P21/18—Estimation of position or speed
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P21/00—Arrangements or methods for the control of electric machines by vector control, e.g. by control of field orientation
- H02P21/22—Current control, e.g. using a current control loop
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P25/00—Arrangements or methods for the control of AC motors characterised by the kind of AC motor or by structural details
- H02P25/02—Arrangements or methods for the control of AC motors characterised by the kind of AC motor or by structural details characterised by the kind of motor
- H02P25/022—Synchronous motors
- H02P25/024—Synchronous motors controlled by supply frequency
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P27/00—Arrangements or methods for the control of AC motors characterised by the kind of supply voltage
- H02P27/04—Arrangements or methods for the control of AC motors characterised by the kind of supply voltage using variable-frequency supply voltage, e.g. inverter or converter supply voltage
- H02P27/06—Arrangements or methods for the control of AC motors characterised by the kind of supply voltage using variable-frequency supply voltage, e.g. inverter or converter supply voltage using dc to ac converters or inverters
- H02P27/08—Arrangements or methods for the control of AC motors characterised by the kind of supply voltage using variable-frequency supply voltage, e.g. inverter or converter supply voltage using dc to ac converters or inverters with pulse width modulation
- H02P27/12—Arrangements or methods for the control of AC motors characterised by the kind of supply voltage using variable-frequency supply voltage, e.g. inverter or converter supply voltage using dc to ac converters or inverters with pulse width modulation pulsing by guiding the flux vector, current vector or voltage vector on a circle or a closed curve, e.g. for direct torque control
Landscapes
- Engineering & Computer Science (AREA)
- Power Engineering (AREA)
- Control Of Ac Motors In General (AREA)
Abstract
本发明提供一种机器人关节伺服电机控制方法,属于机器人控制领域。所述方法包括:对永磁同步电机建模,建立符合干扰观测标准的永磁同步电机数学模型;在永磁同步电机数学模型的基础上,建立永磁同步电机矢量控制系统的干扰观测器;建立针对永磁同步电机矢量控制系统的鲁棒H∞电流控制器;将建立的干扰观测器与鲁棒H∞电流控制器应用到永磁同步电机的矢量控制系统中,通过建立的干扰观测器对干扰进行预测,将干扰预测值前馈至鲁棒H∞电流控制器对干扰进行抵消。采用本发明,能够显著提高感机器人关节的控制精度和抗干扰能力。
Description
技术领域
本发明涉及机器人控制领域,特别涉及是指一种机器人关节伺服电机控制方法。
背景技术
关节机器人也称关节手臂机器人或关节机械手臂,是当今工业领域中最常见的工业机器人的形态之一,适合用于诸多工业领域的机械自动化作业。比如,自动装配、喷漆、搬运、焊接等工作,关节机器人利用电机驱动,使用高精度永磁同步电机矢量控制系统实现机器人关节的高精度控制。
永磁同步电机(permanent magnet synchronous motor,PMSM)具有尺寸小、惯量小、响应速度快、效率高等优点。高精度机器人关节多采用永磁同步电机与矢量(包括电机电压、电流等)控制的方法,然而当永磁同步电机矢量控制系统工作环境复杂且存在多种干扰情况下将导致矢量控制系统性能下降。
发明内容
本发明实施例提供了机器人关节伺服电机控制方法,将干扰观测器与鲁棒电流控制器应用到永磁同步电机矢量控制中,能够提高矢量控制系统的控制性能,从而显著提高感机器人关节的控制精度和抗干扰能力,解决了永磁同步电机矢量控制系统抗复杂干扰差、控制性能下降的问题。所述技术方案如下:
一方面,提供了一种机器人关节伺服电机控制方法,该方法包括:
对永磁同步电机建模,建立符合干扰观测标准的永磁同步电机数学模型;
在永磁同步电机数学模型的基础上,建立永磁同步电机矢量控制系统的干扰观测器;
进一步地,所述永磁同步电机数学模型表示为:
进一步地,所述在永磁同步电机数学模型的基础上,建立永磁同步电机矢量控制系统的干扰观测器包括:
对永磁同步电机数学模型进行等效变换,得到:
其中,为永磁同步电机矢量控制系统的状态,为对时刻的一阶导数,为永磁同步电机矢量控制系统非线性描述,为永磁同步电机矢量控制系统的输入,为输入增益矩阵,为干扰增益矩阵,为干扰,都表示输出矩阵用于输出状态;分别表示轴电流、轴电流、电机角速度;
根据等效变换后的表达式,建立永磁同步电机矢量控制系统的干扰观测器。
进一步地,所述干扰观测器为非线性干扰观测器;
所述干扰观测器的数学模型为:
进一步地,所述干扰为外部环境噪声干扰;
所述外部环境噪声干扰由干扰模型产生,所述干扰模型表示为:
进一步地,所述干扰观测器的误差为:
本发明实施例提供的技术方案带来的有益效果至少包括:
本发明实施例中,将干扰观测器与鲁棒电流控制器应用到永磁同步电机矢量控制中,能够提高矢量控制系统的控制性能,从而显著提高感机器人关节的控制精度和抗干扰能力,解决了永磁同步电机矢量控制系统抗复杂干扰差、控制性能下降的问题。
附图说明
为了更清楚地说明本发明实施例中的技术方案,下面将对实施例描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为本发明实施例提供的机器人关节伺服电机控制方法的流程示意图;
图2为本发明实施例提供的永磁同步电机矢量控制系统的工作原理示意图。
具体实施方式
为使本发明的目的、技术方案和优点更加清楚,下面将结合附图对本发明实施方式作进一步地详细描述。
如图1所示,本发明实施例提供了一种机器人关节伺服电机控制方法,该方法包括:
步骤101,对永磁同步电机建模,建立符合干扰观测标准的永磁同步电机数学模型;
步骤102,在永磁同步电机数学模型的基础上,建立永磁同步电机矢量控制系统的干扰观测器;
本发明实施例提供的机器人关节伺服电机控制方法,将干扰观测器与鲁棒电流控制器应用到永磁同步电机矢量控制中,能够提高矢量控制系统的控制性能,从而显著提高感机器人关节的控制精度和抗干扰能力,解决了永磁同步电机矢量控制系统抗复杂干扰差、控制性能下降的问题。
在前述机器人关节伺服电机控制方法的具体实施方式中,进一步地,所述永磁同步电机数学模型表示为:
在前述机器人关节伺服电机控制方法的具体实施方式中,进一步地,所述在永磁同步电机数学模型的基础上,建立永磁同步电机矢量控制系统的干扰观测器包括:
对永磁同步电机数学模型进行等效变换,得到:
其中,为永磁同步电机矢量控制系统的状态,为对时刻的一阶导数,分别表示轴电流、轴电流、电机角速度,为永磁同步电机矢量控制系统非线性描述,为永磁同步电机矢量控制系统的输入,为输入增益矩阵,为干扰增益矩阵,为干扰,都表示输出矩阵用于输出状态;分别表示轴电流、轴电流、电机角速度;
根据等效变换后的表达式,建立永磁同步电机矢量控制系统的干扰观测器。
在前述机器人关节伺服电机控制方法的具体实施方式中,进一步地,所述干扰观测器为非线性干扰观测器;
所述干扰观测器的数学模型为:
在前述机器人关节伺服电机控制方法的具体实施方式中,进一步地,所述干扰为外部环境噪声干扰;
所述外部环境噪声干扰由干扰模型产生,所述干扰模型表示为:
在前述机器人关节伺服电机控制方法的具体实施方式中,进一步地,所述干扰观测器的误差为:
在前述机器人关节伺服电机控制方法的具体实施方式中,进一步地,所述鲁棒电流控制器采用基于哈密顿-雅可比不等式(Hamilton Jacobi Inequality, HJI)的鲁棒电流控制策略,该电流控制策略表示为:
如图2所示,采用电流内环,转速外环双闭环控制,具体控制过程为:将转速参考值与转速检测器检测到的电机角速度作差得到差值,差值通过速度控制器输出的轴电流参考值与轴电流作差得到差值与轴电流参考值和轴电流的差值经过鲁棒电流控制器得到控制电压轴电压和轴电压和经过(二相旋转坐标系到两相静止坐标系)变换后,输出两相静止坐标系下的控制电压值和和经 (两相静止坐标系到三相静止坐标系)变换得到三相静止坐标系下的三相电压值,电压值经过空间矢量脉宽调制(Space Vector Pulse Width Modulation ,SVPWM),将输出的三相电压控制信号输入逆变器,从而对永磁同步电机进行控制;逆变器输出的三相电流值经过(三相静止坐标系变换到二相静止坐标系)变换后输出两相静止坐标系下的电流经过(两相静止坐标系变换到二相旋转坐标系)后输出、轴电流(为的合称),输出的反馈至比较器,与电流参考值比较形成控制闭环。
综上,本发明提供的机器人关节伺服电机控制方法,无需额外的硬件设备,通过直接在永磁同步电机数学模型上进行设计,建立干扰观测器的数学模型和鲁棒电流控制器,替代原矢量控制系统中的常规PID控制器,能够解决由于环境噪声干扰导致矢量控制系统性能下降的问题,提高矢量控制系统抗干扰控制能力。
本领域普通技术人员可以理解实现上述实施例的全部或部分步骤可以通过硬件来完成,也可以通过程序来指令相关的硬件完成,所述的程序可以存储于一种计算机可读存储介质中,上述提到的存储介质可以是只读存储器,磁盘或光盘等。
以上所述仅为本发明的较佳实施例,并不用以限制本发明,凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (6)
1.一种机器人关节伺服电机控制方法,其特征在于,包括:
对永磁同步电机建模,建立符合干扰观测标准的永磁同步电机数学模型;
在永磁同步电机数学模型的基础上,建立永磁同步电机矢量控制系统的干扰观测器;
所述永磁同步电机数学模型表示为:
所述在永磁同步电机数学模型的基础上,建立永磁同步电机矢量控制系统的干扰观测器包括:
对永磁同步电机数学模型进行等效变换,得到:
其中,为永磁同步电机矢量控制系统的状态,为对时刻t的一阶导数,为永磁同步电机矢量控制系统非线性描述,为永磁同步电机矢量控制系统的输入,为输入增益矩阵,为干扰增益矩阵,为干扰,、都表示输出矩阵用于输出状态;
根据等效变换后的表达式,建立永磁同步电机矢量控制系统的干扰观测器;
所述干扰观测器为非线性干扰观测器;
所述干扰观测器的数学模型为:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010754690.5A CN111740669B (zh) | 2020-07-31 | 2020-07-31 | 一种机器人关节伺服电机控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010754690.5A CN111740669B (zh) | 2020-07-31 | 2020-07-31 | 一种机器人关节伺服电机控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111740669A CN111740669A (zh) | 2020-10-02 |
CN111740669B true CN111740669B (zh) | 2020-12-08 |
Family
ID=72656634
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010754690.5A Active CN111740669B (zh) | 2020-07-31 | 2020-07-31 | 一种机器人关节伺服电机控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111740669B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112564565B (zh) * | 2020-12-07 | 2022-07-05 | 北京航空航天大学 | 一种永磁同步电机伺服系统的全回路抗干扰鲁棒控制方法 |
CN112821828B (zh) * | 2021-02-09 | 2021-10-15 | 北京科技大学 | 一种机器人关节的电机速度环振荡抑制优化方法及装置 |
CN114900085B (zh) * | 2022-05-20 | 2022-11-29 | 北京科技大学 | 一种机器人关节伺服电机模型预测参数优化方法及装置 |
CN115407665B (zh) * | 2022-11-02 | 2023-02-28 | 北京科技大学 | 一种基于h∞的机器人关节高效故障估计方法及装置 |
CN117856691A (zh) * | 2024-02-28 | 2024-04-09 | 华侨大学 | 一种永磁同步电机鲁棒模型预测速度控制方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108336935A (zh) * | 2018-01-12 | 2018-07-27 | 西安理工大学 | 一种反步控制协同eso的直线电机控制方法 |
CN109660170A (zh) * | 2019-01-22 | 2019-04-19 | 东南大学 | 一种永磁同步电机高可靠性电流预测控制方法及其系统 |
CN109995289A (zh) * | 2019-05-13 | 2019-07-09 | 电子科技大学 | 基于模型参考自适应的永磁同步电机自抗扰控制优化方法 |
CN110289795A (zh) * | 2019-05-29 | 2019-09-27 | 南京金崎新能源动力研究院有限公司 | 一种电动汽车用永磁同步电机控制系统及控制方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2010051162A (ja) * | 2008-08-25 | 2010-03-04 | Yokohama National Univ | Pmモータの制御装置及び制御方法 |
-
2020
- 2020-07-31 CN CN202010754690.5A patent/CN111740669B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108336935A (zh) * | 2018-01-12 | 2018-07-27 | 西安理工大学 | 一种反步控制协同eso的直线电机控制方法 |
CN109660170A (zh) * | 2019-01-22 | 2019-04-19 | 东南大学 | 一种永磁同步电机高可靠性电流预测控制方法及其系统 |
CN109995289A (zh) * | 2019-05-13 | 2019-07-09 | 电子科技大学 | 基于模型参考自适应的永磁同步电机自抗扰控制优化方法 |
CN110289795A (zh) * | 2019-05-29 | 2019-09-27 | 南京金崎新能源动力研究院有限公司 | 一种电动汽车用永磁同步电机控制系统及控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN111740669A (zh) | 2020-10-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111740669B (zh) | 一种机器人关节伺服电机控制方法 | |
Ko et al. | A robust digital position control of brushless DC motor with dead beat load torque observer | |
CN102969968B (zh) | 一种永磁同步电机控制方法 | |
Lee et al. | LPV $\mathcal {H} _\infty $ Control with Disturbance Estimation for Permanent Magnet Synchronous Motors | |
Cui et al. | Velocity-tracking control based on refined disturbance observer for gimbal servo system with multiple disturbances | |
Li et al. | Backstepping nonsingular terminal sliding mode control for PMSM with finite-time disturbance observer | |
Cao et al. | A repetitive model predictive control approach for precision tracking of a linear motion system | |
CN111431456B (zh) | 一种永磁同步电机有限集多步模型预测电流控制方法 | |
CN110707981A (zh) | 基于新型扩张状态观测器的永磁同步电机速度控制器 | |
CN107577149B (zh) | 一种采用分数阶快速终端滑模控制的随动控制方法 | |
CN108336935B (zh) | 一种反步控制协同eso的直线电机控制方法 | |
CN110165953B (zh) | 一种基于趋近律的pmsm调速控制方法 | |
CN110995102A (zh) | 一种永磁同步电机直接转矩控制方法及系统 | |
CN111106776A (zh) | 用于控制永磁同步电机的方法和系统 | |
Qian et al. | Extended state observer-based sliding mode control with new reaching law for PMSM speed control | |
Moreno-Valenzuela et al. | Lyapunov-based adaptive control for the permanent magnet synchronous motor driving a robotic load | |
CN113726240A (zh) | 一种基于二阶自抗扰控制的永磁同步电机控制方法及系统 | |
CN115051600A (zh) | 一种无刷直流电机伺服系统跟踪控制方法 | |
Shi et al. | Super-twisting hybrid control for ship-borne PMSM | |
Kawamura et al. | Feedback error learning-based position control in position-sensorless positioning servo systems for IPMSMs | |
Tsai et al. | A transputer-based adaptive speed controller for AC induction motor drives with load torque estimation | |
Zhang et al. | Linear motor nonsingular terminal sliding mode position control via a disturbance observer | |
CN112821828B (zh) | 一种机器人关节的电机速度环振荡抑制优化方法及装置 | |
Van Lanh et al. | Synthesis of Discrete Model Predictive Controller for Opto-Mechanical Complex Electric Drive System | |
Lee et al. | Output-feedback linear parameter varying control of permanent magnet synchronous motors |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
TR01 | Transfer of patent right | ||
TR01 | Transfer of patent right |
Effective date of registration: 20210511 Address after: 528437 101, No.43 Keji West Road, Torch Development Zone, Zhongshan City, Guangdong Province Patentee after: ZHONGSHAN MLTOR CNC TECHNOLOGY Co.,Ltd. Address before: 100083 No. 30, Haidian District, Beijing, Xueyuan Road Patentee before: University OF SCIENCE AND TECHNOLOGY BEIJING |