STM32F407单片机上开发MODBUS RTU 多主站程序(一)

       

  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);

     }
  
}

本程序已经在很多工程项目上成功运用。

源程序参见:STM32F407单片机上开发MODBUS RTU 多主站程序(二)

  • 8
    点赞
  • 78
    收藏
    觉得还不错? 一键收藏
  • 8
    评论

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论 8
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值