You can not select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.

157 lines
6.1 KiB

#include "modbus_processer.h"
#include <stdbool.h>
#include <stdint.h>
/***********************485rx**************************/
//接收到了多少数据
volatile uint16_t s_modbus_uart_rx_off = 0;
//当前是否正在处理接收到的数据
volatile bool s_modbus_uart_rx_buf_is_processing = false;
/***********************485tx**************************/
static modbus_processer_t* g_processer;
#define GET_UINT16(uint8) (uint16_t)(((uint16_t)((uint8)[0]) << 8) + (uint8)[1])
static void modbus_processer_process_data(uint8_t* rx, uint16_t rxlen) {
/**
* @brief modbus接收完成以后在这里进行处理数据
*
*/
//如果不是广播信息或者不是当前设备的信息,丢弃
if (rx[0] != 0 && rx[0] != g_processer->modbus_device_id) {
return;
}
// CRC校验失败
if (!ZCheckRTUMessageIntegrity(rx, rxlen)) {
return;
}
// if(functioncode)
static ModbusMasterData_t rxorder;
static ModbusSlaveData_t txorder;
//将接受到的数据进行组包
ModbusProcessRxData(rx, rxlen, &rxorder);
static uint16_t txsendlen = 0;
txorder.deviceId = g_processer->modbus_device_id;
//功能码
txorder.functionCode = rxorder.functionCode;
modbus_processer_context_t context = {0};
context.tx = &txorder;
context.rx = &rxorder;
g_processer->process_rx(&context);
}
void modbus_processer_init(modbus_processer_t* processer) { g_processer = processer; }
void modbus_processer_push_data(uint8_t rxdata) {
if (!s_modbus_uart_rx_buf_is_processing) {
if (s_modbus_uart_rx_off < g_processer->modbus_processer_rx_buf_size) {
g_processer->modbus_processer_rx_buf[s_modbus_uart_rx_off] = rxdata;
s_modbus_uart_rx_off++;
}
}
}
ModbusFunctionCode modbus_get_function_code(modbus_processer_context_t* context) { //
return context->tx->functionCode;
}
void modbus_set_tx_reg_03(modbus_processer_context_t* context, uint16_t regoff, uint16_t regdata) {
uint16_t off = regoff - context->rx->d.O03.startreg;
ModbusCreateTx_setReg(g_processer->modbus_processer_tx_buf, g_processer->modbus_processer_tx_buf_size, off, //
regdata);
}
uint16_t modbus_get_reg_10(modbus_processer_context_t* context, uint16_t regoff) {
uint16_t off = regoff - context->rx->d.O10.startreg;
uint8_t* data = context->rx->d.O10.reg;
if ((off + 1) * 2 <= context->rx->d.O10.bytenum) {
uint16_t u16 = GET_UINT16(&data[off * 2]);
return u16;
} else {
uint16_t u16 = data[off * 2];
return u16;
}
}
bool modbus_if_register_exists_03(modbus_processer_context_t* context, uint16_t regoff) {
uint16_t startreg = context->rx->d.O03.startreg;
uint16_t endreg = context->rx->d.O03.startreg + context->rx->d.O03.numreg;
return regoff >= startreg && regoff < endreg;
}
bool modbus_if_register_exists_10(modbus_processer_context_t* context, uint16_t regoff) {
uint16_t startreg = context->rx->d.O10.startreg;
uint16_t endreg = context->rx->d.O10.startreg + context->rx->d.O10.numreg;
return regoff >= startreg && regoff < endreg;
}
void modbus_send_03(modbus_processer_context_t* context, ModbusStatus modbus_status) {
uint16_t sendlegth = 0;
if (modbus_status == Modbus_OK) {
context->tx->functionCode = context->rx->functionCode;
context->tx->deviceId = g_processer->modbus_device_id;
context->tx->d.O10.regnum = context->rx->d.O10.numreg;
context->tx->d.O10.startreg = context->rx->d.O10.startreg;
//构造回执,并发送
ModbusCreateTxData(g_processer->modbus_processer_tx_buf, g_processer->modbus_processer_tx_buf_size, &sendlegth, context->tx);
g_processer->tx(g_processer->modbus_processer_tx_buf, sendlegth);
} else {
//构造异常包并发送
ModbusCreateExceptionData(g_processer->modbus_processer_tx_buf, //
g_processer->modbus_processer_tx_buf_size, //
&sendlegth, //
g_processer->modbus_device_id, //
context->rx->functionCode, //
modbus_status);
g_processer->tx(g_processer->modbus_processer_tx_buf, sendlegth);
}
}
void modbus_send_10(modbus_processer_context_t* context, ModbusStatus modbus_status) {
uint16_t sendlegth = 0;
if (modbus_status == Modbus_OK) {
context->tx->functionCode = context->rx->functionCode;
context->tx->deviceId = g_processer->modbus_device_id;
context->tx->d.O10.regnum = context->rx->d.O10.numreg;
context->tx->d.O10.startreg = context->rx->d.O10.startreg;
//构造回执,并发送
ModbusCreateTxData(g_processer->modbus_processer_tx_buf, g_processer->modbus_processer_tx_buf_size, &sendlegth, context->tx);
g_processer->tx(g_processer->modbus_processer_tx_buf, sendlegth);
} else {
//构造异常包并发送
ModbusCreateExceptionData(g_processer->modbus_processer_tx_buf, //
g_processer->modbus_processer_tx_buf_size, //
&sendlegth, //
g_processer->modbus_device_id, //
context->rx->functionCode, //
modbus_status);
g_processer->tx(g_processer->modbus_processer_tx_buf, sendlegth);
}
}
void modbus_processer_try_process_data() {
/**
* @brief
* 根据modbus协议,当超过3.5个字符时间后依然没有收到数据
*/
if (s_modbus_uart_rx_off != 0) {
uint16_t modbus_uart_rx_off_before = s_modbus_uart_rx_off;
g_processer->port_delay_us(g_processer->modbus_baundrate_one_packet_delay_us);
g_processer->port_enter_critical();
if (s_modbus_uart_rx_off == modbus_uart_rx_off_before) {
s_modbus_uart_rx_buf_is_processing = true;
}
g_processer->port_exit_critical();
if (s_modbus_uart_rx_buf_is_processing) {
modbus_processer_process_data(g_processer->modbus_processer_rx_buf, s_modbus_uart_rx_off);
g_processer->port_enter_critical();
s_modbus_uart_rx_off = 0;
s_modbus_uart_rx_buf_is_processing = false;
g_processer->port_exit_critical();
}
}
}