modbus_rtu_s.c 4.1 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148
  1. #define LOG_TAG "modbus.s" // 该模块对应的标签。不定义时,默认:NO_TAG
  2. #define LOG_LVL LOG_LVL_ASSERT////LOG_LVL_DBG 该模块对应的日志输出级别。不定义时,默认:调试级别
  3. #include <ulog.h> // 必须在 LOG_TAG 与 LOG_LVL 下面
  4. #include <rtthread.h>
  5. #include <rtdevice.h>
  6. #include <../add_pkg/libmodbus/inc/modbus.h>
  7. #include "stdio.h"
  8. #include "string.h"
  9. #include "math.h"
  10. #include <easyflash.h>
  11. #include "sys_config.h"
  12. #include <board.h>
  13. #include "bsp_user_lib.h"
  14. #include "signal_led.h"
  15. //uint16_t rt_reg[16]= {0};
  16. //刷新显示寄存器数据
  17. void Sensor_Value_Reflash(uint16_t *rt_reg)
  18. {
  19. uint16_t i = 0;
  20. static uint16_t n = 0;
  21. n ++;
  22. for ( i = 0; i < qxz.Param.Num_sensors; i++ )
  23. {
  24. if( rt_strcmp( sensor[i].eName,"\0" ) != 0)/*传感器eName不能为空*/
  25. {
  26. if( rt_strstr(sensor[i].eValue,"-99.99" ) == NULL )
  27. {
  28. if( rt_strcmp( sensor[i].eName,"illuminance" ) == 0)//光照强度放大了10倍,特殊处理
  29. {
  30. rt_reg[i] = (sensor[i].value / 10);
  31. }
  32. else if(rt_strcmp( sensor[i].eName,"noxygen" ) == 0) //zx 负氧离子缩小10倍,特殊处理
  33. {
  34. rt_reg[i] = (sensor[i].value / 10);
  35. }
  36. else rt_reg[i] = sensor[i].value;
  37. }
  38. // else rt_reg[i] = 0x7FFF;//判断是否传感器未接或故障,如果是则赋值0xx7fff
  39. // else rt_reg[i] = n;
  40. // else
  41. // {
  42. // switch(i)
  43. // {
  44. // case 0: rt_reg[i] = 226; break;
  45. // case 1: rt_reg[i] = 203; break;
  46. // case 2: rt_reg[i] = 189; break;
  47. // case 3: rt_reg[i] = 176; break;
  48. // case 4: rt_reg[i] = 151; break;
  49. // case 5: rt_reg[i] = 226; break;
  50. // case 6: rt_reg[i] = 333; break;
  51. // case 7: rt_reg[i] = 289; break;
  52. // case 8: rt_reg[i] = 32; break;
  53. // case 9: rt_reg[i] = 65; break;
  54. // case 10: rt_reg[i] = 129; break;
  55. // case 11: rt_reg[i] = 62; break;
  56. // default: break;
  57. // }
  58. // }
  59. }
  60. }
  61. }
  62. extern led_t *SENSORLED;
  63. extern led_t *COMMLED;
  64. extern led_t *DOTLED;
  65. #define MODBUS_SERIAL_DEV "/dev/uart3"
  66. #define MODBUS_SERIAL_BANDRATE 9600
  67. #define MODBUS_SERIAL_ADDR 1
  68. #define RS485_RE GET_PIN(D, 1)
  69. #define reg_length 20
  70. static modbus_mapping_t *mb_mapping = NULL;
  71. modbus_t *rtu = RT_NULL;
  72. void modbus_rtu_init(void)
  73. {
  74. ef_get_env_blob("Dotled_Option", &qxz.Param.Dotled_Option, sizeof(qxz.Param.Dotled_Option), RT_NULL);
  75. rtu = modbus_new_rtu(MODBUS_SERIAL_DEV, MODBUS_SERIAL_BANDRATE, 'N', 8, 1);
  76. modbus_rtu_set_serial_mode(rtu, MODBUS_RTU_RS485);
  77. modbus_rtu_set_rts(rtu, RS485_RE, MODBUS_RTU_RTS_UP);
  78. modbus_set_slave(rtu, abs(qxz.Param.Dotled_Option));
  79. //modbus_set_slave(rtu, MODBUS_SERIAL_ADDR);
  80. modbus_connect(rtu);
  81. modbus_set_response_timeout(rtu, 0, 1000000);
  82. }
  83. static void rtu_thread(void *param)
  84. {
  85. int rc;
  86. uint8_t query[MODBUS_TCP_MAX_ADU_LENGTH];
  87. mb_mapping = modbus_mapping_new(MODBUS_MAX_READ_BITS, 0,
  88. MODBUS_MAX_READ_REGISTERS, 0);
  89. if (mb_mapping == NULL) {
  90. LOG_E("Failed to allocate the mapping: %s\n",modbus_strerror(errno));
  91. modbus_free(rtu);
  92. return ;
  93. }
  94. // mb_mapping->tab_registers[0] = 1;//数据缓存区
  95. // mb_mapping->tab_registers[1] = 2;
  96. // mb_mapping->tab_registers[2] = 3;
  97. // mb_mapping->tab_registers[3] = 4;
  98. // mb_mapping->tab_registers[4] = 5;
  99. // mb_mapping->tab_registers[5] = 6;
  100. Sensor_Value_Reflash(mb_mapping->tab_registers);
  101. while (1)
  102. {
  103. Sensor_Value_Reflash(mb_mapping->tab_registers);
  104. // uint8_t query[MODBUS_TCP_MAX_ADU_LENGTH];
  105. rc = modbus_receive(rtu, query);
  106. if ((rc > 0) && (query[0] == abs(qxz.Param.Dotled_Option))) {
  107. modbus_reply(rtu, query, rc, mb_mapping);
  108. }
  109. }
  110. }
  111. static int rtu_s_init(void)
  112. {
  113. #ifndef dot_mod
  114. if(qxz.Param.Dotled_Option < 0)//led点阵屏不使用则标配为RTU功能
  115. {
  116. #endif
  117. modbus_rtu_init();
  118. rt_pin_mode(RS485_RE, PIN_MODE_OUTPUT);
  119. rt_thread_t tid;
  120. tid = rt_thread_create("mod.s",
  121. rtu_thread, RT_NULL,
  122. 2048,
  123. 12, 10);
  124. if (tid != RT_NULL)
  125. rt_thread_startup(tid);
  126. return RT_EOK;
  127. #ifndef dot_mod
  128. }
  129. #endif
  130. }
  131. INIT_APP_EXPORT(rtu_s_init);