upload.c 12 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452
  1. #include "upload.h"
  2. #include "user_uart.h"
  3. #include "user_crc16.h"
  4. #include "base64.h"
  5. #include "string.h"
  6. #include "user_check.h"
  7. modbus_work_s upload_work = {
  8. .rtu_addr = DEV_UART_ADDR,
  9. .tx_size = 0,
  10. .rx_size = 0,
  11. .tx_buffer = {0},
  12. .rx_buffer = {0},
  13. .rtu_rec = {0},
  14. .modbusRx_stat = false,
  15. .modbusTx_stat = false,
  16. };
  17. static coll_data_s coll_data = {
  18. .coll_stat = COLL_NOT_READY_STAT,
  19. .count = 1,
  20. .download_sw_stat = 0,
  21. .sw_stat = false,
  22. };
  23. static uint32_t upload_offline_timeout = 0;
  24. static bool upload_offline_stat = true;
  25. static void set_upload_offline(bool stat);
  26. /*******************************************************************************
  27. * @函数名称 uploadRx_receive
  28. * @函数说明 处理接收数据
  29. * @输入参数 data:数据指针
  30. size:数据长度
  31. * @输出参数 无
  32. * @返回参数 无
  33. *******************************************************************************/
  34. static void uploadRx_receive(uint8_t *data, uint16_t size)
  35. {
  36. memcpy(upload_work.rx_buffer, data, size);
  37. upload_work.rx_size = size;
  38. #if USE_BASE64 == 1
  39. uint8_t data[MODBUS_DATA_SIZE] = {0};
  40. if(upload_work.rx_buffer[upload_work.rx_size - 2] == '\r'
  41. && upload_work.rx_buffer[upload_work.rx_size - 1] == '\n')
  42. {
  43. upload_work.rx_buffer[upload_work.rx_size - 2] = '\0';
  44. int len = base64_decode((char *)upload_work.rx_buffer, data);
  45. memcpy((void *)&(upload_work.rtu_rec), data, len);
  46. memcpy((void *)&(upload_work.rtu_rec.crc), &(data[len - 2]), 2);
  47. upload_work.rtu_rec.dataSize = len - 6;
  48. upload_work.modbusRx_stat = true;
  49. }
  50. #else
  51. memcpy((void *)&(upload_work.rtu_rec), upload_work.rx_buffer, upload_work.rx_size);
  52. memcpy((void *)&(upload_work.rtu_rec.crc), &(upload_work.rx_buffer[upload_work.rx_size - 2]), 2);
  53. upload_work.rtu_rec.dataSize = upload_work.rx_size - 6;
  54. upload_work.modbusRx_stat = true;
  55. #endif
  56. }
  57. /*******************************************************************************
  58. * @函数名称 uploadTx_send
  59. * @函数说明 发送数据
  60. * @输入参数 无
  61. * @输出参数 无
  62. * @返回参数 无
  63. *******************************************************************************/
  64. static void uploadTx_send(uint8_t *data, int size)
  65. {
  66. #if USE_BASE64 == 1
  67. base64_encode(data, (char *)upload_work.tx_buffer, size);
  68. int len = strlen((char *)upload_work.tx_buffer);
  69. upload_work.tx_buffer[len] = '\r';
  70. upload_work.tx_buffer[len + 1] = '\n';
  71. upload_work.tx_buffer[len + 2] = '\0';
  72. upload_work.tx_size = len + 2;
  73. #else
  74. memcpy(upload_work.tx_buffer, data, size);
  75. upload_work.tx_size = size;
  76. #endif
  77. upload_work.modbusTx_stat = true;
  78. vUser_usart1_send(upload_work.tx_buffer, upload_work.tx_size);
  79. }
  80. /*******************************************************************************
  81. * @函数名称 set_sw_stat
  82. * @函数说明 设置开关量状态
  83. * @输入参数 stat:开关量状态
  84. * @输出参数 无
  85. * @返回参数 无
  86. *******************************************************************************/
  87. void set_download_sw_stat(uint32_t stat)
  88. {
  89. coll_data.download_sw_stat = stat;
  90. }
  91. /*******************************************************************************
  92. * @函数名称 set_coll_stat
  93. * @函数说明 设置就绪状态
  94. * @输入参数 count:下挂主板个数
  95. * @输出参数 无
  96. * @返回参数 无
  97. *******************************************************************************/
  98. void set_coll_stat(uint16_t count)
  99. {
  100. coll_data.coll_stat = COLL_READY_STAT;
  101. coll_data.count = count + 1;
  102. }
  103. /*******************************************************************************
  104. * @函数名称 rtu_protocol_rd_dev_type
  105. * @函数说明 设置设备类型数据
  106. * @输入参数 data:数据指针
  107. * @输出参数 无
  108. * @返回参数 无
  109. *******************************************************************************/
  110. static uint8_t * rtu_protocol_rd_dev_type(uint8_t *data)
  111. {
  112. *data++ = 0x00;
  113. *data++ = DEV_UART_ADDR;
  114. return data;
  115. }
  116. /*******************************************************************************
  117. * @函数名称 rtu_protocol_rd_version
  118. * @函数说明 设置版本号数据
  119. * @输入参数 data:数据指针
  120. * @输出参数 无
  121. * @返回参数 无
  122. *******************************************************************************/
  123. static uint8_t * rtu_protocol_rd_version(uint8_t *data)
  124. {
  125. *data++ = HARDWARE_VERSION;
  126. *data++ = SOFTWARE_VERSION;
  127. return data;
  128. }
  129. /*******************************************************************************
  130. * @函数名称 rtu_protocol_coll_stat
  131. * @函数说明 设置主板状态数据
  132. * @输入参数 data:数据指针
  133. * @输出参数 无
  134. * @返回参数 无
  135. *******************************************************************************/
  136. static uint8_t * rtu_protocol_coll_stat(uint8_t *data)
  137. {
  138. *data++ = coll_data.coll_stat >> 8;
  139. *data++ = coll_data.coll_stat;
  140. return data;
  141. }
  142. /*******************************************************************************
  143. * @函数名称 rtu_protocol_coll_count
  144. * @函数说明 设置包含的主板数
  145. * @输入参数 data:数据指针
  146. * @输出参数 无
  147. * @返回参数 无
  148. *******************************************************************************/
  149. static uint8_t * rtu_protocol_coll_count(uint8_t *data)
  150. {
  151. *data++ = coll_data.count >> 8;
  152. *data++ = coll_data.count;
  153. return data;
  154. }
  155. /*******************************************************************************
  156. * @函数名称 rtu_protocol_sw_low_stat
  157. * @函数说明 设置采集到的所有开关量
  158. * @输入参数 data:数据指针
  159. * @输出参数 无
  160. * @返回参数 无
  161. *******************************************************************************/
  162. static uint8_t * rtu_protocol_sw_low_stat(uint8_t *data)
  163. {
  164. uint32_t value = 0;
  165. memcpy((void *)&value, (void *)&(coll_data.download_sw_stat), 4);
  166. value <<= 2;
  167. if(coll_data.sw_stat == true)
  168. {
  169. value += 0x01;
  170. }
  171. *data++ = (uint8_t)(value >> 8);
  172. *data++ = (uint8_t)value;
  173. return data;
  174. }
  175. /*******************************************************************************
  176. * @函数名称 rtu_protocol_sw_low_stat
  177. * @函数说明 设置采集到的所有开关量
  178. * @输入参数 data:数据指针
  179. * @输出参数 无
  180. * @返回参数 无
  181. *******************************************************************************/
  182. static uint8_t * rtu_protocol_sw_high_stat(uint8_t *data)
  183. {
  184. uint32_t value = 0;
  185. memcpy((void *)&value, (void *)&(coll_data.download_sw_stat), 4);
  186. value = value & ~(0x03 << ((coll_data.count - 1) * 2));
  187. if(coll_data.sw_stat == true)
  188. {
  189. value = value | (1 << ((coll_data.count - 1) * 2));
  190. }
  191. *data++ = (uint8_t)(value >> 24);
  192. *data++ = (uint8_t)(value >> 16);
  193. return data;
  194. }
  195. /*******************************************************************************
  196. * @函数名称 rtu_protocol_send
  197. * @函数说明 发送数据
  198. * @输入参数 data:数据指针
  199. size:数据长度
  200. * @输出参数 无
  201. * @返回参数 无
  202. *******************************************************************************/
  203. static void rtu_protocol_send(uint8_t *data, int size)
  204. {
  205. uint16_t crc = 0xFFFF;
  206. crc = GetCRC16(data, size, crc);
  207. memcpy(&data[size], &crc, 2);
  208. uploadTx_send(data, size + 2);
  209. }
  210. /*******************************************************************************
  211. * @函数名称 rtu_protocol_rd_reg_parsing
  212. * @函数说明 解析接收到的上位机数据
  213. * @输入参数 rec:数据
  214. * @输出参数 无
  215. * @返回参数 无
  216. *******************************************************************************/
  217. static bool rtu_protocol_rd_reg_parsing(rtu_rec_s *rec)
  218. {
  219. uint8_t data[MODBUS_DATA_SIZE] = {0};
  220. uint16_t dataSize = 0;
  221. data[0] = upload_work.rtu_addr;
  222. data[1] = CMD_RD_REG;
  223. dataSize = rec->data[0];
  224. dataSize <<= 8;
  225. dataSize += rec->data[1];
  226. data[2] = dataSize * 2;
  227. uint16_t reg_addr = 0;
  228. reg_addr = rec->regAddr[0];
  229. reg_addr <<= 8;
  230. reg_addr += rec->regAddr[1];
  231. uint8_t *ptr = &data[3];
  232. switch(reg_addr)
  233. {
  234. case REG_DEV_TYPE_ADDR: ptr = rtu_protocol_rd_dev_type(ptr);
  235. case 0x0001: ptr += 4;
  236. case REG_VERSION_ADDR:ptr = rtu_protocol_rd_version(ptr);
  237. case 0x0004: ptr += 24;
  238. case REG_COLL_STAT_ADDR: ptr = rtu_protocol_coll_stat(ptr);
  239. case REG_COLL_COUNT_ADDR: ptr = rtu_protocol_coll_count(ptr);
  240. case REG_COLL_SW_HIGH_STAT_ADDR: ptr = rtu_protocol_sw_high_stat(ptr);
  241. case REG_COLL_SW_LOW_STAT_ADDR: ptr = rtu_protocol_sw_low_stat(ptr);
  242. default:break;
  243. }
  244. rtu_protocol_send(data, dataSize * 2 + 3);
  245. return true;
  246. }
  247. /*******************************************************************************
  248. * @函数名称 rtu_protocol_wr_reg_return
  249. * @函数说明 写入数据成功返回
  250. * @输入参数 rec:数据
  251. * @输出参数 无
  252. * @返回参数 无
  253. *******************************************************************************/
  254. static void rtu_protocol_wr_reg_return(rtu_rec_s *rec)
  255. {
  256. uint8_t data[MODBUS_DATA_SIZE] = {0};
  257. data[0] = rec->addr;
  258. data[1] = rec->func;
  259. data[2] = rec->regAddr[0];
  260. data[3] = rec->regAddr[1];
  261. memcpy(&data[4], rec->data, rec->dataSize);
  262. memcpy(&data[rec->dataSize + 4], (uint8_t *)&(rec->crc), 2);
  263. uploadTx_send(data, rec->dataSize + 6);
  264. }
  265. /*******************************************************************************
  266. * @函数名称 rtu_protocol_wr_reg_parsing
  267. * @函数说明 写指令数据解析
  268. * @输入参数 rec:数据
  269. * @输出参数 无
  270. * @返回参数 无
  271. *******************************************************************************/
  272. static bool rtu_protocol_wr_reg_parsing(rtu_rec_s *rec)
  273. {
  274. uint16_t reg_addr = 0;
  275. reg_addr = rec->regAddr[0];
  276. reg_addr <<= 8;
  277. reg_addr += rec->regAddr[1];
  278. switch(reg_addr)
  279. {
  280. default:break;
  281. }
  282. return false;
  283. }
  284. static bool rtu_protocol_parsing(rtu_rec_s *rec)
  285. {
  286. uint16_t crc = 0xFFFF;
  287. crc = GetCRC16((uint8_t *)rec, rec->dataSize + 4, crc);
  288. if(crc != rec->crc)
  289. {
  290. return false;
  291. }
  292. if(rec->addr != upload_work.rtu_addr)
  293. {
  294. return false;
  295. }
  296. if(rec->func == CMD_RD_REG)
  297. {
  298. if(true == rtu_protocol_rd_reg_parsing(rec))
  299. {
  300. set_upload_offline(false);
  301. return true;
  302. }
  303. }
  304. else if(rec->func == CMD_WR_REG)
  305. {
  306. if(true == rtu_protocol_wr_reg_parsing(rec))
  307. {
  308. set_upload_offline(false);
  309. return true;
  310. }
  311. }
  312. else if(rec->func == CMD_WR_MULTI_REG)
  313. {
  314. return false;
  315. }
  316. return false;
  317. }
  318. static void set_upload_offline(bool stat)
  319. {
  320. if(stat == true)
  321. {
  322. upload_offline_timeout = 5000;
  323. if(upload_offline_stat == false)
  324. {
  325. upload_offline_stat = true;
  326. }
  327. }
  328. else{
  329. if(upload_offline_stat == true)
  330. {
  331. upload_offline_stat = false;
  332. }
  333. }
  334. }
  335. /*******************************************************************************
  336. * @函数名称 prvUser_check_upload_callback
  337. * @函数说明 光敏状态上报回调
  338. * @输入参数 无
  339. * @输出参数 无
  340. * @返回参数 无
  341. *******************************************************************************/
  342. static void prvUser_check_upload_callback(bool stat)
  343. {
  344. coll_data.sw_stat = stat;
  345. }
  346. /*******************************************************************************
  347. * @函数名称 vUpload_tick
  348. * @函数说明 任务计时器
  349. * @输入参数 无
  350. * @输出参数 无
  351. * @返回参数 无
  352. *******************************************************************************/
  353. void vUpload_tick(void)
  354. {
  355. if(upload_offline_timeout > 0)
  356. {
  357. upload_offline_timeout--;
  358. }
  359. else{
  360. set_upload_offline(true);
  361. }
  362. }
  363. /*******************************************************************************
  364. * @函数名称 upload_pro
  365. * @函数说明 任务
  366. * @输入参数 无
  367. * @输出参数 无
  368. * @返回参数 无
  369. *******************************************************************************/
  370. void vUpload_pro(void)
  371. {
  372. if(upload_work.modbusRx_stat == true)
  373. {
  374. upload_work.modbusRx_stat = false;
  375. rtu_protocol_parsing(&(upload_work.rtu_rec));
  376. }
  377. }
  378. /*******************************************************************************
  379. * @函数名称 vUpload_init
  380. * @函数说明 初始化
  381. * @输入参数 无
  382. * @输出参数 无
  383. * @返回参数 无
  384. *******************************************************************************/
  385. void vUpload_init(void)
  386. {
  387. user_uart_param_s param = {
  388. .baudrate = 115200,
  389. .wordlength = USART_WordLength_8b,
  390. .stopbit = USART_StopBits_1,
  391. .parity = USART_Parity_No,
  392. };
  393. vUser_usart1_init(&param);
  394. vUser_check_set_upload_func(prvUser_check_upload_callback);
  395. vUser_usart1_set_data_upload_func(uploadRx_receive);
  396. }