1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954 |
- #include "global.h"
- #if JU_XING_MACHINE ==1
- void SK_QueDuan_AlarmProtect(void);
- void SK_QueDuan_ManualAction(void);
- void SK_QueDuan_AutoAction(void);
- void SK_QueDuan_StepCheckStart(void);
- void SK_QueDuan_XiaQue(void);
- void SK_QueDuan_Motor(void);
- void SK_QueDuan_YuanDianAction(void);
- void SK_QueDuan_TuiLianAction(void);
- void SK_QueDuan_ExtiActionX31(void);
- void SK_QueDuan_BingLian(void);
- void SKQD_StopCode(void);
- void SKQD_TuiDaiAction(void);
- short *SKQD_length_buffer;
- void SKQD_SetAlarmCode(unsigned alarm_code)
- {
- SetAlarmCode(SKQD_ALARM_ADDR,alarm_code);
- bAlarmStop = 1;
- }
- void SK_QueDuan_ExtiActionX31(void)
- {
- cCheckLianFlg = 1;
- SKQD_cRealPos = GetPos(X_AXIS);
- }
- void SKQD_StopCode(void)
- {
- switch(SKQD_StopStep)
- {
- case 1:
- SKQD_StopStep=2;
- if(X_DRV)
- {
- AxisChangeSpeedDirect(X_AXIS,GetCurSpeed(X_AXIS) * 2/3);
- AxisDecStop(X_AXIS);
- }
- break;
- case 2:
- if(!X_DRV || (SKQD_cRealPos < 10))
- {
- SKQD_StopCodeDelay=dwTickCount+350;
- SKQD_StopStep = 3;
- }
- break;
- case 3:
- if(dwTickCount >= SKQD_StopCodeDelay)
- {
- if(!cSTOPONE)
- {
- SKQD_StopStep=0;
-
- }
- else
- {
- SKQD_SetAlarmCode(SKQD_PARAM_ANQUANMEN_ALARM);
- SKQD_StopStep=0;
- cSTOPONE=0;
- }
- SKQD_SZ_OUT = 1; //电机松轴
- }
- break;
- }
- switch(SKQD_CHUIQIStep)
- {
- case 1:
- SKQD_CQ_VAVLE=1;
- SKQD_CHUIQIStep=2;
- SKQD_ChuiQiDelay=dwTickCount+SKQD_PARAM_ChuiQi_TIME;
- break;
- case 2:
- if(dwTickCount >= SKQD_ChuiQiDelay)
- {
- SKQD_CQ_VAVLE=0;
- SKQD_CHUIQIStep=0;
- }
- break;
-
- }
- }
- void SK_QueDuan_InitAction(void)
- {
- float length_buff,pulse_buff;
- axis_x->speed_unit = 1; //速度频率倍率单位
- length_buff = SKQD_PARAM_CYCLE_LENGTH;
- pulse_buff = SKQD_PARAM_CYCLE_PULSE;
- XGearRatio = pulse_buff/length_buff;
- // SKQD_SZ_OUT = 1;
- // Motor_SZ(SKQD_MOTOR_DIS); //电机松轴
- SKQD_SetAlarmCode(0);
- SetDirReverse(X_AXIS, 1);
- }
- void SK_QueDuan_Action(void)
- {
-
- SK_QueDuan_AlarmProtect();
- SK_QueDuan_Motor();
- SK_QueDuan_XiaQue();
- SK_QueDuan_ManualAction();
- SK_QueDuan_TuiLianAction();
- SK_QueDuan_BingLian();
- SKQD_StopCode();
- SK_QueDuan_AutoAction();
- SK_QueDuan_StepCheckStart(); // 调用脚踏开关检测程序
-
-
- }
- //手动动作
- void SK_QueDuan_ManualAction(void)
- {
- //条数或扎数达到后,台面电机转两秒之后再停机
- if(cTABLETIME)
- {
- if(cTABLETOTAL)
- {
- cTABLETOTAL=0;
- SKQD_TABLE_VAVLE = 1;
- SKQD_TableDelay=dwTickCount + 2000;
-
- }
- if(dwTickCount >= SKQD_TableDelay)
- {
- SKQD_TABLE_VAVLE = 0;
- cTABLETIME=0;
-
- }
- }
- if(SKQD_HOUXIANWEI_UP && bRunning)
- {
- AxisEgmStop(X_AXIS);
- SKQD_SetAlarmCode(SKQD_PARAM_RUN_LENGTH_ALARM);
- }
- if(bRunning == 0)
- {
-
-
-
- cGoLimitEn = 0;
- if(SKQD_bClearTotal) //切断计数清零
- {
- SKQD_bClearTotal = 0;
- ClrcToTal(SKQD_TOTAL_ADDR);
- }
-
- if(SKQD_bClearNowTotal)
- {
- SKQD_bClearNowTotal = 0;
- SKQD_PARAM_NOW_CNT = 0;
- }
-
- if(SKQD_bXiaQie)
- {
- SKQD_bXiaQie = 0;
- if((SKQD_XiaQieStep == 0) && !SKQD_TL_VAVLE)
- {
- SKQD_XiaQieStep = 1;
- }
- }
-
- if(SKQD_bQianDianDW)
- {
- SKQD_bQianDianDW = 0;
- if(SKQD_MotorStep == 0)
- {
- SKQD_MotorStep = 61;
- cZipCnt = 0;
- }
- }
-
- if(SKQD_bTL)
- {
- SKQD_bTL = 0;
- if(SKQD_TL_VAVLE)
- {
- SKQD_TL_VAVLE = 0;
- }
- else if(!SKQD_GZ_VAVLE && !SKQD_SM_VAVLE)
- {
- SKQD_TL_VAVLE = ~SKQD_TL_VAVLE;
- }
- }
-
-
-
- if(SKQD_bYD)
- {
- SKQD_bYD = 0;
- SKQD_YD_VAVLE = ~SKQD_YD_VAVLE;
- }
- if(SKQD_bHuLian)
- {
- SKQD_bHuLian=0;
- SKQD_HULIAN_VAVLE = ~SKQD_HULIAN_VAVLE;
- }
-
- if(SKQD_bGZ)
- {
- SKQD_bGZ = 0;
- // SKQD_GZ_VAVLE = ~SKQD_GZ_VAVLE;
-
- }
- if(SKQD_bYD_ONE)
- {
- SKQD_bYD_ONE = 0;
- SKQD_YD_ONE_VAVLE = ~SKQD_YD_ONE_VAVLE;
- }
- if(SKQD_bJD)
- {
- SKQD_bJD = 0;
- SKQD_JD_VAVLE = ~SKQD_JD_VAVLE;
- }
-
- if(SKQD_bXM)
- {
- SKQD_bXM = 0;
- SKQD_XM_VAVLE = ~SKQD_XM_VAVLE;
- if(!SKQD_XM_VAVLE)SKQD_GZ_VAVLE = 0;
- }
- if(SKQD_GOUZHEN_IN_DW)
- {
- SKQD_YD_VAVLE=1;
- }
-
- if(SKQD_bSM)
- {
- SKQD_bSM = 0;
- if(SKQD_SM_VAVLE)
- SKQD_SM_VAVLE = 0;
- else if(!SKQD_TL_VAVLE)
- SKQD_SM_VAVLE = 1;
- }
-
- //台面电机
- if(SKQD_bTB)
- {
- SKQD_bTB = 0;
- SKQD_TABLE_VAVLE = ~SKQD_TABLE_VAVLE;
- }
- if(SKQD_bTestCS)
- {
- SKQD_bTestCS = 0;
- SKQD_CS_OUT = 1;
- SKQD_CSDelay = dwTickCount + SKQD_PARAM_CS_TIME;
- }
-
- if(SKQD_bBL)//吹气
- {
- SKQD_bBL = 0;
- SKQD_BL_VAVLE = ~SKQD_BL_VAVLE;
- }
-
- if(SKQD_bHL) //护链,双开用
- {
- SKQD_bHL = 0;
- SKQD_HL_VAVLE = ~SKQD_HL_VAVLE;
- }
-
- if(SKQD_bYX)
- {
- SKQD_bYX = 0;
- SKQD_YX_VAVLE = ~SKQD_YX_VAVLE;
- }
- if(SKQD_XiaQieStep == 0)
- {
- if(dwTickCount >= SKQD_CSDelay)SKQD_CS_OUT = 0;
- }
- //电机控制
- if(SKQD_QIAN_LIMIT_IN && SKQD_bGoMotor)
- {
- AxisEgmStop(X_AXIS);
- }
- if(SKQD_bGoMotor && !SKQD_QIAN_LIMIT_IN)
- {
- SKQD_SZ_OUT = 0;
- // SKQD_JZ_DIR = SKQD_YDIR_N;
-
- if(!X_DRV)
- AxisContinueMoveAcc(X_AXIS,SKQD_PARAM_GO_LOW_SPEED,SKQD_DIR_N,SKQD_PARAM_GO_LOW_SPEED,SKQD_PARAM_GO_LOW_SPEED,10,12);
-
- }
- if(SKQD_HOUXIANWEI && SKQD_bBackMotor)
- {
- AxisEgmStop(X_AXIS);
- }
-
- if(SKQD_bBackMotor && !SKQD_HOUXIANWEI) //后退限位已经取消
- {
- SKQD_SZ_OUT = 0;
- // SKQD_JZ_DIR = SKQD_YDIR_P;
- if(!X_DRV)
-
- AxisContinueMoveAcc(X_AXIS,SKQD_PARAM_GO_LOW_SPEED,SKQD_DIR_P,SKQD_PARAM_GO_LOW_SPEED,SKQD_PARAM_GO_LOW_SPEED,10,12);
-
- }
-
- if(!SKQD_bGoMotor && !SKQD_bBackMotor && (SKQD_MotorStep == 0))
- {
- if(X_DRV)AxisDecStop(X_AXIS);
- }
-
- if(SKQD_QIAN_LIMIT_IN && (SKQD_MotorStep == 0) && !SKQD_bBackMotor &&(SKQD_AutoStep == 0))
- {
- if(X_DRV)AxisEgmStop(X_AXIS);
- }
- }
- }
- void SK_QueDuan_AlarmProtect(void)
- {
- SKQD_cRealPos = GetPos(X_AXIS);
-
- if(!bRunning)
- {
- ;
- //
- #if 0
- if(SKQD_BACK_LIMIT_IN_UP)
- {
- if((SKQD_MotorStep == 0) && X_DRV && SKQD_bBackMotor) //到后限不能再后退但可以点前进
- {
- SKQD_bBackMotor = 0;
-
- AxisDecStop(X_AXIS);
- SKQD_JD_VAVLE = 0;
- SKQD_SetAlarmCode(SKQD_BACK_ALARM);
-
- }
- }
- #endif
- }
- else
- {
- if((SKQD_cRealPos > SKQD_PARAM_RUN_LENGTH) && (SKQD_PARAM_RUN_LENGTH > 3000)
- && (cGoLimitEn != 0))
- {
- AxisEgmStop(X_AXIS);
- SKQD_JD_VAVLE = 0;
- SKQD_SetAlarmCode(SKQD_BACK_ALARM);
- }
- }
- }
- void SK_QueDuan_AutoAction(void)
- {
- //台面电机定时关掉
-
-
- if(SKQD_QIAN_STOP_Auto)
- {
-
- cDLJ_ATUO=1;
- AxisEgmStop(X_AXIS);
-
-
-
- }
- if(SKQD_QIAN_START_Auto)
- {
- if(cDLJ_ATUO)
- {
- cDLJ_ATUO=0;
- SKQD_AutoDelay = dwTickCount + 1000;
- SKQD_MotorDelay = dwTickCount + 2000;
- if((SKQD_MotorStep==63 || SKQD_MotorStep==64 || SKQD_MotorStep==65) && !SKQD_QIAN_LIMIT_IN)
- AxisContinueMoveAcc(X_AXIS,SKQD_PARAM_GO_LOW_SPEED,SKQD_DIR_N,SKQD_PARAM_GO_LOW_SPEED/3,SKQD_PARAM_GO_LOW_SPEED/3,15,15);
- else if((SKQD_cRealPos < SKQD_PARAM_ZIPPER_LENGTH) && (SKQD_MotorStep > 311))
- AxisMoveTwoPos(X_AXIS,1000,(SKQD_PARAM_ZIPPER_LENGTH - SKQD_cRealPos) + (*SKQD_length_buffer),
- SKQD_PARAM_BACK_LOW_SPEED,SKQD_PARAM_BACK_LOW_SPEED_LENGTH,SKQD_DIR_P,5000,3000,20,30);
-
-
-
- }
-
-
- }
- if(!cDLJ_ATUO)
- {
- if(bRunning)
- {
- if(!cTABLETIME)
- {
- if(dwTickCount >= SKQD_TBDelay)
- SKQD_TABLE_VAVLE = 0;
- }
- switch(SKQD_AutoStep)
- {
- case 1:
- if(dwTickCount >= SKQD_AutoDelay)
- {
- if(!SKQD_bDanBuAuto || SKQD_START_IN_UP)
- {
- SKQD_AutoStep = 2;
- if(SKQD_MotorStep == 0)
- {
- SKQD_MotorStep = 61; //前点定位
- }
- cGoLimitEn = 0;
- }
- }
- break;
- case 2:
- if(!SKQD_bDanBuAuto || SKQD_START_IN_UP)
- {
- if(SKQD_MotorStep == 0)
- {
- SKQD_MotorStep = 30;
- SKQD_AutoStep = 3;
- cGoLimitEn = 1;
- }
- }
- break;
- case 3:
-
- if(SKQD_MotorStep == 0)
- {
- if(SKQD_SAFE_IN)
- {
- bStop = 1;
- }
- else
- {
- if(!SKQD_bDanBuAuto || SKQD_START_IN_UP)
- {
- if(SKQD_MotorStep==0)
- {
- if(SKQD_XiaQieStep == 0)
- SKQD_XiaQieStep = 1;
- SKQD_AutoStep = 4;
- }
- }
-
- }
- }
- break;
- case 4:
-
- // 闭口
- if((SKQD_XiaQieStep == 0) || ((SKQD_XiaQieStep == 6) && SKQD_KB_MODE)|| ((SKQD_XiaQieStep == 14) && (SKQD_KB_MODE == 0)))// && !SKQD_SHANG_MU_LIMIT_IN)
- {
- if(!SKQD_bDanBuAuto || SKQD_START_IN_UP)
- {
- if(SKQD_MotorStep == 0)
- {
- cGoLimitEn=0;
- SKQD_MotorStep = 40; //切完后退
-
- }
- SKQD_AutoStep = 5;
- }
- }
-
- break;
- case 5:
-
- if(SKQD_MotorStep == 0)
- {
- cZipCnt++;
- SKQD_PARAM_NOW_CNT++;
- cTableCnt++;
- AddToTal(SKQD_TOTAL_ADDR);
- AddToTal(CT_WORKTOTAL_ADDR);
- CalProSP(SKQD_PROSPEED_ADDR);
-
- if(cTableCnt >= SKQD_PARAM_TABLE_NUM)
- {
- cTableCnt = 0;
- SKQD_TABLE_VAVLE = 1;
- SKQD_TBDelay = dwTickCount + SKQD_PARAM_TB_TIME;
- }
-
- if( SingOneFlg || cZhouWanone)
- {
-
- {
- cZhouWanone=0;
- cStopMode=0;
- bRunning = 0;
- SKQD_AutoStep = 0;
- SingOneFlg = 0;
- SKQD_TABLE_VAVLE = 0;
-
- }
-
- // if(GetTotal(SKQD_TOTAL_ADDR) >= SKQD_PARAM_SET_TOTAL) SKQD_SetAlarmCode(SKQD_TOTAL_ALARM);
- }
- else
- {
- SKQD_AutoStep = 1;
-
- if((SKQD_PARAM_NOW_CNT >= SKQD_PARAM_ZHA_SHU) && (SKQD_PARAM_ZHA_SHU > 0))
- {
- SKQD_AutoDelay = dwTickCount + SKQD_PARAM_ZS_STOP_TIME;
- SKQD_PARAM_NOW_CNT = 0;
- cTABLETIME = 1;
- cTABLETOTAL= 1;
- if(SKQD_PARAM_ZS_STOP_TIME == 0)
- {
- bRunning = 0;
- SKQD_AutoStep = 0;
- SingOneFlg = 0;
- cTABLETIME = 1;
- cTABLETOTAL= 1;
- SKQD_SetAlarmCode(SKQD_TOTAL_ALARM);
- }
- }
- else
- SKQD_AutoDelay = dwTickCount + SKQD_PARAM_CYCLE_DELAY;
- }
- }
- break;
- }
- }
- }
- }
- void SK_QueDuan_StepCheckStart(void)
- {
-
- if(SKQD_DANXUNHUAN_LIMIT_IN_UP)
- {
- SKQD_bSingle=1;
- }
- // 启动
- if((SKQD_START_IN_UP) || bStart || SKQD_bSingle)
- {
- bStart = 0;
-
- if(!bRunning && (SKQD_AutoStep == 0))
- {
- if(SKQD_XIA_MU_LIMIT_IN && !SKQD_PARAM_XM_ENABLE)SKQD_SetAlarmCode(SKQD_XM_DAOWEI);
- // else if(GetAlarmCode(SKQD_ALARM_ADDR) != 0);
- //else if(GetTotal(SKQD_TOTAL_ADDR) >= SKQD_PARAM_SET_TOTAL) SKQD_SetAlarmCode(SKQD_TOTAL_ALARM);
- // else if(SKQD_BL_VAVLE)SKQD_SetAlarmCode(SKQD_BL_ALARM);
- else if(SKQD_SM_VAVLE)SKQD_SetAlarmCode(SKQD_SM_ALARM);
- else
- {
- bRunning = 1;
- SKQD_AutoStep = 1;
- if(SKQD_PARAM_BL_ENABLE)
- SKQD_PARAM_BL_ENABLE=1 ; //并链起动
- if(SKQD_bSingle)
- SingOneFlg= 1;
- cZipCnt = 0;
- cTABLETIME = 0;
- cTABLETOTAL= 0;
- cSTOPONE=0;
- cTuiFangKuaiCnt = 0;
- SKQD_BL_VAVLE = 0; //并链关
- cDLJ_ATUO=0;
- SKQD_HULIAN_VAVLE=1;
- SKQD_YD_ONE_VAVLE=1;
- SKQD_DGLG_VAVLE = 0; //顶过链杆关
- SetAlarmCode(SKQD_ALARM_ADDR,0);
- }
- }
- SKQD_bSingle = 0;
- }
-
- //停止
- if(bStop)
- {
- bStop = 0;
- if(cStopMode < 2)
- cStopMode++;
- if(cStopMode==1 && bRunning)
- cZhouWanone=1;
- if(bRunning && cStopMode==2)
- {
-
-
- SKQD_AutoDelay = dwTickCount;
- SKQD_MotorDelay = dwTickCount;
- SKQD_XiaQieDelay = dwTickCount;
- SKQD_KaDaiDelay = dwTickCount;
- SKQD_CSDelay = dwTickCount;
- SKQD_TBDelay = dwTickCount;
- SKQD_TFKDelay = dwTickCount;
- SKQD_TLDelay = dwTickCount;
- dwTickCount = SKQD_TBDelay;
- SingOneFlg = 0;
- bRunning = 0;
- SKQD_XiaQieStep = 0;
- SKQD_AutoStep = 0;
- SKQD_MotorStep = 0;
- SKQD_TuiLianStep = 0;
- SKQD_JD_VAVLE = 0;
- SKQD_SM_VAVLE = 0;
- SKQD_XM_VAVLE = 0;
- SKQD_YD_VAVLE = 0;
- SKQD_TFK_VAVLE= 0;
- SKQD_TL_VAVLE = 0;
- SKQD_HL_VAVLE = 0;
- SKQD_HULIAN_VAVLE=0;
- SKQD_YD_ONE_VAVLE=0;
- SKQD_CS_OUT = 0;
- SKQD_XiaQieStep = 0;
- SKQD_MotorStep = 0;
- SKQD_TuiLianStep = 0;
- //SKQD_SZ_OUT = 1;
- SKQD_GZ_VAVLE = 0;
- SKQD_TABLE_VAVLE = 0;
- SKQD_DGLG_VAVLE = 0; //顶过链杆关
- if((SKQD_StopStep == 0) && X_DRV)
- SKQD_StopStep = 1;
- SKQD_BinLianStep = 0;
- SKQD_BL_VAVLE = 0;
- cTABLETIME = 0;
- cTABLETOTAL= 0;
- user_datas[121] = 0;
- user_datas[122] = 0;
-
- SetAlarmCode(SKQD_ALARM_ADDR,0);
- }
- else if(!bRunning)
- {
- SKQD_AutoDelay = dwTickCount;
- SKQD_MotorDelay = dwTickCount;
- SKQD_XiaQieDelay = dwTickCount;
- SKQD_KaDaiDelay = dwTickCount;
- SKQD_CSDelay = dwTickCount;
- SKQD_TBDelay = dwTickCount;
- SKQD_TFKDelay = dwTickCount;
- SKQD_TLDelay = dwTickCount;
- dwTickCount = SKQD_TBDelay;
- SKQD_CHUIQIStep=0;
- SingOneFlg = 0;
- SKQD_HULIAN_VAVLE=0;
- SKQD_YD_ONE_VAVLE=0;
- SKQD_JD_VAVLE = 0;
- SKQD_SM_VAVLE = 0;
- SKQD_XM_VAVLE = 0;
- SKQD_YD_VAVLE = 0;
- SKQD_TFK_VAVLE= 0;
- SKQD_YX_VAVLE = 0;
- SKQD_HL_VAVLE = 0;
- cStopMode=0;
- cZhouWanone=0;
- SKQD_TL_VAVLE = 0;
- SKQD_DGLG_VAVLE = 0; //顶过链杆关
- SKQD_CS_OUT = 0;
- SKQD_XiaQieStep = 0;
- SKQD_MotorStep = 0;
- SKQD_TuiLianStep = 0;
- SKQD_SZ_OUT = 1;
- SKQD_GZ_VAVLE = 0;
- SKQD_TABLE_VAVLE = 0;
- if((SKQD_StopStep == 0))
- {
- SK_cSTOPONE = 0;
- AxisEgmStop(X_AXIS);
- SKQD_SZ_OUT = 1;
- }
- cTABLETIME = 0;
- cTABLETOTAL= 0;
- SKQD_BinLianStep = 0;
- SKQD_BL_VAVLE = 0;
- SetAlarmCode(SKQD_ALARM_ADDR,0);
- bRunning = 0;
- SKQD_XiaQieStep = 0;
- SKQD_AutoStep = 0;
- SKQD_MotorStep = 0;
- SKQD_TuiLianStep = 0;
- }
-
- }
- if(SKQD_STOP_IN_UP )
- {
-
-
- if(bRunning)
- {
-
-
- SKQD_AutoDelay = dwTickCount;
- SKQD_MotorDelay = dwTickCount;
- SKQD_XiaQieDelay = dwTickCount;
- SKQD_KaDaiDelay = dwTickCount;
- SKQD_CSDelay = dwTickCount;
- SKQD_TBDelay = dwTickCount;
- SKQD_TFKDelay = dwTickCount;
- SKQD_TLDelay = dwTickCount;
- dwTickCount = SKQD_TBDelay;
- SingOneFlg = 0;
- bRunning = 0;
- SKQD_XiaQieStep = 0;
- SKQD_AutoStep = 0;
- SKQD_MotorStep = 0;
- SKQD_TuiLianStep = 0;
- SKQD_JD_VAVLE = 0;
- SKQD_SM_VAVLE = 0;
- SKQD_XM_VAVLE = 0;
- SKQD_YD_VAVLE = 0;
- SKQD_TFK_VAVLE= 0;
- SKQD_TL_VAVLE = 0;
- SKQD_HL_VAVLE = 0;
- SKQD_HULIAN_VAVLE=0;
- SKQD_YD_ONE_VAVLE=0;
- SKQD_CS_OUT = 0;
- SKQD_XiaQieStep = 0;
- SKQD_MotorStep = 0;
- SKQD_TuiLianStep = 0;
- //SKQD_SZ_OUT = 1;
- SKQD_GZ_VAVLE = 0;
- SKQD_TABLE_VAVLE = 0;
- SKQD_DGLG_VAVLE = 0; //顶过链杆关
- if((SKQD_StopStep == 0) && X_DRV)
- SKQD_StopStep = 1;
- SKQD_BinLianStep = 0;
- SKQD_BL_VAVLE = 0;
- cTABLETIME = 0;
- cTABLETOTAL= 0;
- user_datas[121] = 0;
- user_datas[122] = 0;
-
- SetAlarmCode(SKQD_ALARM_ADDR,0);
- }
- else if(!bRunning)
- {
- SKQD_AutoDelay = dwTickCount;
- SKQD_MotorDelay = dwTickCount;
- SKQD_XiaQieDelay = dwTickCount;
- SKQD_KaDaiDelay = dwTickCount;
- SKQD_CSDelay = dwTickCount;
- SKQD_TBDelay = dwTickCount;
- SKQD_TFKDelay = dwTickCount;
- SKQD_TLDelay = dwTickCount;
- dwTickCount = SKQD_TBDelay;
- SKQD_CHUIQIStep=0;
- SingOneFlg = 0;
- SKQD_HULIAN_VAVLE=0;
- SKQD_YD_ONE_VAVLE=0;
- SKQD_JD_VAVLE = 0;
- SKQD_SM_VAVLE = 0;
- SKQD_XM_VAVLE = 0;
- SKQD_YD_VAVLE = 0;
- SKQD_TFK_VAVLE= 0;
- SKQD_YX_VAVLE = 0;
- SKQD_HL_VAVLE = 0;
- cStopMode=0;
- cZhouWanone=0;
- SKQD_TL_VAVLE = 0;
- SKQD_DGLG_VAVLE = 0; //顶过链杆关
- SKQD_CS_OUT = 0;
- SKQD_XiaQieStep = 0;
- SKQD_MotorStep = 0;
- SKQD_TuiLianStep = 0;
- SKQD_SZ_OUT = 1;
- SKQD_GZ_VAVLE = 0;
- SKQD_TABLE_VAVLE = 0;
- if((SKQD_StopStep == 0))
- {
- SK_cSTOPONE = 0;
- AxisEgmStop(X_AXIS);
- SKQD_SZ_OUT = 1;
- }
- cTABLETIME = 0;
- cTABLETOTAL= 0;
- SKQD_BinLianStep = 0;
- SKQD_BL_VAVLE = 0;
- SetAlarmCode(SKQD_ALARM_ADDR,0);
- bRunning = 0;
- SKQD_XiaQieStep = 0;
- SKQD_AutoStep = 0;
- SKQD_MotorStep = 0;
- SKQD_TuiLianStep = 0;
- }
-
- }
-
- if(bAlarmStop)
- {
- bAlarmStop = 0;
- SKQD_XiaQieStep = 0;
- SKQD_AutoStep = 0;
- SKQD_MotorStep = 0;
- SKQD_TuiLianStep = 0;
-
- SKQD_XiaQieStep = 0;
- SKQD_MotorStep = 0;
- SKQD_TuiLianStep = 0;
- SKQD_AutoDelay = dwTickCount;
- SKQD_MotorDelay = dwTickCount;
- SKQD_XiaQieDelay = dwTickCount;
- SKQD_KaDaiDelay = dwTickCount;
- SKQD_CSDelay = dwTickCount;
- SKQD_TBDelay = dwTickCount;
- SKQD_TFKDelay = dwTickCount;
- SKQD_TLDelay = dwTickCount;
- SingOneFlg = 0;
- bRunning = 0;
- SKQD_StopStep=1;
- cStopMode=0;
- cZhouWanone=0;
- dwTickCount = SKQD_TBDelay;
- SKQD_TABLE_VAVLE = 0;
- SKQD_TFK_VAVLE =0;
- SKQD_JD_VAVLE=0;
- SKQD_GZ_VAVLE=0;
- }
-
- }
- //记忆长度模式误差检测
- void SK_QueDuan_CheckLength(long zip_length)
- {
- static long start_dist;
- switch(SKQD_CheckLengthStep)
- {
- case 0:break;
- case 1:
- start_dist = SKQD_cRealPos;
- dwSaveLength = 0;
- SKQD_CheckLengthStep = 2;
- break;
- case 2:
- if(SKQD_GUO_LIAN_IN_DW)
- {
- dwSaveLength = SKQD_cRealPos - start_dist;
- // user_datas[127] = SKQD_cRealPos;
-
- }
- break;
- }
- }
- void SK_QueDuan_BingLian(void)
- {
- static long bl_pos_buff,HL_delay;
-
- switch(SKQD_BinLianStep)
- {
- case 1:
- bl_pos_buff = SKQD_cRealPos;
-
- SKQD_BinLianStep = 2;
- break;
- case 2:
- if((SKQD_cRealPos - bl_pos_buff) >= SKQD_PARAM_DELAY_HL_LENGTH)
- {
- SKQD_BL_VAVLE = 1;
- SKQD_BinLianStep = 3;
- }
- break;
- case 3://有过链检测
- if((SKQD_cRealPos - bl_pos_buff) >= (SKQD_PARAM_ZIPPER_LENGTH - SKQD_PARAM_HL_DELAY_BACK))
- {
- SKQD_BL_VAVLE = 0;
- SKQD_BinLianStep = 0;
- }
- if(SKQD_GUO_LIAN_IN_DW && SKQD_PARAM_BACK_MODE ==1) //|| (SKQD_PARAM_BACK_MODE==2 && cZipCnt < 2)))
- {
- SKQD_BL_VAVLE = 0;
- SKQD_BinLianStep = 0;
- }
- break;
- case 10:
- bl_pos_buff = SKQD_cRealPos;
- SKQD_BinLianStep = 11;
- break;
- case 11:
- if((SKQD_cRealPos - bl_pos_buff) >= SKQD_PARAM_DELAY_HL_LENGTH)
- {
- SKQD_BL_VAVLE = 1;
- SKQD_BinLianStep = 12;
- }
- break;
- case 12://有过链检测
- if(SKQD_GUO_LIAN_IN_DW)
- {
- SKQD_BL_VAVLE = 0;
- SKQD_BinLianStep = 0;
- }
- break;
- default:;
- }
-
- }
- #if SKQD_KB_MODE==1 //闭口
- //作闭口专用程序
- //不带过链感应长度输入电机长度 闭口有勾针到位
- void SK_QueDuan_Motor_NoGL(void)
- {
- static long save_buff,length_buff,gou_zhen_buff,checkdelay_buff,dandao_buff,back_buff,gouzhen_buff,go_buff,go_length_buff,jz_buff;
- long pulse_buff;
- unsigned short ch,kk;
- user_datas[121] = SKQD_MotorStep;
- user_datas[122] = SKQD_AutoStep;
- user_datas[124]= SKQD_cRealPos;
- user_datas[125]= bRunning;
- // user_datas[123] = length_buff - (*SKQD_length_buffer);
- // user_datas[127] = SKQD_cRealPos;
- // user_datas[126] = go_buff - SKQD_cRealPos;
-
-
-
- if(!cDLJ_ATUO)
- {
- switch(SKQD_MotorStep)
- {
- case 30:
- switch(SKQD_PARAM_BACK_MODE) //开口分四种模式
- {
- case 0: //单数控模式
- SKQD_MotorStep = 310; //每种模式留20步
- SKQD_DGLG_VAVLE = 1; //顶过链杆关
- break;
- case 1://单感应模式
- SKQD_MotorStep = 330; //每种模式留20步
- SKQD_DGLG_VAVLE = 0;
-
- break;
- case 2: //先感应后数控模式+检测
- SKQD_MotorStep = 350; //每种模式留20步
- SKQD_DGLG_VAVLE = 0;
- break;
- default: //数控模式+过链检测长度
-
- break;
- }
- SKQD_MotorDelay = dwTickCount + SKQD_PARAM_DELAY_BACK;
- break;
-
- case 310:
- if(!SKQD_bDanBuAuto || SKQD_START_IN_UP)
- {
- SKQD_MotorDelay = dwTickCount + SKQD_PARAM_DELAY_BACK;
- SetDir(X_AXIS, SKQD_DIR_P);
- SKQD_JZ_DIR = SKQD_YDIR_P;
- SetPos(X_AXIS, 0);
- SKQD_DGLG_VAVLE = 1; //顶过链杆关
- SKQD_length_buffer = &SKQD_PARAM_OFFSET_LENGTH;
- if(SKQD_PARAM_BL_ENABLE) //
- SKQD_BinLianStep = 1;
- SKQD_MotorStep = 311;
- }
- break;
- case 311:
- if(dwTickCount >= SKQD_MotorDelay)
- {
- back_buff = SKQD_cRealPos;
- gou_zhen_buff = SKQD_cRealPos;
- save_buff = SKQD_cRealPos;
- SKQD_length_buffer = &SKQD_PARAM_OFFSET_LENGTH;
- DCC_TIME_BL=SKQD_PARAM_GO_HIGH_SPEED/500;
- AxisMovePosAccDecNotStop(X_AXIS,SKQD_PARAM_BACK_SPEED,SKQD_PARAM_ZIPPER_LENGTH + (*SKQD_length_buffer), SKQD_PARAM_START_SPEED,SKQD_PARAM_BACK_LOW_SPEED,SKQD_PARAM_ACC,DCC_TIME_BL,SKQD_PARAM_BACK_LOW_SPEED_LENGTH);
- SKQD_MotorDelay = dwTickCount + MOTOR_ALARM_TIME;
- SKQD_MotorStep = 312;
- }
- break;
- case 312:
- //勾针提前输出
- if(SKQD_cRealPos >= (SKQD_PARAM_ZIPPER_LENGTH-SKQD_PARAM_GOUZHEN_LENGTH ))
- SKQD_GZ_VAVLE = 1;
- if(SKQD_cRealPos >= (SKQD_PARAM_ZIPPER_LENGTH-SKQD_PARAM_YaDai_LENGTH ))
- SKQD_YD_ONE_VAVLE = 1;
- if(SKQD_cRealPos >= (SKQD_PARAM_ZIPPER_LENGTH-SKQD_PARAM_HuLian_LENGTH ))
- SKQD_HULIAN_VAVLE = 1;
-
- if((SKQD_cRealPos) > (SKQD_PARAM_ZIPPER_LENGTH + (*SKQD_length_buffer) - SKQD_PARAM_BACK_LOW_SPEED_LENGTH)) //- (*SKQD_length_buffer) - (SKQD_PARAM_BACK_LOW_SPEED_LENGTH + PulseToPos(X_AXIS,MV_Cal_Dec_pulse(SKQD_PARAM_BACK_SPEED,SKQD_PARAM_BACK_LOW_SPEED,SKQD_PARAM_DCC)))))
- {
- SKQD_MotorDelay = dwTickCount + 3000; //钩针未到位延时警告
- SKQD_MotorStep = 313;
- }
-
- break;
- case 313:
- if(SKQD_cRealPos >= (SKQD_PARAM_ZIPPER_LENGTH-SKQD_PARAM_GOUZHEN_LENGTH ))
- {
- SKQD_GZ_VAVLE = 1;
- }
- if(SKQD_cRealPos >= (SKQD_PARAM_ZIPPER_LENGTH-SKQD_PARAM_YaDai_LENGTH ))
- SKQD_YD_ONE_VAVLE = 1;
- if(SKQD_cRealPos >= (SKQD_PARAM_ZIPPER_LENGTH-SKQD_PARAM_HuLian_LENGTH ))
- SKQD_HULIAN_VAVLE = 1;
- if(!SKQD_GOUZHEN_IN)
- {
- AxisEgmStop(X_AXIS);
- if(!SKQD_bDanBuAuto || SKQD_START_IN_UP)
- {
- SKQD_MotorDelay = dwTickCount + 10;
- SKQD_YD_VAVLE = 1;
- SKQD_MotorStep = 314;
- SKQD_BL_VAVLE = 0; //停止时并链一定要打开
- }
- }
- else if((SKQD_cRealPos >= SKQD_PARAM_ZIPPER_LENGTH + 200 + (*SKQD_length_buffer)))// 长度超出2CM就警告
- {
- AxisEgmStop(X_AXIS);
- if(dwTickCount >= SKQD_MotorDelay)
- SKQD_SetAlarmCode(SKQD_GZ_ALARM);
- }
- break;
- case 314:
- if(!X_DRV && (dwTickCount >= SKQD_MotorDelay))
- {
- SKQD_MotorDelay = dwTickCount + VAVLE_ALARM_TIME;
- SKQD_YD_VAVLE = 1;
- SKQD_MotorStep = 315;
-
- }
- break;
- case 315:
-
- if(cZipCnt == 0)
- {
- ch = SKQD_PARAM_ZIPPER_LENGTH + (*SKQD_length_buffer)-SKQD_PARAM_WC_LENGTH;
- kk = SKQD_PARAM_ZIPPER_LENGTH + (*SKQD_length_buffer)+SKQD_PARAM_WC_LENGTH;
- }
- else
- {
- ch = SKQD_PARAM_ZIPPER_LENGTH + (*SKQD_length_buffer)-SKQD_PARAM_WC_LENGTH;
- kk = SKQD_PARAM_ZIPPER_LENGTH + (*SKQD_length_buffer)+SKQD_PARAM_WC_LENGTH;
- }
-
- if(SKQD_cRealPos < ch)
- {
- SetAlarmCode(SKQD_ALARM_ADDR,SKQD_LENGTH_SHORT_ALARM);
- if(dwTickCount >= SKQD_MotorDelay)
- bAlarmStop = 1;
- }
- else if(SKQD_cRealPos > kk)
- {
- SetAlarmCode(SKQD_ALARM_ADDR,SKQD_LENGTH_LONG_ALARM);
- if(dwTickCount >= SKQD_MotorDelay)
- bAlarmStop = 1;
- }
- else
- {
- if(!SKQD_bDanBuAuto || SKQD_START_IN_UP)
- {
-
- SKQD_MotorStep = 390;
- }
- }
- break;
- case 330:
- if(!SKQD_bDanBuAuto || SKQD_START_IN_UP)
- {
- back_buff = SKQD_cRealPos;
- gou_zhen_buff = SKQD_cRealPos;
- save_buff = SKQD_cRealPos;
- SKQD_MotorStep = 331;
- SetDir(X_AXIS, SKQD_DIR_P);
- }
-
- break;
- case 331:
- if(dwTickCount >= SKQD_MotorDelay)
- {
-
- SKQD_MotorStep = 332;
- if(cZipCnt < 2)
- {
- if(SKQD_PARAM_BL_ENABLE)
- SKQD_BinLianStep = 10; //并链起动
- //第一条都是过链感应,后拉速度减半//原来SKQD_PARAM_CHECK_BACK_HSPEED/2
- // X轴 运行速度 启动速度 加速度 减速度
- AxisContinueMoveAcc(X_AXIS,SKQD_PARAM_CHECK_BACK_HSPEED,SKQD_DIR_P,SKQD_PARAM_START_SPEED,1000,8,13);
-
-
- }
- else
- {
- if(SKQD_PARAM_BL_ENABLE)
- SKQD_BinLianStep = 1; //并链起动
- //因为每条都是过链感应,所以直接运行检测模式后拉速度
- // X轴 运行速度 启动速度 加速度 减速度
- AxisContinueMoveAcc(X_AXIS,SKQD_PARAM_BACK_SPEED,SKQD_DIR_P,SKQD_PARAM_START_SPEED,1000,SKQD_PARAM_ACC,SKQD_PARAM_DCC);
- }
- }
- break;
- case 332:
- if(cZipCnt > 1) //第三条开始数控降速
- {
- if((SKQD_cRealPos + SKQD_PARAM_BACK_LOW_SPEED_LENGTH + 300)>= length_buff)
- {
- AxisContinueMoveChangeSpeed(X_AXIS,SKQD_PARAM_BACK_LOW_SPEED,SKQD_PARAM_BACK_LOW_SPEED/2,25,15);
- SKQD_MotorStep = 334; //到检测定位
- }
- if(SKQD_GUO_LIAN_IN_UP) //重新到链上
- {
-
- AxisContinueMoveChangeSpeed(X_AXIS,SKQD_PARAM_BACK_LOW_SPEED,SKQD_PARAM_BACK_LOW_SPEED/2,25,15);
- gou_zhen_buff = SKQD_cRealPos;
- SKQD_MotorStep = 333; //到检测定位
- SKQD_MotorDelay = dwTickCount + SKQD_PARAM_FD_TIME;//SKQD_PARAM_DELAY_XM;
-
-
- }
- if(SKQD_cRealPos >= (SKQD_PARAM_ZIPPER_LENGTH-SKQD_PARAM_YaDai_LENGTH ))
- SKQD_YD_ONE_VAVLE = 1;
- if(SKQD_cRealPos >= (SKQD_PARAM_ZIPPER_LENGTH-SKQD_PARAM_HuLian_LENGTH ))
- SKQD_HULIAN_VAVLE = 1;
- if(!SKQD_GZ_VAVLE && (SKQD_cRealPos + SKQD_PARAM_GOUZHEN_LENGTH) > (SKQD_PARAM_ZIPPER_LENGTH ))
- {
-
- SKQD_GZ_VAVLE = 1;
- }
- }
- else //第一条工作
- {
-
- if(SKQD_GUO_LIAN_IN_UP)
- {
-
- checkdelay_buff = SKQD_cRealPos;
- AxisContinueMoveChangeSpeed(X_AXIS,SKQD_PARAM_BACK_LOW_SPEED,SKQD_PARAM_BACK_LOW_SPEED/2,25,15);
- SKQD_MotorDelay = dwTickCount + SKQD_PARAM_FD_TIME;//SKQD_PARAM_DELAY_XM;
- SKQD_MotorStep = 333;
- }
- }
-
-
- break;
- case 333: //此步为前两条运行
-
- if(cZipCnt > 1) //第三条开始要长度误差
- {
- if(SKQD_cRealPos >= (SKQD_PARAM_ZIPPER_LENGTH-SKQD_PARAM_YaDai_LENGTH ))
- SKQD_YD_ONE_VAVLE = 1;
- if(SKQD_cRealPos >= (SKQD_PARAM_ZIPPER_LENGTH-SKQD_PARAM_HuLian_LENGTH ))
- SKQD_HULIAN_VAVLE = 1;
- if(!SKQD_GZ_VAVLE && (SKQD_cRealPos + SKQD_PARAM_GOUZHEN_LENGTH) > (SKQD_PARAM_ZIPPER_LENGTH ))
- {
-
- SKQD_GZ_VAVLE = 1;
- }
- }
- if(SKQD_GUO_LIAN_IN_DW)
- {
- gou_zhen_buff = SKQD_cRealPos;
- SKQD_GouZhenDelay=dwTickCount+SKQD_PARAM_GouZhen_Delay;
- SKQD_YADaiDelay=dwTickCount+SKQD_PARAM_YaDai_Delay;
- SKQD_HuLianDelay=dwTickCount+SKQD_PARAM_HuLian_Delay;
-
- }
- if(dwTickCount >= SKQD_MotorDelay)
- {
- if(SKQD_GUO_LIAN_IN)
- {
-
- AxisContinueMoveChangeSpeed(X_AXIS,SKQD_PARAM_BACK_LOW_SPEED,SKQD_PARAM_BACK_LOW_SPEED/2,25,15);
- back_buff = SKQD_cRealPos;
- SKQD_MotorDelay = dwTickCount + 30;
- SKQD_MotorStep = 334;
- }
- }
- else
- {
- if(!SKQD_GUO_LIAN_IN)
- {
- SKQD_MotorStep = 332;
-
- }
- }
- break;
- case 334:
- if(SKQD_GUO_LIAN_IN_DW) //下降沿,定位长度
- {
-
- gou_zhen_buff = SKQD_cRealPos;
- SKQD_MotorStep = 335;
- SKQD_GouZhenDelay=dwTickCount+SKQD_PARAM_GouZhen_Delay;
- SKQD_YADaiDelay=dwTickCount+SKQD_PARAM_YaDai_Delay;
- SKQD_HuLianDelay=dwTickCount+SKQD_PARAM_HuLian_Delay;
- }
- if(cZipCnt > 1) //第三条开始要长度误差
- {
- if(SKQD_cRealPos >= (SKQD_PARAM_ZIPPER_LENGTH-SKQD_PARAM_YaDai_LENGTH ))
- SKQD_YD_ONE_VAVLE = 1;
- if(SKQD_cRealPos >= (SKQD_PARAM_ZIPPER_LENGTH-SKQD_PARAM_HuLian_LENGTH ))
- SKQD_HULIAN_VAVLE = 1;
- if(!SKQD_GZ_VAVLE && (SKQD_cRealPos + SKQD_PARAM_GOUZHEN_LENGTH) > (SKQD_PARAM_ZIPPER_LENGTH ))
- {
- SKQD_GZ_VAVLE = 1;
- SKQD_MotorStep = 335; //到检测定位
-
- }
-
-
-
- }
- if(cZipCnt > 1) //第三条开始要长度误差
- {
- if(SKQD_cRealPos >= (length_buff + SKQD_PARAM_ERROR_LENGTH))
- {
- SKQD_SetAlarmCode(SKQD_LENGTH_LONG_ALARM);
-
- }
- }
-
-
- break;
- case 335:
- if(cZipCnt > 1) //第三条开始要长度误差
- {
- if(SKQD_cRealPos >= (SKQD_PARAM_ZIPPER_LENGTH-SKQD_PARAM_YaDai_LENGTH ))
- SKQD_YD_ONE_VAVLE = 1;
- if(SKQD_cRealPos >= (SKQD_PARAM_ZIPPER_LENGTH-SKQD_PARAM_HuLian_LENGTH ))
- SKQD_HULIAN_VAVLE = 1;
- if(!SKQD_GZ_VAVLE && (SKQD_cRealPos + SKQD_PARAM_GOUZHEN_LENGTH) > (SKQD_PARAM_ZIPPER_LENGTH ))
- {
-
- SKQD_GZ_VAVLE = 1;
- }
- }
- if(dwTickCount >= SKQD_GouZhenDelay)
- {
- SKQD_GZ_VAVLE=1;
- }
- if(dwTickCount >=SKQD_YADaiDelay)
- {
- SKQD_YD_ONE_VAVLE=1;
- }
- if(dwTickCount >= SKQD_HuLianDelay)
- {
- SKQD_HULIAN_VAVLE=1;
- }
-
- if(SKQD_GUO_LIAN_IN_DW)
- {
- gou_zhen_buff = SKQD_cRealPos;
-
-
-
- }
- //在空们都把延时清零
- if(SKQD_GUO_LIAN_IN)
- {
- gou_zhen_buff = SKQD_cRealPos;
- }
- if(!SKQD_GOUZHEN_IN)
- {
- AxisEgmStop(X_AXIS);
- if(!SKQD_bDanBuAuto || SKQD_START_IN_UP)
- {
- SKQD_MotorDelay = dwTickCount + 10;
- SKQD_YD_VAVLE = 1;
- SKQD_MotorStep = 336;
- SKQD_BL_VAVLE = 0; //停止时并链一定要打开
- }
- }
- else
- {
- if(cZipCnt > 1) //2 条后才有长度误差
- {
- if(SKQD_cRealPos >= (length_buff + 300))
- {
- AxisEgmStop(X_AXIS);
-
- if(dwTickCount >= SKQD_MotorDelay)
- SKQD_SetAlarmCode(SKQD_GZ_ALARM);
- }
- }
- }
-
- break;
- case 336:
- if(cZipCnt > 1) //长度检测
- {
- ch =SKQD_PARAM_ZIPPER_LENGTH;
-
- if(((SKQD_cRealPos + SKQD_PARAM_ERROR_LENGTH) < (ch)) && SKQD_PARAM_ERROR_LENGTH)
- {
- SKQD_SetAlarmCode(SKQD_LENGTH_LONG_ALARM);
- cJiaDaione=1;
-
- }
- else if((SKQD_cRealPos > (ch + SKQD_PARAM_ERROR_LENGTH)) && SKQD_PARAM_ERROR_LENGTH)//(SKQD_PARAM_ERROR_LENGTH - 200 + (*SKQD_length_buffer)+50)))
- {
-
- SKQD_SetAlarmCode(SKQD_LENGTH_SHORT_ALARM);
- cJiaDaione=1;
- }
- else
- {
- SKQD_MotorStep = 337;
- }
- }
- else
- {
- if(cZipCnt == 1)
- {
- length_buff = SKQD_cRealPos - save_buff;
- SetData32bits(SKQD_PARAM_ZIPPER_LENGTH_ADDR,length_buff); //测量记录长度
- }
- SKQD_MotorStep = 337;
- }
- break;
- case 337:
- if(!SKQD_bDanBuAuto || SKQD_START_IN_UP)
- {
- SKQD_MotorStep = 390;
- }
-
- break;
- //350步到369步单感应模式
- case 350:
- if(!SKQD_bDanBuAuto || SKQD_START_IN_UP)
- {
- back_buff = SKQD_cRealPos;
- gou_zhen_buff = SKQD_cRealPos;
- save_buff = SKQD_cRealPos;
- SKQD_MotorStep = 351;
- break;
- }
-
- case 351:
- if(dwTickCount >= SKQD_MotorDelay)
- {
-
- SKQD_MotorStep = 352;
- //第一,二条都是过链感应,测量长度
- if(cZipCnt < 2)
- {
- if(SKQD_PARAM_BL_ENABLE) //因为长度未知,只能通过过链退合链
- SKQD_BinLianStep = 10; //并链起动
- SKQD_DGLG_VAVLE = 0; //顶过链杆关
- // X轴 运行速度 启动速度 加速度 减速度
- AxisContinueMoveAcc(X_AXIS,SKQD_PARAM_CHECK_BACK_HSPEED,SKQD_DIR_P,SKQD_PARAM_START_SPEED,1000,8,12);
-
- }
- else
- {
- if(SKQD_PARAM_BL_ENABLE)
- SKQD_BinLianStep = 1; //并链起动
- SKQD_DGLG_VAVLE = 1; //顶过链杆关
- SKQD_CheckLengthStep = 1; //长度检测,第3条才有对比
- //走数控方式,因第二条中已经测量出来拉链长度,可以直接按长度数控方式走
- SKQD_MotorStep = 311;
- }
- }
- break;
- case 352:
- //前两条都按最低速度工作
- if(SKQD_GUO_LIAN_IN_UP)
- {
- checkdelay_buff = SKQD_cRealPos;
- AxisContinueMoveChangeSpeed(X_AXIS,SKQD_PARAM_BACK_LOW_SPEED,SKQD_PARAM_BACK_LOW_SPEED/2,25,15);
- SKQD_MotorDelay = dwTickCount + 5;//SKQD_PARAM_DELAY_XM;
- SKQD_MotorStep = 353;
-
- }
-
- break;
- case 353:
-
- if(SKQD_GUO_LIAN_IN_DW)
- {
- gou_zhen_buff = SKQD_cRealPos;
- SKQD_GouZhenDelay=dwTickCount+SKQD_PARAM_GouZhen_Delay;
- SKQD_YADaiDelay=dwTickCount+SKQD_PARAM_YaDai_Delay;
- SKQD_HuLianDelay=dwTickCount+SKQD_PARAM_HuLian_Delay;
-
- }
- if(dwTickCount >= SKQD_MotorDelay)
- {
- if(SKQD_GUO_LIAN_IN)
- {
-
- AxisContinueMoveChangeSpeed(X_AXIS,SKQD_PARAM_BACK_LOW_SPEED,SKQD_PARAM_BACK_LOW_SPEED/2,25,15);
- back_buff = SKQD_cRealPos;
- SKQD_MotorDelay = dwTickCount + 30;
- SKQD_MotorStep = 359;
- }
- }
- else
- {
- if(!SKQD_GUO_LIAN_IN)
- {
- SKQD_MotorStep = 352;
-
- }
- }
-
- break;
- case 359:
- if(SKQD_GUO_LIAN_IN_DW) //下降沿,定位长度
- {
-
- gou_zhen_buff = SKQD_cRealPos;
- SKQD_MotorStep = 354;
- SKQD_GouZhenDelay=dwTickCount+SKQD_PARAM_GouZhen_Delay;
- SKQD_YADaiDelay=dwTickCount+SKQD_PARAM_YaDai_Delay;
- SKQD_HuLianDelay=dwTickCount+SKQD_PARAM_HuLian_Delay;
- }
-
- break;
-
-
- case 354:
- if(dwTickCount >= SKQD_GouZhenDelay)
- {
- SKQD_GZ_VAVLE=1;
- }
- if(dwTickCount >=SKQD_YADaiDelay)
- {
- SKQD_YD_ONE_VAVLE=1;
- }
- if(dwTickCount >= SKQD_HuLianDelay)
- {
- SKQD_HULIAN_VAVLE=1;
- }
- if(SKQD_GUO_LIAN_IN_DW) //下降沿,定位长度
- {
- if(SKQD_GUO_LIAN_IN_DW)
- {
- gou_zhen_buff = SKQD_cRealPos;
- SKQD_MotorStep = 355;
-
-
- }
- }
- if(!SKQD_GOUZHEN_IN)
- {
-
- AxisEgmStop(X_AXIS);
- if(!SKQD_bDanBuAuto || SKQD_START_IN_UP)
- {
- SKQD_MotorDelay = dwTickCount + 10;
- SKQD_YD_VAVLE = 1;
- SKQD_MotorStep = 356;
- SKQD_BL_VAVLE = 0; //停止时并链一定要打开
- }
- }
- break;
- case 355:
-
- //在空们都把延时清零
- if(!SKQD_GOUZHEN_IN)
- {
-
- AxisEgmStop(X_AXIS);
- if(!SKQD_bDanBuAuto || SKQD_START_IN_UP)
- {
- SKQD_MotorDelay = dwTickCount + 10;
- SKQD_YD_VAVLE = 1;
- SKQD_MotorStep = 356;
- SKQD_BL_VAVLE = 0; //停止时并链一定要打开
- }
- }
- break;
- case 356:
- if(cZipCnt == 1)
- {
- length_buff = SKQD_cRealPos - save_buff;
- SetData32bits(SKQD_PARAM_ZIPPER_LENGTH_ADDR,length_buff); //测量记录长度
- }
- SKQD_MotorStep = 357;
-
- break;
- case 357:
- if(!SKQD_bDanBuAuto || SKQD_START_IN_UP)
- {
- SKQD_MotorStep = 390; //延时反转步
- }
- break;
-
- case 390:
- SKQD_MotorDelay = dwTickCount +35;
- SKQD_MotorStep = 391;
- break;
- case 391:
- if(dwTickCount >= SKQD_MotorDelay)
- {
- AxisMovePosAccDec(X_AXIS,2200,-SKQD_PARAM_FZ_LENGTH,2200,2200,10,10,0);
- SKQD_MotorStep = 0;
- }
- break;
-
-
- case 40:
- //切完延时后拉带松夹子
- if(SKQD_PARAM_SJZ_LENGTH == 0)
- {
- SKQD_MotorDelay = dwTickCount + SKQD_PARAM_TDYS_DELAY;
- AxisMovePosAccDecNotStop(X_AXIS,SKQD_PARAM_CUT_BACK_SPEED,SKQD_PARAM_BACK_LENGTH,500,1500,100,100,00);
- SetDir(X_AXIS, SKQD_DIR_P);
- SKQD_MotorStep = 44;
- SKQD_JD_VAVLE = 0;
- }
- else
- {
- jz_buff = SKQD_cRealPos;
- SetDir(X_AXIS, SKQD_DIR_P);
- SKQD_MotorStep = 41;
- }
- break;
- case 41:
-
- AxisMovePosAccDecNotStop(X_AXIS,SKQD_PARAM_CUT_BACK_SPEED,SKQD_PARAM_SJZ_LENGTH+SKQD_PARAM_BACK_LENGTH,500,1500,100,100,00);
- // AxisMovePosAccDec(X_AXIS,SKQD_PARAM_CUT_BACK_SPEED,SKQD_PARAM_SJZ_LENGTH+SKQD_PARAM_BACK_LENGTH,1000,1000,80,100,0);
- SKQD_MotorStep = 42;
- // SKQD_MotorDelay = dwTickCount+ 10;
- break;
-
- case 42:
-
- if((SKQD_PARAM_SJZ_LENGTH <= (SKQD_cRealPos - jz_buff)))
- {
-
- SKQD_JD_VAVLE = 0;
- SKQD_GZ_VAVLE=0;
-
- SKQD_MotorStep = 44;
- }
- break;
- case 44: // 切断完成后拉电机动作
- if((SKQD_cRealPos - jz_buff) >= (SKQD_PARAM_SJZ_LENGTH+SKQD_PARAM_BACK_LENGTH))
- {
- AxisEgmStop(X_AXIS);
- SKQD_MotorStep = 0;
- SKQD_GZ_VAVLE=0;
- SKQD_MotorDelay = dwTickCount;
- }
- break;
- case 61: // 前点定位数控模式
- if(SKQD_SZ_OUT)
- {
- SKQD_SZ_OUT = 0;
- SKQD_MotorDelay = dwTickCount + 150;
- SetPos(X_AXIS, 0);
- }
- else
- SKQD_MotorDelay = dwTickCount;
- SKQD_BL_VAVLE = 0;//并链也要打开
- SetDir(X_AXIS,SKQD_DIR_N);
-
- SKQD_JZ_DIR = SKQD_YDIR_N;
- if(!SKQD_TL_VAVLE && cZipCnt) //没送链情况下主动送链
- {
- if(!SKQD_SHANG_MU_LIMIT_IN && (SKQD_TuiLianStep == 0))
- {
- SKQD_TuiLianStep = 1;
- SKQD_MotorStep = 62;
- }
- }
- else
- SKQD_MotorStep = 62;
- break;
- case 62:
-
- if(dwTickCount >= SKQD_MotorDelay)
- {
- if(SKQD_QIAN_LIMIT_IN)
- {
- // SetPos(X_AXIS, 0);//在前点,直接置零点
- SetDir(X_AXIS,SKQD_DIR_N);
- // AxisMovePosAccDec(X_AXIS,3000,SKQD_PARAM_QDW_LENGTH,2000,2000,SKQD_PARAM_ACC,SKQD_PARAM_DCC,0);
- SKQD_JZ_DIR = SKQD_YDIR_P;
- //前点亮的情况下先退出
- AxisMovePos(X_AXIS,SKQD_PARAM_GO_LOW_SPEED,1000);
- SKQD_MotorDelay = dwTickCount + 300;
- }
- SKQD_MotorStep = 63;
- SKQD_JD_VAVLE = 0;
- }
- break;
- case 63:
- if(!X_DRV && !SKQD_QIAN_LIMIT_IN && (dwTickCount >= SKQD_MotorDelay))// && !SKQD_SHANG_MU_LIMIT_IN)
- {
- if(SKQD_ANQUANMEN_LIMIT_IN_UP)
- {
-
- SKQD_StopStep=1;
- cSTOPONE=1;
- }
- SetDir(X_AXIS, SKQD_DIR_N);
- SKQD_JZ_DIR = SKQD_YDIR_N;
- go_buff = SKQD_cRealPos;
- SKQD_YD_VAVLE = 1;
- SKQD_HL_VAVLE = 1;
- SKQD_YX_VAVLE = 1;
- //李永庆代码,当位置在慢速之外,走数控到慢速点
- if(cZipCnt > 0)
- {
-
- if(SKQD_cRealPos>(SKQD_PARAM_GO_LOW_SPEED_LENGTH))
- {
-
- DCC_TIME_BL=SKQD_PARAM_GO_HIGH_SPEED/500;
- AxisMovePosAccDecNotStop(X_AXIS,SKQD_PARAM_GO_HIGH_SPEED,-SKQD_cRealPos,
- SKQD_PARAM_START_SPEED,SKQD_PARAM_GO_LOW_SPEED,SKQD_PARAM_ACC,DCC_TIME_BL,
- SKQD_PARAM_GO_LOW_SPEED_LENGTH);
- }
- else
- {
- // X轴 运行速度 启动速度 加速度 减速度
- AxisContinueMoveAcc(X_AXIS,SKQD_PARAM_GO_LOW_SPEED,SKQD_DIR_N,SKQD_PARAM_GO_LOW_SPEED/3,1000,15,15);
-
- }
-
- }
- else
- {
- // X轴 运行速度 启动速度 加速度 减速度
- AxisContinueMoveAcc(X_AXIS,SKQD_PARAM_GO_LOW_SPEED,SKQD_DIR_N,SKQD_PARAM_GO_LOW_SPEED/3,1000,15,20);
- // MoveAction_Const_AccDec(X_AXIS, SKQD_DIR_N,SKQD_PARAM_FIRST_GO_HIGHSPEED,SKQD_PARAM_START_SPEED,SKQD_PARAM_ACC,SKQD_PARAM_DCC);//
- }
-
- SKQD_MotorDelay = dwTickCount + MOTOR_ALARM_TIME;
- SKQD_MotorStep =64;
- }
-
- break;
- case 64:
-
- if(SKQD_ANQUANMEN_LIMIT_IN_UP)
- {
-
- SKQD_StopStep=1;
- cSTOPONE=1;
- }
- if(cZipCnt > 1)
- {
- //李永庆代码
- if(((SKQD_cRealPos) < (SKQD_PARAM_GO_LOW_SPEED_LENGTH+1200)))// || (SKQD_QIAN_DEC_IN))
- {
-
- SKQD_MotorStep =65;
- }
- if(SKQD_QIAN_LIMIT_IN) //前点限位
- {
- SetPos(X_AXIS, SKQD_PARAM_QDW_LENGTH);
- AxisMovePosAccDec(X_AXIS,1000,-SKQD_PARAM_QDW_LENGTH,1000,1000,5,5,00);
- SKQD_MotorStep = 66;
- }
- }
- else
- {
- if(SKQD_QIAN_LIMIT_IN) //前点限位
- {
- SetPos(X_AXIS, SKQD_PARAM_QDW_LENGTH);
- AxisMovePosAccDec(X_AXIS,1000,-SKQD_PARAM_QDW_LENGTH,1000,1000,5,5,00);
- SKQD_MotorStep = 66;
- }
- }
-
- break;
- case 65:
- if(SKQD_ANQUANMEN_LIMIT_IN_UP)
- {
-
- SKQD_StopStep=1;
- cSTOPONE=1;
- }
- if(SKQD_QIAN_LIMIT_IN)
- {
- SetPos(X_AXIS, SKQD_PARAM_QDW_LENGTH);
- AxisMovePosAccDec(X_AXIS,1000,-SKQD_PARAM_QDW_LENGTH,1000,1000,5,5,00);
- SKQD_MotorStep = 66;
-
- }
- else if(dwTickCount >= SKQD_MotorDelay)
- SKQD_SetAlarmCode(SKQD_NO_ZIPPER_ALARM);
-
- break;
- case 66:
- if(SKQD_ANQUANMEN_LIMIT_IN_UP)
- {
-
- SKQD_StopStep=1;
- cSTOPONE=1;
- }
- if(!X_DRV || SKQD_cRealPos<0)
- {
- AxisEgmStop(X_AXIS);
- SetPos(X_AXIS, 0);
- if(!SKQD_bDanBuAuto || SKQD_START_IN_UP)
- {
- SKQD_MotorDelay = dwTickCount;
- SKQD_MotorStep = 67;
- }
- }
- break;
- case 67: //等推链完成后,
- if((dwTickCount >= SKQD_MotorDelay) && (SKQD_TuiLianStep == 0) && ((SKQD_PARAM_TIAOSHI_MODE && SKQD_bTS) || (SKQD_PARAM_TIAOSHI_MODE == 0)) )
- {
- if(bRunning)
- {
- SKQD_JD_VAVLE = 1;
- SKQD_MotorDelay = dwTickCount + SKQD_PARAM_DELAY_BACK;
- }
- SKQD_MotorStep = 68;
- }
- break;
- case 68:
- if(dwTickCount >= SKQD_MotorDelay)
- {
- if(!SKQD_bDanBuAuto || SKQD_START_IN_UP)
- {
- SKQD_HULIAN_VAVLE=0;
- SKQD_YD_ONE_VAVLE=0;
- SKQD_YD_VAVLE = 0;
- SKQD_HL_VAVLE = 0;
- SKQD_YX_VAVLE = 0;
- SKQD_CHUIQIStep=1;
- SKQD_TL_VAVLE = 0;
- SKQD_MotorStep = 0;
- SKQD_MotorDelay = dwTickCount;
- }
- }
- break;
-
- }
- }
- }
- #endif
- //电机动作
- void SK_QueDuan_Motor(void)
- {
- if(SKQD_KB_MODE) //闭口
- {
- #if SKQD_KB_MODE //闭口
- SK_QueDuan_Motor_NoGL();
- #endif
- }
- else //开口
- {
- #if !SKQD_KB_MODE //开口
- SK_QueDuan_Motor_KK(); //
- #endif
- }
-
- }
- void SK_QueDuan_TuiLianAction(void)
- {
- if(SKQD_PARAM_XM_ENABLE == 0)
- {
- SKQD_TuiLianStep = 0;
- }
- else
- {
- switch(SKQD_TuiLianStep)
- {
- case 1:
- SKQD_TuiLianStep = 2;
- break;
- case 2:
- SKQD_TLDelay = dwTickCount + SKQD_PARAM_YD_DELAY;
- SKQD_TuiLianStep = 3;
- break;
- case 3:
- if(!SKQD_SM_VAVLE && !SKQD_SHANG_MU_LIMIT_IN)//dwTickCount >= SKQD_TLDelay)
- {
- SKQD_TL_VAVLE = 1;
- // SKQD_TFK_VAVLE = 0;
- // if(!bRunning)SKQD_TFK_VAVLE = 1;
-
- SKQD_TLDelay = dwTickCount + SKQD_PARAM_TL_DELAY;
- SKQD_TuiLianStep = 4;
- }
- break;
- case 4:
- if(dwTickCount >= SKQD_TLDelay)
- {
- SKQD_TuiLianStep = 0;
-
- }
- break;
- case 10:
-
- SKQD_TuiLianStep = 11;
- break;
- case 11:
- if(!Y_DRV)
- {
- {
- SKQD_TuiLianStep = 0;
- }
- }
- break;
- }
- }
- }
- //闭口专用
- void SK_QueDuan_XiaQue_NO_GL(void)
- {
- switch(SKQD_XiaQieStep)
- {
- case 0:
- break;
- case 1:
- if(!bRunning)
- {
- SKQD_YD_VAVLE = 1;
- SKQD_HULIAN_VAVLE=1;
- SKQD_YD_ONE_VAVLE=1;
- SKQD_XiaQieStep = 2;
- SKQD_XiaQieDelay = dwTickCount + 80;
-
- }
- else
- {
- SKQD_YD_VAVLE = 1;
- SKQD_XiaQieDelay = dwTickCount + 20;
- SKQD_XiaQieStep = 2;
- }
- break;
- case 2:
- if(dwTickCount >= SKQD_XiaQieDelay)
- {
- SKQD_GZ_VAVLE=1;
- if(SKQD_PARAM_GouZhen_MODE)
- SKQD_GZ_VAVLE=0;
- SKQD_XiaQieStep = 3;
- SKQD_XiaQieDelay = dwTickCount + SKQD_PARAM_CUT_DELAY;
- }
- break;
- case 3:
- if(dwTickCount >= SKQD_XiaQieDelay && (bRunning || !SKQD_GOUZHEN_IN ))
- {
-
- if(!SKQD_bDanBuAuto || SKQD_START_IN_UP)
- {
- if((SKQD_PARAM_TIAOSHI_MODE && SKQD_bTS) || (SKQD_PARAM_TIAOSHI_MODE == 0))
- {
- SKQD_SM_VAVLE = 1;
- if(!SKQD_PARAM_XM_ENABLE)
- SKQD_XM_VAVLE = 1;
- SKQD_XiaQieDelay = dwTickCount + VAVLE_ALARM_TIME; //
- SKQD_XiaQieStep = 4;
- }
- }
-
-
- }
-
- break;
- case 4://永兴为下模固定
- if(SKQD_SHANG_MU_LIMIT_IN && (SKQD_XIA_MU_LIMIT_IN || SKQD_PARAM_XM_ENABLE))
- {
- if(!SKQD_bDanBuAuto || SKQD_START_IN_UP)
- {
- SKQD_GZ_VAVLE = 0;
- if(!SKQD_PARAM_CS_MODE) //气切
- {
- SKQD_XiaQieDelay = dwTickCount + SKQD_PARAM_DELAYBACK_SM; //
- SKQD_XiaQieStep = 5;
- }
- else
- {
- SKQD_XiaQieDelay = dwTickCount + SKQD_PARAM_DELAY_CS; //
- SKQD_XiaQieStep = 10;
- }
- }
- }
- else if(dwTickCount >= SKQD_XiaQieDelay)SKQD_SetAlarmCode(SKQD_SM_DAOWEI);
- break;
- case 5:
- if(dwTickCount >= SKQD_XiaQieDelay)
- {
- if(!SKQD_bDanBuAuto || SKQD_START_IN_UP)
- {
-
- SKQD_SM_VAVLE = 0;
- SKQD_XM_VAVLE = 0;
- SKQD_XiaQieDelay = dwTickCount + VAVLE_ALARM_TIME; //
- SKQD_XiaQieStep = 6;
- }
- }
- break;
- case 6:
- if(!SKQD_SHANG_MU_LIMIT_IN && (!SKQD_XIA_MU_LIMIT_IN || SKQD_PARAM_XM_ENABLE)) //下模不动就不用判断
- {
- if(!SKQD_bDanBuAuto || SKQD_START_IN_UP)
- {
- if(SKQD_TuiLianStep == 0)
- SKQD_TuiLianStep = 1;
- if(!bRunning)
- SKQD_JD_VAVLE = 0;
- SKQD_XiaQieStep = 0;
- }
-
- }
- else if(dwTickCount >= SKQD_XiaQieDelay)
- {
- SKQD_SetAlarmCode(SKQD_SM_YUANWEI);
- }
-
- break;
- //10~11步为超声
- case 10:
- if(dwTickCount >= SKQD_XiaQieDelay)
- {
- if(!SKQD_bDanBuAuto || SKQD_START_IN_UP)
- {
- if(SKQD_PARAM_CS_ENABLE)SKQD_CS_OUT = 1;
- SKQD_XiaQieDelay = dwTickCount + SKQD_PARAM_CS_TIME; //
- SKQD_XiaQieStep = 11;
- }
- }
- break;
- case 11:
- if(dwTickCount >= SKQD_XiaQieDelay)
- {
- SKQD_CS_OUT = 0;
- SKQD_XiaQieDelay = dwTickCount + SKQD_PARAM_CS_COLD_TIME; //
- SKQD_XiaQieStep = 5;
- }
- break;
- case 100:
- if(dwTickCount >= SKQD_XiaQieDelay)
- {
-
- //这是双开程序,暂时不考虑
- #if 1
- if(SKQD_GOUZHEN_IN)
- {
- SKQD_YD_VAVLE = 1;
- SKQD_XiaQieStep = 3;
- }
- #endif
- }
- break;
- }
- }
- //切断动作
- void SK_QueDuan_XiaQue(void)
- {
-
- if(SKQD_KB_MODE) //闭口
- {
- SK_QueDuan_XiaQue_NO_GL(); //
- }
-
- }
- #endif
|