一种基于模糊PID的手套机机头与橡筋电机同步控制方法，包括以下步骤:1)推算出电机电磁推力与q轴电流的关系；2)确定同步运行控制器的输入量速度误差e与加速度误差ec；3)速度跟踪控制器控制电机的正常运行，根据处理器实时读取判断机头电机的编码器1、橡筋电机的编码器2的位置信息，当编码器1、编码器2测出的位置信息不对等时，同步运行控制器的输出将作为控制信号，经过D/A变换传输至变频器，再通过变频器控制电机转速，达到同步控制的目的。本发明专利技术能有效地使机头与橡筋电机位置同步，进而提高智能手套机的生产品质以及产量。
【技术实现步骤摘要】
一种基于模糊PID的手套机机头与橡筋电机同步控制方法
本专利技术涉及一种运动控制方法，尤其是一种智能手套机机头与橡筋电机的同步运动控制方法，属于运动控制领域。
技术介绍
手套机是一种针织机械，用于编制各种手套，包括劳保手套、半指手套、触摸屏手套以及各种时尚流行手套等，市场需求量巨大。从最开始的链条机发展到现在的智能手套机，自动化程度越来越高，对手套编制工艺要求也越来越高。在编织罗纹部位时，通过加入橡筋线来使罗口具有弹性的功能。现有的智能手套机在编制橡筋部位时，是靠机头带住橡筋沙嘴,然后通过橡筋电机转动主动轮，从而将橡筋线输送过来，由于机头与橡筋电机的参数变化、摩擦力的不平衡和负载变动等不确定因素导致两边的运动无法达到完全一致，影响加工工件的质量，进而这将影响手套机生产手套的品质以及产量。
技术实现思路
为了克服现有的智能手套机机头与橡筋电机之间的同步性能较差的不足，本专利技术提供一种能有效地使机头与橡筋电机位置同步的方法，进而提高智能手套机的生产品质以及产量。本专利技术解决其技术问题所采用的技术方案是：一种基于模糊PID的手套机机头与橡筋电机同步控制方法，所述方法包括以下步骤：第一步，确定电磁推力Fe与q轴电流Iq的关系机头与橡筋电机均采用永磁同步电机，永磁同步电机的d-q轴模型电压方程以及磁链方程为：其中，uq为q轴电压，Rs为定子电阻，λpm为永磁体磁链，τ为极距，Iq、Id分别表示流经q、d轴电流，λq、λd分别为磁链在q轴和d轴上的分量，Ld、Lq分别表示d、q轴上的电感；旋转电机三相绕组沿圆周基本对称，因此电磁转矩的谐波分量比较小，即Id＝0，认为其力矩与q轴电流成正比，所以电磁推力Fe只与Iq成正比，其关系为：其中，kT为电磁推力系数；np为磁极对数；第二步，计算同步运行控制器的输入量速度误差e与加速度误差ec采用主从结构，把机头电机作为主电机，橡筋电机作为从电机，通过多组速度、加速度传感器测量出主电机速度V1i、加速度a1i，从电机的速度V2i、加速度a2i，选取主电机速度V1i作为评价速度，并与从电机的实际转速V2i比较得到差值ei，取平均值得到速度误差e，选取主电机加速度a1i作为评价加速度，并与从电机的实际加速度a2i比较得到差值eci，取平均值得到加速度误差ec；第三步，速度跟踪控制器控制电机的正常运行，根据处理器实时读取判断机头电机的编码器1、橡筋电机的编码器2的位置信息，当编码器1、编码器2测出的位置信息不对等时，同步运行控制器的输出将作为控制信号，经过D/A变换传输至变频器，再通过变频器控制电机转速，达到同步控制的目的。进一步，所述第二步中，同步运行控制器是由速度同步补偿器与加速度同步补偿器组成的两输入三输出的模糊PID控制器，速度误差e和加速度误差ec为输入量，比例系数Kp、积分系数Ki和微分系数Kd为输出量，速度误差的连续取值范围为e＝[el，eh]，其中el为低极限，eh为高极限，e的论域为{-m，-m+1，……0，……m-1，m}，m为自然数，则在量化因子确定后，将速度误差e转换为模糊PID控制器的输入E上：式中round()代表取整运算，同理加速度误差的连续取值范围为ec＝[ecl，ech]，其中ecl为低极限，ech为高极限，e的论域为{-n，-n+1，……0，……n-1，n}，n为自然数，则在量化因子确定后，将加速度误差ec转换为模糊PID控制器的输入EC上：将{NB(负大),NM(负中),NS(负小),ZE(零),PS(正小),PM(正大)}作为输入变量E、EC和输出变量Kp、Ki、Kd的模糊子集；模糊规则是专家经验生成知识库作为控制规则，并且不断实验进行修正，最后得到最终规则库；根据模糊规则生成Kp、Ki、Kd模糊规则表，再经过模糊清晰化的处理得到输出KP、KI、KD，从而实现对它们的动态调整。再进一步，所述第三步中，同步运行控制器的输出将作为控制信号，q轴电流为：因为电磁推力Fe与Iq成正比，所以通过对比例系数、积分系数和微分系数的动态调整将改变电磁推力Fe，进而改变电机转速，实现同步控制。本专利技术由于采取以上技术方案，其具有以下优点：1、机头电机与橡筋电机位置同步后，可以对手套罗口部分进行更好的调节，使编制出来的手套质量更好。2、速度、加速度-位置偏差耦合控制器采用模糊PID控制算法，增加了系统鲁棒性。3、模糊PID控制相比较普通PID控制，响应曲线波动更小，恢复更快，抗干扰能力更强。附图说明图1为同步运行控制的程序流程图；图2为模糊PID控制器框图；图3为基于ARM的手套机橡筋电机与机头运行控制系统构成框图；图4为e和ec的隶属度函数；图5为KP、KI、KD的隶属度函数；图6为KP、KI、KD控制规则图。具体实施方式下面结合附图对本专利技术的实施方式做进一步描述。参照图1-图6，一种基于模糊PID的手套机机头与橡筋电机同步控制方法，包括以下步骤：第一步，求得电磁推力Fe与q轴电流Iq的关系永磁同步电机的d-q轴模型电压方程以及磁链方程为：其中，uq为q轴电压，Rs为定子电阻，λpm为永磁体磁链，τ为极距，Iq、Id分别表示流经q、d轴电流，λq、λd分别为磁链在q轴和d轴上的分量，Ld、Lq分别表示d、q轴上的电感，旋转电机三相绕组沿圆周基本对称，因此电磁转矩的谐波分量比较小，即Id＝0，近似的认为其力矩与q轴电流成正比，所以电磁推力Fe只与Iq成正比，其关系为：其中，kT为电磁推力系数；np为磁极对数；第二步，计算同步运行控制器的输入量速度误差e与加速度误差ec采用主从结构，把机头电机作为主电机，橡筋电机作为从电机，通过多组速度、加速度传感器测量出主电机速度V1i、加速度a1i，从电机的速度V2i、加速度a2i，选取主电机速度V1i作为评价速度，并与从电机的实际转速V2i比较得到差值ei，取平均值得到速度误差e，选取主电机加速度a1i作为评价加速度，并与从电机的实际加速度a2i比较得到差值eci，取平均值得到加速度误差ec；第三步，速度跟踪控制器控制电机的正常运行，根据处理器实时读取判断机头电机的编码器1、橡筋电机的编码器2的位置信息，当编码器1、编码器2测出的位置信息不对等时，同步运行控制器的输出将作为控制信号，经过D/A变换传输至变频器，再通过变频器控制电机转速，达到同步控制的目的。进一步，所述第二步中，同步运行控制器是由速度同步补偿器与加速度同步补偿器组成的两输入三输出的模糊PID控制器，速度误差e和加速度误差ec为输入量，比例系数Kp、积分系数Ki和微分系数Kd为输出量，速度误差的连续取值范围为e＝[el，eh]，其中el为低极限，eh为高极限，e的论域为{-m，-m+1，……0，……m-1，m}，m为自然数，则在量化因子确定后，将速度误差e转换为模糊PID控制器的输入E上：式中round()代表取整运算，同理加速度误差的连续取值范围为ec＝[ecl，ech]，其中ecl为低极限，ech为高极限，e的论域为{-n，-n+1，……0，……n-1，n}，n为自然数，则在量化因子确定后，将加速度误差ec转换为模糊PID控制器的输入EC上：将{NB(负大),NM(负中),NS(负小),ZE(零),PS(正小),PM(正中),PB(正大)}作为输入变量E、E本文档来自技高网...
【技术保护点】
1.一种基于模糊PID的手套机机头与橡筋电机同步控制方法，其特征在于，所述方法包括以下步骤：第一步，确定电磁推力Fe与q轴电流Iq的关系机头与橡筋电机均采用永磁同步电机，永磁同步电机的d‑q轴模型电压方程以及磁链方程为：
【技术特征摘要】
1.一种基于模糊PID的手套机机头与橡筋电机同步控制方法，其特征在于，所述方法包括以下步骤：第一步，确定电磁推力Fe与q轴电流Iq的关系机头与橡筋电机均采用永磁同步电机，永磁同步电机的d-q轴模型电压方程以及磁链方程为：其中，uq为q轴电压，Rs为定子电阻，λpm为永磁体磁链，τ为极距，Iq、Id分别表示流经q、d轴电流，λq、λd分别为磁链在q轴和d轴上的分量，Ld、Lq分别表示d、q轴上的电感，旋转电机三相绕组沿圆周基本对称，因此电磁转矩的谐波分量比较小，即Id＝0，认为其力矩与q轴电流成正比，所以电磁推力Fe只与Iq成正比，其关系为：其中，kT为电磁推力系数；np为磁极对数；第二步，求得同步运行控制器的输入量速度误差e与加速度误差ec采用主从结构，把机头电机作为主电机，橡筋电机作为从电机，通过多组速度、加速度传感器测量出主电机速度V1i、加速度a1i，从电机的速度V2i、加速度a2i，选取主电机速度V1i作为评价速度，并与从电机的实际转速V2i比较得到差值ei，取平均值得到速度误差e，选取主电机加速度a1i作为评价加速度，并与从电机的实际加速度a2i比较得到差值eci，取平均值得到加速度误差ec；同步运行控制器是由速度同步补偿器与加速度同步补偿器组成的两输入三输出的模糊PID控制器，速度误差e和加速度误差ec为输入量，比例系数Kp、积分系数Ki和微分系数Kd为输出量，速度误差的连续取值范围为e＝[el，eh]，其中el为低极限，eh为高极限，e的论域...
【专利技术属性】
技术研发人员：董辉，陈志璇，康磊，童辉，王亚男，江丽林，俞立，
申请(专利权)人：浙江工业大学，
类型：发明
国别省市：浙江,33
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。