371 lines
9.2 KiB
C
371 lines
9.2 KiB
C
/*
|
||
* Copyright (c) 2006-2021, RT-Thread Development Team
|
||
*
|
||
* SPDX-License-Identifier: Apache-2.0
|
||
*
|
||
* Change Logs:
|
||
* Date Author Notes
|
||
* 2024-04-23 lijian the first version
|
||
*/
|
||
#include "modbus_rtu.h"
|
||
#include <board.h>
|
||
|
||
Modbus_RTU_t Modbus_RTU;
|
||
|
||
/**
|
||
* 设置modbus从机地址
|
||
* @param modbus_addr
|
||
*/
|
||
void set_Modbus_Addr(rt_uint16_t modbus_addr)
|
||
{
|
||
Modbus_RTU.modbus_addr = modbus_addr;
|
||
}
|
||
|
||
/**
|
||
* @brief 获取Modbus从机地址
|
||
* @return rt_uint16
|
||
*/
|
||
rt_uint16_t get_Modbus_Addr()
|
||
{
|
||
return Modbus_RTU.modbus_addr;
|
||
}
|
||
|
||
/**
|
||
* 设置modbus寄存器地址
|
||
* @param modbus_reg_addr
|
||
*/
|
||
void set_Modbus_Reg_Addr(rt_uint16_t modbus_reg_addr)
|
||
{
|
||
Modbus_RTU.modbus_reg_addr = modbus_reg_addr;
|
||
}
|
||
|
||
/**
|
||
* @brief 获取Modbus读取寄存器起始地址
|
||
* @return rt_uint16
|
||
*/
|
||
rt_uint16_t get_Modbus_Reg_Addr()
|
||
{
|
||
return Modbus_RTU.modbus_reg_addr;
|
||
}
|
||
|
||
/**
|
||
* @brief 设置Modbus读寄存器数量
|
||
* @return rt_uint16
|
||
*/
|
||
void set_Modbus_Reg_Num(rt_uint16_t modbus_reg_num)
|
||
{
|
||
Modbus_RTU.modbus_reg_num = modbus_reg_num;
|
||
}
|
||
|
||
/**
|
||
* @brief 获取Modbus读寄存器数量
|
||
* @return rt_uint16
|
||
*/
|
||
rt_uint16_t get_Modbus_Reg_Num()
|
||
{
|
||
return Modbus_RTU.modbus_reg_num;
|
||
}
|
||
|
||
|
||
|
||
//功能码01（0x01）: 读线圈状态（Read Coils）
|
||
//功能码02（0x02）: 读离散输入状态（Read Discrete Inputs）
|
||
//功能码03（0x03）: 读保持寄存器（Read Holding Registers）
|
||
//功能码04（0x04）: 读输入寄存器（Read Input Registers）
|
||
//功能码05（0x05）: 写单个线圈（Write Single Coil）
|
||
//功能码06（0x06）: 写单个保持寄存器（Write Single Holding Register）
|
||
//功能码15（0x0F）: 写多个线圈（Write Multiple Coils）
|
||
//功能码16（0x10）: 写多个保持寄存器（Write Multiple Holding Registers）
|
||
|
||
/**
|
||
* modbus初始化
|
||
*/
|
||
void Modbus_init()
|
||
{
|
||
|
||
// Modbus_RTU.modbus_addr = (rt_uint16_t)0x01;
|
||
// Modbus_RTU.modbus_reg_addr = (rt_uint16_t)0x00;
|
||
// Modbus_RTU.modbus_reg_num = (rt_uint16_t)0x02;
|
||
|
||
rs485_inst_t *hinst = rs485_create(RS485_SAMPLE_MASTER_SERIAL, RS485_SAMPLE_MASTER_BAUDRATE,
|
||
RS485_SAMPLE_MASTER_PARITY, RS485_SAMPLE_MASTER_PIN, RS485_SAMPLE_MASTER_LVL);
|
||
|
||
if (hinst == RT_NULL)
|
||
{
|
||
rt_kprintf("create rs485 instance fail.\n");
|
||
return;
|
||
}
|
||
|
||
rs485_set_recv_tmo(hinst, 1000);
|
||
if (rs485_connect(hinst) != RT_EOK)
|
||
{
|
||
rs485_destory(hinst);
|
||
rt_kprintf("rs485 connect fail.\n");
|
||
return;
|
||
}
|
||
|
||
rt_uint8_t ctx_send_buf[AGILE_MODBUS_MAX_ADU_LENGTH];
|
||
rt_uint8_t ctx_read_buf[AGILE_MODBUS_MAX_ADU_LENGTH];
|
||
|
||
|
||
agile_modbus_rtu_t ctx_rtu;
|
||
agile_modbus_t *ctx = &ctx_rtu._ctx;
|
||
agile_modbus_rtu_init(&ctx_rtu, ctx_send_buf, sizeof(ctx_send_buf), ctx_read_buf, sizeof(ctx_read_buf));
|
||
agile_modbus_set_slave(ctx, Modbus_RTU.modbus_addr); //地址
|
||
rt_kprintf("Modbus Running.\n");
|
||
|
||
|
||
rt_int8_t send_len;
|
||
rt_int8_t read_len;
|
||
rt_uint8_t i;
|
||
rt_int8_t rc;
|
||
|
||
//
|
||
|
||
|
||
while (1)
|
||
{
|
||
rt_thread_mdelay(1000);
|
||
|
||
|
||
//if(Modbus_RTU.modbus_func == 3){
|
||
send_len = agile_modbus_serialize_read_registers(ctx, Modbus_RTU.modbus_reg_addr, Modbus_RTU.modbus_reg_num);
|
||
//
|
||
// } else if(Modbus_RTU.modbus_func == 1){
|
||
// send_len = agile_modbus_serialize_read_bits(ctx, Modbus_RTU.modbus_reg_addr, Modbus_RTU.modbus_reg_num);
|
||
//
|
||
// }
|
||
|
||
// rt_kprintf("rs485 send %d datas : ", send_len);
|
||
// for (i = 0; i < send_len; i++) {
|
||
// rt_kprintf("%02X ", ctx->send_buf[i]);
|
||
// }
|
||
|
||
// rt_kprintf("\n");
|
||
|
||
read_len = rs485_send_then_recv(hinst, (void *) ctx->send_buf, send_len, ctx->read_buf, ctx->read_bufsz);
|
||
if (read_len < 0)
|
||
{
|
||
// rt_kprintf("rs485 send datas error.\n");
|
||
break;
|
||
}
|
||
|
||
if (read_len == 0)
|
||
{
|
||
// rt_kprintf("rs485 recv timeout.\n");
|
||
continue;
|
||
}
|
||
|
||
ctx->read_buf[read_len] = 0;
|
||
|
||
// Bsp_Rs485_Tx(ctx->send_buf, send_len); //
|
||
// int read_len = Bsp_Rs485_Rx(ctx->read_buf, ctx->read_bufsz); //
|
||
|
||
if (read_len == 0)
|
||
{
|
||
// rt_kprintf("Receive timeout.\n");
|
||
continue;
|
||
}
|
||
rc = agile_modbus_deserialize_read_registers(ctx, read_len, Modbus_RTU.hold_register);
|
||
if (rc < 0)
|
||
{
|
||
Modbus_RTU.modbus_rec = 0;
|
||
|
||
rt_kprintf("Receive failed.\n");
|
||
if (rc != -1)
|
||
rt_kprintf("Error code:%d\n", -128 - rc);
|
||
continue;
|
||
}
|
||
|
||
Modbus_RTU.modbus_rec = 1;
|
||
|
||
if (Modbus_RTU.log) {
|
||
rt_kprintf("Hold Registers:");
|
||
for (i = 0; i < 10; i++)
|
||
rt_kprintf("Register [%d]: 0x%04X\n", i, Modbus_RTU.hold_register[i]);
|
||
}
|
||
|
||
if (Modbus_RTU.modbus_rec) {
|
||
//get_modbus_rec();
|
||
// MQTT_Send_Modbus(get_modbus_rec());
|
||
}
|
||
rt_kprintf("\r\n\r\n\r\n");
|
||
}
|
||
|
||
}
|
||
|
||
void set_modbus_log(rt_uint8_t log){
|
||
Modbus_RTU.log = log;
|
||
}
|
||
|
||
/**
|
||
* 获取modbus读取数据的转换后返回值
|
||
* @return
|
||
*/
|
||
rt_uint16_t get_modbus_rec(){
|
||
if (Modbus_RTU.modbus_rec) {
|
||
|
||
rt_uint8_t high_d=0;
|
||
rt_uint8_t low_d=0;
|
||
|
||
if (Modbus_RTU.modbus_reg_num == 2) {
|
||
high_d = Modbus_RTU.hold_register[0];
|
||
low_d = Modbus_RTU.hold_register[1];
|
||
rt_uint16_t rec = (high_d << 8) | low_d;
|
||
return rec;
|
||
}
|
||
Modbus_RTU.modbus_rec =0;
|
||
}
|
||
return 0;
|
||
}
|
||
|
||
//void Bsp_Rs485_Tx(){
|
||
//
|
||
//}
|
||
//
|
||
//void Bsp_Rs485_Rx(){
|
||
//
|
||
//}
|
||
//
|
||
//static void rs485_sample_master(void *args)
|
||
//{
|
||
// const char read_cmd[] = "read datas test\r\n";
|
||
// static rt_uint8_t buf[256];
|
||
// rs485_inst_t *hinst = rs485_create(RS485_SAMPLE_MASTER_SERIAL, RS485_SAMPLE_MASTER_BAUDRATE,
|
||
// RS485_SAMPLE_MASTER_PARITY, RS485_SAMPLE_MASTER_PIN, RS485_SAMPLE_MASTER_LVL);
|
||
//
|
||
// if (hinst == RT_NULL)
|
||
// {
|
||
// LOG_E("create rs485 instance fail.");
|
||
// return;
|
||
// }
|
||
//
|
||
// rs485_set_recv_tmo(hinst, 1000);
|
||
// if (rs485_connect(hinst) != RT_EOK)
|
||
// {
|
||
// rs485_destory(hinst);
|
||
// LOG_E("rs485 connect fail.");
|
||
// return;
|
||
// }
|
||
//
|
||
// while (1)
|
||
// {
|
||
// int len = strlen(read_cmd);
|
||
// len = rs485_send_then_recv(hinst, (void *) read_cmd, len, buf, sizeof(buf));
|
||
// if (len < 0)
|
||
// {
|
||
// LOG_E("rs485 send datas error.");
|
||
// break;
|
||
// }
|
||
//
|
||
// if (len == 0)
|
||
// {
|
||
// LOG_D("rs485 recv timeout.");
|
||
// continue;
|
||
// }
|
||
//
|
||
// buf[len] = 0;
|
||
// LOG_D("rs485 recv %d datas : %s", len, buf);
|
||
// }
|
||
//
|
||
//}
|
||
|
||
//
|
||
//#define PORT_NUM MB_MASTER_USING_PORT_NUM
|
||
//#define PORT_BAUDRATE MB_MASTER_USING_PORT_BAUDRATE
|
||
//
|
||
//#define PORT_PARITY MB_PAR_EVEN
|
||
//
|
||
//#define MB_POLL_CYCLE_MS 500
|
||
//
|
||
//#define func_Coil 1
|
||
//#define func_Holding 3
|
||
//
|
||
//#define MODBUS_REG_NUM 30
|
||
|
||
//rt_uint16_t buffer[MODBUS_REG_NUM];
|
||
//
|
||
///*
|
||
// *
|
||
|
||
// *
|
||
// */
|
||
//
|
||
//void Copy_Holding(rt_uint16_t * Holding, rt_uint16_t reg_num){
|
||
// rt_uint16_t * a = get_modbus_03();
|
||
// for (rt_uint8_t var = 0; var < reg_num; var++) {
|
||
// Holding[var] = a[var];
|
||
// }
|
||
//}
|
||
//
|
||
//void Copy_Coil(rt_uint16_t * Coil, rt_uint16_t reg_num){
|
||
// unsigned char * a = get_modbus_01();
|
||
// for (rt_uint8_t var = 0; var < reg_num; var++) {
|
||
// Coil[var] = a[var];
|
||
// }
|
||
//}
|
||
//
|
||
//
|
||
//
|
||
//void Modbus_Read_Holding_Registers(rt_uint16_t addr, rt_uint16_t reg_addr, rt_uint16_t reg_num, rt_uint16_t * Holding){
|
||
//
|
||
// while(1){
|
||
// eMBMasterPoll();
|
||
//
|
||
// /*
|
||
// * ucSndAddr 请求的从机地址，0代表广播。
|
||
// usRegAddr 读寄存器的地址
|
||
// usRegData 读寄存器的数量
|
||
// lTimeOut 请求超时时间。支持永久等待，使用操作系统的永久等待参数即可。
|
||
// */
|
||
// eMBMasterReqReadHoldingRegister(addr, reg_addr, reg_num, 1000);
|
||
//
|
||
// rt_thread_mdelay(MB_POLL_CYCLE_MS);
|
||
//
|
||
// if (get_Holding_flag()) {
|
||
// Copy_Holding(Holding, reg_num);
|
||
// Modbus_RTU.modbus_rec =1;
|
||
// get_modbus_rec();
|
||
// }
|
||
//
|
||
// }
|
||
//}
|
||
//
|
||
//void Modbus_Read_Coils(rt_uint16_t addr, rt_uint16_t reg_addr, rt_uint16_t reg_num, rt_uint16_t * Coil){
|
||
//
|
||
// while(1){
|
||
// eMBMasterPoll();
|
||
//
|
||
// /*
|
||
// * ucSndAddr 请求的从机地址，0代表广播。
|
||
// usCoilAddr 读线圈的地址
|
||
// usNCoils 读线圈的数量
|
||
// lTimeOut 请求超时时间。支持永久等待，使用操作系统的永久等待参数即可
|
||
// */
|
||
// eMBMasterReqReadCoils(addr, reg_addr, reg_num, 1000);
|
||
//
|
||
// rt_thread_mdelay(MB_POLL_CYCLE_MS);
|
||
// if (get_Coil_flag()) {
|
||
// Copy_Coil(Coil , reg_num);
|
||
// Modbus_RTU.modbus_rec =1;
|
||
// }
|
||
// }
|
||
//}
|
||
//
|
||
//
|
||
//void Modbus_config(void){
|
||
//
|
||
// eMBMasterInit(MB_RTU, PORT_NUM, PORT_BAUDRATE, PORT_PARITY);
|
||
// eMBMasterEnable();
|
||
//
|
||
//// if(Modbus_RTU.modbus_func == func_Holding){
|
||
// Modbus_Read_Holding_Registers(Modbus_RTU.modbus_addr, Modbus_RTU.modbus_reg_addr, Modbus_RTU.modbus_reg_num ,buffer);
|
||
//// } else if(Modbus_RTU.modbus_func == func_Coil){
|
||
//// Modbus_Read_Coils(Modbus_RTU.modbus_addr, Modbus_RTU.modbus_reg_addr, Modbus_RTU.modbus_reg_num , buffer);
|
||
//// }
|
||
//
|
||
//}
|
||
//
|
||
|
||
|