#include "global.h" #if JU_XING_MACHINE void MXC_NiLongXiuCiJiCheckStart(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; unsigned long cZipperLength[2]; unsigned char cCheckLengthOk=0,cDaoJu_Flag=0; unsigned char STOP_IN_FLAG,STOP_IN_FLAG_OLD,STOP_FILTER; unsigned char MXC_SingOneFlag = 0; unsigned char MXC_KD_Flag = 0,KD_GO_ON_FLAG = 0; long MXC_KD_pos = 0,save_pos_buff = 0; //故障报警 void MXC_SetAlarmCode(unsigned alarm_code) { SetAlarmCode(MXC_ALARM_ADDR,alarm_code); MXC_bAlarmStop = 1; } //高速输入X31/X17外部色标信号中断 void MXC_ExtiActionX31(void) { if(cSeBiaoEn && !cSeBiaoOk) { cSeBiaoOk = 1; cSeBiaoEn = 0; if(X_DRV)SetRemainLength(X_AXIS, MXC_PARAM_SEBIAO_DW_LENGTH,MXC_PARAM_SB_OFFSET_SPEED); } } void MXC_ExtiActionX20(void) { } void MXC_InitAction(void) { float length_buff,pulse_buff; CalFreqTab_X_Free(25); length_buff = MXC_PARAM_DAILUN_LENGTH; pulse_buff = 2000; XGearRatio = pulse_buff/length_buff; MXC_XC_SongZhou = MXC_SERVER_EN; MXC_XIA_ZHI_ENABLE = 0; MXC_TuoDaiSongZhou = MXC_SERVER_DISEN; if(MXC_XIA_ZHI_ENABLE) MXC_XiaZhi_MOTOR = 1; else MXC_XiaZhi_MOTOR = 0; STOP_IN_FLAG = STOP_IN; STOP_IN_FLAG_OLD = STOP_IN_FLAG; } void MXC_NiLongXiuCiJiAction(void) { MXC_NiLongXiuCiJiCheckStart(); //启动 MXC_NiLongXiuCiJi_FenZhengProc(); //左右分针 MXC_NiLongXiuCiJi_XiaC(); //下冲 MXC_ChuiQiProc(); 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); MXC_bSaveWorkData = 1; } //当长度改变时，生产总量自动清零 if(MXC_bChangeLength) { MXC_bChangeLength = 0; MXC_bClear = 1; } //加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(!MXC_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(!MXC_bRunning) { MXC_GOU_ZHEN_MODE++; if(MXC_GOU_ZHEN_MODE > 1)MXC_GOU_ZHEN_MODE = 0; } } //下止工作选择)　 if(MXC_bChangeXiaZhiMode) { MXC_bChangeXiaZhiMode = 0; if(!MXC_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_bChuiQi) { MXC_bChuiQi = 0; if(MXC_cChuiQiStep == 0)MXC_cChuiQiStep = 1; } if((MXC_bRunning) == 0) ////手动 { if(MXC_ManXiaChong_UP || MXC_bXiaChong) { MXC_bXiaChong = 0; if(MXC_cXiaChongStep == 0)MXC_cXiaChongStep = 1; } if(MXC_cXiaChongStep == 0) { if(MXC_bLeftFenZhen) { MXC_bLeftFenZhen = 0; MXC_LeftFenZhen_VAVLE = ~MXC_LeftFenZhen_VAVLE; } if(MXC_bRightFenZhen) { MXC_bRightFenZhen = 0; MXC_RightFenZhen_VAVLE= ~MXC_RightFenZhen_VAVLE; } //点动下冲 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 + 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(MXC_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) { DISPLAY_DATA0 = MXC_cAutoStep; DISPLAY_DATA1 = MXC_cMotorStep; DISPLAY_DATA2 = MXC_cLeftFenZhenStep; DISPLAY_DATA3 = MXC_cRightFenZhenStep; DISPLAY_DATA4 = MXC_cXiaChongStep; DISPLAY_DATA5 = dwRealPos; if(MXC_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(dwTickCount >= MXC_cAutoDelay) { if(MXC_TuoDaiSongZhou == MXC_SERVER_DISEN) { MXC_TuoDaiSongZhou = MXC_SERVER_EN; MXC_cAutoDelay = dwTickCount + 200; //先锁轴 } else MXC_cAutoDelay = dwTickCount; MXC_cAutoStep = 2; } break; case 2: //左右分针要退到位，过链到位要离开 if(!MXC_GouZhen_IN && MXC_LeftFenZhen_Origin_IN && MXC_RightFenZhen_Origin_IN && !MXC_LeftFenZhen_IN && !MXC_RighttFenZhen_IN && (dwTickCount >= MXC_cAutoDelay)) { MXC_cAutoStep = 3; MXC_cMotorStep = 1; //启动拖带 } break; case 3: //拖带已经完成 if(MXC_cMotorStep == 0) { if(SingOneFlg) { dwZipCnt = 0; SingOneFlg = 0; MXC_cAutoStep = 0; MXC_bRunning = 0; } else { MXC_cAutoStep = 4; } } break; case 4: MXC_cAutoStep = 5; break; case 5: //左右分针都已完成 if((MXC_cLeftFenZhenStep == 0) && (MXC_cRightFenZhenStep == 0)) { MXC_cXiaChongStep = 1; //下冲电机启动 MXC_cAutoStep = 6; } break; case 6: //下冲已完成 if(MXC_cXiaChongStep == 0) { dwZipCnt++; AddToTal(MXC_TOTAL_ADDR); //计数增加和保存 CalProSP(MXC_PROSPEED_ADDR); MXC_cAutoStep = 7; } break; case 7: 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 = 8; } break; case 8: MXC_cAutoDelay = dwTickCount + MXC_PARAM_MOTOR_DELAY; if(MXC_SingOneFlag) { dwZipCnt = 0; MXC_SingOneFlag = 0; MXC_cAutoStep = 0; MXC_bRunning = 0; } MXC_cAutoStep = 1; break; } } } // 检测是否踏了脚踏开关 void MXC_NiLongXiuCiJiCheckStart(void) { // 停止键 不能在工作,手动,停止过程中 if((MXC_bRunning == 0) && (START_IN_UP || MXC_bStart || MXC_bNext)) { if(!MXC_LeftFenZhen_Origin_IN)MXC_SetAlarmCode(MXC_START_LFZ_ORIGIN_ALARM); //没拉链 else if(GetTotal(MXC_TOTAL_ADDR) >= MXC_SET_TOTAL)MXC_SetAlarmCode(MXC_TOTAL_ALARM); else if(!MXC_RightFenZhen_Origin_IN)MXC_SetAlarmCode(MXC_START_RFZ_ORIGIN_ALARM); else if(!MXC_Zipper_IN)MXC_SetAlarmCode(MXC_START_NO_ZIPPER_ALARM); else if((MXC_PARAM_SEBIAO_DW_LENGTH > MXC_SET_ZIPPER_LENGTH) && (MXC_DC_MODE==2))MXC_SetAlarmCode(MXC_SEBIAO_ZIPPER_LENGTH_ALARM); else if(MXC_KaDai_IN)MXC_SetAlarmCode(MXC_KA_DAI_ALARM); else { if(MXC_bNext) { SingOneFlg = 1; MXC_bNext = 0; } MXC_bRunning = 1; MXC_cAutoStep = 1; cGouZhenTime = 1; cCheckLengthOk = 0; cZipperLength[0] = 0; cZipperLength[1] = 0; dwZipCnt = 0; } MXC_bStart = 0; } //卡带感应 if(MXC_KaDai_IN && (dwTickCount >= MXC_cKaDaiDelay)) { if(MXC_DC_MODE == 1) { if(X_DRV && MXC_bRunning && (MXC_cMotorStep == 20)) { MXC_KD_Flag = 1; KD_GO_ON_FLAG = 1; } } MXC_SetAlarmCode(MXC_KA_DAI_ALARM); MXC_cKaDaiDelay = dwTickCount + 2200; } if(MXC_KD_Flag) { if(!X_DRV) { MXC_KD_pos = dwRealPos - save_pos_buff; MXC_KD_Flag = 0; } } if(MXC_KaDai_IN_UP) { if(MXC_cChuiQiStep == 0)MXC_cChuiQiStep = 1; } //停止 STOP_IN_FLAG_OLD = STOP_IN_FLAG; if(STOP_IN) { if(STOP_FILTER < 50) { STOP_FILTER++; } else STOP_IN_FLAG = 1; } else if(STOP_FILTER > 25) { STOP_FILTER--; } else STOP_IN_FLAG = 0; if(MXC_bStop) { MXC_bStop = 0; if(MXC_bRunning)MXC_SingOneFlag = 1; } if(((STOP_IN_FLAG && !STOP_IN_FLAG_OLD))) { MXC_bStop = 0; if(MXC_bRunning) { if(MXC_cXiaChongStep==0) { if(MXC_cChuiQiStep == 0)MXC_cChuiQiStep = 1; if(!MXC_XiaChong_MOTOR)MXC_XC_SongZhou = MXC_SERVER_DISEN; } MXC_bRunning = 0; cStopFlag = 0; MXC_cAutoStep = 0; MXC_cMotorStep = 0; MXC_cDCPStep = 0; AxisDecStop(X_AXIS); MXC_cJiaoDaoStep = 0; SingOneFlg = 0; MXC_SingOneFlag = 0; MXC_KD_Flag = 0; KD_GO_ON_FLAG = 0; } else { MXC_bRunning = 0; cStopFlag = 0; MXC_cAutoStep = 0; MXC_cMotorStep = 0; MXC_cXiaChongStep = 0; MXC_cLeftFenZhenStep = 0; MXC_cRightFenZhenStep = 0; MXC_cJiaoDaoStep = 0; MXC_cDCPStep = 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; SingOneFlg = 0; MXC_SingOneFlag = 0; MXC_KD_Flag = 0; KD_GO_ON_FLAG = 0; if(MXC_XiaChongMotorMode) MXC_XC_SongZhou = MXC_SERVER_DISEN; else MXC_XC_ShaChe = MXC_SC_DISEN; if((MXC_cChuiQiStep == 0) &&(MXC_cXiaChongStep==0))MXC_cChuiQiStep = 1; AxisDecStop(X_AXIS); SetAlarmCode(MXC_ALARM_ADDR,MXC_NO_ALARM); } } if(!MXC_bRunning && (MXC_cMotorStep==0) && (MXC_cXiaChongStep == 0)) { if(!X_DRV)MXC_TuoDaiSongZhou = MXC_SERVER_DISEN; } if(MXC_bAlarmStop) { MXC_bAlarmStop = 0; MXC_bRunning = 0; MXC_cAutoStep = 0; MXC_cMotorStep = 0; MXC_cLeftFenZhenStep = 0; MXC_cRightFenZhenStep = 0; MXC_cDCPStep = 0; MXC_LeftFenZhen_VAVLE = 0; MXC_RightFenZhen_VAVLE = 0; MXC_SingOneFlag = 0; AxisDecStop(X_AXIS); if((GetAlarmCode(MXC_ALARM_ADDR) == MXC_XIA_CHONG_ALARM) || (GetAlarmCode(MXC_ALARM_ADDR) == MXC_XC_ALARM) || (GetAlarmCode(MXC_ALARM_ADDR) == MXC_FEN_ZHEN_ALARM)) { MXC_cXiaChongStep = 0; MXC_XiaChong_MOTOR = 0; } } } 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_ChuiQiProc(void) { //吹气 if(MXC_XiaChong_IN_UP) { if(MXC_cChuiQiStep == 0)MXC_cChuiQiStep = 1; } switch (MXC_cDCPStep) { case 0: break; case 1: MXC_cDCPStep = 2; MXC_cDaoJuCheckDelay = dwTickCount + ERRORTIME; break; case 2: if(MXC_DingChuPian_IN_DW) { MXC_cDCPStep = 0; } else if(dwTickCount >= MXC_cDaoJuCheckDelay)MXC_SetAlarmCode(MXC_DAO_JU_ALARM); break; } switch(MXC_cChuiQiStep) { case 1: MXC_cChuiQiStep = 2; if(MXC_bRunning)MXC_cChuiQiDelay = dwTickCount+MXC_PARAM_DELAY_CHUIQI_TIME; break; case 2: if(dwTickCount >= MXC_cChuiQiDelay) { MXC_cChuiQiDelay = dwTickCount + MXC_PARAM_CHUIQI_TIME; MXC_ChuiQi_VAVLE = 1;// MXC_cDCPStep = 1; MXC_cChuiQiStep = 3; } break; case 3: if(dwTickCount >= MXC_cChuiQiDelay) { MXC_ChuiQi_VAVLE = 0;// MXC_cChuiQiStep = 0; } break; } } void MXC_ShaChe_Output(void) { //启动吹气 cShaCheTime = dwTickCount + (unsigned long)120; if(MXC_XiaChongMotorMode == 0)MXC_XC_SongZhou = MXC_SERVER_EN; } 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(MXC_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 char ComPareLength(void) { if((cZipperLength[0] != 0) && (cZipperLength[1] != 0)) { if(cZipperLength[0] > cZipperLength[1]) { if((cZipperLength[0] - cZipperLength[1]) > 200) { return 0; } else return 1; } else { if((cZipperLength[1] - cZipperLength[0]) > 200) { return 0; } else return 1; } } else return 0; } void MXC_NiLongXiuCiJi_Motor(void) { static long save_buff,gou_zhen_buff,zipper_length_buff; static unsigned long zipper_length; short *revise_buff; DISPLAY_DATA6 = zipper_length; if(MXC_bRunning) { if(MXC_Zipper_IN) { MXC_cBudaiCheckDelay = dwTickCount + MXC_PARAM_MOTOR_ALARM_TIME; } else if(dwTickCount >= MXC_cBudaiCheckDelay) //没布带了 { MXC_SetAlarmCode(MXC_NO_ZIPPER_ALARM); //没拉链 } } 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)) { save_buff = dwRealPos; revise_buff = &user_datas[17]; save_pos_buff = dwRealPos; if(MXC_DC_MODE == 0) //钩针定寸 { if(MXC_DEC_MODE) //数控模式 { if(MXC_PARAM_AUTO_CHECK_MODE) { if(cCheckLengthOk) { MoveAction_Const_AccDec(X_AXIS,MXC_DIR_P,MXC_PARAM_SET_SPEED,1,5,1); } else { if(cCheckLengthOk == 0) { cZipperLength[0] = cZipperLength[1]; cZipperLength[1] = zipper_length_buff - dwRealPos; zipper_length_buff = dwRealPos; if(ComPareLength()) { cCheckLengthOk = 1; } } if(cCheckLengthOk)zipper_length = cZipperLength[1] + (*revise_buff); MoveAction_Const_AccDec(X_AXIS,MXC_DIR_P,MXC_PARAM_FIRST_SPEED,1,5,1); } } else { zipper_length = MXC_SET_ZIPPER_LENGTH + (*revise_buff) + MXC_PARAM_DAOKOU_LENGTH; if(dwZipCnt==0) MoveAction_Const_AccDec(X_AXIS,MXC_DIR_P,MXC_PARAM_FIRST_SPEED,1,5,1); else MoveAction_Const_AccDec(X_AXIS,MXC_DIR_P,MXC_PARAM_SET_SPEED,1,5,1); } } else // 感应方式 { AxisContinueMove(X_AXIS,MXC_PARAM_SET_SPEED,MXC_DIR_P); } MXC_cMotorStep = 2; } else if(MXC_DC_MODE == 1) //电机定寸 { if(KD_GO_ON_FLAG) { if(MXC_KD_pos > (MXC_SET_ZIPPER_LENGTH + (*revise_buff) + MXC_PARAM_DAOKOU_LENGTH)) zipper_length = MXC_SET_ZIPPER_LENGTH + (*revise_buff) + MXC_PARAM_DAOKOU_LENGTH; else zipper_length = MXC_SET_ZIPPER_LENGTH + (*revise_buff) + MXC_PARAM_DAOKOU_LENGTH - MXC_KD_pos; KD_GO_ON_FLAG = 0; } else zipper_length = MXC_SET_ZIPPER_LENGTH + (*revise_buff) + MXC_PARAM_DAOKOU_LENGTH; MXC_cMotorStep = 20; MXC_GouZhen_VAVLE = 1; //定位(活动勾针)电磁阀 MXC_GuDingGouZhen = 1; //定位(活动勾针)电磁阀 AxisMovePosAccDec(X_AXIS,MXC_PARAM_SET_SPEED,zipper_length,1,5,1); } else //色标定寸 { zipper_length = MXC_SET_ZIPPER_LENGTH + (*revise_buff); if((dwZipCnt==0)||SingOneFlg)MoveAction_Const_AccDec(X_AXIS,MXC_DIR_P,MXC_PARAM_SB_LOW_SPEED,1,5,1); else MoveAction_Const_AccDec(X_AXIS,MXC_DIR_P,MXC_PARAM_SB_HIGH_SPEED,1,5,1); cSeBiaoOk = 0; cSeBiaoEn = 0; MXC_cMotorStep = 50; } MXC_cGouZhenTime = dwTickCount + MXC_PARAM_GZ_DELAY; MXC_cMotorDelay = dwTickCount + MXC_MOTOR_ALALRM_TIME; } break; // step2-5 活动勾针定寸 case 2: if((dwTickCount >= MXC_cGouZhenTime)&&(MXC_PARAM_GZ_RESET_MODE==0))MXC_GouZhen_VAVLE = 0; if(MXC_DEC_MODE) // 数控方式 { if(MXC_PARAM_AUTO_CHECK_MODE) { if(cCheckLengthOk) { if(((save_buff - dwRealPos) >= (zipper_length - MXC_PARAM_GZ_LENGTH))&&MXC_PARAM_GZ_RESET_MODE)MXC_GouZhen_VAVLE = 0; if((save_buff - dwRealPos) >= (zipper_length - MXC_PARAM_LOWSPEED_LENGTH)) { AxisChangeSpeed(X_AXIS,MXC_PARAM_LOW_SPEED); MXC_cMotorStep = 3; } } else { if(MXC_GouZhen_IN) { MXC_GouZhen_VAVLE = 0; MXC_cMotorStep = 4; AxisEgmStop(X_AXIS); } else { if(dwTickCount >= MXC_cGouZhenTime)MXC_GouZhen_VAVLE = 0; MXC_cMotorStep = 3; } } } else { if(dwZipCnt==0) { if(MXC_GouZhen_IN) { MXC_GouZhen_VAVLE = 0; MXC_cMotorStep = 4; AxisEgmStop(X_AXIS); } else { if(dwTickCount >= MXC_cGouZhenTime)MXC_GouZhen_VAVLE = 0; MXC_cMotorStep = 3; } } else { if(((save_buff - dwRealPos) >= (zipper_length - MXC_PARAM_GZ_LENGTH))&&MXC_PARAM_GZ_RESET_MODE)MXC_GouZhen_VAVLE = 0; if((save_buff -dwRealPos) >= (zipper_length - MXC_PARAM_LOWSPEED_LENGTH)) { AxisChangeSpeed(X_AXIS,MXC_PARAM_LOW_SPEED); MXC_cMotorStep = 3; } } } } else // 感应方式 { if(MXC_Dec_IN_DW) { AxisChangeSpeed(X_AXIS,MXC_PARAM_LOW_SPEED); MXC_cGouZhenTime = dwTickCount + MXC_PARAM_GZ_DELAY; MXC_cMotorStep = 3; } } if(dwTickCount >= MXC_cMotorDelay)MXC_SetAlarmCode(MXC_LONG_TIME_NO_ZIPPER_ALARM); break; case 3: if((dwTickCount >= MXC_cGouZhenTime)&&(MXC_PARAM_GZ_RESET_MODE==0))MXC_GouZhen_VAVLE = 0; if(MXC_DEC_MODE) // 数控方式 { if(MXC_PARAM_AUTO_CHECK_MODE) { if(((save_buff - dwRealPos) >= (zipper_length - MXC_PARAM_GZ_LENGTH))&&MXC_PARAM_GZ_RESET_MODE &&cCheckLengthOk)MXC_GouZhen_VAVLE = 0; } else { if(((save_buff - dwRealPos) >= (zipper_length - MXC_PARAM_GZ_LENGTH))&&MXC_PARAM_GZ_RESET_MODE)MXC_GouZhen_VAVLE = 0; } if(MXC_GouZhen_IN) { MXC_GouZhen_VAVLE = 0; MXC_cMotorStep = 4; AxisEgmStop(X_AXIS); } } else // 感应方式 { MXC_cMotorStep = 4; } if(dwTickCount >= MXC_cMotorDelay)MXC_SetAlarmCode(MXC_LONG_TIME_NO_ZIPPER_ALARM); break; case 4: if((dwTickCount >= MXC_cGouZhenTime)&&(MXC_PARAM_GZ_RESET_MODE==0))MXC_GouZhen_VAVLE = 0; if(MXC_DEC_MODE) // 数控方式 { if(!X_DRV) { MXC_cMotorStep = 0; } } else // 感应方式 { if(MXC_GouZhen_IN) { MXC_cMotorStep = 5; AxisEgmStop(X_AXIS); } } if(dwTickCount >= MXC_cMotorDelay)MXC_SetAlarmCode(MXC_LONG_TIME_NO_ZIPPER_ALARM); break; case 5: if(MXC_DEC_MODE) // 数控方式 { } else // 感应方式 { if(!X_DRV) { MXC_cMotorStep = 0; } } if(dwTickCount >= MXC_cMotorDelay)MXC_SetAlarmCode(MXC_LONG_TIME_NO_ZIPPER_ALARM); 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; } } } } break; //伺服定寸 case 20: if(!X_DRV)MXC_cMotorStep = 0; else if(dwTickCount >= MXC_cMotorDelay)MXC_SetAlarmCode(MXC_LONG_TIME_NO_ZIPPER_ALARM); break; case 50: if(dwZipCnt==0) { cSeBiaoOk = 0; cSeBiaoEn = 1; MXC_cMotorStep = 51; } else { if((save_buff - dwRealPos + MXC_PARAM_LOWSPEED_LENGTH) >= (zipper_length -MXC_PARAM_SEBIAO_DW_LENGTH)) AxisChangeSpeed(X_AXIS,MXC_PARAM_LOW_SPEED); if((save_buff - dwRealPos + MXC_PARAM_SEBIAO_TQ_LENGTH) >= (zipper_length - MXC_PARAM_SEBIAO_DW_LENGTH)) { cSeBiaoOk = 0; cSeBiaoEn = 1; MXC_cMotorStep = 51; } else if((dwRealPos - save_buff) > (zipper_length + MXC_ERROR_LENGTH))MXC_SetAlarmCode(MXC_NO_SEBIAO_ALARM); } break; case 51: if(dwZipCnt!=0) { if((save_buff - dwRealPos) >= (zipper_length - MXC_PARAM_LOWSPEED_LENGTH)) AxisChangeSpeed(X_AXIS,MXC_PARAM_LOW_SPEED); if((save_buff - dwRealPos) > (zipper_length + MXC_ERROR_LENGTH))MXC_SetAlarmCode(MXC_NO_SEBIAO_ALARM); } if(!X_DRV) { if(dwZipCnt!=0) { if((save_buff - dwRealPos) < (zipper_length - MXC_ERROR_LENGTH))MXC_SetAlarmCode(MXC_NO_SEBIAO_ALARM); } MXC_cMotorStep = 0; } else if(dwTickCount >= MXC_cMotorDelay)MXC_SetAlarmCode(MXC_NO_SEBIAO_ALARM); break; } } //下冲 void MXC_NiLongXiuCiJi_XiaC(void) { switch(MXC_cXiaChongStep) { case 0: return; break; case 1: { MXC_cRightFenZhenStep = 1; MXC_cLeftFenZhenStep = 0; cRFengTimer = 0; cLFengTimer = 0; } MXC_cXiaChongStep = 2; break; case 2: if((MXC_cRightFenZhenStep==0) && (MXC_cLeftFenZhenStep==0)) { if(MXC_XiaChongMotorMode) MXC_XC_SongZhou = MXC_SERVER_DISEN; else MXC_XC_ShaChe = MXC_SC_DISEN; MXC_XC_SongZhou = MXC_SERVER_EN; //刹车打开 if(MXC_bRunning)MXC_cXiaChongDelay = dwTickCount + MXC_PARAM_DELAY_XC; MXC_cXiaChongStep = 3; } break; case 3: if(dwTickCount >= MXC_cXiaChongDelay) { MXC_cXiaChongStep = 4; MXC_XiaChong_MOTOR = 1; //下冲电机 MXC_cXiaChongDelay = dwTickCount + (unsigned long)ERRORTIME; //下冲最长时间 if(MXC_XiaChongMotorMode == 1) { AxisMoveTwoPos(Y_AXIS,MXC_XiaChongSpeed,2000,MXC_XiaChongLowSpeed,9999999,0); } } break; case 4: //碰到右大微动,延时停 if(MXC_XiaChong_IN_UP) { MXC_cXiaChongDelay = dwTickCount + MXC_PARAM_XC_DELAY; MXC_cXiaChongStep = 5; MXC_LeftFenZhen_VAVLE = 0; //退左分针 MXC_RightFenZhen_VAVLE = 0; //退右分针 MXC_GouZhen_VAVLE = 1; MXC_cGouZhenTime = dwTickCount + 300; } 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 5: if(dwTickCount >= MXC_cXiaChongDelay) { AxisEgmStop(Y_AXIS); MXC_XiaChong_MOTOR = 0; //延时刹车 if(MXC_PARAM_SC_MODE) { MXC_cXiaChongStep = 0; } else { MXC_cXiaChongStep = 6; } // MXC_cXiaChongDelay = dwTickCount + MXC_PARAM_SC_DELAY; } break; case 6: // if((dwTickCount >= MXC_cXiaChongDelay)) { MXC_cXiaChongStep = 7; MXC_cXiaChongDelay = dwTickCount + MXC_PARAM_SC_DELAY; // MXC_ShaChe_Output(); } break; case 7: if((dwTickCount >= MXC_cXiaChongDelay)) { MXC_cXiaChongStep = 0; MXC_cXiaChongDelay = dwTickCount; MXC_XC_SongZhou = MXC_SERVER_DISEN; } break; case 20: // 点动普通下冲动作 MXC_XC_SongZhou = MXC_SERVER_EN; 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 = MXC_SERVER_EN; if(MXC_XiaChongMotorMode) MXC_cXiaChongStep = 0; else { MXC_cXiaChongDelay = dwTickCount + 150; MXC_cXiaChongStep = 23; } } break; case 23: if((dwTickCount >= MXC_cXiaChongDelay)) { MXC_XC_SongZhou = MXC_SERVER_DISEN; MXC_cXiaChongStep = 0; } break; case 40: // 点动电机下冲动作 MXC_XC_SongZhou = MXC_SERVER_EN; 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_NiLongXiuCiJi_FenZhengProc(void) { if(MXC_FenZSelect==0) { MXC_cLeftFenZhenStep = 0; MXC_cRightFenZhenStep = 0; } //右分针 switch(MXC_cRightFenZhenStep) { case 0: break; case 1: MXC_cFenZhenRightDelay = MXC_PARAM_R_FZ_DELAY+dwTickCount; MXC_cRightFenZhenStep = 2; break; case 2: if(dwTickCount >= MXC_cFenZhenRightDelay) { MXC_cRightFenZhenStep = 3; MXC_RightFenZhen_VAVLE = 1;//右分针电磁阀 MXC_cFenZhenRightDelay = dwTickCount + FenZhengErrorTime; } break; case 3: //碰到右大微动,延时停 if(!MXC_RightFenZhen_Origin_IN) //右分针原点离开 { MXC_cFenZhenRightDelay = dwTickCount + FenZhengErrorTime; MXC_cRightFenZhenStep = 4; }//右分针不下去 else if(dwTickCount >= MXC_cFenZhenRightDelay) { MXC_SetAlarmCode(MXC_FEN_ZHEN_ALARM); } break; case 4: if(MXC_RighttFenZhen_IN) //插针到位 { MXC_cRightFenZhenStep = 0; MXC_cLeftFenZhenStep = 1; //左分针延时启动 } else if(dwTickCount >= MXC_cFenZhenRightDelay) { MXC_RightFenZhen_VAVLE = 0;//右分针 cRFengTimer++; //当右分针分不到位时，左分针也要重新分针 MXC_LeftFenZhen_VAVLE = 0; MXC_cRightFenZhenStep = 0; if(cRFengTimer < 4) { MXC_cRightFenZhenStep = 5; MXC_cFenZhenRightDelay = dwTickCount + FenZhengErrorTime; } else { MXC_SetAlarmCode(MXC_FEN_ZHEN_ALARM); } } break; case 5: if(MXC_RightFenZhen_Origin_IN) //退到位 { MXC_cRightFenZhenStep = 6; } else if(dwTickCount >= MXC_cFenZhenRightDelay) { MXC_SetAlarmCode(MXC_FEN_ZHEN_ALARM); } break; case 6: { MXC_cRightFenZhenStep = 1; } break; } //左分针 switch(MXC_cLeftFenZhenStep) { case 0: break; case 1: MXC_cFenZhenLeftDelay = MXC_PARAM_L_FZ_DELAY+dwTickCount; MXC_cLeftFenZhenStep = 2; break; case 2: if(dwTickCount >= MXC_cFenZhenLeftDelay) { MXC_cLeftFenZhenStep = 3; MXC_LeftFenZhen_VAVLE = 1; //左分针电磁阀 MXC_cFenZhenLeftDelay = dwTickCount + FenZhengErrorTime; } break; case 3: //离开左分针原点 if(!MXC_LeftFenZhen_Origin_IN) //左分针原点离开 { MXC_cFenZhenLeftDelay = dwTickCount + FenZhengErrorTime; MXC_cLeftFenZhenStep = 4; }//左分针不下去 else if(dwTickCount >= MXC_cFenZhenLeftDelay) { MXC_SetAlarmCode(MXC_FEN_ZHEN_ALARM); } break; case 4: if(MXC_LeftFenZhen_IN) //插针到位 MXC_cLeftFenZhenStep = 0; else if(dwTickCount >= MXC_cFenZhenLeftDelay) { MXC_LeftFenZhen_VAVLE = 0;//左分针 cLFengTimer++; if(cLFengTimer < 6) { MXC_cLeftFenZhenStep = 5; MXC_cFenZhenLeftDelay = dwTickCount + FenZhengErrorTime; if((cLFengTimer%2) == 0) { MXC_RightFenZhen_VAVLE = 0; MXC_cRightFenZhenStep = 0; } } else { MXC_SetAlarmCode(MXC_FEN_ZHEN_ALARM); } } break; case 5: if(MXC_LeftFenZhen_Origin_IN) //退到位 { MXC_cLeftFenZhenStep = 6; } else if(dwTickCount >= MXC_cFenZhenLeftDelay) { MXC_SetAlarmCode(MXC_FEN_ZHEN_ALARM); } break; case 6: if((cLFengTimer%2) == 0) //左边插两次都插不到，就退右边再同时插 { MXC_cRightFenZhenStep = 1; cRFengTimer = 0; MXC_cLeftFenZhenStep = 0; } else { MXC_cLeftFenZhenStep = 1; } break; } } #endif