sample_mb_master.c 9.8 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232
  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. #ifdef PKG_MODBUS_MASTER_SAMPLE
  15. #define SLAVE_ADDR MB_SAMPLE_TEST_SLAVE_ADDR
  16. #define PORT_NUM MB_MASTER_USING_PORT_NUM
  17. #define PORT_BAUDRATE MB_MASTER_USING_PORT_BAUDRATE
  18. #else
  19. #define SLAVE_ADDR 0x01
  20. #define PORT_NUM 5
  21. #define PORT_BAUDRATE 9600
  22. #endif
  23. #define PORT_PARITY MB_PAR_NONE
  24. #define MB_POLL_THREAD_PRIORITY 30
  25. #define MB_SEND_THREAD_PRIORITY 31
  26. //#define MB_SEND_REG_START 1034
  27. #define MB_SEND_REG_START 0
  28. #define MB_SEND_REG_NUM 10
  29. #define MB_POLL_CYCLE_MS 500
  30. /* 线程栈:原为 512 字节,实测最坏调用链(Modbus 请求/应答 + rt_kprintf/rt_sprintf)
  31. * 已接近该值,且历史上曾因栈不足触发溢出(破坏相邻堆对象 → HardFault)。
  32. * 这里增大到 1024 字节留出余量。 */
  33. #define MB_THREAD_STACK_SIZE 1024
  34. rt_thread_t tid1 = RT_NULL, tid2 = RT_NULL;
  35. Device_Status_typedef device_status;
  36. extern USHORT usMRegInBuf[MB_MASTER_TOTAL_SLAVE_NUM][M_REG_INPUT_NREGS];
  37. extern SHORT usMRegHoldBuf[MB_MASTER_TOTAL_SLAVE_NUM][M_REG_HOLDING_NREGS];
  38. int delete_mb_thread(void)
  39. {
  40. int32_t try_cnt;
  41. /* 安全删除:若线程恰好挂在 IPC 等待链表上则稍后重试,
  42. * 避免 rt_thread_delete 造成 IPC 等待链表野指针(见 control.c 说明) */
  43. for (try_cnt = 0; try_cnt < 30; try_cnt++)
  44. {
  45. if (thread_delete_safe(&tid1) == 0 && thread_delete_safe(&tid2) == 0)
  46. {
  47. break;
  48. }
  49. rt_thread_mdelay(50);
  50. }
  51. return 0;
  52. }
  53. static void send_thread_entry(void *parameter)
  54. {
  55. BOOL IN_3A = 0; //数据解析方式设置
  56. eMBMasterReqErrCode error_code = MB_MRE_NO_ERR;
  57. rt_uint16_t error_count = 0;
  58. //USHORT data[3] = {0};
  59. while (1)
  60. {
  61. /* Test Modbus Master */
  62. // data[0] = (USHORT)(rt_tick_get() / 10);
  63. // data[1] = (USHORT)(rt_tick_get() % 10);
  64. // data[3] = data[1] + 1;
  65. // error_code = eMBMasterReqWriteMultipleHoldingRegister(SLAVE_ADDR, /* salve address */
  66. // MB_SEND_REG_START, /* register start address */
  67. // MB_SEND_REG_NUM, /* register total number */
  68. // data, /* data to be written */
  69. // RT_WAITING_FOREVER); /* timeout */
  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_sprintf(device_status.voltage_sun,"%d.%d",usMRegInBuf[0][0]/100,usMRegInBuf[0][0]%100/10);
  86. //太阳能板电压
  87. HMI_WRITE("menu.g0.txt=\"太阳能板电压:%sV\"",device_status.voltage_sun);
  88. }else{
  89. rt_sprintf(device_status.voltage_sun,"%s","0.0");
  90. }
  91. #endif
  92. if(device_status.sensor_485_sta!=200){
  93. error_code = eMBMasterReqReadHoldingRegister(SLAVE_ADDR, MB_SEND_REG_START,10,1000);//读多个保持寄存器
  94. rt_kprintf("eMBMasterReqReadHoldingRegister: %d \n",error_code);//一直出错,我便把错误返回值打印出来
  95. if(error_code==0)
  96. {
  97. device_status.sensor_485_sta = 1;
  98. error_count = 0;
  99. //温度=25并且湿度=30不更新,否则会导致屏幕上显示空
  100. // if((int)usMRegHoldBuf[0][0]/10!=25&&(int)usMRegHoldBuf[0][1]/10!=30)
  101. // {
  102. // rt_sprintf(device_status.tempture,"%d.%d",(int)usMRegHoldBuf[0][0]/10, (uint)usMRegHoldBuf[0][0] % 10);
  103. // rt_sprintf(device_status.humidity,"%d.%d",(int)usMRegHoldBuf[0][1]/10, (uint)usMRegHoldBuf[0][1] % 10);
  104. // rt_sprintf(device_status.lux,"%d",((int)usMRegHoldBuf[0][2]*10+(int)usMRegHoldBuf[0][3]));
  105. // rt_kprintf("照度:%s Lux\n",device_status.lux);
  106. #if 0
  107. rt_kprintf("usMRegHoldBuf[0]:%d\n",(int)usMRegHoldBuf[0][0]);
  108. rt_kprintf("usMRegHoldBuf[1]:%d\n",(int)usMRegHoldBuf[0][1]);
  109. rt_kprintf("usMRegHoldBuf[2]:%d\n",(int)usMRegHoldBuf[0][2]);
  110. rt_kprintf("usMRegHoldBuf[3]:%d\n",(int)usMRegHoldBuf[0][3]);
  111. rt_kprintf("usMRegHoldBuf[4]:%d\n",(int)usMRegHoldBuf[0][4]);
  112. rt_kprintf("usMRegHoldBuf[5]:%d\n",(int)usMRegHoldBuf[0][5]);
  113. rt_kprintf("usMRegHoldBuf[6]:%d\n",(int)usMRegHoldBuf[0][6]);
  114. rt_sprintf(device_status.tempture,"%d.%d",(int)usMRegHoldBuf[0][2]/10, (uint)usMRegHoldBuf[0][2] % 10);
  115. rt_sprintf(device_status.humidity,"%d.%d",(int)usMRegHoldBuf[0][3]/10, (uint)usMRegHoldBuf[0][3] % 10);
  116. rt_sprintf(device_status.ap,"%d.%d",(int)usMRegHoldBuf[0][4]/10, (uint)usMRegHoldBuf[0][4] % 10); // 大气压
  117. rt_sprintf(device_status.lux,"%d",(int)usMRegHoldBuf[0][5]*10+(int)usMRegHoldBuf[0][6]); // 照度
  118. rt_kprintf("大气压:%s 照度:%s\n",device_status.ap,device_status.lux);//0代表从机ID=1
  119. #else
  120. rt_kprintf("usMRegHoldBuf[0]:%d\n",(int)usMRegHoldBuf[0][0]);
  121. rt_kprintf("usMRegHoldBuf[1]:%d\n",(int)usMRegHoldBuf[0][1]);
  122. rt_kprintf("usMRegHoldBuf[2]:%d\n",(int)usMRegHoldBuf[0][2]);
  123. rt_kprintf("usMRegHoldBuf[3]:%d\n",(int)usMRegHoldBuf[0][3]);
  124. rt_kprintf("usMRegHoldBuf[4]:%d\n",(int)usMRegHoldBuf[0][4]);
  125. rt_kprintf("usMRegHoldBuf[5]:%d\n",(int)usMRegHoldBuf[0][5]);
  126. rt_kprintf("usMRegHoldBuf[6]:%d\n",(int)usMRegHoldBuf[0][6]);
  127. /* 注意:本线程栈较小,禁止在此使用浮点 printf(%f/%0.01f):
  128. * newlib 浮点格式化链(_svfprintf_r+_dtoa_r+_Balloc+_calloc_r)约需 700+ 字节栈,
  129. * 会导致本线程栈溢出并破坏相邻堆对象(历史故障: 启动即 HardFault)。
  130. * 与其它字段保持一致,用整数格式化输出 wind_speed。 */
  131. rt_sprintf(device_status.wind_speed, "%d.%d",
  132. (int)usMRegHoldBuf[0][0]/100,
  133. (int)(usMRegHoldBuf[0][0]%100)/10);
  134. rt_sprintf(device_status.wind_dir,"%d",(int)usMRegHoldBuf[0][1]);
  135. rt_sprintf(device_status.tempture,"%d.%d",(int)usMRegHoldBuf[0][2]/10, (uint)usMRegHoldBuf[0][2] % 10);
  136. rt_sprintf(device_status.humidity,"%d.%d",(int)usMRegHoldBuf[0][3]/10, (uint)usMRegHoldBuf[0][3] % 10);
  137. rt_sprintf(device_status.ap,"%d.%d",(int)usMRegHoldBuf[0][4]/10, (uint)usMRegHoldBuf[0][4] % 10); // 大气压
  138. //滴感式雨量
  139. rt_sprintf(device_status.rain,"%d.%02d",(int)usMRegHoldBuf[0][5]/10, (uint)usMRegHoldBuf[0][5] % 10); // 雨量0.03mm/min
  140. rt_kprintf("风速:%s m/s 风向:%s ° \n",device_status.wind_speed,device_status.wind_dir); //风速:0.01m/s
  141. rt_kprintf("温度:%s 湿度:%s 雨量:%s mm/min\n",device_status.tempture,device_status.humidity,device_status.rain);
  142. rt_kprintf("雨量:%s mm/min\n",device_status.rain);
  143. #endif
  144. // sprintf(device_status.tempture,"%0.01f",(float)usMRegHoldBuf[0][0]/100);
  145. // sprintf(device_status.humidity,"%0.01f",(float)usMRegHoldBuf[0][1]/100);
  146. // }
  147. //rt_thread_delay(1000);
  148. }
  149. }
  150. rt_kprintf("slave data-tem:%s,hum:%s\n",device_status.tempture,device_status.humidity);//0代表从机ID=1
  151. rt_thread_delay(5000);
  152. /* Record the number of errors */
  153. if (error_code != 0)
  154. {
  155. error_count++;
  156. if(error_count == 10)
  157. {
  158. error_count = 0;
  159. device_status.sensor_485_sta = 0;
  160. rt_sprintf(device_status.lux,"NA");
  161. }
  162. }
  163. }
  164. }
  165. static void mb_master_poll(void *parameter)
  166. {
  167. eMBMasterInit(MB_RTU, PORT_NUM, PORT_BAUDRATE, PORT_PARITY);
  168. eMBMasterEnable();
  169. while (1)
  170. {
  171. eMBMasterPoll();
  172. rt_thread_mdelay(MB_POLL_CYCLE_MS);
  173. }
  174. }
  175. int mb_master_samlpe(void)
  176. {
  177. static rt_uint8_t is_init = 0;
  178. if (is_init > 0)
  179. {
  180. rt_kprintf("sample is running\n");
  181. return -RT_ERROR;
  182. }
  183. tid1 = rt_thread_create("md_m_poll", mb_master_poll, RT_NULL, MB_THREAD_STACK_SIZE, MB_POLL_THREAD_PRIORITY, 10);
  184. if (tid1 != RT_NULL)
  185. {
  186. rt_thread_startup(tid1);
  187. }
  188. else
  189. {
  190. goto __exit;
  191. }
  192. tid2 = rt_thread_create("md_m_send", send_thread_entry, RT_NULL, MB_THREAD_STACK_SIZE, MB_SEND_THREAD_PRIORITY, 10);
  193. if (tid2 != RT_NULL)
  194. {
  195. rt_thread_startup(tid2);
  196. }
  197. else
  198. {
  199. goto __exit;
  200. }
  201. is_init = 1;
  202. return RT_EOK;
  203. __exit:
  204. if (tid1)
  205. rt_thread_delete(tid1);
  206. if (tid2)
  207. rt_thread_delete(tid2);
  208. return -RT_ERROR;
  209. }
  210. MSH_CMD_EXPORT(mb_master_samlpe, run a modbus master sample);