一种伺服控制装置制造方法及图纸

本发明专利技术公开了一种伺服控制装置，在现有典型伺服控制装置的基础上增加了滤波器和扰动观测器。扰动观测器可观测系统中的扰动，包括变化的负载转矩扰动和变化的负载惯量扰动，并对扰动进行补偿；同时使用速度调节器输出减去扰动观测器的观测速度乘以KD，用以调节速度环的阻尼；使用滤波器对转矩给定进行滤波，可滤除转矩给定中的噪声。本发明专利技术的伺服控制装置结构简单，参数整定方便，不需要精确地辨识出负载转矩和惯量，能迅速地适应变化的负载惯量和负载转矩。

A servo control device

【技术实现步骤摘要】
一种伺服控制装置
本专利技术涉及伺服控制技术，具体涉及一种伺服控制装置。
技术介绍
现如今，基于矢量控制技术和数字控制技术的交流伺服系统被广泛应用于工业自动化、数控机床、工业机器人等场合。交流伺服系统由伺服控制器和伺服电机组成。其中伺服控制器包含有嵌入式微处理器，其接收上位机命令，并对电能进行管理与控制，输出的电能用来驱动伺服电机；伺服电机作为执行机构，驱动负载设备实现跟踪、定位等功能。由于使用形式多样，交流伺服系统一般都支持位置、转速、转矩控制模式。在控制上，它们分别由嵌套的位置环、转速环、转矩环实现。这些控制环路均需要进行参数(通常为PI参数)调整才能达到较好的性能，而负载惯量、负载转矩扰动等与负载设备相关的要素对整个伺服系统性能的影响较大。所以在调整参数时，对负载惯量、负载转矩等参数的计算或学习是必要的。在一些特殊的场合，负载惯量、负载转矩是时变的。如卷绕设备的转动惯量随卷绕材料的增多而变大，工业机器人的转动惯量与机械臂角度相关；折弯设备、搬运机器人的负载也是变化的。在这些场合，通过离线计算或学习的方法是不适用的，固定参数(通常为PI参数)往往不能获得稳定的控制性能。针对该问题，学者们研究的方向有很多：参考文献1：专利《一种交流伺服系统速度环控制器参数自整定方法》，李世华等，南京科远驱动技术有限公司，授权公告号CN104242770，2017；参考文献2：期刊《交流伺服系统的转动惯量辨识及调节器参数自整定》，郭宇婕等，清华大学学报,2012；参考文献3：专利《伺服控制装置》，张文农等，株式会社安川电机，CN101454969A,2009；参考文献1和参考文献2属同一类，都是使用模型参考自适应算法在线辨识出系统惯量，然后依据该惯量计算控制器参数。问题是该惯量辨识算法的收敛速度太慢，达到了数十秒，完全不能满足负载惯量实时变化的需求；且该方法中惯量辨识的准确性与伺服电机的运行状态有关，如果是匀速运行，惯量辨识的精度是比较差的。参考文献3使用干扰观测器和相位超前补偿观测器对未知或变化的负载惯量有较好的适应效果。但是其参数整定比较复杂。另外，若实际负载惯量J较小(靠近最小值Jm)时，转速ωp的相位超前量将远大于等效低通滤波器Lo的相位滞后量，极易引起速度高频振动。
技术实现思路
参阅图1～图4，在图1至图4中所示的相同部件采用了相同的附图标记。现有典型伺服控制装置如图1所示，包括第一减法器1、位置调节器2、第二减法器3、速度调节器4、第一积分器5及第二积分器6；位置调节器CP(s)的输入为经第一减法器1计算的给定角度γ*和反馈角度γf的偏差，输出为给定速度ω*。位置调节器CP(s)的作用是为了让被控对象的转动角度γm跟踪给定角度使误差最小，其类型一般为P调节器。速度调节器Cs(s)的输入为给定速度ω*和反馈速度ωf的偏差，输出为给定转矩m*。速度调节器Cs(s)的作用是为了让被控对象的运行速度ωm跟踪给定速度ω*使误差最小，其类型一般为PI调节器。第一积分器5及第二积分器6是以被控对象建立的积分模型，第一积分器5用于将给定转矩m*通过积分运算输出被控对象的运行速度ωm，第二积分器6用于将运行速度ωm通过积分运算输出被控对象的转动角度γm。被控对象中的J*为标幺化的总转动惯量，即其中，JM为伺服电机的转动惯量，JL为负载的转动惯量。本专利技术提供一种伺服控制装置，如图2所示，在现有典型伺服控制装置的基础上增加了滤波器10和扰动观测器9。扰动观测器可观测系统中的扰动，包括变化的负载转矩扰动和变化的负载惯量扰动，并对扰动进行补偿；同时使用速度调节器输出减去扰动观测器的观测速度乘以KD(如图2)，用以调节速度环的阻尼；使用滤波器对转矩给定进行滤波，可滤除转矩给定中的噪声。本专利技术的伺服控制装置结构简单，参数整定方便，不需要精确地辨识出负载转矩和惯量，能迅速地适应变化的负载惯量和负载转矩。本专利技术采用的第一技术方案是：一种伺服控制装置，用于基于转矩指令对被控对象执行驱动控制，所述伺服控制装置包括：第一调节器2，用于基于给定角度和反馈角度之间的偏差输出给定速度；第二调节器4，用于基于所述给定速度与反馈速度之间的偏差输出给定转矩；扰动观测器9，用于基于给定转矩及所述反馈速度和/或所述反馈角度，输出观测速度和观测转矩扰动；将所述观测转矩扰动补偿至所述给定转矩中，并且使用系数KC调节补偿量的大小；同时，将所述观测转速作为另一补偿量补偿至所述给定转矩中，并且使用系数KD调节补偿量的大小；滤波器10，用于将经扰动观测器补偿后的给定转矩进行滤波，并将滤波后给定转矩输入至被控对象；第一积分器5，用于将输入至被控对象的给定转矩通过积分运算输出被控对象的运行速度，并将运行速度反馈至扰动观测器和第二调节器；以及第二积分器6，用于将所述运行速度通过积分运算输出被控对象的转动角度，并将转动角度反馈至扰动观测器和第一调节器。本专利技术采用的第二技术方案是在第一技术方案上的改进，本专利技术采用的第二技术方案是：参阅图3，所述扰动观测器9包括：第三调节器92，用于基于所述反馈速度ωf与反馈观测速度ωpf的偏差输出观测转矩扰动mp；第一加法器93，用于将观测转矩扰动mp与给定转矩m*加算后输入至理想模型；以及第三积分器94，用于将输入至理想模型的给定转矩通过积分运算输出所述观测速度ωp，并将观测速度反馈至第三调节器92中。本专利技术采用的第三技术方案是在第一技术方案上的改进，本专利技术采用的第三技术方案是：参阅图4，所述扰动观测器9包括：第三调节器92，用于基于所述反馈角度γf与反馈观测角度γpf的偏差输出观测转矩扰动mp；第一加法器93，用于将观测转矩扰动mp与给定转矩m*加算后输入至理想模型；第三积分器94，用于将输入至理想模型的给定转矩通过积分运算输出所述观测速度ωp；以及第四积分器95，用于将所述观测速度通过积分运算输出观测角度γp，并将所述观测角度反馈至第三调节器92中。本专利技术采用的第四技术方案是在第二或第三技术方案上的改进，本专利技术采用的第四技术方案是：所述理想模型的总惯量的标幺值为1。本专利技术采用的第五技术方案是在第四技术方案上的改进，本专利技术采用的第五技术方案是：所述第三调节器92可以为P调节器、PI调节器或PID调节器。本专利技术采用的第六技术方案是在第一技术方案上的改进，本专利技术采用的第六技术方案是：所述第一调节器2及第二调节器4可以为P调节器、PI调节器或PID调节器。本专利技术采用的第七技术方案是在第一技术方案上的改进，本专利技术采用的第七技术方案是：所述第一积分器5以被控对象的标幺化的总转动惯量J*为参数建立积分模型，所述被控对象包括伺服电机及负载机；其中，JM为伺服电机的转动惯量，JL为负载的转动惯量。本专利技术的有益效果：1、本专利技术的伺服控制装置使用一套固定的参数即能适应负载转矩扰动和负载惯量变化，对不同的负载惯量和突加负载转矩都有较好的适应性能。...

