全电动注塑机开合模电机和顶出电机的控制系统及控制方法

专利名称：全电动注塑机开合模电机和顶出电机的控制系统及控制方法
技术领域：
本发明涉及电动注塑机领域，特别涉及一种电动注塑机开合模电机、顶出电机的 控制系统及控制方法。
背景技术：
在全电动注塑机注射过程中，合模装置是保证成型模具可靠的闭紧和实现模具启 闭动作及顶出制品的部件。在注射成型时，由于进入模腔中的熔料还具有一定的压力，目前 很多注塑机的合模装置没有足够的合紧力，模具在熔料的压力下被打开，从而导致制品溢 边或使制品精度下降。另外，目前很多合模电机驱动系统仍不能满足模具启闭时的速度要求，既没有考 虑缩短空载行程的时间，同时又没有考虑到模具启闭过程的缓冲要求，以致损坏模具和制 件，导致机器的生产率低，使机器受到强烈振动和产生撞击噪音。此外，很多模具不能满足安装和制品取出时空间位置的要求，致使合模装置不能 满足对合模力、速度、位置三方面的控制要求，承载能力低，结构不紧凑，运动性能差，力的 放大比相对较小，在注射过程中易产生涨模现象。很多顶出装置不具有足够而均勻的顶出力和可控的顶出次数、顶出速度，也不具 有足够可调的顶出行程，导致了制品不能准确而平稳地从模内制品顶出。

