| 123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581 |
- #include "uart.h"
- #include "bsp/shark_bsp.h"
- #include "bsp/gpio.h"
- #include "libs/shark_libs.h"
- #include "libs/shark_task.h"
- #include "libs/logger.h"
- #define SHARK_UART_BAUDRATE 38400
- #define SHARK_UART0_com USART0
- #define SHARK_UART0_tx_port GPIOB
- #define SHARK_UART0_tx_pin GPIO_PIN_6
- #define SHARK_UART0_rx_port GPIOB
- #define SHARK_UART0_rx_pin GPIO_PIN_7
- #define SHARK_UART0_irq USART0_IRQn
- #define SHARK_UART0_clk RCU_USART0
- #define SHARK_UART0_tx_gpio_clk RCU_GPIOB
- #define SHARK_UART0_rx_gpio_clk RCU_GPIOB
- #define SHARK_UART0_tx_dma DMA
- #define SHARK_UART0_tx_dma_ch DMA_CH1
- #define SHARK_UART0_tx_dma_clk RCU_DMA
- #define SHARK_UART0_rx_dma DMA
- #define SHARK_UART0_rx_dma_ch DMA_CH2
- #define SHARK_UART0_rx_dma_clk RCU_DMA
- #define SHARK_UART1_com USART1
- #define SHARK_UART1_tx_port GPIOA
- #define SHARK_UART1_tx_pin GPIO_PIN_2
- #define SHARK_UART1_rx_port GPIOA
- #define SHARK_UART1_rx_pin GPIO_PIN_3
- #define SHARK_UART1_irq USART1_IRQn
- #define SHARK_UART1_clk RCU_USART1
- #define SHARK_UART1_tx_gpio_clk RCU_GPIOA
- #define SHARK_UART1_rx_gpio_clk RCU_GPIOA
- #define SHARK_UART1_tx_dma DMA
- #define SHARK_UART1_tx_dma_ch DMA_CH3
- #define SHARK_UART1_tx_dma_clk RCU_DMA
- #define SHARK_UART1_rx_dma DMA
- #define SHARK_UART1_rx_dma_ch DMA_CH4
- #define SHARK_UART1_rx_dma_clk RCU_DMA
- // ================================================================================
- #define ENABLE_RX_DMA 1
- static u8 shark_uart0_tx_cache[SHARK_UART_TX_MEM_SIZE];
- #if UART_NUM==2
- static u8 shark_uart1_tx_cache[SHARK_UART_TX_MEM_SIZE];
- #endif
- static u8 shark_uart0_rx_cache[SHARK_UART_RX_MEM_SIZE];
- #if UART_NUM==2
- static u8 shark_uart1_rx_cache[SHARK_UART_RX_MEM_SIZE];
- #endif
- static shark_uart_t _shark_uart[UART_NUM];
- static shark_task_t _uart_task;
- static u64 _rx_time;
- u32 uart_rx_bytes = 0;
- u32 uart_old_prot = 0;
- u32 uart_new_prot = 0;
- u32 uart_tx_bytes = 0;
- static u32 uart_run_times[2];
- static u32 uart_irq_times[2];
- ///static bool uart_no_data = false;
- #if ENABLE_RX_DMA==1
- #define update_dma_w_pos(uart) circle_update_write_position(&uart->rx_queue, SHARK_UART_RX_MEM_SIZE - DMA_CHCNT(uart->rx_dma_ch))
- #else
- #define update_dma_w_pos(uart){}
- #endif
- extern void protocol_recv_frame(uart_enum_t uart_no, char *data, int len);
- extern void protocol_old_recv_frame(uart_enum_t uart_no, uint8_t *data, int len);
- extern void health_add_uart_error(uint32_t c, uint32_t l, uint32_t d);
- // ================================================================================
- static uart_enum_t _uart_index(uint32_t com){
- return com == SHARK_UART0_com?SHARK_UART0:SHARK_UART1;
- }
- static bool shark_uart_on_rx_frame(shark_uart_t *uart)
- {
- u16 crc0 = shark_decode_u16(uart->rx_frame + uart->rx_length);
- u16 crc1 = shark_crc16_check(uart->rx_frame, uart->rx_length);
- if (crc0 != crc1) {
- health_add_uart_error(1, 0, 0);
- return false;
- }
- #if (CONFIG_BOARD_TYPE==SHARK_BOARD_SP600)
- //wait 250us to give the time for PS200 485 switch to rx mode
- task_udelay(250);
- #endif
- protocol_recv_frame(_uart_index(uart->uart_com), (char *)uart->rx_frame, uart->rx_length);
- return true;
- }
- static void shark_uart_rx(shark_uart_t *uart){
- while(1) {
- u8 data;
- uart_run_times[_uart_index(uart->uart_com)] ++;
- update_dma_w_pos(uart);
- if (circle_get_one_data(&uart->rx_queue, &data) != 1) {
- if (shark_get_mseconds() >= (5 + _rx_time)) {
- //_rx_time = 0xFFFFFFFFFFFFL;
- if (uart->rx_length_old_prot > 0){
- protocol_old_recv_frame(_uart_index(uart->uart_com), uart->rx_frame_old_prot, uart->rx_length_old_prot);
- uart->rx_length_old_prot = 0;
- }
- }
-
- if (shark_get_mseconds() >= (UART_TIMEOUT + _rx_time)){
- uart->uart_no_data = true;
- }else {
- uart->uart_no_data = false;
- }
- break;
- }
- uart_rx_bytes ++;
- _rx_time = shark_get_mseconds();
- uart->rx_frame_old_prot[uart->rx_length_old_prot ++] = data;
- if (uart->rx_length_old_prot == sizeof(uart->rx_frame_old_prot)){
- uart->rx_length_old_prot = 0;
- }
- switch(data){
- case CH_START:
- uart->rx_length = 0;
- uart->escape = false;
- uart->start = true;
- break;
- case CH_END:
- if (uart->rx_length > 2 && uart->rx_length != 0xFFFF){
- uart->rx_length -= 2; //skip crc
- shark_uart_on_rx_frame(uart);
- }else if (uart->start == true){
- health_add_uart_error(0, 1, 0);
- }
- uart->rx_length = 0xFFFF;
- uart->start = false;
- break;
- case CH_ESC:
- uart->escape = true;
- break;
- default:
- if (uart->escape) {
- uart->escape = false;
- switch (data) {
- case CH_ESC_START:
- data = CH_START;
- break;
- case CH_ESC_END:
- data = CH_END;
- break;
- case CH_ESC_ESC:
- data = CH_ESC;
- break;
- default:
- data = 0xFF;
- }
- }
- if (uart->rx_length < sizeof(uart->rx_frame)) {
- uart->rx_frame[uart->rx_length] = data;
- uart->rx_length++;
- } else {
- uart->rx_length = 0xFFFF;
- if (uart->start == true) {
- health_add_uart_error(0, 1, 0);
- }
- }
- }
- }
- }
- static void shark_uart_dma_tx(shark_uart_t *uart)
- {
- u32 value = DMA_CHCTL(uart->tx_dma_ch);
- if (value & DMA_CHXCTL_CHEN) {
- if (SET != dma_flag_get(uart->tx_dma_ch, DMA_FLAG_FTF)) {
- return;
- }
- byte_queue_skip(&uart->tx_queue, uart->tx_length);
- DMA_CHCTL(uart->tx_dma_ch) = value & (~DMA_CHXCTL_CHEN);
- }
- uart->tx_length = byte_queue_peek(&uart->tx_queue);
- if (uart->tx_length > 0) {
- DMA_CHCNT(uart->tx_dma_ch) = uart->tx_length;
- DMA_CHMADDR(uart->tx_dma_ch) = (u32) byte_queue_head(&uart->tx_queue);
- dma_flag_clear(uart->tx_dma_ch, DMA_FLAG_FTF);
- DMA_CHCTL(uart->tx_dma_ch) = value | DMA_CHXCTL_CHEN;
- }
- }
- static void shark_uart_write(shark_uart_t *uart, const u8 *buff, u16 size)
- {
- uart_tx_bytes += size;
- while (size > 0) {
- u16 length = byte_queue_write(&uart->tx_queue, buff, size);
- if (length == size) {
- shark_uart_dma_tx(uart);
- break;
- }
- shark_uart_dma_tx(uart);
- buff += length;
- size -= length;
- }
- }
- static void shark_uart_write_byte(shark_uart_t *uart, u8 value)
- {
- shark_uart_write(uart, &value, 1);
- }
- static void shark_uart_tx_dma_init(shark_uart_t *uart){
- dma_parameter_struct dma_init_struct;
- rcu_periph_clock_enable(_uart_index(uart->uart_com)== SHARK_UART0?SHARK_UART0_tx_dma_clk:SHARK_UART1_tx_dma_clk);
- dma_deinit(uart->tx_dma_ch);
- dma_init_struct.direction = DMA_MEMORY_TO_PERIPHERAL;
- dma_init_struct.memory_inc = DMA_MEMORY_INCREASE_ENABLE;
- dma_init_struct.memory_width = DMA_MEMORY_WIDTH_8BIT;
- dma_init_struct.periph_addr = (u32) &USART_TDATA(uart->uart_com);
- dma_init_struct.periph_inc = DMA_PERIPH_INCREASE_DISABLE;
- dma_init_struct.periph_width = DMA_PERIPHERAL_WIDTH_8BIT;
- dma_init_struct.priority = DMA_PRIORITY_ULTRA_HIGH;
- dma_init(uart->tx_dma_ch, &dma_init_struct);
- dma_circulation_disable(uart->tx_dma_ch);
- dma_memory_to_memory_disable(uart->tx_dma_ch);
- usart_dma_transmit_config(uart->uart_com, USART_DENT_ENABLE);
- #if 0
- if (uart->tx_dma_ch == DMA_CH1) {
- nvic_irq_enable(DMA_Channel1_2_IRQn ,4, 0);
- }else {
- nvic_irq_enable(DMA_Channel3_4_IRQn ,4, 0);
- }
- dma_interrupt_enable(uart->tx_dma_ch, DMA_INT_FTF);
- #endif
- }
- #if ENABLE_RX_DMA==1
- static void shark_uart_rx_dma_init(shark_uart_t *uart){
- dma_parameter_struct dma_init_struct;
- rcu_periph_clock_enable(_uart_index(uart->uart_com)== SHARK_UART0?SHARK_UART0_rx_dma_clk:SHARK_UART1_rx_dma_clk);
- dma_deinit(uart->rx_dma_ch);
- dma_init_struct.direction = DMA_PERIPHERAL_TO_MEMORY;
- dma_init_struct.memory_inc = DMA_MEMORY_INCREASE_ENABLE;
- dma_init_struct.memory_width = DMA_MEMORY_WIDTH_8BIT;
- dma_init_struct.memory_addr = (u32)uart->rx_queue.buffer;
- dma_init_struct.number = uart->rx_queue.buffer_len;
- dma_init_struct.periph_addr = (u32) &USART_RDATA(uart->uart_com);
- dma_init_struct.periph_inc = DMA_PERIPH_INCREASE_DISABLE;
- dma_init_struct.periph_width = DMA_PERIPHERAL_WIDTH_8BIT;
- dma_init_struct.priority = DMA_PRIORITY_ULTRA_HIGH;
- dma_init(uart->rx_dma_ch, &dma_init_struct);
- dma_circulation_enable(uart->rx_dma_ch);
- dma_memory_to_memory_disable(uart->rx_dma_ch);
- dma_channel_enable(uart->rx_dma_ch);
- usart_dma_receive_config(uart->uart_com, USART_DENR_ENABLE);
- }
- #endif
- static void shark_uart_pin_init(shark_uart_t *uart){
- if (_uart_index(uart->uart_com) == SHARK_UART0) {
- rcu_periph_clock_enable(SHARK_UART0_clk);
- rcu_periph_clock_enable(SHARK_UART0_rx_gpio_clk);
- rcu_periph_clock_enable(SHARK_UART0_tx_gpio_clk);
- gpio_af_set(SHARK_UART0_tx_port, GPIO_AF_0,SHARK_UART0_tx_pin);
- gpio_mode_set(SHARK_UART0_tx_port, GPIO_MODE_AF, GPIO_PUPD_PULLUP, SHARK_UART0_tx_pin);
- gpio_output_options_set(SHARK_UART0_tx_port, GPIO_OTYPE_PP, GPIO_OSPEED_50MHZ, SHARK_UART0_tx_pin);
- gpio_af_set(SHARK_UART0_rx_port, GPIO_AF_0,SHARK_UART0_rx_pin);
- gpio_mode_set(SHARK_UART0_rx_port, GPIO_MODE_AF, GPIO_PUPD_PULLUP, SHARK_UART0_rx_pin);
- gpio_output_options_set(SHARK_UART0_rx_port, GPIO_OTYPE_PP, GPIO_OSPEED_50MHZ,SHARK_UART0_rx_pin);
- }else {
- rcu_periph_clock_enable(SHARK_UART1_clk);
- rcu_periph_clock_enable(SHARK_UART1_rx_gpio_clk);
- rcu_periph_clock_enable(SHARK_UART1_tx_gpio_clk);
- gpio_af_set(SHARK_UART1_tx_port, GPIO_AF_1,SHARK_UART1_tx_pin);
- gpio_mode_set(SHARK_UART1_tx_port, GPIO_MODE_AF, GPIO_PUPD_PULLUP, SHARK_UART1_tx_pin);
- gpio_output_options_set(SHARK_UART1_tx_port, GPIO_OTYPE_PP, GPIO_OSPEED_50MHZ, SHARK_UART1_tx_pin);
- gpio_af_set(SHARK_UART1_rx_port, GPIO_AF_1,SHARK_UART1_rx_pin);
- gpio_mode_set(SHARK_UART1_rx_port, GPIO_MODE_AF, GPIO_PUPD_PULLUP, SHARK_UART1_rx_pin);
- gpio_output_options_set(SHARK_UART1_rx_port, GPIO_OTYPE_PP, GPIO_OSPEED_50MHZ,SHARK_UART1_rx_pin);
- }
- }
- static void shark_uart_pin_deinit(shark_uart_t *uart){
- if (_uart_index(uart->uart_com) == SHARK_UART0) {
- gpio_mode_set(SHARK_UART0_tx_port, GPIO_MODE_INPUT, GPIO_PUPD_NONE, SHARK_UART0_tx_pin);
- gpio_mode_set(SHARK_UART0_rx_port, GPIO_MODE_INPUT, GPIO_PUPD_NONE, SHARK_UART0_rx_pin);
- }else {
- gpio_mode_set(SHARK_UART1_tx_port, GPIO_MODE_INPUT, GPIO_PUPD_NONE, SHARK_UART1_tx_pin);
- gpio_mode_set(SHARK_UART1_rx_port, GPIO_MODE_INPUT, GPIO_PUPD_NONE, SHARK_UART1_rx_pin);
- }
- }
- static void shark_uart_device_init(shark_uart_t *uart){
- usart_deinit(uart->uart_com);
- usart_baudrate_set(uart->uart_com, SHARK_UART_BAUDRATE);
- usart_word_length_set(uart->uart_com, USART_WL_8BIT);
- usart_stop_bit_set(uart->uart_com, USART_STB_1BIT);
- usart_parity_config(uart->uart_com, USART_PM_NONE);
- usart_hardware_flow_rts_config(uart->uart_com, USART_RTS_DISABLE);
- usart_hardware_flow_cts_config(uart->uart_com, USART_CTS_DISABLE);
- usart_receive_config(uart->uart_com, USART_RECEIVE_ENABLE);
- usart_transmit_config(uart->uart_com, USART_TRANSMIT_ENABLE);
- #if ENABLE_RX_DMA==0
- usart_overrun_disable(uart->uart_com);//must add
- usart_lin_mode_disable(uart->uart_com);
- usart_receiver_timeout_disable(uart->uart_com);
- usart_reception_error_dma_disable(uart->uart_com);
- usart_interrupt_enable(uart->uart_com,USART_INT_RBNE);
- #endif
- }
- static u32 shark_uart_handler(void)
- {
- shark_uart_t *uart = _shark_uart + SHARK_UART0;
- if (uart->uart_com != 0) {
- shark_uart_rx(uart);
- shark_uart_dma_tx(uart);
- }
- #if UART_NUM==2
- uart = _shark_uart + SHARK_UART1;
- if (uart->uart_com != 0) {
- shark_uart_rx(uart);
- shark_uart_dma_tx(uart);
- }
- #endif
- return 0;
- }
- void shark_uart_log(void){
- shark_uart_t *uart = _shark_uart + SHARK_UART0;
- sys_debug("Debug: %d, %d, %d, %d\n", uart_tx_bytes, uart_rx_bytes, uart_new_prot, uart_old_prot);
- sys_debug("uart0: %d, %d, %d, %d, %d\n", uart_run_times[0], uart->rx_queue.r_pos, uart->rx_queue.w_pos, uart->rx_queue.buffer_len, uart_irq_times[0]);
- #if ENABLE_RX_DMA==1
- sys_debug("dma0: %d\n", DMA_CHCNT(uart->rx_dma_ch));
- #endif
- #if UART_NUM==2
- uart = _shark_uart + SHARK_UART1;
- sys_debug("uart1: %d, %d, %d, %d, %d\n", uart_run_times[1], uart->rx_queue.r_pos, uart->rx_queue.w_pos, uart->rx_queue.buffer_len, uart_irq_times[1]);
- #if ENABLE_RX_DMA==1
- sys_debug("dma1: %d\n", DMA_CHCNT(uart->rx_dma_ch));
- #endif
- #endif
- }
- void shark_uart_flush(void){
- shark_uart_t *uart = _shark_uart + SHARK_UART0;
- if (uart->uart_com != 0) {
- while(!byte_queue_empty(&uart->tx_queue)) {
- shark_uart_dma_tx(uart);
- }
- }
- #if UART_NUM==2
- uart = _shark_uart + SHARK_UART1;
- if (uart->uart_com != 0) {
- while(!byte_queue_empty(&uart->tx_queue)) {
- shark_uart_dma_tx(uart);
- }
- }
- #endif
- }
- #if 0
- void DMA_Channel1_2_IRQHandler(void){
- shark_uart_t *uart = _shark_uart + SHARK_UART0;
- if (dma_interrupt_flag_get(uart->tx_dma_ch, DMA_INT_FLAG_FTF) != RESET){
- shark_uart_dma_tx(uart);
- dma_interrupt_flag_clear(uart->tx_dma_ch, DMA_INT_FLAG_FTF);
- }
- }
- void DMA_Channel3_4_IRQHandler(void){
- shark_uart_t *uart = _shark_uart + SHARK_UART1;
- if (dma_interrupt_flag_get(uart->tx_dma_ch, DMA_INT_FLAG_FTF) != RESET){
- shark_uart_dma_tx(uart);
- dma_interrupt_flag_clear(uart->tx_dma_ch, DMA_INT_FLAG_FTF);
- }
- }
- #endif
- static u8 *tx_cache_addr(uart_enum_t uart_no){
- #if UART_NUM==2
- return (uart_no == SHARK_UART0)?shark_uart0_tx_cache:shark_uart1_tx_cache;
- #else
- return shark_uart0_tx_cache;
- #endif
- }
- static u8 *rx_cache_addr(uart_enum_t uart_no){
- #if UART_NUM==2
- return (uart_no == SHARK_UART0)?shark_uart0_rx_cache:shark_uart1_rx_cache;
- #else
- return shark_uart0_rx_cache;
- #endif
- }
- void shark_uart_deinit(uart_enum_t uart_no){
- shark_uart_t *uart = _shark_uart + uart_no;
- if (uart->uart_com != 0) {
- usart_disable(uart->uart_com);
- usart_deinit(uart->uart_com);
- rcu_periph_clock_disable(uart_no == SHARK_UART0?SHARK_UART0_clk:SHARK_UART1_clk);
- dma_channel_disable(uart->rx_dma_ch);
- dma_channel_disable(uart->tx_dma_ch);
- rcu_periph_clock_disable(uart_no == SHARK_UART0?SHARK_UART0_tx_dma_clk:SHARK_UART1_tx_dma_clk);
- rcu_periph_clock_disable(uart_no == SHARK_UART0?SHARK_UART0_rx_dma_clk:SHARK_UART1_rx_dma_clk);
- shark_uart_pin_deinit(uart);
- }
- if (uart_no == SHARK_UART0) {
- UART0_IR_EN(0);
- #if ENABLE_RX_DMA==0
- nvic_irq_disable(USART0_IRQn);
- #endif
- }else {
- UART1_IR_EN(0);
- #if ENABLE_RX_DMA==0
- nvic_irq_disable(USART1_IRQn);
- #endif
- }
- }
- bool shark_uart_timeout(void){
- #if UART_NUM==2
- return (_shark_uart[0].uart_no_data && _shark_uart[1].uart_no_data)?TRUE:FALSE;
- #else
- return (_shark_uart[0].uart_no_data)?TRUE:FALSE;
- #endif
- }
- void shark_uart_init(uart_enum_t uart_no)
- {
- shark_uart_t *uart = _shark_uart + uart_no;
- uart->escape = false;
- uart->rx_length = 0;
- uart->tx_length = 0;
- uart->uart_com = (uart_no == SHARK_UART0)?SHARK_UART0_com:SHARK_UART1_com;
- circle_buffer_init(&uart->rx_queue, rx_cache_addr(uart_no), SHARK_UART_RX_MEM_SIZE);
- byte_queue_init(&uart->tx_queue,tx_cache_addr(uart_no), SHARK_UART_TX_MEM_SIZE);
- uart->rx_dma_ch = (uart_no == SHARK_UART0)?SHARK_UART0_rx_dma_ch:SHARK_UART1_rx_dma_ch;
- uart->tx_dma_ch = (uart_no == SHARK_UART0)?SHARK_UART0_tx_dma_ch:SHARK_UART1_tx_dma_ch;
- shark_uart_pin_init(uart);
- shark_uart_device_init(uart);
- #if ENABLE_RX_DMA==1
- shark_uart_rx_dma_init(uart);
- #endif
- shark_uart_tx_dma_init(uart);
- usart_enable(uart->uart_com);
-
- if (_uart_task.handler == NULL) {
- _uart_task.handler = shark_uart_handler;
- shark_task_add(&_uart_task);
- }
- if (uart_no == SHARK_UART0) {
- UART0_IR_EN(1);
- #if ENABLE_RX_DMA==0
- nvic_irq_enable(USART0_IRQn, 3, 0);
- #endif
- }else {
- UART1_IR_EN(1);
- #if ENABLE_RX_DMA==0
- nvic_irq_enable(USART1_IRQn, 3, 0);
- #endif
- }
- _rx_time = shark_get_mseconds();
- uart->uart_no_data = false;
- }
- #if ENABLE_RX_DMA==0
- void USART0_IRQHandler(void){
- if(usart_flag_get(USART0, USART_FLAG_RBNE) == SET){
- shark_uart_t *uart = _shark_uart + SHARK_UART0;
- uart_irq_times[0] ++;
- u8 c = usart_data_receive(USART0);
- circle_put_one_data(&uart->rx_queue, c);
- }
- }
- void USART1_IRQHandler(void){
- if(usart_flag_get(USART1, USART_FLAG_RBNE) == SET){
- shark_uart_t *uart = _shark_uart + SHARK_UART1;
- uart_irq_times[1] ++;
- u8 c = usart_data_receive(USART1);
- circle_put_one_data(&uart->rx_queue, c);
- }
- }
- #endif
- static void shark_uart_write_byte_esc(shark_uart_t *uart, u8 value)
- {
- switch (value) {
- case CH_START:
- shark_uart_write_byte(uart, CH_ESC);
- value = CH_ESC_START;
- break;
- case CH_END:
- shark_uart_write_byte(uart, CH_ESC);
- value = CH_ESC_END;
- break;
- case CH_ESC:
- shark_uart_write_byte(uart, CH_ESC);
- value = CH_ESC_ESC;
- break;
- }
- shark_uart_write_byte(uart, value);
- }
- static void shark_uart_write_esc(shark_uart_t *uart, const u8 *buff, u16 length)
- {
- const u8 *buff_end;
- for (buff_end = buff + length; buff < buff_end; buff++) {
- shark_uart_write_byte_esc(uart, *buff);
- }
- }
- static void shark_uart_tx_start(shark_uart_t *uart)
- {
- shark_uart_write_byte(uart, CH_START);
- uart->tx_crc16 = 0;
- }
- static void shark_uart_tx_continue(shark_uart_t *uart, const void *buff, u16 length)
- {
- shark_uart_write_esc(uart, (const u8 *) buff, length);
- uart->tx_crc16 = shark_crc16_update(uart->tx_crc16, (const u8 *) buff, length);
- }
- static void shark_uart_tx_end(shark_uart_t *uart)
- {
- shark_uart_write_esc(uart, (u8 *)&uart->tx_crc16, sizeof(uart->tx_crc16));
- shark_uart_write_byte(uart, CH_END);
- }
- void shark_uart_write_frame(uart_enum_t uart_no, uint8_t *bytes, int len){
- shark_uart_t *uart = _shark_uart + uart_no;
- shark_uart_tx_start(uart);
- shark_uart_tx_continue(uart, bytes, len);
- shark_uart_tx_end(uart);
- }
- void shark_uart_frame_start(uart_enum_t uart_no, uint8_t *bytes, int len){
- shark_uart_t *uart = _shark_uart + uart_no;
- shark_uart_tx_start(uart);
- shark_uart_tx_continue(uart, bytes, len);
- }
- void shark_uart_frame_continue(uart_enum_t uart_no, uint8_t *bytes, int len){
- shark_uart_t *uart = _shark_uart + uart_no;
- shark_uart_tx_continue(uart, bytes, len);
- }
- void shark_uart_frame_end(uart_enum_t uart_no){
- shark_uart_tx_end(_shark_uart + uart_no);
- }
- void shark_uart_write_bytes(uart_enum_t uart_no, u8 *buff, u16 size){
- shark_uart_write(_shark_uart + uart_no, buff, size);
- }
|