control.c 23 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654
  1. #include <control.h>
  2. /*
  3. * Copyright (c) 2006-2020, RT-Thread Development Team
  4. *
  5. * SPDX-License-Identifier: Apache-2.0
  6. *
  7. * Change Logs:
  8. * Date Author Notes
  9. * 2020-05-30 Administrator the first version
  10. */
  11. #include "beep.h"
  12. #include "hmi.h"
  13. #include "easyflash.h"
  14. #include "stdio.h"
  15. #include "sound.h"
  16. #define DBG_TAG "control.c"
  17. #define DBG_LVL LOG_LVL_INFO
  18. #include <ulog.h>
  19. #include "dtu_uart2.h"
  20. #include "sht30_collect.h"
  21. //工作检测
  22. #define WORK_CHECK_THREAD_PRIORITY 23 //线程优先级
  23. #define WORK_CHECK_THREAD_STACK_SIZE 1024 //栈大小
  24. #define WORK_CHECK_THREAD_TIMESLICE 5 //时间片
  25. //工作流程
  26. #define WORK_LOOP_THREAD_PRIORITY 12 //线程优先级
  27. #define WORK_LOOP_THREAD_STACK_SIZE 1024 //栈大小
  28. #define WORK_LOOP_THREAD_TIMESLICE 5 //时间片
  29. //设备状态表结构体
  30. Device_Status_typedef device_status;
  31. rt_thread_t tid_workloop = RT_NULL;
  32. rt_thread_t tid_wkstc = RT_NULL;
  33. /*光控*/
  34. uint8_t In_Light_status(void)
  35. {
  36. rt_pin_mode(LIGHT_PIN,PIN_MODE_INPUT);
  37. return rt_pin_read(LIGHT_PIN);
  38. }
  39. /*雨控*/
  40. uint8_t In_Rain_status(void)
  41. {
  42. rt_pin_mode(RAIN_PIN,PIN_MODE_INPUT);
  43. return rt_pin_read(RAIN_PIN);
  44. }
  45. /*加热*/
  46. uint8_t ctr_Heat(uint8_t status_heat)
  47. {
  48. device_status.heat_status = status_heat;
  49. rt_pin_mode(Heat_Pin, PIN_MODE_OUTPUT);
  50. rt_pin_write(Heat_Pin,status_heat);
  51. return status_heat;
  52. }
  53. /*制冷*/
  54. uint8_t ctr_Cold(uint8_t status_cold)
  55. {
  56. device_status.cold_status = status_cold;
  57. rt_pin_mode(Cold_Pin, PIN_MODE_OUTPUT);
  58. rt_pin_write(Cold_Pin,status_cold);
  59. return status_cold;
  60. }
  61. /*相机供电*/
  62. uint8_t ctr_photo(uint8_t status_photo)
  63. {
  64. rt_pin_mode(PHOTO,PIN_MODE_OUTPUT);
  65. rt_pin_write(PHOTO,status_photo);
  66. return status_photo;
  67. }
  68. /*采集风机/上仓门*/
  69. uint8_t ctr_cangmen_up(uint8_t status_up)
  70. {
  71. rt_pin_mode(TURN_ZP_R, PIN_MODE_OUTPUT);
  72. rt_pin_mode(TURN_ZP_L, PIN_MODE_OUTPUT);
  73. if(status_up==OFF)
  74. {
  75. }
  76. if(status_up==OPEN)
  77. {
  78. }
  79. return 0;
  80. }
  81. /*************************************************
  82. Function: ctr_Cool_Fan
  83. Description: 散热风机的开关
  84. Calls:
  85. Table Accessed: // 被访问的表(此项仅对于牵扯到数据库操作的程序)
  86. Table Updated: // 被修改的表(此项仅对于牵扯到数据库操作的程序)
  87. Input: ON-开,OFF-关
  88. Output: NULL
  89. Return: ON-开,OFF-关
  90. Others: NULL
  91. *************************************************/
  92. uint8_t ctr_Cool_Fan(uint8_t status_cool)
  93. {
  94. device_status.cool_fan_status = status_cool;
  95. rt_pin_mode(Cool_Fan_L, PIN_MODE_OUTPUT);
  96. rt_pin_mode(Cool_Fan_R, PIN_MODE_OUTPUT);
  97. if(status_cool==OFF)
  98. {
  99. rt_pin_write(Cool_Fan_L,OFF);
  100. rt_pin_write(Cool_Fan_R,OFF);
  101. }
  102. if(status_cool==ON)
  103. {
  104. rt_pin_write(Cool_Fan_L,ON);
  105. rt_pin_write(Cool_Fan_R,OFF);
  106. }
  107. return device_status.cool_fan_status;
  108. }
  109. /*************************************************
  110. Function: ctr_Collect_Fan
  111. Description: 采集风机的开关
  112. Calls:
  113. Table Accessed: // 被访问的表(此项仅对于牵扯到数据库操作的程序)
  114. Table Updated: // 被修改的表(此项仅对于牵扯到数据库操作的程序)
  115. Input: ON-开,OFF-关
  116. Output: NULL
  117. Return: ON-开,OFF-关
  118. Others: NULL
  119. *************************************************/
  120. uint8_t ctr_Collect_Fan(uint8_t status_collect)
  121. {
  122. device_status.collect_fan_status = status_collect;
  123. rt_pin_mode(Collect_Fan, PIN_MODE_OUTPUT);
  124. if(status_collect==OFF)
  125. {
  126. rt_pin_write(Collect_Fan,OFF);
  127. }
  128. if(status_collect==ON)
  129. {
  130. rt_pin_write(Collect_Fan,ON);
  131. }
  132. return device_status.collect_fan_status;
  133. }
  134. /*************************************************
  135. Function: ctr_DiYe
  136. Description: 电磁阀控制
  137. Calls:
  138. Table Accessed: // 被访问的表(此项仅对于牵扯到数据库操作的程序)
  139. Table Updated: // 被修改的表(此项仅对于牵扯到数据库操作的程序)
  140. Input: shake_sec
  141. Output: NULL
  142. Return: shake_sec
  143. Others: NULL
  144. *************************************************/
  145. uint8_t ctr_DiYe(uint8_t shake_sec)
  146. {
  147. if(shake_sec>0) DTU_Write("drop.mp3");
  148. rt_pin_mode(SHAKE_SW, PIN_MODE_OUTPUT);
  149. if(shake_sec==0)
  150. {
  151. rt_pin_write(SHAKE_SW,OFF);
  152. return 0;
  153. }
  154. rt_pin_write(SHAKE_SW,ON);
  155. rt_thread_delay(shake_sec*1000);
  156. rt_pin_write(SHAKE_SW,OFF);
  157. HMI_WRITE("sysTest.switchDrop.val=%d",OFF);
  158. return shake_sec;
  159. }
  160. /*************************************************
  161. Function: ctr_Motor_Driver
  162. Description: 步进电机驱动
  163. Calls:
  164. Table Accessed: // 被访问的表(此项仅对于牵扯到数据库操作的程序)
  165. Table Updated: // 被修改的表(此项仅对于牵扯到数据库操作的程序)
  166. Input: 50000000
  167. Output: NULL
  168. Return: shake_sec
  169. Others: NULL
  170. *************************************************/
  171. void ctr_Motor_Driver(uint8_t EN,uint8_t DIR,rt_uint32_t pwm,rt_uint32_t time_out)
  172. {
  173. beep_init();
  174. rt_pin_mode(Motor_Power, PIN_MODE_OUTPUT);
  175. rt_pin_mode(LIMIT_UP, PIN_MODE_INPUT);
  176. rt_pin_mode(LIMIT_DOWN, PIN_MODE_INPUT);
  177. rt_pin_mode(Motor_EN, PIN_MODE_OUTPUT);
  178. rt_pin_mode(Motor_DIR, PIN_MODE_OUTPUT);
  179. if(EN==2)
  180. {
  181. rt_pin_write(Motor_EN, 0);
  182. rt_pin_write(HK_TAKE, 0); //使能步进电机2
  183. }
  184. else if(EN==0)
  185. {
  186. rt_pin_write(Motor_Power,0);
  187. }
  188. else{
  189. rt_pin_write(Motor_EN, EN);
  190. rt_pin_write(Motor_Power,1);
  191. }
  192. rt_pin_write(Motor_DIR, DIR);
  193. beep_set(pwm, pwm/2); //200kzh - 50%
  194. while(DIR==1&&rt_pin_read(LIMIT_DOWN)==1)
  195. {
  196. if(time_out==0)
  197. {
  198. break;
  199. }
  200. rt_thread_delay(50);
  201. time_out --;
  202. }
  203. while(DIR==0&&rt_pin_read(LIMIT_UP)==1)
  204. {
  205. if(time_out==0)
  206. {
  207. break;
  208. }
  209. rt_thread_delay(50);
  210. time_out --;
  211. }
  212. rt_pin_write(Motor_EN, OFF);
  213. rt_pin_write(HK_TAKE,OFF); //双电机此处ON
  214. //rt_pin_write(HK_TAKE,ON); //双电机此处ON
  215. beep_set(0, 0); //200kzh - 50%
  216. }
  217. /*************************************************
  218. Function: ctr_Petroleum_jelly
  219. Description: 涂凡士林
  220. Calls:
  221. Table Accessed: // 被访问的表(此项仅对于牵扯到数据库操作的程序)
  222. Table Updated: // 被修改的表(此项仅对于牵扯到数据库操作的程序)
  223. Input: NULL
  224. Output: NULL
  225. Return: NULL
  226. Others: NULL
  227. *************************************************/
  228. void ctr_Petroleum_jelly(rt_uint32_t delay)
  229. {
  230. beep_init();
  231. pwm_on(2,50000);
  232. rt_thread_delay(delay*1000);
  233. pwm_off(2,0);
  234. rt_thread_delay(1000);
  235. pwm_on(3, 50000);
  236. rt_thread_delay(delay*1000);
  237. pwm_off(3,0);
  238. device_status.fsl_sw = 0;
  239. }
  240. uint8_t ctr_led(uint8_t status_led)
  241. {
  242. rt_pin_mode(LED_SW, PIN_MODE_OUTPUT);
  243. if(status_led==ON)
  244. {
  245. rt_pin_write(LED_SW,ON);
  246. HMI_WRITE("sysTest.switchFill.val=%d",ON);
  247. }
  248. else {
  249. rt_pin_write(LED_SW,OFF);
  250. HMI_WRITE("sysTest.switchPhoto.val=%d",OFF);
  251. HMI_WRITE("sysTest.switchFill.val=%d",OFF);
  252. }
  253. return status_led;
  254. }
  255. /*************************************************
  256. Function: ctr_turn
  257. Description: 转盘驱动
  258. Calls:
  259. Table Accessed: // 被访问的表(此项仅对于牵扯到数据库操作的程序)
  260. Table Updated: // 被修改的表(此项仅对于牵扯到数据库操作的程序)
  261. Input: v=0(复位) v=90转90度
  262. Output: NULL
  263. Return: NULL
  264. Others: NULL
  265. *************************************************/
  266. void ctr_turn(uint8_t v)
  267. {
  268. DTU_Write("turn.mp3");
  269. LOG_I("================v===============:%d\n",v);
  270. rt_uint16_t turn_cnt = 0;
  271. rt_pin_mode(TURN_ZP_R, PIN_MODE_OUTPUT);
  272. rt_pin_mode(TURN_ZP_L, PIN_MODE_OUTPUT);
  273. rt_pin_mode(LIMIT_0, PIN_MODE_INPUT);
  274. rt_pin_mode(LIMIT_90, PIN_MODE_INPUT);
  275. if(v==0&&rt_pin_read(LIMIT_0)==0) return; //如果在初始位置,则不再往下执行
  276. while(rt_pin_read(LIMIT_0)==0||rt_pin_read(LIMIT_90)==0)
  277. {
  278. rt_pin_write(TURN_ZP_R, ON);
  279. rt_pin_write(TURN_ZP_L, OFF);
  280. turn_cnt ++;
  281. rt_thread_delay(100);
  282. if(turn_cnt==1000)
  283. {
  284. turn_cnt = 0;
  285. rt_pin_write(TURN_ZP_R, OFF);
  286. rt_pin_write(TURN_ZP_L, OFF);
  287. char *turn_warn ="limit timeout!!!";
  288. DTU_Write(makeJson_Warn(turn_warn, "ERR"));
  289. rt_free(turn_warn);
  290. break;
  291. }
  292. }
  293. turn_cnt = 0;
  294. while(v==0&&rt_pin_read(LIMIT_0)==1)
  295. {
  296. rt_pin_write(TURN_ZP_R, ON);
  297. rt_pin_write(TURN_ZP_L, OFF);
  298. rt_thread_delay(10);
  299. turn_cnt ++;
  300. if(turn_cnt==5000)
  301. {
  302. turn_cnt = 0;
  303. rt_pin_write(TURN_ZP_R, OFF);
  304. rt_pin_write(TURN_ZP_L, OFF);
  305. char *turn_warn ="turn timrout!!!";
  306. DTU_Write(makeJson_Warn(turn_warn, "ERR"));
  307. rt_free(turn_warn);
  308. break;
  309. }
  310. }
  311. turn_cnt = 0;
  312. while(v==90&&rt_pin_read(LIMIT_90)==1)
  313. {
  314. rt_pin_write(TURN_ZP_R, ON);
  315. rt_pin_write(TURN_ZP_L, OFF);
  316. rt_thread_delay(10);
  317. turn_cnt ++;
  318. if(turn_cnt==5000)
  319. {
  320. turn_cnt = 0;
  321. rt_pin_write(TURN_ZP_R, OFF);
  322. rt_pin_write(TURN_ZP_L, OFF);
  323. char *turn_warn ="turn timrout!!!";
  324. DTU_Write(makeJson_Warn(turn_warn, "ERR"));
  325. rt_free(turn_warn);
  326. break;
  327. }
  328. }
  329. turn_cnt = 0;
  330. rt_pin_write(TURN_ZP_R, OFF);
  331. rt_pin_write(TURN_ZP_L, OFF);
  332. HMI_WRITE("cangWei.rotateFlag.val=0");
  333. }
  334. //路由器供电
  335. void ctr_router(uint8_t status_router)
  336. {
  337. rt_pin_mode(ROUTER, PIN_MODE_OUTPUT);
  338. if(status_router==ON)
  339. {
  340. rt_pin_write(ROUTER,ON);
  341. }
  342. else {
  343. rt_pin_write(ROUTER,OFF);
  344. }
  345. }
  346. //DTU,RTU供电
  347. void ctr_RTU_DTU(uint8_t status_rtu)
  348. {
  349. rt_pin_mode(RTU_DTU, PIN_MODE_OUTPUT);
  350. if(status_rtu==ON)
  351. {
  352. rt_pin_write(RTU_DTU,ON);
  353. }
  354. else
  355. {
  356. rt_pin_write(RTU_DTU,OFF);
  357. }
  358. }
  359. //海康拍照
  360. void Hk_Take_io(void)
  361. {
  362. rt_pin_mode(HK_TAKE, PIN_MODE_OUTPUT);
  363. rt_pin_write(HK_TAKE, ON);
  364. rt_thread_delay(1000);
  365. //Beep_Tip(500);
  366. rt_pin_write(HK_TAKE, 0);
  367. }
  368. /*************************************************
  369. Function: ctr_develop
  370. Description: 培养载玻片孢子
  371. Calls:
  372. Table Accessed: // 被访问的表(此项仅对于牵扯到数据库操作的程序)
  373. Table Updated: // 被修改的表(此项仅对于牵扯到数据库操作的程序)
  374. Input: v=0(复位) v=90转90度
  375. Output: NULL
  376. Return: NULL
  377. Others: NULL
  378. *************************************************/
  379. void ctr_develop(void)
  380. {
  381. rt_kprintf("===============开始培养=================:%d\n",device_status.culture_time);
  382. //已经培养的时间-分钟
  383. device_status.staytime = 0;
  384. rt_uint32_t ii = 0;
  385. while(device_status.develop_flag==1)
  386. {
  387. ii++;
  388. LOG_I("developing...................................%d\n",ii);
  389. LOG_I("============================设定的培养温度:%d\n",device_status.set_tempture);
  390. LOG_I("============================培养仓实时温度:%d\n",device_status.culture_tempture);
  391. if(device_status.culture_tempture<(device_status.set_tempture-10))
  392. {
  393. //未制冷
  394. if(device_status.cold_status==0)
  395. {
  396. ctr_Heat(ON);
  397. }
  398. }
  399. else
  400. {
  401. ctr_Heat(OFF);
  402. }
  403. LOG_I("============================制冷开关:%d\n",device_status.cold_sw);
  404. if(device_status.cold_sw==1)
  405. {
  406. if(device_status.culture_tempture>(device_status.set_tempture-10))
  407. {
  408. if(device_status.heat_status==0)
  409. {
  410. ctr_Cold(ON);
  411. }
  412. }
  413. else
  414. {
  415. ctr_Cold(OFF);
  416. }
  417. }
  418. if(ii%60==0)
  419. {
  420. device_status.staytime++;
  421. if(device_status.staytime/60==device_status.culture_time) device_status.develop_flag = 0;
  422. LOG_I("developed...................................%d分钟\n",device_status.staytime);
  423. float stayedtime = 0.1;
  424. char stayed[5];
  425. stayedtime = device_status.staytime / 60;
  426. rt_sprintf(stayed,"%s",stayedtime);
  427. HMI_WRITE("workSta.staytime.txt=\"%s\"",stayed);
  428. }
  429. rt_thread_delay(1000);
  430. }
  431. ctr_Cold(OFF);
  432. ctr_Heat(OFF);
  433. LOG_I("=========!!!培养完成!!!==========");
  434. }
  435. //拍照
  436. void HK_TakePhoto(void)
  437. {
  438. //触发海康相机拍照
  439. Hk_Take_io();
  440. HMI_WRITE("sysTest.switchPic.val=%d",OFF);
  441. HMI_WRITE("sysTest.switchLed.val=%d",OFF);
  442. }
  443. /*上电初始化*/
  444. void ResetInit(void)
  445. {
  446. device_status.work_done = 1;
  447. ctr_Motor_Driver(0, 0, 0, 0);
  448. //1.打开路由器供电
  449. ctr_router(ON);
  450. ctr_RTU_DTU(ON);
  451. //2.打开相机供电
  452. ctr_photo(ON);
  453. //4.关闭电磁阀
  454. ctr_DiYe(OFF);
  455. //5.关闭加热
  456. ctr_Heat(OFF);
  457. //关闭制冷
  458. ctr_Cold(OFF);
  459. //6.关闭补光灯
  460. ctr_led(OFF);
  461. //
  462. ctr_turn(0);
  463. }
  464. /*入口函数-工作流程*/
  465. static void Work_Loop_thread_entry(void *parameter)
  466. {
  467. Beep_Tip(200);
  468. ResetInit();
  469. while(1)
  470. {
  471. if(device_status.ds==1)
  472. {
  473. //时间段判断
  474. //先判断第一个时间段
  475. time_t now;
  476. time(&now);
  477. static struct tm now_stamp; //现在
  478. static struct tm cul_sh1_stamp; //开始1
  479. static struct tm cul_eh1_stamp; //结束1
  480. static struct tm cul_sh2_stamp; //开始2
  481. static struct tm cul_eh2_stamp; //结束2
  482. static struct tm cul_sh3_stamp; //开始3
  483. static struct tm cul_eh3_stamp; //结束3
  484. now_stamp = *localtime(&now);
  485. //获取定时开始的时间戳
  486. cul_sh1_stamp = *localtime(&now);
  487. cul_sh1_stamp.tm_hour = device_status.culture_sh1;
  488. cul_sh1_stamp.tm_min = 0;
  489. cul_sh1_stamp.tm_sec = 0;
  490. cul_sh2_stamp = *localtime(&now);
  491. cul_sh2_stamp.tm_hour = device_status.culture_sh2;
  492. cul_sh2_stamp.tm_min = 0;
  493. cul_sh2_stamp.tm_sec = 0;
  494. cul_sh3_stamp = *localtime(&now);
  495. cul_sh3_stamp.tm_hour = device_status.culture_sh3;
  496. cul_sh3_stamp.tm_min = 0;
  497. cul_sh3_stamp.tm_sec = 0;
  498. //获取定时结束的时间戳
  499. cul_eh1_stamp = *localtime(&now);
  500. cul_eh1_stamp.tm_hour = device_status.culture_eh1;
  501. cul_eh1_stamp.tm_min = 0;
  502. cul_eh1_stamp.tm_sec = 0;
  503. cul_eh2_stamp = *localtime(&now);
  504. cul_eh2_stamp.tm_hour = device_status.culture_eh2;
  505. cul_eh2_stamp.tm_min = 0;
  506. cul_eh2_stamp.tm_sec = 0;
  507. cul_eh3_stamp = *localtime(&now);
  508. cul_eh3_stamp.tm_hour = device_status.culture_eh3;
  509. cul_eh3_stamp.tm_min = 0;
  510. cul_eh3_stamp.tm_sec = 0;
  511. LOG_I("采集时间1-%04d年%02d月%02d日%02d时%02d分%02d秒.\n",cul_sh1_stamp.tm_year+1900,cul_sh1_stamp.tm_mon+1,cul_sh1_stamp.tm_mday,cul_sh1_stamp.tm_hour,cul_sh1_stamp.tm_min,cul_sh1_stamp.tm_sec);
  512. LOG_I("采集时间2-%04d年%02d月%02d日%02d时%02d分%02d秒.\n",cul_sh2_stamp.tm_year+1900,cul_sh2_stamp.tm_mon+1,cul_sh2_stamp.tm_mday,cul_sh2_stamp.tm_hour,cul_sh2_stamp.tm_min,cul_sh2_stamp.tm_sec);
  513. LOG_I("采集时间3-%04d年%02d月%02d日%02d时%02d分%02d秒.\n",cul_sh3_stamp.tm_year+1900,cul_sh3_stamp.tm_mon+1,cul_sh3_stamp.tm_mday,cul_sh3_stamp.tm_hour,cul_sh3_stamp.tm_min,cul_sh3_stamp.tm_sec);
  514. LOG_I("结束时间1-%04d年%02d月%02d日%02d时%02d分%02d秒.\n",cul_eh1_stamp.tm_year+1900,cul_eh1_stamp.tm_mon+1,cul_eh1_stamp.tm_mday,cul_eh1_stamp.tm_hour,cul_eh1_stamp.tm_min,cul_eh1_stamp.tm_sec);
  515. LOG_I("结束时间2-%04d年%02d月%02d日%02d时%02d分%02d秒.\n",cul_eh2_stamp.tm_year+1900,cul_eh2_stamp.tm_mon+1,cul_eh2_stamp.tm_mday,cul_eh2_stamp.tm_hour,cul_eh2_stamp.tm_min,cul_eh2_stamp.tm_sec);
  516. LOG_I("结束时间3-%04d年%02d月%02d日%02d时%02d分%02d秒.\n",cul_eh3_stamp.tm_year+1900,cul_eh3_stamp.tm_mon+1,cul_eh3_stamp.tm_mday,cul_eh3_stamp.tm_hour,cul_eh3_stamp.tm_min,cul_eh3_stamp.tm_sec);
  517. //此处判断,一个一个时间段判断,判断当前时间是否大于开始时间:
  518. while(difftime(mktime(&now_stamp), mktime(&cul_sh1_stamp)) < 0)
  519. {
  520. time_t now;
  521. time(&now);
  522. cul_sh1_stamp = *localtime(&now);
  523. cul_sh1_stamp.tm_hour = device_status.culture_sh1;
  524. cul_sh1_stamp.tm_min = 0;
  525. cul_sh1_stamp.tm_sec = 0;
  526. now_stamp = *localtime(&now);
  527. LOG_I("==============收集时间1:%04d年%02d月%02d日%02d时%02d分%02d秒.\n",cul_sh1_stamp.tm_year+1900,cul_sh1_stamp.tm_mon+1,cul_sh1_stamp.tm_mday,cul_sh1_stamp.tm_hour,cul_sh1_stamp.tm_min,cul_sh1_stamp.tm_sec);
  528. LOG_I("==============未到收集时间1:%04d年%02d月%02d日%02d时%02d分%02d秒.\n",now_stamp.tm_year+1900,now_stamp.tm_mon+1,now_stamp.tm_mday,now_stamp.tm_hour,now_stamp.tm_min,now_stamp.tm_sec);
  529. rt_thread_delay(1000);
  530. }
  531. while(difftime(mktime(&now_stamp), mktime(&cul_sh2_stamp)) < 0&&difftime(mktime(&now_stamp), mktime(&cul_eh1_stamp)) > 0)
  532. {
  533. time_t now;
  534. time(&now);
  535. cul_sh2_stamp = *localtime(&now);
  536. cul_sh2_stamp.tm_hour = device_status.culture_sh2;
  537. cul_sh2_stamp.tm_min = 0;
  538. cul_sh2_stamp.tm_sec = 0;
  539. now_stamp = *localtime(&now);
  540. LOG_I("==============收集时间2:%04d年%02d月%02d日%02d时%02d分%02d秒.\n",cul_sh2_stamp.tm_year+1900,cul_sh2_stamp.tm_mon+1,cul_sh2_stamp.tm_mday,cul_sh2_stamp.tm_hour,cul_sh2_stamp.tm_min,cul_sh2_stamp.tm_sec);
  541. LOG_I("==============未到收集时间2:%04d年%02d月%02d日%02d时%02d分%02d秒.\n",now_stamp.tm_year+1900,now_stamp.tm_mon+1,now_stamp.tm_mday,now_stamp.tm_hour,now_stamp.tm_min,now_stamp.tm_sec);
  542. rt_thread_delay(1000);
  543. }
  544. if((difftime(mktime(&now_stamp), mktime(&cul_sh1_stamp)) >= 0&&difftime(mktime(&now_stamp), mktime(&cul_eh1_stamp)) < 0)||(difftime(mktime(&now_stamp), mktime(&cul_sh2_stamp)) >= 0&&difftime(mktime(&now_stamp), mktime(&cul_eh2_stamp)) < 0))
  545. {
  546. LOG_I("start to collect!!!");
  547. DTU_Write("collect.mp3");
  548. //判断是否在初始位置
  549. ctr_turn(90);
  550. rt_thread_delay(2000);
  551. //涂凡士林
  552. ctr_Petroleum_jelly(10);
  553. rt_thread_delay(5000);
  554. ctr_turn(90);
  555. //只有开始和结束时刻不同的时间段,才有效
  556. if((difftime(mktime(&cul_eh1_stamp), mktime(&now_stamp)) > 0)||(difftime(mktime(&cul_eh2_stamp), mktime(&now_stamp)) > 0))
  557. {
  558. device_status.work_status = 1;
  559. rt_uint32_t collect_cnt = 0;
  560. ctr_Collect_Fan(ON);
  561. if((difftime(mktime(&cul_eh1_stamp), mktime(&now_stamp)) > 0))
  562. {
  563. collect_cnt = difftime(mktime(&cul_eh1_stamp), mktime(&now_stamp));
  564. while(collect_cnt--)
  565. {
  566. rt_kprintf("===========采集风机启动,正在收集.....%d\n",collect_cnt);
  567. rt_thread_delay(1000);
  568. }
  569. collect_cnt = 2;
  570. }
  571. if(difftime(mktime(&cul_eh2_stamp), mktime(&now_stamp)) > 0)
  572. {
  573. collect_cnt = difftime(mktime(&cul_eh2_stamp), mktime(&now_stamp));
  574. while(collect_cnt--)
  575. {
  576. rt_kprintf("===========采集风机启动,正在收集.....%d\n",collect_cnt);
  577. rt_thread_delay(1000);
  578. }
  579. }
  580. ctr_Collect_Fan(OFF);
  581. }
  582. else
  583. {
  584. LOG_I("this collect time is 0s,The wait time cannot be negative!");
  585. }
  586. }
  587. else
  588. {
  589. LOG_I("next collect time is not arrivd!!! >>> .. start now time:%d",mktime(&now_stamp));
  590. }
  591. if(device_status.work_status==1)
  592. {
  593. LOG_I("===============collect ok,turn to drop!!!");
  594. device_status.develop_flag=1;
  595. device_status.work_status=2; //现在是培养
  596. DTU_Write("develop.mp3");
  597. ctr_turn(90);
  598. rt_thread_delay(1000);
  599. ctr_DiYe(device_status.drop_sec);
  600. rt_thread_delay(1000);
  601. ctr_develop();
  602. ctr_turn(90);
  603. rt_thread_delay(1000);
  604. DTU_Write("takephoto.mp3");
  605. device_status.work_status=3; //现在是拍照
  606. device_status.autotakepic=1; //对焦拍照
  607. while(device_status.autotakepic==0)
  608. {
  609. rt_thread_delay(500);
  610. LOG_I("正在对焦拍照............\n");
  611. }
  612. device_status.work_status = 0; //待机
  613. DTU_Write("wait.mp3");
  614. LOG_I("=====================work finished==================");
  615. }
  616. }
  617. else
  618. {
  619. LOG_W("==================!!!设备已关机!!!===================");
  620. }
  621. rt_thread_delay(1000);
  622. }
  623. }
  624. /*工作流程线程*/
  625. int Work_Loop_Task(void)
  626. {
  627. /* 创建线程*/
  628. tid_workloop = rt_thread_create("work_loop_thread",
  629. Work_Loop_thread_entry, RT_NULL,
  630. WORK_LOOP_THREAD_STACK_SIZE, //2048
  631. WORK_LOOP_THREAD_PRIORITY, //12
  632. WORK_LOOP_THREAD_TIMESLICE); //5
  633. if(tid_workloop!=RT_NULL)
  634. {
  635. rt_thread_startup(tid_workloop);
  636. }
  637. return 0;
  638. }