CN105892286B - 一种用于伸缩式托盘交换机构的伺服系统及其控制方法 - Google Patents
一种用于伸缩式托盘交换机构的伺服系统及其控制方法 Download PDFInfo
- Publication number
- CN105892286B CN105892286B CN201610270229.6A CN201610270229A CN105892286B CN 105892286 B CN105892286 B CN 105892286B CN 201610270229 A CN201610270229 A CN 201610270229A CN 105892286 B CN105892286 B CN 105892286B
- Authority
- CN
- China
- Prior art keywords
- driving motor
- auxiliary driving
- main
- controller
- locating support
- 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
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/0205—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric not using a model or a simulator of the controlled system
- G05B13/024—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric not using a model or a simulator of the controlled system in which a parameter or coefficient is automatically adjusted to optimise the performance
Landscapes
- Engineering & Computer Science (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position Or Direction (AREA)
Abstract
本发明公开了一种用于伸缩式托盘交换机构的伺服系统,包括主传动电机,用于驱动托盘支架在主齿条上运动;主传动控制器,用于控制主传动电机的运动;副传动电机,用于驱动定位支架在副齿条上运动,副齿条安装在托盘支架上;副传动控制器,用于控制副传动电机的运动。本发明还提供了一种上述用于伸缩式托盘交换机构的伺服系统的控制方法。本发明能够解决现有技术的不足,针对伸缩式托盘交换机构的运动特性进行了相应的优化,提高了伺服系统定位的速度,简化了伺服系统的结构。
Description
技术领域
本发明涉及工厂自动化技术领域,尤其是一种用于伸缩式托盘交换机构的伺服系统及其控制方法。
背景技术
在自动化生产线中,伸缩式托盘交换机构的控制精度和定位速度直接影响到物料传输过程的时效性。伺服系统是一个由电机驱动的位置闭环控制系统,具有高精度的优点,非常适用于应用于伸缩式托盘交换机构的控制上。现有的高精度伺服系统种类很多,例如中国发明专利CN 101571705 B公开的位置伺服系统与方法。这种系统的应用针对性较弱,使用在伸缩式托盘交换机构的控制系统中存在设备复杂,控制流程冗长的缺点。
发明内容
本发明要解决的技术问题是提供一种用于伸缩式托盘交换机构的伺服系统及其控制方法,能够解决现有技术的不足,针对伸缩式托盘交换机构的运动特性进行了相应的优化,提高了伺服系统定位的速度,简化了伺服系统的结构。
为解决上述技术问题,本发明所采取的技术方案如下。
一种用于伸缩式托盘交换机构的伺服系统,包括,
主传动电机,用于驱动托盘支架在主齿条上运动;
主传动控制器,用于控制主传动电机的运动;
副传动电机,用于驱动定位支架在副齿条上运动,副齿条安装在托盘支架上;
副传动控制器,用于控制副传动电机的运动。
一种上述的用于伸缩式托盘交换机构的伺服系统的控制方法,包括以下步骤:
A、主传动电机带动托盘支架向目标位置运动,主传动控制器采集托盘支架的运动状态;与此同时副传动电机带动定位支架向目标位置运动,副传动控制器采集定位支架的运动状态;副传动控制器根据定位支架的运动状态对副传动电机的运行进行调整,并将定位支架的运动状态和对于副传动电机的调整指令反馈至主传动控制器;主传动控制器根据副传动控制器反馈来的信息参数以及托盘支架的运动状态对主传动电机的运行进行调整;
B、定位支架相对于托盘支架提前到达目标位置,定位支架到达目标位置后,随着托盘支架的运动,副传动电机带动定位支架反方向运动,将定位支架保持在目标位置;主传动控制器将托盘支架的运动状态反馈至副传动控制器,副传动控制器根据反馈信息对副传动电机进行调整,副传动控制器将副传动电机的调整信息反馈至主传动控制器,主传动控制器对主传动电机进行预调整。
作为优选,所述托盘支架的运动状态和定位支架的运动状态包括托盘支架的位置参数、速度参数和加速度参数,以及定位支架的位置参数、速度参数和加速度参数。
作为优选,步骤A中,副传动控制器对于副传动电机进行调整的传递函数为,
其中,
T5=k5;
k1~k5为比例常数,μ1为副传动电机的最高响应阶次,ω1为副传动电机的剪切频率,L1为定位支架与目标位置的位置差,v1为副传动电机的速度,a1为副传动电机的加速度,t1和t2为取样时段端点。
作为优选,步骤A中,主传动控制器对主传动电机进行调整的传递函数为,
其中,
k6~k10为比例常数,μ2为主传动电机的最高响应阶次,ω2为主传动电机的剪切频率,L2为托盘支架与目标位置的位置差,v2为主传动电机的速度,a2为主传动电机的加速度。
作为优选,步骤B中,副传动控制器对于副传动电机进行调整的传递函数为,
其中,
T11=ω1πk11L2
k11~k13为比例常数。
作为优选,步骤B中,主传动控制器对主传动电机进行调整的传递函数为,
其中,k14为比例常数。
采用上述技术方案所带来的有益效果在于:本发明通过建立一个双运动装置的定位系统,通过对两个运动装置的相互调整修正,提高了整个定位过程的速度。通过对传递函数的实时调整,可以优化整个调整过程的精度,降低定位过程中的重复位移。
附图说明
图1是本发明的一个具体实施方式的原理图。
图中:1、主传动电机;2、托盘支架;3、主齿条;4、主传动控制器;5、副传动电机;6、驱动定位支架;7、副齿条;8、副传动控制器。
具体实施方式
参照图1,本发明的一个具体实施方式包括,
主传动电机1,用于驱动托盘支架2在主齿条3上运动;
主传动控制器4,用于控制主传动电机1的运动;
副传动电机5,用于驱动定位支架6在副齿条7上运动,副齿条7安装在托盘支架2上;
副传动控制器8,用于控制副传动电机5的运动。
一种上述的用于伸缩式托盘交换机构的伺服系统的控制方法,包括以下步骤:
A、主传动电机1带动托盘支架2向目标位置运动,主传动控制器4采集托盘支架2的运动状态;与此同时副传动电机5带动定位支架6向目标位置运动,副传动控制器8采集定位支架6的运动状态;副传动控制器8根据定位支架6的运动状态对副传动电机5的运行进行调整,并将定位支架6的运动状态和对于副传动电机5的调整指令反馈至主传动控制器4;主传动控制器4根据副传动控制器8反馈来的信息参数以及托盘支架2的运动状态对主传动电机1的运行进行调整;
B、定位支架6相对于托盘支架2提前到达目标位置,定位支架6到达目标位置后,随着托盘支架2的运动,副传动电机5带动定位支架6反方向运动,将定位支架6保持在目标位置;主传动控制器4将托盘支架2的运动状态反馈至副传动控制器8,副传动控制器8根据反馈信息对副传动电机5进行调整,副传动控制器8将副传动电机5的调整信息反馈至主传动控制器4,主传动控制器4对主传动电机1进行预调整。
所述托盘支架2的运动状态和定位支架6的运动状态包括托盘支架2的位置参数、速度参数和加速度参数,以及定位支架6的位置参数、速度参数和加速度参数。
步骤A中,副传动控制器8对于副传动电机5进行调整的传递函数为,
其中,
T5=k5;
k1~k5为比例常数,μ1为副传动电机5的最高响应阶次,ω1为副传动电机5的剪切频率,L1为定位支架6与目标位置的位置差,v1为副传动电机5的速度,a1为副传动电机5的加速度,t1和t2为取样时段端点。
步骤A中,主传动控制器4对主传动电机1进行调整的传递函数为,
其中,
k6~k10为比例常数,μ2为主传动电机1的最高响应阶次,ω2为主传动电机1的剪切频率,L2为托盘支架2与目标位置的位置差,v2为主传动电机1的速度,a2为主传动电机1的加速度。
步骤B中,副传动控制器8对于副传动电机5进行调整的传递函数为,
其中,
T11=ω1πk11L2
k11~k13为比例常数。
步骤B中,主传动控制器4对主传动电机1进行调整的传递函数为,
其中,k14为比例常数。
另外,设置安全因数δ,
δ=|(L1-L2)(v1-v2)|
当安全因数δ超过设定的阈值时,降低主传动电机1和副传动电机5的调整幅度,使安全因数δ降低至阈值以内。
副传动控制器8对副传动电机5上的振幅A进行监控,然后对步骤A中主传动控制器4对主传动电机1进行调整的传递函数G2(s)和步骤B中副传动控制器8对于副传动电机5进行调整的传递函数G3(s)进行二次修正:
本发明简化了伺服系统的复杂度,针对伸缩式托盘交换机构进行了调整方法的优化。与背景技术引用的伺服系统相比,其应用在伸缩式托盘交换机构上之后,可以在保证定位精度的前提下,将定位时间缩短20%左右。
上述描述仅作为本发明可实施的技术方案提出,不作为对其技术方案本身的单一限制条件。
Claims (6)
1.一种用于伸缩式托盘交换机构的伺服系统的控制方法,所述用于伸缩式托盘交换机构的伺服系统包括,
主传动电机(1),用于驱动托盘支架(2)在主齿条(3)上运动;
主传动控制器(4),用于控制主传动电机(1)的运动;
副传动电机(5),用于驱动定位支架(6)在副齿条(7)上运动,副齿条(7)安装在托盘支架(2)上;
副传动控制器(8),用于控制副传动电机(5)的运动;
其特征在于包括以下步骤:
A、主传动电机(1)带动托盘支架(2)向目标位置运动,主传动控制器(4)采集托盘支架(2)的运动状态;与此同时副传动电机(5)带动定位支架(6)向目标位置运动,副传动控制器(8)采集定位支架(6)的运动状态;副传动控制器(8)根据定位支架(6)的运动状态对副传动电机(5)的运行进行调整,并将定位支架(6)的运动状态和对于副传动电机(5)的调整指令反馈至主传动控制器(4);主传动控制器(4)根据副传动控制器(8)反馈来的信息参数以及托盘支架(2)的运动状态对主传动电机(1)的运行进行调整;
B、定位支架(6)相对于托盘支架(2)提前到达目标位置,定位支架(6)到达目标位置后,随着托盘支架(2)的运动,副传动电机(5)带动定位支架(6)反方向运动,将定位支架(6)保持在目标位置;主传动控制器(4)将托盘支架(2)的运动状态反馈至副传动控制器(8),副传动控制器(8)根据反馈信息对副传动电机(5)进行调整,副传动控制器(8)将副传动电机(5)的调整信息反馈至主传动控制器(4),主传动控制器(4)对主传动电机(1)进行预调整。
2.根据权利要求1所述的用于伸缩式托盘交换机构的伺服系统的控制方法,其特征在于:所述托盘支架(2)的运动状态和定位支架(6)的运动状态包括托盘支架(2)的位置参数、速度参数和加速度参数,以及定位支架(6)的位置参数、速度参数和加速度参数。
3.根据权利要求2所述的用于伸缩式托盘交换机构的伺服系统的控制方法,其特征在于:步骤A中,副传动控制器(8)对于副传动电机(5)进行调整的传递函数为,
其中,
T5=k5;
k1~k5为比例常数,μ1为副传动电机(5)的最高响应阶次,ω1为副传动电机(5)的剪切频率,L1为定位支架(6)与目标位置的位置差,v1为副传动电机(5)的速度,a1为副传动电机(5)的加速度,t1和t2为取样时段端点。
4.根据权利要求3所述的用于伸缩式托盘交换机构的伺服系统的控制方法,其特征在于:步骤A中,主传动控制器(4)对主传动电机(1)进行调整的传递函数为,
其中,
k6~k10为比例常数,μ2为主传动电机(1)的最高响应阶次,ω2为主传动电机(1)的剪切频率,L2为托盘支架(2)与目标位置的位置差,v2为主传动电机(1)的速度,a2为主传动电机(1)的加速度。
5.根据权利要求4所述的用于伸缩式托盘交换机构的伺服系统的控制方法,其特征在于:步骤B中,副传动控制器(8)对于副传动电机(5)进行调整的传递函数为,
其中,
T11=ω1πk11L2
k11~k13为比例常数。
6.根据权利要求5所述的用于伸缩式托盘交换机构的伺服系统的控制方法,其特征在于:步骤B中,主传动控制器(4)对主传动电机(1)进行调整的传递函数为,
其中,k14为比例常数。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610270229.6A CN105892286B (zh) | 2016-04-27 | 2016-04-27 | 一种用于伸缩式托盘交换机构的伺服系统及其控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610270229.6A CN105892286B (zh) | 2016-04-27 | 2016-04-27 | 一种用于伸缩式托盘交换机构的伺服系统及其控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105892286A CN105892286A (zh) | 2016-08-24 |
CN105892286B true CN105892286B (zh) | 2018-08-31 |
Family
ID=56701953
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610270229.6A Active CN105892286B (zh) | 2016-04-27 | 2016-04-27 | 一种用于伸缩式托盘交换机构的伺服系统及其控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105892286B (zh) |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN201537829U (zh) * | 2009-10-16 | 2010-08-04 | 沈阳机床(集团)设计研究院有限公司 | 旋转托盘交换机构 |
CN102000990A (zh) * | 2010-11-05 | 2011-04-06 | 威海华东数控股份有限公司 | 链条单驱动双交换工作台 |
US8046782B2 (en) * | 2008-02-28 | 2011-10-25 | Panasonic Corporation | Tray carry-out method for disc changer device |
CN203173473U (zh) * | 2013-04-12 | 2013-09-04 | 河源富马硬质合金股份有限公司 | 料仓舟皿数控存取装置 |
CN103331618A (zh) * | 2013-07-28 | 2013-10-02 | 沈阳机床(集团)有限责任公司 | 一种卧式加工中心托盘交换机构 |
-
2016
- 2016-04-27 CN CN201610270229.6A patent/CN105892286B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8046782B2 (en) * | 2008-02-28 | 2011-10-25 | Panasonic Corporation | Tray carry-out method for disc changer device |
CN201537829U (zh) * | 2009-10-16 | 2010-08-04 | 沈阳机床(集团)设计研究院有限公司 | 旋转托盘交换机构 |
CN102000990A (zh) * | 2010-11-05 | 2011-04-06 | 威海华东数控股份有限公司 | 链条单驱动双交换工作台 |
CN203173473U (zh) * | 2013-04-12 | 2013-09-04 | 河源富马硬质合金股份有限公司 | 料仓舟皿数控存取装置 |
CN103331618A (zh) * | 2013-07-28 | 2013-10-02 | 沈阳机床(集团)有限责任公司 | 一种卧式加工中心托盘交换机构 |
Also Published As
Publication number | Publication date |
---|---|
CN105892286A (zh) | 2016-08-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103676653B (zh) | 应用于龙门机构的伺服同步控制方法及系统 | |
CN104148931A (zh) | 用于大型筒段构件对位的多点伺服调整装置及其方法 | |
CN102298357B (zh) | 基于现场总线的cnc双轴协调式同步控制方法 | |
CN205485598U (zh) | 一种大型电机线圈绕线机控制系统 | |
CN110980425B (zh) | 丝饼自动落筒系统及其多伺服驱动器同步控制方法 | |
CN203345713U (zh) | 一种极耳纠偏装置 | |
CN107116281B (zh) | 大范围智能坡口切割系统及方法 | |
CN105372987A (zh) | 一种位置伺服闭环控制系统及其使用方法 | |
CN102554668A (zh) | 数值控制装置以及数值控制装置的控制方法 | |
CN104385279B (zh) | 一种机械手示教方法及系统 | |
CN105033473A (zh) | 一种激光焊接用自适应压轮设备 | |
CN104493332A (zh) | 一种基于电弧摆动自调节传感机构的焊缝跟踪控制方法 | |
CN101693290B (zh) | 结晶器在线调宽方法 | |
CN105034853A (zh) | 一种减小电动汽车定速巡航速度波动的控制系统及方法 | |
CN105892286B (zh) | 一种用于伸缩式托盘交换机构的伺服系统及其控制方法 | |
CN205032859U (zh) | 自动调焦激光切割头 | |
CN203689073U (zh) | 钢丝定长切割控制系统 | |
CN203344052U (zh) | 一种机器人的柔性跟踪定位系统 | |
CN103862582A (zh) | 玻璃钻孔机用传送装置及其玻璃钻孔机 | |
CN202462508U (zh) | 制袋机自动纠偏打孔装置 | |
CN206164312U (zh) | 一种转子的全自动入端板装置 | |
CN112193900B (zh) | 一种伺服驱动张力辊的微张力控制系统及方法 | |
CN203959446U (zh) | 一种自动在线纠偏装置 | |
CN103862325A (zh) | 一种加工中心的红外控制对刀方法与系统 | |
CN107728579B (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 | ||
CP01 | Change in the name or title of a patent holder | ||
CP01 | Change in the name or title of a patent holder |
Address after: No.296, Tongxin South Street, Yinchuan Development Zone, 750021 Ningxia Hui Autonomous Region Patentee after: NINGXIA JUNENG ROBOT Co.,Ltd. Address before: No.296, Tongxin South Street, Yinchuan Development Zone, 750021 Ningxia Hui Autonomous Region Patentee before: NINGXIA JUNENG ROBOT SYSTEM Co.,Ltd. |