#include "global.h" #if XIN_SHENG_MACHINE void MXC_NiLongXiuCiJiCheckStart(void); void MXC_CuiQi_Start(void); void MXC_ShaChe_Output(void); void MXC_NiLongXiuCiJi_Motor(void); void MXC_NiLongXiuCiJi_XiaC(void); void MXC_Start_FenZ(void); void MXC_NiLongXiuCiJi_FenZhengProc(void); void MXC_ChuiQiProc(void); void MXC_JiaoDao(void); void MXC_ManualAction(void); void MXC_AutoAction(void); unsigned char cLFengTimer,cRFengTimer,cGuZhangStop = 0; unsigned long cShaCheTime,cLaLianLine,cGouZhenTime; unsigned char cChuiQiStep = 0,cGouZhenResetOK; unsigned short cBudaiCheckDelay = 0; unsigned char bHandWork,bPulseTatol_EN,bFirst,cInt1_OK,cStopFlag,cOneTimes,cKey_Time; long cSetEncode,cTotal,cDinWeiTime,cAddSetPulseNum,cEncodePulse,cWorkPulseNum; //故障报警 void MXC_SetAlarmCode(unsigned alarm_code) { SetAlarmCode(MXC_ALARM_ADDR,alarm_code); MXC_bAlarmStop = 1; MXC_bSaveWorkData = 1; } void MXC_InitAction(void) { MXC_XC_SongZhou = 1; MXC_XIA_ZHI_ENABLE = 0; if(MXC_MOTOR_MODE == 0) MXC_TuoDaiSongZhou = 1; else MXC_TuoDaiSongZhou = 0; if(MXC_XIA_ZHI_ENABLE) MXC_XiaZhi_MOTOR = 1; else MXC_XiaZhi_MOTOR = 0; } void MXC_NiLongXiuCiJiAction(void) { MXC_NiLongXiuCiJiCheckStart(); //启动 MXC_NiLongXiuCiJi_FenZhengProc(); //左右分针 MXC_NiLongXiuCiJi_XiaC(); //下冲 MXC_NiLongXiuCiJi_Motor(); //拖带控制 MXC_JiaoDao(); MXC_ManualAction(); MXC_AutoAction(); } void MXC_ManualAction(void) { long i; //清总产量 if(MXC_bClear) //清总产量 { MXC_bClear = 0; ClrcToTal(MXC_TOTAL_ADDR); } //当长度改变时，生产总量自动清零 if(MXC_bChangeLength) { MXC_bChangeLength = 0; i = MXC_SET_ZIPPER_LENGTH; if(cLaLianLine != i) { cLaLianLine = i; SetData32bits(MXC_ZIPPER_LENGTH_ADDR,0); ClrcToTal(MXC_TOTAL_ADDR); } } //加10 if(MXC_bAddLength) { MXC_bAddLength = 0; i = MXC_SET_REVISE_ZIPPER_LENGTH; i += 10; SetData32bits(MXC_ZIPPER_LENGTH_ADDR,i); } //减10 if(MXC_bDecLength) { MXC_bDecLength = 0; i = MXC_SET_REVISE_ZIPPER_LENGTH; i -= 10; SetData32bits(MXC_ZIPPER_LENGTH_ADDR,i); } //工作方式选择(数控定寸和勾针定寸)　 if(MXC_bSetDCMode) { MXC_bSetDCMode = 0; if(!bRunning) { MXC_DC_MODE++; if(MXC_DC_MODE > 2)MXC_DC_MODE = 0; if(MXC_DC_MODE != 0) { MXC_GouZhen_VAVLE = 1; MXC_XIA_ZHI_ENABLE = 0; MXC_XiaZhi_MOTOR = 0; } } } //勾针方式选择(活动勾针和固定勾针)　 if(MXC_bChangeGouZhenMode) { MXC_bChangeGouZhenMode = 0; if(!bRunning) { MXC_GOU_ZHEN_MODE++; if(MXC_GOU_ZHEN_MODE > 1)MXC_GOU_ZHEN_MODE = 0; } } //下止工作选择)　 if(MXC_bChangeXiaZhiMode) { MXC_bChangeXiaZhiMode = 0; if(!bRunning) { MXC_XIA_ZHI_ENABLE++; if(MXC_XIA_ZHI_ENABLE > 1)MXC_XIA_ZHI_ENABLE = 0; if(MXC_XIA_ZHI_ENABLE) MXC_XiaZhi_MOTOR = 1; else MXC_XiaZhi_MOTOR = 0; } } if(MXC_bJiaoDao) { MXC_cJiaoDaoStep = 1; MXC_bJiaoDao = 0; } //吹气 if((MXC_ChuiQi_VAVLE == 0)) { if(MXC_DingChuPian_IN_DW) { MXC_bChuiQi = 0; MXC_cChuiQiDelay = dwTickCount + 10*MXC_PARAM_DELAY_CHUIQI_TIME; MXC_cChuiQiStep = 1; } else if(MXC_bChuiQi == 1) { MXC_bChuiQi = 0; MXC_cChuiQiDelay = 0; MXC_cChuiQiStep = 1; } } MXC_ChuiQiProc(); if(MXC_ChuiQi_VAVLE && (dwTickCount >= MXC_cChuiQiDelay)) { MXC_ChuiQi_VAVLE = 1;// MXC_XiChiChuiQi = 1; MXC_cChuiQiDelay = dwTickCount + 10 * MXC_PARAM_CHUIQI_TIME; } if(MXC_XiChiChuiQi && (dwTickCount >= MXC_cChuiQiDelay)) { MXC_XiChiChuiQi = 0; } if((bRunning) == 0) ////手动 { if(MXC_ManXiaChong_UP || MXC_bXiaChong) { if(MXC_cXiaChongStep == 0)MXC_cXiaChongStep = 1; } if(MXC_cXiaChongStep == 0) { if(MXC_bLeftFenZhen) MXC_LeftFenZhen_VAVLE = 1; else MXC_LeftFenZhen_VAVLE = 0; if(MXC_bRightFenZhen) MXC_RightFenZhen_VAVLE = 1; else MXC_RightFenZhen_VAVLE = 0; //点动下冲 if((MXC_bDotXiaChong)) { MXC_bDotXiaChong = 0; if(MXC_LeftFenZhen_IN && MXC_RighttFenZhen_IN) { if(MXC_XiaChongMotorMode == 0) { if(MXC_cXiaChongStep == 0)MXC_cXiaChongStep = 20; } else { if(MXC_cXiaChongStep == 0)MXC_cXiaChongStep = 40; } } else { MXC_SetAlarmCode(MXC_XIA_CHONG_ALARM); //下冲条件不满足 } } if(MXC_bGouZhen) { MXC_bGouZhen = 0; if((MXC_GOU_ZHEN_MODE == 0))//普通勾针（活动）过链 { MXC_cGouZhenTime = dwTickCount + 300; MXC_GouZhen_VAVLE = ~MXC_GouZhen_VAVLE; } else //固定勾针 { MXC_GuDingGouZhen = ~MXC_GuDingGouZhen; } } } if(MXC_DC_MODE != 0) //伺服定寸 { MXC_GuDingGouZhen = 1; MXC_GouZhen_VAVLE = 1; } else if((MXC_GOU_ZHEN_MODE == 0) )//普通勾针（活动）过链 { if(dwTickCount >= MXC_cGouZhenTime) MXC_GouZhen_VAVLE = 0; } else { if(MXC_XiaMode) //0普通下止，1超声下止 { if(MXC_GuoLian_IN_UP) { MXC_GuDingGouZhen = 0; } } else //刘铁方式(下拉一下就可以复位) { if(dwTickCount >= MXC_cGouZhenTime) MXC_GuDingGouZhen = 0; } } //下止动作 if(MXC_XiaZhi_IN_UP || MXC_bXiaZhi) { MXC_bXiaZhi = 0; if(MXC_XiaZhi_VAVLE) { MXC_XiaZhi_VAVLE = 0; MXC_ChaoSheng = 0; MXC_FenDai_VAVLE = 0; //分带输出 } else { if(MXC_XiaZhi_IN || MXC_XIA_ZHI_ENABLE) //下止选择 { //下止输出 MXC_cXiaZhiDelay = dwTickCount + 10 * MXC_PARAM_XIAZHI_TIME; MXC_XiaZhi_VAVLE = 1; } } } else if(MXC_XiaZhi_IN_DW) { MXC_XiaZhi_VAVLE = 0; //下止电磁阀 MXC_ChaoSheng = 0; //超声输出 MXC_FenDai_VAVLE = 0; //分带输出 } if(MXC_bChuDai) { MXC_ChuDai_VAVLE = 1; } else { MXC_ChuDai_VAVLE = 0; } } if((MXC_XiaMode != 0))//普通下止 { if(MXC_GuoLian_IN_UP|| MXC_FenDai_IN_UP)MXC_FenDai_VAVLE = 1; if(bRunning) { if(MXC_GuoLian_IN_UP && MXC_XiaZhi_VAVLE)MXC_cXiaZhiDelay = dwTickCount + 10 * MXC_PARAM_XIAZHI_DELAY_TIME; if(MXC_GuoLian_IN && MXC_XiaZhi_VAVLE) { if(!MXC_ChaoSheng && (dwTickCount >= MXC_cXiaZhiDelay)) { MXC_ChaoSheng = 1; MXC_cXiaZhiDelay = dwTickCount + (unsigned long)10 * MXC_PARAM_CHAOSHENG_TIME; } if(MXC_ChaoSheng && (dwTickCount >= MXC_cXiaZhiDelay)) { MXC_FenDai_VAVLE = 0; //分带输出 MXC_ChaoSheng = 0; //超声输出 MXC_XiaZhi_VAVLE = 0; //下止阀 } } } } else { //下止下冲电磁铁 if((MXC_XiaZhi_VAVLE != 0) && (dwTickCount >= MXC_cXiaZhiDelay)) { MXC_XiaZhi_VAVLE = 0; } } } void MXC_AutoAction(void) { unsigned long i; if(bRunning) { if(MXC_XiaZhi_IN || (!MXC_Zipper_IN)) MXC_ChuDai_VAVLE = 0; else MXC_ChuDai_VAVLE = 1; if((MXC_DC_MODE == 0) && (MXC_GOU_ZHEN_MODE == 0)) { if(MXC_GouZhen_IN_UP)MXC_cGouZhenTime = 1; } else MXC_cGouZhenTime = 1; switch(MXC_cAutoStep) { case 0: break; case 1: //左右分针要退到位，过链到位要离开 if(MXC_LeftFenZhen_Origin_IN && MXC_RightFenZhen_Origin_IN && !MXC_LeftFenZhen_IN && !MXC_RighttFenZhen_IN && (dwTickCount >= MXC_cAutoDelay)) { MXC_cAutoStep = 2; MXC_cMotorStep = 1; //启动拖带 } break; case 2: //拖带已经完成 if(MXC_cMotorStep == 0) { bFirst = 1; //调试功能 if(MXC_DC_MODE != 2)MXC_cAutoStep = 3; // 调试功能 下一条 下冲 else if((!MXC_bDingWei) || MXC_bNext || MXC_ManXiaChong_UP || MXC_bXiaChong) { if(MXC_bNext) { MXC_cAutoStep = 1; MXC_bNext = 0; cInt1_OK = 0; } else { MXC_cAutoStep = 3; MXC_bDingWei = 0; } } MXC_cAutoDelay = dwTickCount + 5; //延时分针 } break; case 3: if((dwTickCount >= MXC_cAutoDelay) && MXC_cGouZhenTime) { MXC_cGouZhenTime = 0; if(MXC_cLeftFenZhenStep == 0)MXC_cLeftFenZhenStep = 1; MXC_cAutoStep = 4; } break; case 4: //左右分针都已完成 if((MXC_cLeftFenZhenStep == 0) && (MXC_cRightFenZhenStep == 0)) { MXC_cXiaChongStep = 1; //下冲电机启动 MXC_cAutoStep = 5; } break; case 5: //下冲已完成 if(MXC_cXiaChongStep == 0) { AddToTal(MXC_TOTAL_ADDR); //计数增加和保存 CalProSP(MXC_PROSPEED_ADDR); MXC_cAutoStep = 6; } break; case 6: if(MXC_LeftFenZhen_Origin_IN && MXC_RightFenZhen_Origin_IN && !MXC_LeftFenZhen_IN && !MXC_RighttFenZhen_IN) { if(GetTotal(MXC_TOTAL_ADDR) >= MXC_SET_TOTAL)MXC_SetAlarmCode(MXC_TOTAL_ALARM); MXC_cAutoStep = 7; } break; case 7: if((dwTickCount >= MXC_cAutoDelay) && (MXC_Dec_IN || MXC_GOU_ZHEN_DEC_MODE || MXC_DC_MODE)) { if(SingOneFlg) { SingOneFlg = 0; } else { MXC_cAutoStep = 1; } } break; } } } // 检测是否踏了脚踏开关 void MXC_NiLongXiuCiJiCheckStart(void) { // 停止键 不能在工作,手动,停止过程中 if((!STOP_IN) && (bHandWork == 0) && (bRunning == 0) && (cStopFlag==0) // 启动 && (START_IN_UP || (MXC_bStart)) && (cKey_Time == 0) && (!MXC_Zipper_IN)) { if(MXC_LeftFenZhen_Origin_IN && MXC_RightFenZhen_Origin_IN && !MXC_KaDai_IN) { bRunning = 1; MXC_bClearAlarm = 1; cKey_Time = 10; MXC_cAutoStep = 1; MXC_cMotorStep = 0; MXC_cXiaChongStep = 0; MXC_cLeftFenZhenStep = 0; MXC_cRightFenZhenStep = 0; SetAlarmCode(100,MXC_NO_ALARM); MXC_cAutoDelay = dwTickCount + (unsigned long)200; //先锁轴 cOneTimes = 0; cGouZhenTime = 1; MXC_XiaChong_MOTOR = 0; // if(MXC_XiaChongMotorMode == 1) { MXC_XC_SongZhou = 0; } if(MXC_MOTOR_MODE == 0) MXC_TuoDaiSongZhou = 0; else MXC_TuoDaiSongZhou = 1; if(MXC_bDingWei)cSetEncode = 0; bFirst = 0; } else { // user_datas[75] = 5; //页面跳转 if(MXC_KaDai_IN) SetAlarmCode(100,MXC_KA_DAI_ALARM); //卡带 else SetAlarmCode(100,MXC_START_ALARM); //起动条件不满足 } MXC_bStart = 0; } //卡带感应 if(MXC_KaDai_IN && (dwTickCount >= MXC_cKaDaiDelay)) { SetAlarmCode(MXC_ALARM_ADDR,MXC_KA_DAI_ALARM); //警告清 // user_datas[75] = 5; //页面跳转 MXC_cKaDaiDelay = dwTickCount + 2200; } if(MXC_KaDai_IN_UP) { MXC_bSaveWorkData = 1; } //停止 if((STOP_IN_UP || (MXC_bStop))) { // 不是下冲状态 if((MXC_cXiaChongStep == 0) && (bRunning == 0)) { MXC_CuiQi_Start(); if(!MXC_XiaChong_MOTOR)MXC_XC_SongZhou = 1; } if((cStopFlag == 0) && (cKey_Time == 0)) { cKey_Time = 4; if(((MXC_DC_MODE == 0) || STOP_IN_UP) && ((MXC_XiaChongMotorMode == 0) || (MXC_cXiaChongStep == 0))) { AxisDecStop(X_AXIS); } MXC_GuDingGouZhen = 0; MXC_CuiQi_Start(); if(X_DRV && !MXC_XiaChong_MOTOR && (MXC_DC_MODE == 1)) { cGuZhangStop = 1; } if((++cOneTimes >= 2) || !bRunning || !X_DRV) { cStopFlag = 1; SetAlarmCode(100,MXC_NO_ALARM); // user_datas[75] = 50; if(!X_DRV) { if(MXC_MOTOR_MODE == 0) MXC_TuoDaiSongZhou = 1; else MXC_TuoDaiSongZhou = 0; } } MXC_cKaDaiDelay = dwTickCount + 1200; MXC_cGouZhenTime = dwTickCount + (unsigned long)300; //勾针延时退 } MXC_bStop = 0; MXC_bSaveWorkData = 1; } if((MXC_cXiaChongStep == 0) && (((cStopFlag) != 0) || (MXC_KaDai_IN))) { bRunning = 0; bHandWork = 0; cStopFlag = 0; MXC_cAutoStep = 0; MXC_cMotorStep = 0; MXC_cXiaChongStep = 0; MXC_cLeftFenZhenStep = 0; MXC_cRightFenZhenStep = 0; MXC_XC_SongZhou = 0; MXC_XiaZhi_VAVLE = 0; MXC_LeftFenZhen_VAVLE = 0; MXC_RightFenZhen_VAVLE = 0; MXC_XiaChong_MOTOR = 0; MXC_ChaoSheng = 0; MXC_JiaoDao_OUT = 0; MXC_FenDai_VAVLE = 0; MXC_ChuDai_VAVLE = 0; MXC_GuDingGouZhen = 0; if(!X_DRV) { if(MXC_MOTOR_MODE == 0) MXC_TuoDaiSongZhou = 1; else MXC_TuoDaiSongZhou = 0; } if(MXC_KaDai_IN_UP)MXC_CuiQi_Start(); MXC_XC_SongZhou = 1; // 刹车 if(MXC_GOU_ZHEN_MODE != 0) //超声(固定)勾针 MXC_GuDingGouZhen = 1; if(MXC_DC_MODE != 0) { if(X_DRV)cGuZhangStop = 1; } else AxisDecStop(X_AXIS); MXC_cGouZhenTime = dwTickCount + (unsigned long)300; //勾针延时退 } } void MXC_JiaoDao(void) { if(MXC_cJiaoDaoStep == 1) { MXC_cChuiQiDelay = dwTickCount + 500; MXC_JiaoDao_OUT = 1; MXC_cJiaoDaoStep = 2; } else if((MXC_cJiaoDaoStep == 2) && (dwTickCount >= MXC_cChuiQiDelay)) { MXC_JiaoDao_OUT = 0; MXC_cJiaoDaoStep = 0; } } void MXC_CuiQi_Start(void) { //启动吹气 MXC_cChuiQiDelay = dwTickCount + (unsigned long)50 * MXC_PARAM_CHUIQI_TIME; MXC_ChuiQi_VAVLE = 1; MXC_XiChiChuiQi = 0; } void MXC_ChuiQiProc(void) { if(MXC_cChuiQiStep == 0) { } else if((MXC_cChuiQiStep == 1) && (dwTickCount >= MXC_cChuiQiDelay)) { MXC_CuiQi_Start(); MXC_cChuiQiStep = 0; } } void MXC_ShaChe_Output(void) { //启动吹气 cShaCheTime = dwTickCount + (unsigned long)120; if(MXC_XiaChongMotorMode == 0)MXC_XC_SongZhou = 1; } void MXC_Output_XiaCi(void)//下止输出 { if(MXC_XiaZhi_IN || MXC_XIA_ZHI_ENABLE) //下止选择 { //下止输出 MXC_cXiaZhiDelay = dwTickCount + 10 * MXC_PARAM_XIAZHI_TIME; MXC_XiaZhi_VAVLE = 1; } } //关下止动作 void MXC_Close_XiaCi(void) { if((MXC_XiaMode != 0))//普通下止 { if(MXC_GuoLian_IN_UP || MXC_FenDai_IN_UP) MXC_FenDai_VAVLE = 1; if(bRunning) { if(MXC_GuoLian_IN_UP && MXC_XiaZhi_VAVLE) { MXC_cXiaZhiDelay = dwTickCount + 10 * MXC_PARAM_XIAZHI_DELAY_TIME; } if(MXC_GuoLian_IN && MXC_XiaZhi_VAVLE) { if(!MXC_ChaoSheng && (dwTickCount >= MXC_cXiaZhiDelay)) { MXC_ChaoSheng = 1; MXC_cXiaZhiDelay = dwTickCount + (unsigned long)10 * MXC_PARAM_CHAOSHENG_TIME; } if(MXC_ChaoSheng && (dwTickCount >= MXC_cXiaZhiDelay)) { MXC_FenDai_VAVLE = 0; //分带输出 MXC_ChaoSheng = 0; //超声输出 MXC_XiaZhi_VAVLE = 0; //下止阀 } } } } else { //下止下冲电磁铁 if((MXC_XiaZhi_VAVLE != 0) && (dwTickCount >= MXC_cXiaZhiDelay)) { MXC_XiaZhi_VAVLE = 0; } } } unsigned long MXC_LengthCallPulse(unsigned long length) { return (length * 2000 / MXC_PARAM_DAILUN_LENGTH); } //高速输入X31/X17外部色标信号中断 void MXC_ExtiActionX31(void) { if(cSeBiaoEn && !cSeBiaoOk) { cSeBiaoOk = 1; cSeBiaoEn = 0; AxisDecStopPos(X_AXIS,MXC_PARAM_SEBIAO_DW_LENGTH); } } void MXC_NiLongXiuCiJi_Motor(void) { static long back_save_buff,gou_zhen_buff; static unsigned long zipper_length; dwRealPos = GetPos(X_AXIS); switch(MXC_cMotorStep) { case 0: break; // 过链 左分针退位 左到位 case 1: if(MXC_LeftFenZhen_Origin_IN && (!MXC_LeftFenZhen_IN) && MXC_RightFenZhen_Origin_IN && (!MXC_RighttFenZhen_IN)) { MXC_LIHE_VAVLE = 1; //离合器 gou_zhen_buff = dwRealPos; if(MXC_DC_MODE == 0) { zipper_length = MXC_SET_ZIPPER_LENGTH + MXC_SET_REVISE_ZIPPER_LENGTH + MXC_PARAM_DAOKOU_LENGTH; if((MXC_GOU_ZHEN_MODE == 0))//普通勾针（活动）过链 { if(dwZipCnt == 0) AxisMoveTwoPos(X_AXIS,MXC_PARAM_FIRST_SPEED,zipper_length,MXC_PARAM_LOW_SPEED,9999999,0); else AxisMoveTwoPos(X_AXIS,MXC_PARAM_SET_SPEED,zipper_length,MXC_PARAM_LOW_SPEED,9999999,0); if(MXC_PARAM_GZ_RESET_MODE) MXC_cMotorStep = 3; else { MXC_cMotorStep = 2; MXC_cAutoDelay = dwTickCount + MXC_PARAM_GZ_DELAY; } } else //带下止型勾针 { MXC_cMotorStep = 11; if(dwZipCnt == 0) AxisMoveTwoPos(X_AXIS,MXC_PARAM_FIRST_SPEED,zipper_length,MXC_PARAM_LOW_SPEED,9999999,0); else AxisMoveTwoPos(X_AXIS,MXC_PARAM_SET_SPEED,zipper_length,MXC_PARAM_LOW_SPEED,9999999,0); } cGuZhangStop = 0; cWorkPulseNum = 0; if(!MXC_GouZhen_VAVLE) { MXC_cMotorStep = 3; } } else if(MXC_DC_MODE == 1) { zipper_length = MXC_SET_ZIPPER_LENGTH + MXC_SET_REVISE_ZIPPER_LENGTH + MXC_PARAM_DAOKOU_LENGTH; MXC_cMotorStep = 20; MXC_GouZhen_VAVLE = 1; //定位(活动勾针)电磁阀 MXC_GuDingGouZhen = 1; //定位(活动勾针)电磁阀 if(cWorkPulseNum >= cSetEncode)MXC_cMotorStep = 0; else { AxisMovePos(X_AXIS,MXC_PARAM_SET_SPEED,zipper_length); } } else { zipper_length = MXC_SET_ZIPPER_LENGTH; if(cWorkPulseNum >= cSetEncode)MXC_cMotorStep = 0; else { back_save_buff = dwRealPos; if(dwZipCnt == 0) { cSeBiaoOk = 0; cSeBiaoEn = 1; AxisMoveTwoPos(X_AXIS,MXC_PARAM_FIRST_SPEED,zipper_length,MXC_PARAM_LOW_SPEED,9999999,0); } else AxisMoveTwoPos(X_AXIS,MXC_PARAM_SET_SPEED,zipper_length,MXC_PARAM_LOW_SPEED,9999999,0); MXC_cMotorStep = 50; MXC_cAutoDelay = dwTickCount + (unsigned long)10000; } } } break; // step2-5 活动勾针定寸 case 2: if((dwTickCount >= MXC_cAutoDelay)) { MXC_GouZhen_VAVLE = 0;//定位电磁阀 } if(!MXC_GouZhen_VAVLE && !MXC_GouZhen_IN) { MXC_cMotorStep = 3; MXC_cAutoDelay = dwTickCount + (unsigned long)10000; } break; case 3: if(MXC_PARAM_GZ_RESET_MODE) { if((dwRealPos - gou_zhen_buff + MXC_PARAM_GZ_LENGTH) >= zipper_length) { MXC_GouZhen_VAVLE = 0;//定位电磁阀 } } if(MXC_GOU_ZHEN_DEC_MODE)//数控方式 { MXC_cMotorStep = 4; MXC_cAutoDelay = dwTickCount + (unsigned long)10000; } else //感应方式 { if(!MXC_Dec_IN) { AxisChangeSpeed(X_AXIS,MXC_PARAM_LOW_SPEED); MXC_cMotorStep = 4; MXC_cAutoDelay = dwTickCount + (unsigned long)10000; } } if(MXC_GouZhen_IN) { AxisEgmStop(X_AXIS); MXC_cMotorStep = 4; MXC_LIHE_VAVLE = 0; } else if(dwTickCount >= MXC_cAutoDelay) { MXC_SetAlarmCode(MXC_NO_GOUZHEN_ALARM); } break; case 4: if(MXC_GouZhen_IN) { MXC_cMotorStep = 0; AxisEgmStop(X_AXIS); } else if((dwTickCount >= MXC_cAutoDelay)) { MXC_SetAlarmCode(MXC_NO_GOUZHEN_ALARM); } //布带对射检测 if(MXC_Zipper_IN) { MXC_cBudaiCheckDelay = dwTickCount + 3000; } else if(dwTickCount >= cBudaiCheckDelay) //没布带了 { MXC_SetAlarmCode(MXC_NO_ZIPPER_ALARM); MXC_GouZhen_VAVLE = 0; } break; case 11://以下为固定勾针方式 if(MXC_XiaMode == 0) //0　普通下止　1　超声下止 当超声下时勾针 { if(dwTickCount >= MXC_cAutoDelay)MXC_GuDingGouZhen = 0; if(!MXC_GuoLian_IN) { AxisChangeSpeed(X_AXIS,MXC_PARAM_LOW_SPEED); MXC_cMotorStep = 12; MXC_cAutoDelay = dwTickCount + (unsigned long)1500; //延时检测 } } else { if(MXC_GuoLianCheckMode) { if(!MXC_GuoLian_IN) { AxisChangeSpeed(X_AXIS,MXC_PARAM_LOW_SPEED); MXC_cMotorStep = 12; MXC_cAutoDelay = dwTickCount + (unsigned long)user_datas[12]; //延时检测 } } else { if(MXC_GuoLian_IN) { AxisChangeSpeed(X_AXIS,MXC_PARAM_LOW_SPEED); MXC_cMotorStep = 12; MXC_cAutoDelay = dwTickCount + (unsigned long)user_datas[12]; //延时检测 } } } break; case 12: if(dwTickCount >= MXC_cAutoDelay) { if(MXC_GuDingGouZhen) { MXC_GuDingGouZhen = 0; MXC_cAutoDelay = dwTickCount + (unsigned long)1500; //延时检测 } else if(!MXC_GuDingGouZhen) { MXC_SetAlarmCode(MXC_GU_DING_GOUZHEN_ALARM); } } if(MXC_XiaMode == 0) //0　普通下止　1　超声下止 当超声下时勾针 { if(MXC_GuoLian_IN) { MXC_GuDingGouZhen = 0; MXC_cMotorStep = 13; MXC_cAutoDelay = dwTickCount + (unsigned long)user_datas[10]; //延时停电机 } } else { if(MXC_GuoLianCheckMode) { if(MXC_GuoLian_IN_UP) { MXC_GuDingGouZhen = 0; MXC_cMotorStep = 13; MXC_cAutoDelay = dwTickCount + (unsigned long)user_datas[10]; //延时停电机 } } else { if(MXC_GuoLian_IN_DW) { MXC_GuDingGouZhen = 0; MXC_cMotorStep = 13; MXC_cAutoDelay = dwTickCount + (unsigned long)user_datas[10]; //延时停电机 } } } break; case 13: if((dwTickCount >= MXC_cAutoDelay)) { if(MXC_XiaMode == 0) //0　普通下止　1　超声下止 当超声下时勾针 { AxisEgmStop(X_AXIS); if(MXC_GuoLian_IN) { MXC_cMotorStep = 0; MXC_LIHE_VAVLE = 0; } } else { if(MXC_GuoLianCheckMode) { if(MXC_GuoLian_IN) { MXC_cMotorStep = 0; AxisEgmStop(X_AXIS); MXC_LIHE_VAVLE = 0; } } else { if(!MXC_GuoLian_IN) { MXC_cMotorStep = 0; AxisEgmStop(X_AXIS); MXC_LIHE_VAVLE = 0; } } } } if(MXC_Zipper_IN) { MXC_cBudaiCheckDelay = dwTickCount + 3000; } else if(dwTickCount >= MXC_cBudaiCheckDelay) //没布带了 { MXC_SetAlarmCode(MXC_NO_ZIPPER_ALARM); //没拉链 MXC_GouZhen_VAVLE = 0; } break; //伺服定寸 case 20: if(!X_DRV)MXC_cMotorStep = 0; //布带对射检测 if(MXC_Zipper_IN) { MXC_cBudaiCheckDelay = dwTickCount + 140; } else if(dwTickCount >= MXC_cBudaiCheckDelay) //没布带了 { MXC_SetAlarmCode(MXC_NO_ZIPPER_ALARM); //没拉链 MXC_GouZhen_VAVLE = 0; } break; case 50: if(dwZipCnt != 0) { if(MXC_SET_ZIPPER_LENGTH >= (MXC_PARAM_SEBIAO_DW_LENGTH + MXC_PARAM_SEBIAO_TQ_LENGTH)) { cSeBiaoOk = 0; cSeBiaoEn = 1; } else { if((dwRealPos - back_save_buff) >= (MXC_SET_ZIPPER_LENGTH - MXC_PARAM_SEBIAO_DW_LENGTH - MXC_PARAM_SEBIAO_TQ_LENGTH)) { cSeBiaoOk = 0; cSeBiaoEn = 1; } } } if(cSeBiaoOk) { cSeBiaoOk = 0; cSeBiaoEn = 0; MXC_cMotorStep = 51; } else { //布带对射检测 if(MXC_Zipper_IN) { MXC_cBudaiCheckDelay = dwTickCount + 140; } else if(dwTickCount >= MXC_cBudaiCheckDelay) //没布带了 { MXC_SetAlarmCode(MXC_NO_ZIPPER_ALARM); //没拉链 MXC_GouZhen_VAVLE = 0; } } break; case 51: if(!X_DRV) { MXC_cMotorStep = 0; } else if(dwTickCount >= MXC_cAutoDelay) { MXC_SetAlarmCode(MXC_NO_SEBIAO_ALARM); // } //布带对射检测 if(MXC_Zipper_IN) { MXC_cBudaiCheckDelay = dwTickCount + 140; } else if(dwTickCount >= MXC_cBudaiCheckDelay) //没布带了 { MXC_SetAlarmCode(MXC_NO_ZIPPER_ALARM); //没拉链 MXC_GouZhen_VAVLE = 0; } break; } } //下冲 void MXC_NiLongXiuCiJi_XiaC(void) { switch(MXC_cXiaChongStep) { case 0: return; break; case 1: MXC_cXiaChongStep = 2; MXC_XC_SongZhou = 0; //刹车打开 MXC_cXiaChongDelay = dwTickCount + (unsigned long)7; //刹车放开时间 //下止输出 if(bRunning)MXC_Output_XiaCi(); break; case 2: if(dwTickCount >= MXC_cXiaChongDelay) { MXC_cXiaChongStep = 3; MXC_XiaChong_MOTOR = 1; //下冲电机 MXC_cXiaChongDelay = dwTickCount + (unsigned long)ERRORTIME; //下冲最长时间 if(MXC_XiaChongMotorMode == 1) { AxisMoveTwoPos(Y_AXIS,MXC_XiaChongSpeed,2000,MXC_XiaChongLowSpeed,9999999,0); MXC_ChuiQi_VAVLE = 1; } } break; case 3: //碰到右大微动,延时停 if(MXC_XiaChong_IN_UP) { MXC_cXiaChongDelay = dwTickCount + MXC_PARAM_XC_DELAY; MXC_cXiaChongStep = 4; MXC_LeftFenZhen_VAVLE = 0; //退左分针 MXC_RightFenZhen_VAVLE = 0; //退右分针 MXC_cGouZhenTime = dwTickCount + (unsigned long)150; //勾针延时退 MXC_GouZhen_VAVLE = 1; MXC_GuDingGouZhen = 1; } else if(dwTickCount >= MXC_cXiaChongDelay) //自动停机 { MXC_cXiaChongStep = 0; MXC_ShaChe_Output();////刹车 MXC_XiaChong_MOTOR = 0;// //下冲电机 MXC_SetAlarmCode(MXC_XC_ALARM); MXC_LeftFenZhen_VAVLE = 0; //退左分针 MXC_RightFenZhen_VAVLE = 0; //退右分针 AxisEgmStop(Y_AXIS); } break; case 4: if(dwTickCount >= MXC_cXiaChongDelay) { MXC_cXiaChongStep = 5; AxisEgmStop(Y_AXIS); MXC_XiaChong_MOTOR = 0; //延时刹车 MXC_cXiaChongDelay = dwTickCount + MXC_PARAM_SC_DELAY; } break; case 5: if((dwTickCount >= MXC_cXiaChongDelay)) { MXC_cXiaChongStep = 6; MXC_ShaChe_Output(); MXC_cXiaChongDelay = dwTickCount + (unsigned long)30; } break; case 6: if(!MXC_XiaZhi_VAVLE && !MXC_ChaoSheng && (dwTickCount >= MXC_cXiaChongDelay)) { MXC_cXiaChongStep = 0; } break; case 20: // 点动普通下冲动作 MXC_XC_SongZhou = 0; MXC_cXiaChongDelay = dwTickCount + 50; MXC_cXiaChongStep = 21; break; case 21: if((dwTickCount >= MXC_cXiaChongDelay)) { MXC_XiaChong_MOTOR = 1; MXC_cXiaChongDelay = dwTickCount + 50; MXC_cXiaChongStep = 22; } break; case 22: if((dwTickCount >= MXC_cXiaChongDelay)) { MXC_XiaChong_MOTOR = 0; MXC_XC_SongZhou = 1; if(MXC_XiaChongMotorMode) MXC_cXiaChongStep = 0; else { MXC_cXiaChongDelay = dwTickCount + 150; MXC_cXiaChongStep = 23; } } break; case 23: if((dwTickCount >= MXC_cXiaChongDelay)) { MXC_XC_SongZhou = 0; MXC_cXiaChongStep = 0; } break; case 40: // 点动电机下冲动作 MXC_XC_SongZhou = 0; MXC_cXiaChongDelay = dwTickCount + 50; MXC_cXiaChongStep = 41; break; case 41: if(!Y_DRV)AxisMovePos(Y_AXIS,20,10); MXC_cXiaChongStep = 42; break; case 42: if(!Y_DRV) { MXC_cXiaChongStep = 0; } break; } } //启动分针 void MXC_Start_FenZ(void) { } //分针 void MXC_NiLongXiuCiJi_FenZhengProc(void) { if(MXC_FenZSelect != 0) { MXC_cLeftFenZhenStep = 0; MXC_cRightFenZhenStep = 0; } //右分针 switch(MXC_cLeftFenZhenStep) { case 0: break; case 1: if(dwTickCount >= MXC_cFenZhenLeftDelay) { MXC_cLeftFenZhenStep = 2; MXC_RightFenZhen_VAVLE = 1;//cMidleCoil[2] |= Q06;//SETY006; //右分针电磁阀 MXC_cFenZhenLeftDelay = dwTickCount + (unsigned long)FenZhengErrorTime; } break; case 2: //碰到右大微动,延时停 if(!MXC_RightFenZhen_Origin_IN) //右分针原点离开 { MXC_cFenZhenLeftDelay = dwTickCount + 500; MXC_cLeftFenZhenStep = 3; MXC_cFenZhenRightDelay = dwTickCount + (unsigned long)20; }//右分针不下去 else if(dwTickCount >= MXC_cFenZhenLeftDelay) { MXC_SetAlarmCode(MXC_FEN_ZHEN_ALARM); if(MXC_XiaChongMotorMode == 1) { MXC_XiaChong_MOTOR = 0; //下冲电机 } } break; case 3: if(MXC_RighttFenZhen_IN) //插针到位 { MXC_cLeftFenZhenStep = 0; MXC_cRightFenZhenStep = 1; //左分针延时启动 } else if(dwTickCount >= MXC_cFenZhenLeftDelay) { MXC_RightFenZhen_VAVLE = 0;//右分针 cRFengTimer++; //当右分针分不到位时，左分针也要重新分针 MXC_LeftFenZhen_VAVLE = 0; MXC_cRightFenZhenStep = 0; if(cRFengTimer < 4) { MXC_cLeftFenZhenStep = 4; MXC_cFenZhenLeftDelay = dwTickCount + FenZhengErrorTime; } else { MXC_SetAlarmCode(MXC_FEN_ZHEN_ALARM); if(MXC_XiaChongMotorMode == 1) { MXC_XiaChong_MOTOR = 0; //下冲电机 } } } break; case 4: if(MXC_RightFenZhen_Origin_IN) //退到位 { MXC_cLeftFenZhenStep = 5; MXC_cFenZhenLeftDelay = dwTickCount + 150; } else if(dwTickCount >= MXC_cFenZhenLeftDelay) { MXC_SetAlarmCode(MXC_FEN_ZHEN_ALARM); if(MXC_XiaChongMotorMode == 1) { MXC_XiaChong_MOTOR = 0; //下冲电机 } } break; case 5: if(dwTickCount >= MXC_cFenZhenLeftDelay) { MXC_cFenZhenLeftDelay = dwTickCount + 30; MXC_cLeftFenZhenStep = 1; } break; } //左分针 switch(MXC_cRightFenZhenStep) { case 0: break; case 1: if(dwTickCount >= MXC_cFenZhenRightDelay) { MXC_cRightFenZhenStep = 2; MXC_LeftFenZhen_VAVLE = 1; //左分针电磁阀 MXC_cFenZhenRightDelay = dwTickCount + (unsigned long)FenZhengErrorTime; } break; case 2: //碰到右大微动,延时停 if(!MXC_LeftFenZhen_Origin_IN) //右分针原点离开 { MXC_cFenZhenRightDelay = dwTickCount + 500; MXC_cRightFenZhenStep = 3; }//左分针不下去 else if(dwTickCount >= MXC_cFenZhenRightDelay) { MXC_SetAlarmCode(MXC_FEN_ZHEN_ALARM); if(MXC_XiaChongMotorMode == 1) { MXC_XiaChong_MOTOR = 0; //下冲电机 } } break; case 3: if(MXC_LeftFenZhen_IN) //插针到位 MXC_cRightFenZhenStep = 0; else if(dwTickCount >= MXC_cFenZhenRightDelay) { MXC_LeftFenZhen_VAVLE = 0;//左分针 cLFengTimer++; if(cLFengTimer < 6) { MXC_cRightFenZhenStep = 4; MXC_cFenZhenRightDelay = dwTickCount + FenZhengErrorTime; if((cLFengTimer%2) == 0) { MXC_RightFenZhen_VAVLE = 0; MXC_cLeftFenZhenStep = 0; } } else { if(MXC_XiaChongMotorMode == 1) { MXC_XiaChong_MOTOR = 0; //下冲电机 } MXC_SetAlarmCode(MXC_FEN_ZHEN_ALARM); } } break; case 4: if(MXC_LeftFenZhen_Origin_IN) //退到位 { MXC_cRightFenZhenStep = 5; MXC_cFenZhenRightDelay = dwTickCount + 150; } else if(dwTickCount >= MXC_cFenZhenRightDelay) { MXC_SetAlarmCode(MXC_FEN_ZHEN_ALARM); if(MXC_XiaChongMotorMode == 1) { MXC_XiaChong_MOTOR = 0;//下冲电机 } } break; case 5: if(dwTickCount >= 36) { MXC_cFenZhenRightDelay = dwTickCount + 30; if((cLFengTimer%2) == 0) //左边插两次都插不到，就退右边再同时插 { MXC_cFenZhenLeftDelay = dwTickCount + 30; MXC_cLeftFenZhenStep = 1; cRFengTimer = 0; MXC_cRightFenZhenStep = 0; } else { MXC_cRightFenZhenStep = 1; } } break; } } #endif