haifeng.wang
/
NANO130_H2Press
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity
NANO130_H2Press/User_RS485Up（PB9冲突）/modbus_slave.c

411 lines
9.8 KiB
C
Raw Permalink Normal View History

初始版本提交
2025-04-10 14:54:41 +08:00
#include "includes.h"
#define MODBUS_EN PB9
// <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
void Modbus_Task(uint8_t c);
// modbusͨѶ<CDA8><D1B6><EFBFBD><EFBFBD>
#pragma pack(push, 1)
typedef struct
{
uint8_t id; // ͨ<>ŵ<EFBFBD>ַ
uint8_t cmd; // <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
uint16_t reg; // <20>Ĵ<EFBFBD><C4B4><EFBFBD><EFBFBD><EFBFBD>ַ
union
{
uint16_t cnt; // <20><>ȡ<EFBFBD><C8A1><EFBFBD>Ĵ<EFBFBD><C4B4><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
uint16_t data; // д<>룺<EFBFBD>Ĵ<EFBFBD><C4B4><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
};
uint16_t crc;
} modbus_request_t;
#pragma pack(pop)
// MODBUS<55><53>CRC<52>㷨
//uint16_t MODBUS_RTU_CRC16(const uint8_t *puchMsg, uint16_t usDataLen)
//{
// uint16_t crc = 0xFFFF;
// uint8_t i;
// while (usDataLen--) // <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ϣ<EFBFBD><CFA2><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
// {
// crc ^= *puchMsg++;
// for(i = 0; i < 8; i++)
// {
// if(crc & 0x0001)
// {
// crc >>= 1;
// crc ^= 0xA001;
// }
// else
// {
// crc >>= 1;
// }
// }
// }
// // <20><><EFBFBD><EFBFBD><EFBFBD>ߵ<EFBFBD><DFB5>ֽ<EFBFBD>˳<EFBFBD><CBB3>
// return ((crc & 0xFF) << 8) | ((crc >> 8) & 0xFF);
//}
// modbus rtu <20><><EFBFBD>ݻ<EFBFBD><DDBB><EFBFBD><EFBFBD><EFBFBD>
#define MODBUS_1ST_REG (30001) // <20><>1<EFBFBD><31><EFBFBD><EFBFBD><EFBFBD>ݵ<EFBFBD>ַ
#define MODBUS_LAST_REG (30018) // <20><><EFBFBD><EFBFBD>һ<EFBFBD><D2BB><EFBFBD><EFBFBD><EFBFBD>ݵ<EFBFBD>ַ
#define MODBUS_ADR_REG (40001) // ͨ<>ŵ<EFBFBD>ַ<EFBFBD><D6B7><EFBFBD><EFBFBD><EFBFBD>ݵ<EFBFBD>ַ
// modbus rtu<74><75><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
#define MODBUS_ERR_ILF (0x01) // <20><>Ч<EFBFBD><D0A7><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
#define MODBUS_ERR_ILA (0x02) // <20><>ЧͨѶ<CDA8><D1B6>ַ
#define MODBUS_ERR_ILD (0x03) // <20><>Ч<EFBFBD><D0A7><EFBFBD><EFBFBD>ֵ
#define MODBUS_ERR_FID (0x04) // ִ<><D6B4>ʧ<EFBFBD><CAA7>
#define MODBUS_ERR_ACK (0x05) // ACK<43><4B><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ѽ<EFBFBD><D1BD>ܲ<EFBFBD><DCB2>ڴ<EFBFBD><DAB4><EFBFBD><EFBFBD>У<EFBFBD>
#define MODBUS_ERR_BUSY (0x06) // <20>豸æ<E8B1B8><C3A6><EFBFBD>ܾ<EFBFBD>
#define MODBUS_ERR_NAK (0x07) // NAK<41><4B><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>޷<EFBFBD>ִ<EFBFBD>У<EFBFBD>
// modbus rtu <20><><EFBFBD>ݻ<EFBFBD><DDBB><EFBFBD><EFBFBD><EFBFBD>
uint8_t MODBUS_RTU_Buf[(MODBUS_LAST_REG - MODBUS_1ST_REG + 1) * 2];
void UART0_IRQHandler(void)
{
uint8_t c;
if(UART_GET_INT_FLAG(UART0, UART_ISR_RDA_IS_Msk) || UART_GET_INT_FLAG(UART0, UART_ISR_RTO_IS_Msk)) /* Rx Ready or Time-out INT*/
{
// do
{
c = UART0->RBR;
// printf("%02X ", c);
/* Handle received data */
Modbus_Task(c);
} //while(UART_IS_RX_READY(UART0));
}
if(UART_GET_INT_FLAG(UART0, UART_ISR_BUF_ERR_IS_Msk)) /* Buffer Error INT */
{
UART_ClearIntFlag(UART0, UART_ISR_BUF_ERR_IS_Msk);
}
if(UART_GET_INT_FLAG(UART0, UART_ISR_RLS_IS_Msk)) /* RLS INT */
{
UART_ClearIntFlag(UART0, UART_ISR_RLS_IS_Msk);
}
}
void Modbus_Init()
{
/* Select IP clock source */
CLK_SetModuleClock(UART0_MODULE, CLK_CLKSEL1_UART_S_HXT, CLK_UART_CLK_DIVIDER(1));
/*---------------------------------------------------------------------------------------------------------*/
/* Init I/O Multi-function */
/*---------------------------------------------------------------------------------------------------------*/
/* Set GPA multi-function pins for UART0 RXD and TXD */
SYS->PA_H_MFP &= ~(SYS_PA_H_MFP_PA14_MFP_Msk | SYS_PA_H_MFP_PA15_MFP_Msk);
SYS->PA_H_MFP |= (SYS_PA_H_MFP_PA14_MFP_UART0_RX | SYS_PA_H_MFP_PA15_MFP_UART0_TX);
// <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ʱ<EFBFBD><CAB1>
CLK_EnableModuleClock(UART0_MODULE);
}
/*---------------------------------------------------------------------------------------------------------*/
/* RS485 Transmit Control (Address Byte: Parity Bit =1 , Data Byte:Parity Bit =0) */
/*---------------------------------------------------------------------------------------------------------*/
static void RS485_SendDataByte(uint8_t *pu8TxBuf, uint32_t u32WriteBytes)
{
MODBUS_EN = 1;
delay_us(1);
/* Send data */
UART_Write(UART0, pu8TxBuf, u32WriteBytes);
delay_ms(6); // <20><><EFBFBD><EFBFBD>5ms<6D><73><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>6ms
MODBUS_EN = 0;
}
void Modbus_Open()
{
SYS_ResetModule(UART0_RST);
/* Configure UART and set UART Baudrate */
UART_Open(UART0, 9600ul);
/* Enable RDA\RLS\Time-out Interrupt */
UART_ENABLE_INT(UART0, (UART_IER_RDA_IE_Msk | UART_IER_BUF_ERR_IE_Msk | UART_IER_RLS_IE_Msk)); // | UART_IER_RTO_IE_Msk));
/* Enable UART interrupt */
NVIC_SetPriority(UART0_IRQn, 1);
NVIC_EnableIRQ(UART0_IRQn);
}
void Fill_MODBUS_RTU_Buf()
{
uint8_t len = 0; // <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ݳ<EFBFBD><DDB3><EFBFBD>
uint16_t val = 0;
uint32_t val32 = 0;
// <20><><EFBFBD><EFBFBD>״̬
if(dcBuff.sampleData.staPress.notConnect)
val |= (1 << 0);
if(dcBuff.sampleData.staExtTempr[0].notConnect)
val |= (1 << 2);
if(dcBuff.sampleData.staDPress.notConnect)
val |= (1 << 4);
// Һλ<D2BA><CEBB><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
if(dcBuff.configDisplay.op_USE_CAPACITY_SENSOR)
val |= (1 << 6);
// <20><><EFBFBD><EFBFBD>ֵ״̬
if(dcBuff.sampleData.staPress.underFlow)
val |= (1 << 8);
else if(dcBuff.sampleData.staPress.overFlow)
val |= (2 << 8);
if(dcBuff.sampleData.staExtTempr[0].underFlow)
val |= (1 << 10);
else if(dcBuff.sampleData.staExtTempr[0].overFlow)
val |= (2 << 10);
if(dcBuff.sampleData.staDPress.underFlow)
val |= (1 << 12);
else if(dcBuff.sampleData.staDPress.overFlow)
val |= (2 << 12);
val = htons(val);
memmove(MODBUS_RTU_Buf + len, &val, 2);
len += 2;
// <20><>ѹ
val = (uint16_t) dcBuff.sampleData.diff;
val = htons(val);
memmove(MODBUS_RTU_Buf + len, &val, 2);
len += 2;
// <20>ݻ<EFBFBD><DDBB>ٷֱ<D9B7>
val = (uint16_t) dcBuff.sampleData.volumePct;
val = htons(val);
memmove(MODBUS_RTU_Buf + len, &val, 2);
len += 2;
// <20><><EFBFBD><EFBFBD>
val32 = dcBuff.sampleData.volume;
val32 = htonl(val32);
memmove(MODBUS_RTU_Buf + len, &val32, 4);
len += 4;
// <20><><EFBFBD><EFBFBD>
val32 = dcBuff.sampleData.weight;
val32 = htonl(val32);
memmove(MODBUS_RTU_Buf + len, &val32, 4);
len += 4;
// <20>߶ȣ<DFB6>mmWC <20><> mm
if(!dcBuff.configDisplay.op_USE_CAPACITY_SENSOR)
val = (uint16_t) KPa2mmH2O(dcBuff.sampleData.diff);
else
val = (uint16_t) dcBuff.sampleData.height;
val = htons(val);
memmove(MODBUS_RTU_Buf + len, &val, 2);
len += 2;
// ѹ<><D1B9>
val = (uint16_t) dcBuff.sampleData.pressure;
val = htons(val);
memmove(MODBUS_RTU_Buf + len, &val, 2);
len += 2;
// <20><EFBFBD>: <20>з<EFBFBD><D0B7><EFBFBD><EFBFBD><EFBFBD>
memmove(&val, &dcBuff.sampleData.extTempr[0], 2);
val = htons(val);
memmove(MODBUS_RTU_Buf + len, &val, 2);
len += 2;
// <20><><EFBFBD><EFBFBD>
val = (uint16_t) dcBuff.configBottle.source;
val = htons(val);
memmove(MODBUS_RTU_Buf + len, &val, 2);
len += 2;
// <20><><EFBFBD><EFBFBD>Ч<EFBFBD>ݻ<EFBFBD>
val32 = dcBuff.sampleData.volumeTotal;
val32 = htonl(val32);
memmove(MODBUS_RTU_Buf + len, &val32, 4);
len += 4;
// <20><><EFBFBD>ռ<EFBFBD>״̬
val = 0;
if(dcBuff.sampleData.vacuum[0].staVacuum == VACUUM_STATUS_COMM_FAULT)
val |= 1;
else
{
if(dcBuff.sampleData.vacuum[0].staVacuum == VACUUM_STATUS_FAULT)
val |= (3 << 2);
else if(dcBuff.sampleData.vacuum[0].vacuum > 99.99999999)
val |= (2 << 2);
else if(dcBuff.sampleData.vacuum[0].vacuum <= 0.00999999)
val |= (1 << 2);
}
val = htons(val);
memmove(MODBUS_RTU_Buf + len, &val, 2);
len += 2;
// <20><><EFBFBD>ն<EFBFBD>
val = dcBuff.sampleData.vacuum[0].vacuum * 100;
val = htons(val);
memmove(MODBUS_RTU_Buf + len, &val, 2);
len += 2;
// <20><><EFBFBD>ռ<EFBFBD><D5BC><EFBFBD>
val = (int16_t) dcBuff.sampleData.vacuum[0].tempr;
val = htons(val);
memmove(MODBUS_RTU_Buf + len, &val, 2);
len += 2;
// <20><><EFBFBD><EFBFBD>״̬
val = 0;
if(dcBuff.sampleData.staExtTempr[1].notConnect)
val |= (1 << 0);
// <20><><EFBFBD><EFBFBD>ֵ״̬
if(dcBuff.sampleData.staExtTempr[1].underFlow)
val |= (1 << 2);
else if(dcBuff.sampleData.staExtTempr[1].overFlow)
val |= (2 << 2);
val = htons(val);
memmove(MODBUS_RTU_Buf + len, &val, 2);
len += 2;
// <20><EFBFBD>2: <20>з<EFBFBD><D0B7><EFBFBD><EFBFBD><EFBFBD>
memmove(&val, &dcBuff.sampleData.extTempr[1], 2);
val = htons(val);
memmove(MODBUS_RTU_Buf + len, &val, 2);
len += 2;
}
// <20><><EFBFBD><EFBFBD>modbus rtu<74><75><EFBFBD><EFBFBD>Ѿ<EFBFBD><D1BE><EFBFBD>֤<EFBFBD><D6A4><EFBFBD><EFBFBD><EFBFBD>Ⱥ<EFBFBD>CRC<52>İ<EFBFBD><C4B0><EFBFBD>
void MODBUS_RTU_CMD(modbus_request_t *req)
{
static uint8_t BUFF[(MODBUS_LAST_REG - MODBUS_1ST_REG + 1) * 2 + 6]; // <20><>Ӧ<EFBFBD><D3A6>
uint8_t err = 0; // <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
uint8_t len = 0; // <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ݳ<EFBFBD><DDB3><EFBFBD>
uint16_t id; // ͨ<>ŵ<EFBFBD>ַ
uint16_t reg; // <20><><EFBFBD>ݵ<EFBFBD>ַ
uint16_t cnt; // <20><><EFBFBD>ݸ<EFBFBD><DDB8><EFBFBD>
uint16_t crc;
// <20><><EFBFBD><EFBFBD>ͨ<EFBFBD>ŵ<EFBFBD>ַ
if(req->id != dcBuff.configBottle.addr && req->id != 0)
return;
// <20><><EFBFBD>շ<EFBFBD><D5B7><EFBFBD>֡
memset(BUFF, 0, sizeof(BUFF));
BUFF[len++] = dcBuff.configBottle.addr; // <20>ӻ<EFBFBD><D3BB><EFBFBD>ַ
BUFF[len++] = req->cmd; // <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
reg = ntohs(req->reg); // <20><><EFBFBD>ݼĴ<DDBC><C4B4><EFBFBD>
if(req->cmd == 0x03 || req->cmd == 0x06)
reg += 40001;
else if(req->cmd == 0x04)
reg += 30001;
else
err = MODBUS_ERR_ILF; // <20><>Ч<EFBFBD><D0A7><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
if(err == 0)
{
if(req->cmd == 0x03) // <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
{
cnt = ntohs(req->cnt); // <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
if(reg != MODBUS_ADR_REG || cnt != 1)
err = MODBUS_ERR_NAK; // <20><><EFBFBD><EFBFBD><EFBFBD>޷<EFBFBD>ִ<EFBFBD><D6B4>
else
{
// <20><><EFBFBD><EFBFBD><EFBFBD>µ<EFBFBD>ͨѶ<CDA8><D1B6>ַˢ<D6B7>»<EFBFBD><C2BB><EFBFBD>
id = htons(dcBuff.configBottle.addr);
BUFF[len++] = 2; // <20><><EFBFBD>ݳ<EFBFBD><DDB3><EFBFBD>
memmove(BUFF + len, (uint8_t *) &id, 2);
len += 2;
}
}
else if(req->cmd == 0x06) // <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
{
if(reg != MODBUS_ADR_REG)
err = MODBUS_ERR_NAK; // <20><><EFBFBD><EFBFBD><EFBFBD>޷<EFBFBD>ִ<EFBFBD><D6B4>
else
{
id = ntohs(req->data);
if(id < 1 || id > 247)
err = MODBUS_ERR_ILD; // <20><>Ч<EFBFBD><D0A7><EFBFBD><EFBFBD>ֵ
else
{
// <20><><EFBFBD>õ<EFBFBD>ַ<EFBFBD><D6B7><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
dcBuff.configBottle.addr = id;
Config_SaveConfig();
BUFF[0] = id; // <20>µ<EFBFBD>ַ
memmove(BUFF + len, &req->reg, 4); // <20><><EFBFBD>ݵ<EFBFBD>ַ<EFBFBD><D6B7>ͨѶ<CDA8><D1B6>ַ
len += 4;
}
}
}
else if(req->cmd == 0x04) // <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
{
cnt = ntohs(req->cnt); // <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
if(reg < MODBUS_1ST_REG || reg > MODBUS_LAST_REG || cnt < 1 || reg + (cnt - 1) > MODBUS_LAST_REG)
err = MODBUS_ERR_NAK; // <20><><EFBFBD><EFBFBD><EFBFBD>޷<EFBFBD>ִ<EFBFBD><D6B4>
else
{
// <20><><EFBFBD><EFBFBD><EFBFBD>µIJɼ<C4B2><C9BC><EFBFBD><EFBFBD><EFBFBD>ˢ<EFBFBD>»<EFBFBD><C2BB><EFBFBD>
Fill_MODBUS_RTU_Buf();
BUFF[len++] = cnt * 2; // <20><><EFBFBD>ݳ<EFBFBD><DDB3><EFBFBD>
memmove(BUFF + len, ((uint8_t *) MODBUS_RTU_Buf) + (reg - MODBUS_1ST_REG) * 2, cnt * 2);
len += cnt * 2;
}
}
}
if(err != 0)
{
BUFF[1] |= 0x80; // <20><><EFBFBD><EFBFBD>ָʾ
BUFF[len++] = err; // <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
}
// <20><><EFBFBD><EFBFBD>CRC
crc = MODBUS_RTU_CRC16(BUFF, len);
crc = htons(crc);
memmove(BUFF+len, &crc, 2);
len += 2;
if(req->id != 0)
{
// <20><><EFBFBD><EFBFBD>Ӧ<EFBFBD><D3A6>
RS485_SendDataByte(BUFF, len);
}
}
// <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
void Modbus_Task(uint8_t c)
{
static uint8_t BUFF[sizeof(modbus_request_t)] = {0};
static uint8_t len = 0;
// ȡ<><C8A1><EFBFBD><EFBFBD>
BUFF[len++] = c;
// <20><>֤<EFBFBD><D6A4><EFBFBD>Ⱥ<EFBFBD>CRCֵ
if(len == sizeof(modbus_request_t))
{
if(MODBUS_RTU_CRC16(BUFF, sizeof(modbus_request_t)) == 0)
{
MODBUS_RTU_CMD((modbus_request_t *) BUFF);
len = 0;
}
else
{
// <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>һ<EFBFBD><D2BB><EFBFBD>ֽ<EFBFBD>
memmove(BUFF, BUFF + 1, --len);
}
}
}