soft_uart.c 12 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508
  1. #include "soft_uart.h"
  2. #include "usart.h"
  3. #include "stdbool.h"
  4. #include "soft_timer.h"
  5. #include "soft_adc.h"
  6. #include "soft_flow.h"
  7. #include "soft_crc.h"
  8. #include <string.h>
  9. #include "stdbool.h"
  10. #include "tim.h"
  11. #include "hard_led.h"
  12. #include "soft_can.h"
  13. #include "stdio.h"
  14. #include "soft_bms.h"
  15. #include "soft_terrain.h"
  16. #include "soft_obstacle.h"
  17. #include "soft_okcell.h"
  18. #include "soft_adc.h"
  19. #include "soft_p_2_c.h"
  20. #include "soft_engine.h"
  21. #include "stm32f1xx_it.h"
  22. #include "bsp_serial.h"
  23. #include "rkfifo.h"
  24. #include "stm32f1xx_hal_def.h"
  25. #include "soft_update.h"
  26. #include "common.h"
  27. #include "soft_water_device.h"
  28. #include "config.h"
  29. #include "soft_seed_device.h"
  30. uint8_t Update_buf[150] = {0};
  31. Vk_protocol vk_protocol;
  32. rkfifo_t send_uart_rkfifo;
  33. bool radar_update_flag = false; //雷达升级标志
  34. Uart uart_info = {.vk_dev_pack_num = 1};
  35. /**
  36. * @file printf
  37. * @brief 串口发送重定向
  38. * @param
  39. * @details
  40. * @author Zhang Sir
  41. **/
  42. int _write(int fd, char *pBuffer, int size)
  43. {
  44. uint32_t uart3_send_count_time = HAL_GetTick();
  45. while (__HAL_UART_GET_FLAG(&huart3, UART_FLAG_TC) == 0 &&
  46. HAL_GetTick() - uart3_send_count_time < 5)
  47. ;
  48. HAL_UART_Transmit(&huart3, (uint8_t *)pBuffer, size, 0xff);
  49. return size;
  50. }
  51. /**
  52. * @file uart_send_is_ok
  53. * @brief 检测串口是否可用
  54. * @param uart_num 串口号
  55. * @details
  56. * @author Zhang Sir
  57. **/
  58. bool uart_send_is_ok(uint8_t uart_num)
  59. {
  60. //设备升级不发送
  61. //if(radar_update_flag == true)
  62. // return false;
  63. // if(uart_info.vk_dev_update_flag == true)
  64. // return false;
  65. if (uart_num == USART_2)
  66. {
  67. if (huart2.gState == HAL_UART_STATE_READY && (__HAL_UART_GET_FLAG(&huart2, UART_FLAG_TC) != RESET && __HAL_UART_GET_FLAG(&huart2, UART_FLAG_TXE) != RESET))
  68. {
  69. }
  70. else
  71. {
  72. return false;
  73. }
  74. //延迟1ms发送,防止如果是空闲中断接收,连续发送变成一包
  75. if(HAL_GetTick() - uart2_send_delay_time <= 1)
  76. {
  77. return false;
  78. }
  79. }
  80. else if (uart_num == USART_3)
  81. {
  82. if (huart3.gState == HAL_UART_STATE_READY && (__HAL_UART_GET_FLAG(&huart3, UART_FLAG_TC) != RESET && __HAL_UART_GET_FLAG(&huart3, UART_FLAG_TXE) != RESET))
  83. {
  84. }
  85. else
  86. {
  87. return false;
  88. }
  89. if(HAL_GetTick() - uart3_send_delay_time <= 1)
  90. {
  91. return false;
  92. }
  93. }
  94. return true;
  95. }
  96. /**
  97. * @file uart2_send_msg
  98. * @brief 串口2发送
  99. * @param
  100. * @details
  101. * @author Zhang Sir
  102. **/
  103. uint32_t uart2_send_delay_time = 0;
  104. uint32_t uart3_send_delay_time = 0;
  105. void uart2_send_msg(uint8_t *data, uint8_t size)
  106. {
  107. rkfifo_in(&send_uart_rkfifo,data,size);
  108. // HAL_UART_Transmit_DMA(&huart2, data, size);
  109. // uart2_send_delay_time = HAL_GetTick();
  110. //bspSerialWrite(&serial2,data,size);
  111. }
  112. uint8_t send_uart_buf[256 * 4] = {0};
  113. void send_uartfifo_msg(void)
  114. {
  115. uint16_t len = 0;
  116. if(uart_send_is_ok(USART_2) == true)
  117. {
  118. len = rkfifo_out(&send_uart_rkfifo, &send_uart_buf, MAX_UART_BUF * 4);
  119. if(len > 0)
  120. {
  121. HAL_UART_Transmit_DMA(&huart2, send_uart_buf, len);
  122. uart2_send_delay_time = HAL_GetTick();
  123. }
  124. }
  125. }
  126. //uart3 发送调用函数
  127. void uart3_send_msg(uint8_t *data, uint8_t size)
  128. {
  129. static uint32_t send_time3 = 0;
  130. send_time3 = HAL_GetTick();
  131. while (HAL_GetTick() - send_time3 <= 1)
  132. ;
  133. HAL_UART_Transmit_DMA(&huart3, data, size);
  134. uart3_send_delay_time = HAL_GetTick();
  135. }
  136. /**
  137. * @file UART_Init
  138. * @brief UART23初始化接收空闲中断 开起DMA
  139. * @param
  140. * @details
  141. * @author Zhang Sir
  142. **/
  143. void UART_Init(void)
  144. {
  145. //uart2
  146. //__HAL_UART_ENABLE_IT(&huart2, UART_IT_RXNE); //接收到一个字节产生一次中断
  147. //HAL_UART_Receive_IT(&huart2, &test_buf, 1);
  148. __HAL_UART_ENABLE_IT(&huart2, UART_IT_IDLE); //uart2 空闲中断
  149. HAL_UART_Receive_DMA(&huart2, (uint8_t *)uart_info.uart2_recv_buf, MAX_UART_BUF);
  150. //开启错误处理机制
  151. __HAL_UART_ENABLE_IT(&huart2, UART_IT_ERR);
  152. //uart3
  153. //HAL_UART_Receive_IT(&huart3, (uint8_t *)uart_info.uart3_recv_buf, 1);
  154. __HAL_UART_ENABLE_IT(&huart3, UART_IT_IDLE);
  155. HAL_UART_Receive_DMA(&huart3, (uint8_t *)uart_info.uart3_recv_buf, MAX_UART_BUF/2);
  156. //开启错误处理机制
  157. __HAL_UART_ENABLE_IT(&huart3, UART_IT_ERR);
  158. }
  159. /**
  160. * @file USER_UART_IRQHandler
  161. * @brief user用户中断函数
  162. * @param
  163. * @details
  164. * @author Zhang Sir
  165. **/
  166. uint32_t read_DR;
  167. rkfifo_t recv_rkfifo;
  168. void USER_UART_IRQHandler(UART_HandleTypeDef *huart)
  169. {
  170. if (huart == &huart2)
  171. {
  172. if (RESET != __HAL_UART_GET_FLAG(&huart2, UART_FLAG_IDLE))
  173. {
  174. read_DR = huart2.Instance->DR;
  175. __HAL_UART_CLEAR_IDLEFLAG(&huart2);
  176. HAL_UART_AbortReceive(&huart2);//HAL_UART_DMAStop 有问题
  177. uart_info.uart_dma_recv_counts = MAX_UART_BUF - __HAL_DMA_GET_COUNTER(huart->hdmarx);
  178. for(uint8_t i = 0;i<uart_info.uart_dma_recv_counts;i++)
  179. {
  180. if(uart_info.uart2_recv_buf[i] == 0xfe && uart_info.uart2_recv_buf[i+5] == 27)
  181. {
  182. time_heart[0] = HAL_GetTick();
  183. time_count[0]++;
  184. }
  185. }
  186. rkfifo_in(&recv_rkfifo,uart_info.uart2_recv_buf,uart_info.uart_dma_recv_counts);
  187. memset(uart_info.uart2_recv_buf,0,MAX_UART_BUF);
  188. HAL_UART_Receive_DMA(&huart2, uart_info.uart2_recv_buf, MAX_UART_BUF);
  189. }
  190. }
  191. if(huart == &huart3)
  192. {
  193. if (RESET != __HAL_UART_GET_FLAG(&huart3, UART_FLAG_IDLE))
  194. {
  195. read_DR = huart3.Instance->DR;
  196. __HAL_UART_CLEAR_IDLEFLAG(&huart3); //清除中断标志位,不清除一直在中断里
  197. HAL_UART_AbortReceive(&huart3);
  198. uart_info.uart_dma_recv_counts = MAX_UART_BUF - __HAL_DMA_GET_COUNTER(huart->hdmarx);
  199. //串口三接奥安,上飞发动机
  200. if (aoan_engine_Link.connect_status != COMP_NOEXIST)
  201. {
  202. decode_aoan_engine(uart_info.uart3_recv_buf, uart_info.uart_dma_recv_counts);
  203. }
  204. else if (vkv3_engine_link.connect_status != COMP_NOEXIST)
  205. {
  206. decode_vkv3_engine(uart_info.uart3_recv_buf, uart_info.uart_dma_recv_counts);
  207. }
  208. else
  209. {
  210. //根据协议选择设备
  211. decode_vkv3_engine(uart_info.uart3_recv_buf, uart_info.uart_dma_recv_counts);
  212. decode_aoan_engine(uart_info.uart3_recv_buf, uart_info.uart_dma_recv_counts);
  213. }
  214. HAL_UART_Receive_DMA(&huart3, (uint8_t *)uart_info.uart3_recv_buf, MAX_UART_BUF/2);
  215. }
  216. }
  217. }
  218. /**
  219. * @file HAL_UART_ErrorCallback
  220. * @brief uart错误中断回调函数
  221. * @param
  222. * @details
  223. * @author Zhang Sir
  224. **/
  225. void HAL_UART_ErrorCallback(UART_HandleTypeDef *huart)
  226. {
  227. if (__HAL_UART_GET_FLAG(huart, UART_FLAG_ORE) != RESET) //接收溢出检测
  228. {
  229. __HAL_UART_CLEAR_OREFLAG(huart);
  230. }
  231. if (__HAL_UART_GET_FLAG (huart, UART_FLAG_RXNE) != RESET)//接收数据
  232. {
  233. __HAL_UART_CLEAR_FLAG (huart, UART_FLAG_RXNE);
  234. }
  235. __HAL_UART_CLEAR_PEFLAG (huart);
  236. if (huart == &huart2)
  237. {
  238. HAL_UART_Receive_DMA(&huart2, (uint8_t *)uart_info.uart2_recv_buf, MAX_UART_BUF);
  239. }
  240. else if (huart == &huart3)
  241. {
  242. HAL_UART_Receive_DMA(&huart3, (uint8_t *)uart_info.uart3_recv_buf, MAX_UART_BUF/2);
  243. }
  244. }
  245. /**
  246. * @file HAL_UART_TxCpltCallback
  247. * @brief uart发送回调
  248. * @param
  249. * @details
  250. * @author Zhang Sir
  251. **/
  252. void HAL_UART_TxCpltCallback(UART_HandleTypeDef *huart)
  253. {
  254. if (huart == &huart2)
  255. {
  256. }
  257. }
  258. /**
  259. * @file check_uart_data
  260. * @brief 接收数据组包解析
  261. * @param
  262. * @details
  263. * @author Zhang Sir
  264. **/
  265. Msg_Rx_Stage recv_step;
  266. Vk_protocol fcu_protocol;
  267. Vk_protocol vk_data = {.head = 0XFE,
  268. .system_id = 0,
  269. .head_bytes = 6,
  270. .check_bytes = 2};
  271. void check_uart_data(rkfifo_t *fifo)
  272. {
  273. uint8_t c = 0;
  274. static uint32_t vk_recv_time = 0;
  275. static uint8_t i = 0;
  276. while (rkfifo_out(fifo, &c, 1) != 0)
  277. {
  278. if(recv_step != RX_HEAD && HAL_GetTick() - vk_recv_time > 200)
  279. {
  280. recv_step = RX_HEAD;
  281. }
  282. //解析出一包完整的数据
  283. switch (recv_step)
  284. {
  285. case RX_HEAD:
  286. if(c == vk_data.head)
  287. {
  288. vk_recv_time = HAL_GetTick();
  289. recv_step = RX_PAYLOAD_LEN;
  290. }
  291. break;
  292. case RX_PAYLOAD_LEN:
  293. vk_data.len = c;
  294. recv_step = RX_SEQ;
  295. break;
  296. case RX_SEQ:
  297. vk_data.seq = c;
  298. recv_step = RX_SYSID;
  299. break;
  300. case RX_SYSID:
  301. if(c == vk_data.system_id)
  302. {
  303. recv_step = RX_GROUPID;
  304. }
  305. else
  306. {
  307. recv_step = RX_HEAD;
  308. }
  309. break;
  310. case RX_GROUPID:
  311. if(c == GROUP_ID_FCU || c == GROUP_ID_PMU_UPDATE || c == GROUP_ID_F_UPDATE ||
  312. c == GROUP_ID_B_UPDATE || c == GROUP_ID_T_UPDATE|| c == GROUP_ID_WEIGHT_UPDATE)
  313. {
  314. vk_data.group_id = c;
  315. recv_step = RX_MSGID;
  316. }
  317. else
  318. {
  319. recv_step = RX_HEAD;
  320. }
  321. break;
  322. case RX_MSGID:
  323. vk_data.msg_id = c;
  324. if(c == 27)
  325. {
  326. time_heart[2] = HAL_GetTick();
  327. time_count[2]++;
  328. }
  329. recv_step = RX_PAYLOAD;
  330. i = 0;
  331. break;
  332. case RX_PAYLOAD:
  333. vk_data.payload[vk_data.head_bytes + i] = c;
  334. i++;
  335. if(i == vk_data.len)
  336. {
  337. recv_step = RX_CHECK_LOW;
  338. }
  339. else if(vk_data.len == 0) //没有payload
  340. {
  341. recv_step = RX_CHECK_HIGH;
  342. }
  343. break;
  344. case RX_CHECK_LOW:
  345. vk_data.payload[vk_data.head_bytes + i] = c;
  346. i++;
  347. recv_step = RX_CHECK_HIGH;
  348. break;
  349. case RX_CHECK_HIGH:
  350. vk_data.payload[vk_data.head_bytes + i] = c;
  351. vk_data.payload[0] = vk_data.head;
  352. vk_data.payload[1] = vk_data.len;
  353. vk_data.payload[2] = vk_data.seq;
  354. vk_data.payload[3] = vk_data.system_id;
  355. vk_data.payload[4] = vk_data.group_id;
  356. vk_data.payload[5] = vk_data.msg_id;
  357. if(0 == Get_Crc16(&vk_data.payload[0],vk_data.len + vk_data.head_bytes + vk_data.check_bytes))
  358. {
  359. if(vk_data.group_id == GROUP_ID_FCU || vk_data.group_id == GROUP_ID_PMU_UPDATE)
  360. {
  361. fcu_protocol.msg_id = vk_data.msg_id;
  362. memcpy(&fcu_protocol.payload[0],&vk_data.payload[0],vk_data.len + vk_data.head_bytes + vk_data.check_bytes);
  363. uart_info.fcu_buf_flag = true;
  364. }
  365. //莫之比雷达升级
  366. else if((vk_data.group_id == GROUP_ID_F_UPDATE && uavr11_info.Link.connect_status != COMP_NOEXIST) ||
  367. (vk_data.group_id == GROUP_ID_B_UPDATE && uavr12_info.Link.connect_status != COMP_NOEXIST) ||
  368. (vk_data.group_id == GROUP_ID_T_UPDATE && uavr56_info.Link.connect_status != COMP_NOEXIST))
  369. {
  370. if(uart_info.use_update_buf_flag == false)
  371. {
  372. uart_info.update_time = HAL_GetTick();
  373. memcpy(&Update_buf[0],&vk_data.payload[0],vk_data.len + vk_data.head_bytes + vk_data.check_bytes);
  374. uart_info.use_update_buf_flag = true;
  375. if (vk_data.msg_id == 200)
  376. {
  377. {
  378. radar_update_flag = true;
  379. update_count = 0;
  380. }
  381. }
  382. }
  383. else
  384. {
  385. if(HAL_GetTick() - uart_info.update_time > 3000)
  386. {
  387. uart_info.use_update_buf_flag = false;
  388. }
  389. }
  390. }
  391. //VK协议设备升级
  392. else if (vk_data.group_id == GROUP_ID_WEIGHT_UPDATE ||
  393. (vk_data.group_id == GROUP_ID_F_UPDATE /*&& mimo_f_info.Link.connect_status != COMP_NOEXIST*/) || //mimo
  394. (vk_data.group_id == GROUP_ID_B_UPDATE /*&& mimo_b_info.Link.connect_status != COMP_NOEXIST*/) || //mimo
  395. (vk_data.group_id == GROUP_ID_T_UPDATE /*&& mimo_ter_info.Link.connect_status != COMP_NOEXIST*/)) //mimo
  396. {
  397. #ifdef mimo_update
  398. if(vk_data.msg_id == 200)
  399. {
  400. if(EZup_par.step == STEP_DEFAULT)//mimo
  401. {//mimo
  402. memset(&EZup_par,0,sizeof(ez_update));//mimo
  403. memset(&uart_info.fcu_buf_flag,0,sizeof(Uart));
  404. memcpy(&uart_info.bin_size,&vk_data.payload[6],4);
  405. uart_info.vk_dev_pack_num = 1;
  406. uart_info.vk_dev_update_flag = true;
  407. EZup_par.update_flag = true;//mimo
  408. EZup_par.step = STEP_FIND_NODE;//mimo
  409. }
  410. }
  411. #else
  412. if(vk_data.msg_id == 200)
  413. {
  414. memset(&uart_info.fcu_buf_flag,0,sizeof(Uart));
  415. memcpy(&uart_info.bin_size,&vk_data.payload[6],4);
  416. uart_info.vk_dev_pack_num = 1;
  417. uart_info.vk_dev_update_flag = true;
  418. }
  419. #endif
  420. //if(uart_info.use_update_buf_flag == false)
  421. //{
  422. memcpy(&Update_buf[0],&vk_data.payload[0],vk_data.len + vk_data.head_bytes + vk_data.check_bytes);
  423. //判断是否是需要的包序号
  424. if(uart_info.vk_dev_pack_num > (Update_buf[PACK_NUM] + Update_buf[PACK_NUM + 1] * 256) &&
  425. vk_data.msg_id == 201)
  426. {
  427. Update_ack_func(Update_buf[DEVICE],201,&Update_buf[PACK_NUM]);
  428. }
  429. uart_info.use_update_buf_flag = true;
  430. //}
  431. }
  432. }
  433. else
  434. {
  435. //vk_protocol_test[4]++;
  436. }
  437. recv_step = RX_HEAD;
  438. break;
  439. default:
  440. recv_step = RX_HEAD;
  441. //vk_protocol_test[5]++;
  442. break;
  443. }
  444. if( uart_info.fcu_buf_flag == true)
  445. break;
  446. }
  447. }