sample_mb_master.c 8.3 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213
  1. /*
  2. * Copyright (c) 2006-2018, RT-Thread Development Team
  3. *
  4. * SPDX-License-Identifier: Apache-2.0
  5. *
  6. * Change Logs:
  7. * Date Author Notes
  8. * 2019-06-21 flybreak first version
  9. */
  10. #include <rtthread.h>
  11. #include <user_mb_app.h>
  12. #include "control.h"
  13. #include "hmi.h"
  14. /* ★ 引入 rtdbg.h 才能用 LOG_x。原来本文件只有 rt_kprintf,
  15. P2-12 把每 5s 刷屏的两行降级成 LOG_D。 */
  16. #define DBG_ENABLE
  17. #define DBG_COLOR
  18. #define DBG_TAG "mbmst"
  19. #define DBG_LVL DBG_LOG
  20. #include <rtdbg.h> //must after of DBG_LVL, DBG_TAG or other options
  21. #ifdef PKG_MODBUS_MASTER_SAMPLE
  22. #define SLAVE_ADDR MB_SAMPLE_TEST_SLAVE_ADDR
  23. #define PORT_NUM MB_MASTER_USING_PORT_NUM
  24. #define PORT_BAUDRATE MB_MASTER_USING_PORT_BAUDRATE
  25. #else
  26. #define SLAVE_ADDR 0x01
  27. #define PORT_NUM 5
  28. #define PORT_BAUDRATE 9600
  29. #endif
  30. #define PORT_PARITY MB_PAR_NONE
  31. #define MB_POLL_THREAD_PRIORITY 30
  32. #define MB_SEND_THREAD_PRIORITY 31
  33. //#define MB_SEND_REG_START 1034
  34. #define MB_SEND_REG_START 0
  35. #define MB_SEND_REG_NUM 10
  36. #define MB_POLL_CYCLE_MS 500
  37. /* device_status 已收敛为全工程唯一定义(在 main.c), 此处不再重复定义, 见 control.h 的 extern 声明 */
  38. extern USHORT usMRegInBuf[MB_MASTER_TOTAL_SLAVE_NUM][M_REG_INPUT_NREGS];
  39. extern SHORT usMRegHoldBuf[MB_MASTER_TOTAL_SLAVE_NUM][M_REG_HOLDING_NREGS];
  40. extern eMBMasterReqErrCode _485_play(USHORT *Buffer,USHORT NREGS)
  41. {
  42. UCHAR SLAVE_ADDRESS = 0x10;
  43. USHORT REGISTER_ADDRESS = 0x9c41;
  44. eMBMasterReqErrCode _code_ret = eMBMasterReqWriteMultipleHoldingRegister(SLAVE_ADDRESS, /* salve address */
  45. REGISTER_ADDRESS, /* register start address */
  46. NREGS, /* register total number */
  47. Buffer, /* data to be written */
  48. /* ★ 原来用 RT_WAITING_FOREVER: 485 从机掉线/接线松动/地址不符
  49. (现场最常见的故障)时, 主站会无限等待应答,
  50. 调用线程永久挂起 -> 485 采集流程卡死, 温湿度不再更新。
  51. 改成有限超时, 由调用方按错误计数重试/降级。 */
  52. 3000); /* timeout (tick) */
  53. return _code_ret;
  54. }
  55. extern eMBMasterReqErrCode write_single_holding_register(UCHAR ucSndAddr, USHORT usRegAddr, USHORT usRegData, LONG lTimeOut)
  56. {
  57. eMBMasterReqErrCode _code_ret = eMBMasterReqWriteHoldingRegister(ucSndAddr,
  58. usRegAddr,
  59. usRegData,
  60. lTimeOut );
  61. return _code_ret;
  62. }
  63. static void send_thread_entry(void *parameter)
  64. {
  65. BOOL IN_3A = 0; //数据解析方式设置
  66. eMBMasterReqErrCode error_code = MB_MRE_NO_ERR;
  67. rt_uint16_t error_count = 0;
  68. while (1)
  69. {
  70. #if 0
  71. error_code = eMBMasterReqReadInputRegister(SLAVE_ADDR, MB_SEND_REG_START,3,1000);
  72. rt_kprintf("eMBMasterReqReadInputRegister: %d \n",error_code);//一直出错,把错误返回值打印出来
  73. if(error_code==0)
  74. {
  75. if(IN_3A==0){
  76. error_code = eMBMasterReqWriteHoldingRegister(0,0x3A,1,1000);
  77. IN_3A = 1;
  78. rt_kprintf("数据解析方式设置:%d\n",error_code);
  79. }
  80. device_status.sensor_485_sta = 200;
  81. error_count = 0;
  82. for(int i=0;i<3;i++){
  83. rt_kprintf("usMRegInBuf:%d-%u\n",i,usMRegInBuf[0][i]);
  84. }
  85. rt_snprintf(device_status.voltage_sun, sizeof(device_status.voltage_sun),
  86. "%d.%d",(int)(usMRegInBuf[0][0]/100),(int)(usMRegInBuf[0][0]%100/10));
  87. //太阳能板电压
  88. HMI_WRITE("menu.g0.txt=\"太阳能板电压:%sV\"",device_status.voltage_sun);
  89. }else{
  90. rt_snprintf(device_status.voltage_sun, sizeof(device_status.voltage_sun), "%s", "0.0");
  91. }
  92. #endif
  93. if(device_status.sensor_485_sta!=200){
  94. error_code = eMBMasterReqReadHoldingRegister(SLAVE_ADDR, MB_SEND_REG_START,2,1000);//读多个保持寄存器
  95. // 发送写多个保持寄存器请求
  96. //error_code = eMBMasterReqWriteMultipleHoldingRegister(SLAVE_ADDRESS,REGISTER_ADDRESS,REGISTER_COUNT,usDataBuffer,1000);
  97. rt_kprintf("eMBMasterReqReadHoldingRegister: %d \n",error_code);//一直出错,我便把错误返回值打印出来
  98. if(error_code==0)
  99. {
  100. device_status.sensor_485_sta = 100;
  101. error_count = 0;
  102. //温度=25并且湿度=30不更新,否则会导致屏幕上显示空
  103. // if((int)usMRegHoldBuf[0][0]/10!=25&&(int)usMRegHoldBuf[0][1]/10!=30)
  104. // {
  105. /* ★ P2-12: 改 rt_snprintf 限长(原来 tempture/humidity 是 rt_sprintf,
  106. 从机寄存器值不受控;虽然两个数组现在都有 12 字节,但仍走 sizeof 兜底)。
  107. 另外"拼好再一次性写入"避免读到半新半旧的串。 */
  108. {
  109. char tbuf[12], hbuf[12];
  110. rt_snprintf(tbuf, sizeof(tbuf), "%d.%d",
  111. (int)usMRegHoldBuf[0][0]/100, (int)(usMRegHoldBuf[0][0] % 100));
  112. rt_snprintf(hbuf, sizeof(hbuf), "%d.%d",
  113. (int)usMRegHoldBuf[0][1]/100, (int)(usMRegHoldBuf[0][1] % 100));
  114. rt_snprintf(device_status.tempture, sizeof(device_status.tempture), "%s", tbuf);
  115. rt_snprintf(device_status.humidity, sizeof(device_status.humidity), "%s", hbuf);
  116. }
  117. // sprintf(device_status.tempture,"%0.01f",(float)usMRegHoldBuf[0][0]/100);
  118. // sprintf(device_status.humidity,"%0.01f",(float)usMRegHoldBuf[0][1]/100);
  119. // }
  120. //rt_thread_delay(1000);
  121. }
  122. }
  123. /* ★ P2-12: 原来每 5s 无条件 rt_kprintf 刷两行,占调试口带宽还拖慢接收。
  124. 降为 LOG_D(DBG_LVL 调到 DEBUG 才输出)。 */
  125. LOG_D("slave data-tem:%d,hum:%d",usMRegHoldBuf[0][0],usMRegHoldBuf[0][1]);
  126. LOG_D("slave data-tem:%s,hum:%s",device_status.tempture,device_status.humidity);
  127. rt_thread_delay(5000);
  128. /* Record the number of errors */
  129. if (error_code != 0)
  130. {
  131. error_count++;
  132. if(error_count == 10)
  133. {
  134. error_count = 0;
  135. device_status.sensor_485_sta = 0;
  136. }
  137. }
  138. }
  139. }
  140. static void mb_master_poll(void *parameter)
  141. {
  142. eMBMasterInit(MB_RTU, PORT_NUM, PORT_BAUDRATE, PORT_PARITY);
  143. eMBMasterEnable();
  144. while (1)
  145. {
  146. eMBMasterPoll();
  147. rt_thread_mdelay(MB_POLL_CYCLE_MS);
  148. }
  149. }
  150. int mb_master_samlpe(void)
  151. {
  152. USHORT qidong[] = {0xbfd8,0xd6c6,0xc4a3,0xbfe9,0xd2d1,0xc6f4,0xb6af};
  153. static rt_uint8_t is_init = 0;
  154. rt_thread_t tid1 = RT_NULL, tid2 = RT_NULL;
  155. if (is_init > 0)
  156. {
  157. rt_kprintf("sample is running\n");
  158. return -RT_ERROR;
  159. }
  160. /* ★ 栈 512 -> 1024: mb_master_poll 里跑 freemodbus 状态机 + 串口收发回调,
  161. 512 太紧(栈溢出不会有任何提示, 只有 hard fault / 数据停更)。 */
  162. tid1 = rt_thread_create("md_m_poll", mb_master_poll, RT_NULL, 1024, MB_POLL_THREAD_PRIORITY, 10);
  163. if (tid1 != RT_NULL)
  164. {
  165. rt_thread_startup(tid1);
  166. }
  167. else
  168. {
  169. goto __exit;
  170. }
  171. tid2 = rt_thread_create("md_m_send", send_thread_entry, RT_NULL, 1024, MB_SEND_THREAD_PRIORITY, 10);
  172. if (tid2 != RT_NULL)
  173. {
  174. rt_thread_startup(tid2);
  175. }
  176. else
  177. {
  178. goto __exit;
  179. }
  180. is_init = 1;
  181. rt_thread_delay(10000);
  182. _485_play(qidong,7);
  183. return RT_EOK;
  184. __exit:
  185. if (tid1)
  186. rt_thread_delete(tid1);
  187. if (tid2)
  188. rt_thread_delete(tid2);
  189. return -RT_ERROR;
  190. }
  191. MSH_CMD_EXPORT(mb_master_samlpe, run a modbus master sample);