TYChuChiJi.c 12 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479
  1. #include "global.h"
  2. #if TONG_YONG_MACHINE
  3. static unsigned short cJiaLianNum = 0;
  4. unsigned char ManualDWFlg = 0;
  5. void CCJ_ManualAction(void);
  6. void CCJ_MotorAction(void);
  7. void CCJ_ChuCiAction(void);
  8. void CCJ_AutoAction(void);
  9. void CCJ_StepAction(void);
  10. void CCJ_StartStopAction(void);
  11. void CCJ_ChuiQiStep(void);
  12. void CCJ_SetAlarmCode(unsigned alarm_code)
  13. {
  14. SetAlarmCode(CCJ_ALARM_ADDR,alarm_code);
  15. CCJ_bAlarmStop = 1;
  16. }
  17. void CCJ_ChuiQiStep(void)
  18. {
  19. if(CCJ_ChuiQi_VAVLE && !CCJ_bRunning)
  20. {
  21. if(CCJ_ChuiQiDelay < dwTickCount)CCJ_ChuiQi_VAVLE = 0;
  22. }
  23. }
  24. void CCJ_InitAction(void)
  25. {
  26. // float pulse_buff,length_buff;
  27. // CCJ_Param = (CCJ_ParamStrct *)&user_datas[80];
  28. /* pulse_buff = CCJ_Param->MotorCyclePulse;
  29. length_buff = CCJ_Param->MotorCyclePulse;
  30. YGearRatio = length_buff/pulse_buff;
  31. SetAccTime(Y_AXIS,CCJ_Param->MotorAccTime);
  32. SetDecTime(Y_AXIS,CCJ_Param->MotorDecTime);*/
  33. CCJ_SongZhou = 1;
  34. }
  35. void CCJ_DelayAction(void)
  36. {
  37. }
  38. void CCJ_Action(void)
  39. {
  40. CCJ_StartStopAction();
  41. CCJ_ChuiQiStep();
  42. CCJ_StepAction();
  43. if(CCJ_bRunning && !STOP_IN)
  44. {
  45. CCJ_AutoAction();
  46. if(!CCJ_bSingleXiChi)
  47. {
  48. if(CCJ_PARAM_XICHI_ENABLE)CCJ_XiChi_MOTOR = 1;
  49. else CCJ_XiChi_MOTOR = 0;
  50. }
  51. if(CCJ_PARAM_MAOSHUA_ENABLE)CCJ_MaoShua_MOTOR = 1;
  52. else CCJ_MaoShua_MOTOR = 0;
  53. }
  54. }
  55. void CCJ_ManualAction(void)
  56. {
  57. //手动勾针
  58. if (CCJ_bManGouZhen)
  59. {
  60. CCJ_bManGouZhen = 0;
  61. CCJ_GouZhen_VAVLE = ~CCJ_GouZhen_VAVLE;
  62. /* if(CCJ_GouZhen_VAVLE)
  63. {
  64. SetDir(X_AXIS, 1);
  65. }
  66. else
  67. {
  68. SetDir(X_AXIS, 0);
  69. }*/
  70. }
  71. //手动夹链
  72. if(CCJ_bManJiaLian)
  73. {
  74. CCJ_bManJiaLian = 0;
  75. CCJ_JiaLian_VAVLE = ~CCJ_JiaLian_VAVLE;
  76. /* if(CCJ_JiaLian_VAVLE)
  77. {
  78. SetDir(Y_AXIS, 1);
  79. Y15 = 1;
  80. }
  81. else
  82. {
  83. SetDir(Y_AXIS, 0);
  84. Y15 = 0;
  85. }*/
  86. }
  87. //手动推链
  88. if (CCJ_bManTuiLian)
  89. {
  90. CCJ_bManTuiLian = 0;
  91. CCJ_TuiLian_VAVLE = ~CCJ_TuiLian_VAVLE;
  92. }
  93. if(CCJ_bMaoShuaMotor)
  94. {
  95. CCJ_bMaoShuaMotor = 0;
  96. CCJ_MaoShua_MOTOR = ~CCJ_MaoShua_MOTOR;
  97. }
  98. if(CCJ_bManXiChi)
  99. {
  100. CCJ_bManXiChi = 0;
  101. CCJ_XiChi_MOTOR =~CCJ_XiChi_MOTOR;
  102. }
  103. if(CCJ_bSongZhou)
  104. {
  105. CCJ_bSongZhou = 0;
  106. CCJ_SongZhou = ~CCJ_SongZhou;
  107. }
  108. if(CCJ_bChuiQi)
  109. {
  110. CCJ_bChuiQi = 0;
  111. CCJ_ChuiQi = 1;
  112. CCJ_ChuiQiDelay = CCJ_PARAM_CHUI_QI_TIME * 10 + dwTickCount;
  113. }
  114. }
  115. void CCJ_MotorAction(void)
  116. {
  117. DISPLAY_DATA1 = CCJ_MotorStep;
  118. DISPLAY_DATA2 = CCJRunFlg;
  119. DISPLAY_DATA3 = JYDCRunFlg;
  120. DISPLAY_DATA4 = CCJ_AutoStep;
  121. if((CCJ_MotorStep == 1) && (CCJRunFlg == 1) && !Y_DRV)
  122. {
  123. if(CCJ_bSingleXiChi)
  124. {
  125. CCJ_XiChi_MOTOR = 1;
  126. CCJ_MotorStep = 99;
  127. CCJ_ChuiQi_VAVLE = 1;
  128. CCJ_MotorDelay = dwTickCount + CCJ_PARAM_NO_ZIPPER_TIME * 10;
  129. AxisContinueMove(Y_AXIS,CCJ_PARAM_SET_SPEED,0);
  130. }
  131. else
  132. {
  133. if(CCJ_GuoLian_IN)
  134. {
  135. AxisContinueMove(Y_AXIS,CCJ_PARAM_SET_SPEED,0);
  136. }
  137. else
  138. {
  139. AxisContinueMove(Y_AXIS,CCJ_PARAM_SET_LOW_SPEED,0);
  140. }
  141. CCJ_MotorDelay = dwTickCount + CCJ_PARAM_NO_ZIPPER_TIME * 10;
  142. CCJ_MotorStep = 2;
  143. }
  144. }
  145. else if(CCJ_MotorStep == 2)
  146. {
  147. if(CCJ_GuoLian_IN_DW)
  148. {
  149. AxisChangeSpeed(Y_AXIS,CCJ_PARAM_SET_LOW_SPEED);
  150. CCJ_GouZhen_VAVLE = 1;
  151. CCJ_MotorDelay = dwTickCount + CCJ_PARAM_DELAY_GOU_ZHEN * 10; //延时下勾针
  152. CCJ_MotorStep = 3;
  153. }
  154. else if((dwTickCount >= CCJ_MotorDelay) && (CCJ_PARAM_NO_ZIPPER_TIME >= 5) && Y_DRV)
  155. {
  156. CCJ_SetAlarmCode(CCJ_NO_ZIPPER_ALARM);
  157. }
  158. else
  159. {
  160. if(CCJ_ChuDaiStop_IN)
  161. {
  162. CCJ_SetAlarmCode(CCJ_START_ALARM);
  163. CCJ_bStop = 1;
  164. }
  165. }
  166. }
  167. else if((CCJ_MotorStep == 3) && (dwTickCount >= CCJ_MotorDelay))
  168. {
  169. // if(CCJ_GuoLian_IN_DW)
  170. {
  171. CCJ_MotorStep = 4;
  172. CCJ_MotorDelay = dwTickCount + 4000;
  173. }
  174. }
  175. else if(CCJ_MotorStep == 4)
  176. {
  177. /* if(CCJ_GuoLian_IN)
  178. {
  179. CCJ_MotorStep = 5;
  180. CCJ_MotorDelay = dwTickCount + 4000;
  181. }
  182. else if(dwTickCount >= CCJ_MotorDelay)
  183. {
  184. CCJ_SetAlarmCode(CCJ_NO_ZIPPER_ALARM);
  185. CCJ_bStop = 1;
  186. } */
  187. CCJ_MotorStep = 5;
  188. }
  189. else if(CCJ_MotorStep == 5)
  190. {
  191. if(CCJ_GouZhen_FAST_IN)
  192. {
  193. AxisEgmStop(Y_AXIS);
  194. CCJ_MotorStep = 0;
  195. CCJ_MotorDelay = dwTickCount;
  196. }
  197. }
  198. else if(CCJ_MotorStep == 99)
  199. {
  200. if(CCJRunFlg)
  201. {
  202. }
  203. else
  204. {
  205. AxisDecStop(Y_AXIS);
  206. CCJ_MotorStep = 1;
  207. }
  208. }
  209. }
  210. void CCJ_AutoAction(void)
  211. {
  212. switch (CCJ_AutoStep)
  213. {
  214. //启动电机锁轴
  215. case 1:
  216. CCJ_AutoDelay = dwTickCount + 220;
  217. CCJ_MotorDelay = dwTickCount;
  218. CCJ_AutoStep = 2;
  219. CCJ_SongZhou = 0;
  220. break;
  221. case 2:
  222. if(dwTickCount >= CCJ_AutoDelay)
  223. {
  224. CCJ_MotorStep = 1;
  225. CCJ_AutoStep = 3;
  226. cJiaLianNum = 0;
  227. }
  228. break;
  229. //电机拖带完成
  230. case 3:
  231. if((CCJ_MotorStep == 0) && (dwTickCount >= CCJ_AutoDelay))
  232. {
  233. if(ManualDWFlg)
  234. {
  235. CCJ_AutoStep = 0;
  236. ManualDWFlg = 0;
  237. CCJ_bRunning = 0;
  238. }
  239. else
  240. {
  241. CCJ_JiaLian_VAVLE = 1; //
  242. CCJ_AutoDelay = dwTickCount + CCJ_ERRORTIME;
  243. CCJ_AutoStep = 4;
  244. }
  245. }
  246. break;
  247. case 4:
  248. if(CCJ_JiaLian_IN && !CCJ_JiaLian_ORIGIN_IN)
  249. {
  250. CCJ_AutoStep = 5;
  251. CCJ_AutoDelay = dwTickCount + (unsigned long)10 * CCJ_PARAM_DELAY_TUILIAN;
  252. }
  253. else if(dwTickCount >= CCJ_AutoDelay) //夹链不到位
  254. {
  255. if(++cJiaLianNum >= CCJ_PARAM_JIALIAN_TIMES)
  256. {
  257. CCJ_AutoStep = 0;
  258. CCJ_bStop = 1;
  259. CCJ_SetAlarmCode(CCJ_JIALIAN_ALARM);
  260. }
  261. else
  262. {
  263. CCJ_JiaLian_VAVLE = 0;
  264. CCJ_AutoDelay = dwTickCount + (unsigned long)30 * 10;
  265. CCJ_AutoStep = 3;
  266. }
  267. }
  268. break;
  269. case 5:
  270. if(dwTickCount >= CCJ_AutoDelay)
  271. {
  272. CCJ_TuiLian_VAVLE = 1;
  273. CCJ_ChuiQi_VAVLE = 1;
  274. CCJ_AutoStep = 6;
  275. CCJ_AutoDelay = dwTickCount + CCJ_ERRORTIME+1500;
  276. cDelayTime3 = dwTickCount + CCJ_PARAM_JIALIAN_HOLD_TIME * 10;
  277. }
  278. break;
  279. case 6:
  280. if(CCJ_PARAM_TUILIAN_TIMES == 1)
  281. {
  282. if(dwTickCount >= cDelayTime3)
  283. {
  284. CCJ_JiaLian_VAVLE = 0;
  285. }
  286. }
  287. if(CCJ_TuiLian_IN && !CCJ_TuiLian_ORIGIN_IN)
  288. {
  289. CCJ_AutoStep = 7;
  290. CCJ_JiaLian_VAVLE = 0;
  291. CCJ_AutoDelay = dwTickCount + (unsigned long)10 * CCJ_PARAM_TUILIAN_ALARM_TIME;
  292. if(CCJ_PARAM_TUILIAN_TIMES == 0)
  293. {
  294. CCJ_TuiLian_VAVLE = 0;
  295. CCJ_GouZhen_VAVLE = 0;
  296. CCJ_ChuiQi_VAVLE = 0;
  297. CCJ_AutoStep = 8;
  298. }
  299. }
  300. else if(dwTickCount >= CCJ_AutoDelay) //推止不到位
  301. {
  302. CCJ_AutoStep = 0;
  303. CCJ_bStop = 1;
  304. CCJ_SetAlarmCode(CCJ_TUICHI_ALARM);
  305. }
  306. break;
  307. case 7:
  308. if(CCJ_JiaLian_ORIGIN_IN && !CCJ_JiaLian_IN && CCJ_TuiLian_IN && (dwTickCount >= CCJ_AutoDelay))
  309. {
  310. if(CCJ_PARAM_TUILIAN_TIMES == 1) CCJ_JiaLian_VAVLE = 1;
  311. }
  312. if(CCJ_JiaLian_VAVLE && !CCJ_JiaLian_ORIGIN_IN && CCJ_JiaLian_IN)
  313. {
  314. CCJ_AutoDelay = dwTickCount + (unsigned long)10 * CCJ_PARAM_DELAY_TUILIAN;
  315. CCJ_AutoStep = 8;
  316. }
  317. break;
  318. case 8:
  319. if(dwTickCount >= CCJ_AutoDelay)
  320. {
  321. CCJ_TuiLian_VAVLE = 0;
  322. }
  323. if(CCJ_TuiLian_ORIGIN_IN && !CCJ_TuiLian_IN)
  324. {
  325. CCJ_JiaLian_VAVLE = 0;
  326. CCJ_GouZhen_VAVLE = 0;
  327. CCJ_ChuiQi_VAVLE = 0;
  328. }
  329. if(!CCJ_JiaLian_VAVLE && !CCJ_JiaLian_IN && CCJ_JiaLian_ORIGIN_IN && !CCJ_GouZhen_IN)
  330. {
  331. CCJ_AutoDelay = dwTickCount + (unsigned long)10 * CCJ_PARAM_CYCLE_TIME;
  332. CCJ_AutoStep = 9;
  333. }
  334. break;
  335. case 9:
  336. if(CCJRunFlg == 1)
  337. {
  338. if (dwTickCount >= CCJ_AutoDelay)
  339. {
  340. if(CCJ_KaDai_IN)
  341. {
  342. CCJ_bRunning = 0;
  343. CCJ_bStop = 1;
  344. }
  345. else
  346. CCJ_AutoStep = 2;
  347. // CalProSP(78);
  348. // AddToTal(80);
  349. // if((GetTotal(CCJ_TOTAL_ADDR) >= GetTotal(CCJ_SET_TOTAL_ADDR)) && (GetTotal(CCJ_SET_TOTAL_ADDR) != 0))
  350. {
  351. // CCJ_bStop = 1;
  352. }
  353. }
  354. }
  355. break;
  356. default:
  357. break;
  358. }
  359. }
  360. void CCJ_StartStopAction(void)
  361. {
  362. //启动
  363. if ((CCJ_bStart || START_IN_UP || CCJ_bTest) && CCJ_bRunning == 0 && !STOP_IN)
  364. {
  365. CCJ_bStart = 0;
  366. if(CCJ_bTest)ManualDWFlg = 1;
  367. CCJ_bTest = 0;
  368. if(CCJ_GouZhen_IN)CCJ_SetAlarmCode(CCJ_GOUZHEN_IN_ALARM);
  369. else if(!CCJ_JiaLian_ORIGIN_IN)CCJ_SetAlarmCode(CCJ_JIALIAN_ORIGIN_ALARM);
  370. else if(!CCJ_TuiLian_ORIGIN_IN)CCJ_SetAlarmCode(CCJ_TUIJIA_ORIGIN_ALARM);
  371. else
  372. {
  373. CCJ_bRunning = 1;
  374. CCJ_AutoStep = 1;
  375. }
  376. }
  377. if (STOP_IN_UP || CCJ_bStop || CCJ_bManStop)
  378. {
  379. if(STOP_IN_UP || CCJ_bManStop)
  380. {
  381. CCJ_GouZhen_VAVLE = 0;
  382. CCJ_JiaLian_VAVLE = 0;
  383. CCJ_TuiLian_VAVLE = 0;
  384. CCJ_ChuiQi_VAVLE = 0;
  385. CCJ_SetAlarmCode(CCJ_NO_ALARM);
  386. }
  387. CCJ_bManStop = 0;
  388. CCJ_bStop = 0;
  389. AxisDecStop(Y_AXIS);
  390. CCJ_bRunning = 0;
  391. CCJ_AutoStep = 0;
  392. CCJ_MotorStep = 0;
  393. CCJ_SongZhou = 1;
  394. CCJ_XiChi_MOTOR = 0;
  395. CCJ_MaoShua_MOTOR = 0;
  396. }
  397. if(CCJ_bAlarmStop)
  398. {
  399. CCJ_bAlarmStop = 0;
  400. AxisDecStop(Y_AXIS);
  401. CCJ_bRunning = 0;
  402. CCJ_AutoStep = 0;
  403. }
  404. }
  405. void CCJ_StepAction(void)
  406. {
  407. //电机控制
  408. CCJ_MotorAction();
  409. if(CCJ_bRunning && !STOP_IN)
  410. {
  411. CCJ_AutoAction();
  412. }
  413. else if (!STOP_IN && CCJ_bRunning == 0)
  414. {
  415. CCJ_ManualAction();
  416. }
  417. }
  418. #endif