【技术保护点】
1.一种伺服控制装置，用于基于转矩指令对被控对象执行驱动控制，其特征在于，所述伺服控制装置包括：/n第一调节器(2)，用于基于给定角度和反馈角度之间的偏差输出给定速度；/n第二调节器(4)，用于基于所述给定速度与反馈速度之间的偏差输出给定转矩；/n扰动观测器(9)，用于基于给定转矩及所述反馈速度和/或所述反馈角度，输出观测速度和观测转矩扰动；将所述观测转矩扰动补偿至所述给定转矩中，并且使用系数K

【技术特征摘要】
1.一种伺服控制装置，用于基于转矩指令对被控对象执行驱动控制，其特征在于，所述伺服控制装置包括：
第一调节器(2)，用于基于给定角度和反馈角度之间的偏差输出给定速度；
第二调节器(4)，用于基于所述给定速度与反馈速度之间的偏差输出给定转矩；
扰动观测器(9)，用于基于给定转矩及所述反馈速度和/或所述反馈角度，输出观测速度和观测转矩扰动；将所述观测转矩扰动补偿至所述给定转矩中，并且使用系数KC调节补偿量的大小；同时，将所述观测转速作为另一补偿量补偿至所述给定转矩中，并且使用系数KD调节补偿量的大小；
滤波器(10)，用于将经扰动观测器补偿后的给定转矩进行滤波，并将滤波后给定转矩输入至被控对象；
第一积分器(5)，用于将输入至被控对象的给定转矩通过积分运算输出被控对象的运行速度，并将运行速度反馈至扰动观测器和第二调节器；以及
第二积分器(6)，用于将所述运行速度通过积分运算输出被控对象的转动角度，并将转动角度反馈至扰动观测器和第一调节器。


2.如权利要求1所述的伺服控制装置，其特征在于，所述扰动观测器包括：
第三调节器(92)，用于基于所述反馈速度与反馈观测速度的偏差输出观测转矩扰动；
第一加法器(93)，用于将观测转矩扰动与给定转矩加算后输入至理想模型；以及
第三积分器(94)，用于将输入至理想模...

【专利技术属性】
技术研发人员：范仁凯，齐丹丹，杨凯峰，姚瑱，钱巍，
申请(专利权)人：南京埃斯顿自动化股份有限公司，
类型：发明
国别省市：江苏;32