control.c 23 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655
  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. ctr_Heat(ON);
  174. rt_thread_delay(1000*5);
  175. beep_init();
  176. rt_pin_mode(Motor_Power, PIN_MODE_OUTPUT);
  177. rt_pin_mode(LIMIT_UP, PIN_MODE_INPUT);
  178. rt_pin_mode(LIMIT_DOWN, PIN_MODE_INPUT);
  179. rt_pin_mode(Motor_EN, PIN_MODE_OUTPUT);
  180. rt_pin_mode(Motor_DIR, PIN_MODE_OUTPUT);
  181. if(EN==2)
  182. {
  183. rt_pin_write(Motor_EN, 0);
  184. rt_pin_write(HK_TAKE, 0); //使能步进电机2
  185. }
  186. else if(EN==0)
  187. {
  188. rt_pin_write(Motor_Power,0);
  189. }
  190. else{
  191. rt_pin_write(Motor_EN, EN);
  192. rt_pin_write(Motor_Power,1);
  193. }
  194. rt_pin_write(Motor_DIR, DIR);
  195. beep_set(pwm, pwm/2); //200kzh - 50%
  196. while(DIR==1&&rt_pin_read(LIMIT_DOWN)==1)
  197. {
  198. // if(time_out==0)
  199. // {
  200. // break;
  201. // }
  202. rt_thread_delay(50);
  203. time_out --;
  204. }
  205. while(DIR==0&&rt_pin_read(LIMIT_UP)==1)
  206. {
  207. // if(time_out==0)
  208. // {
  209. // break;
  210. // }
  211. rt_thread_delay(50);
  212. time_out --;
  213. }
  214. rt_pin_write(Motor_EN, OFF);
  215. rt_pin_write(HK_TAKE,OFF); //双电机此处ON
  216. //rt_pin_write(HK_TAKE,ON); //双电机此处ON
  217. beep_set(0, 0); //200kzh - 50%
  218. }
  219. /*************************************************
  220. Function: ctr_Petroleum_jelly
  221. Description: 涂凡士林
  222. Calls:
  223. Table Accessed: // 被访问的表(此项仅对于牵扯到数据库操作的程序)
  224. Table Updated: // 被修改的表(此项仅对于牵扯到数据库操作的程序)
  225. Input: NULL
  226. Output: NULL
  227. Return: NULL
  228. Others: NULL
  229. *************************************************/
  230. void ctr_Petroleum_jelly(rt_uint32_t delay)
  231. {
  232. beep_init();
  233. pwm_on(2,50000);
  234. rt_thread_delay(delay*1000);
  235. pwm_off(2,0);
  236. rt_thread_delay(1000);
  237. pwm_on(3, 50000);
  238. rt_thread_delay(delay*1000);
  239. pwm_off(3,0);
  240. device_status.fsl_sw = 0;
  241. }
  242. uint8_t ctr_led(uint8_t status_led)
  243. {
  244. rt_pin_mode(LED_SW, PIN_MODE_OUTPUT);
  245. if(status_led==ON)
  246. {
  247. rt_pin_write(LED_SW,ON);
  248. HMI_WRITE("sysTest.switchFill.val=%d",ON);
  249. }
  250. else {
  251. rt_pin_write(LED_SW,OFF);
  252. HMI_WRITE("sysTest.switchPhoto.val=%d",OFF);
  253. HMI_WRITE("sysTest.switchFill.val=%d",OFF);
  254. }
  255. return status_led;
  256. }
  257. /*************************************************
  258. Function: ctr_turn
  259. Description: 转盘驱动
  260. Calls:
  261. Table Accessed: // 被访问的表(此项仅对于牵扯到数据库操作的程序)
  262. Table Updated: // 被修改的表(此项仅对于牵扯到数据库操作的程序)
  263. Input: v=0(复位) v=90转90度
  264. Output: NULL
  265. Return: NULL
  266. Others: NULL
  267. *************************************************/
  268. void ctr_turn(uint8_t v)
  269. {
  270. DTU_Write("turn.mp3");
  271. LOG_I("================v===============:%d\n",v);
  272. rt_uint16_t turn_cnt = 0;
  273. rt_pin_mode(TURN_ZP_R, PIN_MODE_OUTPUT);
  274. rt_pin_mode(TURN_ZP_L, PIN_MODE_OUTPUT);
  275. rt_pin_mode(LIMIT_0, PIN_MODE_INPUT);
  276. rt_pin_mode(LIMIT_90, PIN_MODE_INPUT);
  277. if(v==0&&rt_pin_read(LIMIT_0)==0) return; //如果在初始位置,则不再往下执行
  278. while(rt_pin_read(LIMIT_0)==0||rt_pin_read(LIMIT_90)==0)
  279. {
  280. rt_pin_write(TURN_ZP_R, ON);
  281. rt_pin_write(TURN_ZP_L, OFF);
  282. turn_cnt ++;
  283. rt_thread_delay(100);
  284. if(turn_cnt==1000)
  285. {
  286. turn_cnt = 0;
  287. rt_pin_write(TURN_ZP_R, OFF);
  288. rt_pin_write(TURN_ZP_L, OFF);
  289. char *turn_warn ="limit timeout!!!";
  290. DTU_Write(makeJson_Warn(turn_warn, "ERR"));
  291. rt_free(turn_warn);
  292. break;
  293. }
  294. }
  295. turn_cnt = 0;
  296. while(v==0&&rt_pin_read(LIMIT_0)==1)
  297. {
  298. rt_pin_write(TURN_ZP_R, ON);
  299. rt_pin_write(TURN_ZP_L, OFF);
  300. rt_thread_delay(10);
  301. turn_cnt ++;
  302. if(turn_cnt==5000)
  303. {
  304. turn_cnt = 0;
  305. rt_pin_write(TURN_ZP_R, OFF);
  306. rt_pin_write(TURN_ZP_L, OFF);
  307. char *turn_warn ="turn timrout!!!";
  308. DTU_Write(makeJson_Warn(turn_warn, "ERR"));
  309. rt_free(turn_warn);
  310. break;
  311. }
  312. }
  313. turn_cnt = 0;
  314. while(v==90&&rt_pin_read(LIMIT_90)==1)
  315. {
  316. rt_pin_write(TURN_ZP_R, ON);
  317. rt_pin_write(TURN_ZP_L, OFF);
  318. rt_thread_delay(10);
  319. turn_cnt ++;
  320. if(turn_cnt==5000)
  321. {
  322. turn_cnt = 0;
  323. rt_pin_write(TURN_ZP_R, OFF);
  324. rt_pin_write(TURN_ZP_L, OFF);
  325. char *turn_warn ="turn timrout!!!";
  326. DTU_Write(makeJson_Warn(turn_warn, "ERR"));
  327. rt_free(turn_warn);
  328. break;
  329. }
  330. }
  331. turn_cnt = 0;
  332. rt_pin_write(TURN_ZP_R, OFF);
  333. rt_pin_write(TURN_ZP_L, OFF);
  334. HMI_WRITE("cangWei.rotateFlag.val=0");
  335. }
  336. //路由器供电
  337. void ctr_router(uint8_t status_router)
  338. {
  339. rt_pin_mode(ROUTER, PIN_MODE_OUTPUT);
  340. if(status_router==ON)
  341. {
  342. rt_pin_write(ROUTER,ON);
  343. }
  344. else {
  345. rt_pin_write(ROUTER,OFF);
  346. }
  347. }
  348. //DTU,RTU供电
  349. void ctr_RTU_DTU(uint8_t status_rtu)
  350. {
  351. rt_pin_mode(RTU_DTU, PIN_MODE_OUTPUT);
  352. if(status_rtu==ON)
  353. {
  354. rt_pin_write(RTU_DTU,ON);
  355. }
  356. else
  357. {
  358. rt_pin_write(RTU_DTU,OFF);
  359. }
  360. }
  361. //海康拍照
  362. void Hk_Take_io(void)
  363. {
  364. rt_pin_mode(HK_TAKE, PIN_MODE_OUTPUT);
  365. rt_pin_write(HK_TAKE, ON);
  366. rt_thread_delay(1000);
  367. //Beep_Tip(500);
  368. rt_pin_write(HK_TAKE, 0);
  369. }
  370. /*************************************************
  371. Function: ctr_develop
  372. Description: 培养载玻片孢子
  373. Calls:
  374. Table Accessed: // 被访问的表(此项仅对于牵扯到数据库操作的程序)
  375. Table Updated: // 被修改的表(此项仅对于牵扯到数据库操作的程序)
  376. Input: v=0(复位) v=90转90度
  377. Output: NULL
  378. Return: NULL
  379. Others: NULL
  380. *************************************************/
  381. void ctr_develop(void)
  382. {
  383. rt_kprintf("===============开始培养=================:%d\n",device_status.culture_time);
  384. //已经培养的时间-分钟
  385. device_status.staytime = 0;
  386. rt_uint32_t ii = 0;
  387. while(device_status.develop_flag==1)
  388. {
  389. ii++;
  390. LOG_I("developing...................................%d\n",ii);
  391. LOG_I("============================设定的培养温度:%d\n",device_status.set_tempture);
  392. LOG_I("============================培养仓实时温度:%d\n",device_status.culture_tempture);
  393. if(device_status.culture_tempture<(device_status.set_tempture-10))
  394. {
  395. //未制冷
  396. if(device_status.cold_status==0)
  397. {
  398. ctr_Heat(ON);
  399. }
  400. }
  401. else
  402. {
  403. ctr_Heat(OFF);
  404. }
  405. LOG_I("============================制冷开关:%d\n",device_status.cold_sw);
  406. if(device_status.cold_sw==1)
  407. {
  408. if(device_status.culture_tempture>(device_status.set_tempture-10))
  409. {
  410. if(device_status.heat_status==0)
  411. {
  412. ctr_Cold(ON);
  413. }
  414. }
  415. else
  416. {
  417. ctr_Cold(OFF);
  418. }
  419. }
  420. if(ii%60==0)
  421. {
  422. device_status.staytime++;
  423. if(device_status.staytime/60==device_status.culture_time) device_status.develop_flag = 0;
  424. LOG_I("developed...................................%d分钟\n",device_status.staytime);
  425. float stayedtime = 0.1;
  426. char stayed[5];
  427. stayedtime = device_status.staytime / 60;
  428. rt_sprintf(stayed,"%s",stayedtime);
  429. HMI_WRITE("workSta.staytime.txt=\"%s\"",stayed);
  430. }
  431. rt_thread_delay(1000);
  432. }
  433. ctr_Cold(OFF);
  434. ctr_Heat(OFF);
  435. LOG_I("=========!!!培养完成!!!==========");
  436. }
  437. //拍照
  438. void HK_TakePhoto(void)
  439. {
  440. //触发海康相机拍照
  441. Hk_Take_io();
  442. HMI_WRITE("sysTest.switchPic.val=%d",OFF);
  443. HMI_WRITE("sysTest.switchLed.val=%d",OFF);
  444. }
  445. /*上电初始化*/
  446. void ResetInit(void)
  447. {
  448. device_status.work_done = 1;
  449. ctr_Motor_Driver(0, 0, 0, 0);
  450. //1.打开路由器供电
  451. ctr_router(ON);
  452. ctr_RTU_DTU(ON);
  453. //2.打开相机供电
  454. ctr_photo(ON);
  455. //4.关闭电磁阀
  456. ctr_DiYe(OFF);
  457. //5.关闭加热
  458. ctr_Heat(OFF);
  459. //关闭制冷
  460. ctr_Cold(OFF);
  461. //6.关闭补光灯
  462. ctr_led(OFF);
  463. //
  464. ctr_turn(0);
  465. }
  466. /*入口函数-工作流程*/
  467. static void Work_Loop_thread_entry(void *parameter)
  468. {
  469. Beep_Tip(200);
  470. ResetInit();
  471. while(1)
  472. {
  473. if(device_status.ds==1)
  474. {
  475. //时间段判断
  476. //先判断第一个时间段
  477. time_t now;
  478. time(&now);
  479. static struct tm now_stamp; //现在
  480. static struct tm cul_sh1_stamp; //开始1
  481. static struct tm cul_eh1_stamp; //结束1
  482. static struct tm cul_sh2_stamp; //开始2
  483. static struct tm cul_eh2_stamp; //结束2
  484. static struct tm cul_sh3_stamp; //开始3
  485. static struct tm cul_eh3_stamp; //结束3
  486. now_stamp = *localtime(&now);
  487. //获取定时开始的时间戳
  488. cul_sh1_stamp = *localtime(&now);
  489. cul_sh1_stamp.tm_hour = device_status.culture_sh1;
  490. cul_sh1_stamp.tm_min = 0;
  491. cul_sh1_stamp.tm_sec = 0;
  492. cul_sh2_stamp = *localtime(&now);
  493. cul_sh2_stamp.tm_hour = device_status.culture_sh2;
  494. cul_sh2_stamp.tm_min = 0;
  495. cul_sh2_stamp.tm_sec = 0;
  496. cul_sh3_stamp = *localtime(&now);
  497. cul_sh3_stamp.tm_hour = device_status.culture_sh3;
  498. cul_sh3_stamp.tm_min = 0;
  499. cul_sh3_stamp.tm_sec = 0;
  500. //获取定时结束的时间戳
  501. cul_eh1_stamp = *localtime(&now);
  502. cul_eh1_stamp.tm_hour = device_status.culture_eh1;
  503. cul_eh1_stamp.tm_min = 0;
  504. cul_eh1_stamp.tm_sec = 0;
  505. cul_eh2_stamp = *localtime(&now);
  506. cul_eh2_stamp.tm_hour = device_status.culture_eh2;
  507. cul_eh2_stamp.tm_min = 0;
  508. cul_eh2_stamp.tm_sec = 0;
  509. cul_eh3_stamp = *localtime(&now);
  510. cul_eh3_stamp.tm_hour = device_status.culture_eh3;
  511. cul_eh3_stamp.tm_min = 0;
  512. cul_eh3_stamp.tm_sec = 0;
  513. 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);
  514. 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);
  515. 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);
  516. 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);
  517. 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);
  518. 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);
  519. //此处判断,一个一个时间段判断,判断当前时间是否大于开始时间:
  520. while(difftime(mktime(&now_stamp), mktime(&cul_sh1_stamp)) < 0)
  521. {
  522. time_t now;
  523. time(&now);
  524. cul_sh1_stamp = *localtime(&now);
  525. cul_sh1_stamp.tm_hour = device_status.culture_sh1;
  526. cul_sh1_stamp.tm_min = 0;
  527. cul_sh1_stamp.tm_sec = 0;
  528. now_stamp = *localtime(&now);
  529. 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);
  530. 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);
  531. rt_thread_delay(1000);
  532. }
  533. while(difftime(mktime(&now_stamp), mktime(&cul_sh2_stamp)) < 0&&difftime(mktime(&now_stamp), mktime(&cul_eh1_stamp)) > 0)
  534. {
  535. time_t now;
  536. time(&now);
  537. cul_sh2_stamp = *localtime(&now);
  538. cul_sh2_stamp.tm_hour = device_status.culture_sh2;
  539. cul_sh2_stamp.tm_min = 0;
  540. cul_sh2_stamp.tm_sec = 0;
  541. now_stamp = *localtime(&now);
  542. 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);
  543. 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);
  544. rt_thread_delay(1000);
  545. }
  546. 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))
  547. {
  548. LOG_I("start to collect!!!");
  549. DTU_Write("collect.mp3");
  550. //判断是否在初始位置
  551. ctr_turn(90);
  552. rt_thread_delay(2000);
  553. //涂凡士林
  554. ctr_Petroleum_jelly(10);
  555. rt_thread_delay(5000);
  556. ctr_turn(90);
  557. //只有开始和结束时刻不同的时间段,才有效
  558. if((difftime(mktime(&cul_eh1_stamp), mktime(&now_stamp)) > 0)||(difftime(mktime(&cul_eh2_stamp), mktime(&now_stamp)) > 0))
  559. {
  560. device_status.work_status = 1;
  561. rt_uint32_t collect_cnt = 0;
  562. ctr_Collect_Fan(ON);
  563. if((difftime(mktime(&cul_eh1_stamp), mktime(&now_stamp)) > 0))
  564. {
  565. collect_cnt = difftime(mktime(&cul_eh1_stamp), mktime(&now_stamp));
  566. while(collect_cnt--)
  567. {
  568. rt_kprintf("===========采集风机启动,正在收集.....%d\n",collect_cnt);
  569. rt_thread_delay(1000);
  570. }
  571. collect_cnt = 2;
  572. }
  573. if(difftime(mktime(&cul_eh2_stamp), mktime(&now_stamp)) > 0)
  574. {
  575. collect_cnt = difftime(mktime(&cul_eh2_stamp), mktime(&now_stamp));
  576. while(collect_cnt--)
  577. {
  578. rt_kprintf("===========采集风机启动,正在收集.....%d\n",collect_cnt);
  579. rt_thread_delay(1000);
  580. }
  581. }
  582. ctr_Collect_Fan(OFF);
  583. }
  584. else
  585. {
  586. LOG_I("this collect time is 0s,The wait time cannot be negative!");
  587. }
  588. }
  589. else
  590. {
  591. LOG_I("next collect time is not arrivd!!! >>> .. start now time:%d",mktime(&now_stamp));
  592. }
  593. if(device_status.work_status==1)
  594. {
  595. LOG_I("===============collect ok,turn to drop!!!");
  596. device_status.develop_flag=1;
  597. device_status.work_status=2; //现在是培养
  598. DTU_Write("develop.mp3");
  599. ctr_turn(90);
  600. rt_thread_delay(1000);
  601. ctr_DiYe(device_status.drop_sec);
  602. rt_thread_delay(1000);
  603. ctr_develop();
  604. ctr_turn(90);
  605. rt_thread_delay(1000);
  606. DTU_Write("takephoto.mp3");
  607. device_status.work_status=3; //现在是拍照
  608. device_status.autotakepic=1; //对焦拍照
  609. while(device_status.autotakepic==0)
  610. {
  611. rt_thread_delay(500);
  612. LOG_I("正在对焦拍照............\n");
  613. }
  614. device_status.work_status = 0; //待机
  615. DTU_Write("wait.mp3");
  616. LOG_I("=====================work finished==================");
  617. }
  618. }
  619. else
  620. {
  621. LOG_W("==================!!!设备已关机!!!===================");
  622. }
  623. rt_thread_delay(1000);
  624. }
  625. }
  626. /*工作流程线程*/
  627. int Work_Loop_Task(void)
  628. {
  629. /* 创建线程*/
  630. tid_workloop = rt_thread_create("work_loop_thread",
  631. Work_Loop_thread_entry, RT_NULL,
  632. WORK_LOOP_THREAD_STACK_SIZE, //2048
  633. WORK_LOOP_THREAD_PRIORITY, //12
  634. WORK_LOOP_THREAD_TIMESLICE); //5
  635. if(tid_workloop!=RT_NULL)
  636. {
  637. rt_thread_startup(tid_workloop);
  638. }
  639. return 0;
  640. }