专利名称：多轴伺服制瓶机智能系统的制作方法
技术领域：
多轴伺服制瓶机智能系统，属玻璃瓶罐机械控制领域。
背景技术：
目前玻璃瓶罐机械领域的行列式制瓶机，是多组数多机构的气动机器，机器的动作主要是靠控制电磁阀的开和关，控制气路的通断从而控制机构的动作，这种控制方式能耗高，动作稳定性差，结构复杂，运行机速低。近几年，国外推出了制瓶机上的伺服钳瓶，伺服翻转机构，这些伺服机构运行稳定，能耗低，机速高，深受用户欢迎。但是国外的伺服机构控制系统一般采用通用式标准伺服运动控制器，每组一个计算机总线单元，计算机单元连接了 1/0板，通讯板，多块运动伺服控制板的复杂结构，制瓶机的多轴控制需要庞大的计算机控制系统和多个控制柜组成，现场伺服机构带位置检测装置，现场调整定位需用现场终端，控制系统结构复杂，调整麻烦，造价高。为系统的长期、连续、可靠运行埋下隐患，给日常维护带来极大不便。
实用新型内容本实用新型要解决的技术问题是克服国内外现有技术存在的问题，针对行列式制瓶机的特殊要求，设计一种结构简单、集系统数据处理、通讯、1/0、几十轴定时定位运动控制于一体的多轴伺服制瓶机智能系统。 本实用新型解决其技术问题所采用的技术方案是该多轴伺服制瓶机智能系统，包括上位计算机PC，与上位计算机PC相连的控制中心PN，其特征在于控制中心PN又包括下位计算机控制单元CPUS和伺服驱动单元，伺服驱动单元又包括多组双轴拨瓶器机构、多组伺服钳瓶机构、多组伺服翻转机构和多组伺服开模机构的驱动器，多组双轴拨瓶器机构、多组伺服钳瓶机构、多组伺服翻转机构和多组伺服开模机构通过电缆线与控制中心PN相连。 多组双轴拨瓶器机构包括步进电机驱动器SDP1 SDPi，驱动拨瓶步进电机PMl PMi，步进电机驱动器SDR1 SDRi，驱动拨爪縮回步进电机RM1 RMi ;多组伺服钳瓶机构包括伺服电机驱动器SDT1 SDTi，驱动伺服钳瓶电机TKM1 TKMi ;多组伺服翻转机构包括伺服电机驱动器SDI1 SDIi，驱动伺服翻转电机IVM1 IVMi ;多组伺服开模机构包括伺服电机驱动器SD0B1 SDOBi ， SD0P1 SDOPi ，开模电机0PBM1 OPBMi ， 0PPM1 OPPMi ，(其中i为1、2、3……12)。 下位计算机控制单元CPUS又包括CPU多轴伺服控制板CB1 CBi和母板MB，母板MB通过插槽与CPU多轴伺服控制板CBI CBi相连，每块CPU多轴伺服控制板可以连接1 7轴的伺服驱动器或者步进电机驱动器，(其中i为1、2、3……12)。[0007] 多轴伺服控制板为CB1 CB12块，每块伺服控制板CB通过伺服驱动器SDT与伺服钳瓶电动机TKM相连，通过伺服驱动器SDI与伺服翻转电动机IVM相连，通过伺服驱动器SDOB与伺服初模开电动机OPBM相连，通过伺服驱动器SDOP与伺服成模开电动机OPPM相
3连；伺服控制板CB通过步进电动机驱动器SDP与现场的双轴拨瓶器步进电动机PM相连，通过步进电动机驱动器SDR与双轴拨瓶器步进电动机RM相连，伺服控制板CB与拨瓶到位感应开关PSW、縮回到位感应开关RSW相连，拨瓶到位感应开关PSW和縮回到位感应开关RSW安装在双轴拨瓶器上。 安装在下位计算机单元CPUS内的每块伺服控制板的程序包括主程序和中断程序，主程序用于接收上位机的数据并进行数据处理、运算、保存，按纽开关信号的采集分析，执行按纽开关命令，运行过程中的故障处理等相关处理，主要包括伺服机构初始化模块、伺服机构点动模块、双轴拨瓶器初始化模块和伺服机构启动/停止模块，其中伺服机构初始化模块通过检测向原点运行的过程中机构的负载情况，确定机构的原点，再运行偏移量，定位完成，实现一键定位；伺服机构点动模块包括自动状态下的点动命令和手动状态下的点动命令，自动状态下的点动命令，在启动之前的点动，能单步循环运行各个位置，检测运行情况，在启动之后的运行过程中，通过点动按纽修正定位数据，每个循环可以处理一次点动命令，修正一次定位数据，手动状态下的点动命令用于调整机构运行到合适的位置，记录该位置对应的数据，并且自动初始化；双轴拨瓶器初始化模块启动时初始化双轴步进电机到原位，然后根据定时进入运行，停机时立即使双轴拨瓶机构回原位，运行过程中检测伺服驱动器的报警情况，负载情况，进行故障处理；伺服机构启动/停止模块用于检测数据和硬件是否满足启动条件，满足时置启动标记，系统在定时中断中检测到启动标记才正式启动运行，启动信号消失后置停机标记，系统在定时中断中检测到停机标记，要运行到规定停机位置才正式停机； 中断程序包括2ms中断程序和1度中断程序，其中2ms中断程序中使用多个计时器计时并定时通过同步信号采样处理模块采样感应开关的信号，采样主系统的同步信号BT，取同步信号的每周期的信号标定成3600度，计算出1度的定时值，采样双轴拨瓶器的定位感应开关信号，确认双轴拨瓶器的到位并置标记，进行相应的处理；1度中断程序进行周期计数，检测各伺服轴的定时运行、停机、停顿和变换曲线。 下位计算机控制单元CPUS，是多个CPU多伺服控制板的集合。包括母板MB和12个段控CPU多轴伺服控制板，每个段控CPU多轴伺服控制板具有通讯，1/0， 1 7轴的伺服定位控制功能，系统可控制多达80轴的伺服机构，实现多轴的定时定位定曲线协调同步运行。 本实用新型的多轴伺服制瓶机智能系统是针对行列式制瓶机的特殊要求，设计的一种集系统数据处理、通讯、1/0、几十轴运动控制于一体的单板智能运动控制器，制瓶机的一段1 7个伺服轴用一块CPU多轴伺服板控制，多段制瓶机用多块这样的CPU多轴伺服控制板同插到母板上，实现同步信号，通讯信号共享，实现一台制瓶机多达80轴的定时、定位、定曲线协调同步运行的简洁集中控制。以极为简单的结构方式，达到最佳可靠的多轴运动控制，本实用新型的CPU多轴伺服控制板安装的程序，与现场的几个开关按钮结合，实现启动一键定位，手动状态下用按钮调整行程的大小，运行中用按钮修正行程数据，节省了现场终端调数据、调定位的复杂结构，给用户操作带来了极大方便。 与国内外现有技术相比，本实用新型的多轴伺服制瓶机智能系统的有益效果是仅用一个由12块CPU多轴伺服控制板和一个母板组成的计算机单元，就可以实现达80个伺服轴的定时定位定曲线运行，并且各伺服轴同步协调，定时定位准确。在制瓶机上用伺服机构取代气动机构，制瓶机上的每段1 7轴的伺服运动控制用一块CPU多轴伺服控制板取代国外同类产品的复杂计算机单元组织。本实用新型专用的CPU伺服控制板及上位计算机控制程序，可以实现随意制作各种凸轮机构曲线并准确定时定位按曲线运行。与国外同类产品相比，具有结构简单，性价比高，运行可靠，操作方便，定位准确，技术先进等优点。
图1是本实用新型多轴伺服制瓶机控制系统结构示意图； 图2是本实用新型多轴伺服制瓶机控制系统电路原理示意图； 图3是本实用新型多轴伺服制瓶机控制系统每段的现场控制盘示意图； 图4是本实用新型多轴伺服制瓶机伺服控制板的主程序流程图； 图5是本实用新型多轴伺服制瓶机伺服控制板的2mS中断程序流程图； 图6是本实用新型多轴伺服制瓶机伺服控制板的1度中断程序流程图。 图1-2中PC上位计算机，CPUS下位计算机单元，MB下位机计算机母板PN控制
中心单元CB1 CB12下位CPU伺服控制板SDP1 SDP12双轴拨瓶的拨瓶步进电机驱动器
SDR1 SDR12双轴拨瓶的縮回步进电机驱动器PM1 PM12双轴拨瓶的拨瓶步进电机RM1
RM12双轴拨瓶的縮回步进电机PSW1 PSW12拨瓶到位感应开关RSW1 RSW12縮回到位感
应开关SDT1 SDT12伺服钳瓶电机驱动器TKM1 TKM12伺服钳瓶电机SDI1 SDI12伺
服翻转电机驱动器IVM1 IVM12伺服翻转电机SD0B1 SD0B12初型模开/关伺服电机驱
动器0PBM1 0PBM12初型模开/关伺服电机SD0P1 SD0P12成型模开/关伺服电机驱动
器0PPM1 0PPM12成型模开/关伺服电机LCPN现场控制盘； 图3中BTPi双轴拨瓶启动按钮SWTi伺服钳瓶的手动/自动初始化开关Tjog+伺服钳瓶点动+和单步运行调试按钮T jog-伺服钳瓶点动和单步运行调试按钮SWi伺服翻转的手动/自动初始化开关I jog+伺服翻转点动+和单步运行调试按钮I jog-伺服翻转点动_和单步运行调试按钮SW0Bi伺服初模开的手动/自动初始化开关Bjog+伺服初模开点动+和单步运行调试按钮Bjog-伺服初模开点动_和单步运行调试按钮SW0Pi伺服成模开的手动自动初始化开关Pjog+伺服成模开点动+和单步运行调试按钮Pjog-伺服成模开点动_和单步运行调试按钮XI进线端口 X2出线端口 。
具体实施方式图1 6是本实用新型的最佳实施例，
以下结合附图1 6对本实用新型做进一步说明 参照图1 : 多轴伺服制瓶机智能系统，主要包括控制中心PN，上位计算机PC，双轴拨瓶步进电动机PM1 PM2 ，双轴拨瓶縮回电机RM1 RM2 ，钳瓶伺服电机TKM1 TKM12 ，翻转伺服电机IVM1 IVM12，初型模开/关伺服电机0PBM1 0PBM12，成型模开/关伺服电机0PPM1 0PPM12，拨瓶到位感应开关PSW1 PSW2，拨爪返回感应开关RSW1 RSW12组成，上位计算机PC的COM 口与控制中心PN中的母板MB相连，控制中心PN通过信号线与生产线主控制系统KC、现场控制盘LCPN、双轴拨瓶器的步进电机驱动器SDP1 SDP12，驱动拨瓶步进电机PM1 PM12，步进电机驱动器SDR1 SDR12，驱动拨爪縮回步进电机RM1 RM12 ;多组伺服钳瓶机构的伺服电机驱动器SDT1 SDT12，驱动伺服钳瓶电机TKM1 TKM12 ;多组伺 服翻转机构的伺服电机驱动器SDI1 SDI12，驱动伺服翻转电机IVM1 IVM12 ;多组伺服 开模机构的伺服电机驱动器SD0B1 SD0B12， SD0P1 SD0P12，开模电机0PBM1 0PBM12， 0PPM1 0PPM12相连。 参照图2: 中心控制单元PN由下位计算机单元CPUS组成，CPUS由12块CPU多轴伺服控制 板CB1 CB12和母板MB组成。母板MB通过插槽与12块CPU多轴伺服控制板相连。下位 计算机单元CPUS与步进电机驱动器SDP1 SDP12， SDR1 SDR12相连，与伺服电机驱动器 SDT1 SDT12， SDI1 SDI12, SD0B1 SD0B12， SD0P1 SD0P12相连，与拨瓶到位感应开 关PSW1 PSW12、縮回到位感应开关RSW1 RSW12相连，与现场控制盘LCPN相连。上位计 算机PC的COM 口与网络分配板FPB相连，网络分配板FPB与中心控制单元PN中的母板MB 相连。母板MB接受的Start启动信号和WTB外同步信号与生产线主控制系统KC相连. 参照图3: 是制瓶机一段的伺服控制按钮和开关。 BTPi是双轴拨瓶启动按钮，SWTi是伺服钳瓶的手动/自动初始化开关，Tjog+伺 服钳瓶点动"+ "和单步运行调试按钮开关，Tjog-伺服钳瓶点动"_"和单步运行调试按钮， SWi是伺服翻转的手动/自动初始化开关，Ijog+伺服翻转点动"+ "和单步运行调试按钮， IJog-是伺服翻转点动"-"和单步运行调试按钮，SWOBi是伺服初模开的手动/自动初始化 开关，Bjog+伺服初模开点动"+ "和单步运行调试按钮，Bjog-是伺服初模开点动"_"和单 步运行调试按钮，SWOPi是伺服成模开的手动自动初始化开关，Pjog+伺服成模开点动"+ " 和单步运行调试按钮，Pjog-伺服成模开点动"-"和单步运行调试按钮，XI进线端口 X2出 线端口。
参照图4 :是多轴伺服控制板的主程序流程图. 首先是初始化部分，对I/0端口、寄存器、存儲器、定时器、控制寄存器等进行初始 化。主程序部分检测是否有接收的上位机的数据，若有，进行数据处理，保存；检测是否 有按钮开关命令，若有，分析在什么状态下的哪一个开关按钮命令，进行相应的处理若是 某伺服机构的手动开关信号，进行初始化定位后置手动标记；若是某伺服机构的自动开关 信号，进行初始化定位后置自动标记；如果是双轴拨瓶的按钮命令，处理双轴拨瓶的初始化 及启动和停止；如果是主系统发来的Start启动信号，对各个伺服轴进行启动停止处理；检 测内/外同步控制方式，在内同步方式下，系统自动产生周期信号；检测系统报警并进行处 理。 参照图5 :是多轴伺服控制板的2ms中断程序流程图 在2mS中断中，对多个计时器进行记时，采样从生产线主控制系统发来的外同步 信号WTB并分析处理，用同步信号的周期时间产生1度对应的时间用于1度的定时中断。采 样双轴拨瓶的到位感应开关信号PSWi和RSWi信号，进行处理后控制双轴拨瓶的运行；中断 返回。
参照图6 :是多轴伺服控制板的1度中断程序流程图 该中断中对周期时间计时，检测各轴的启动情况，根据启动状态，适时输出各伺服 轴的运动控制信号。如果有双轴拨瓶的启动标记，就定时按点读出运动曲线数据，输出双轴拨瓶运行曲线脉冲；如果是某伺服机构的启动标记，定时输出某伺服机构的运行曲线脉冲； 如果是某伺服机构的停机过程标记，检测是否到达停机位置，未到达就继续运行，到达就清 停机标记，该伺服轴停机；中断返回。 按照图1 6设计制作的多轴伺服制瓶机智能系统的工作原理和工作过程如下 首先通过上位计算机单元PC的串行口 COM对下位计算机单元CPUS的各多轴伺服 控制板进行参数和曲线设置，以便符合制瓶机各伺服轴的运动定位要求。初次使用，可将各 伺服轴的三位开关SWXi拨到手动上，初始化后用jog键调整定位和行程。各伺服轴的三位 开关SWXi拨到自动位置上，自动初始化后，等待主系统发来Start启动信号和WTB同步信 号，伺服轴便按照设定曲线开始执行"动_停_动"的循环运动，主系统启动信号停止或同 步信号停，各伺服轴便停在设定位置。在运行过程中按点动按纽，可以修正运行的行程。在 自动状态下运行之前，按点动按纽，可以单步运行到各个定位。对于双轴拨瓶，没有初始化 开关，只有启动/停止按钮，在主系统同步信号正常的情况下，按下双轴拨瓶启动按钮，双 轴拨瓶器首先初始化到原始位置，然后按照外同步信号的周期，每周期完成1次拨瓶动作， 再按一次拨瓶启动/停止按钮，双轴拨瓶器停止在原始位置，当同步信号WTB停止后，双轴 拨瓶器也自动停在原始位置。
权利要求多轴伺服制瓶机智能系统，包括上位计算机PC，与上位计算机PC相连的控制中心PN，其特征在于控制中心PN又包括下位计算机控制单元CPUS和伺服驱动单元，伺服驱动单元又包括多组双轴拨瓶器机构、多组伺服钳瓶机构、多组伺服翻转机构和多组伺服开模机构的驱动器，多组双轴拨瓶器机构、多组伺服钳瓶机构、多组伺服翻转机构和多组伺服开模机构通过电缆线与控制中心PN相连。
2. 根据权利要求1所述的多轴伺服制瓶机智能系统，其特征在于多组双轴拨瓶器机构包括步进电机驱动器SDP1 SDPi，驱动拨瓶步进电机PMl PMi，步进电机驱动器SDR1 SDRi，驱动拨爪縮回步进电机RMl RMi ;多组伺服钳瓶机构包括伺服电机驱动器SDT1 SDTi，驱动伺服钳瓶电机TKM1 TKMi ;多组伺服翻转机构包括伺服电机驱动器SDI1 SDIi，驱动伺服翻转电机IVM1 IVMi ;多组伺服开模机构包括伺服电机驱动器SD0B1 SD0Bi， SD0P1 SD0Pi，开模电机0PBM1 0PBMi， 0PPM1 OPPMi，其中i为1、2、3......12o
3. 根据权利要求1所述的多轴伺服制瓶机智能系统，其特征在于下位计算机控制单元CPUS又包括CPU多轴伺服控制板CB1 CBi和母板MB，母板MB通过插槽与CPU多轴伺服控制板CBI CBi相连，每块CPU多轴伺服控制板可以连接1 7轴的伺服驱动器或者步进电机驱动器，其中i为1、2、3……12。
4. 根据权利要求3所述的多轴伺服制瓶机智能系统，其特征在于多轴伺服控制板为CB1 CB12块，每块伺服控制板CB通过伺服驱动器SDT与伺服钳瓶电动机TKM相连，通过伺服驱动器SDI与伺服翻转电动机IVM相连，通过伺服驱动器SD0B与伺服初模开电动机0PBM相连，通过伺服驱动器SD0P与伺服成模开电动机0PPM相连；伺服控制板CB通过步进电动机驱动器SDP与现场的双轴拨瓶器步进电动机PM相连，通过步进电动机驱动器SDR与双轴拨瓶器步进电动机RM相连，伺服控制板CB与拨瓶到位感应开关PSW、縮回到位感应开关RSW相连，拨瓶到位感应开关PSW和縮回到位感应开关RSW安装在双轴拨瓶器上。
专利摘要多轴伺服制瓶机智能系统，属玻璃瓶罐机械控制领域。包括上位计算机PC，与上位计算机PC相连的控制中心PN，其特征在于控制中心PN又包括下位计算机控制单元CPUS和伺服驱动单元，伺服驱动单元又包括多组双轴拨瓶器机构、多组伺服钳瓶机构、多组伺服翻转机构和多组伺服开模机构的驱动器，多组双轴拨瓶器机构、多组伺服钳瓶机构、多组伺服翻转机构和多组伺服开模机构通过电缆线与控制中心PN相连。结构简单、集系统数据处理、通讯、I/O，可实现制瓶机每组的双轴拨瓶，伺服钳瓶，伺服翻转，伺服开模等多达80个伺服轴的定时定位定曲线的协调同步定位运行。
文档编号G05B19/04GK201532567SQ20092002928
公开日2010年7月21日 申请日期2009年7月11日 优先权日2009年7月11日
发明者姜丰英, 朱文金, 王莉, 陈晓晨 申请人:山东三金玻璃机械股份有限公司