发明内容
本发明的目的在于克服现有技术的缺点与不足，提供一种全电动注塑机开合模电 机和顶出电机的控制系统及控制方法，保证成型模具可靠的闭紧和实现模具启闭动作及制 品准确而平稳地从模内顶出。本发明的目的通过下述技术方案实现一种全电动注塑机的开合模电机和顶出电 机控制系统，与开合模电机和顶出电机连接，其特征是，包括电脑控制器、PLC控制器和开合 模顶出驱动器；所述电脑控制器和PLC控制器分别通过CAN网络与开合模顶出驱动器信号 连接，所述开合模顶出驱动器分别与开合模电机和顶出电机连接。为了更好地实现本发明，所述开合模顶出驱动器由伺服控制器、IPM功率驱动板、 电流传感器、码盘和开关电源组成；所述伺服控制器与外部电路信号连接；所述IPM功率驱 动板连接伺服控制器和伺服电机；所述电流传感器连接IPM功率驱动板、伺服电机和伺服 控制器；所述码盘连接伺服电机和伺服控制器；所述开关电源连接IPM功率模块、电流传感 器、码盘和伺服控制器；所述伺服电机是指开合模电机和顶出电机。所述开合模顶出驱动器中的伺服控制器是指数字信号处理芯片TMS320F2833X，其 包括系统初始化程序模块、定时器下溢中断服务程序模块、正交编码器中断处理模块；所述 芯片TMS320F2833X的一个输出端通过其自带的CAN总线通信模块、JTAG接口分别连接到 注塑机电脑控制器和仿真器，另一输出端通过其自带的事件管理器EVA/B依次连接IPM功率驱动板和伺服电机，所述伺服电机通过电流传感器连接到芯片的模数转换模块ADC，所述 伺服电机还通过码盘连接芯片的正交编码器单元QEP ；所述伺服电机是指开合模电机和顶 出电机。上述的全电动注塑机开合模电机和顶出电机控制系统的控制方法，其特征是，包 括如下步骤第一步，采用五支铰合模双曲肘合模机构和曲柄滑块顶出机构，根据双曲肘机构 的开合模过程的移模速度特性和增力特性，确定合模装置和顶出装置选用的滚珠丝杠和开 合模电机、顶出电机；第二步，根据开合模电机、顶出电机的负载特性和工艺要求，对开合模电机和顶出 电机进行控制并设置完善的模具保护措施，包括(1)合模过程中，首先以低压力快速进行合模，当动模板与定模板接近时，自动切 换为低速合模，在确定模腔内无异物后，再次切换到高压将模具闭合；合模过程中，为防止 模具物料溢出，需要施加较大的合模力，该过程开合模电机采用力矩控制；(2)开模过程中，首先要保证注塑零件冷却模具型腔面脱离导柱的位置，然后动模 板勻速移动快速开模，在接近动模板的起点位置时动模板慢速停止；(3)通过调节顶出电机的转速来调整顶出速度，保证准确而平稳地将模内制品顶 出ο为了更好地实现上述方法，所述第一步中的确定合模装置和顶出装置选用的滚珠 丝杠和开合模电机、顶出电机是指①根据五支铰合模双曲肘合模机构的平动工作状况，确 定滚珠丝杠轴径、导程、丝杠长度、丝杠轴径和精度等级；②综合考虑所需的锁模力、移模速 度、行程比、滚珠丝杠导程、皮带传动装置的传动比来选定开合模电机、顶出电机。所述第二步第(1)中的确定模腔内无异物是指在接近定模板的位置设定一个检 测区间，通过检测开合模电机负载电流的变化有否超限来确定有无障碍物。所述第二步第(2)中保证注塑零件冷却模具型腔面脱离导柱的位置是指将所述 位置设定为导柱与固定侧的模具接触时的位置。所述第二步第(1)中的合模过程，包括①、从开模结束位置移动到合模变速位置，称为合模速度1段；②、从合模变速位置移动到模具保护位置，称为合模速度为2段，该段是高速低压 运动；③、从模具保护位置移动到模具接触位置，称为合模速度3段，该段为模具保护 区，如果电流传感器监测到该段合模出现电流比平常电流曲线增大，视为模具端面有残余 塑料没有被取出，合模过程停止并且立即开模；④、从模具保护区移动到模具合紧，施加最大压力锁模。所述第二步开模和闭模过程的移模速度按下述方法得出I、动模板行程依结构分析，动模板的移动行程Sm可以铰支座B点的位移量表征sm = lab0 cos Yo 一 lAB1 COS γλ(i)式(1)中^ω。是在终锁位置铰A、B的中心连线。
6
肘长比λ = L1Zl2,根据正弦定律
由此可得 11、活塞杆行程Sg和行程比Ks活塞杆行程是沿用液压式合模装置的术语，在电机驱动的合模装置里，Sg表示十 字头的行程，以十字头上铰E的移动量表征 模板行程与十字头行程之比称为行程比Ks = SM/Sg (9)Ks反映了移模速度和十字头移动速度的比值，而且也反映了机台的能量消耗；III、移模速度Vm和速度变化系数Kv肘杆式合模机构的移模速度为可控制移模速度，若忽略摩擦损失，根据能量守恒 定理，对合模机构输入的功率应等于输出的功率即Pb · Vb = Pm · Vm(10)所以模板移动速度可得
v =yA sinCflr +β +θ) cos φ
m Pm L5 sin(or +φ + θ ->rY)cosfi
(11)
Z1 sincir cos Acosa
=VB 人.V—(I + ·
2) 1
/Iv
cos0sin(a +γ + θ + φ) ^l-A2Sin2a本发明的控制原理如下如图1、图2-1所示，双曲肘机构的开合模过程的移模速度特性为1、动模板行程SmSm = Lab。cosX0-Labi Cosyl，式中i^。是在终锁位置铰A、B的中心连 线。lAB0 =L1 +L2 Lab^ =LlCOsai +L2 Cosfil .肘长比 λ = L/L2,根据正弦定律 OT1 = COS"1 1--——_(5)
！ S^lLx -SmX) Hl(L^ALl-ASm)
CN 101913236 A
说明书3/17页
(2)
(3) 其中由此可知肘杆机构的行程是Sm是随肘
m J
长比λ和Ci1的增大而增加的。然而后连杆L1的尺寸受后模板的外形尺寸制约，一般有L1 <LAA/2，LM为后模板两支铰的中心距。而Ci1的大小则会影响到机构能否实现自锁。2、活塞杆行程Sg和行程比Ks在电机驱动的合模装置里，Sg表示十字头的行程，以十字头上铰E的移动量表征 为:Sg = L5[cos0-Cosal + 没]+Z4(cos灼- cos^0)
.-\rh-Ls sin(a, + θ)^. _xh-Ls sin其中=
板行程与十字头行
厶4，
程之比称为行程比Ks = SM/Sg，Ksi映了移模速度和十字头移动速度的比值，而且也反映了 机台的能量消耗。实践证明Ks在1 3之间，小型机取大值，大型机取小值，过大的Ks值会 引起冲击现象。3.移模速度Vm和速度变化系数Kv肘杆式合模机构的移模速度一般指其平均移模速度。若忽略摩擦损失，根据能量 守恒定理，对合模机构输入的功率应等于输出的功率即Pb · Vb = PM · VM，所以模板移动速度 为
由上式可知肘杆机构在移模过程中平缓变速的特性。双曲肘机构的开合模过程的增力特性为1、增力倍数M设十字头推力Ρ。，合模力Pm，由上述运动分析可知，十字头的移动速度Vg = Ve, 动模板的移动速度Vm = Vb，因为。二·^ Vm=I故有"^ = ；^根据虚位移原理 P0dsg-Pffldsffl = ，则连杆机构的增力倍数Pm dSm Vm Z1SinCa +P)cos9式中 ^ζ。2、机构的自锁和正常运动条件 由sf= ^^ = ^^—t = ^；"可知连杆机构的自锁条件是 Pm dSm Vm IlSmipcKv
α +没+识=180°，连杆机构的正常运动条件是叫< 180 -汐+夠)。
3、肘杆机构在锁模过程的变形力设Δ S为系统的总形变量，则有 式中LP，Δ Lp—拉杆长度和拉伸变形量；Lk, Δ Lk——受压件总的自由长度和压缩变形量；f17 f2—后模板和前模板的弯曲挠度；α L，β L——锁模临界角；根据虎克定律，合模机构的变形力为Pc = C [L1 (cos α -cos α L) +L2 (cos β -cos β J ]，当模具合紧，连杆 L1 和 L2 撑成一条 直线时，α = 0°，β = 0°，变形力达到最大值，即 Pcm = c [I1 (1-cos α L)+l2(l-C0Si3L)]， 式中C为系统总刚度。4、十字头推力P0根据工艺生产的要求，在模具合紧过程中，十字头推力Ptj(相当于液压机型中的液 压油缸推力)产生的合模力Pm应该大于等于机构变形力Pc 双曲肘机构具有力的放大特性，力的放大倍数M表示机构在合模过程中的移模力 Pm与十字头推力仏之间的关系。双曲肘五支铰式合模机构的力放大比在整个合模过程的变 化曲线如图2_3a所示。变形力Pc与α角成二次抛物线规律变化，而移模力Pm则如图所示 与α是双曲线关系。机构在克服变形阻力最终实现合模力的过程中，电机传动机构作用于 十字头上的推动力经过双曲肘机构放大得到的移模力Pm，随机构的放大比改变而改变，如 图2_3b所示，只有保证Pm大于合模过程的机构变形力P。，才能顺利合模，如图2_3b的相切 情况。实际上由于摩擦力和加工精度等原因，移模力通常要比Pml高才能合模。因此Pml就 成为了我们电机选型中对电机额定力矩计算的关键参考依据。模糊自适应位置控制在全电动注塑机中，快速的模板移动、频繁的开合模导致电 动机在几秒间就需要进行一次正反转的切换，再加上螺杆式丝杠等机械传动会产生的累计 误差，另外模具保护也需要在锁紧前1. 5mm附近的狭小位置进行力矩和电流的检测，因此 位置的控制显得重要。5、电流环控制器的设计电流环在系统中的作用主要是控制输出力矩，目的是实现快速的动态响应，并保 证电流在突加负载时的过渡过程中没有超调或者超调越小越好。为此我们把电流环校正成 I型系统，开环传递函数为 电流环采用PI控制，框图如图8。为了使控制器的零点对消电机控制对象相对较大的时间常数，令τ , = Tm则T = Ts,KKiKs/てiRs，所以Ki＝KてiRs/Ks
为使超调量低于5%，可取阻尼比ξ = 0. 707，ΚΤ = 0. 5，则K= 1/2Τ，根据式(13) 付‘IKsT代入数值即可求得K” τ ”其中，电机参数为额定转速N，额定转矩T，转子惯量J， 绕组电阻R，机械时间常数Tm，电气时间常数Ts，电感Lq，转矩常数Kt ；6、速度环控制器的设计
w(s) =_ __(14)电流环的传递函数为 W T
—S H---l· 1
K K考虑到转速环的截止频率一般较低，因此电流环传递函数可近似降阶为 「 ι ^) = -^—=(15)v ‘ 1 . 2Ts + \
— + 1 K在上述电流调节环节的基础上，速度环采用PI控制器的原理框图如图9 将速度 环校正为典II型系统，使用PI速度控制器，开环传递函数为二(16) TnJs (2Ts +Y)根据典型II型系统设计参考公式τ n = h · 2T
h + 1 JKn
2h 2ΤΚ,取h= 5，可求得 τη、Κη7、模糊自适应位置控制器的设计位置环位于闭环控制系统的最外环，作用是保证动模板移动位置的静态精度。在 全电动注塑机中，快速的的模板移动、频繁的开模合模导致电动机在几秒间就需要进行一 次正反转的切换，再加上螺杆式丝杠等机械传动会产生的累计误差，另外模具保护也需要 在锁紧前1. 5mm附近的狭小位置进行力矩和电流的检测，因此位置的控制显得重要。模糊自适应控制器的设计是根据模糊理论建立自适应机构，它并不要求对参考模 型和被控对象建立精确的数学模型而只要根据系统的模糊信息，模拟一个有经验的控制工 作人员，用模糊条件语句写出控制规则，就能实现其控制作用，另外，模糊算法比较简单，便 于在DSP上实现实时控制。其原理框图如下所示。
模糊位置控制器的设计包含如下步骤 (1)精确量的模糊化
位置控制对象的模型用一个二阶传递函数描述
Gm=-T-^--(17)
s +gs +ω
模糊控制器设计为两输入单输出系统，输入变量为位置误差e和误差变化率 ，输 出控制变量ΔΚ为速度环的给定信号。它们三者的实际变化范围称为这些变量的基本论 域。对位置误差e、误差变化率 和控制变量△ K的定义如下位置误差e的精确值分为14 级，其基变量的模糊集的论域定义为
{-6，-5，-4，-3，-2，-1，-0，+0，1，2，3，4，5，6}；
10
相应地误差e的模糊语言子集定义为8档，依次对应从“正大”到“负大”{PL PM PS PO NO NS NM NL}误差变化率 的等级分为13级，其基变量模糊集的论域定义为{-6，-5，-4，-3，-2，_1，0，1，2，3，4，5，6}；误差变化率 的模糊语言子集定义为7档{PL PM PS 0 NS NM NL}控制变量ΔΚ的定义类似 ，基变量模糊集的论域定义为{-6，-5，-4，-3，-2，-1，0，1，2，3，4，5，6}；控制变量Δ K的Fuzzy语言子集定义为{PL PM PS 0 NS NM NL}在我们的电机合模系统中，位置误差e是对应着正交编码器反馈回来的脉冲数换 算出的位移与电子尺测量值之差，位置误差变化率 则是前者对时间t的导数，最大的输出 量为电机的最高转速2000转/分。从测量反馈回来的误差和误差变化率的精确值，变换到 基变量模糊集中的某一个成员，这需要一个量化比例因子或者换算表。同样地输出的控制 量ΔΚ也有一个从基变量模糊论域成员到精确量的比例因子。实际程序中换算的公式如式 18、19所示，换算表1说明具体换算的情况。
然后是要确定基变量论域内的元素对模糊语言子集变量的隶属度，这称为语言化 过程。位置误差变量e的语言化过程由模糊关系矩阵兄给出 同理误差变化率纟、输出控制量ΔΚ的语言化过程由模糊关系矩阵瓦和及α给出 设e论域上的模糊集为f ,语言论域上的模糊集为炉； 论域上的模糊集为C，语言
论域上的模糊集为，则把测量进行Fuzzy语言化的过程可以用矩阵的内积表示为 及/和及/分别是民和瓦的转置矩阵。而在确定输出控制量Δ K的时候，数量化是Fuzzy语言化的反变换，设Δ K论域上 的模糊集为G，在Fuzzy语言论域上的模糊集为，则把控制量ΔΚ数量化的过程可以表示
为 (2)设计模糊规则模糊规则的选择是设计模糊控制器的核心。模糊控制规则实质上是将操作者在控 制过程中的实践经验(即手动控制策略)加以总结而得到的一条条模糊条件语句的集合。 操作者要认真调查研究，反复进行试验，使模糊规则客观的反映控制对象的规律，这样才能 减少人为的影响，使其符合控制要求。并要注意规则的完整性，相容性和干涉性。表2是根 据经验而对输出量ΔΚ的控制规则。表2 ΔΚ的控制规则
VPLPMPSPONONSNMNL^ N
13 这些规则在实际中达到良好的控制效果。可以利用这些规则通过模糊算法求解控 制量的语言值。每个表分别由56条语句构成，表格中点(i，j)表示的语句意义为if e = At and = Cj then AK = Gk(3)模糊判决上面模糊控制器的输出量是一个模糊集合，而被控过程只能接受一个控制量，这 就需要从输出的模糊集集判决出一个精确的控制量，也就是设计一个由模糊集合到普通集 合的映射，称为判决。我们采用取中位数法(均值判决法)。上述计算是离线进行的，通过 计算得到修正值表，在DSP中实现模型参考模糊自适应控制是通过查询修正表3来实现的。表3 Δ K的模糊控制修正查询表 设置合模机构具有完善的模具保护措施，注射成型的周期一般以模具闭合动作一 次为标记，起点位置是①，合紧为⑧。合模过程中，首先以低压力快速进行合模，当动模板 与定模板接近时，自动切换为低速合模，在确定模腔内无异物后，再次切换到高压将模具闭 合。合模过程中，为防止模具胀开或者物料溢出，需要施加较大的合模力，该过程伺服电机 采用力矩控制。合模动作分解1、从开模结束位置①移动到合模变速位置④，称为合模速度1段(其中①至②是 动模板克服静摩擦驱动瞬间的位移，③至④是合模速度1段)。2、合模变速位置④移动到模具保护位置⑥，称为合模速度为2段，该段是高速低 压运动。3、模具保护位置⑥移动到模具接触位置⑦，称为合模速度为3段或者称模具保护 区，模具位置⑥移动到模具接触位置⑦靠模具保护力，如果驱动器监测到模具端面有残余 塑料没有被取出，合模过程停止并且立即开模。4、从模具导柱插入定模位置⑦移动到模具合紧⑧，伺服电机施加最大压力锁模。在锁紧状态，开闭模轴的现在位置为⑧。开模动作设定第一步、开模⑧至⑨是在模具打开时，要保证注塑零件冷却模具型腔面脱离导柱 的位置。第二步、⑨和⑩是快速开模，按照面板设定值勻速移动，(11)至①是开模慢速停 止，大约与①至②的值小IOmm相等。第三步、⑧至⑨的位置设定为模具的导柱与固定侧的模具接触时的位置。第四步、⑦至⑧和⑧至⑨的设定值应相同。除此以外，还需要有完善的模具保护措施。通常注射用的模具精密且结构复杂。如 果模具内留有制品或者残留物，或者在使用嵌件时嵌件的位置没有正确放置时，模具按设 定进行合模的话，会使模具受到损伤。在全电动注塑机中，模具保护是通过在临近定模的位 置设定一个检测区间，电机以低速低转矩推动模板靠近定模，同时检测电机负载电流的变 化有否超限来确定无障碍物。制品顶出装置的功能是保证准确而平稳地将模内制品顶出。因此，顶出装置应具 有足够而均勻的顶出力和可控的顶出次数、顶出速度，应具有足够可调的顶出行程。本例采 用滚珠丝杠顶出机构，通过调节电机转速来调整顶出速度。这种顶出机构的结构简单，顶出 平稳。全电动注塑机开合模电机顶出电机控制装置有如下特点1、开合模机构采用五支铰合模双曲肘合模机构；2、全电动注射机的顶出装置采用滚珠丝杠机构；3、完善的模具保 护措施；4、伺服驱动器设计了 PI电流环控制器、PI速度环控制器、模糊自适应位置控制器； 5、基于DSP的伺服电机控制程序，采用磁场定向(FOC)控制算法。本发明相对于现有技术具有如下的优点及效果1.本发明的控制系统引进了模糊自适应智能控制器，具有较高的动态性能和静态 性能；算法简单，易于解析生成，适合于实时控制；对各种参数变化、扰动及不确定性干扰 不敏感，系统鲁棒性好；与传统控制策略(如PID控制)相结合，优势互补。2、本发明的控制系统采用的驱动器满足开合模非线性运动规律要求的控制技术， 自学习控制、滑模变结构控制、鲁棒自适应控制等多种控制策略，提高系统参数自整定能 力，保证系统在高负载情况下的稳定可靠性，同时提高扰动的补偿性。3、采用本发明的控制系统进行控制，对电机采取消除应力负载，使得顶出过程完 全消除了塑料制品模腔应力脱模的突变现象，保证顶出工艺正常工作。4、本发明采用TMS320F2833X微处理器控制器芯片和大功率智能模块IPM功率驱 动板相结合，满足了对合模力、速度和位置三方面的控制要求，采用本发明的控制方法，实 现了开合模时间的最优化，而且具有完善的模具保护功能，保证了成型模具可靠的闭紧和 实现模具启闭动作及制品准确而平稳地从模内顶出。


