?? mb_pfunction.c
字號:
/****************************************Copyright (c)**************************************************
** 廣州周立功單片機發展有限公司
** 研 究 所
** 產品一部
**
** http://www.zlgmcu.com
**
**--------------文件信息--------------------------------------------------------------------------------
**文 件 名: MB_PFunction.c
**創 建 人: 周立山
**最后修改日期: 2005年7月29日
**描 述: MODBUS RTU 協議棧
**
**--------------歷史版本信息----------------------------------------------------------------------------
** 創建人: 周立山
** 版 本: 1.0a
** 日 期: 2005年7月29日
** 描 述: 原始版本
**
**------------------------------------------------------------------------------------------------------
** 修改人:
** 版 本:
** 日 期:
** 描 述:
**
**--------------當前版本修訂------------------------------------------------------------------------------
** 修改人:
** 日 期:
** 描 述:
**
**------------------------------------------------------------------------------------------------------
********************************************************************************************************/
#include "config.h"
#include "modbus.h"
//**************************************************
// 函數名稱：MB_GetDiscrete
// 輸入參數：Address，線圈地址
// 輸出參數：返回線圈值（0\1）
// 功能描述：獲取離散值函數，訪函數由用戶編寫
//**************************************************
uint8 MB_GetDiscrete(uint16 Address);
//**************************************************
// 函數名稱：MB_GetCoils
// 輸入參數：Address，線圈地址
// 輸出參數：返回線圈值（0\1）
// 功能描述：獲取線圈值函數，訪函數由用戶編寫
//**************************************************
uint8 MB_GetCoils(uint16 Address);
//**************************************************
// 函數名稱：MB_SetCoil
// 輸入參數：Address，線圈地址
// CoilValue,線圈值（0\1）
// 輸出參數：返回寄存器值
// 功能描述：設置線圈值函數，訪函數由用戶編寫
//**************************************************
uint8 MB_SetCoil(uint16 Address,uint8 CoilValue);
//**************************************************
// 函數名稱：MB_GetInputRegValue
// 輸入參數：Address，寄存器地址
// 輸出參數：返回寄存器值
// 功能描述：讀輸入寄存器值函數，訪函數由用戶編寫
//**************************************************
uint16 MB_GetInputRegValue(uint16 Address);
//**************************************************
// 函數名稱：MB_GetRegValue
// 輸入參數：Address，寄存器地址
// 輸出參數：返回寄存器值
// 功能描述：讀保持寄存器值函數，訪函數由用戶編寫
//**************************************************
uint16 MB_GetRegValue(uint16 Address);
//**************************************************
// 函數名稱：MB_SetRegValue
// 輸入參數：Address，寄存器地址
// Value，寫入的值
// 輸出參數：無
// 功能描述：寫保持寄存器值函數，訪函數由用戶編寫
//**************************************************
void MB_SetRegValue(uint16 Address,uint16 Value);
/****************************************************************************************/
// 函數名稱：FReadCoils
// 輸入參數：Response
// 輸出參數：無
// 功能描述：處理讀單線圈指令01
/***************************************************************************************/
void FReadCoils(PDU_RESPONSE *Response);
/****************************************************************************************/
// 函數名稱：FReadDiscreteInputs
// 輸入參數：Response
// 輸出參數：無
// 功能描述：處理讀離散輸入指令02
/***************************************************************************************/
void FReadDiscreteInputs(PDU_RESPONSE *Response);
/****************************************************************************************/
// 函數名稱：FReadHoldingReg
// 輸入參數：Response
// 輸出參數：無
// 功能描述：處理讀保持寄存器指令03
/****************************************************************************************/
void FReadHoldingReg(PDU_RESPONSE *Response);
/****************************************************************************************/
// 函數名稱：FReadInputReg
// 輸入參數：Response
// 輸出參數：無
// 功能描述：處理讀輸入寄存器指令04
/****************************************************************************************/
void FReadInputReg(PDU_RESPONSE *Response);
/****************************************************************************************/
// 函數名稱：FWriteSingleCoil
// 輸入參數：Response
// 輸出參數：無
// 功能描述：處理寫單線圈指令05
/****************************************************************************************/
void FWriteSingleCoil(PDU_RESPONSE *Response);
/****************************************************************************************/
// 函數名稱：FWriteSingleReg
// 輸入參數：Response
// 輸出參數：無
// 功能描述：處理寫單線圈指令06
/****************************************************************************************/
void FWriteSingleReg(PDU_RESPONSE *Response);
/****************************************************************************************/
// 函數名稱：FWriteMultipleCoils
// 輸入參數：Response
// 輸出參數：無
// 功能描述：處理寫多線圈指令15
/****************************************************************************************/
void FWriteMultipleCoils(PDU_RESPONSE *Response);
/****************************************************************************************/
// 函數名稱：FWriteMultipleReg
// 輸入參數：Response
// 輸出參數：無
// 功能描述：處理寫多寄存器指令16
/****************************************************************************************/
void FWriteMultipleReg(PDU_RESPONSE *Response);
/****************************************************************************************/
// 函數名稱：FMaskWriteReg
// 輸入參數：Response
// 輸出參數：無
// 功能描述：處理屏蔽寄存器指令22
/****************************************************************************************/
void FMaskWriteReg(PDU_RESPONSE *Response);
/****************************************************************************************/
// 函數名稱：FRWMultipleReg
// 輸入參數：Response
// 輸出參數：無
// 功能描述：處理讀寫多寄存器指令23
/****************************************************************************************/
void FRWMultipleReg(PDU_RESPONSE *Response);
void FTest(PDU_RESPONSE *Response){}
AT_CODE FUNCTION_ARRAY FCodeHandleArray[MAX_FUNCTION]={
#if READ_COILS_EN > 0
{0x01,FReadCoils}, // 讀線圈
#endif
#if READ_DIS_INPUT_EN > 0
{0x02,FReadDiscreteInputs}, // 讀離散量輸入
#endif
#if READ_HOLD_REG_EN > 0
{0x03,FReadHoldingReg}, // 讀保持寄存器
#endif
#if READ_INPUT_REG_EN > 0
{0x04,FReadInputReg}, // 讀輸入寄存器
#endif
#if WRITE_SING_COIL_EN > 0
{0x05,FWriteSingleCoil}, // 寫單個線圈
#endif
#if WRITE_SING_REG_EN > 0
{0x06,FWriteSingleReg}, // 寫單個寄存器
#endif
#if WRITE_MULT_COIL_EN > 0
{0x0f,FWriteMultipleCoils}, // 寫多個線圈
#endif
#if WRITE_MULT_REG_EN > 0
{0x10,FWriteMultipleReg}, // 寫多個寄存器
#endif
#if MASK_WRITE_REG_EN > 0
{0x16,FMaskWriteReg}, // 處理屏蔽寄存器指令
#endif
#if READ_WRITE_REG_EN > 0
{0x17,FRWMultipleReg}, // 讀寫多個寄存器
#endif
{0x00,FTest} // 測試功能代碼
};
#if READ_DIS_INPUT_EN
//************************************************************************************
// 函數名稱：ReadDiscreteInputs
// 輸入參數：CoilsDataPtr，存放離散輸入數據指針
// StAddr,離散的起始地址
// Quantity,離散的數量
// 輸出參數：正常返回TRUE,出錯返回FALSE。
// 功能描述：讀離散輸入操作函數
//************************************************************************************
uint8 ReadDiscreteInputs(uint8 *CoilsDataPtr,uint16 StAddr ,uint16 Quantity)
{
uint8 *CoilsInByte;
uint8 offset;
uint16 i=0 ;
CoilsInByte = CoilsDataPtr;
while(i<Quantity)
{
*CoilsInByte = 0;
for(offset=0;offset<8;offset++,i++) // 將線圈值寫入一個字節
{
if(i<Quantity)
{
*CoilsInByte |= MB_GetDiscrete(StAddr+i)<<offset;
}
}
CoilsInByte++;
}
return TRUE;
}
#endif
#if READ_COILS_EN
//************************************************************************************
// 函數名稱：ReadCoils
// 輸入參數：CoilsDataPtr，存放線圈數據指針
// StAddr,線圈的起始地址
// Quantity,線圈的數量
// 輸出參數：正常返回TRUE,出錯返回FALSE。
// 功能描述：讀多線圈操作函數
//************************************************************************************
uint8 ReadCoils(uint8 *CoilsDataPtr,uint16 StAddr ,uint16 Quantity)
{
uint8 *CoilsInByte;
uint8 offset;
uint16 i=0 ;
CoilsInByte = CoilsDataPtr;
while(i<Quantity)
{
*CoilsInByte = 0;
for(offset=0;offset<8;offset++,i++) // 將線圈值寫入一個字節
{
if(i<Quantity)
{
*CoilsInByte |= MB_GetCoils(StAddr+i)<<offset;
}
}
CoilsInByte++;
}
return TRUE;
}
#endif
#if WRITE_SING_COIL_EN
//************************************************************************************
// 函數名稱：WriteSingleCoil
// 輸入參數：DataPtr,數據指針，
// StAddr，寄存器起始地址
// Quantity，寄存器數量。
// 輸出參數：正常返回TRUE,出錯返回FALSE。
// 功能描述：寫單線圈處理函數
//************************************************************************************
uint8 WriteSingleCoil(uint16 OutputAddr,uint16 OutputValue)
{
return MB_SetCoil(OutputAddr,(OutputValue==0xff00)?1:0);
}
#endif
#if WRITE_MULT_COIL_EN
//************************************************************************************
// 函數名稱：WriteMultipleCoils
// 輸入參數：DataPtr,數據指針，
// StAddr，寄存器起始地址
// Quantity，寄存器數量。
// 輸出參數：正常返回TRUE,出錯返回FALSE。
// 功能描述：寫多線圈處理函數
//************************************************************************************
uint8 WriteMultipleCoils(uint8 *DataPtr,uint16 StAddr ,uint16 Quantity)
{
uint16 i;
uint8 CoilInByte;
for(i=0;i<Quantity;i++)
{
if((i%8)==0)
CoilInByte = *(DataPtr+(i/8));
if( FALSE == MB_SetCoil(StAddr+i,(CoilInByte>>(i%8))&0x01))
return FALSE;
}
return TRUE;
}
#endif
#if READ_INPUT_REG_EN
//************************************************************************************
// 函數名稱：ReadInputReg
// 輸入參數：DataPtr,數據指針，
// StAddr，寄存器起始地址
// Quantity，寄存器數量。
// 輸出參數：正常返回TRUE,出錯返回FALSE。
// 功能描述：讀輸入寄存器
//************************************************************************************
uint8 ReadInputReg(uint8 *DataPtr,uint16 StAddr ,uint16 Quantity)
{
uint8 i;
uint16 Value;
for(i=0;i<Quantity;i++)
{
Value = MB_GetInputRegValue(StAddr+i);
*(DataPtr+i*2) = (uint8)(Value>>8); // 先傳高位
*(DataPtr+i*2+1) = (uint8)Value; // 后傳低位
}
return TRUE;
}
#endif
#if (READ_HOLD_REG_EN | READ_WRITE_REG_EN)
//************************************************************************************
// 函數名稱：ReadHoldingReg
// 輸入參數：DataPtr,數據指針，16位數據高8位在低字節，低8位在高字節
// StAddr，寄存器起始地址
// Quantity，寄存器數量。
// 輸出參數：正常返回TRUE,出錯返回FALSE。
// 功能描述：讀寄存器處理函數
//************************************************************************************
uint8 ReadHoldingReg(uint8 *DataPtr,uint16 StAddr ,uint16 Quantity)
{
uint8 i;
uint16 Value;
for(i=0;i<Quantity;i++)
{
Value = MB_GetRegValue(StAddr+i);
*(DataPtr+i*2) = (uint8)(Value>>8); // 先傳高位
*(DataPtr+i*2+1) = (uint8)Value; // 后傳低位
}
return TRUE;
}
#endif
#if (WRITE_SING_REG_EN | WRITE_MULT_REG_EN |\
MASK_WRITE_REG_EN | READ_WRITE_REG_EN )
//************************************************************************************
// 函數名稱：WriteHoldingReg
// 輸入參數：DataPtr,數據指針，16位數據高8位在低字節，低8位在高字節
// StAddr，寄存器起始地址
// Quantity，寄存器數量。
// 輸出參數：正常返回TRUE,出錯返回FALSE。
// 功能描述：寫寄存器處理函數
//************************************************************************************
uint8 WriteHoldingReg(uint8 *KeepDataPtr,uint16 StAddr ,uint16 Quantity)
{
uint8 i;
uint16 Value;
for(i=0;i<Quantity;i++)
{
Value = (*(KeepDataPtr+i*2)<<8)|(*(KeepDataPtr+i*2+1));
MB_SetRegValue(StAddr+i,Value);
}
return TRUE;
}
#endif
/****************************************************************************************/
// 函數名稱：FReadCoils
// 輸入參數：Response，為PDU_RESPONSE類型的指針，PDU_RESPONSE：
// typedef struct __PDU_RESPONSE{
// uint8* PDUDataPtr; 請求數據指針,功能代碼處理函數必需將處理的數據包存在該指針的開始位始
// uint8 PDUByteLength;請求數據數長度
// uint8 ExceptionCode;僅為輸出錯異常代碼，正常操作設為0
// }PDU_RESPONSE
// 輸出參數：無
// 功能描述：處理讀多線圈指令01
/***************************************************************************************/
#if READ_COILS_EN >0
void FReadCoils(PDU_RESPONSE *Response)
{
uint8 * PDUPtr;
uint16 StAddr ,Quantity;
// 從請求PDU中提取相關參數
PDUPtr = Response->PDUDataPtr;
StAddr = PDUPtr[1]<<8|PDUPtr[2];
Quantity = PDUPtr[3]<<8|PDUPtr[4];
Response->PDUByteLength = 2 + Quantity/8+((Quantity%8)?1:0) ; // 正常返回的數據長度
if((Quantity>=0x001)&&(Quantity<=0x07d0))
{
if((StAddr<END_COILS_ADDR)&&((StAddr+Quantity)<=END_COILS_ADDR))
{
if(ReadCoils(PDUPtr+2,StAddr,Quantity))
{
*(PDUPtr+1) = Quantity/8+(Quantity%8)?1:0; // 字節數
?? 快捷鍵說明
復制代碼
Ctrl + C
搜索代碼
Ctrl + F
全屏模式
F11
切換主題
Ctrl + Shift + D
顯示快捷鍵
?
增大字號
Ctrl + =
減小字號
Ctrl + -