control.c 38 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314
  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. #include "dtu_uart2.h"
  17. #include "sht30_collect.h"
  18. #define DBG_ENABLE
  19. #define DBG_COLOR
  20. #define DBG_TAG "control"
  21. #define DBG_LEVEL DBG_LOG
  22. #include <rtdbg.h> //must after of DBG_LVL, DBG_TAG or other options
  23. //工作检测
  24. #define WORK_CHECK_THREAD_PRIORITY 23 //线程优先级
  25. #define WORK_CHECK_THREAD_STACK_SIZE 1024 //栈大小
  26. #define WORK_CHECK_THREAD_TIMESLICE 5 //时间片
  27. //工作流程
  28. #define WORK_LOOP_THREAD_PRIORITY 12 //线程优先级
  29. #define WORK_LOOP_THREAD_STACK_SIZE 2048 //栈大小
  30. #define WORK_LOOP_THREAD_TIMESLICE 5 //时间片
  31. #define PWM_EN 1 //0关闭,1-打开
  32. //设备状态表结构体
  33. Device_Status_typedef device_status;
  34. Device_slide_typedef slide_para;
  35. static rt_thread_t tid_workloop = RT_NULL;
  36. static rt_thread_t tid_wkstc = RT_NULL;
  37. static rt_thread_t tid_ctr = RT_NULL;
  38. static rt_thread_t tid_heat = RT_NULL;
  39. static rt_thread_t rt_slide = RT_NULL;
  40. /***************************************************************************/
  41. int thread_delete_workloop(void)
  42. {
  43. rt_err_t result;
  44. if(tid_workloop!=RT_NULL)
  45. {
  46. result = rt_thread_delete(tid_workloop);
  47. }
  48. return result;
  49. }
  50. int thread_restart_workloop(void)
  51. {
  52. rt_err_t result;
  53. result = Work_Loop_Task();
  54. return result;
  55. }
  56. void slidelock();
  57. //滑台垂直方向开关
  58. uint8_t ctr_swz(uint8_t status_swz)
  59. {
  60. rt_pin_mode(SHAKE_SW, PIN_MODE_OUTPUT);
  61. if(status_swz == ON){
  62. rt_pin_write(SHAKE_SW,ON);
  63. }
  64. else if(status_swz == OFF){
  65. rt_pin_write(SHAKE_SW,OFF);
  66. }
  67. return status_swz;
  68. }
  69. //限位开关判断函数
  70. void turnlimit(void)
  71. {
  72. //Motor_shake(ON,0);
  73. Motor_Qingsao_R_PWM(ON);
  74. static uint16_t turn_timeout = 0;
  75. rt_pin_mode(LIMIT_DOWN,PIN_MODE_INPUT);
  76. while(rt_pin_read(LIMIT_DOWN)==0)
  77. {
  78. rt_thread_delay(20);
  79. while(rt_pin_read(LIMIT_DOWN)==0)
  80. {
  81. //ctr_cangmen_down(CLOSE);
  82. rt_thread_delay(50);
  83. turn_timeout++;
  84. if(turn_timeout==200){
  85. char *translate = makeJson_Warn("translate","limit timeout");
  86. DTU_Write("%s",translate);
  87. rt_free(translate);
  88. break;
  89. }
  90. }
  91. break;
  92. }
  93. while(rt_pin_read(LIMIT_DOWN)==1)
  94. {
  95. rt_thread_delay(10);
  96. while(rt_pin_read(LIMIT_DOWN)==1)
  97. {
  98. turn_timeout++;
  99. rt_thread_delay(5);
  100. if(turn_timeout==2000){
  101. char *translate = makeJson_Warn("translate","limit timeout");
  102. DTU_Write("%s",translate);
  103. rt_free(translate);
  104. break;
  105. }
  106. }
  107. break;
  108. }
  109. while(rt_pin_read(LIMIT_DOWN)==0)
  110. {
  111. rt_thread_delay(20);
  112. if(rt_pin_read(LIMIT_DOWN)==0)
  113. {
  114. //Motor_shake(OFF,0);
  115. Motor_Qingsao_R_PWM(OFF);
  116. break;
  117. }
  118. else {
  119. break;
  120. }
  121. }
  122. //Motor_shake(OFF,0);
  123. Motor_Qingsao_R_PWM(OFF);
  124. turn_timeout = 0;
  125. char *translate = makeJson_Warn("translate","done");
  126. DTU_Write("%s",translate);
  127. rt_free(translate);
  128. // rt_thread_delay(1000);
  129. }
  130. uint32_t mapSpeed(int a1) {
  131. const int a1Min = 0;
  132. const int a1Max = 100;
  133. const int a2Min = 50000; //20khz
  134. const int a2Max = 200000; //5khz
  135. // 确保 a1 在有效范围内
  136. if (a1 < a1Min) {
  137. a1 = a1Min;
  138. } else if (a1 > a1Max) {
  139. a1 = a1Max;
  140. }
  141. // 执行线性映射
  142. uint32_t a2 = a2Max - ((a2Max - a2Min) * a1) / (a1Max - a1Min);
  143. return a2;
  144. }
  145. void stop_move(void)
  146. {
  147. slide_para.stop_flag = 1;
  148. slidelock();
  149. rt_pin_mode(HK_IO, PIN_MODE_OUTPUT); //PB14 EN
  150. pwm_stop();
  151. rt_pin_write(HK_IO, ON);
  152. }
  153. //DIR_ 轴选择(0-X,1-Y,2-Z) dir 轴方向
  154. uint32_t ctr_move(uint8_t DIR_,uint8_t dir_,uint32_t dis_,uint32_t pulse)
  155. {
  156. uint32_t j;
  157. slidelock();
  158. //限位检测初始化
  159. rt_pin_mode(Limit_Motor_X, PIN_MODE_INPUT);
  160. rt_pin_mode(Limit_Motor_Y, PIN_MODE_INPUT);
  161. rt_pin_mode(Limit_Motor_Z, PIN_MODE_INPUT);
  162. //驱动器初始化
  163. rt_pin_mode(HK_IO, PIN_MODE_OUTPUT); //PB14 EN
  164. rt_pin_mode(CTR_RO_LIMIT, PIN_MODE_OUTPUT); //PB15 DIR
  165. //rt_pin_mode(CTR_RC_LIMIT, PIN_MODE_OUTPUT); //PC6 PWM
  166. // if(dis_ >=1000){
  167. // beep_set(500000, 250000); //PWM使能
  168. // }else{
  169. // beep_set(2000000, 1000000); //PWM使能
  170. // }
  171. //驱动使能
  172. //rt_pin_write(HK_IO, ON);
  173. //方向选择
  174. if(dir_ == 1){
  175. rt_pin_write(CTR_RO_LIMIT, ON);
  176. }else{
  177. rt_pin_write(CTR_RO_LIMIT, OFF);
  178. }
  179. switch(DIR_){
  180. case X_:
  181. ctr_lamp(1, ON); //X轴电源开关:开
  182. rt_thread_delay(100);
  183. //判断限位
  184. if(dir_== 0 && rt_pin_read(Limit_Motor_X)==1){
  185. for(int z =0;z < 3; z++){
  186. Beep_Tip(200);
  187. LOG_W("X:已在初始位置!");
  188. }
  189. return 0;
  190. }
  191. rt_pin_write(HK_IO, ON);
  192. beep_set(pulse, pulse/2); //PWM使能
  193. for(j=0;j<dis_;j++){
  194. if(slide_para.stop_flag == 0){
  195. rt_thread_delay(10); //10ms
  196. if(dir_==0&&rt_pin_read(Limit_Motor_X)==1){
  197. rt_thread_delay(10); //10ms
  198. if(rt_pin_read(Limit_Motor_X)==1){
  199. j = dis_;
  200. }
  201. }
  202. }else{ //急停
  203. for(int z =0;z < 3; z++){
  204. Beep_Tip(200);
  205. }
  206. break;
  207. }
  208. }
  209. break;
  210. case Y_:
  211. ctr_Collect_Fan(ON); //Y轴电源开关:开
  212. rt_thread_delay(100);
  213. //判断限位
  214. if(dir_== 0 && rt_pin_read(Limit_Motor_Y)==1){
  215. for(int z =0;z < 3; z++){
  216. Beep_Tip(200);
  217. LOG_W("Y:已在初始位置!");
  218. }
  219. return 0;
  220. }
  221. rt_pin_write(HK_IO, ON);
  222. beep_set(pulse, pulse/3); //PWM使能
  223. for(j=0;j<dis_;j++){
  224. if(slide_para.stop_flag == 0){
  225. rt_thread_delay(1);
  226. if(dir_==0&&rt_pin_read(Limit_Motor_Y)==1){
  227. rt_thread_delay(1);
  228. if(rt_pin_read(Limit_Motor_Y)==1){
  229. j = dis_;
  230. }
  231. }
  232. }else{ //急停
  233. for(int z =0;z < 3; z++){
  234. Beep_Tip(200);
  235. }
  236. break;
  237. }
  238. }
  239. break;
  240. case Z_:
  241. ctr_swz(ON); //Z轴电源开关:开
  242. rt_thread_delay(100); //
  243. //判断限位
  244. if(dir_== 0 && rt_pin_read(Limit_Motor_Z)==1){
  245. for(int z =0;z < 3; z++){
  246. Beep_Tip(200);
  247. LOG_W("Z:已在初始位置!");
  248. }
  249. return 0;
  250. }
  251. //驱动使能
  252. rt_pin_write(HK_IO, ON);
  253. beep_set(pulse, pulse/2); //PWM使能
  254. for(j=0;j<dis_;j++){
  255. if(slide_para.stop_flag == 0){
  256. rt_thread_delay(10);
  257. if(dir_==0&&rt_pin_read(Limit_Motor_Z)==1){
  258. rt_thread_delay(10);
  259. if(rt_pin_read(Limit_Motor_Z)==1){
  260. j = dis_;
  261. }
  262. }
  263. }else{ //急停
  264. for(int z =0;z < 3; z++){
  265. Beep_Tip(200);
  266. }
  267. break;
  268. }
  269. }
  270. break;
  271. }
  272. pwm_stop();
  273. rt_pin_write(HK_IO, ON);
  274. switch(DIR_){
  275. case X_:
  276. ctr_lamp(ON,1); //X轴开关:关
  277. ctr_swz(OFF); //Z轴开关:关
  278. ctr_Collect_Fan(OFF); //Y轴开关:关
  279. break;
  280. case Y_:
  281. ctr_swz(OFF); //Z轴开关:关
  282. ctr_lamp(OFF,1); //X轴开关:关
  283. ctr_Collect_Fan(ON); //Y轴开关:开
  284. break;
  285. case Z_:
  286. ctr_swz(ON); //Y轴开关:关
  287. ctr_lamp(OFF,1); //X轴开关:关
  288. ctr_Collect_Fan(OFF); //Y轴开关:关
  289. break;
  290. }
  291. return dis_;
  292. }
  293. void slidelock()
  294. {
  295. ctr_lamp(OFF,1); //X轴开关:关
  296. ctr_swz(OFF); //Z轴开关:关
  297. ctr_Collect_Fan(OFF); //Y轴开关:关
  298. }
  299. /**********************************************************************/
  300. /*光控*/
  301. uint8_t In_Light_status(void)
  302. {
  303. rt_pin_mode(LIGHT_PIN,PIN_MODE_INPUT);
  304. return rt_pin_read(LIGHT_PIN);
  305. }
  306. /*雨控*/
  307. uint8_t In_Rain_status(void)
  308. {
  309. rt_pin_mode(RAIN_PIN,PIN_MODE_INPUT);
  310. return rt_pin_read(RAIN_PIN);
  311. }
  312. /*加热*/
  313. uint8_t ctr_Heat(uint8_t status_heat)
  314. {
  315. device_status.heat_status = status_heat;
  316. rt_pin_mode(Heat_Pin, PIN_MODE_OUTPUT);
  317. rt_pin_write(Heat_Pin,status_heat);
  318. return status_heat;
  319. }
  320. /*制冷*/
  321. uint8_t ctr_Cold(uint8_t status_cold)
  322. {
  323. device_status.cold_status = status_cold;
  324. rt_pin_mode(Cold_Pin, PIN_MODE_OUTPUT);
  325. rt_pin_write(Cold_Pin,status_cold);
  326. return status_cold;
  327. }
  328. /*相机供电*/
  329. void ctr_photo(uint8_t status_photo)
  330. {
  331. rt_pin_mode(PHOTO,PIN_MODE_OUTPUT);
  332. rt_pin_write(PHOTO,status_photo);
  333. }
  334. /*************************************************
  335. Function: ctr_Cool_Fan
  336. Description: 散热风机的开关
  337. Calls:
  338. Table Accessed: // 被访问的表(此项仅对于牵扯到数据库操作的程序)
  339. Table Updated: // 被修改的表(此项仅对于牵扯到数据库操作的程序)
  340. Input: ON-开,OFF-关
  341. Output: NULL
  342. Return: ON-开,OFF-关
  343. Others: NULL
  344. *************************************************/
  345. uint8_t ctr_Cool_Fan(uint8_t status_cool)
  346. {
  347. device_status.cool_fan_status = status_cool;
  348. rt_pin_mode(Cool_Fan_L, PIN_MODE_OUTPUT);
  349. rt_pin_mode(Cool_Fan_R, PIN_MODE_OUTPUT);
  350. if(status_cool==OFF)
  351. {
  352. rt_pin_write(Cool_Fan_L,OFF);
  353. rt_pin_write(Cool_Fan_R,OFF);
  354. }
  355. if(status_cool==ON)
  356. {
  357. rt_pin_write(Cool_Fan_L,ON);
  358. rt_pin_write(Cool_Fan_R,OFF);
  359. }
  360. return device_status.cool_fan_status;
  361. }
  362. /*************************************************
  363. Function: ctr_Collect_Fan
  364. Description: 采集风机的开关
  365. Calls:
  366. Table Accessed: // 被访问的表(此项仅对于牵扯到数据库操作的程序)
  367. Table Updated: // 被修改的表(此项仅对于牵扯到数据库操作的程序)
  368. Input: ON-开,OFF-关
  369. Output: NULL
  370. Return: ON-开,OFF-关
  371. Others: NULL
  372. *************************************************/
  373. uint8_t ctr_Collect_Fan(uint8_t status_collect)
  374. {
  375. device_status.collect_fan_status = status_collect;
  376. rt_pin_mode(Collect_Fan, PIN_MODE_OUTPUT);
  377. if(status_collect==OFF)
  378. {
  379. rt_pin_write(Collect_Fan,OFF);
  380. }
  381. if(status_collect==ON)
  382. {
  383. rt_pin_write(Collect_Fan,ON);
  384. }
  385. return device_status.collect_fan_status;
  386. }
  387. /*上仓门*/
  388. uint8_t ctr_cangmen_up(uint8_t status_up)
  389. {
  390. rt_pin_mode(Collect_fan_R, PIN_MODE_OUTPUT);
  391. rt_pin_mode(Collect_fan_L, PIN_MODE_OUTPUT);
  392. if(status_up==OFF)
  393. {
  394. rt_pin_write(Collect_fan_R,ON);
  395. rt_pin_write(Collect_fan_L,ON);
  396. device_status.ctr_up_motor = 0;
  397. rt_thread_delay(1000);
  398. }
  399. if(status_up==OPEN)
  400. {
  401. device_status.up_status = 1;
  402. rt_pin_write(Collect_fan_R,OFF);
  403. rt_pin_write(Collect_fan_L,OFF);
  404. rt_pin_write(Collect_fan_R,ON);
  405. rt_pin_write(Collect_fan_L,OFF);
  406. }
  407. if(status_up==CLOSE)
  408. {
  409. device_status.up_status = 0;
  410. rt_pin_write(Collect_fan_R,OFF);
  411. rt_pin_write(Collect_fan_L,OFF);
  412. rt_pin_write(Collect_fan_R,OFF);
  413. rt_pin_write(Collect_fan_L,ON);
  414. }
  415. return device_status.up_status;
  416. }
  417. //下仓门
  418. uint8_t ctr_cangmen_down(uint8_t status_down)
  419. {
  420. rt_pin_mode(C_DOWN_R, PIN_MODE_OUTPUT);
  421. rt_pin_mode(C_DOWN_L, PIN_MODE_OUTPUT);
  422. if(status_down==OFF)
  423. {
  424. rt_pin_write(C_DOWN_R,ON);
  425. rt_pin_write(C_DOWN_L,ON);
  426. device_status.ctr_down_motor = 0;
  427. rt_thread_delay(1000);
  428. }
  429. if(status_down==OPEN)
  430. {
  431. device_status.down_status = 1;
  432. rt_pin_write(C_DOWN_R,OFF);
  433. rt_pin_write(C_DOWN_L,OFF);
  434. rt_pin_write(C_DOWN_R,ON);
  435. rt_pin_write(C_DOWN_L,OFF);
  436. }
  437. if(status_down==CLOSE)
  438. {
  439. device_status.down_status = 0;
  440. rt_pin_write(C_DOWN_R,OFF);
  441. rt_pin_write(C_DOWN_L,OFF);
  442. rt_pin_write(C_DOWN_R,OFF);
  443. rt_pin_write(C_DOWN_L,ON);
  444. }
  445. return device_status.down_status;
  446. }
  447. //镇流器
  448. uint8_t ctr_lamp(uint8_t status_lamp,uint8_t lamp_num)
  449. {
  450. rt_pin_mode(LAMP_SW, PIN_MODE_OUTPUT);
  451. rt_pin_mode(LAMP_1_SW, PIN_MODE_OUTPUT);
  452. rt_pin_mode(LAMP_2_SW, PIN_MODE_OUTPUT);
  453. if(status_lamp==ON)
  454. {
  455. switch(lamp_num){
  456. case 1:
  457. rt_pin_write(LAMP_SW,ON);
  458. device_status.lamp_status = status_lamp;
  459. break;
  460. case 2:
  461. rt_pin_write(LAMP_1_SW,ON);
  462. device_status.lamp_status = status_lamp;
  463. break;
  464. case 3:
  465. rt_pin_write(LAMP_2_SW,ON);
  466. device_status.lamp_status = status_lamp;
  467. break;
  468. default:
  469. break;
  470. }
  471. }
  472. else {
  473. switch(lamp_num){
  474. case 1:
  475. rt_pin_write(LAMP_SW,OFF);
  476. device_status.lamp_status = status_lamp;
  477. break;
  478. case 2:
  479. rt_pin_write(LAMP_1_SW,OFF);
  480. device_status.lamp1_status = status_lamp;
  481. break;
  482. case 3:
  483. rt_pin_write(LAMP_2_SW,OFF);
  484. device_status.lamp2_status = status_lamp;
  485. break;
  486. default:
  487. break;
  488. }
  489. }
  490. return device_status.lamp_status;
  491. }
  492. //震动电机
  493. uint8_t ctr_shake(uint8_t status_shake,uint16_t shake_sec)
  494. {
  495. static rt_uint16_t shake_i = 0;
  496. shake_i = atoi(device_status.power);
  497. LOG_I("震动电机待机电流:%d",shake_i);
  498. if(device_status.dtype==7&&shake_sec!=0)
  499. DTU_Write("drop");
  500. rt_pin_mode(SHAKE_SW, PIN_MODE_OUTPUT);
  501. #if 0
  502. rt_pin_write(SHAKE_SW,ON);
  503. return 0;
  504. #endif
  505. if(status_shake==ON&&device_status.shake_ws==1)
  506. {
  507. #if 0
  508. for(int8_t s = 0;s++;s<2)
  509. {
  510. rt_pin_write(SHAKE_SW,ON);
  511. rt_thread_delay(100);
  512. rt_pin_write(SHAKE_SW,OFF);
  513. rt_thread_delay(1000);
  514. }
  515. #endif
  516. rt_pin_write(SHAKE_SW,ON);
  517. if(device_status.dtype==3)
  518. {
  519. while(shake_sec--)
  520. {
  521. rt_thread_delay(100);
  522. if(shake_sec==20&&device_status.clear_status==0&&device_status.work_status==1&&atoi(device_status.power)-shake_i<100&&shake_i!=0&&shake_i<5000)
  523. {
  524. char * shake_warn = makeJson_Warn("电流不足", "震动电机");
  525. DTU_Write("%s",shake_warn);
  526. rt_free(shake_warn);
  527. }
  528. LOG_D("震动电机:%d",atoi(device_status.power));
  529. }
  530. }
  531. if(device_status.dtype==7) rt_thread_delay(shake_sec*1000);
  532. rt_pin_write(SHAKE_SW,OFF);
  533. }
  534. else
  535. {
  536. rt_pin_write(SHAKE_SW,OFF);
  537. }
  538. if(device_status.dtype==7)
  539. return status_shake;
  540. }
  541. //补光
  542. uint8_t ctr_led(uint8_t status_led)
  543. {
  544. rt_pin_mode(LED_SW, PIN_MODE_OUTPUT);
  545. if(device_status.version_type==6)
  546. rt_pin_mode(LED_P, PIN_MODE_OUTPUT);
  547. if(status_led==ON)
  548. {
  549. rt_pin_write(LED_SW,ON);
  550. if(device_status.version_type==6)
  551. rt_pin_write(LED_P,ON);
  552. }
  553. else if(status_led==OFF){
  554. rt_pin_write(LED_SW,OFF);
  555. if(device_status.version_type==6)
  556. rt_pin_write(LED_P,OFF);
  557. }
  558. return status_led;
  559. }
  560. /*************************************************
  561. Function: ctr_Petroleum_jelly
  562. Description: 涂凡士林
  563. Calls:
  564. Table Accessed: // 被访问的表(此项仅对于牵扯到数据库操作的程序)
  565. Table Updated: // 被修改的表(此项仅对于牵扯到数据库操作的程序)
  566. Input: NULL
  567. Output: NULL
  568. Return: NULL
  569. Others: NULL
  570. *************************************************/
  571. void ctr_Petroleum_jelly(rt_uint32_t delay)
  572. {
  573. beep_init();
  574. pwm_on(2,50000);
  575. rt_thread_delay(delay*1000);
  576. pwm_off(2,0);
  577. rt_thread_delay(1000);
  578. pwm_on(3, 50000);
  579. rt_thread_delay(delay*1000);
  580. pwm_off(3,0);
  581. device_status.fsl_sw = 0;
  582. }
  583. //1.0转仓
  584. void turnzp(void)
  585. {
  586. static uint16_t turn_timeout = 0;
  587. // rt_pin_mode(CLEAR_R, PIN_MODE_OUTPUT);
  588. // rt_pin_mode(CLEAR_L, PIN_MODE_OUTPUT);
  589. rt_pin_mode(CLEAR_R_LIMIT,PIN_MODE_INPUT);
  590. // rt_pin_write(CLEAR_R,OFF);
  591. // rt_pin_write(CLEAR_L,OFF);
  592. while(rt_pin_read(CLEAR_R_LIMIT)==0)
  593. {
  594. rt_thread_delay(20);
  595. while(rt_pin_read(CLEAR_R_LIMIT)==0)
  596. {
  597. // rt_pin_write(CLEAR_R,ON);
  598. // rt_pin_write(CLEAR_L,OFF);
  599. Motor_Juandai(ON);
  600. rt_thread_delay(50);
  601. turn_timeout++;
  602. if(turn_timeout==600)
  603. {
  604. LOG_E("检测不到限位,电机强制停止");
  605. char *ctr_zp_limit_warn =makeJson_Warn("电流不足/限位超时","转盘电机");
  606. DTU_Write("%s",ctr_zp_limit_warn);
  607. rt_free(ctr_zp_limit_warn);
  608. break;
  609. }
  610. }
  611. break;
  612. }
  613. while(rt_pin_read(CLEAR_R_LIMIT)==1)
  614. {
  615. rt_thread_delay(20);
  616. while(rt_pin_read(CLEAR_R_LIMIT)==1)
  617. {
  618. // rt_pin_write(CLEAR_R,ON);
  619. // rt_pin_write(CLEAR_L,OFF);
  620. Motor_Juandai(ON);
  621. rt_thread_delay(50);
  622. turn_timeout++;
  623. if(turn_timeout==600)
  624. {
  625. LOG_E("检测不到离开限位,电机或者限位开关异常,电机强制停止");
  626. char *ctr_zp_limit_warn =makeJson_Warn("检测不到离开限位,电机未启动或者限位开关故障","转盘电机");
  627. DTU_Write("%s",ctr_zp_limit_warn);
  628. rt_free(ctr_zp_limit_warn);
  629. break;
  630. }
  631. }
  632. break;
  633. }
  634. while(rt_pin_read(CLEAR_R_LIMIT)==0)
  635. {
  636. rt_thread_delay(20);
  637. if(rt_pin_read(CLEAR_R_LIMIT)==0)
  638. {
  639. // rt_pin_write(CLEAR_R,OFF);
  640. // rt_pin_write(CLEAR_L,OFF);
  641. Motor_Juandai(OFF);
  642. break;
  643. }
  644. else {
  645. break;
  646. }
  647. }
  648. Motor_Juandai(OFF);
  649. // rt_pin_write(CLEAR_R,OFF);
  650. // rt_pin_write(CLEAR_L,OFF);
  651. turn_timeout = 0;
  652. rt_thread_delay(1000);
  653. }
  654. //路由器供电
  655. void ctr_router(uint8_t status_router)
  656. {
  657. rt_pin_mode(ROUTER, PIN_MODE_OUTPUT);
  658. if(device_status.version_type==6)
  659. rt_pin_mode(ROUTER_P,PIN_MODE_OUTPUT);
  660. //rt_pin_mode(POWER_CLEAR, PIN_MODE_OUTPUT);
  661. if(status_router==ON)
  662. {
  663. rt_pin_write(ROUTER,ON);
  664. //
  665. #if LAMP_EN == 0
  666. if(device_status.version_type==6)
  667. rt_pin_write(ROUTER_P,ON);
  668. #endif
  669. }
  670. else {
  671. rt_pin_write(ROUTER,OFF);
  672. //
  673. #if LAMP_EN == 0
  674. if(device_status.version_type==6)
  675. rt_pin_write(ROUTER_P,OFF);
  676. #endif
  677. }
  678. }
  679. //清扫-推杆电机
  680. void ctr_TG_Clear(uint16_t clear_timeout)
  681. {
  682. #if 0
  683. int current_clear[200];
  684. int16_t Electric_current = atoi(device_status.power); //获取电机运动前的电流
  685. LOG_I("清扫电机待机:%d",Electric_current);
  686. #endif
  687. static uint16_t clear_count = 0;
  688. clear_count = clear_timeout;
  689. #if PWM_EN == 0
  690. rt_pin_mode(CLEAR_R, PIN_MODE_OUTPUT);
  691. rt_pin_mode(CLEAR_L, PIN_MODE_OUTPUT);
  692. #endif
  693. while(clear_count!=0)
  694. {
  695. #if PWM_EN == 0
  696. rt_pin_write(CLEAR_R,ON);
  697. rt_pin_write(CLEAR_L,OFF);
  698. #else
  699. Motor_Qingsao_R_PWM(ON);
  700. Motor_Qingsao_L_PWM(OFF);
  701. #endif
  702. clear_count--;
  703. rt_thread_delay(100);
  704. }
  705. #if PWM_EN == 0
  706. rt_pin_write(CLEAR_R,ON);
  707. rt_pin_write(CLEAR_L,ON);
  708. #else
  709. Motor_Qingsao_R_PWM(OFF);
  710. Motor_Qingsao_L_PWM(OFF);
  711. #endif
  712. rt_thread_delay(3000);
  713. clear_count = 0;
  714. while(clear_timeout!=clear_count)
  715. {
  716. #if PWM_EN == 0
  717. rt_pin_write(CLEAR_R,OFF);
  718. rt_pin_write(CLEAR_L,ON);
  719. #else
  720. Motor_Qingsao_R_PWM(OFF);
  721. Motor_Qingsao_L_PWM(ON);
  722. #endif
  723. // if(clear_count<200)
  724. // current_clear[clear_count] = atoi(device_status.power);
  725. clear_count++;
  726. rt_thread_delay(100);
  727. }
  728. #if PWM_EN == 0
  729. rt_pin_write(CLEAR_R,ON);
  730. rt_pin_write(CLEAR_L,ON);
  731. #else
  732. Motor_Qingsao_R_PWM(OFF);
  733. Motor_Qingsao_L_PWM(OFF);
  734. #endif
  735. #if 0
  736. bubblesort(current_clear,200);
  737. if(current_clear[199]-Electric_current <100&&device_status.work_status==1&&Electric_current!=0&&Electric_current<5000)
  738. {
  739. LOG_E("清扫电机电流不足:%d!",current_clear[199]);
  740. char *ctr_clear_warn = makeJson_Warn("电流不足","清扫电机");
  741. DTU_Write("%s",ctr_clear_warn);
  742. rt_free(ctr_clear_warn);
  743. }
  744. #endif
  745. rt_thread_delay(2000);
  746. device_status.clear_status = 0;
  747. }
  748. //DTU,RTU供电
  749. void ctr_RTU_DTU(uint8_t status_rtu)
  750. {
  751. rt_pin_mode(RTU_DTU, PIN_MODE_OUTPUT);
  752. if(status_rtu==ON)
  753. {
  754. rt_pin_write(RTU_DTU,ON);
  755. }
  756. else
  757. {
  758. LOG_W("RTU电源复位!!!");
  759. rt_pin_write(RTU_DTU,OFF);
  760. }
  761. }
  762. //海康拍照
  763. void Hk_Take_io(void)
  764. {
  765. rt_pin_mode(HK_TAKE, PIN_MODE_OUTPUT);
  766. rt_pin_mode(HK_IO, PIN_MODE_OUTPUT);
  767. rt_pin_write(HK_TAKE, 1);
  768. rt_pin_write(HK_IO, 0);
  769. if(device_status.dtype==3)
  770. Beep_Tip(1000);
  771. if(device_status.dtype==7)
  772. rt_thread_mdelay(1000);
  773. rt_pin_write(HK_TAKE, 0);
  774. rt_pin_write(HK_IO, 1);
  775. }
  776. //初始化所有控制驱动,关闭
  777. void HardWare_Init(uint8_t boot)
  778. {
  779. Beep_Tip(200);
  780. //关闭上仓门
  781. ctr_cangmen_up(OFF);
  782. ctr_cangmen_down(OFF);
  783. //关闭镇流器
  784. ctr_lamp(OFF,1);
  785. //关闭震动电机
  786. ctr_shake(OFF,0);
  787. //关闭加热
  788. ctr_Heat(OFF);
  789. //关闭补光灯
  790. ctr_led(OFF);
  791. //关闭12V供电(海康相机,RTU)
  792. ctr_photo(OFF);
  793. }
  794. //拍照
  795. void HK_TakePhoto(void)
  796. {
  797. //打开补光灯
  798. DTU_Write("takephoto.mp3");
  799. rt_thread_delay(10000);
  800. char *takephotojson = makeJson_takephoto();
  801. DTU_Write("%s",takephotojson);
  802. rt_free(takephotojson);
  803. //吸虫塔
  804. if(device_status.version_type!=6)
  805. {
  806. ctr_led(ON);
  807. if(device_status.version_type==48)
  808. {
  809. rt_thread_delay(1000*60);
  810. }
  811. else {
  812. rt_thread_delay(1000*15);
  813. }
  814. }
  815. //触发海康相机拍照
  816. Hk_Take_io();
  817. if(device_status.version_type!=6)
  818. {
  819. rt_thread_delay(1000*45);
  820. }
  821. else {
  822. ctr_led(ON);
  823. rt_thread_delay(1000*19);
  824. }
  825. ctr_led(OFF);
  826. }
  827. //光控测试任务
  828. void SunTest(void)
  829. {
  830. rt_uint16_t ui_timeout_l = 0;
  831. //未检测到光照,一秒扫描等待,超时30S
  832. while(Read_Light_Voltage()<500)
  833. {
  834. ui_timeout_l ++;
  835. rt_thread_delay(1000);
  836. if(ui_timeout_l==30) break;
  837. }
  838. rt_thread_delay(3000);
  839. if(Read_Light_Voltage()<500)
  840. {
  841. device_status.sun_status = 0;//光控状态
  842. }
  843. if(Read_Light_Voltage()>500)
  844. {
  845. rt_thread_delay(1000);
  846. }
  847. rt_thread_delay(3000);
  848. if(Read_Light_Voltage()>500)
  849. {
  850. device_status.sun_status = 1;
  851. ctr_lamp(OFF,1);
  852. }
  853. device_status.sun_test = 0;
  854. device_status.work_status=0;
  855. }
  856. /*上电初始化*/
  857. void ResetInit(void)
  858. {
  859. //关闭电磁阀
  860. ctr_shake(OFF, 0);
  861. //关闭加热
  862. ctr_Heat(OFF);
  863. //关闭制冷
  864. ctr_Cold(OFF);
  865. //关闭补光灯
  866. ctr_led(OFF);
  867. //关闭Y轴驱动电源
  868. ctr_Collect_Fan(OFF);
  869. //关闭X轴驱动电源
  870. }
  871. //出厂前自检 0-开机自检 1-屏幕或指令下发手动自检
  872. void HardWare_Check(uint8_t boot)
  873. {
  874. //停止所有动作 -完成
  875. HardWare_Init(boot);
  876. }
  877. //工作状态检测
  878. /*孢子仪多段定时功能函数
  879. * 循环判断定时的触发
  880. *
  881. */
  882. u_int8_t alarmCheck(u_int8_t starthour,u_int8_t endhour)
  883. {
  884. u_int8_t workflag = 0;
  885. if(starthour == endhour) return workflag;
  886. //雨控检测,温控检测,电池电压检测
  887. // while(1)
  888. // {
  889. // rt_thread_delay(1000);
  890. if(starthour < endhour)
  891. {
  892. LOG_D("开始和结束是同一天");
  893. time_t now;
  894. time(&now);
  895. static struct tm nowtime; //现在
  896. static struct tm starttime; //开始
  897. static struct tm endtime; //结束
  898. //获取当前时间戳
  899. nowtime =*localtime(&now);
  900. nowtime.tm_hour = nowtime.tm_hour-8;
  901. //获取定时开始的时间戳
  902. starttime = *localtime(&now);
  903. starttime.tm_hour = starthour-8;
  904. starttime.tm_min = 0;
  905. starttime.tm_sec = 0;
  906. //获取定时结束的时间戳
  907. endtime = *localtime(&now);
  908. endtime.tm_hour = endhour - 8;
  909. endtime.tm_min = 0;
  910. endtime.tm_sec = 0;
  911. LOG_D("***工作结束在当天:现在时间:%d-开始时间:%d-结束时间:%d***",mktime(&nowtime),mktime(&starttime),mktime(&endtime));
  912. //如果当前时间大于开始时间且小于结束时间,且没有开始工作
  913. if((difftime(mktime(&nowtime), mktime(&starttime)) >=0) && (difftime(mktime(&nowtime),mktime(&endtime))<0))
  914. {
  915. LOG_D("当前时间大于开始时间,小于结束时间,工作中!!!");
  916. workflag = ON;
  917. }
  918. //如果当前时间小于开始时间
  919. else if(difftime(mktime(&nowtime),mktime(&starttime))<0)
  920. {
  921. LOG_D("当前时间小于开始时间,不工作!!!-%d-%d",mktime(&nowtime),mktime(&starttime));
  922. workflag = OFF;
  923. }
  924. //当前时间大于结束时间
  925. else {
  926. LOG_D("当前时间大于结束时间,不工作!!!-%d-%d",mktime(&nowtime),mktime(&starttime));
  927. workflag = OFF;
  928. }
  929. }
  930. //如果结束时间是第二天
  931. else if (starthour>endhour)
  932. {
  933. time_t now;
  934. time(&now);
  935. static struct tm nowtime; //现在
  936. static struct tm starttime; //开始
  937. static struct tm endtime; //结束
  938. //获取当前时间戳
  939. nowtime =*localtime(&now);
  940. nowtime.tm_hour = nowtime.tm_hour-8;
  941. //获取定时开始的时间戳
  942. starttime = *localtime(&now);
  943. starttime.tm_hour = starthour - 8;
  944. starttime.tm_min = 0;
  945. starttime.tm_sec = 0;
  946. //获取定时结束的时间戳
  947. endtime = *localtime(&now);
  948. endtime.tm_hour = endhour-8;
  949. endtime.tm_min = 0;
  950. endtime.tm_sec = 0;
  951. // LOG_I("工作结束在第二天:现在时间:%d-开始时间:%d-结束时间:%d!!!",mktime(&nowtime),mktime(&starttime),mktime(&endtime));
  952. //如果当前时间大于开始时间,且没有开始工作 ,注意时间戳日期加1
  953. if((difftime(mktime(&nowtime), mktime(&starttime)) > 0 ))
  954. {
  955. //获取定时结束的时间戳
  956. endtime = *localtime(&now); //将获取到的时间转换为时间戳
  957. endtime.tm_hour = endhour - 8; //这里需减8用于时区转换
  958. endtime.tm_min = 0;
  959. endtime.tm_sec = 0;
  960. workflag = ON;
  961. // LOG_I("当前前时间大于开始时间,且没有开始工作");
  962. }
  963. //当前时间小于开始时间
  964. else if ((difftime(mktime(&nowtime), mktime(&starttime)) < 0))
  965. {
  966. //获取定时结束的时间戳
  967. endtime = *localtime(&now); //将获取到的时间转换为时间戳
  968. endtime.tm_hour = endhour - 8; //这里需减8用于时区转换
  969. endtime.tm_min = 0;
  970. endtime.tm_sec = 0;
  971. //如果当前时间戳小于结束时间戳
  972. if(difftime(mktime(&nowtime),mktime(&endtime)) < 0)
  973. {
  974. // LOG_I("当前时间大于开始时间,且没有开始工作,当前时间小于结束时间的情况:计算工作时间:从当前时间工作第二天的结束时间");
  975. workflag = ON;
  976. }
  977. else
  978. {
  979. // LOG_I("当前时间小于开始时间,且没有开始工作,不是重启引起的,即还没到开始时间");
  980. workflag = OFF; //不在工作时间,待机
  981. }
  982. }
  983. }
  984. return workflag;
  985. //}
  986. }
  987. void WorkTask_BZYV2(void)
  988. {
  989. if(device_status.ds==1){
  990. ctr_lamp(OFF,1); //镇流器关=X轴开关:开
  991. ctr_swz(OFF);
  992. ctr_Collect_Fan(OFF);
  993. while(device_status.work_status ==0){
  994. rt_thread_delay(1000);
  995. LOG_W("等待设备进入工作");
  996. }
  997. while(device_status.work_status ==1){
  998. if(device_status.autotakepic==0){
  999. ctr_router(ON);
  1000. }else{
  1001. ctr_router(OFF);
  1002. }
  1003. rt_thread_delay(1000);
  1004. }
  1005. ctr_router(OFF);
  1006. if(device_status.work_done==1){
  1007. turnlimit(); //卷带电机转一圈
  1008. slide_para.en_slide = 5; //滑台复位
  1009. while(slide_para.en_slide!=0){
  1010. LOG_D("等待电机完成复位!");
  1011. rt_thread_delay(100);
  1012. }
  1013. char *take_start = makeJson_Warn("start", "autofocus");
  1014. DTU_Write(take_start);
  1015. rt_free(take_start);
  1016. device_status.work_done = 0;
  1017. }
  1018. }else{
  1019. LOG_W("==================!!!设备已待机!!!===================");
  1020. }
  1021. }
  1022. /* 入口函数-工作状态检测 */
  1023. static void Work_status_thread_entry(void *parameter)
  1024. {
  1025. while(1)
  1026. {
  1027. while(alarmCheck(device_status.collecting_sh1,device_status.collecting_eh1) == ON)
  1028. {
  1029. if(device_status.collecting_sh2==device_status.collecting_eh2){
  1030. device_status.work_done = 1;
  1031. }else{
  1032. device_status.work_done = 0;
  1033. }
  1034. device_status.work_status = 1;
  1035. LOG_I("the alarm1 workflag was ON");
  1036. rt_thread_delay(1000);
  1037. }
  1038. while(alarmCheck(device_status.collecting_sh2,device_status.collecting_eh2) == ON)
  1039. {
  1040. if(device_status.collecting_sh3==device_status.collecting_eh3){
  1041. device_status.work_done = 1;
  1042. }else{
  1043. device_status.work_done = 0;
  1044. }
  1045. device_status.work_status = 1;
  1046. LOG_I("the alarm2 workflag was ON");
  1047. rt_thread_delay(1000);
  1048. }
  1049. while(alarmCheck(device_status.collecting_sh3,device_status.collecting_eh3) == ON)
  1050. {
  1051. device_status.work_done = 1;
  1052. device_status.work_status = 1;
  1053. LOG_I("the alarm3 workflag was ON");
  1054. rt_thread_delay(1000);
  1055. }
  1056. //当前时间大于3段定时结束时间
  1057. device_status.work_status = 0;
  1058. rt_thread_delay(1000);
  1059. }
  1060. }
  1061. /*入口函数-工作流程*/
  1062. static void Work_Loop_thread_entry(void *parameter)
  1063. {
  1064. rt_thread_delay(1000);
  1065. ResetInit();
  1066. while(1)
  1067. {
  1068. WorkTask_BZYV2();
  1069. rt_thread_delay(1000);
  1070. }
  1071. }
  1072. void slide_thread_entry(void *parameter)
  1073. {
  1074. slide_para.pulse_period = 1; //默认滑台的脉宽为1ms
  1075. while(1)
  1076. {
  1077. rt_thread_delay(10);
  1078. switch(slide_para.en_slide){
  1079. case 1:{
  1080. ctr_move(X_,slide_para.xdir,slide_para.xdis,slide_para.pulse_period);
  1081. LOG_I("The slide's x movement was done ok");
  1082. if(slide_para.xdis==55)
  1083. {
  1084. rt_thread_delay(1000);
  1085. DTU_Write("{\"cmd\": \"takephoto\" }");
  1086. device_status.autotakepic = 4;
  1087. }else {
  1088. rt_thread_delay(1000);
  1089. char *photo = makeJson_Warn("movx","done");
  1090. LOG_I("%s",photo);
  1091. DTU_Write("%s",photo);
  1092. rt_free(photo);
  1093. }
  1094. slide_para.stop_flag = 0;
  1095. slide_para.en_slide = OFF;
  1096. break;
  1097. }
  1098. case 2:{
  1099. ctr_move(Z_,slide_para.zdir,slide_para.zdis,slide_para.pulse_period);
  1100. rt_kprintf("The slide's z movement was done ok\n");
  1101. if(slide_para.zdis==55)
  1102. {
  1103. rt_thread_delay(1000);
  1104. DTU_Write("{\"cmd\": \"takephoto\" }");
  1105. device_status.autotakepic = 4;
  1106. }else {
  1107. rt_thread_delay(1000);
  1108. char *photo = makeJson_Warn("movz","done");
  1109. LOG_I("%s",photo);
  1110. DTU_Write("%s",photo);
  1111. rt_free(photo);
  1112. }
  1113. slide_para.zdir = 1;
  1114. slide_para.zdis = 0;
  1115. slide_para.stop_flag = 0;
  1116. slide_para.en_slide = OFF;
  1117. break;
  1118. }
  1119. case 3:{ //复位X
  1120. LOG_W("X轴复位!");
  1121. slide_para.xdir = 0;
  1122. slide_para.xdis = 8000;
  1123. ctr_move(X_,slide_para.xdir,slide_para.xdis,slide_para.pulse_period);
  1124. LOG_I("The slide's X movement was done ok");
  1125. slide_para.xdir = 0;
  1126. slide_para.xdis = 0;
  1127. slide_para.stop_flag = 0;
  1128. slide_para.en_slide = OFF;
  1129. break;
  1130. }
  1131. case 4:{
  1132. //复位Z
  1133. LOG_W("Z轴复位!");
  1134. slide_para.zdir = 0;
  1135. slide_para.zdis = 5000;
  1136. ctr_move(Z_,slide_para.zdir,slide_para.zdis,slide_para.pulse_period);
  1137. LOG_I("The slide's Z movement was done ok");
  1138. slide_para.zdis = 0;
  1139. slide_para.stop_flag = 0;
  1140. slide_para.en_slide = OFF;
  1141. break;
  1142. }
  1143. case 6:{ //Y轴
  1144. ctr_move(Y_,slide_para.ydir,slide_para.ydis,slide_para.pulse_period);
  1145. rt_kprintf("The slide's y movement was done ok\n");
  1146. rt_thread_delay(1000);
  1147. if(1){
  1148. char *photo = makeJson_Warn("movy","done");
  1149. LOG_I("%s",photo);
  1150. DTU_Write("%s",photo);
  1151. rt_free(photo);
  1152. }
  1153. slide_para.ydis = 0;
  1154. slide_para.stop_flag = 0;
  1155. slide_para.en_slide = OFF;
  1156. break;
  1157. }
  1158. case 7:{ //Y轴复位
  1159. LOG_W("Y轴复位!");
  1160. slide_para.ydir = 0;
  1161. slide_para.ydis = 8000;
  1162. ctr_move(Y_,slide_para.ydir,slide_para.ydis,slide_para.pulse_period);
  1163. LOG_I("The slide's Y movement was done ok");
  1164. slide_para.stop_flag = 0;
  1165. slide_para.en_slide = OFF;
  1166. break;
  1167. }
  1168. default:
  1169. {
  1170. slide_para.en_slide = OFF;
  1171. slide_para.stop_flag = 0;
  1172. break;
  1173. }
  1174. }
  1175. }
  1176. }
  1177. /* 创建线程 -工作状态检测*/
  1178. int Workstatus_check(void)
  1179. {
  1180. /* 创建线程*/
  1181. tid_wkstc = rt_thread_create("work_status_check_thread",
  1182. Work_status_thread_entry, RT_NULL,
  1183. WORK_CHECK_THREAD_STACK_SIZE, //1024
  1184. WORK_CHECK_THREAD_PRIORITY, //23
  1185. WORK_CHECK_THREAD_TIMESLICE); //5
  1186. if(tid_wkstc!=RT_NULL)
  1187. {
  1188. rt_thread_startup(tid_wkstc);
  1189. }
  1190. return 0;
  1191. }
  1192. /*工作流程线程*/
  1193. int Work_Loop_Task(void)
  1194. {
  1195. rt_err_t result_loop;
  1196. /* 创建线程*/
  1197. tid_workloop = rt_thread_create("work_loop_thread",
  1198. Work_Loop_thread_entry, RT_NULL,
  1199. WORK_LOOP_THREAD_STACK_SIZE, //2048
  1200. WORK_LOOP_THREAD_PRIORITY, //12
  1201. WORK_LOOP_THREAD_TIMESLICE); //5
  1202. #if Color_EN == 0
  1203. if(tid_workloop!=RT_NULL)
  1204. {
  1205. result_loop = rt_thread_startup(tid_workloop);
  1206. }
  1207. #endif
  1208. return result_loop;
  1209. }
  1210. int slide_Fresh(void)
  1211. {
  1212. rt_err_t ret = RT_EOK;
  1213. rt_slide = rt_thread_create("rt_slide",
  1214. slide_thread_entry,
  1215. RT_NULL,
  1216. 1024,
  1217. 5,
  1218. 20);
  1219. if (rt_slide != RT_NULL)
  1220. {
  1221. rt_thread_startup(rt_slide);
  1222. rt_kprintf("the thread of rt_slide start ok\n");
  1223. }
  1224. else
  1225. {
  1226. ret = RT_ERROR;
  1227. }
  1228. return ret;
  1229. }
  1230. MSH_CMD_EXPORT(HardWare_Check,HardWare_Check<ON|OFF>);
  1231. MSH_CMD_EXPORT(ctr_lamp,ctr_lamp<ON|OFF>);
  1232. MSH_CMD_EXPORT(ctr_led,sample:ctr_led <ON|OFF>);
  1233. //INIT_APP_EXPORT(Control_heat);