1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284228522862287228822892290229122922293229422952296229722982299230023012302230323042305230623072308230923102311231223132314231523162317231823192320232123222323232423252326232723282329233023312332233323342335233623372338233923402341234223432344234523462347234823492350235123522353235423552356235723582359236023612362236323642365236623672368236923702371237223732374237523762377237823792380238123822383238423852386238723882389239023912392239323942395239623972398239924002401240224032404240524062407240824092410241124122413241424152416241724182419242024212422242324242425242624272428242924302431243224332434243524362437243824392440244124422443244424452446244724482449245024512452245324542455245624572458245924602461246224632464246524662467246824692470247124722473247424752476247724782479248024812482248324842485248624872488248924902491249224932494249524962497249824992500250125022503250425052506250725082509251025112512251325142515251625172518251925202521252225232524252525262527252825292530253125322533253425352536253725382539254025412542254325442545254625472548254925502551255225532554255525562557255825592560256125622563256425652566256725682569257025712572257325742575257625772578257925802581258225832584258525862587258825892590259125922593259425952596259725982599 |
- #include "global.h"
- #if XIN_YE_MACHINE
- void YYa_AlarmProtect(void);
- void YYa_ManualAction(void);
- void YYa_AutoAction(void);
- void YYa_StepCheckStart(void);
- void YYa_ExtiActionX31(void);
- void YYa_SongLiao(void);
- void YY_JieTouControl(void);
- void YY_ZhuYou(void);
- void YY_Stop_Action(void);
- void YY_StartZYFirst(void);
- float YY_CalToothLength(unsigned short roll_diameter,unsigned short tooth_num);
- //输入齿数计算长度返回的是单位厘米
- unsigned long YY_ToothNumCalLengthCM(float single_length,unsigned short tooth_num,unsigned long zipper_num);
- //输入齿数计算长度返回的是单位英寸
- unsigned long YY_ToothNumCalLengthInch(float single_length,unsigned short tooth_num,unsigned long zipper_num);
- //输入长度厘米算齿数
- unsigned long YY_ToothLengthCMCalNum(float single_length,unsigned short tooth_length,unsigned long zipper_num);
- //输入长度厘米算英寸
- unsigned long YY_ToothLengthCMCalInch(float single_length,unsigned short tooth_length,unsigned long zipper_num);
- //输入厘米长度计算总长度单位米
- unsigned long YY_LengthCalLengthM(unsigned short set_length,unsigned short kongwei_length,unsigned long zipper_num);
- //输入英寸长度计算总长度
- unsigned long YY_InchLengthCalLength(unsigned short set_length,unsigned short kongwei_length,unsigned long zipper_num);
- //输入齿数计算长度返回的是单位米
- unsigned long YY_ToothNumCalLength(float single_length,unsigned short tooth_num,unsigned long zipper_num);
- //输入齿数计算长度返回的是单位米带浮点型
- float YY_ToothNumCalLengthFloat(float single_length,unsigned short tooth_num,unsigned long zipper_num);
- //输入长度英寸算齿数
- unsigned long YY_ToothLengthInchCalNum(float single_length,unsigned short tooth_length,unsigned long zipper_num);
- //输入长度英寸算厘米
- unsigned long YY_ToothLengthInchCalCM(float single_length,unsigned short tooth_length,unsigned long zipper_num);
- void YY_SetLeftPyData(unsigned short cLeftData,unsigned short cLeftKongWei);
- void YY_SetRightPyData(unsigned short cRightData,unsigned short cRightKongWei);
- void SetLeftSpaceDisplay(unsigned char mode,unsigned short source_data);
- void SetRightSpaceDisplay(unsigned char mode,unsigned short source_data);
- void YY_SetLeftDCTSpace(void);
- void YY_SetRightDCTSpace(void);
- void YY_SetLeftDCTTooth(void);
- void YY_SetRightDCTTooth(void);
- unsigned long YY_GetLeftToothNum(void);
- unsigned long YY_GetRightToothNum(void);
- unsigned long YY_GetLeftToothNumDisplay(void);
- unsigned long YY_GetRightToothNumDisplay(void);
- unsigned long YY_GetLeftSpace(void);
- unsigned long YY_GetRightSpace(void);
- unsigned long YY_GetLeftSpaceDisplay(void);
- unsigned long YY_GetRightSpaceDisplay(void);
- void YY_SetLeftDisplay(unsigned short source_data);
- void YY_SetRightDisplay(unsigned short source_data);
- void YY_SetLeftSpaceDisplay(unsigned short source_data);
- void YY_SetRightSpaceDisplay(unsigned short source_data);
- void YY_AddTotal(void);
- unsigned long YY_GetTotal(void);
- unsigned long YY_GetSetTotal(void);
- void YY_LeftToothDisplayAdd(void);
- void YY_RightToothDisplayAdd(void);
- void YY_LeftSpaceDisplayAdd(void);
- void YY_RightSpaceDisplayAdd(void);
- void YY_LeftOverSet(void);
- void YY_RightOverSet(void);
- float YY_SingleToothLength;
- unsigned long YY_cTotal,YY_ProOnceTime,YY_cJieDaiClrTotal,YY_cJieDaiState,YY_cJieDaiTotal;
- unsigned char YY_RightCountEnable,YY_cOverTotalLeftFlg = 0,YY_cOverTotalRightFlg = 0,YY_LeftOk,YY_RightOk,YY_ChangeNextGroupFlg,YY_cTatal_OK,YY_CalUseLifeFlg,
- YY_SaveParamFlg,YY_UseLifeNowGroup,YY_LastGroup,YY_cHeLian,YY_bOldMode,YY_OldGroup;
- unsigned short YY_NowLeftPyNum,YY_NowRightPyNum,YY_NowLeftPyKongWei,YY_NowRightPyKongWei,YY_ZYBuff,YY_cStartWorkTime;
- unsigned short YY_cStartPYFlag_Left,YY_cStartPYFlag_Right;
- YY_SingleParam_str *YY_SingleParam;
- YY_GroupParam_str *YY_GroupParam;
- YY_SystemParam_str *YY_SystemParam;
- YY_ComponentParam_str *YY_ComponentParam;
- void YYa_SetAlarmCode(unsigned short alarm_code)
- {
- YY_SystemParam->AlarmCode |= alarm_code;
- YY_bAlarmStop = 1;
- }
- void YYa_SetLifeAlarmCode(unsigned short alarm_code)
- {
- YY_ComponentParam->LifeAlarm |= 0x0001 << alarm_code;
- }
- void YYa_InitAction(void)
- {
- static unsigned long start_delay;
-
- YY_SingleParam = (YY_SingleParam_str *)&user_datas[YY_SINGLE_ADDR];
- YY_GroupParam = (YY_GroupParam_str *)&user_datas[YY_GROUP_ADDR];
- YY_SystemParam = (YY_SystemParam_str *)&user_datas[YY_SYSTEM_ADDR];
- YY_ComponentParam = (YY_ComponentParam_str *)&user_datas[YY_LIFE_ADDR];
-
- if(YY_SystemParam->NowGroup > 4)YY_SystemParam->NowGroup = 0;
-
- YY_SingleToothLength = YY_CalToothLength(YY_SystemParam->ToothLength,YY_SystemParam->ToothNum);
- YY_bMode = YY_SINGLE_MODE;
- YY_bDCTEnable = 1;
- YY_cTotal = YY_GetTotal();
-
- YY_StartZYFirst();
- YY_bCalculateTotal = 1; //bCalculate
- YY_SystemParam->AlarmCode = 0;
- start_delay = dwTickCount + 1000;
- while(dwTickCount <= start_delay)
- {
- io_app_read_input();
- }
- }
- void YYa_Action(void)
- {
- YYa_ManualAction();
- YYa_AutoAction();
- YY_ZhuYou();
- YYa_SongLiao();
- YYa_StepCheckStart(); // 调用脚踏开关检测程序
- YYa_AlarmProtect();
- }
- void YY_ClearJTData(void)
- {
- YY_cJieDaiState = 0;
- YY_cJieDaiTotal = 0;
- YY_cJieDaiClrTotal = 0;
- }
- //重设数据
- void YY_ReSetData(void)
- {
- unsigned char i;
- switch(YY_bMode)
- {
- case YY_SINGLE_MODE:
- {
- if((YY_SingleParam->DisplyLeftToothNum != YY_SingleParam->DisplyRightToothNum) || (YY_SingleParam->DisplyLeftToothNumSpace != YY_SingleParam->DisplyRightToothNumSpace))
- YY_RightCountEnable = 1;
- else
- YY_RightCountEnable = 0;
- YY_SingleParam->DisplyLeftToothNum = 0;
- YY_SingleParam->DisplyLeftToothLengthCM = 0;
- YY_SingleParam->DisplyLeftToothLengthINCH = 0;
- YY_SingleParam->DisplyLeftToothNumSpace = 0;
- YY_SingleParam->DisplyLeftToothLengthCMSpace = 0;
- YY_SingleParam->DisplyLeftToothLengthINCHSpace = 0;
- YY_SingleParam->DisplyRightToothNum = 0;
- YY_SingleParam->DisplyRightToothLengthCM = 0;
- YY_SingleParam->DisplyRightToothLengthINCH = 0;
- YY_SingleParam->DisplyRightToothNumSpace = 0;
- YY_SingleParam->DisplyRightToothLengthCMSpace = 0;
- YY_SingleParam->DisplyRightToothLengthINCHSpace = 0;
- YY_ClearJTData();
-
- }break;
- case YY_GROUP_MODE:
- {
- if((YY_GroupParam->DisplyLeftToothNum[YY_SystemParam->NowGroup] != YY_GroupParam->DisplyRightToothNum[YY_SystemParam->NowGroup]) || (YY_GroupParam->DisplyLeftToothNumSpace[YY_SystemParam->NowGroup] != YY_GroupParam->DisplyRightToothNumSpace[YY_SystemParam->NowGroup]))
- {
- YY_RightCountEnable = 1;
- }
- else
- {
- YY_RightCountEnable = 0;
- }
-
- for(i = 0;i < 5;i++)
- {
- YY_GroupParam->DisplyLeftToothNum[i] = 0;
- YY_GroupParam->DisplyLeftToothLengthCM[i] = 0;
- YY_GroupParam->DisplyLeftToothLengthINCH[i] = 0;
- YY_GroupParam->DisplyLeftToothNumSpace[i]= 0;
- YY_GroupParam->DisplyLeftToothLengthCMSpace[i]= 0;
- YY_GroupParam->DisplyLeftToothLengthINCHSpace[i]= 0;
- YY_GroupParam->DisplyRightToothNum[i]= 0;
- YY_GroupParam->DisplyRightToothLengthCM[i]= 0;
- YY_GroupParam->DisplyRightToothLengthINCH[i]= 0;
- YY_GroupParam->DisplyRightToothLengthCM[i]= 0;
- YY_GroupParam->DisplyRightToothLengthCMSpace[i]= 0;
- YY_GroupParam->DisplyRightToothLengthINCHSpace[i]= 0;
- YY_ClearJTData();
- }
- }break;
- }
- }
- unsigned long YY_CalOverLength(void)
- {
- unsigned char i;
- switch(YY_bMode)
- {
- case YY_SINGLE_MODE:
- {
- YY_SingleParam->OverLength = (YY_SingleParam->LeftToothLengthCM + YY_SingleParam->LeftToothLengthCMSpace) * YY_SingleParam->OverTotal / 1000;
- }break;
- case YY_GROUP_MODE:
- {
- YY_GroupParam->AllOverLength = 0;
- for(i=0;i<5;i++)
- {
- YY_GroupParam->AllOverLength += (YY_GroupParam->LeftToothLengthCM[i] + YY_GroupParam->LeftToothLengthCMSpace[i]) * YY_GroupParam->OverSetTotal[i] / 1000;
- }
- }break;
- default:return 0;
- }
- return 0;
- }
- void YY_CalProcessTime(unsigned long add_time)
- {
- unsigned long time_buff,hour_buff,minute_buff;
- unsigned char i;
- switch(YY_bMode)
- {
- case YY_SINGLE_MODE:
- {
- if(YY_MAIN_MOTOR)
- {
- time_buff = YY_SingleParam->OverTotal * (YY_SingleParam->LeftToothNum + YY_SingleParam->LeftToothNumSpace) * add_time;
- time_buff = time_buff / 1000;
-
- hour_buff = time_buff / 3600;
-
- YY_SingleParam->SetTimeHour = hour_buff;
- time_buff -= hour_buff * 3600;
-
- minute_buff = time_buff / 60;
-
- YY_SingleParam->SetTimeMinute = minute_buff;
- }
- }break;
- case YY_GROUP_MODE:
- {
- if(YY_MAIN_MOTOR)
- {
- time_buff = 0;
- for(i=0;i<5;i++)
- {
- time_buff += YY_GroupParam->OverSetTotal[i] * (YY_GroupParam->LeftToothNum[i] + YY_GroupParam->LeftToothNumSpace[i]) * add_time;
- }
- time_buff = time_buff / 1000;
-
- hour_buff = time_buff / 3600;
-
- YY_GroupParam->SetTimeHour = hour_buff;
- time_buff -= hour_buff * 3600;
-
- minute_buff = time_buff / 60;
-
- YY_GroupParam->SetTimeMinute = minute_buff;
-
- }
- }break;
- }
- }
- void YY_CalRemainTime(unsigned long one_time)
- {
- unsigned long time_buff,hour_buff,minute_buff;
- unsigned char i;
-
- switch(YY_bMode)
- {
- case YY_SINGLE_MODE:
- {
- time_buff = one_time * (YY_SingleParam->SetTotal - YY_SingleParam->OverTotal) * (YY_SingleParam->LeftToothNum + YY_SingleParam->LeftToothNumSpace);
-
- time_buff = time_buff / 1000;
-
- hour_buff = time_buff / 3600;
-
- YY_SingleParam->RemainTimeHour = hour_buff;
- time_buff -= hour_buff * 3600;
-
- minute_buff = time_buff / 60;
-
- YY_SingleParam->RemainTimeMinute = minute_buff;
-
- }break;
- case YY_GROUP_MODE:
- {
- time_buff = 0;
- for(i=0;i<5;i++)
- {
- time_buff += (YY_GroupParam->SetTotal[i] - YY_GroupParam->OverSetTotal[i]) * (YY_GroupParam->LeftToothNum[i] + YY_GroupParam->LeftToothNumSpace[i]) * one_time;
- }
- time_buff = time_buff / 1000;
-
- hour_buff = time_buff / 3600;
-
- YY_GroupParam->RemainTimeHour = hour_buff;
- time_buff -= hour_buff * 3600;
-
- minute_buff = time_buff / 60;
-
- YY_GroupParam->RemainTimeMinute = minute_buff;
- }break;
- }
- }
- void YY_cTotal_Time(void)
- {
- YY_CalOverLength();
- YY_CalProcessTime(YY_ProOnceTime);
- YY_CalRemainTime(YY_ProOnceTime);
- }
- //参数运算控制
- void YY_CalculataParam(void)
- {
- unsigned char i;
- unsigned long total_buff;
-
- if(YY_bMode != YY_bOldMode)
- {
- YY_cTotal = YY_GetTotal();
- }
- YY_bOldMode = YY_bMode;
-
- if(YY_SystemParam->NowGroup != YY_OldGroup)
- {
- YY_SystemParam->NextGroupBuff = YY_SystemParam->NowGroup + 1;
- }
- YY_OldGroup = YY_SystemParam->NowGroup;
-
- //输入右边的齿数
- if(YY_bCalInputRightToothNum)
- {
- YY_bCalInputRightToothNum = 0;
-
- YY_SingleParam->RightToothNumSpace = (YY_SingleParam->LeftToothNumSpace + YY_SingleParam->LeftToothNum) - YY_SingleParam->RightToothNum;
- YY_bCalInputToothNum = 1;
- }
-
- if(YY_bCalInputRightKongWei)
- {
- YY_bCalInputRightKongWei = 0;
-
- YY_SingleParam->RightToothNum = (YY_SingleParam->LeftToothNumSpace + YY_SingleParam->LeftToothNum) - YY_SingleParam->RightToothNumSpace;
- YY_bCalInputToothNum = 1;
- }
- //输入右边的长度
- if(YY_bCalInputRightToothNumLength)
- {
- YY_bCalInputRightToothNumLength = 0;
-
- YY_SingleParam->RightToothLengthCMSpace = (YY_SingleParam->LeftToothLengthCMSpace + YY_SingleParam->LeftToothLengthCM) - YY_SingleParam->RightToothLengthCM;
- YY_bCalInputLength = 1;
- }
-
- if(YY_bCalInputRightKongWeiLength)
- {
- YY_bCalInputRightKongWeiLength = 0;
-
- YY_SingleParam->RightToothLengthCM = (YY_SingleParam->LeftToothLengthCMSpace + YY_SingleParam->LeftToothLengthCM) - YY_SingleParam->RightToothLengthCMSpace;
- YY_bCalInputLength = 1;
- }
- //输入右边的英寸长度
- if(YY_bCalInputRightToothNumLengthInch)
- {
- YY_bCalInputRightToothNumLengthInch = 0;
-
- YY_SingleParam->RightToothLengthINCHSpace = (YY_SingleParam->LeftToothLengthINCHSpace + YY_SingleParam->LeftToothLengthINCH) - YY_SingleParam->RightToothLengthINCH;
- YY_bCalInputLengthInch = 1;
- }
-
- if(YY_bCalInputRightKongWeiLengthInch)
- {
- YY_bCalInputRightKongWeiLengthInch = 0;
-
- YY_SingleParam->RightToothLengthINCH = (YY_SingleParam->LeftToothLengthINCHSpace + YY_SingleParam->LeftToothLengthINCH) - YY_SingleParam->RightToothLengthINCHSpace;
- YY_bCalInputLengthInch = 1;
- }
-
-
- if(YY_bCalInputToothNum)
- {
- YY_bCalInputToothNum = 0;
-
- YY_SingleParam->LeftToothLengthCM = YY_ToothNumCalLengthCM(YY_SingleToothLength,YY_SingleParam->LeftToothNum,1);
- YY_SingleParam->LeftToothLengthINCH = YY_ToothNumCalLengthInch(YY_SingleToothLength,YY_SingleParam->LeftToothNum,1);
-
- YY_SingleParam->RightToothLengthCM = YY_ToothNumCalLengthCM(YY_SingleToothLength,YY_SingleParam->RightToothNum,1);
- YY_SingleParam->RightToothLengthINCH = YY_ToothNumCalLengthInch(YY_SingleToothLength,YY_SingleParam->RightToothNum,1);
-
- YY_SingleParam->LeftToothLengthCMSpace = YY_ToothNumCalLengthCM(YY_SingleToothLength,YY_SingleParam->LeftToothNumSpace,1);
- YY_SingleParam->LeftToothLengthINCHSpace = YY_ToothNumCalLengthInch(YY_SingleToothLength,YY_SingleParam->LeftToothNumSpace,1);
-
- YY_SingleParam->RightToothLengthCMSpace = YY_ToothNumCalLengthCM(YY_SingleToothLength,YY_SingleParam->RightToothNumSpace,1);
- YY_SingleParam->RightToothLengthINCHSpace = YY_ToothNumCalLengthInch(YY_SingleToothLength,YY_SingleParam->RightToothNumSpace,1);
-
- YY_GroupParam->AllSetLength = 0;
- for(i = 0;i < 5;i++)
- {
- YY_GroupParam->AllSetLength += YY_ToothNumCalLength(YY_SingleToothLength,(YY_GroupParam->LeftToothNum[i] + YY_GroupParam->LeftToothNumSpace[i]),YY_GroupParam->SetTotal[i]);
- }
-
- YY_SingleParam->SetLength = YY_ToothNumCalLength(YY_SingleToothLength,(YY_SingleParam->LeftToothNum + YY_SingleParam->LeftToothNumSpace),YY_SingleParam->SetTotal);
-
- YY_GroupParam->AllSetTotal = 0;
- for(i = 0;i < 5;i++)
- {
- YY_GroupParam->AllSetTotal += YY_GroupParam->SetTotal[i];
- }
- for(i = 0;i < 5;i++)
- {
- YY_GroupParam->LeftToothLengthCM[i] = YY_ToothNumCalLengthCM(YY_SingleToothLength,YY_GroupParam->LeftToothNum[i],1);
- }
-
- for(i = 0;i < 5;i++)
- {
- YY_GroupParam->LeftToothLengthCMSpace[i] = YY_ToothNumCalLengthCM(YY_SingleToothLength,YY_GroupParam->LeftToothNumSpace[i],1);
- }
- for(i = 0;i < 5;i++)
- {
- YY_GroupParam->LeftToothLengthINCH[i] = YY_ToothNumCalLengthInch(YY_SingleToothLength,YY_GroupParam->LeftToothNum[i],1);
- }
-
- for(i = 0;i < 5;i++)
- {
- YY_GroupParam->LeftToothLengthINCHSpace[i] = YY_ToothNumCalLengthInch(YY_SingleToothLength,YY_GroupParam->LeftToothNumSpace[i],1);
- }
-
- }
-
- if(YY_bCalInputLength)
- {
- YY_bCalInputLength = 0;
-
- YY_SingleParam->LeftToothLengthINCH = YY_ToothLengthCMCalInch(YY_SingleToothLength,YY_SingleParam->LeftToothLengthCM,1);
- YY_SingleParam->LeftToothNum = YY_ToothLengthCMCalNum(YY_SingleToothLength,YY_SingleParam->LeftToothLengthCM,1);
-
- YY_SingleParam->RightToothLengthINCH = YY_ToothLengthCMCalInch(YY_SingleToothLength,YY_SingleParam->RightToothLengthCM,1);
- YY_SingleParam->RightToothNum = YY_ToothLengthCMCalNum(YY_SingleToothLength,YY_SingleParam->RightToothLengthCM,1);
- YY_SingleParam->LeftToothLengthINCHSpace = YY_ToothLengthCMCalInch(YY_SingleToothLength,YY_SingleParam->LeftToothLengthCMSpace,1);
- YY_SingleParam->LeftToothNumSpace = YY_ToothLengthCMCalNum(YY_SingleToothLength,YY_SingleParam->LeftToothLengthCMSpace,1);
-
- YY_SingleParam->RightToothLengthINCHSpace = YY_ToothLengthCMCalInch(YY_SingleToothLength,YY_SingleParam->RightToothLengthCMSpace,1);
- YY_SingleParam->RightToothNumSpace = YY_ToothLengthCMCalNum(YY_SingleToothLength,YY_SingleParam->RightToothLengthCMSpace,1);
-
-
- YY_GroupParam->AllSetLength = 0;
- for(i = 0;i < 5;i++)
- {
- YY_GroupParam->AllSetLength += YY_LengthCalLengthM(YY_GroupParam->LeftToothLengthCM[i],YY_GroupParam->LeftToothLengthCMSpace[i],YY_GroupParam->SetTotal[i]);
- }
-
- YY_SingleParam->SetLength = YY_ToothNumCalLength(YY_SingleToothLength,(YY_SingleParam->LeftToothNum + YY_SingleParam->LeftToothNumSpace),YY_SingleParam->SetTotal);
-
- YY_GroupParam->AllSetTotal = 0;
- for(i = 0;i < 5;i++)
- {
- YY_GroupParam->AllSetTotal += YY_GroupParam->SetTotal[i];
- }
-
- for(i = 0;i < 5;i++)
- {
- YY_GroupParam->LeftToothNum[i] = YY_ToothLengthCMCalNum(YY_SingleToothLength,YY_GroupParam->LeftToothLengthCM[i],1);
- }
-
- for(i = 0;i < 5;i++)
- {
- YY_GroupParam->LeftToothNumSpace[i] = YY_ToothLengthCMCalNum(YY_SingleToothLength,YY_GroupParam->LeftToothLengthCMSpace[i],1);
- }
- for(i = 0;i < 5;i++)
- {
- YY_GroupParam->LeftToothLengthINCH[i] = YY_ToothLengthCMCalInch(YY_SingleToothLength,YY_GroupParam->LeftToothLengthCMSpace[i],1);
- }
-
- for(i = 0;i < 5;i++)
- {
- YY_GroupParam->LeftToothLengthINCHSpace[i] = YY_ToothLengthCMCalInch(YY_SingleToothLength,YY_GroupParam->LeftToothLengthCMSpace[i],1);
- }
-
- YY_bCalInputToothNum = 1;
- }
-
- if(YY_bCalInputLengthInch)
- {
- YY_bCalInputLengthInch = 0;
-
- YY_SingleParam->LeftToothLengthCM = YY_ToothLengthInchCalCM(YY_SingleToothLength,YY_SingleParam->LeftToothLengthINCH,1);
- YY_SingleParam->LeftToothNum = YY_ToothLengthInchCalNum(YY_SingleToothLength,YY_SingleParam->LeftToothLengthINCH,1);
-
- YY_SingleParam->RightToothLengthCM = YY_ToothLengthInchCalCM(YY_SingleToothLength,YY_SingleParam->RightToothLengthINCH,1);
- YY_SingleParam->RightToothNum = YY_ToothLengthInchCalNum(YY_SingleToothLength,YY_SingleParam->RightToothLengthINCH,1);
-
- YY_SingleParam->LeftToothLengthCMSpace = YY_ToothLengthInchCalCM(YY_SingleToothLength,YY_SingleParam->LeftToothLengthINCHSpace,1);
- YY_SingleParam->LeftToothNumSpace = YY_ToothLengthInchCalNum(YY_SingleToothLength,YY_SingleParam->LeftToothLengthINCHSpace,1);
-
- YY_SingleParam->RightToothLengthCMSpace = YY_ToothLengthInchCalCM(YY_SingleToothLength,YY_SingleParam->RightToothLengthINCHSpace,1);
- YY_SingleParam->RightToothNumSpace = YY_ToothLengthInchCalNum(YY_SingleToothLength,YY_SingleParam->RightToothLengthINCHSpace,1);
-
- YY_GroupParam->AllSetLength = 0;
- for(i = 0;i < 5;i++)
- {
- YY_GroupParam->AllSetLength += YY_InchLengthCalLength(YY_GroupParam->LeftToothLengthINCH[i],YY_GroupParam->LeftToothLengthINCHSpace[i],YY_GroupParam->SetTotal[i]);
- }
-
- YY_SingleParam->SetLength = YY_ToothNumCalLength(YY_SingleToothLength,(YY_SingleParam->LeftToothNum + YY_SingleParam->LeftToothNumSpace),YY_SingleParam->SetTotal);
-
- YY_GroupParam->AllSetTotal = 0;
- for(i = 0;i < 5;i++)
- {
- YY_GroupParam->AllSetTotal += YY_GroupParam->SetTotal[i];
- }
-
- for(i = 0;i < 5;i++)
- {
- YY_GroupParam->LeftToothNum[i] = YY_ToothLengthInchCalNum(YY_SingleToothLength,YY_GroupParam->LeftToothLengthINCH[i],1);
- }
-
- for(i = 0;i < 5;i++)
- {
- YY_GroupParam->LeftToothNumSpace[i] = YY_ToothLengthInchCalNum(YY_SingleToothLength,YY_GroupParam->LeftToothLengthINCHSpace[i],1);
- }
- for(i = 0;i < 5;i++)
- {
- YY_GroupParam->LeftToothLengthCM[i] = YY_ToothLengthInchCalCM(YY_SingleToothLength,YY_GroupParam->LeftToothLengthINCH[i],1);
- }
-
- for(i = 0;i < 5;i++)
- {
- YY_GroupParam->LeftToothLengthCMSpace[i] = YY_ToothLengthInchCalCM(YY_SingleToothLength,YY_GroupParam->LeftToothLengthINCHSpace[i],1);
- }
-
- YY_bCalInputToothNum = 1;
- }
-
- if(YY_bCalculateTotal) //下一程序周期计算长度的时间
- {
- YY_bCalculateTotal = 0; // 清通知位
-
- total_buff = 0;
-
- for(i = 0;i < 5;i++)
- {
- total_buff += YY_GroupParam->SetTotal[i];
- }
-
- if(YY_GroupParam->AllSetTotal > total_buff)YY_GroupParam->AllSetTotal = total_buff;
-
- YY_cTotal_Time();
- }
-
- if(YY_bCalAllLength)
- {
- YY_bCalAllLength = 0;
-
- YY_GroupParam->AllSetLength = 0;
- for(i = 0;i < 5;i++)
- {
- YY_GroupParam->AllSetLength += YY_ToothNumCalLength(YY_SingleToothLength,(YY_GroupParam->LeftToothNum[i] + YY_GroupParam->LeftToothNumSpace[i]),YY_GroupParam->SetTotal[i]);
- }
-
- YY_SingleParam->SetLength = YY_ToothNumCalLength(YY_SingleToothLength,(YY_SingleParam->LeftToothNum + YY_SingleParam->LeftToothNumSpace),YY_SingleParam->SetTotal);
- }
-
- if(YY_bClear1)
- {
- YY_bClear1 = 0;
- YY_GroupParam->OverSetTotal[0] = 0;
- YY_GroupParam->DisplyLeftToothLengthCM[0] = 0;
- YY_GroupParam->DisplyLeftToothLengthCMSpace[0] = 0;
- YY_GroupParam->DisplyLeftToothLengthINCHSpace[0] = 0;
- YY_GroupParam->DisplyLeftToothLengthINCH[0] = 0;
-
- YY_GroupParam->DisplyRightToothNum[0] = 0;
- YY_GroupParam->DisplyRightToothNumSpace[0] = 0;
- }
- if(YY_bClear2)
- {
- YY_bClear2 = 0;
- YY_GroupParam->OverSetTotal[1] = 0;
- YY_GroupParam->DisplyLeftToothLengthCM[1] = 0;
- YY_GroupParam->DisplyLeftToothLengthCMSpace[1] = 0;
- YY_GroupParam->DisplyLeftToothLengthINCHSpace[1] = 0;
- YY_GroupParam->DisplyLeftToothLengthINCH[1] = 0;
-
- YY_GroupParam->DisplyRightToothNum[1] = 0;
- YY_GroupParam->DisplyRightToothNumSpace[1] = 0;
- }
-
- if(YY_bClear3)
- {
- YY_bClear3 = 0;
- YY_GroupParam->OverSetTotal[2] = 0;
- YY_GroupParam->DisplyLeftToothLengthCM[2] = 0;
- YY_GroupParam->DisplyLeftToothLengthCMSpace[2] = 0;
- YY_GroupParam->DisplyLeftToothLengthINCHSpace[2] = 0;
- YY_GroupParam->DisplyLeftToothLengthINCH[2] = 0;
-
- YY_GroupParam->DisplyRightToothNum[2] = 0;
- YY_GroupParam->DisplyRightToothNumSpace[2] = 0;
- }
- if(YY_bClear4)
- {
- YY_bClear4 = 0;
- YY_GroupParam->OverSetTotal[3] = 0;
- YY_GroupParam->DisplyLeftToothLengthCM[3] = 0;
- YY_GroupParam->DisplyLeftToothLengthCMSpace[3] = 0;
- YY_GroupParam->DisplyLeftToothLengthINCHSpace[3] = 0;
- YY_GroupParam->DisplyLeftToothLengthINCH[3] = 0;
-
- YY_GroupParam->DisplyRightToothNum[3] = 0;
- YY_GroupParam->DisplyRightToothNumSpace[3] = 0;
- }
-
- if(YY_bClear5)
- {
- YY_bClear5 = 0;
- YY_GroupParam->OverSetTotal[4] = 0;
- YY_GroupParam->DisplyLeftToothLengthCM[4] = 0;
- YY_GroupParam->DisplyLeftToothLengthCMSpace[4] = 0;
- YY_GroupParam->DisplyLeftToothLengthINCHSpace[4] = 0;
- YY_GroupParam->DisplyLeftToothLengthINCH[4] = 0;
-
- YY_GroupParam->DisplyRightToothNum[4] = 0;
- YY_GroupParam->DisplyRightToothNumSpace[4] = 0;
- }
- }
- void YY_StartZYFirst(void)
- {
- YY_ZYBuff = YY_SystemParam->StartOilTime;
- YY_bFirstZY = 1; //M100 倒时显示
- YY_bZhuYou = 1;
- YY_ZYDelay = dwTickCount + 1000;
- YY_OIL_MOTOR = 1;
- YY_DISPLAY_STATE = 1;
- YY_OilCheckDelay = dwTickCount + 2500;
- }
- void YY_ZhuYou(void)
- {
- if(YY_OIL_MOTOR)
- {
- if((dwTickCount >= YY_ZYDelay) || (YY_bZhuYou == 0))
- {
- if(YY_bFirstZY)
- {
- YY_ZYDelay = dwTickCount + 1000;
- if(YY_SystemParam->StartOilTime)
- {
- YY_SystemParam->StartOilTime--;
- }
- if((YY_SystemParam->StartOilTime == 0) || (YY_bZhuYou == 0)) //初次注油完成
- {
- YY_bFirstZY = 0; //M100
- YY_OIL_MOTOR = 0; //注油机关
- YY_SystemParam->StartOilTime = YY_ZYBuff;
- YY_ZYDelay = dwTickCount + YY_SystemParam->IntOilTime * 60 * 1000;
- YY_DISPLAY_STATE = 2; //注油完成
- }
- }
- else
- {
- YY_OIL_MOTOR = 0; //注油机关
- if(YY_bZhuYou)
- YY_ZYDelay = dwTickCount + YY_SystemParam->IntOilTime * 60 * 1000; //间隔注油时间 分钟
- else
- YY_ZYDelay = dwTickCount;
- }
- YY_bZYNow = 0; //M8 清通知位
- }
- }
- else if(YY_bZhuYou && ((dwTickCount >= YY_ZYDelay) || YY_bZYNow) && YY_EGMSTOP_IN)
- {
- //大于1小时,重新先注油
- if(((dwTickCount - YY_ZYDelay) > (3600 * 1000)) && (dwTickCount >= YY_ZYDelay))
- {
- YY_StartZYFirst();
- }
- else
- {
- YY_OIL_MOTOR = 1;
- YY_ZYDelay = dwTickCount + YY_SystemParam->OilTime * 1000; //注油时间 秒
- YY_OilCheckDelay = dwTickCount + (unsigned long)2500; //延时检测油压
- }
- YY_bZYNow = 0; //M8 清通知位
- }
- }
- //手动动作
- void YYa_ManualAction(void)
- {
- //合链机启动
- if(YY_bHL)
- {
- if(YY_HL_DW_IN)
- {
- YY_HL_MOTOR = 1;
- }
- else if(YY_HL_UP_IN)
- {
- YY_HL_MOTOR = 0;
- }
- }
- else
- {
- YY_HL_MOTOR = 0;
- }
-
- if(YY_bPYMotor)
- {
- YY_bPYMotor = 0;
-
- if(YY_MAIN_MOTOR)
- {
- if(!YY_bRunning)YY_bPYControl = 0;
- }
- else if(YY_bZhuYou && !YY_bOnceStartPower) YY_bPYControl = 1;
- }
-
- if(YY_bPYControl)
- {
- if(YY_MAIN_MOTOR == 0)
- {
- YY_CheckDelay = dwTickCount + 1000;
- YY_OIL_MOTOR = 1;
- YY_ZhuYouDelay = dwTickCount + 1000*YY_SystemParam->OilTime;
- YY_CheckDelay = dwTickCount + 2500;
- }
- YY_MAIN_MOTOR = 1;
- }
- else
- {
- if(YY_MAIN_MOTOR)
- {
- YY_CheckDelay = dwTickCount + 1000;
- }
- YY_MAIN_MOTOR = 0;
- }
-
- if(YY_bClearTotal)
- {
- YY_bClearTotal = 0;
- switch(YY_bMode)
- {
- case YY_SINGLE_MODE:
- {
- YY_SystemParam->AllProductTime += YY_SingleParam->SetTimeHour;
- YY_SystemParam->AllProductTime += YY_SingleParam->SetTimeMinute/60;
- YY_SingleParam->OverTotal = 0;
- YY_SingleParam->OverLength = 0;
- YY_SingleParam->SetTimeHour = 0;
- YY_SingleParam->SetTimeMinute = 0;
- }break;
- case YY_GROUP_MODE:
- {
- YY_SystemParam->AllProductTime += YY_GroupParam->SetTimeHour;
- YY_SystemParam->AllProductTime += YY_GroupParam->SetTimeMinute/60;
- YY_GroupParam->AllOverTotal = 0;
- YY_GroupParam->AllOverLength = 0;
- YY_GroupParam->SetTimeHour = 0;
- YY_GroupParam->SetTimeMinute = 0;
- }break;
-
- }
- YY_cTotal = 0;
- }
-
- /* if(YY_bClearAll)
- {
- YY_bClearAll = 0;
- YY_SystemParam->AllProductTime = 0;
- YY_SystemParam->AllProductLength = 0;
- }*/
-
- if(!YY_bRunning)
- {
- if((YY_bChangeNextGroup) && (YY_GroupParam->DisplyLeftToothNum[YY_SystemParam->NowGroup] == 0) && (YY_GroupParam->DisplyLeftToothNumSpace[YY_SystemParam->NowGroup] == 0))
- {
- YY_bChangeNextGroup = 0;
- YY_SystemParam->NowGroup = YY_SystemParam->NextGroupBuff - 1;
- }
-
-
- if(YY_bReset)
- {
- YY_bReset = 0;
- switch(YY_bMode)
- {
- case YY_SINGLE_MODE:
- {
- YY_ReSetData();
- }break;
- case YY_GROUP_MODE:
- {
- YY_ReSetData();
- }break;
- }
- }
- }
-
- //故障清除
- if(YY_bClearAlarm)
- {
- if(YY_SystemParam->AlarmCode& YY_TOOTH_NUM_ALARM) //叠牙时直接打空位
- {
- YY_ReSetData(); //6空位,6牙
- }
- YY_ALARM_LED = 0;
- YY_SystemParam->AlarmCode = 0;
- YY_bClearAlarm = 0;
- }
-
- if(YY_bSetDCTEnable)
- {
- YY_bSetDCTEnable = 0;
- if(YY_bDCTEnable)
- {
- YY_SingleParam->DisplyLeftToothNum = 0;
- YY_SingleParam->DisplyLeftToothLengthCM = 0;
- YY_SingleParam->DisplyLeftToothLengthINCH = 0;
- YY_SingleParam->DisplyLeftToothNumSpace = 0;
- YY_SingleParam->DisplyLeftToothLengthCMSpace = 0;
- YY_SingleParam->DisplyLeftToothLengthINCHSpace = 0;
- YY_SingleParam->DisplyRightToothNum = 0;
- YY_SingleParam->DisplyRightToothLengthCM = 0;
- YY_SingleParam->DisplyRightToothLengthINCH = 0;
- YY_SingleParam->DisplyRightToothNumSpace = 0;
- YY_SingleParam->DisplyRightToothLengthCMSpace = 0;
- YY_SingleParam->DisplyRightToothLengthINCHSpace = 0;
- YY_cStartPYFlag_Left = 1;
- YY_cStartPYFlag_Right = 1;
- }
- else
- {
- YY_cStartPYFlag_Left = 0;
- YY_cStartPYFlag_Right = 0;
- YY_SingleParam->DisplyLeftToothNum = 0;
- YY_SingleParam->DisplyLeftToothLengthCM = 0;
- YY_SingleParam->DisplyLeftToothLengthINCH = 0;
- YY_SingleParam->DisplyLeftToothNumSpace = 0;
- YY_SingleParam->DisplyLeftToothLengthCMSpace = 0;
- YY_SingleParam->DisplyLeftToothLengthINCHSpace = 0;
- YY_SingleParam->DisplyRightToothNum = 0;
- YY_SingleParam->DisplyRightToothLengthCM = 0;
- YY_SingleParam->DisplyRightToothLengthINCH = 0;
- YY_SingleParam->DisplyRightToothNumSpace = 0;
- YY_SingleParam->DisplyRightToothLengthCMSpace = 0;
- YY_SingleParam->DisplyRightToothLengthINCHSpace = 0;
- YY_SetLeftDCTSpace();
- YY_SetRightDCTSpace();
- }
- }
-
- YY_CalculataParam();
- }
- //拉链接头控制处理
- void YY_JieTouControl(void)
- {
- //接头检测
- if(YY_JT_IN_UP) //空位
- {
- YY_cJieDaiTotal = YY_SystemParam->JieTouMJToothNum;
- YY_cJieDaiClrTotal = 0;
- YY_cJieDaiState = 1;
- }
- else if(YY_JT_IN_DW)
- {
- YY_cJieDaiState = 2;
- if(YY_cJieDaiTotal == 0)
- {
- YY_cJieDaiTotal = YY_SystemParam->JieTouMJToothNum;
- }
- else
- {
- }
- }
- }
- void YY_CountYaError(void)
- {
- unsigned short i;
- switch(YY_bMode)
- {
- case YY_SINGLE_MODE:
- {
- //数牙出错
- /* if(UserParam->LeftOverToothNum || UserParam->RightOverToothNum)
- {
- if(UserParam->LeftOverToothNum >= UserParam->RightOverToothNum)
- {
- i = UserParam->LeftOverToothNum - UserParam->RightOverToothNum;
- }
- else
- i = UserParam->RightOverToothNum - UserParam->LeftOverToothNum;
- // 正常打牙状态
- if((i > 2) && (((i < (UserParam->LeftSetNum-1)) && (cStartPYFlag_Right == 0))
- // 复位打牙状态
- ||(cStartPYFlag_Right && (i < 5))))
-
- {
- M88 = 1; //M88 数牙出错
- ALARM_CODE = 88;
-
- if(Y017 == 0)Y16 = 1;
-
- }
- }
- else if((UserParam->LeftOverKongWei || UserParam->RightOverKongWei) && UserParam->LeftSetKongWei)
- {
- if(UserParam->LeftOverKongWei >= UserParam->RightOverKongWei)
- {
- i = UserParam->LeftOverKongWei - UserParam->RightOverKongWei;
- }
- else
- i = UserParam->RightOverKongWei - UserParam->LeftOverKongWei;
- if((i > 2) && (i != UserParam->LeftSetKongWei))
- {
- M88 = 1; //M88 数牙出错
- ALARM_CODE = 88;
- if(Y16 == 0)Y017 = 1;
-
- }
- } */
- }break;
- case YY_GROUP_MODE:
- {
- //数牙出错
- if(YY_GroupParam->DisplyLeftToothNum[YY_SystemParam->NowGroup] || YY_GroupParam->DisplyRightToothNum[YY_SystemParam->NowGroup])
- {
- if(YY_GroupParam->DisplyLeftToothNum[YY_SystemParam->NowGroup] >= YY_GroupParam->DisplyRightToothNum[YY_SystemParam->NowGroup])
- {
- i = YY_GroupParam->DisplyLeftToothNum[YY_SystemParam->NowGroup] - YY_GroupParam->DisplyRightToothNum[YY_SystemParam->NowGroup];
- }
- else
- i = YY_GroupParam->DisplyRightToothNum[YY_SystemParam->NowGroup] - YY_GroupParam->DisplyLeftToothNum[YY_SystemParam->NowGroup];
- // 正常打牙状态
- if((i > 2) && (((i < (YY_GroupParam->LeftToothNum[YY_SystemParam->NowGroup]-1)) && (YY_cStartPYFlag_Right == 0))
- // 复位打牙状态
- ||(YY_cStartPYFlag_Right && (i < 5))))
- {
-
- YYa_SetAlarmCode(YY_TOOTH_NUM_ALARM);
- if(Y017 == 0)Y16 = 1;
-
- }
- }
- else if((YY_GroupParam->DisplyLeftToothNumSpace[YY_SystemParam->NowGroup] || YY_GroupParam->DisplyRightToothNumSpace[YY_SystemParam->NowGroup]) && YY_GroupParam->LeftToothNumSpace[YY_SystemParam->NowGroup])
- {
- if(YY_GroupParam->DisplyLeftToothNumSpace[YY_SystemParam->NowGroup] >= YY_GroupParam->DisplyRightToothNumSpace[YY_SystemParam->NowGroup])
- {
- i = YY_GroupParam->DisplyLeftToothNumSpace[YY_SystemParam->NowGroup] - YY_GroupParam->DisplyRightToothNumSpace[YY_SystemParam->NowGroup];
- }
- else
- i = YY_GroupParam->DisplyRightToothNumSpace[YY_SystemParam->NowGroup] - YY_GroupParam->DisplyLeftToothNumSpace[YY_SystemParam->NowGroup];
- if((i > 2) && (i != YY_GroupParam->LeftToothNumSpace[YY_SystemParam->NowGroup]))
- {
- YYa_SetAlarmCode(YY_TOOTH_NUM_ALARM);
- if(Y16 == 0)Y017 = 1;
-
- }
- }
- }break;
- }
- }
- void YY_RefreshLengthInch(void)
- {
- unsigned char i;
- switch(YY_bMode)
- {
- case YY_SINGLE_MODE:
- {
- YY_SingleParam->DisplyLeftToothLengthCM = YY_ToothNumCalLengthCM(YY_SingleToothLength,YY_SingleParam->DisplyLeftToothNum,1);
- YY_SingleParam->DisplyLeftToothLengthCMSpace = YY_ToothNumCalLengthCM(YY_SingleToothLength,YY_SingleParam->DisplyLeftToothNumSpace,1);
- YY_SingleParam->DisplyRightToothLengthCM = YY_ToothNumCalLengthCM(YY_SingleToothLength,YY_SingleParam->DisplyRightToothNum,1);
- YY_SingleParam->DisplyRightToothLengthCMSpace = YY_ToothNumCalLengthCM(YY_SingleToothLength,YY_SingleParam->DisplyRightToothNumSpace,1);
- YY_SingleParam->DisplyLeftToothLengthINCH = YY_ToothNumCalLengthInch(YY_SingleToothLength,YY_SingleParam->DisplyLeftToothNum,1);
- YY_SingleParam->DisplyLeftToothLengthINCHSpace = YY_ToothNumCalLengthInch(YY_SingleToothLength,YY_SingleParam->DisplyLeftToothNumSpace,1);
- YY_SingleParam->DisplyRightToothLengthINCH = YY_ToothNumCalLengthInch(YY_SingleToothLength,YY_SingleParam->DisplyRightToothNum,1);
- YY_SingleParam->DisplyRightToothLengthINCHSpace = YY_ToothNumCalLengthInch(YY_SingleToothLength,YY_SingleParam->DisplyRightToothNumSpace,1);
- }break;
- case YY_GROUP_MODE:
- {
- for(i=0;i < 5;i++)
- {
- YY_GroupParam->DisplyLeftToothLengthCM[i] = YY_ToothNumCalLengthCM(YY_SingleToothLength,YY_GroupParam->DisplyLeftToothNum[i],1);
- YY_GroupParam->DisplyLeftToothLengthCMSpace[i] = YY_ToothNumCalLengthCM(YY_SingleToothLength,YY_GroupParam->DisplyLeftToothNumSpace[i],1);
- YY_GroupParam->DisplyLeftToothLengthINCH[i]= YY_ToothNumCalLengthInch(YY_SingleToothLength,YY_GroupParam->DisplyLeftToothNum[i],1);
- YY_GroupParam->DisplyLeftToothLengthINCHSpace[i] = YY_ToothNumCalLengthInch(YY_SingleToothLength,YY_GroupParam->DisplyLeftToothNumSpace[i],1);
- }
- }break;
- }
- }
- void YY_ReFreshRemainLife(void)
- {
- unsigned char i;
-
- for(i=0;i<16;i++)
- {
- YY_ComponentParam->RemainLife[i] = YY_ComponentParam->LeftRightLife[i] - YY_ComponentParam->LeftRightUsedLife[i];
- }
- }
- void YY_DisplayStateRefresh(void)
- {
- unsigned char i;
- switch(YY_bMode)
- {
- case YY_SINGLE_MODE:
- {
-
- }break;
- case YY_GROUP_MODE:
- {
- if(YY_bRunning)
- {
- for(i=0;i<5;i++)
- {
- if(i==YY_SystemParam->NowGroup)YY_SystemParam->TotalDisplayState[i] = 1;
- else
- {
- if(YY_GroupParam->OverSetTotal[i] < YY_GroupParam->SetTotal[i])
- {
- YY_SystemParam->TotalDisplayState[i] = 0;//待加工组
- }
- else
- {
- YY_SystemParam->TotalDisplayState[i] = 2;//已完成组
- }
- }
- }
- }
- else
- {
- for(i=0;i<5;i++)
- {
- if(i==(YY_SystemParam->NextGroupBuff - 1))YY_SystemParam->TotalDisplayState[i] = 1;
- else
- {
- if(YY_GroupParam->OverSetTotal[i] < YY_GroupParam->SetTotal[i])
- {
- YY_SystemParam->TotalDisplayState[i] = 0;//待加工组
- }
- else
- {
- YY_SystemParam->TotalDisplayState[i] = 2;//已完成组
- }
- }
- }
- }
- }break;
- }
- }
- //错误停机
- void YY_Error_Action(void)
- {
- static unsigned long tx_cnt = 0;
- if(YY_EGMSTOP_IN == 0) //紧急停止
- {
- YYa_SetAlarmCode(YY_EGM_ALARM);
- }
-
- if(dwTickCount >= YY_ErrorDelay)
- {
- if(YY_YW_IN) //液位警告
- {
- YYa_SetAlarmCode(YY_OIL_VOLUME_ALARM);
- }
- if(YY_TX_IN) //铜线故障
- {
- tx_cnt++;
- if(tx_cnt > 1000)
- {
- YYa_SetAlarmCode(YY_TONG_XIAN_ALARM);
- }
- }
- else
- tx_cnt = 0;
- if(YY_CX_IN && YY_MAIN_MOTOR) //叠牙
- {
- YYa_SetAlarmCode(YY_CHENG_XING_ALARM);
- }
- if(YY_KD_IN) //卡带故障(布带1)
- {
- YYa_SetAlarmCode(YY_KA_DAI_ALARM);
- }
- if(YY_ZIPPER_IN) //没带故障(布带2)
- {
- YYa_SetAlarmCode(YY_QUE_DAI_ALARM);
- }
- if(YY_HL_LIMIT_IN) //合链上限、下限位开关(合链1)
- {
- YYa_SetAlarmCode(YY_JIN_LIAN_ALARM);
- }
-
- if(dwTickCount >= YY_OilCheckDelay)
- {
- YY_OilCheckDelay= dwTickCount+ 100;
- //油压不到警告
- if(YY_OIL_MOTOR)
- {
- if(YY_YY_IN)
- {
- YYa_SetAlarmCode(YY_OIL_PRESSURE_ALARM);
- }
- }
- }
-
- YY_CountYaError();
- YY_RefreshLengthInch();
- YY_ReFreshRemainLife();
- YY_DisplayStateRefresh();
-
- }
- }
- void YYa_AlarmProtect(void)
- {
- YY_Error_Action();
- //旋转电磁铁动作
- if((YY_LEFT_IN || YY_LEFT_OUT) && (dwTickCount >= YY_LCntDelay)) //左边
- {
- YY_LEFT_IN = 0;
- YY_LEFT_OUT = 0;
- }
- if((YY_RIGHT_IN || YY_RIGHT_OUT) && (dwTickCount >= YY_RCntDelay)) //右边
- {
- YY_RIGHT_IN = 0;
- YY_RIGHT_OUT = 0;
- }
- }
- //检测现在加工是否会换组
- unsigned short YY_CheckHaveChangeGroup(void)
- {
- switch(YY_bMode)
- {
- case YY_SINGLE_MODE:
- {
- return 0;
- }break;
- case YY_GROUP_MODE:
- {
- if(YY_GroupParam->OverSetTotal[YY_SystemParam->NowGroup] == (YY_GroupParam->SetTotal[YY_SystemParam->NowGroup] - 1))
- return 1;
- else
- return 0;
- }break;
- default:return 0;
- }
- }
- //检测剩余齿数够不够完成拉链
- unsigned short YY_CheckRemainToothOk(void)
- {
- unsigned short toothbuff1,toothbuff2;
- switch(YY_bMode)
- {
- case YY_SINGLE_MODE:
- {
- if(((YY_SingleParam->LeftToothNum+YY_SingleParam->LeftToothNumSpace) - (YY_SingleParam->DisplyLeftToothNum+YY_SingleParam->DisplyLeftToothNumSpace)) <= YY_cJieDaiTotal)
- {
- return 1;
- }
- else
- {
- return 0;
- }
- }break;
- case YY_GROUP_MODE:
- {
- toothbuff1 = YY_GroupParam->LeftToothNum[YY_SystemParam->NowGroup] + YY_GroupParam->LeftToothNumSpace[YY_SystemParam->NowGroup];
- toothbuff2 = YY_GroupParam->DisplyLeftToothNum[YY_SystemParam->NowGroup] + YY_GroupParam->DisplyLeftToothNumSpace[YY_SystemParam->NowGroup];
- if(YY_CheckHaveChangeGroup())
- {
- if((toothbuff1 - toothbuff2 + YY_SystemParam->DifferentLengthToothNum) <= YY_cJieDaiTotal)
- {
- return 1;
- }
- else
- {
- return 0;
- }
- }
- else
- {
- if((toothbuff1 - toothbuff2) <= YY_cJieDaiTotal)
- {
- return 1;
- }
- else
- {
- return 0;
- }
- }
- }break;
- default:return 0;
- }
- }
- unsigned short YY_FindNextUserFulGroup(unsigned short now_group)
- {
- unsigned char i;
-
- for(i=(now_group + 1);i<5;i++)
- {
- if((YY_GroupParam->OverSetTotal[i] < YY_GroupParam->SetTotal[i]) && (YY_GroupParam->SetTotal[i] != 0)) return i;
- }
-
- for(i=0;i<now_group;i++)
- {
- if((YY_GroupParam->OverSetTotal[i] < YY_GroupParam->SetTotal[i]) && (YY_GroupParam->SetTotal[i] != 0)) return i;
- }
-
- return 99;
- }
- void YY_ChangeGroupControlLeft(void)
- {
- switch(YY_bMode)
- {
- case YY_SINGLE_MODE:
- {
- }break;
- case YY_GROUP_MODE:
- {
- if(YY_GroupParam->SetTotal[YY_SystemParam->NowGroup] != 0)
- {
- if(YY_GroupParam->OverSetTotal[YY_SystemParam->NowGroup] < YY_GroupParam->SetTotal[YY_SystemParam->NowGroup])
- {
-
- }
- else
- {
- if(YY_FindNextUserFulGroup(YY_SystemParam->NowGroup) != 99)
- {
- YY_SetLeftPyData(0,YY_SystemParam->DifferentLengthToothNum);
- YY_SetRightPyData(0,YY_SystemParam->DifferentLengthToothNum);
- YY_cStartPYFlag_Left = 1;
- YY_cStartPYFlag_Right = 1;
- YY_SystemParam->NowGroup = YY_FindNextUserFulGroup(YY_SystemParam->NowGroup);
- }
- }
- }
- }
- }
- }
- //搜索全部做完没有
- unsigned long YY_FindCanWorkNum(void)
- {
- unsigned char i;
-
- switch(YY_bMode)
- {
- case YY_SINGLE_MODE:
- {
- return 1;
- }break;
- case YY_GROUP_MODE:
- {
- for(i=0;i < 5;i++)
- {
- if(YY_GroupParam->OverSetTotal[i] < YY_GroupParam->SetTotal[i])return 1;
- }
-
- return 0;
- }break;
- default:return 0;
- }
- }
- //左边排牙动作
- /*
- 当在按下复位时就先打6空位,再打6牙
- */
- void YY_Left_Action(void)
- {
- YY_DIAPLAY0 = YY_cTotal;
- YY_DIAPLAY1 = YY_GetSetTotal();
- YY_DIAPLAY2 = YY_FindCanWorkNum();
- if(YY_LEFT_COUNT_IN_UP && YY_bDCTEnable)
- {
- YY_RightCountEnable = 0;
-
- if(YY_cJieDaiState == 1)
- {
- if(YY_cJieDaiTotal)
- {
- YY_cJieDaiClrTotal++;
- }
- else
- YY_cJieDaiClrTotal = 0;
- }
- if(YY_cJieDaiTotal && YY_cJieDaiState)
- {
- YY_cJieDaiTotal--;
- if(YY_cJieDaiTotal == 0)
- {
- YY_cStartPYFlag_Left = 3;
- YY_cStartPYFlag_Right = 3;
-
- if(YY_GetLeftSpace() == 0) // 空位设定
- {
- YY_SetLeftPyData(0,YY_cJieDaiClrTotal + 10 + YY_SystemParam->JieTouToothNum);
- YY_SetRightPyData(0,YY_cJieDaiClrTotal + 10 +YY_SystemParam->JieTouToothNum);
- YY_SetLeftSpaceDisplay(0);
- YY_SetLeftDisplay(0);
- YY_SetRightSpaceDisplay(0);
- YY_SetRightDisplay(0);
- YY_cJieDaiState = 0;
- }
- else
- {
- YY_SetLeftPyData(0,YY_cJieDaiClrTotal + 6 + YY_SystemParam->JieTouToothNum);
- YY_SetRightPyData(0,YY_cJieDaiClrTotal + 6 + YY_SystemParam->JieTouToothNum);
- YY_SetLeftSpaceDisplay(0);
- YY_SetLeftDisplay(0);
- YY_SetRightSpaceDisplay(0);
- YY_SetRightDisplay(0);
- YY_cJieDaiState = 0;
- }
-
- if(YY_cJieDaiState == 2)YY_cJieDaiState = 0;
-
- if(YY_bDCTEnable)
- {
- YY_SetLeftDCTSpace();
- YY_SetRightDCTSpace();
- }
- }
- }
- if(YY_NowLeftPyKongWei)
- {
- if(YY_cStartPYFlag_Left)
- {
- YY_cStartPYFlag_Left = 0;
- //变为空位,不用铜丝
- if(YY_bDCTEnable)
- {
- YY_SetLeftDCTSpace();
- }
- }
- YY_NowLeftPyKongWei--;
-
- if(YY_NowLeftPyKongWei == 0)YY_cStartPYFlag_Left = 1;
- }
- else if(YY_NowLeftPyNum)
- {
- if(YY_cStartPYFlag_Left && (YY_cOverTotalLeftFlg == 0))
- {
- YY_cStartPYFlag_Left = 0;
-
- if(YY_bDCTEnable)
- {
- //变为打牙,
- YY_SetLeftDCTTooth();
- }
- }
- YY_NowLeftPyNum--;
-
- if(YY_NowLeftPyNum == 0)
- {
- YY_cStartPYFlag_Left = 1;
- YY_cOverTotalLeftFlg = 0;
- }
- }
- else if(YY_GetLeftToothNum() > YY_GetLeftToothNumDisplay()) //打齿状态
- {
- if(YY_cStartPYFlag_Left)
- {
- YY_cStartPYFlag_Left = 0;
-
- if(YY_bDCTEnable)
- {
- //变为打牙,
- YY_SetLeftDCTTooth();
- }
- }
-
- YY_LeftToothDisplayAdd();
-
- if(YY_cJieDaiState)
- {
- if(YY_GetLeftSpace() != 0)
- {
- if(YY_CheckRemainToothOk())
- {
- }
- else
- {
- YY_SetLeftPyData(0,YY_cJieDaiTotal);
- YY_SetLeftSpaceDisplay(0);
- YY_SetLeftDisplay(0);
-
- YY_SetRightPyData(0,YY_cJieDaiTotal);
- YY_SetRightSpaceDisplay(0);
- YY_SetRightDisplay(0);
-
- YY_cStartPYFlag_Left = 1;
- YY_cStartPYFlag_Right = 1;
- }
- }
- }
-
- if(YY_GetLeftToothNum() == YY_GetLeftToothNumDisplay()) //打完齿
- {
- YY_cStartPYFlag_Left = 1;
- YY_LeftOverSet();
- if(YY_GetLeftSpace() == 0)
- {
- if(YY_bChangeNextGroup)
- {
- YY_bChangeNextGroup = 0;
- YY_SystemParam->NowGroup = YY_SystemParam->NextGroupBuff - 1;
- YY_SetLeftPyData(0,YY_SystemParam->DifferentLengthToothNum);
- YY_SetRightPyData(0,YY_SystemParam->DifferentLengthToothNum);
- YY_cStartPYFlag_Left = 1;
- YY_cStartPYFlag_Right = 1;
- }
-
- YY_ChangeGroupControlLeft();
-
- YY_SetLeftSpaceDisplay(0);
- YY_SetLeftDisplay(0);
- }
- //按停止 或产量到
- if(YY_bSingStop || (YY_cTotal >= YY_GetSetTotal()) || (YY_FindCanWorkNum() == 0))
- {
- if(YY_GetLeftSpace() == 0)
- {
- if((YY_cTotal >= YY_GetSetTotal()) || (YY_FindCanWorkNum() == 0))
- {
- YY_SetLeftPyData(10,YY_SystemParam->DifferentLengthToothNum);
- YY_SetRightPyData(10,YY_SystemParam->DifferentLengthToothNum);
- YY_cStartPYFlag_Left = 1;
- YY_cStartPYFlag_Right = 1;
-
- YY_cOverTotalRightFlg = 1;
- YY_cOverTotalLeftFlg = 1;
- }
- }
-
- YY_Stop_Action();
- if(YY_bSingStop == 0)YY_DISPLAY_STATE = 4;
- }
- YY_LeftOk = 0;
- }
- }
- else if(YY_GetLeftSpace() > YY_GetLeftSpaceDisplay()) //空位状态
- {
- if(YY_cStartPYFlag_Left)
- {
- YY_cStartPYFlag_Left = 0;
- if(YY_bDCTEnable)
- {
- //变为空位,不用铜丝
- YY_SetLeftDCTSpace();
- }
- }
-
- YY_LeftSpaceDisplayAdd();
-
- if(YY_GetLeftSpace() == YY_GetLeftSpaceDisplay())
- {
- //只有大于一条拉链时才打牙状态
- if(YY_cJieDaiState)
- {
- if(YY_CheckRemainToothOk())
- {
- }
- else
- {
- if(YY_cJieDaiState != 0)
- {
- YY_SetLeftPyData(0,YY_cJieDaiTotal);
- YY_SetLeftSpaceDisplay(0);
- YY_SetLeftDisplay(0);
-
- YY_SetRightPyData(0,YY_cJieDaiTotal);
- YY_SetRightSpaceDisplay(0);
- YY_SetRightDisplay(0);
- }
- }
- }
-
- YY_SetLeftSpaceDisplay(0);
- YY_SetLeftDisplay(0);
- YY_cStartPYFlag_Left = 1;
- YY_LeftOk = 1;
- if(YY_ChangeNextGroupFlg && YY_RightOk)
- {
- YY_RightOk = 0;
- YY_LeftOk = 0;
- YY_ChangeNextGroupFlg = 0;
- YY_SetLeftSpaceDisplay(0);
- YY_SetLeftDisplay(0);
- if(YY_bChangeNextGroup)
- {
- YY_bChangeNextGroup = 0;
- YY_SystemParam->NowGroup = YY_SystemParam->NextGroupBuff - 1;
- YY_SetLeftPyData(0,YY_SystemParam->DifferentLengthToothNum);
- YY_SetRightPyData(0,YY_SystemParam->DifferentLengthToothNum);
- YY_cStartPYFlag_Left = 1;
- YY_cStartPYFlag_Right = 1;
- }
-
- YY_ChangeGroupControlLeft();
- }
-
-
- }
- }
-
- //如叠牙或数牙导常的情况下,不能送牙
- if((YY_SystemParam->AlarmCode == YY_CHENG_XING_ALARM) || (YY_SystemParam->AlarmCode == YY_TOOTH_NUM_ALARM) || !YY_bDCTEnable)// || M81 || M80)
- {
- YY_SetLeftDCTSpace();
- }
-
- YY_ProOnceTime = dwTickCount - YY_CalProcessDelay; //计算时间
- YY_CalProcessDelay = dwTickCount;
- }
- }
- void YY_LeftOverSet(void)
- {
- switch(YY_bMode)
- {
- case YY_SINGLE_MODE:
- {
- //产量计数
- //当两边的齿都打完时,产量加1
- if(YY_cTatal_OK)
- {
- YY_cTatal_OK = 0;
- YY_cTotal++;
- YY_AddTotal();
- YY_CalUseLifeFlg = 1;
- YY_bCalculateTotal = 1;
- }
- else
- YY_cTatal_OK = 1;
- }break;
- case YY_GROUP_MODE:
- {
- //产量计数
- //当两边的齿都打完时,产量加1
- if(YY_cTatal_OK)
- {
- YY_cTatal_OK = 0;
- YY_cTotal++;
- YY_AddTotal();
- YY_CalUseLifeFlg = 1;
- YY_bCalculateTotal = 1;
- YY_SaveParamFlg = 1;
- YY_UseLifeNowGroup = YY_SystemParam->NowGroup;
- YY_LastGroup = YY_SystemParam->NowGroup;
- YY_ChangeNextGroupFlg = 1;
- }
- else
- {
- YY_cTatal_OK = 1;
- }
-
- }break;
- }
- }
- void YY_RightOverSet(void)
- {
- //产量计数
- //当两边的齿都打完时,产量加1
- if(YY_cTatal_OK)
- {
- YY_cTatal_OK = 0;
- YY_cTotal++;
- YY_AddTotal();
- YY_CalUseLifeFlg = 1;
- YY_bCalculateTotal = 1;
- YY_UseLifeNowGroup = YY_SystemParam->NowGroup;
- YY_LastGroup = YY_SystemParam->NowGroup;
- YY_ChangeNextGroupFlg = 1;
- }
- else
- {
- YY_cTatal_OK = 1;
- }
- }
- void YY_Right_Action(void)
- {
-
- if(YY_RIGHT_COUNT_IN_UP && (YY_RightCountEnable == 0) && YY_bDCTEnable)
- {
- if(YY_NowRightPyKongWei)
- {
- if(YY_cStartPYFlag_Right)
- {
- YY_cStartPYFlag_Right = 0;
-
- if(YY_bDCTEnable)
- {
- //变为空位,不用铜丝
- YY_SetRightDCTSpace();
- }
- }
- YY_NowRightPyKongWei--;
-
- if((YY_NowRightPyKongWei == 0))YY_cStartPYFlag_Right = 1;
- }
- else if(YY_NowRightPyNum)
- {
- if(YY_cStartPYFlag_Right && (YY_cOverTotalRightFlg == 0))
- {
- YY_cStartPYFlag_Right = 0;
- //变为打牙,
- if(YY_bDCTEnable)
- {
- YY_SetRightDCTTooth();
- }
- }
- YY_NowRightPyNum--;
- if(YY_NowRightPyNum == 0)
- {
- YY_cStartPYFlag_Right = 1;
- YY_cOverTotalRightFlg = 0;
- }
- }
- else if(YY_GetRightToothNum() > YY_GetRightToothNumDisplay()) //打齿状态
- {
- if(YY_cStartPYFlag_Right)
- {
- YY_cStartPYFlag_Right = 0;
- if(YY_bDCTEnable)
- {
- //变为打牙,
- YY_SetRightDCTTooth();
- }
- }
-
- YY_RightToothDisplayAdd();
-
- if(YY_GetRightToothNum() == YY_GetRightToothNumDisplay()) //打齿状态
- {
- YY_cStartPYFlag_Right = 1;
-
- YY_RightOverSet();
-
- if(YY_GetRightSpace() == 0)
- {
- YY_SetRightSpaceDisplay(0);
- YY_SetRightDisplay(0);
- if(YY_bChangeNextGroup)
- {
- YY_bChangeNextGroup = 0;
- YY_SystemParam->NowGroup = YY_SystemParam->NextGroupBuff - 1;
- YY_SetLeftPyData(0,YY_SystemParam->DifferentLengthToothNum);
- YY_SetRightPyData(0,YY_SystemParam->DifferentLengthToothNum);
- YY_cStartPYFlag_Left = 1;
- YY_cStartPYFlag_Right = 1;
- }
-
- YY_ChangeGroupControlLeft();
- }
- //按停止 或产量到
- if(YY_bSingStop || (YY_cTotal >= YY_GetSetTotal()) || (YY_FindCanWorkNum() == 0))
- {
- if(YY_GetLeftSpace() == 0)
- {
- if((YY_cTotal >= YY_GetSetTotal()) || (YY_FindCanWorkNum() == 0))
- {
- YY_SetLeftPyData(10,YY_SystemParam->DifferentLengthToothNum);
- YY_SetRightPyData(10,YY_SystemParam->DifferentLengthToothNum);
- YY_cStartPYFlag_Left = 1;
- YY_cStartPYFlag_Right = 1;
- YY_cOverTotalRightFlg = 1;
- YY_cOverTotalLeftFlg = 1;
- }
- }
- YY_Stop_Action();
- if(YY_bSingStop == 0)YY_DISPLAY_STATE = 4;
- }
- YY_RightOk = 0;
-
- }
- }
- else if(YY_GetRightSpace() > YY_GetRightSpaceDisplay()) //空位状态
- {
- if(YY_cStartPYFlag_Right)
- {
- YY_cStartPYFlag_Right = 0;
- if(YY_bDCTEnable)
- {
- //变为空位,不用铜丝
- YY_SetRightDCTSpace();
- }
- }
-
- YY_RightSpaceDisplayAdd();
-
- if(YY_GetRightSpace() == YY_GetRightSpaceDisplay())
- {
- YY_SetRightSpaceDisplay(0);
- YY_SetRightDisplay(0);
- YY_cStartPYFlag_Right = 1;
- YY_RightOk = 1;
- if(YY_ChangeNextGroupFlg && YY_LeftOk)
- {
- YY_ChangeNextGroupFlg = 0;
- YY_LeftOk = 0;
- YY_RightOk = 0;
- if(YY_bChangeNextGroup)
- {
- YY_bChangeNextGroup = 0;
- YY_SystemParam->NowGroup = YY_SystemParam->NextGroupBuff - 1;
- YY_SetLeftPyData(10,YY_SystemParam->DifferentLengthToothNum);
- YY_SetRightPyData(10,YY_SystemParam->DifferentLengthToothNum);
- YY_cStartPYFlag_Left = 1;
- YY_cStartPYFlag_Right = 1;
- }
-
- YY_ChangeGroupControlLeft();
- }
-
- }
-
- }
-
-
- //如叠牙的情况下,不能送牙
- if((YY_SystemParam->AlarmCode == YY_CHENG_XING_ALARM) || (YY_SystemParam->AlarmCode == YY_TOOTH_NUM_ALARM) || !YY_bDCTEnable)// || M81 || M80)
- {
- YY_SetRightDCTSpace();
- }
- }
- }
- void YYa_AutoAction(void)
- {
- YY_Left_Action();
- YY_Right_Action();
- }
- void YYa_SongLiao(void)
- {
- //送丝启动
- if(YY_bSongSi)
- {
- //左送料(送丝)
- if(YY_LEFT_SL_DW_IN)
- {
- YY_LEFT_SL_MOTOR = 1;
- }
- else if(YY_LEFT_SL_UP_IN)
- {
- YY_LEFT_SL_MOTOR = 0;
- }
- //右送料(送丝)
- if(YY_RIGHT_SL_DW_IN)
- {
- YY_RIGHT_SL_MOTOR = 1;
- }
- else if(YY_RIGHT_SL_UP_IN)
- {
- YY_RIGHT_SL_MOTOR = 0;
- }
- }
- else
- {
- YY_LEFT_SL_MOTOR = 0;
- YY_RIGHT_SL_MOTOR = 0;
- }
- }
- // 停止工作
- void YY_Stop_Action(void)
- {
- YY_bWorkState = 0; //M7 工作显示
- if((YY_EGMSTOP_IN == 0) && ((YY_SystemParam->AlarmCode & YY_TOOTH_NUM_ALARM) == 0))YY_bZhuYou = 0; // 注油控制
- YY_bHL = 0;
- YY_bSongSi = 0;
- YY_bPYControl = 0;
- YY_DISPLAY_STATE = 2;
- YY_bRunning = 0;
- YY_bSingStop = 0;
- }
- //启动时检测当前要加工的组别可不可以加工,不可以就切换到可以加工的组别
- unsigned char YY_StartCheckChoose(void)
- {
- switch(YY_bMode)
- {
- case YY_SINGLE_MODE:
- {
- return 1;
- }break;
- case YY_GROUP_MODE:
- {
- if(YY_GroupParam->OverSetTotal[YY_SystemParam->NowGroup] < YY_GroupParam->SetTotal[YY_SystemParam->NowGroup])
- {
- return 1;
- }
- else
- {
- if(YY_FindNextUserFulGroup(YY_SystemParam->NowGroup) != 99)
- {
- if((YY_GroupParam->DisplyLeftToothNumSpace[YY_SystemParam->NowGroup] == 0) && (YY_GroupParam->DisplyRightToothNum[YY_SystemParam->NowGroup] == 0))YY_SystemParam->NowGroup = YY_FindNextUserFulGroup(YY_SystemParam->NowGroup);
-
- return 1;
- }
- else
- {
- return 0;
- }
- }
- }break;
- default:return 0;
- }
- }
- void YYa_StepCheckStart(void)
- {
- if(YY_bFirstZY == 0)//首次加油已经完成
- {
- if((YY_bStart || YY_START_IN_UP) && !YY_bRunning && YY_bZhuYou && (YY_STOP_IN == 0) && (YY_SystemParam->AlarmCode== 0) && (YY_StartCheckChoose() == 1)&& (YY_cTotal < YY_GetSetTotal()))
- {
- YY_bWorkState = 1; //M7 工作显示
- YY_bHL = 1; //M4 合链控制
- YY_bSongSi = 1; //M5 送丝控制
- YY_bPYControl = 1; //M6 排牙控制
- YY_bZYNow = 1; //M8 马上注油D2时间
- YY_DISPLAY_STATE = 3;
- YY_bRunning = 1;
- // YY_DIAPLAY1++;
- if(!YY_bDCTEnable)
- {
- YY_cStartWorkTime = 3;
- }
- }
- YY_bStart = 0; //M0
- }
- else
- {
- YY_bStart = 0; //M0
- }
-
- if((YY_cStartWorkTime != 0) && (dwTickCount >= YY_TryDelay))
- {
- YY_cStartWorkTime--;
- YY_SetLeftDCTSpace();
- YY_SetRightDCTSpace();
- YY_TryDelay = dwTickCount + 500;
- }
- //停止
- if(YY_STOP_IN || (YY_bAlarmStop == 1) || YY_bStop)
- {
- // 普通停止是打完当条再停止
- if((YY_bStop || (YY_STOP_IN)) && YY_bDCTEnable)
- {
- if(YY_bPYControl)YY_bSingStop = 1;
- }
- else //其它故障都要立即停止
- {
- if(YY_bRunning)YY_ALARM_LED = 1;
- YY_Stop_Action();
- }
- YY_bStop = 0; //M0 系统复位
- YY_bAlarmStop = 0;
- }
-
-
- }
- //零件寿命相关控制和运算
- void YYa_CalParts(void)
- {
- // AddUsedLifeControl();
- if(YY_bClearLife1)
- {
- YY_bClearLife1 = 0;
- YY_ComponentParam->LeftRightLife[0] = 0;
- YY_ComponentParam->LeftRightUsedLife[0] = 0;
-
- YY_ComponentParam->RefreshTimes[0]++;
- }
-
- if(YY_bClearTimes1)
- {
- YY_bClearTimes1 = 0;
- YY_ComponentParam->RefreshTimes[0] = 0;
- }
-
- if(YY_bClearLife2)
- {
- YY_bClearLife2 = 0;
- YY_ComponentParam->LeftRightLife[1] = 0;
- YY_ComponentParam->LeftRightUsedLife[1] = 0;
-
- YY_ComponentParam->RefreshTimes[1]++;
- }
-
- if(YY_bClearTimes2)
- {
- YY_bClearTimes2 = 0;
- YY_ComponentParam->RefreshTimes[1] = 0;
- }
-
- if(YY_bClearLife3)
- {
- YY_bClearLife3 = 0;
- YY_ComponentParam->LeftRightLife[2] = 0;
- YY_ComponentParam->LeftRightUsedLife[2] = 0;
-
- YY_ComponentParam->RefreshTimes[2]++;
- }
-
- if(YY_bClearTimes3)
- {
- YY_bClearTimes3 = 0;
- YY_ComponentParam->RefreshTimes[2] = 0;
- }
-
- if(YY_bClearLife4)
- {
- YY_bClearLife4 = 0;
- YY_ComponentParam->LeftRightLife[3] = 0;
- YY_ComponentParam->LeftRightUsedLife[3] = 0;
-
- YY_ComponentParam->RefreshTimes[3]++;
- }
-
- if(YY_bClearTimes4)
- {
- YY_bClearTimes4 = 0;
- YY_ComponentParam->RefreshTimes[3] = 0;
- }
-
- if(YY_bClearLife5)
- {
- YY_bClearLife5 = 0;
- YY_ComponentParam->LeftRightLife[4] = 0;
- YY_ComponentParam->LeftRightUsedLife[4] = 0;
-
- YY_ComponentParam->RefreshTimes[4]++;
- }
-
- if(YY_bClearTimes5)
- {
- YY_bClearTimes5 = 0;
- YY_ComponentParam->RefreshTimes[4] = 0;
- }
-
- if(YY_bClearLife6)
- {
- YY_bClearLife6 = 0;
- YY_ComponentParam->LeftRightLife[5] = 0;
- YY_ComponentParam->LeftRightUsedLife[5] = 0;
-
- YY_ComponentParam->RefreshTimes[5]++;
- }
-
- if(YY_bClearTimes6)
- {
- YY_bClearTimes6 = 0;
- YY_ComponentParam->RefreshTimes[5] = 0;
- }
-
- if(YY_bClearLife7)
- {
- YY_bClearLife7 = 0;
- YY_ComponentParam->LeftRightLife[6] = 0;
- YY_ComponentParam->LeftRightUsedLife[6] = 0;
-
- YY_ComponentParam->RefreshTimes[6]++;
- }
-
- if(YY_bClearTimes7)
- {
- YY_bClearTimes7 = 0;
- YY_ComponentParam->RefreshTimes[6] = 0;
- }
-
- if(YY_bClearLife8)
- {
- YY_bClearLife8 = 0;
- YY_ComponentParam->LeftRightLife[7] = 0;
- YY_ComponentParam->LeftRightUsedLife[7] = 0;
-
- YY_ComponentParam->RefreshTimes[7]++;
- }
-
- if(YY_bClearTimes8)
- {
- YY_bClearTimes8 = 0;
- YY_ComponentParam->RefreshTimes[7] = 0;
- }
-
- if(YY_bClearLife9)
- {
- YY_bClearLife9 = 0;
- YY_ComponentParam->LeftRightLife[8] = 0;
- YY_ComponentParam->LeftRightUsedLife[8] = 0;
-
- YY_ComponentParam->RefreshTimes[8]++;
- }
-
- if(YY_bClearTimes9)
- {
- YY_bClearTimes9 = 0;
- YY_ComponentParam->RefreshTimes[8] = 0;
- }
-
- if(YY_bClearLife10)
- {
- YY_bClearLife10 = 0;
- YY_ComponentParam->LeftRightLife[9] = 0;
- YY_ComponentParam->LeftRightUsedLife[9] = 0;
-
- YY_ComponentParam->RefreshTimes[9]++;
- }
-
- if(YY_bClearTimes10)
- {
- YY_bClearTimes10 = 0;
- YY_ComponentParam->RefreshTimes[9] = 0;
- }
-
- if(YY_bClearLife11)
- {
- YY_bClearLife11 = 0;
- YY_ComponentParam->LeftRightLife[10] = 0;
- YY_ComponentParam->LeftRightUsedLife[10] = 0;
-
- YY_ComponentParam->RefreshTimes[10]++;
- }
-
- if(YY_bClearTimes11)
- {
- YY_bClearTimes1 = 0;
- YY_ComponentParam->RefreshTimes[10] = 0;
- }
-
- if(YY_bClearLife12)
- {
- YY_bClearLife12 = 0;
- YY_ComponentParam->LeftRightLife[11] = 0;
- YY_ComponentParam->LeftRightUsedLife[11] = 0;
-
- YY_ComponentParam->RefreshTimes[11]++;
- }
-
- if(YY_bClearTimes12)
- {
- YY_bClearTimes12 = 0;
- YY_ComponentParam->RefreshTimes[11] = 0;
- }
-
- if(YY_bClearLife13)
- {
- YY_bClearLife13 = 0;
- YY_ComponentParam->LeftRightLife[12] = 0;
- YY_ComponentParam->LeftRightUsedLife[12] = 0;
-
- YY_ComponentParam->RefreshTimes[12]++;
- }
-
- if(YY_bClearTimes13)
- {
- YY_bClearTimes13 = 0;
- YY_ComponentParam->RefreshTimes[12] = 0;
- }
-
- if(YY_bClearLife14)
- {
- YY_bClearLife14 = 0;
- YY_ComponentParam->LeftRightLife[13] = 0;
- YY_ComponentParam->LeftRightUsedLife[13] = 0;
-
- YY_ComponentParam->RefreshTimes[13]++;
- }
-
- if(YY_bClearTimes14)
- {
- YY_bClearTimes14 = 0;
- YY_ComponentParam->RefreshTimes[13] = 0;
- }
-
- if(YY_bClearLife15)
- {
- YY_bClearLife15 = 0;
- YY_ComponentParam->LeftRightLife[14] = 0;
- YY_ComponentParam->LeftRightUsedLife[14] = 0;
-
- YY_ComponentParam->RefreshTimes[14]++;
- }
-
- if(YY_bClearTimes15)
- {
- YY_bClearTimes15 = 0;
- YY_ComponentParam->RefreshTimes[14] = 0;
- }
-
- if(YY_bClearLife16)
- {
- YY_bClearLife16 = 0;
- YY_ComponentParam->LeftRightLife[15] = 0;
- YY_ComponentParam->LeftRightUsedLife[15] = 0;
-
- YY_ComponentParam->RefreshTimes[15]++;
- }
-
- if(YY_bClearTimes16)
- {
- YY_bClearTimes16 = 0;
- YY_ComponentParam->RefreshTimes[15] = 0;
- }
- }
- ///////////////////////////////////////////////////////////////////////////////////////////////
- void YY_LeftToothDisplayAdd(void)
- {
- switch(YY_bMode)
- {
- case YY_SINGLE_MODE:YY_SingleParam->DisplyLeftToothNum++;break;
- case YY_GROUP_MODE:YY_GroupParam->DisplyLeftToothNum[YY_SystemParam->NowGroup]++;break;
- }
- }
- void YY_RightToothDisplayAdd(void)
- {
- switch(YY_bMode)
- {
- case YY_SINGLE_MODE:YY_SingleParam->DisplyRightToothNum++;break;
- case YY_GROUP_MODE:YY_GroupParam->DisplyRightToothNum[YY_SystemParam->NowGroup]++;break;
- }
- }
- void YY_LeftSpaceDisplayAdd(void)
- {
- switch(YY_bMode)
- {
- case YY_SINGLE_MODE:YY_SingleParam->DisplyLeftToothNumSpace++;break;
- case YY_GROUP_MODE:YY_GroupParam->DisplyLeftToothNumSpace[YY_SystemParam->NowGroup]++;break;
- }
- }
- void YY_RightSpaceDisplayAdd(void)
- {
- switch(YY_bMode)
- {
- case YY_SINGLE_MODE:YY_SingleParam->DisplyRightToothNumSpace++;break;
- case YY_GROUP_MODE:YY_GroupParam->DisplyRightToothNumSpace[YY_SystemParam->NowGroup]++;break;
- }
- }
- unsigned long YY_GetLeftToothNum(void)
- {
- switch(YY_bMode)
- {
- case YY_SINGLE_MODE:
- {
- return YY_SingleParam->LeftToothNum;
- }break;
- case YY_GROUP_MODE:
- {
- return YY_GroupParam->LeftToothNum[YY_SystemParam->NowGroup];
- }break;
- default:return 0;
- }
- }
- unsigned long YY_GetRightToothNum(void)
- {
- switch(YY_bMode)
- {
- case YY_SINGLE_MODE:
- {
- return YY_SingleParam->RightToothNum;
- }break;
- case YY_GROUP_MODE:
- {
- return YY_GroupParam->LeftToothNum[YY_SystemParam->NowGroup];
- }break;
- default:return 0;
- }
- }
- unsigned long YY_GetLeftToothNumDisplay(void)
- {
- switch(YY_bMode)
- {
- case YY_SINGLE_MODE:
- {
- return YY_SingleParam->DisplyLeftToothNum;
- }break;
- case YY_GROUP_MODE:
- {
- return YY_GroupParam->DisplyLeftToothNum[YY_SystemParam->NowGroup];
- }break;
- default:return 0;
- }
- }
- unsigned long YY_GetRightToothNumDisplay(void)
- {
- switch(YY_bMode)
- {
- case YY_SINGLE_MODE:
- {
- return YY_SingleParam->DisplyRightToothNum;
- }break;
- case YY_GROUP_MODE:
- {
- return YY_GroupParam->DisplyRightToothNum[YY_SystemParam->NowGroup];
- }break;
- default:return 0;
- }
- }
- unsigned long YY_GetLeftSpace(void)
- {
- switch(YY_bMode)
- {
- case YY_SINGLE_MODE:
- {
- return YY_SingleParam->LeftToothNumSpace;
- }break;
- case YY_GROUP_MODE:
- {
- return YY_GroupParam->LeftToothNumSpace[YY_SystemParam->NowGroup];
- }break;
- default:return 0;
- }
- }
- unsigned long YY_GetRightSpace(void)
- {
- switch(YY_bMode)
- {
- case YY_SINGLE_MODE:
- {
- return YY_SingleParam->RightToothNumSpace;
- }break;
- case YY_GROUP_MODE:
- {
- return YY_GroupParam->LeftToothNumSpace[YY_SystemParam->NowGroup];
- }break;
- default:return 0;
- }
- }
- unsigned long YY_GetLeftSpaceDisplay(void)
- {
- switch(YY_bMode)
- {
- case YY_SINGLE_MODE:
- {
- return YY_SingleParam->DisplyLeftToothNumSpace;
- }break;
- case YY_GROUP_MODE:
- {
- return YY_GroupParam->DisplyLeftToothNumSpace[YY_SystemParam->NowGroup];
- }break;
- default:return 0;
- }
- }
- unsigned long YY_GetRightSpaceDisplay(void)
- {
- switch(YY_bMode)
- {
- case YY_SINGLE_MODE:
- {
- return YY_SingleParam->DisplyRightToothNumSpace;
- }break;
- case YY_GROUP_MODE:
- {
- return YY_GroupParam->DisplyRightToothNumSpace[YY_SystemParam->NowGroup];
- }break;
- default:return 0;
- }
- }
- void YY_SetLeftDCTSpace(void)
- {
- //变为空位,不用铜丝
- YY_LEFT_OUT = 0;
- YY_LEFT_IN = 1;
- YY_LCntDelay = dwTickCount + YY_DCT_OUT_TIME;
- }
- void YY_SetLeftDCTTooth(void)
- {
- //变为排牙
- YY_LEFT_OUT = 1;
- YY_LEFT_IN = 0;
- YY_LCntDelay = dwTickCount + YY_DCT_OUT_TIME;
- }
- void YY_SetRightDCTSpace(void)
- {
- //变为空位,不用铜丝
- YY_RIGHT_OUT = 0;
- YY_RIGHT_IN = 1;
- YY_RCntDelay = dwTickCount + YY_DCT_OUT_TIME;
- }
- void YY_SetRightDCTTooth(void)
- {
- //变为排牙
- YY_RIGHT_OUT = 1;
- YY_RIGHT_IN = 0;
- YY_RCntDelay = dwTickCount + YY_DCT_OUT_TIME;
- }
- void YY_SetLeftPyData(unsigned short cLeftData,unsigned short cLeftKongWei)
- {
- YY_NowLeftPyKongWei = cLeftKongWei;
- YY_NowLeftPyNum = cLeftData;
- }
- void YY_SetRightPyData(unsigned short cRightData,unsigned short cRightKongWei)
- {
- YY_NowRightPyKongWei = cRightKongWei;
- YY_NowRightPyNum = cRightData;
- }
- void YY_SetLeftDisplay(unsigned short source_data)
- {
- switch(YY_bMode)
- {
- case YY_SINGLE_MODE:
- {
- YY_SingleParam->DisplyLeftToothNum = source_data;
- }break;
- case YY_GROUP_MODE:
- {
- YY_GroupParam->DisplyLeftToothNum[YY_SystemParam->NowGroup] = source_data;
- }break;
- }
- }
- void YY_SetRightDisplay(unsigned short source_data)
- {
- switch(YY_bMode)
- {
- case YY_SINGLE_MODE:
- {
- YY_SingleParam->DisplyRightToothNum = source_data;
- }break;
- case YY_GROUP_MODE:
- {
- YY_GroupParam->DisplyRightToothNum[YY_SystemParam->NowGroup] = source_data;
- }break;
- }
- }
- void YY_SetLeftSpaceDisplay(unsigned short source_data)
- {
- switch(YY_bMode)
- {
- case YY_SINGLE_MODE:
- {
- YY_SingleParam->DisplyLeftToothNumSpace = source_data;
- }break;
- case YY_GROUP_MODE:
- {
- YY_GroupParam->DisplyLeftToothNumSpace[YY_SystemParam->NowGroup] = source_data;
- }break;
- }
- }
- void YY_SetRightSpaceDisplay(unsigned short source_data)
- {
- switch(YY_bMode)
- {
- case YY_SINGLE_MODE:
- {
- YY_SingleParam->DisplyRightToothNumSpace = source_data;
- }break;
- case YY_GROUP_MODE:
- {
- YY_GroupParam->DisplyRightToothNumSpace[YY_SystemParam->NowGroup] = source_data;
- }break;
- }
- }
- unsigned long YY_GetTotal(void)
- {
- switch(YY_bMode)
- {
- case YY_SINGLE_MODE:
- {
- return YY_SingleParam->OverTotal;
- }break;
- case YY_GROUP_MODE:
- {
- return YY_GroupParam->AllOverTotal;
- }break;
- default:return 0;
- }
- }
- unsigned long YY_GetSetTotal(void)
- {
- switch(YY_bMode)
- {
- case YY_SINGLE_MODE:return YY_SingleParam->SetTotal;break;
- case YY_GROUP_MODE:return YY_GroupParam->AllSetTotal;break;
- default:return 0;
- }
- }
- void YY_AddTotal(void)
- {
- switch(YY_bMode)
- {
- case YY_SINGLE_MODE:YY_SingleParam->OverTotal++;break;
- case YY_GROUP_MODE:
- {
- YY_GroupParam->AllOverTotal++;
- YY_GroupParam->OverSetTotal[YY_SystemParam->NowGroup]++;
- }break;
- }
- }
- //算单个齿长度
- float YY_CalToothLength(unsigned short roll_diameter,unsigned short tooth_num)
- {
- float buff,buff_num;
-
- buff = roll_diameter;
- buff_num = tooth_num;
- return (buff * 3.1415926 / buff_num);
- }
- //输入齿数计算长度返回的是单位厘米
- unsigned long YY_ToothNumCalLengthCM(float single_length,unsigned short tooth_num,unsigned long zipper_num)
- {
- float buff1,buff2,buff3;
- buff1 = single_length;
- buff2 = tooth_num;
- buff3 = zipper_num;
- return (unsigned long)(buff1 * buff2 * buff3);
- }
- //输入齿数计算长度返回的是单位英寸
- unsigned long YY_ToothNumCalLengthInch(float single_length,unsigned short tooth_num,unsigned long zipper_num)
- {
- float buff1,buff2,buff3;
- buff1 = single_length;
- buff2 = tooth_num;
- buff3 = zipper_num;
- return (unsigned long)(buff1 * buff2 * buff3 / 2.5399);
- }
- //输入长度厘米算齿数
- unsigned long YY_ToothLengthCMCalNum(float single_length,unsigned short tooth_length,unsigned long zipper_num)
- {
- float buff1,buff2,buff3;
- buff1 = zipper_num;
- buff2 = tooth_length;
- buff3 = single_length;
- return (unsigned long)ceil(buff1 * buff2 / buff3);
- }
- //输入长度厘米算英寸
- unsigned long YY_ToothLengthCMCalInch(float single_length,unsigned short tooth_length,unsigned long zipper_num)
- {
- float buff1,buff2;
- buff1 = tooth_length;
- buff2 = zipper_num;
- return (unsigned long)(buff1 * buff2 / 2.5399);
- }
- //输入厘米长度计算总长度单位米
- unsigned long YY_LengthCalLengthM(unsigned short set_length,unsigned short kongwei_length,unsigned long zipper_num)
- {
- float buff1,buff2,buff3;
-
- buff1 = set_length;
- buff2 = kongwei_length;
- buff3 = zipper_num;
- return (unsigned long)((buff1 + buff2) * buff3 / 100);
- }
- //输入英寸长度计算总长度
- unsigned long YY_InchLengthCalLength(unsigned short set_length,unsigned short kongwei_length,unsigned long zipper_num)
- {
- float buff1,buff2,buff3;
-
- buff1 = set_length;
- buff2 = kongwei_length;
- buff3 = zipper_num;
- return (unsigned long)((buff1 + buff2) * buff3 / 2.5399);
- }
- //输入齿数计算长度返回的是单位米
- unsigned long YY_ToothNumCalLength(float single_length,unsigned short tooth_num,unsigned long zipper_num)
- {
- float buff1,buff2,buff3;
-
- buff1 = single_length;
- buff2 = tooth_num;
- buff3 = zipper_num;
- return (unsigned long)(buff1 * buff2 * buff3 / 1000);
- }
- //输入齿数计算长度返回的是单位米带浮点型
- float YY_ToothNumCalLengthFloat(float single_length,unsigned short tooth_num,unsigned long zipper_num)
- {
- float buff1,buff2,buff3;
-
- buff1 = single_length;
- buff2 = tooth_num;
- buff3 = zipper_num;
- return (buff1 * buff2 * buff3 / 1000);
- }
- //输入长度英寸算齿数
- unsigned long YY_ToothLengthInchCalNum(float single_length,unsigned short tooth_length,unsigned long zipper_num)
- {
- float buff1,buff2;
- buff1 = zipper_num * tooth_length;
- buff2 = single_length;
- return (unsigned long)ceil(buff1 * 2.5399 / buff2);
- }
- //输入长度英寸算厘米
- unsigned long YY_ToothLengthInchCalCM(float single_length,unsigned short tooth_length,unsigned long zipper_num)
- {
- float buff1,buff2;
- buff1 = tooth_length;
- buff2 = zipper_num;
- return (unsigned long)(buff1 * buff2 * 2.5399);
- }
- #endif
|