main_task.c 5.3 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234
  1. #include "main_task.h"
  2. #include "uart.h"
  3. #include "gpio.h"
  4. #include "cfg.h"
  5. #include "protocol.h"
  6. #include "process.h"
  7. #include "crc16.h"
  8. #include <string.h>
  9. /**
  10. * Uart0_RxDataHandle
  11. *
  12. * @return none
  13. *
  14. * @brief 主任务处理函数
  15. */
  16. void Uart0_RxDataHandle(void)
  17. {
  18. uint8_t* rxbuf = uart0_info.recv_buffer;
  19. uint16_t rx_len = uart0_info.recv_len;
  20. uint8_t* txbuf = uart0_info.send_buffer;
  21. uint16_t txbuf_size = UART0_TRANSMIT_DATA_POOL_COUNT;
  22. uint16_t tx_len = 0;
  23. uint16_t cmd;
  24. uint16_t crc;
  25. uint16_t ret_len = 0;
  26. uint8_t ret_write = RET_OK;
  27. if(rx_len > 2){
  28. //check rs485 addr
  29. if(config->addr == rxbuf[0] || BROADCAST_ADDR == rxbuf[0]){
  30. #if 1
  31. // check crc
  32. crc = ((uint16_t)rxbuf[rx_len-2]<<8) | rxbuf[rx_len-1];
  33. if (crc == crc16(rxbuf, rx_len-2))
  34. {
  35. //copy 地址、功能码、命令、到发送buf
  36. memcpy(txbuf, (void *)rxbuf, 4);
  37. tx_len +=4;
  38. if(MODBUS_FUNC_READ == rxbuf[1]){
  39. cmd = ((uint16_t)rxbuf[2]<<8) | rxbuf[3];
  40. switch(cmd){
  41. case Cmd_FirmwareVersion:
  42. ret_len = Read_FirmwareVersion(txbuf+tx_len, txbuf_size-tx_len);
  43. break;
  44. case Cmd_HardwareVersion:
  45. ret_len = Read_HardwareVersion(txbuf+tx_len, txbuf_size-tx_len);
  46. break;
  47. case Cmd_DeviceID:
  48. ret_len = Read_Deviceid(txbuf+tx_len, txbuf_size-tx_len);
  49. break;
  50. case Cmd_DeviceType:
  51. ret_len = Read_Devicetype(txbuf+tx_len, txbuf_size-tx_len);
  52. break;
  53. case Cmd_Addr:
  54. ret_len = Read_Addr(txbuf+tx_len, txbuf_size-tx_len);
  55. break;
  56. case Cmd_Baudrate:
  57. ret_len = Read_Baudrate(txbuf+tx_len, txbuf_size-tx_len);
  58. break;
  59. case Cmd_LockStatus:
  60. ret_len = Read_LockStatus(txbuf+tx_len, txbuf_size-tx_len);
  61. break;
  62. default:
  63. txbuf[1] |= 0x80;
  64. txbuf[tx_len] = INVALID_COMMAND;
  65. ret_len = 1;
  66. break;
  67. };
  68. if(0 == ret_len){
  69. // error occur
  70. txbuf[1] |= 0x80;
  71. txbuf[tx_len] = DEVICE_FAULT;
  72. ret_len = 1;
  73. }
  74. tx_len += ret_len;
  75. crc = crc16(txbuf, tx_len);
  76. txbuf[tx_len++] = (uint8_t)((crc>>8) & 0x00ff);
  77. txbuf[tx_len++] = (uint8_t)(crc & 0x00ff);
  78. uart0_TransmitData(txbuf, tx_len);
  79. }else if(MODBUS_FUNC_WRITE == rxbuf[1]){
  80. ret_write = RET_OK;
  81. cmd = ((uint16_t)rxbuf[2]<<8) | rxbuf[3];
  82. switch(cmd){
  83. case Cmd_HardwareVersion:
  84. ret_write = Write_HardwareVersion(rxbuf+4, rx_len-4-2);
  85. break;
  86. case Cmd_DeviceID:
  87. ret_write = Write_Deviceid(rxbuf+4, rx_len-4-2);
  88. break;
  89. case Cmd_DeviceType:
  90. ret_write = Write_Devicetype(rxbuf+4, rx_len-4-2);
  91. break;
  92. case Cmd_Addr:
  93. ret_write = Write_Addr(rxbuf+4, rx_len-4-2);
  94. break;
  95. case Cmd_Baudrate:
  96. ret_write = Write_Baudrate(rxbuf+4, rx_len-4-2);
  97. break;
  98. case Cmd_Reboot:
  99. //NVIC_SystemReset();
  100. ret_write = RET_NEED_REBOOT;
  101. break;
  102. case Cmd_Reset:
  103. ResetConfig();
  104. ret_write = RET_NEED_SAVE|RET_NEED_REBOOT;
  105. //NVIC_SystemReset();
  106. break;
  107. default:
  108. ret_write = RET_CMDINVALID;
  109. break;
  110. };
  111. if((ret_write&RET_ERROR_MASK) > 0){
  112. if((ret_write&RET_DATAINVALID) > 0){
  113. txbuf[1] |= 0x80;
  114. txbuf[tx_len++] = INVALID_DATA;
  115. }else if((ret_write&RET_CMDINVALID) > 0){
  116. txbuf[1] |= 0x80;
  117. txbuf[tx_len++] = INVALID_COMMAND;
  118. }
  119. }else{
  120. //copy the whole rx frame
  121. memcpy(txbuf, (void *)rxbuf, rx_len-2);
  122. tx_len =rx_len-2;
  123. }
  124. crc = crc16(txbuf, tx_len);
  125. txbuf[tx_len++] = (uint8_t)((crc>>8) & 0x00ff);
  126. txbuf[tx_len++] = (uint8_t)(crc & 0x00ff);
  127. uart0_TransmitData(txbuf, tx_len);
  128. if((ret_write&RET_NEED_SAVE) > 0 ){
  129. SaveConfig();
  130. }
  131. if((ret_write&RET_NEED_REBOOT) > 0 ){
  132. NVIC_SystemReset();
  133. }
  134. }else{
  135. //function code no exist
  136. txbuf[1] |= 0x80;
  137. txbuf[tx_len++] = INVALID_FUNCTION_CODE;
  138. crc = crc16(txbuf, tx_len);
  139. txbuf[tx_len++] = (uint8_t)((crc>>8) & 0x00ff);
  140. txbuf[tx_len++] = (uint8_t)(crc & 0x00ff);
  141. uart0_TransmitData(txbuf, tx_len);
  142. }
  143. }
  144. #else
  145. memcpy(txbuf, (void *)rxbuf, rx_len);
  146. tx_len +=rx_len;
  147. uart0_TransmitData(txbuf, tx_len);
  148. #endif
  149. }
  150. } //END rx_len
  151. if(rx_len > 0){
  152. uart0_RecvData();
  153. }
  154. //处理 485 收发状态
  155. if(uart0_info.dmasend_count >= UART_DMASEND_COUNT_RESET){
  156. uart0_info.dmasend_count = 0;
  157. RS485_RX_EN;
  158. }
  159. }
  160. /**
  161. * Task_Init
  162. *
  163. * @return none
  164. *
  165. * @brief 初始化
  166. */
  167. void Task_Init(void)
  168. {
  169. uart_Initialize();
  170. }
  171. /**
  172. * Task_Handle
  173. *
  174. * @return none
  175. *
  176. * @brief 主任务处理函数
  177. */
  178. void Task_Handle(void)
  179. {
  180. Process_RunLedPrd();
  181. Process_ThreeStatus();
  182. Uart0_RxDataHandle();
  183. }