STM32F407单片机上开发MODBUS RTU 多主站程序(一)
STM32F407单片机上开发MODBUS RTU 多主站程序(二)
因为工程需要经常要在STM32F407上编写MODBUS RTU 多主站程序。何谓多主站程序呢?即:1个单片机系统需要编写多个MODBUS RTU主程序,例如:USART1需要编写1个MODBUS RTU 主站程序, 读取相关的数据;USART2也需要编写1个MODBUS RTU 主站程序,读取相关的数据。
按照一般的方式,USART1串口编写一个主站程序,USART2也串口编写一个主站程序,就样就显然太不专业了,显然我们可以实现USART1串口和USART2串口共用一个主站程序,我使用了队列+指针的方式实现MODBUS RTU 多主站程序。
1、宏定义
#define BOOL uint8_t
#ifndef TRUE
#define TRUE (1)
#endif
#ifndef FALSE
#define FALSE (!(TRUE))
#endif
2、CRC16.H
#ifndef __CRC16_H__
#define __CRC16_H__
#include "stm32f4xx.h"
uint16_t CRC16(uint8_t *puchMsg, uint16_t usDataLen);
#endif
3、CRC16.c
#include "stm32f4xx.h"
#include "CRC16.h"
const uint8_t auchCRCHi[] = {
0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0,
0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41,
0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0,
0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40,
0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1,
0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41,
0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1,
0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41,
0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0,
0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40,
0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1,
0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40,
0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0,
0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40,
0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0,
0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40,
0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0,
0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41,
0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0,
0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41,
0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0,
0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40,
0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1,
0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41,
0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0,
0x80, 0x41, 0x00, 0xC1, 0x81, 0x40
};
const uint8_t auchCRCLo[] = {
0x00, 0xC0, 0xC1, 0x01, 0xC3, 0x03, 0x02, 0xC2, 0xC6, 0x06,
0x07, 0xC7, 0x05, 0xC5, 0xC4, 0x04, 0xCC, 0x0C, 0x0D, 0xCD,
0x0F, 0xCF, 0xCE, 0x0E, 0x0A, 0xCA, 0xCB, 0x0B, 0xC9, 0x09,
0x08, 0xC8, 0xD8, 0x18, 0x19, 0xD9, 0x1B, 0xDB, 0xDA, 0x1A,
0x1E, 0xDE, 0xDF, 0x1F, 0xDD, 0x1D, 0x1C, 0xDC, 0x14, 0xD4,
0xD5, 0x15, 0xD7, 0x17, 0x16, 0xD6, 0xD2, 0x12, 0x13, 0xD3,
0x11, 0xD1, 0xD0, 0x10, 0xF0, 0x30, 0x31, 0xF1, 0x33, 0xF3,
0xF2, 0x32, 0x36, 0xF6, 0xF7, 0x37, 0xF5, 0x35, 0x34, 0xF4,
0x3C, 0xFC, 0xFD, 0x3D, 0xFF, 0x3F, 0x3E, 0xFE, 0xFA, 0x3A,
0x3B, 0xFB, 0x39, 0xF9, 0xF8, 0x38, 0x28, 0xE8, 0xE9, 0x29,
0xEB, 0x2B, 0x2A, 0xEA, 0xEE, 0x2E, 0x2F, 0xEF, 0x2D, 0xED,
0xEC, 0x2C, 0xE4, 0x24, 0x25, 0xE5, 0x27, 0xE7, 0xE6, 0x26,
0x22, 0xE2, 0xE3, 0x23, 0xE1, 0x21, 0x20, 0xE0, 0xA0, 0x60,
0x61, 0xA1, 0x63, 0xA3, 0xA2, 0x62, 0x66, 0xA6, 0xA7, 0x67,
0xA5, 0x65, 0x64, 0xA4, 0x6C, 0xAC, 0xAD, 0x6D, 0xAF, 0x6F,
0x6E, 0xAE, 0xAA, 0x6A, 0x6B, 0xAB, 0x69, 0xA9, 0xA8, 0x68,
0x78, 0xB8, 0xB9, 0x79, 0xBB, 0x7B, 0x7A, 0xBA, 0xBE, 0x7E,
0x7F, 0xBF, 0x7D, 0xBD, 0xBC, 0x7C, 0xB4, 0x74, 0x75, 0xB5,
0x77, 0xB7, 0xB6, 0x76, 0x72, 0xB2, 0xB3, 0x73, 0xB1, 0x71,
0x70, 0xB0, 0x50, 0x90, 0x91, 0x51, 0x93, 0x53, 0x52, 0x92,
0x96, 0x56, 0x57, 0x97, 0x55, 0x95, 0x94, 0x54, 0x9C, 0x5C,
0x5D, 0x9D, 0x5F, 0x9F, 0x9E, 0x5E, 0x5A, 0x9A, 0x9B, 0x5B,
0x99, 0x59, 0x58, 0x98, 0x88, 0x48, 0x49, 0x89, 0x4B, 0x8B,
0x8A, 0x4A, 0x4E, 0x8E, 0x8F, 0x4F, 0x8D, 0x4D, 0x4C, 0x8C,
0x44, 0x84, 0x85, 0x45, 0x87, 0x47, 0x46, 0x86, 0x82, 0x42,
0x43, 0x83, 0x41, 0x81, 0x80, 0x40
};
uint16_t CRC16(uint8_t *puchMsg, uint16_t usDataLen)
{
uint8_t uchCRCHi = 0xFF;
uint8_t uchCRCLo = 0xFF;
uint32_t uIndex;
while (usDataLen--)
{
uIndex = uchCRCHi ^ *puchMsg++;
uchCRCHi = uchCRCLo ^ auchCRCHi[uIndex];
uchCRCLo = auchCRCLo[uIndex];
}
return (uchCRCHi << 8 | uchCRCLo);
}
4、modbus_queue.h
#ifndef __MODBUS_QUEUE_H__
#define __MODBUS_QUEUE_H__
#include <stm32f4xx.h>
#define MODBUS_ELEMENT_DATA_LENGTH (255)
typedef struct TagMODBUS_ELEMENT
{
uint8_t Reserved;
uint8_t DeviceAddr;
uint8_t Func;
uint8_t StartAddr;
uint8_t RegisterAmount;
uint8_t ByteCount;
uint8_t SendBytes;
int8_t SendCount;
uint8_t Data[MODBUS_ELEMENT_DATA_LENGTH];
} MODBUS_ELEMENT;
typedef struct tagMODBUS_QUEUE_STRUCT
{
MODBUS_ELEMENT *MODBUS_Element;
uint8_t volatile size;
uint8_t volatile front;
uint8_t volatile rear;
}MODBUS_QUEUE_STRUCT , *MODBUS_QUEUE_STRUCT_PTR;
BOOL MODBUS_QUEUE_Empty(MODBUS_QUEUE_STRUCT *MODBUS_queue);
BOOL MODBUS_QUEUE_Full(MODBUS_QUEUE_STRUCT *MODBUS_queue);
BOOL MODBUS_QUEUE_In(MODBUS_QUEUE_STRUCT *MODBUS_queue , MODBUS_ELEMENT MODBUS_element);
BOOL MODBUS_QUEUE_Out(MODBUS_QUEUE_STRUCT *MODBUS_queue , MODBUS_ELEMENT *MODBUS_element);
#endif //__MODBUS_QUEUE_H__
5、modbus_queue.c
#include "platform.h"
#include "modbus_queue.h"
BOOL MODBUS_QUEUE_Empty(MODBUS_QUEUE_STRUCT *MODBUS_queue)
{
return (MODBUS_queue->rear == MODBUS_queue->front);
}
BOOL MODBUS_QUEUE_Full(MODBUS_QUEUE_STRUCT *MODBUS_queue)
{
return ((MODBUS_queue->rear + 1) % MODBUS_queue->size == MODBUS_queue->front);
}
BOOL MODBUS_QUEUE_In(MODBUS_QUEUE_STRUCT *MODBUS_queue , MODBUS_ELEMENT MODBUS_element)
{
if (!MODBUS_QUEUE_Full(MODBUS_queue))
{
MODBUS_queue->rear = (MODBUS_queue->rear + 1) % MODBUS_queue->size;
MODBUS_queue->MODBUS_Element[MODBUS_queue->rear].Reserved = MODBUS_element.Reserved;//MODBUS主站增加识别码,识别MODBUS主站使用16号功能码给HMI液晶下发的报文到底是何报文
MODBUS_queue->MODBUS_Element[MODBUS_queue->rear].DeviceAddr = MODBUS_element.DeviceAddr;
MODBUS_queue->MODBUS_Element[MODBUS_queue->rear].Func = MODBUS_element.Func;
MODBUS_queue->MODBUS_Element[MODBUS_queue->rear].StartAddr = MODBUS_element.StartAddr;
MODBUS_queue->MODBUS_Element[MODBUS_queue->rear].RegisterAmount = MODBUS_element.RegisterAmount;
MODBUS_queue->MODBUS_Element[MODBUS_queue->rear].ByteCount = MODBUS_element.ByteCount;
MODBUS_queue->MODBUS_Element[MODBUS_queue->rear].SendBytes = MODBUS_element.SendBytes;
MODBUS_queue->MODBUS_Element[MODBUS_queue->rear].SendCount = MODBUS_element.SendCount;
memcpy(MODBUS_queue->MODBUS_Element[MODBUS_queue->rear].Data , MODBUS_element.Data , MODBUS_ELEMENT_DATA_LENGTH);
return (TRUE);
}
return (FALSE);
}
BOOL MODBUS_QUEUE_Out(MODBUS_QUEUE_STRUCT *MODBUS_queue , MODBUS_ELEMENT *MODBUS_element)
{
if (!MODBUS_QUEUE_Empty(MODBUS_queue))
{
MODBUS_queue->front = (MODBUS_queue->front + 1) % MODBUS_queue->size;
MODBUS_element->Reserved = MODBUS_queue->MODBUS_Element[MODBUS_queue->front].Reserved;//MODBUS主站增加识别码,识别MODBUS主站使用16号功能码给HMI液晶下发的报文到底是何报文
MODBUS_element->DeviceAddr = MODBUS_queue->MODBUS_Element[MODBUS_queue->front].DeviceAddr;
MODBUS_element->Func = MODBUS_queue->MODBUS_Element[MODBUS_queue->front].Func;
MODBUS_element->StartAddr = MODBUS_queue->MODBUS_Element[MODBUS_queue->front].StartAddr;
MODBUS_element->RegisterAmount = MODBUS_queue->MODBUS_Element[MODBUS_queue->front].RegisterAmount;
MODBUS_element->ByteCount = MODBUS_queue->MODBUS_Element[MODBUS_queue->front].ByteCount;
MODBUS_element->SendBytes = MODBUS_queue->MODBUS_Element[MODBUS_queue->front].SendBytes;
MODBUS_element->SendCount = MODBUS_queue->MODBUS_Element[MODBUS_queue->front].SendCount;
memcpy(MODBUS_element->Data , MODBUS_queue->MODBUS_Element[MODBUS_queue->front].Data , MODBUS_ELEMENT_DATA_LENGTH);
return (TRUE);
}
return (FALSE);
}
6、modbus_hosts.h
#ifndef __MODBUS_HOSTS_H__
#define __MODBUS_HOSTS_H__
#include <stm32f4xx.h>
#include "modbus_queue.h"
#define MODBUS_HOSTS_FUNC_ReadCoil (0x01)
#define MODBUS_HOSTS_FUNC_ReadDiscrete (0x02)
#define MODBUS_HOSTS_FUNC_ReadHoldingRegisters (0x03)
#define MODBUS_HOSTS_FUNC_ReadInputRegisters (0x04)
#define MODBUS_HOSTS_FUNC_ForceSingleCoil (0x05)
#define MODBUS_HOSTS_FUNC_PresetSingleHoldingRegister (0x06)
#define MODBUS_HOSTS_FUNC_ForceMultipleCoil (0x0F)
#define MODBUS_HOSTS_FUNC_PresetMultipleHoldingRegisters (0x10)
//MODBUS主站最大传输254字节,当波特率=115200时,1秒钟最大能够传输11520字节,则50毫秒能传输576字节
//30毫秒能传输345字节,25毫秒能传输288字节,20毫秒能传输234字节
//MODBUS主站最大传输254字节,当波特率=9600时,1秒钟最大能够传输960字节,则100毫秒能传输96字节,
//50毫秒能传输48字节
#define MODBUS_HOSTS_POLL_TIME (10)
#define MBHOSTS_MIN_REPEAT_SEND_COUNT (1)
#define MBHOSTS_MAX_REPEAT_SEND_COUNT (5)
enum MODBUS_HOSTS_STATUS
{
enum_MODBUS_STATUS_READY = 0,
enum_MODBUS_STATUS_SEND_BEGIN =1,
enum_MODBUS_STATUS_SEND_BEGINING =2,
enum_MODBUS_STATUS_SEND_OVER =3,
enum_MODBUS_STATUS_RECV_OVER =4,
enum_MODBUS_STATUS_RECV_ERROR =5,
enum_MODBUS_STATUS_TIME_OUT =6,
};
uint16_t CRC16(uint8_t *puchMsg, uint16_t usDataLen);
void MBHOSTS_Init(void);
BOOL MBHOSTS_ReadCoilRegisters(uint8_t DeviceAddr , uint16_t startAddr , uint16_t registerAmount , uint8_t SendCount , MODBUS_QUEUE_STRUCT *MODBUS_queue);
BOOL MBHOSTS_ReadDiscreteRegisters(uint8_t DeviceAddr , uint16_t startAddr , uint16_t registerAmount , uint8_t SendCount , MODBUS_QUEUE_STRUCT *MODBUS_queue);
BOOL MBHOSTS_ReadInputRegisters(uint8_t DeviceAddr , uint16_t startAddr , uint8_t registerAmount , uint8_t SendCount , MODBUS_QUEUE_STRUCT *MODBUS_queue);
BOOL MBHOSTS_ReadHoldingRegisters(uint8_t DeviceAddr , uint16_t startAddr , uint8_t registerAmount , uint8_t SendCount , MODBUS_QUEUE_STRUCT *MODBUS_queue);
BOOL MBHOSTS_ForceSingleCoil(uint8_t DeviceAddr , uint16_t startAddr , uint16_t On_Off , uint8_t SendCount , MODBUS_QUEUE_STRUCT *MODBUS_queue);
BOOL MBHOSTS_PresetSingleHoldingRegister(uint8_t DeviceAddr , uint16_t startAddr , int16_t Value , uint8_t SendCount , MODBUS_QUEUE_STRUCT *MODBUS_queue);
BOOL MBHOSTS_ForceMultipleCoil(uint8_t DeviceAddr , uint16_t startAddr , uint16_t registerAmount , uint8_t Data_Buffer[] , uint8_t SendCount , MODBUS_QUEUE_STRUCT *MODBUS_queue);
BOOL MBHOSTS_PresetMultipleHoldingRegisters(uint8_t DeviceAddr , uint16_t startAddr , uint8_t registerAmount , int16_t Data_Buffer[] , uint8_t SendCount , uint8_t Reserved_Func , MODBUS_QUEUE_STRUCT *MODBUS_queue);
#endif //__MODBUS_HOSTS_H__
7、modbus_hosts.c
#include "modbus_hosts.h"
BOOL MBHOSTS_ReadCoilRegisters(uint8_t DeviceAddr , uint16_t startAddr , uint16_t registerAmount , uint8_t SendCount , MODBUS_QUEUE_STRUCT *MODBUS_queue)
{
uint8_t ByteCount;
uint16_t crcData;
MODBUS_ELEMENT MODBUS_element;
memset(&MODBUS_element , 0x00 , sizeof(MODBUS_ELEMENT));
MODBUS_element.Data[0] = DeviceAddr;
MODBUS_element.Data[1] = MODBUS_HOSTS_FUNC_ReadCoil;
MODBUS_element.Data[2] = startAddr >> 0x08;
MODBUS_element.Data[3] = startAddr & 0xFF;
MODBUS_element.Data[4] = registerAmount >> 0x08;
MODBUS_element.Data[5] = registerAmount & 0xFF;
crcData = CRC16(MODBUS_element.Data , 6);
MODBUS_element.Data[6] = crcData >> 0x08;
MODBUS_element.Data[7] = crcData & 0xFF;
ByteCount = registerAmount >> 0x03;
if (registerAmount & 0x07)
ByteCount++;
MODBUS_element.DeviceAddr = DeviceAddr;
MODBUS_element.Func = MODBUS_HOSTS_FUNC_ReadCoil;
MODBUS_element.StartAddr = startAddr;
MODBUS_element.RegisterAmount = registerAmount;
MODBUS_element.ByteCount = ByteCount;
MODBUS_element.SendBytes = 0x08;
MODBUS_element.SendCount = SendCount;
if (MODBUS_QUEUE_In(MODBUS_queue , MODBUS_element))
return (TRUE);
return (FALSE);
}
BOOL MBHOSTS_ReadDiscreteRegisters(uint8_t DeviceAddr , uint16_t startAddr , uint16_t registerAmount , uint8_t SendCount , MODBUS_QUEUE_STRUCT *MODBUS_queue)
{
uint8_t ByteCount;
uint16_t crcData;
MODBUS_ELEMENT MODBUS_element;
memset(&MODBUS_element , 0x00 , sizeof(MODBUS_ELEMENT));
MODBUS_element.Data[0] = DeviceAddr;
MODBUS_element.Data[1] = MODBUS_HOSTS_FUNC_ReadDiscrete;
MODBUS_element.Data[2] = startAddr >> 0x08;
MODBUS_element.Data[3] = startAddr & 0xFF;
MODBUS_element.Data[4] = registerAmount >> 0x08;
MODBUS_element.Data[5] = registerAmount & 0xFF;
crcData = CRC16(MODBUS_element.Data , 6);
MODBUS_element.Data[6] = crcData >> 0x08;
MODBUS_element.Data[7] = crcData & 0xFF;
ByteCount = registerAmount >> 0x03;
if (registerAmount & 0x07)
ByteCount++;
MODBUS_element.DeviceAddr = DeviceAddr;
MODBUS_element.Func = MODBUS_HOSTS_FUNC_ReadDiscrete;
MODBUS_element.StartAddr = startAddr;
MODBUS_element.RegisterAmount = registerAmount;
MODBUS_element.ByteCount = ByteCount;
MODBUS_element.SendBytes = 0x08;
MODBUS_element.SendCount = SendCount;
if (MODBUS_QUEUE_In(MODBUS_queue , MODBUS_element))
return (TRUE);
return (FALSE);
}
BOOL MBHOSTS_ReadInputRegisters(uint8_t DeviceAddr , uint16_t startAddr , uint8_t registerAmount , uint8_t SendCount , MODBUS_QUEUE_STRUCT *MODBUS_queue)
{
uint16_t crcData;
MODBUS_ELEMENT MODBUS_element;
memset(&MODBUS_element , 0x00 , sizeof(MODBUS_ELEMENT));
MODBUS_element.Data[0] = DeviceAddr;
MODBUS_element.Data[1] = MODBUS_HOSTS_FUNC_ReadInputRegisters;
MODBUS_element.Data[2] = startAddr >> 0x08;
MODBUS_element.Data[3] = startAddr & 0xFF;
MODBUS_element.Data[4] = registerAmount >> 0x08;
MODBUS_element.Data[5] = registerAmount & 0xFF;
crcData = CRC16(MODBUS_element.Data , 6);
MODBUS_element.Data[6] = crcData >> 0x08;
MODBUS_element.Data[7] = crcData & 0xFF;
MODBUS_element.DeviceAddr = DeviceAddr;
MODBUS_element.Func = MODBUS_HOSTS_FUNC_ReadInputRegisters;
MODBUS_element.StartAddr = startAddr;
MODBUS_element.RegisterAmount = registerAmount;
MODBUS_element.ByteCount = registerAmount << 0x01;
MODBUS_element.SendBytes = 0x08;
MODBUS_element.SendCount = SendCount;
if (MODBUS_QUEUE_In(MODBUS_queue , MODBUS_element))
return (TRUE);
return (FALSE);
}
BOOL MBHOSTS_ReadHoldingRegisters(uint8_t DeviceAddr , uint16_t startAddr , uint8_t registerAmount , uint8_t SendCount , MODBUS_QUEUE_STRUCT *MODBUS_queue)
{
uint16_t crcData;
MODBUS_ELEMENT MODBUS_element;
memset(&MODBUS_element , 0x00 , sizeof(MODBUS_ELEMENT));
MODBUS_element.Data[0] = DeviceAddr;
MODBUS_element.Data[1] = MODBUS_HOSTS_FUNC_ReadHoldingRegisters;
MODBUS_element.Data[2] = startAddr >> 0x08;
MODBUS_element.Data[3] = startAddr & 0xFF;
MODBUS_element.Data[4] = registerAmount >> 0x08;
MODBUS_element.Data[5] = registerAmount & 0xFF;
crcData = CRC16(MODBUS_element.Data , 6);
MODBUS_element.Data[6] = crcData >> 0x08;
MODBUS_element.Data[7] = crcData & 0xFF;
MODBUS_element.DeviceAddr = DeviceAddr;
MODBUS_element.Func = MODBUS_HOSTS_FUNC_ReadHoldingRegisters;
MODBUS_element.StartAddr = startAddr;
MODBUS_element.RegisterAmount = registerAmount;
MODBUS_element.ByteCount = registerAmount << 0x01;
MODBUS_element.SendBytes = 0x08;
MODBUS_element.SendCount = SendCount;
if (MODBUS_QUEUE_In(MODBUS_queue , MODBUS_element))
return (TRUE);
return (FALSE);
}
BOOL MBHOSTS_ForceSingleCoil(uint8_t DeviceAddr , uint16_t startAddr , uint16_t On_Off , uint8_t SendCount , MODBUS_QUEUE_STRUCT *MODBUS_queue)
{
uint16_t crcData;
MODBUS_ELEMENT MODBUS_element;
memset(&MODBUS_element , 0x00 , sizeof(MODBUS_ELEMENT));
MODBUS_element.Data[0] = DeviceAddr;
MODBUS_element.Data[1] = MODBUS_HOSTS_FUNC_ForceSingleCoil;
MODBUS_element.Data[2] = startAddr >> 0x08;
MODBUS_element.Data[3] = startAddr & 0xFF;
switch (On_Off)
{
case 1:
MODBUS_element.Data[4] = 0xFF; // (4,5) = 0x0000/0xFF00
MODBUS_element.Data[5] = 0x00;
break;
default:
MODBUS_element.Data[4] = 0x00; // (4,5) = 0x0000/0xFF00
MODBUS_element.Data[5] = 0x00;
break;
}
crcData = CRC16(MODBUS_element.Data , 6);
MODBUS_element.Data[6] = crcData >> 0x08;
MODBUS_element.Data[7] = crcData & 0xFF;
MODBUS_element.DeviceAddr = DeviceAddr;
MODBUS_element.Func = MODBUS_HOSTS_FUNC_ForceSingleCoil;
MODBUS_element.StartAddr = startAddr;
MODBUS_element.RegisterAmount = 0x01; // 无意义
MODBUS_element.ByteCount = MODBUS_element.RegisterAmount << 0x01; // 无意义
MODBUS_element.SendBytes = 0x08;
MODBUS_element.SendCount = SendCount;
if (MODBUS_QUEUE_In(MODBUS_queue , MODBUS_element))
return (TRUE);
return (FALSE);
}
BOOL MBHOSTS_PresetSingleHoldingRegister(uint8_t DeviceAddr , uint16_t startAddr , int16_t Value , uint8_t SendCount , MODBUS_QUEUE_STRUCT *MODBUS_queue)
{
uint16_t crcData;
MODBUS_ELEMENT MODBUS_element;
memset(&MODBUS_element , 0x00 , sizeof(MODBUS_ELEMENT));
MODBUS_element.Data[0] = DeviceAddr;
MODBUS_element.Data[1] = MODBUS_HOSTS_FUNC_PresetSingleHoldingRegister;
MODBUS_element.Data[2] = startAddr >> 0x08;
MODBUS_element.Data[3] = startAddr & 0xFF;
MODBUS_element.Data[4] = Value >> 0x08;
MODBUS_element.Data[5] = Value & 0xFF;
crcData = CRC16(MODBUS_element.Data , 6);
MODBUS_element.Data[6] = crcData >> 0x08;
MODBUS_element.Data[7] = crcData & 0xFF;
MODBUS_element.DeviceAddr = DeviceAddr;
MODBUS_element.Func = MODBUS_HOSTS_FUNC_PresetSingleHoldingRegister;
MODBUS_element.StartAddr = startAddr;
MODBUS_element.RegisterAmount = 0x01;
MODBUS_element.ByteCount = MODBUS_element.RegisterAmount << 0x01; //无意义
MODBUS_element.SendBytes = 0x08;
MODBUS_element.SendCount = SendCount;
if (MODBUS_QUEUE_In(MODBUS_queue , MODBUS_element))
return (TRUE);
return (FALSE);
}
BOOL MBHOSTS_ForceMultipleCoil(uint8_t DeviceAddr , uint16_t startAddr , uint16_t registerAmount , uint8_t Data_Buffer[] , uint8_t SendCount , MODBUS_QUEUE_STRUCT *MODBUS_queue)
{
uint8_t i;
uint8_t j;
uint16_t k;
uint8_t ByteCount;
uint16_t crcData;
MODBUS_ELEMENT MODBUS_element;
memset(&MODBUS_element , 0x00 , sizeof(MODBUS_ELEMENT));
MODBUS_element.Data[0] = DeviceAddr;
MODBUS_element.Data[1] = MODBUS_HOSTS_FUNC_ForceMultipleCoil;
MODBUS_element.Data[2] = startAddr >> 0x08;
MODBUS_element.Data[3] = startAddr & 0xFF;
MODBUS_element.Data[4] = registerAmount >> 0x08;
MODBUS_element.Data[5] = registerAmount & 0xFF;
ByteCount = registerAmount >> 3;
if (registerAmount & 0x07)
ByteCount++;
MODBUS_element.Data[6] = ByteCount;
k = 0x00;
for (i = 0 ; i < ByteCount ; i++)
{
MODBUS_element.Data[i + 7] = 0x00;
for (j = 0 ; j < 8 ; j++ )
{
MODBUS_element.Data[i + 7] |= (Data_Buffer[k] << j);
k++;
if (k >= registerAmount)
break;
}
}
crcData = CRC16(MODBUS_element.Data , (ByteCount + 9) - 2);
MODBUS_element.Data[(ByteCount + 9) - 2] = crcData >> 0x08;
MODBUS_element.Data[(ByteCount + 9) - 1] = crcData & 0xFF;
MODBUS_element.DeviceAddr = DeviceAddr;
MODBUS_element.Func = MODBUS_HOSTS_FUNC_ForceMultipleCoil;
MODBUS_element.StartAddr = startAddr;
MODBUS_element.RegisterAmount = registerAmount;
MODBUS_element.ByteCount = ByteCount;
MODBUS_element.SendBytes = ByteCount + 9;
MODBUS_element.SendCount = SendCount;
if (MODBUS_QUEUE_In(MODBUS_queue , MODBUS_element))
return (TRUE);
return (FALSE);
}
BOOL MBHOSTS_PresetMultipleHoldingRegisters(uint8_t DeviceAddr , uint16_t startAddr , uint8_t registerAmount , int16_t Data_Buffer[] , uint8_t SendCount , uint8_t Reserved_Func , MODBUS_QUEUE_STRUCT *MODBUS_queue)
{
uint8_t k;
uint8_t ByteCount;
uint16_t crcData;
MODBUS_ELEMENT MODBUS_element;
memset(&MODBUS_element , 0x00 , sizeof(MODBUS_ELEMENT));
MODBUS_element.Data[0] = DeviceAddr;
MODBUS_element.Data[1] = MODBUS_HOSTS_FUNC_PresetMultipleHoldingRegisters;
MODBUS_element.Data[2] = startAddr >> 0x08;
MODBUS_element.Data[3] = startAddr & 0xFF;
MODBUS_element.Data[4] = registerAmount >> 0x08;
MODBUS_element.Data[5] = registerAmount & 0xFF;
ByteCount = registerAmount << 0x01;
MODBUS_element.Data[6] = ByteCount;
for (k = 0 ; k < ByteCount ; k++)
{
MODBUS_element.Data[7+2*k] = Data_Buffer[k] >> 0x08;
MODBUS_element.Data[7+2*k+1] = Data_Buffer[k] & 0xFF;
}
crcData = CRC16(MODBUS_element.Data , (ByteCount + 9) - 2);
MODBUS_element.Data[(ByteCount + 9) - 2] = crcData >> 0x08;
MODBUS_element.Data[(ByteCount + 9) - 1] = crcData & 0xFF;
MODBUS_element.DeviceAddr = DeviceAddr;
MODBUS_element.Func = MODBUS_HOSTS_FUNC_PresetMultipleHoldingRegisters;
MODBUS_element.Reserved = Reserved_Func;
MODBUS_element.StartAddr = startAddr;
MODBUS_element.RegisterAmount = registerAmount;
MODBUS_element.ByteCount = ByteCount;
MODBUS_element.SendBytes = ByteCount + 9;
MODBUS_element.SendCount = SendCount;
if (MODBUS_QUEUE_In(MODBUS_queue , MODBUS_element))
return (TRUE);
return (FALSE);
}
8、main.c
#define MBCOM1_MODBUS_QUEUE_LENGTH 20
#define MBCOM2_MODBUS_QUEUE_LENGTH 20
MODBUS_ELEMENT MBCOM1_MODBUS_ELEMENT[MBCOM1_MODBUS_QUEUE_LENGTH];
MODBUS_QUEUE_STRUCT MBCOM1_MODBUS_QUEUE_STRUCT;
MODBUS_QUEUE_STRUCT *MBCOM1_MODBUS_QUEUE;
MODBUS_ELEMENT MBCOM2_MODBUS_ELEMENT[MBCOM2_MODBUS_QUEUE_LENGTH];
MODBUS_QUEUE_STRUCT MBCOM2_MODBUS_QUEUE_STRUCT;
MODBUS_QUEUE_STRUCT *MBCOM2_MODBUS_QUEUE;
void MBCOM1_MODBUS_QUEUE_Init(void)
{
uint16_t i;
MBCOM1_MODBUS_QUEUE = &MBCOM1_MODBUS_QUEUE_STRUCT;
MBCOM1_MODBUS_QUEUE->size = MBCOM1_MODBUS_QUEUE_LENGTH;
MBCOM1_MODBUS_QUEUE->MODBUS_Element = MBCOM1_MODBUS_ELEMENT;
for (i = 0; i < MBCOM1_MODBUS_QUEUE->size ; i++)
{
MBCOM1_MODBUS_QUEUE->MODBUS_Element[i].Reserved = 0x00;
MBCOM1_MODBUS_QUEUE->MODBUS_Element[i].DeviceAddr = 0x00;
MBCOM1_MODBUS_QUEUE->MODBUS_Element[i].Func = 0x00;
MBCOM1_MODBUS_QUEUE->MODBUS_Element[i].StartAddr = 0x00;
MBCOM1_MODBUS_QUEUE->MODBUS_Element[i].RegisterAmount = 0x00;
MBCOM1_MODBUS_QUEUE->MODBUS_Element[i].ByteCount = 0x00;
MBCOM1_MODBUS_QUEUE->MODBUS_Element[i].SendBytes = 0x00;
MBCOM1_MODBUS_QUEUE->MODBUS_Element[i].SendCount = 0x00;
memset(MBCOM1_MODBUS_QUEUE->MODBUS_Element[i].Data , 0x00 , MODBUS_ELEMENT_DATA_LENGTH);
}
MBCOM1_MODBUS_QUEUE->front = 0x00;
MBCOM1_MODBUS_QUEUE->rear = 0x00;
}
void MBCOM2_MODBUS_QUEUE_Init(void)
{
uint16_t i;
MBCOM2_MODBUS_QUEUE = &MBCOM2_MODBUS_QUEUE_STRUCT;
MBCOM2_MODBUS_QUEUE->size = MBCOM2_MODBUS_QUEUE_LENGTH;
MBCOM2_MODBUS_QUEUE->MODBUS_Element = MBCOM2_MODBUS_ELEMENT;
for (i = 0; i < MBCOM2_MODBUS_QUEUE->size ; i++)
{
MBCOM2_MODBUS_QUEUE->MODBUS_Element[i].Reserved = 0x00;
MBCOM2_MODBUS_QUEUE->MODBUS_Element[i].DeviceAddr = 0x00;
MBCOM2_MODBUS_QUEUE->MODBUS_Element[i].Func = 0x00;
MBCOM2_MODBUS_QUEUE->MODBUS_Element[i].StartAddr = 0x00;
MBCOM2_MODBUS_QUEUE->MODBUS_Element[i].RegisterAmount = 0x00;
MBCOM2_MODBUS_QUEUE->MODBUS_Element[i].ByteCount = 0x00;
MBCOM2_MODBUS_QUEUE->MODBUS_Element[i].SendBytes = 0x00;
MBCOM2_MODBUS_QUEUE->MODBUS_Element[i].SendCount = 0x00;
memset(MBCOM2_MODBUS_QUEUE->MODBUS_Element[i].Data , 0x00 , MODBUS_ELEMENT_DATA_LENGTH);
}
MBCOM2_MODBUS_QUEUE->front = 0x00;
MBCOM2_MODBUS_QUEUE->rear = 0x00;
}
int main(void)
{
MBCOM1_MODBUS_QUEUE_Init();
MBCOM2_MODBUS_QUEUE_Init();
while (1)
{
MBHOSTS_ReadInputRegisters(1 , 0 , 10 , MBHOSTS_MAX_REPEAT_SEND_COUNT , MBCOM1_MODBUS_QUEUE);
MBHOSTS_ReadHoldingRegisters(2 , 0 , 10 , MBHOSTS_MAX_REPEAT_SEND_COUNT , MBCOM1_MODBUS_QUEUE);
MBHOSTS_ReadInputRegisters(1 , 0 , 10 , MBHOSTS_MAX_REPEAT_SEND_COUNT , MBCOM2_MODBUS_QUEUE);
MBHOSTS_ReadHoldingRegisters(2 , 0 , 10 , MBHOSTS_MAX_REPEAT_SEND_COUNT , MBCOM2_MODBUS_QUEUE);
}
}
本程序已经在很多工程项目上成功运用。