123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234 |
- #include "main_task.h"
- #include "uart.h"
- #include "gpio.h"
- #include "cfg.h"
- #include "protocol.h"
- #include "process.h"
- #include "crc16.h"
- #include <string.h>
- /**
- * Uart0_RxDataHandle
- *
- * @return none
- *
- * @brief 主任务处理函数
- */
- void Uart0_RxDataHandle(void)
- {
- uint8_t* rxbuf = uart0_info.recv_buffer;
- uint16_t rx_len = uart0_info.recv_len;
- uint8_t* txbuf = uart0_info.send_buffer;
- uint16_t txbuf_size = UART0_TRANSMIT_DATA_POOL_COUNT;
- uint16_t tx_len = 0;
- uint16_t cmd;
- uint16_t crc;
- uint16_t ret_len = 0;
- uint8_t ret_write = RET_OK;
-
- if(rx_len > 2){
-
- //check rs485 addr
- if(config->addr == rxbuf[0] || BROADCAST_ADDR == rxbuf[0]){
-
- #if 1
- // check crc
- crc = ((uint16_t)rxbuf[rx_len-2]<<8) | rxbuf[rx_len-1];
- if (crc == crc16(rxbuf, rx_len-2))
- {
- //copy 地址、功能码、命令、到发送buf
- memcpy(txbuf, (void *)rxbuf, 4);
- tx_len +=4;
-
- if(MODBUS_FUNC_READ == rxbuf[1]){
- cmd = ((uint16_t)rxbuf[2]<<8) | rxbuf[3];
- switch(cmd){
- case Cmd_FirmwareVersion:
- ret_len = Read_FirmwareVersion(txbuf+tx_len, txbuf_size-tx_len);
- break;
- case Cmd_HardwareVersion:
- ret_len = Read_HardwareVersion(txbuf+tx_len, txbuf_size-tx_len);
- break;
- case Cmd_DeviceID:
- ret_len = Read_Deviceid(txbuf+tx_len, txbuf_size-tx_len);
- break;
- case Cmd_DeviceType:
- ret_len = Read_Devicetype(txbuf+tx_len, txbuf_size-tx_len);
- break;
- case Cmd_Addr:
- ret_len = Read_Addr(txbuf+tx_len, txbuf_size-tx_len);
- break;
- case Cmd_Baudrate:
- ret_len = Read_Baudrate(txbuf+tx_len, txbuf_size-tx_len);
- break;
- case Cmd_LockStatus:
- ret_len = Read_LockStatus(txbuf+tx_len, txbuf_size-tx_len);
- break;
- default:
- txbuf[1] |= 0x80;
- txbuf[tx_len] = INVALID_COMMAND;
- ret_len = 1;
- break;
- };
-
- if(0 == ret_len){
- // error occur
- txbuf[1] |= 0x80;
- txbuf[tx_len] = DEVICE_FAULT;
- ret_len = 1;
- }
-
- tx_len += ret_len;
- crc = crc16(txbuf, tx_len);
- txbuf[tx_len++] = (uint8_t)((crc>>8) & 0x00ff);
- txbuf[tx_len++] = (uint8_t)(crc & 0x00ff);
-
- uart0_TransmitData(txbuf, tx_len);
-
- }else if(MODBUS_FUNC_WRITE == rxbuf[1]){
-
- ret_write = RET_OK;
- cmd = ((uint16_t)rxbuf[2]<<8) | rxbuf[3];
- switch(cmd){
- case Cmd_HardwareVersion:
- ret_write = Write_HardwareVersion(rxbuf+4, rx_len-4-2);
- break;
- case Cmd_DeviceID:
- ret_write = Write_Deviceid(rxbuf+4, rx_len-4-2);
- break;
- case Cmd_DeviceType:
- ret_write = Write_Devicetype(rxbuf+4, rx_len-4-2);
- break;
- case Cmd_Addr:
- ret_write = Write_Addr(rxbuf+4, rx_len-4-2);
- break;
- case Cmd_Baudrate:
- ret_write = Write_Baudrate(rxbuf+4, rx_len-4-2);
- break;
- case Cmd_Reboot:
- //NVIC_SystemReset();
- ret_write = RET_NEED_REBOOT;
- break;
- case Cmd_Reset:
- ResetConfig();
- ret_write = RET_NEED_SAVE|RET_NEED_REBOOT;
- //NVIC_SystemReset();
- break;
- default:
- ret_write = RET_CMDINVALID;
- break;
- };
-
- if((ret_write&RET_ERROR_MASK) > 0){
-
- if((ret_write&RET_DATAINVALID) > 0){
- txbuf[1] |= 0x80;
- txbuf[tx_len++] = INVALID_DATA;
- }else if((ret_write&RET_CMDINVALID) > 0){
- txbuf[1] |= 0x80;
- txbuf[tx_len++] = INVALID_COMMAND;
- }
-
- }else{
- //copy the whole rx frame
- memcpy(txbuf, (void *)rxbuf, rx_len-2);
- tx_len =rx_len-2;
- }
-
- crc = crc16(txbuf, tx_len);
- txbuf[tx_len++] = (uint8_t)((crc>>8) & 0x00ff);
- txbuf[tx_len++] = (uint8_t)(crc & 0x00ff);
-
- uart0_TransmitData(txbuf, tx_len);
-
- if((ret_write&RET_NEED_SAVE) > 0 ){
- SaveConfig();
- }
-
- if((ret_write&RET_NEED_REBOOT) > 0 ){
- NVIC_SystemReset();
- }
-
-
- }else{
-
- //function code no exist
- txbuf[1] |= 0x80;
- txbuf[tx_len++] = INVALID_FUNCTION_CODE;
-
- crc = crc16(txbuf, tx_len);
- txbuf[tx_len++] = (uint8_t)((crc>>8) & 0x00ff);
- txbuf[tx_len++] = (uint8_t)(crc & 0x00ff);
-
- uart0_TransmitData(txbuf, tx_len);
- }
-
- }
- #else
- memcpy(txbuf, (void *)rxbuf, rx_len);
- tx_len +=rx_len;
-
- uart0_TransmitData(txbuf, tx_len);
-
- #endif
-
- }
-
- } //END rx_len
-
- if(rx_len > 0){
- uart0_RecvData();
- }
-
-
-
- //处理 485 收发状态
- if(uart0_info.dmasend_count >= UART_DMASEND_COUNT_RESET){
- uart0_info.dmasend_count = 0;
- RS485_RX_EN;
- }
- }
- /**
- * Task_Init
- *
- * @return none
- *
- * @brief 初始化
- */
- void Task_Init(void)
- {
- uart_Initialize();
- }
- /**
- * Task_Handle
- *
- * @return none
- *
- * @brief 主任务处理函数
- */
- void Task_Handle(void)
- {
-
- Process_RunLedPrd();
- Process_ThreeStatus();
- Uart0_RxDataHandle();
- }
|