user_elect.c 11 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358
  1. #include "user_elect.h"
  2. #include "define.h"
  3. #include "stdarg.h"
  4. #include "user_config.h"
  5. tmosTaskID elect_task_id = INVALID_TASK_ID;
  6. static bool elect_start_stat = false;
  7. static elect_in_upload_func elect_in_upload = NULL;
  8. static uint16_t elect_task_process_event(uint8_t task_id, uint16_t events);
  9. static void prvUser_elect_left_work_stat(elect_work_type_e type);
  10. static void prvUser_elect_right_work_stat(elect_work_type_e type);
  11. static bool bUser_elect_get_left_level(void);
  12. static bool bUser_elect_get_right_level(void);
  13. static elect_work_s elect_work[ELECT_COUNT] = {
  14. {
  15. .idx = LEFT_IDX,
  16. .type = ELECT_WORK_NULL,
  17. .workTime = 0,
  18. .func = prvUser_elect_left_work_stat,
  19. .elect_in_stat = 2,
  20. .elect_in_finish = false,
  21. .elect_in_on_count = ELECT_IN_CHECK_COUNT,
  22. .elect_in_off_count = ELECT_IN_CHECK_COUNT,
  23. .elect_default_count = ELECT_IN_CHECK_COUNT,
  24. .get_level = bUser_elect_get_left_level,
  25. },
  26. {
  27. .idx = RIGHT_IDX,
  28. .type = ELECT_WORK_NULL,
  29. .workTime = 0,
  30. .func = prvUser_elect_right_work_stat,
  31. .elect_in_stat = 2,
  32. .elect_in_finish = false,
  33. .elect_in_on_count = ELECT_IN_CHECK_COUNT,
  34. .elect_in_off_count = ELECT_IN_CHECK_COUNT,
  35. .elect_default_count = ELECT_IN_CHECK_COUNT,
  36. .get_level = bUser_elect_get_right_level,
  37. },
  38. };
  39. /*******************************************************************************
  40. * @函数名称 prvUser_elect_in_gpio_init
  41. * @函数说明 GPIO初始化
  42. * @输入参数 无
  43. * @输出参数 无
  44. * @返回参数 无
  45. *******************************************************************************/
  46. static void prvUser_elect_in_gpio_init(void)
  47. {
  48. GPIO_InitTypeDef GPIO_InitStructure={0};
  49. GPIO_InitStructure.GPIO_Pin = ELECT_LEFT_IN_PIN;
  50. GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IPU;
  51. GPIO_Init(ELECT_LEFT_IN_GPIO, &GPIO_InitStructure);
  52. GPIO_InitStructure.GPIO_Pin = ELECT_RIGHT_IN_PIN;
  53. GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IPU;
  54. GPIO_Init(ELECT_RIGHT_IN_GPIO, &GPIO_InitStructure);
  55. }
  56. /*******************************************************************************
  57. * @函数名称 prvUser_elect_gpio_init
  58. * @函数说明 GPIO初始化
  59. * @输入参数 无
  60. * @输出参数 无
  61. * @返回参数 无
  62. *******************************************************************************/
  63. static void prvUser_elect_gpio_init(void)
  64. {
  65. GPIO_InitTypeDef GPIO_InitStructure = {0};
  66. ELECT_GPIO_RCC_ENABLE;
  67. GPIO_InitStructure.GPIO_Pin = ELECT_LEFT_OPEN_PIN;
  68. GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP;
  69. GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
  70. GPIO_Init(ELECT_LEFT_OPEN_GPIO, &GPIO_InitStructure);
  71. ELECT_LEFT_OPEN_OFF;
  72. GPIO_InitStructure.GPIO_Pin = ELECT_RIGHT_OPEN_PIN;
  73. GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP;
  74. GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
  75. GPIO_Init(ELECT_RIGHT_OPEN_GPIO, &GPIO_InitStructure);
  76. ELECT_RIGHT_OPEN_OFF;
  77. prvUser_elect_in_gpio_init();
  78. }
  79. /*******************************************************************************
  80. * @函数名称 bUser_elect_get_left_level
  81. * @函数说明 获取左边电磁锁状态
  82. * @输入参数 无
  83. * @输出参数 无
  84. * @返回参数 电磁锁开启状态
  85. *******************************************************************************/
  86. static bool bUser_elect_get_left_level(void)
  87. {
  88. if(0 == ELECT_LEFT_IN_IN)
  89. {
  90. return (user_config_param.npn_in_param.left_elect_level == 1)?true:false;
  91. }
  92. else{
  93. return (user_config_param.npn_in_param.left_elect_level == 1)?false:true;
  94. }
  95. }
  96. /*******************************************************************************
  97. * @函数名称 bUser_elect_get_right_level
  98. * @函数说明 获取右边电磁锁状态
  99. * @输入参数 无
  100. * @输出参数 无
  101. * @返回参数 电磁锁开启状态
  102. *******************************************************************************/
  103. static bool bUser_elect_get_right_level(void)
  104. {
  105. if(0 == ELECT_RIGHT_IN_IN)
  106. {
  107. return (user_config_param.npn_in_param.right_elect_level == 1)?true:false;
  108. }
  109. else{
  110. return (user_config_param.npn_in_param.right_elect_level == 1)?false:true;
  111. }
  112. }
  113. /*******************************************************************************
  114. * @函数名称 prvUser_elect_left_work_stat
  115. * @函数说明 设置左边电磁锁状态
  116. * @输入参数 type:工作状态
  117. * @输出参数 无
  118. * @返回参数 无
  119. *******************************************************************************/
  120. static void prvUser_elect_left_work_stat(elect_work_type_e type)
  121. {
  122. if(type == ELECT_WORK_START)
  123. {
  124. ELECT_LEFT_OPEN_ON;
  125. }
  126. else if(type == ELECT_WORK_END)
  127. {
  128. ELECT_LEFT_OPEN_OFF;
  129. }
  130. }
  131. /*******************************************************************************
  132. * @函数名称 prvUser_elect_right_work_stat
  133. * @函数说明 设置右边电磁锁状态
  134. * @输入参数 type:工作状态
  135. * @输出参数 无
  136. * @返回参数 无
  137. *******************************************************************************/
  138. static void prvUser_elect_right_work_stat(elect_work_type_e type)
  139. {
  140. if(type == ELECT_WORK_START)
  141. {
  142. ELECT_RIGHT_OPEN_ON;
  143. }
  144. else if(type == ELECT_WORK_END)
  145. {
  146. ELECT_RIGHT_OPEN_OFF;
  147. }
  148. }
  149. /*******************************************************************************
  150. * @函数名称 vUser_elect_open
  151. * @函数说明 设置电磁锁
  152. * @输入参数 idx:锁下标
  153. * @输出参数 无
  154. * @返回参数 无
  155. *******************************************************************************/
  156. void vUser_elect_open(uint8_t idx)
  157. {
  158. elect_work[idx].type = ELECT_WORK_START;
  159. elect_work[idx].workTime = 0;
  160. }
  161. /*******************************************************************************
  162. * @函数名称 prvUser_elect_work_pro
  163. * @函数说明 电磁锁执行
  164. * @输入参数 elect:对象
  165. * @输出参数 无
  166. * @返回参数 无
  167. *******************************************************************************/
  168. static void prvUser_elect_work_pro(elect_work_s *elect)
  169. {
  170. if(elect->workTime == 0)
  171. {
  172. if(elect->type == ELECT_WORK_START)
  173. {
  174. elect->workTime = user_config_param.elect_param.elect_on_timne[elect->idx];
  175. elect->func(ELECT_WORK_START);
  176. elect->type = ELECT_WORK_END;
  177. }
  178. else if(elect->type == ELECT_WORK_END)
  179. {
  180. elect->func(ELECT_WORK_END);
  181. elect->type = ELECT_WORK_NULL;
  182. }
  183. }
  184. else{
  185. elect->workTime--;
  186. }
  187. }
  188. /*******************************************************************************
  189. * @函数名称 prvUser_elect_task
  190. * @函数说明 电磁锁任务
  191. * @输入参数 无
  192. * @输出参数 无
  193. * @返回参数 无
  194. *******************************************************************************/
  195. static void prvUser_elect_task(void)
  196. {
  197. for(int i = 0; i < ELECT_COUNT; i++)
  198. {
  199. prvUser_elect_work_pro(&elect_work[i]);
  200. }
  201. }
  202. /*******************************************************************************
  203. * @函数名称 prvUser_elect_in_check
  204. * @函数说明 电磁锁状态检测任务
  205. * @输入参数 elect:电磁锁变量指针
  206. * @输出参数 无
  207. * @返回参数 无
  208. *******************************************************************************/
  209. static void prvUser_elect_in_check(elect_work_s *elect)
  210. {
  211. if(true == elect->get_level())
  212. {
  213. elect->elect_in_off_count = elect->elect_default_count;
  214. if(elect->elect_in_on_count == 0)
  215. {
  216. if(elect->elect_in_finish == false)
  217. {
  218. elect->elect_in_finish = true;
  219. if(elect->elect_in_stat != 1)
  220. {
  221. elect->elect_in_stat = 1;
  222. // PRINT("No.%d switch is active!\n",npn->idx);
  223. if(elect_in_upload != NULL)
  224. {
  225. elect_in_upload(elect->idx, true);
  226. }
  227. }
  228. }
  229. }
  230. else{
  231. elect->elect_in_finish = false;
  232. elect->elect_in_on_count--;
  233. }
  234. }
  235. else{
  236. elect->elect_in_on_count = elect->elect_default_count;
  237. if(elect->elect_in_off_count == 0)
  238. {
  239. if(elect->elect_in_finish == false)
  240. {
  241. elect->elect_in_finish = true;
  242. if(elect->elect_in_stat != 0)
  243. {
  244. elect->elect_in_stat = 0;
  245. // PRINT("No.%d switch is deactive!\n",npn->idx);
  246. if(elect_in_upload != NULL)
  247. {
  248. elect_in_upload(elect->idx, false);
  249. }
  250. }
  251. }
  252. }
  253. else{
  254. elect->elect_in_finish = false;
  255. elect->elect_in_off_count--;
  256. }
  257. }
  258. }
  259. /*******************************************************************************
  260. * @函数名称 prvUser_elect_in_pro
  261. * @函数说明 电磁锁状态检测任务
  262. * @输入参数 无
  263. * @输出参数 无
  264. * @返回参数 无
  265. *******************************************************************************/
  266. static void prvUser_elect_in_pro(void)
  267. {
  268. for(uint8_t i = 0; i < 2; i++)
  269. {
  270. prvUser_elect_in_check(&elect_work[i]);
  271. }
  272. }
  273. /*******************************************************************************
  274. * @函数名称 elect_task_process_event
  275. * @函数说明 task的event处理回调函数,需要在注册task时候,传进去
  276. * @输入参数 task_id:任务ID
  277. events:事件
  278. * @输出参数 无
  279. * @返回参数 无
  280. *******************************************************************************/
  281. static uint16_t elect_task_process_event(uint8_t task_id, uint16_t events)
  282. {
  283. //event 处理
  284. if(events & (1 << ELECT_QUEUE_TIME))
  285. {
  286. prvUser_elect_task();
  287. return (events ^ (1 << ELECT_QUEUE_TIME)); //异或的方式清除该事件运行标志,并返回未运行的事件标志
  288. }
  289. if(events & (1 << ELECT_QUEUE_IN_TIME))
  290. {
  291. prvUser_elect_in_pro();
  292. return (events ^ (1 << ELECT_QUEUE_IN_TIME)); //异或的方式清除该事件运行标志,并返回未运行的事件标志
  293. }
  294. return 0;
  295. }
  296. /*******************************************************************************
  297. * @函数名称 elect_task_init
  298. * @函数说明 ELECT任务初始化
  299. * @输入参数 无
  300. * @输出参数 无
  301. * @返回参数 无
  302. *******************************************************************************/
  303. void vUser_elect_task_init(void)
  304. {
  305. elect_task_id = TMOS_ProcessEventRegister(elect_task_process_event);
  306. PRINT("elect_task_id=%d\n", elect_task_id);
  307. prvUser_elect_gpio_init();
  308. }
  309. /*******************************************************************************
  310. * @函数名称 elect_task_start
  311. * @函数说明 ELECT任务开始
  312. * @输入参数 无
  313. * @输出参数 无
  314. * @返回参数 无
  315. *******************************************************************************/
  316. void vUser_elect_task_start(void)
  317. {
  318. bStatus_t stat = tmos_start_reload_task(elect_task_id, (1 << ELECT_QUEUE_TIME), MS1_TO_SYSTEM_TIME(ELECT_INTERVAL));
  319. stat = tmos_start_reload_task(elect_task_id, (1 << ELECT_QUEUE_IN_TIME), MS1_TO_SYSTEM_TIME(ELECT_INTERVAL));
  320. }
  321. /*******************************************************************************
  322. * @函数名称 vUser_elect_set_upload_stat_func
  323. * @函数说明 设置电磁锁状态回调函数
  324. * @输入参数 func:函数指针
  325. * @输出参数 无
  326. * @返回参数 无
  327. *******************************************************************************/
  328. void vUser_elect_set_upload_stat_func(elect_in_upload_func func)
  329. {
  330. elect_in_upload = func;
  331. }