uart.c 13 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450
  1. #include "uart.h"
  2. #include "os/os_task.h"
  3. #include "libs/crc16.h"
  4. #include "libs/logger.h"
  5. #include "libs/utils.h"
  6. #define SHARK_UART_BAUDRATE 500000
  7. #define SHARK_UART0_com USART1
  8. #define SHARK_UART0_tx_port GPIOB
  9. #define SHARK_UART0_tx_pin GPIO_PINS_6
  10. #define SHARK_UART0_rx_port GPIOB
  11. #define SHARK_UART0_rx_pin GPIO_PINS_7
  12. #define SHARK_UART0_IOMUX USART1_GMUX_0001
  13. #define SHARK_UART0_irq USART0_IRQn
  14. #define SHARK_UART0_clk CRM_USART1_PERIPH_CLOCK
  15. #define SHARK_UART0_tx_gpio_clk CRM_GPIOB_PERIPH_CLOCK
  16. #define SHARK_UART0_rx_gpio_clk CRM_GPIOB_PERIPH_CLOCK
  17. #define SHARK_UART0_tx_dma DMA1
  18. #define SHARK_UART0_tx_dma_ch DMA1_CHANNEL2
  19. #define SHARK_UART0_tx_dma_clk CRM_DMA1_PERIPH_CLOCK
  20. #define SHARK_UART0_rx_dma DMA1
  21. #define SHARK_UART0_rx_dma_ch DMA1_CHANNEL3
  22. #define SHARK_UART0_rx_dma_clk CRM_DMA1_PERIPH_CLOCK
  23. #define DMA_UART_TX_FLEX_CHANNEL FLEX_CHANNEL2
  24. #define DMA_UART_TX_FLEX DMA_FLEXIBLE_UART1_TX
  25. #define DMA_UART_RX_FLEX_CHANNEL FLEX_CHANNEL3
  26. #define DMA_UART_RX_FLEX DMA_FLEXIBLE_UART1_RX
  27. #define DMA_UART_TX_FDT_FLAG DMA1_FDT2_FLAG
  28. #define SHARK_UART_DMA_CHCNT_RX() (SHARK_UART0_rx_dma_ch->dtcnt)
  29. // ================================================================================
  30. #define ENABLE_RX_DMA 1
  31. static u8 shark_uart0_tx_cache[SHARK_UART_TX_MEM_SIZE];
  32. static u8 shark_uart0_rx_cache[SHARK_UART_RX_MEM_SIZE];
  33. static shark_uart_t _shark_uart[1];
  34. ///static bool uart_no_data = false;
  35. #if ENABLE_RX_DMA==1
  36. #define update_dma_w_pos(uart) circle_update_write_position(&uart->rx_queue, SHARK_UART_RX_MEM_SIZE - SHARK_UART0_rx_dma_ch->dtcnt)
  37. #else
  38. #define update_dma_w_pos(uart){}
  39. #endif
  40. // ================================================================================
  41. static usart_type *_uart_index(usart_type* com){
  42. return SHARK_UART0;
  43. }
  44. __weak void shark_uart_on_frame_received(u8 *data, u16 lenght){
  45. }
  46. static bool shark_uart_on_rx_frame(shark_uart_t *uart)
  47. {
  48. u16 crc0 = decode_u16(uart->rx_frame + uart->rx_length);
  49. u16 crc1 = crc16_get(uart->rx_frame, uart->rx_length);
  50. if (crc0 != crc1) {
  51. return false;
  52. }
  53. shark_uart_on_frame_received(uart->rx_frame, uart->rx_length);
  54. return true;
  55. }
  56. static void shark_uart_rx_data(shark_uart_t *uart, u8 *buff, u16 size){
  57. for (u8 *buff_end = buff + size; buff < buff_end; buff++) {
  58. u8 data = *buff;
  59. switch(data){
  60. case CH_START:
  61. uart->rx_length = 0;
  62. uart->escape = false;
  63. uart->start = true;
  64. break;
  65. case CH_END:
  66. if (uart->rx_length > 2 && uart->rx_length != 0xFFFF){
  67. uart->rx_length -= 2; //skip crc
  68. shark_uart_on_rx_frame(uart);
  69. }
  70. uart->rx_length = 0xFFFF;
  71. uart->start = false;
  72. break;
  73. case CH_ESC:
  74. uart->escape = true;
  75. break;
  76. default:
  77. if (uart->escape) {
  78. uart->escape = false;
  79. switch (data) {
  80. case CH_ESC_START:
  81. data = CH_START;
  82. break;
  83. case CH_ESC_END:
  84. data = CH_END;
  85. break;
  86. case CH_ESC_ESC:
  87. data = CH_ESC;
  88. break;
  89. default:
  90. data = 0xFF;
  91. }
  92. }
  93. if (uart->rx_length < sizeof(uart->rx_frame)) {
  94. uart->rx_frame[uart->rx_length] = data;
  95. uart->rx_length++;
  96. } else {
  97. uart->rx_length = 0xFFFF;
  98. }
  99. }
  100. }
  101. }
  102. void shark_uart_dma_rx(shark_uart_t *uart)
  103. {
  104. u16 index = uart->rx_index;
  105. uart->rx_index = SHARK_UART_RX_MEM_SIZE - SHARK_UART_DMA_CHCNT_RX();
  106. if (uart->rx_index < index) {
  107. shark_uart_rx_data(uart, uart->rx_cache + index, SHARK_UART_RX_MEM_SIZE - index);
  108. shark_uart_rx_data(uart, uart->rx_cache, uart->rx_index);
  109. } else {
  110. shark_uart_rx_data(uart, uart->rx_cache + index, uart->rx_index - index);
  111. }
  112. }
  113. #define DMA_CHCTL(dma, dma_ch) ((dma_channel_type *)dma_ch)->ctrl
  114. #define DMA_CHMADDR(dma, dma_ch) ((dma_channel_type *)dma_ch)->maddr
  115. #define DMA_CHXCTL_CHEN BIT(0) /*!< channel enable */
  116. static void shark_uart_dma_tx(shark_uart_t *uart)
  117. {
  118. u32 value = DMA_CHCTL(SHARK_UART0_tx_dma, uart->tx_dma_ch);
  119. if (value & DMA_CHXCTL_CHEN) {
  120. if (SET != dma_flag_get(DMA_UART_TX_FDT_FLAG)) {
  121. return;
  122. }
  123. dma_flag_clear(DMA_UART_TX_FDT_FLAG);
  124. byte_queue_skip(&uart->tx_queue, uart->tx_length);
  125. DMA_CHCTL(SHARK_UART0_tx_dma, uart->tx_dma_ch) = value & (~DMA_CHXCTL_CHEN);
  126. }
  127. uart->tx_length = byte_queue_peek(&uart->tx_queue);
  128. if (uart->tx_length > 0) {
  129. dma_data_number_set(uart->tx_dma_ch, uart->tx_length);
  130. DMA_CHMADDR(SHARK_UART0_tx_dma, uart->tx_dma_ch) = (u32) byte_queue_head(&uart->tx_queue);
  131. DMA_CHCTL(SHARK_UART0_tx_dma, uart->tx_dma_ch) = value | DMA_CHXCTL_CHEN;
  132. }
  133. }
  134. static void shark_uart_write(shark_uart_t *uart, const u8 *buff, u16 size)
  135. {
  136. while (size > 0) {
  137. u16 length = byte_queue_write(&uart->tx_queue, buff, size);
  138. if (length == size) {
  139. shark_uart_dma_tx(uart);
  140. break;
  141. }
  142. shark_uart_dma_tx(uart);
  143. buff += length;
  144. size -= length;
  145. }
  146. }
  147. static void shark_uart_write_byte(shark_uart_t *uart, u8 value)
  148. {
  149. byte_queue_write(&uart->tx_queue, &value, 1);
  150. }
  151. void shark_uart_write_log(char *buffer){
  152. int len = strlen(buffer);
  153. shark_uart_t *uart = (_shark_uart+SHARK_UART0);
  154. if (len > byte_queue_get_free(&uart->tx_queue)){
  155. return;
  156. }
  157. byte_queue_write(&uart->tx_queue, (const u8 *)buffer, len);
  158. shark_uart_dma_tx(uart);
  159. }
  160. static void shark_uart_tx_dma_init(shark_uart_t *uart){
  161. dma_init_type dma_init_struct;
  162. crm_periph_clock_enable(SHARK_UART0_tx_dma_clk, TRUE);
  163. dma_reset(uart->tx_dma_ch);
  164. dma_init_struct.direction = DMA_DIR_MEMORY_TO_PERIPHERAL;
  165. dma_init_struct.memory_inc_enable = TRUE;
  166. dma_init_struct.memory_data_width = DMA_MEMORY_DATA_WIDTH_BYTE;
  167. dma_init_struct.peripheral_base_addr = (u32) &(((usart_type *)uart->uart_com)->dt);
  168. dma_init_struct.peripheral_inc_enable = FALSE;
  169. dma_init_struct.peripheral_data_width = DMA_PERIPHERAL_DATA_WIDTH_BYTE;
  170. dma_init_struct.priority = DMA_PRIORITY_MEDIUM;
  171. dma_init_struct.loop_mode_enable = FALSE;
  172. dma_init(uart->tx_dma_ch, &dma_init_struct);
  173. /* config flexible dma for usart1 tx */
  174. dma_flexible_config(SHARK_UART0_tx_dma, DMA_UART_TX_FLEX_CHANNEL, DMA_UART_TX_FLEX);
  175. usart_dma_transmitter_enable(uart->uart_com, TRUE);
  176. }
  177. #if ENABLE_RX_DMA==1
  178. static void shark_uart_rx_dma_init(shark_uart_t *uart){
  179. dma_init_type dma_init_struct;
  180. crm_periph_clock_enable(SHARK_UART0_rx_dma_clk, TRUE);
  181. /* dma1 channel2 for usart2 rx configuration */
  182. dma_reset(uart->rx_dma_ch);
  183. dma_default_para_init(&dma_init_struct);
  184. dma_init_struct.buffer_size = SHARK_UART_RX_MEM_SIZE;
  185. dma_init_struct.direction = DMA_DIR_PERIPHERAL_TO_MEMORY;
  186. dma_init_struct.memory_base_addr = (uint32_t)shark_uart0_rx_cache;
  187. dma_init_struct.memory_data_width = DMA_MEMORY_DATA_WIDTH_BYTE;
  188. dma_init_struct.memory_inc_enable = TRUE;
  189. dma_init_struct.peripheral_base_addr = (u32) &(((usart_type *)uart->uart_com)->dt);
  190. dma_init_struct.peripheral_data_width = DMA_PERIPHERAL_DATA_WIDTH_BYTE;
  191. dma_init_struct.peripheral_inc_enable = FALSE;
  192. dma_init_struct.priority = DMA_PRIORITY_MEDIUM;
  193. dma_init_struct.loop_mode_enable = FALSE;
  194. dma_init(uart->rx_dma_ch, &dma_init_struct);
  195. /* config flexible dma for usart1 rx */
  196. dma_flexible_config(SHARK_UART0_rx_dma, DMA_UART_RX_FLEX_CHANNEL, DMA_UART_RX_FLEX);
  197. usart_dma_receiver_enable(uart->uart_com, TRUE);
  198. }
  199. #endif
  200. static void shark_uart_pin_init(shark_uart_t *uart){
  201. crm_periph_clock_enable(SHARK_UART0_rx_gpio_clk, TRUE);
  202. crm_periph_clock_enable(SHARK_UART0_tx_gpio_clk, TRUE);
  203. gpio_init_type gpio_init_struct;
  204. gpio_init_struct.gpio_drive_strength = GPIO_DRIVE_STRENGTH_STRONGER;
  205. gpio_init_struct.gpio_out_type = GPIO_OUTPUT_PUSH_PULL;
  206. gpio_init_struct.gpio_mode = GPIO_MODE_MUX;
  207. gpio_init_struct.gpio_pins = SHARK_UART0_tx_pin;
  208. gpio_init_struct.gpio_pull = GPIO_PULL_NONE;
  209. gpio_init(SHARK_UART0_tx_port, &gpio_init_struct);
  210. /* configure the usart2 rx pin */
  211. gpio_init_struct.gpio_mode = GPIO_MODE_INPUT;
  212. gpio_init_struct.gpio_pins = SHARK_UART0_rx_pin;
  213. gpio_init_struct.gpio_pull = GPIO_PULL_UP;
  214. gpio_init(SHARK_UART0_rx_port, &gpio_init_struct);
  215. /* remap usart1 tx and rx pins */
  216. gpio_pin_remap_config(SHARK_UART0_IOMUX, TRUE);
  217. }
  218. static void shark_uart_pin_deinit(shark_uart_t *uart){
  219. if (_uart_index(uart->uart_com) == SHARK_UART0) {
  220. gpio_init_type gpio_init_struct;
  221. gpio_init_struct.gpio_drive_strength = GPIO_DRIVE_STRENGTH_STRONGER;
  222. gpio_init_struct.gpio_out_type = GPIO_OUTPUT_PUSH_PULL;
  223. gpio_init_struct.gpio_mode = GPIO_MODE_INPUT;
  224. gpio_init_struct.gpio_pins = SHARK_UART0_tx_pin;
  225. gpio_init_struct.gpio_pull = GPIO_PULL_NONE;
  226. gpio_init(SHARK_UART0_tx_port, &gpio_init_struct);
  227. gpio_init_struct.gpio_pins = SHARK_UART0_rx_pin;
  228. gpio_init_struct.gpio_pull = GPIO_PULL_NONE;
  229. gpio_init(SHARK_UART0_rx_port, &gpio_init_struct);
  230. }
  231. }
  232. static void shark_uart_device_init(shark_uart_t *uart){
  233. crm_periph_clock_enable(SHARK_UART0_clk, TRUE);
  234. usart_reset(uart->uart_com);
  235. /* configure usart2 param */
  236. usart_init(uart->uart_com, SHARK_UART_BAUDRATE, USART_DATA_8BITS, USART_STOP_1_BIT);
  237. usart_transmitter_enable(uart->uart_com, TRUE);
  238. usart_receiver_enable(uart->uart_com, TRUE);
  239. usart_enable(uart->uart_com, TRUE);
  240. }
  241. static u32 shark_uart_task(void *args)
  242. {
  243. shark_uart_t *uart = (shark_uart_t *)args;
  244. if(uart->uart_com != 0) {
  245. shark_uart_dma_rx(uart);
  246. shark_uart_dma_tx(uart);
  247. }
  248. return 0;
  249. }
  250. void shark_uart_flush(void){
  251. shark_uart_t *uart = _shark_uart + SHARK_UART0;
  252. if (uart->uart_com != 0) {
  253. while(!byte_queue_empty(&uart->tx_queue)) {
  254. shark_uart_dma_tx(uart);
  255. }
  256. }
  257. }
  258. static u8 *tx_cache_addr(uart_enum_t uart_no){
  259. return shark_uart0_tx_cache;
  260. }
  261. static u8 *rx_cache_addr(uart_enum_t uart_no){
  262. return shark_uart0_rx_cache;
  263. }
  264. void shark_uart_deinit(uart_enum_t uart_no){
  265. shark_uart_t *uart = _shark_uart + uart_no;
  266. if (uart->uart_com != 0) {
  267. usart_enable(uart->uart_com, FALSE);
  268. usart_reset(uart->uart_com);
  269. crm_periph_clock_enable(SHARK_UART0_clk, FALSE);
  270. dma_channel_enable(uart->rx_dma_ch, FALSE);
  271. dma_channel_enable(uart->tx_dma_ch, FALSE);
  272. crm_periph_clock_enable(SHARK_UART0_tx_dma_clk, FALSE);
  273. crm_periph_clock_enable(SHARK_UART0_rx_dma_clk, FALSE);
  274. shark_uart_pin_deinit(uart);
  275. }
  276. #if ENABLE_RX_DMA==0
  277. nvic_irq_disable(SHARK_UART0_irq);
  278. #endif
  279. }
  280. void shark_uart_init(uart_enum_t uart_no)
  281. {
  282. shark_uart_t *uart = _shark_uart + uart_no;
  283. uart->escape = false;
  284. uart->rx_length = 0;
  285. uart->tx_length = 0;
  286. uart->uart_com = SHARK_UART0_com;
  287. uart->rx_cache = rx_cache_addr(uart_no);
  288. byte_queue_init(&uart->tx_queue,tx_cache_addr(uart_no), SHARK_UART_TX_MEM_SIZE);
  289. uart->rx_dma_ch = SHARK_UART0_rx_dma_ch;
  290. uart->tx_dma_ch = SHARK_UART0_tx_dma_ch;
  291. shark_uart_pin_init(uart);
  292. shark_uart_device_init(uart);
  293. #if ENABLE_RX_DMA==1
  294. shark_uart_rx_dma_init(uart);
  295. #endif
  296. shark_uart_tx_dma_init(uart);
  297. usart_enable(uart->uart_com, TRUE);
  298. shark_task_create(shark_uart_task, uart);
  299. #if ENABLE_RX_DMA==0
  300. nvic_irq_enable(SHARK_UART0_irq, UART_IRQ_PRIORITY, 0);
  301. #endif
  302. uart->uart_no_data = false;
  303. }
  304. #if ENABLE_RX_DMA==0
  305. void USART3_IRQHandler(void){
  306. if(usart_flag_get(USART0, USART_FLAG_RBNE) == SET){
  307. shark_uart_t *uart = _shark_uart + SHARK_UART0;
  308. u8 c = usart_data_receive(USART0);
  309. circle_put_one_data(&uart->rx_queue, c);
  310. }
  311. }
  312. #endif
  313. static void shark_uart_write_byte_esc(shark_uart_t *uart, u8 value)
  314. {
  315. switch (value) {
  316. case CH_START:
  317. shark_uart_write_byte(uart, CH_ESC);
  318. value = CH_ESC_START;
  319. break;
  320. case CH_END:
  321. shark_uart_write_byte(uart, CH_ESC);
  322. value = CH_ESC_END;
  323. break;
  324. case CH_ESC:
  325. shark_uart_write_byte(uart, CH_ESC);
  326. value = CH_ESC_ESC;
  327. break;
  328. }
  329. shark_uart_write_byte(uart, value);
  330. }
  331. static void shark_uart_write_esc(shark_uart_t *uart, const u8 *buff, u16 length)
  332. {
  333. const u8 *buff_end;
  334. for (buff_end = buff + length; buff < buff_end; buff++) {
  335. shark_uart_write_byte_esc(uart, *buff);
  336. }
  337. }
  338. static void shark_uart_tx_start(shark_uart_t *uart)
  339. {
  340. shark_uart_write_byte(uart, CH_START);
  341. uart->tx_crc16 = 0;
  342. }
  343. static void shark_uart_tx_continue(shark_uart_t *uart, const void *buff, u16 length)
  344. {
  345. shark_uart_write_esc(uart, (const u8 *) buff, length);
  346. uart->tx_crc16 = crc16_update(uart->tx_crc16, (const u8 *) buff, length);
  347. }
  348. static void shark_uart_tx_end(shark_uart_t *uart)
  349. {
  350. shark_uart_write_esc(uart, (u8 *)&uart->tx_crc16, sizeof(uart->tx_crc16));
  351. shark_uart_write_byte(uart, CH_END);
  352. }
  353. void shark_uart_write_frame(uart_enum_t uart_no, uint8_t *bytes, int len){
  354. shark_uart_t *uart = _shark_uart + uart_no;
  355. shark_uart_tx_start(uart);
  356. shark_uart_tx_continue(uart, bytes, len);
  357. shark_uart_tx_end(uart);
  358. shark_uart_dma_tx(uart);
  359. }
  360. void shark_uart_frame_start(uart_enum_t uart_no, uint8_t *bytes, int len){
  361. shark_uart_t *uart = _shark_uart + uart_no;
  362. shark_uart_tx_start(uart);
  363. shark_uart_tx_continue(uart, bytes, len);
  364. }
  365. void shark_uart_frame_continue(uart_enum_t uart_no, uint8_t *bytes, int len){
  366. shark_uart_t *uart = _shark_uart + uart_no;
  367. shark_uart_tx_continue(uart, bytes, len);
  368. }
  369. void shark_uart_frame_end(uart_enum_t uart_no){
  370. shark_uart_tx_end(_shark_uart + uart_no);
  371. }
  372. void shark_uart_write_bytes(uart_enum_t uart_no, u8 *buff, u16 size){
  373. shark_uart_write(_shark_uart + uart_no, buff, size);
  374. }
  375. int fputc(int c, FILE *fp){
  376. shark_uart_write_byte(_shark_uart+SHARK_UART0, (u8)c);
  377. return 1;
  378. }