图1是全电动注塑机采用的电机合模机构的结构示意图其中1_调模板；2-曲肘机构；3-动模板；4-定模板；5-开合模电机；6_顶出电 机；7-滚珠丝杆；8-动模具；9-导杆；10-定模具；图2-1是全电动注塑机采用的双曲肘机构运动图；图2_2a是全电动注塑机采用的双曲肘机构速度特性图；图2_2b是全电动注塑机采用的双曲肘机构的压力特性图；图2_3a全电动注塑机采用的双曲肘五支铰式合模机构的力放大比在整个合模过 程的变化曲线；图2_3b是全电动注塑机采用的双曲肘机构力的放大比曲线；图3是本发明全电动注塑机开合模电机顶出电机控制系统结构框图；图4是本发明的控制系统采用的电流、速度、位置三闭环控制方法原理图；图5是本发明的控制系统中的伺服驱动器的内部连接框图；图6是本发明的控制系统中的伺服控制器与外部电路的连接图；图7是本发明的控制系统采用的FOC算法控制框图；图8是本发明的控制系统采用的电流环控制框图；图9是本发明的控制系统采用的速度环控制框图；图10是本发明的控制系统采用的模糊自适应控制框图。
具体实施例方式下面结合附图和实施例对本发明作进一步说明。但本发明的实施方式不限于此。如图1所示为全电动注塑机采用的合模机构，包括五支铰合模双曲肘合模机构、
16部分，其中五支铰合模双曲肘合模机构由开合模电机、调 模板、曲肘机构、动模板、动模具、定模具、顶出电机、滚珠丝杆、导杆、定模板组成，曲柄滑块 顶出装置由顶出电机、滚珠丝杆、顶出杆、顶板、齿形带轮、皮带、动模板组成；所述开合模电 机一端连接调模板和滚珠丝杠与曲肘机构的十字头，调模板另一端连接滚珠丝杆同时与导 杆相连，导杆同时还连接动模板、定模板，动模板连接曲肘机构和顶出杆与动模具固定连接 在一起，滚珠丝杆另一端与顶出装置相连，即与顶出电机、顶板和齿形带轮相连，齿形带轮 驱动皮带并带动滚珠丝杆回转，顶板另一端连接顶出杆，定模板另一端与定模具相连，控制 系统连接控制开合模电机和顶出电机。注射成型的周期一般以模具闭合动作一次为标记，起点位置是①，合紧为⑧。合模 过程中，首先以低压力快速进行合模，当动模板与定模板接近时，自动切换为低速合模，在 确定模腔内无异物后，再次切换到高压将模具闭合。合模过程中，为防止模具胀开或者物料 溢出，需要施加较大的合模力，该过程伺服电机采用力矩控制。除此以外，还需要有完善的模具保护措施。通常注射用的模具精密且结构复杂。如 果模具内留有制品或者残留物，或者在使用嵌件时嵌件的位置没有正确放置时，模具按设 定进行合模的话，会使模具受到损伤。在全电动注塑机中，模具保护是通过在临近定模的位 置设定一个检测区间，电机以低速低转矩推动模板靠近定模，同时检测电机负载电流的变 化有否超限来确定无障碍物。制品顶出装置的功能是保证准确而平稳地将模内制品顶出。因此，顶出装置应具 有足够而均勻的顶出力和可控的顶出次数、顶出速度，应具有足够可调的顶出行程。本例采 用滚珠丝杠顶出机构，通过调节电机转速来调整顶出速度。这种顶出机构的结构简单，顶出 平稳。如图2-1所示为五支铰合模双曲肘合模机构在某一位置时的运动原理图，其工作 原理为伺服电机带动滚珠丝杠与曲肘机构的十字头联接，电机通过滚珠丝杆推动十字头运 动，十字头与曲肘机构配合将旋转运动转化为开合模方向的线性运动。合模过程的原理是 当电机正向转动时，移模丝杆带动肘杆机构推动模板向前运动。当模具的分型面接触时，肘 杆机构尚未形成一线排列，动模板受到变形阻力的作用。此时电机的转速降低、扭矩增大， 使作用在移模丝杆上的作用力不断增加，直至足以克服变形应力，使肘杆成为一线排列。合 模机构发生的弹性变形对模具实现了预紧，该预紧力即为合模力。开模时，电机反转，在移 模螺杆力的作用下，肘杆的一线排列被拉下扭曲，动模板被迫与定模板分离并退回合模前 的初始位置，从而实现开模。在合模过程中，要求动模板的速度按照“慢-快-慢”的规律变化。在起始阶段，移 模速度尽量慢，以降低系统冲击；在运行过程中要求移模速度尽量高，从而降低工作循环时 间，提高工作效率；在接近行程终点时，动模板的移动速度能够无限接近0，从而避免模具 受到锁模系统的冲击，延长其使用寿命。当机构运动到终点前某一位置时，模具刚好碰上， 机构继续运动，迫使合模装置机件发生弹性变形，从而对模具产生压紧力(即锁模力)，防 止模具在注入高压熔体时模具的型腔张开。图2-1中锁模伺服电机推动十字头，动模板向前移动，L1L2伸直。其中1、从动模板行程Sm可知肘杆机构的行程是Sm是随肘长比λ和α工的增大而增加 的。然而后连杆L1的尺寸受后模板的外形尺寸制约，一般有L1 < Laa/2, Laa为后模板两支
17铰的中心距。而Ci1的大小则会影响到机构能否实现自锁。2、活塞杆行程Sg和行程比Ks实践证明Ks在1 3之间，小型机取大值，大型机取小值，过大的Ks值会引起冲击 现象。图2_2a所示为双曲肘机构速度特性图，如图2_2a、b所示，肘杆式合模机构的移模 速度一般指其平均移模速度。若忽略摩擦损失，根据能量守恒定理，可知肘杆机构在移模过 程中平缓变速的特性。双曲肘机构具有力的放大特性，力的放大倍数M表示机构在合模过程中的移模力 Pm与十字头推力仏之间的关系。双曲肘五支铰式合模机构的力放大比在整个合模过程的 变化曲线如图2_3a所示。变形力Pc与α角成二次抛物线规律变化，而移模力Pm则如图所示与α是双曲线 关系。机构在克服变形阻力最终实现合模力的过程中，电机传动机构作用于十字头上的推 动力经过双曲肘机构放大得到的移模力Pm，随机构的放大比改变而改变，如图2-3b所示，只 有保证Pm大于合模过程的机构变形力P。，才能顺利合模，如图2-3b的相切情况。实际上由 于摩擦力和加工精度等原因，移模力通常要比Pml高才能合模。因此Pml就成为了我们电机 选型中对电机额定力矩计算的关键参考依据。根据开合模电机、顶出电机的负载特性，采用如图3所示的全电动注塑机开合模 电机顶出电机控制系统，包括电脑控制器、PLC控制器和开合模顶出驱动器；电脑控制器、 PLC控制器通过CAN网络连接控制开合模顶出驱动器，开合模顶出驱动器连接控制开合模 电机和顶出电机。注塑机电脑为AMDGeodeLXSOO，开合模电机顶出电机控制系统的功能有 开合模电机和顶出电机由DSP伺服驱动器控制，完成电动注塑机的开合模控制和顶出控 制，该驱动器带动开合模电机和顶出电机，通过图4所示的电流、速度、位置三闭环控制，实 现对电机的智能控制，上位控制器和下位伺服控制系统之间采用高速CAN总线实现通信。图4中，模糊自适应控制从电动锁模的环节看，电机控制部分的PI电流环是为控 制合模力、限制最大电流服务的；PI速度环负责控制移模速度、消除转速波动；模糊自适应 位置环处于最外面，负责对动模板的起、停定位，作用是保证动模板移动位置的静态精度。 在全电动注塑机中，快速的的模板移动、频繁的开合模导致电动机在几秒间就需要进行一 次正反转的切换，再加上螺杆式丝杠等机械传动会产生的累计误差，另外模具保护也需要 在锁紧前1. 5mm附近的狭小位置进行力矩和电流的检测，因此位置的控制显得重要。模糊自适应控制器的设计是根据模糊理论建立自适应机构，它并不要求对参考模 型和被控对象建立精确的数学模型而只要根据系统的模糊信息，模拟一个有经验的控制工 作人员，用模糊条件语句写出控制规则，就能实现其控制作用，另外，模糊算法比较简单，便 于在DSP上实现实时控制。合模装置的机械结构决定了电动锁模对象的力与运动特性，而注塑工艺对开合模 的控制要求则是联系机械运动与控制理论的桥梁。本发明将合模装置的机构特点和工艺要 求与伺服电机的控制理论结合起来，提取出双曲肘合模机构与电机驱动息息相关的多个物 理量进行分析与计算，并详细地设计了模糊控制器。在本发明中，开合模顶出驱动器的结构如图5所示，由伺服控制器、IPM功率驱动 板、电流传感器、码盘、开关电源组成，与伺服电机电连接，其中伺服电机在本发明中指开合
18模电机和顶出电机；所述IPM功率驱动板连接伺服控制器和伺服电机，电流传感器连接IPM 功率驱动板、伺服电机和伺服控制器，码盘连接伺服电机和伺服控制器，开关电源连接IPM 功率模块、电流传感器、码盘和伺服控制器。其中，伺服控制器以TMS320F2833X为核心，主 要负责电流、编码器、报警等反馈信号的处理，电机控制算法的运算，运行状态的显示，与上 位机通信的实现等工作；功率驱动电路以IPM功率驱动板为核心，功率驱动电路主回路采 用交-直-交整流逆变电路；电源电路采用开关电源，变压得到的多路电源供控制板，功率 模块栅极控制电源、传感器、散热风扇等使用。如图6所示本发明开合模顶出电机伺服控制器硬件结构图，所述开合模顶出驱动 器伺服控制器是指由数字信号处理芯片TMS320F2833X及其外设模块组成的DSP控制器，其 中外设模块包括SCI外设接口、CAN总线通信模块、JTAG接口、事件管理器EVA/B、ADC转换 模块、正交编码器单元QEP ；所述芯片TMS320F2833X控制器一输出端通过其外设模块CAN、 JTAG分别连接注塑机电脑、仿真器，另一输出端通过事件管理器EVA/B依次连接IPM模块、 开合模电机，开合模电机通过电流传感器、码盘分别连接到外设模块ADC转换模块、正交编 码器单元QEP，顶出电机也是通过事件管理器EVA/B连接到DSP控制器，同时顶出电机还通 过电流传感器、码盘分别连接到DSP的外设模块ADC转换模块、正交编码器单元QEP。本发 明的伺服控制器以TMS320F2833X芯片为核心控制电路，分别连接仿真器、伺服电机报警输 出定位完成信号，通过SCI连接在线监测，CAN总线连接注塑机电脑，通过事件管理器EVA/B 产生脉宽调制信号PWM送到智能模块IPM控制开合模电机和顶出电机，同时开合模电机和 顶出电机将电流通过电流传感器反馈连接到ADC并经过克拉克/帕克变换处理，正交编码 器单元QEP根据捕获的编码器信号获得电机转子的速度和方向信息。本发明的伺服控制器 以MS320F2833X芯片为核心控制电路，采用磁场定向算法(FOC)，实现对开合模电机、顶出 电机电流、速度和位置的控制。基于DSP的伺服电机控制程序实行的是按功能分工的模块化设计，包括四大部 分，由系统初始化程序模块、定时器下溢中断服务程序、正交编码器中断处理模块组成。各 大模块又由多个功能细分的子模块组成，系统初始化模块完成系统的上电自检测、对芯片 级寄存器进行初始化设置以及初始化伺服控制模块的参数。外部中断处理模块处理因电机 转动引起的正交编码器电平跳变中断，作用是获得转子相对位置信息以及计算转速增量， 该模块是磁场定向算法实现的重要部分。定时器下溢中断服务程序是整个程序中最复杂、 运算量最为集中的软件模块，磁场定向算法中的核心计算皆在此完成。ZLG7290程序模块是 管理人机交互的软件，负责显示系统运行状态、参数设置和处理按键事件。在进入主程序后的第一件事情就是封锁所有PWM通道，使之成为高阻态，让IPM的 功率管栅极状态由硬件电路中的上拉电阻拉高，即处于截止状态。尽管DSP的PWM通道默认 上电后是输入功能的I/O 口，理论上不会使得IPM模块的功率管导通，但是为了避免在初始 化过程中误修改了 PWM通道的状态，所以一开始就可靠地封锁PWM通道是很有必要的。然 后检测主电路是否正常(有否欠压、功率模块保护等)，进行芯片一级的寄存器的初始化， 包括SCSR、WatchD0g、MCRA、IMR、IFR等。然后是伺服系统运行参数的初始化，如运行模式、 最大允许转速、最大允许转矩、转速计数器清零等。一切都正常后，数码管显示第一个运行 选项，程序开中断，等待速度指令或按键。如图7所示为本发明的磁场定向算法(FOC)控制框图，磁场定向算法(FOC)程序
19实行模块化设计，使用到的模块如表4所示。 表4磁场定向算法程序模块 每一次磁场定向计算依次完成定子转子位置检测、电流检测、CLARKE和PARK坐 标变换、速度环PI调节、q轴电流PI调节、PARK逆变换、SVPWM发生等步骤。触发每一次 FOC计算的事件是DSP的定时器1的下溢中断，中断的周期为67us，对应产生的PWM载波频 率为15KHz，在定时器1的下溢中断程序中完成FOC算法的全部计算。磁场定向控制算法是基于电压空间矢量理论来讨论的，我们通过坐标变换以及模 糊、PI调节器把控制量解耦和校正，得到基于2相静止坐标系的的输出量Ua和U0，这时需 要通过DSP根据电压空间矢量理论调制成PWM输出作用于功率管的栅极上，这是整个FOC 计算中的最后一环。根据式
可见得到任意幅值和相位
的空间矢量的关键是不断计算和更新Tl、T2和TO的值。根据三角形的正弦定理有
解得
上述是基于abc三相坐标系讨论的，当把UOUT、UX和UX+60投影到2相平面直角坐标系α β中
时，式.
变换成 其中，一旦确定了 PWM的载波频率，Tpwm就事先选定了，而UQUTa和Uqut0正是FOC 算法中倒数第二环节的PARK逆变换的输出量Ua和ue。而六个非零基本空间电压矢量是已知的，因此逆阵
U Xa Uχ±60α U χβ
是可以离线预先计算好，然后分扇区存储成表，在实际的
计算中查表就可得到。则tl和t2就可以通过式
=TpH
Uχα U χ±ωα Uχβ υχ±60β
U,
OUTa
υ‘
ουτβ
计算
确定了。根据TPWM = tl+t2+t0，可确定零矢量的作用时间to = TPWM-(tl+t2)。本来对于无转子位置检测装置的电机如异步电动机要应用SVPWM调制输出电压 还必须通过UOTTa和Uott0计算UOUT所在的扇区，然后才能知道该查表选择哪一对UX和 UX士60的逆阵进行计算。不过在带有转子位置反馈的永磁同步伺服电机就可以直接得知当 前的UOUT位于哪个扇区了。添加零矢量是遵循使功率管开关次数最小的原则。插入零矢 量有两种不同的方式，一种是把零矢量集中的插入，另外一种则是把零矢量作用时间平均 分成几份、多点的插入到一个PWM周期中，但作用时间的和仍旧是t0。前者对减少功率管开 关次数有好处，而后者对平滑磁链的变化速度、抑制转矩脉动有好处。上述实施例为本发明较佳的实施方式，但本发明的实施方式并不受上述实施例的 限制，其他的任何未背离本发明的精神实质与原理下所作的改变、修饰、替代、组合、简化， 均应为等效的置换方式，都包含在本发明的保护范围之内。
2权利要求
一种全电动注塑机的开合模电机和顶出电机控制系统，与开合模电机和顶出电机连接，其特征是，包括电脑控制器、PLC控制器、开合模和顶出驱动器；所述电脑控制器和PLC控制器分别通过CAN网络与开合模和顶出驱动器信号连接，所述开合模和顶出驱动器分别与开合模电机和顶出电机连接。
2.根据权利要求1所述的全电动注塑机的开合模电机和顶出电机控制系统，其特征 是，所述开合模和顶出驱动器由伺服控制器、IPM功率驱动板、电流传感器、码盘和开关电源 组成；所述伺服控制器与外部电路信号连接；所述IPM功率驱动板连接伺服控制器和伺服 电机；所述电流传感器连接IPM功率驱动板、伺服电机和伺服控制器；所述码盘连接伺服电 机和伺服控制器；所述开关电源连接IPM功率模块、电流传感器、码盘和伺服控制器；所述 伺服电机是指开合模电机和顶出电机。
3.根据权利要求2所述的全电动注塑机的开合模电机和顶出电机控制系统，其特征 是，所述开合模顶出驱动器中的伺服控制器是指数字信号处理芯片TMS320F2833X，其包括 系统初始化程序模块、定时器下溢中断服务程序模块、正交编码器中断处理模块；所述芯片 TMS320F2833X的一个输出端通过其自带的CAN总线通信模块、JTAG接口分别连接到注塑 机电脑控制器和仿真器，另一输出端通过其自带的事件管理器EVA/B依次连接IPM功率驱 动板和伺服电机，所述伺服电机通过电流传感器连接到芯片的模数转换模块ADC，所述伺服 电机还通过码盘连接芯片的正交编码器单元QEP ；所述伺服电机是指开合模电机和顶出电 机。
4.一种权利要求1至3所述的全电动注塑机开合模电机和顶出电机控制系统的控制方 法，其特征是，包括如下步骤第一步，采用五支铰合模双曲肘合模机构和曲柄滑块顶出机构，根据双曲肘机构的开 合模过程的移模速度特性和增力特性，确定合模装置和顶出装置选用的滚珠丝杠和开合模 电机、顶出电机；第二步，根据开合模电机、顶出电机的负载特性和工艺要求，对开合模电机和顶出电机 进行控制并设置完善的模具保护措施，包括(1)合模过程中，首先以低压力快速进行合模，当动模板与定模板接近时，自动切换为 低速合模，在确定模腔内无异物后，再次切换到高压将模具闭合；合模过程中，为防止模具 物料溢出，需要施加较大的合模力，该过程开合模电机采用力矩控制；(2)开模过程中，首先要保证注塑零件冷却模具型腔面脱离导柱的位置，然后动模板勻 速移动快速开模，在接近动模板的起点位置时动模板慢速停止；(3)通过调节顶出电机的转速来调整顶出速度，保证准确而平稳地将模内制品顶出。
5.根据权利要求4所述的全电动注塑机开合模电机和顶出电机控制系统的控制方法， 其特征是，所述第一步中的确定合模装置和顶出装置选用的滚珠丝杠和开合模电机、顶出 电机是指①根据五支铰合模双曲肘合模机构的平动工作状况，确定滚珠丝杠轴径、导程、 丝杠长度、丝杠轴径和精度等级；②综合考虑所需的锁模力、移模速度、行程比、滚珠丝杠导 程、皮带传动装置的传动比来选定开合模电机、顶出电机。
6.根据权利要求4所述的全电动注塑机开合模电机和顶出电机控制系统的控制方法， 其特征是，所述第二步第(1)中的确定模腔内无异物是指在接近定模板的位置设定一个检 测区间，通过检测开合模电机负载电流的变化有否超限来确定有无障碍物。
7.根据权利要求4所述的全电动注塑机开合模电机和顶出电机控制系统的控制方法， 其特征是，所述第二步第(2)中保证注塑零件冷却模具型腔面脱离导柱的位置是指将所述 位置设定为导柱与固定侧的模具接触时的位置。
8.根据权利要求4所述的全电动注塑机开合模电机和顶出电机控制系统的控制方法， 其特征是，所述第二步第(1)中的合模过程，包括①、从开模结束位置移动到合模变速位置，称为合模速度1段；②、从合模变速位置移动到模具保护位置，称为合模速度为2段，该段是高速低压运动；③、从模具保护位置移动到模具接触位置，称为合模速度3段，该段为模具保护区，如 果电流传感器监测到该段合模出现电流比平常电流曲线增大，视为模具端面有残余塑料没 有被取出，合模过程停止并且立即开模；④、从模具保护区移动到模具合紧，施加最大压力锁模。
9.根据权利要求4所述的全电动注塑机开合模电机和顶出电机控制系统的控制方法， 其特征是，所述第二步开模和闭模过程的移模速度按下述方法得出①、动模板行程依结构分析，动模板的移动行程Sm可以铰支座B点的位移量表征 式(1)中Zm。是在终锁位置铰A、B的中心连线。 肘长比λ = L1A2,根据正弦定律cos A = - A2 sin2 α,由此可得 ②、活塞杆行程Sg和行程比Ks活塞杆行程是沿用液压式合模装置的术语，在电机驱动的合模装置里，Sg表示十字头 的行程，以十字头上铰E的移动量表征 厶4外=Sin1C——f-)C )厶4模板行程与十字头行程之比称为行程比Ks = SM/Sg (9)Ks反映了移模速度和十字头移动速度的比值，而且也反映了机台的能量消耗；③、移模速度Vm和速度变化系数Kv肘杆式合模机构的移模速度为可控制移模速度，若忽略摩擦损失，根据能量守恒定理，3对合模机构输入的功率应等于输出的功率即PRVB = PMVh(10)所以模板移动速度可得
全文摘要
本发明为全电动注塑机的开合模电机和顶出电机控制系统，一种全电动注塑机的开合模电机和顶出电机控制系统，包括相互连接的电脑控制器、PLC控制器、开合模顶出驱动器、开合模电机和顶出电机；本发明还分析了五支铰合模双曲肘合模机构对象的肘杆机构运动特性和动力学特性，提出了全电机驱动下的合模机构的模具保护实现方法，并从控制理论角度提出一种基于模糊自适应理论的合模机构控制方法和磁场定向控制算法，满足对合模力、速度、位置三方面的控制要求，保证成型模具可靠的闭紧和实现模具启闭动作及制品准确而平稳地从模内顶出，所设计的DSP驱动器保证了系统在高负载情况下的稳定可靠性，同时提高扰动的补偿性。
文档编号G05B19/05GK101913236SQ20101024748
公开日2010年12月15日 申请日期2010年8月5日 优先权日2010年8月5日
发明者钟汉如 申请人:华南理工大学