control.c 34 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238
  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. time_t now;
  887. time(&now);
  888. struct tm now_tm = *localtime(&now);
  889. rt_uint32_t curr_sec = now_tm.tm_hour*3600 + now_tm.tm_min*60 + now_tm.tm_sec;
  890. rt_uint32_t start_sec = starthour * 3600;
  891. rt_uint32_t end_sec = endhour * 3600;
  892. // 修复跨天判断逻辑
  893. if (start_sec < end_sec)
  894. {
  895. // 不跨天模式
  896. workflag = (curr_sec >= start_sec && curr_sec < end_sec) ? 1 : 0;
  897. }
  898. else
  899. {
  900. // 跨天模式
  901. workflag = (curr_sec >= start_sec || curr_sec < end_sec) ? 1 : 0;
  902. }
  903. LOG_I("时控模式:状态[%s] 当前时间:%02d:%02d:%02d 设置:%02d:00-%02d:00",
  904. workflag ? "工作" : "待机",
  905. now_tm.tm_hour, now_tm.tm_min, now_tm.tm_sec,
  906. starthour, endhour);
  907. rt_thread_delay(10000);
  908. return workflag;
  909. }
  910. void WorkTask_BZYV2(void)
  911. {
  912. if(device_status.ds==1){
  913. ctr_lamp(OFF,1); //镇流器关=X轴开关:开
  914. ctr_swz(OFF);
  915. ctr_Collect_Fan(OFF);
  916. while(device_status.work_status ==0){
  917. rt_thread_delay(10000);
  918. LOG_W("等待设备进入工作");
  919. }
  920. while(device_status.work_status ==1){
  921. if(device_status.autotakepic==0){
  922. ctr_router(ON);
  923. }else{
  924. ctr_router(OFF);
  925. }
  926. rt_thread_delay(1000);
  927. }
  928. ctr_router(OFF);
  929. if(device_status.work_done==1){
  930. turnlimit(); //卷带电机转一圈
  931. slide_para.en_slide = 5; //滑台复位
  932. while(slide_para.en_slide!=0){
  933. LOG_D("等待电机完成复位!");
  934. rt_thread_delay(100);
  935. }
  936. char *take_start = makeJson_Warn("start", "autofocus");
  937. DTU_Write(take_start);
  938. rt_free(take_start);
  939. device_status.work_done = 0;
  940. }
  941. }else{
  942. LOG_W("==================!!!设备已待机!!!===================");
  943. }
  944. }
  945. /* 入口函数-工作状态检测 */
  946. static void Work_status_thread_entry(void *parameter)
  947. {
  948. while(device_status.ds==1)
  949. {
  950. while(alarmCheck(device_status.collecting_sh1,device_status.collecting_eh1) == ON)
  951. {
  952. device_status.work_status = 1;
  953. LOG_I("the alarm1 workflag was ON");
  954. device_status.work_done=1;
  955. rt_thread_delay(1000);
  956. }
  957. //如果当前时间大于collecting_eh1,开始拍照
  958. while(alarmCheck(device_status.collecting_sh2,device_status.collecting_eh2) == ON)
  959. {
  960. device_status.work_status = 1;
  961. device_status.work_done=1;
  962. LOG_I("the alarm2 workflag was ON");
  963. rt_thread_delay(1000);
  964. }
  965. //如果当前时间大于collecting_eh2,开始拍照
  966. while(alarmCheck(device_status.collecting_sh3,device_status.collecting_eh3) == ON)
  967. {
  968. device_status.work_status = 1;
  969. device_status.work_done=1;
  970. LOG_I("the alarm3 workflag was ON");
  971. rt_thread_delay(1000);
  972. }
  973. device_status.work_status = 0;
  974. //如果当前时间大于
  975. if(device_status.work_done!=0)
  976. {
  977. rt_thread_delay(1000*30);
  978. device_status.work_done = 0;
  979. }
  980. rt_thread_delay(1000);
  981. }
  982. }
  983. /*入口函数-工作流程*/
  984. static void Work_Loop_thread_entry(void *parameter)
  985. {
  986. rt_thread_delay(1000);
  987. ResetInit();
  988. while(1)
  989. {
  990. WorkTask_BZYV2();
  991. rt_thread_delay(1000);
  992. }
  993. }
  994. void slide_thread_entry(void *parameter)
  995. {
  996. slide_para.pulse_period = 1; //默认滑台的脉宽为1ms
  997. while(1)
  998. {
  999. rt_thread_delay(10);
  1000. switch(slide_para.en_slide){
  1001. case 1:{
  1002. ctr_move(X_,slide_para.xdir,slide_para.xdis,slide_para.pulse_period);
  1003. LOG_I("The slide's x movement was done ok");
  1004. if(slide_para.xdis==55)
  1005. {
  1006. rt_thread_delay(1000);
  1007. DTU_Write("{\"cmd\": \"takephoto\" }");
  1008. device_status.autotakepic = 4;
  1009. }else {
  1010. rt_thread_delay(1000);
  1011. char *photo = makeJson_Warn("movx","done");
  1012. LOG_I("%s",photo);
  1013. DTU_Write("%s",photo);
  1014. rt_free(photo);
  1015. }
  1016. slide_para.stop_flag = 0;
  1017. slide_para.en_slide = OFF;
  1018. break;
  1019. }
  1020. case 2:{
  1021. ctr_move(Z_,slide_para.zdir,slide_para.zdis,slide_para.pulse_period);
  1022. rt_kprintf("The slide's z movement was done ok\n");
  1023. if(slide_para.zdis==55)
  1024. {
  1025. rt_thread_delay(1000);
  1026. DTU_Write("{\"cmd\": \"takephoto\" }");
  1027. device_status.autotakepic = 4;
  1028. }else {
  1029. rt_thread_delay(1000);
  1030. char *photo = makeJson_Warn("movz","done");
  1031. LOG_I("%s",photo);
  1032. DTU_Write("%s",photo);
  1033. rt_free(photo);
  1034. }
  1035. slide_para.zdir = 1;
  1036. slide_para.zdis = 0;
  1037. slide_para.stop_flag = 0;
  1038. slide_para.en_slide = OFF;
  1039. break;
  1040. }
  1041. case 3:{ //复位X
  1042. LOG_W("X轴复位!");
  1043. slide_para.xdir = 0;
  1044. slide_para.xdis = 8000;
  1045. ctr_move(X_,slide_para.xdir,slide_para.xdis,slide_para.pulse_period);
  1046. LOG_I("The slide's X movement was done ok");
  1047. slide_para.xdir = 0;
  1048. slide_para.xdis = 0;
  1049. slide_para.stop_flag = 0;
  1050. slide_para.en_slide = OFF;
  1051. break;
  1052. }
  1053. case 4:{
  1054. //复位Z
  1055. LOG_W("Z轴复位!");
  1056. slide_para.zdir = 0;
  1057. slide_para.zdis = 5000;
  1058. ctr_move(Z_,slide_para.zdir,slide_para.zdis,slide_para.pulse_period);
  1059. LOG_I("The slide's Z movement was done ok");
  1060. slide_para.zdis = 0;
  1061. slide_para.stop_flag = 0;
  1062. slide_para.en_slide = OFF;
  1063. break;
  1064. }
  1065. case 6:{ //Y轴
  1066. ctr_move(Y_,slide_para.ydir,slide_para.ydis,slide_para.pulse_period);
  1067. rt_kprintf("The slide's y movement was done ok\n");
  1068. rt_thread_delay(1000);
  1069. if(1){
  1070. char *photo = makeJson_Warn("movy","done");
  1071. LOG_I("%s",photo);
  1072. DTU_Write("%s",photo);
  1073. rt_free(photo);
  1074. }
  1075. slide_para.ydis = 0;
  1076. slide_para.stop_flag = 0;
  1077. slide_para.en_slide = OFF;
  1078. break;
  1079. }
  1080. case 7:{ //Y轴复位
  1081. LOG_W("Y轴复位!");
  1082. slide_para.ydir = 0;
  1083. slide_para.ydis = 8000;
  1084. ctr_move(Y_,slide_para.ydir,slide_para.ydis,slide_para.pulse_period);
  1085. LOG_I("The slide's Y movement was done ok");
  1086. slide_para.stop_flag = 0;
  1087. slide_para.en_slide = OFF;
  1088. break;
  1089. }
  1090. default:
  1091. {
  1092. slide_para.en_slide = OFF;
  1093. slide_para.stop_flag = 0;
  1094. break;
  1095. }
  1096. }
  1097. }
  1098. }
  1099. /* 创建线程 -工作状态检测*/
  1100. int Workstatus_check(void)
  1101. {
  1102. /* 创建线程*/
  1103. tid_wkstc = rt_thread_create("work_status_check_thread",
  1104. Work_status_thread_entry, RT_NULL,
  1105. WORK_CHECK_THREAD_STACK_SIZE, //1024
  1106. WORK_CHECK_THREAD_PRIORITY, //23
  1107. WORK_CHECK_THREAD_TIMESLICE); //5
  1108. if(tid_wkstc!=RT_NULL)
  1109. {
  1110. rt_thread_startup(tid_wkstc);
  1111. }
  1112. return 0;
  1113. }
  1114. /*工作流程线程*/
  1115. int Work_Loop_Task(void)
  1116. {
  1117. rt_err_t result_loop;
  1118. /* 创建线程*/
  1119. tid_workloop = rt_thread_create("work_loop_thread",
  1120. Work_Loop_thread_entry, RT_NULL,
  1121. WORK_LOOP_THREAD_STACK_SIZE, //2048
  1122. WORK_LOOP_THREAD_PRIORITY, //12
  1123. WORK_LOOP_THREAD_TIMESLICE); //5
  1124. #if Color_EN == 0
  1125. if(tid_workloop!=RT_NULL)
  1126. {
  1127. result_loop = rt_thread_startup(tid_workloop);
  1128. }
  1129. #endif
  1130. return result_loop;
  1131. }
  1132. int slide_Fresh(void)
  1133. {
  1134. rt_err_t ret = RT_EOK;
  1135. rt_slide = rt_thread_create("rt_slide",
  1136. slide_thread_entry,
  1137. RT_NULL,
  1138. 1024,
  1139. 5,
  1140. 20);
  1141. if (rt_slide != RT_NULL)
  1142. {
  1143. rt_thread_startup(rt_slide);
  1144. rt_kprintf("the thread of rt_slide start ok\n");
  1145. }
  1146. else
  1147. {
  1148. ret = RT_ERROR;
  1149. }
  1150. return ret;
  1151. }
  1152. MSH_CMD_EXPORT(HardWare_Check,HardWare_Check<ON|OFF>);
  1153. MSH_CMD_EXPORT(ctr_lamp,ctr_lamp<ON|OFF>);
  1154. MSH_CMD_EXPORT(ctr_led,sample:ctr_led <ON|OFF>);
  1155. //INIT_APP_EXPORT(Control_heat);