main_task.c 6.0 KB

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