| 123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232 |
- /*
- * Copyright (c) 2006-2018, RT-Thread Development Team
- *
- * SPDX-License-Identifier: Apache-2.0
- *
- * Change Logs:
- * Date Author Notes
- * 2019-06-21 flybreak first version
- */
- #include <rtthread.h>
- #include <user_mb_app.h>
- #include "control.h"
- #include "hmi.h"
- #ifdef PKG_MODBUS_MASTER_SAMPLE
- #define SLAVE_ADDR MB_SAMPLE_TEST_SLAVE_ADDR
- #define PORT_NUM MB_MASTER_USING_PORT_NUM
- #define PORT_BAUDRATE MB_MASTER_USING_PORT_BAUDRATE
- #else
- #define SLAVE_ADDR 0x01
- #define PORT_NUM 5
- #define PORT_BAUDRATE 9600
- #endif
- #define PORT_PARITY MB_PAR_NONE
- #define MB_POLL_THREAD_PRIORITY 30
- #define MB_SEND_THREAD_PRIORITY 31
- //#define MB_SEND_REG_START 1034
- #define MB_SEND_REG_START 0
- #define MB_SEND_REG_NUM 10
- #define MB_POLL_CYCLE_MS 500
- /* 线程栈:原为 512 字节,实测最坏调用链(Modbus 请求/应答 + rt_kprintf/rt_sprintf)
- * 已接近该值,且历史上曾因栈不足触发溢出(破坏相邻堆对象 → HardFault)。
- * 这里增大到 1024 字节留出余量。 */
- #define MB_THREAD_STACK_SIZE 1024
- rt_thread_t tid1 = RT_NULL, tid2 = RT_NULL;
- Device_Status_typedef device_status;
- extern USHORT usMRegInBuf[MB_MASTER_TOTAL_SLAVE_NUM][M_REG_INPUT_NREGS];
- extern SHORT usMRegHoldBuf[MB_MASTER_TOTAL_SLAVE_NUM][M_REG_HOLDING_NREGS];
- int delete_mb_thread(void)
- {
- int32_t try_cnt;
- /* 安全删除:若线程恰好挂在 IPC 等待链表上则稍后重试,
- * 避免 rt_thread_delete 造成 IPC 等待链表野指针(见 control.c 说明) */
- for (try_cnt = 0; try_cnt < 30; try_cnt++)
- {
- if (thread_delete_safe(&tid1) == 0 && thread_delete_safe(&tid2) == 0)
- {
- break;
- }
- rt_thread_mdelay(50);
- }
- return 0;
- }
- static void send_thread_entry(void *parameter)
- {
- BOOL IN_3A = 0; //数据解析方式设置
- eMBMasterReqErrCode error_code = MB_MRE_NO_ERR;
- rt_uint16_t error_count = 0;
- //USHORT data[3] = {0};
- while (1)
- {
- /* Test Modbus Master */
- // data[0] = (USHORT)(rt_tick_get() / 10);
- // data[1] = (USHORT)(rt_tick_get() % 10);
- // data[3] = data[1] + 1;
- // error_code = eMBMasterReqWriteMultipleHoldingRegister(SLAVE_ADDR, /* salve address */
- // MB_SEND_REG_START, /* register start address */
- // MB_SEND_REG_NUM, /* register total number */
- // data, /* data to be written */
- // RT_WAITING_FOREVER); /* timeout */
- #if 0
- error_code = eMBMasterReqReadInputRegister(SLAVE_ADDR, MB_SEND_REG_START,3,1000);
- rt_kprintf("eMBMasterReqReadInputRegister: %d \n",error_code);//一直出错,把错误返回值打印出来
- if(error_code==0)
- {
- if(IN_3A==0){
- error_code = eMBMasterReqWriteHoldingRegister(0,0x3A,1,1000);
- IN_3A = 1;
- rt_kprintf("数据解析方式设置:%d\n",error_code);
- }
- device_status.sensor_485_sta = 200;
- error_count = 0;
- for(int i=0;i<3;i++){
- rt_kprintf("usMRegInBuf:%d-%u\n",i,usMRegInBuf[0][i]);
- }
- rt_sprintf(device_status.voltage_sun,"%d.%d",usMRegInBuf[0][0]/100,usMRegInBuf[0][0]%100/10);
- //太阳能板电压
- HMI_WRITE("menu.g0.txt=\"太阳能板电压:%sV\"",device_status.voltage_sun);
- }else{
- rt_sprintf(device_status.voltage_sun,"%s","0.0");
- }
- #endif
- if(device_status.sensor_485_sta!=200){
- error_code = eMBMasterReqReadHoldingRegister(SLAVE_ADDR, MB_SEND_REG_START,10,1000);//读多个保持寄存器
- rt_kprintf("eMBMasterReqReadHoldingRegister: %d \n",error_code);//一直出错,我便把错误返回值打印出来
- if(error_code==0)
- {
- device_status.sensor_485_sta = 1;
- error_count = 0;
- //温度=25并且湿度=30不更新,否则会导致屏幕上显示空
- // if((int)usMRegHoldBuf[0][0]/10!=25&&(int)usMRegHoldBuf[0][1]/10!=30)
- // {
- // rt_sprintf(device_status.tempture,"%d.%d",(int)usMRegHoldBuf[0][0]/10, (uint)usMRegHoldBuf[0][0] % 10);
- // rt_sprintf(device_status.humidity,"%d.%d",(int)usMRegHoldBuf[0][1]/10, (uint)usMRegHoldBuf[0][1] % 10);
- // rt_sprintf(device_status.lux,"%d",((int)usMRegHoldBuf[0][2]*10+(int)usMRegHoldBuf[0][3]));
- // rt_kprintf("照度:%s Lux\n",device_status.lux);
- #if 0
- rt_kprintf("usMRegHoldBuf[0]:%d\n",(int)usMRegHoldBuf[0][0]);
- rt_kprintf("usMRegHoldBuf[1]:%d\n",(int)usMRegHoldBuf[0][1]);
- rt_kprintf("usMRegHoldBuf[2]:%d\n",(int)usMRegHoldBuf[0][2]);
- rt_kprintf("usMRegHoldBuf[3]:%d\n",(int)usMRegHoldBuf[0][3]);
- rt_kprintf("usMRegHoldBuf[4]:%d\n",(int)usMRegHoldBuf[0][4]);
- rt_kprintf("usMRegHoldBuf[5]:%d\n",(int)usMRegHoldBuf[0][5]);
- rt_kprintf("usMRegHoldBuf[6]:%d\n",(int)usMRegHoldBuf[0][6]);
- rt_sprintf(device_status.tempture,"%d.%d",(int)usMRegHoldBuf[0][2]/10, (uint)usMRegHoldBuf[0][2] % 10);
- rt_sprintf(device_status.humidity,"%d.%d",(int)usMRegHoldBuf[0][3]/10, (uint)usMRegHoldBuf[0][3] % 10);
- rt_sprintf(device_status.ap,"%d.%d",(int)usMRegHoldBuf[0][4]/10, (uint)usMRegHoldBuf[0][4] % 10); // 大气压
- rt_sprintf(device_status.lux,"%d",(int)usMRegHoldBuf[0][5]*10+(int)usMRegHoldBuf[0][6]); // 照度
- rt_kprintf("大气压:%s 照度:%s\n",device_status.ap,device_status.lux);//0代表从机ID=1
- #else
- rt_kprintf("usMRegHoldBuf[0]:%d\n",(int)usMRegHoldBuf[0][0]);
- rt_kprintf("usMRegHoldBuf[1]:%d\n",(int)usMRegHoldBuf[0][1]);
- rt_kprintf("usMRegHoldBuf[2]:%d\n",(int)usMRegHoldBuf[0][2]);
- rt_kprintf("usMRegHoldBuf[3]:%d\n",(int)usMRegHoldBuf[0][3]);
- rt_kprintf("usMRegHoldBuf[4]:%d\n",(int)usMRegHoldBuf[0][4]);
- rt_kprintf("usMRegHoldBuf[5]:%d\n",(int)usMRegHoldBuf[0][5]);
- rt_kprintf("usMRegHoldBuf[6]:%d\n",(int)usMRegHoldBuf[0][6]);
- /* 注意:本线程栈较小,禁止在此使用浮点 printf(%f/%0.01f):
- * newlib 浮点格式化链(_svfprintf_r+_dtoa_r+_Balloc+_calloc_r)约需 700+ 字节栈,
- * 会导致本线程栈溢出并破坏相邻堆对象(历史故障: 启动即 HardFault)。
- * 与其它字段保持一致,用整数格式化输出 wind_speed。 */
- rt_sprintf(device_status.wind_speed, "%d.%d",
- (int)usMRegHoldBuf[0][0]/100,
- (int)(usMRegHoldBuf[0][0]%100)/10);
- rt_sprintf(device_status.wind_dir,"%d",(int)usMRegHoldBuf[0][1]);
- rt_sprintf(device_status.tempture,"%d.%d",(int)usMRegHoldBuf[0][2]/10, (uint)usMRegHoldBuf[0][2] % 10);
- rt_sprintf(device_status.humidity,"%d.%d",(int)usMRegHoldBuf[0][3]/10, (uint)usMRegHoldBuf[0][3] % 10);
- rt_sprintf(device_status.ap,"%d.%d",(int)usMRegHoldBuf[0][4]/10, (uint)usMRegHoldBuf[0][4] % 10); // 大气压
- //滴感式雨量
- rt_sprintf(device_status.rain,"%d.%02d",(int)usMRegHoldBuf[0][5]/10, (uint)usMRegHoldBuf[0][5] % 10); // 雨量0.03mm/min
- rt_kprintf("风速:%s m/s 风向:%s ° \n",device_status.wind_speed,device_status.wind_dir); //风速:0.01m/s
- rt_kprintf("温度:%s 湿度:%s 雨量:%s mm/min\n",device_status.tempture,device_status.humidity,device_status.rain);
- rt_kprintf("雨量:%s mm/min\n",device_status.rain);
- #endif
- // sprintf(device_status.tempture,"%0.01f",(float)usMRegHoldBuf[0][0]/100);
- // sprintf(device_status.humidity,"%0.01f",(float)usMRegHoldBuf[0][1]/100);
- // }
- //rt_thread_delay(1000);
- }
- }
- rt_kprintf("slave data-tem:%s,hum:%s\n",device_status.tempture,device_status.humidity);//0代表从机ID=1
- rt_thread_delay(5000);
- /* Record the number of errors */
- if (error_code != 0)
- {
- error_count++;
- if(error_count == 10)
- {
- error_count = 0;
- device_status.sensor_485_sta = 0;
- rt_sprintf(device_status.lux,"NA");
- }
- }
- }
- }
- static void mb_master_poll(void *parameter)
- {
- eMBMasterInit(MB_RTU, PORT_NUM, PORT_BAUDRATE, PORT_PARITY);
- eMBMasterEnable();
- while (1)
- {
- eMBMasterPoll();
- rt_thread_mdelay(MB_POLL_CYCLE_MS);
- }
- }
- int mb_master_samlpe(void)
- {
- static rt_uint8_t is_init = 0;
- if (is_init > 0)
- {
- rt_kprintf("sample is running\n");
- return -RT_ERROR;
- }
- tid1 = rt_thread_create("md_m_poll", mb_master_poll, RT_NULL, MB_THREAD_STACK_SIZE, MB_POLL_THREAD_PRIORITY, 10);
- if (tid1 != RT_NULL)
- {
- rt_thread_startup(tid1);
- }
- else
- {
- goto __exit;
- }
- tid2 = rt_thread_create("md_m_send", send_thread_entry, RT_NULL, MB_THREAD_STACK_SIZE, MB_SEND_THREAD_PRIORITY, 10);
- if (tid2 != RT_NULL)
- {
- rt_thread_startup(tid2);
- }
- else
- {
- goto __exit;
- }
- is_init = 1;
- return RT_EOK;
- __exit:
- if (tid1)
- rt_thread_delete(tid1);
- if (tid2)
- rt_thread_delete(tid2);
- return -RT_ERROR;
- }
- MSH_CMD_EXPORT(mb_master_samlpe, run a modbus master sample);
|