forked from xuos/xiuos
modify s7 read value num
This commit is contained in:
Wien.b
parent
62e3006e1a
commit
38481e2ae2
|
|
@ -1,4 +1,5 @@
|
||||||
SRC_DIR := plc_demo
|
SRC_DIR := plc_demo
|
||||||
|
SRC_DIR += modbus_tcp_server_demo
|
||||||
|
|
||||||
ifeq ($(CONFIG_RESOURCES_LWIP),y)
|
ifeq ($(CONFIG_RESOURCES_LWIP),y)
|
||||||
|
|
||||||
|
|
|
||||||
|
|
@ -0,0 +1,3 @@
|
||||||
|
SRC_FILES := freemodbustcpserver.c
|
||||||
|
|
||||||
|
include $(KERNEL_ROOT)/compiler.mk
|
||||||
|
|
@ -0,0 +1,55 @@
|
||||||
|
/*
|
||||||
|
* Copyright (c) 2022 AIIT XUOS Lab
|
||||||
|
* XiUOS is licensed under Mulan PSL v2.
|
||||||
|
* You can use this software according to the terms and conditions of the Mulan PSL v2.
|
||||||
|
* You may obtain a copy of Mulan PSL v2 at:
|
||||||
|
* http://license.coscl.org.cn/MulanPSL2
|
||||||
|
* THIS SOFTWARE IS PROVIDED ON AN "AS IS" BASIS, WITHOUT WARRANTIES OF ANY KIND,
|
||||||
|
* EITHER EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO NON-INFRINGEMENT,
|
||||||
|
* MERCHANTABILITY OR FIT FOR A PARTICULAR PURPOSE.
|
||||||
|
* See the Mulan PSL v2 for more details.
|
||||||
|
*/
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @file freemodbustcpserver.c
|
||||||
|
* @brief PLC fREEMODBUSTCP SERVER app
|
||||||
|
* @version 3.0
|
||||||
|
* @author AIIT XUOS Lab
|
||||||
|
* @date 2023.7.31
|
||||||
|
*/
|
||||||
|
|
||||||
|
#include <control.h>
|
||||||
|
|
||||||
|
void ControlMtcpsTest(void)
|
||||||
|
{
|
||||||
|
int i, j = 1;
|
||||||
|
int read_data_length = 0;
|
||||||
|
uint8_t read_data[128] = {0};
|
||||||
|
ControlProtocolType freemodbus_tcp_protocol = ControlProtocolFind();
|
||||||
|
if (NULL == freemodbus_tcp_protocol) {
|
||||||
|
printf("%s get freemodbus tcp protocol %p failed\n", __func__, freemodbus_tcp_protocol);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
printf("%s get freemodbus tcp protocol %p successfull\n", __func__, freemodbus_tcp_protocol);
|
||||||
|
|
||||||
|
printf("%4X %4X %4X\n",freemodbus_tcp_protocol->name,freemodbus_tcp_protocol->recipe,freemodbus_tcp_protocol->done);
|
||||||
|
|
||||||
|
if (CONTROL_REGISTERED == freemodbus_tcp_protocol->protocol_status) {
|
||||||
|
ControlProtocolOpen(freemodbus_tcp_protocol);
|
||||||
|
// for (;;) {
|
||||||
|
// read_data_length = ControlProtocolRead(modbus_tcp_protocol, read_data, sizeof(read_data));
|
||||||
|
// printf("%s read [%d] modbus tcp data %d using receipe file\n", __func__, i, read_data_length);
|
||||||
|
// if (read_data_length) {
|
||||||
|
// for (j = 0; j < read_data_length; j ++) {
|
||||||
|
// printf("j %d data 0x%x\n", j, read_data[j]);
|
||||||
|
// }
|
||||||
|
// }
|
||||||
|
// i++;
|
||||||
|
// memset(read_data, 0, sizeof(read_data));
|
||||||
|
PrivTaskDelay(10000);
|
||||||
|
// }
|
||||||
|
//ControlProtocolClose(modbus_tcp_protocol);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
PRIV_SHELL_CMD_FUNCTION(ControlMtcpsTest, M Demo, PRIV_SHELL_CMD_MAIN_ATTR);
|
||||||
|
|
@ -13,3 +13,12 @@ config CONTROL_PROTOCOL_MODBUS_UART
|
||||||
if CONTROL_PROTOCOL_MODBUS_UART
|
if CONTROL_PROTOCOL_MODBUS_UART
|
||||||
source "$APP_DIR/Framework/control/ipc_protocol/modbus_uart/Kconfig"
|
source "$APP_DIR/Framework/control/ipc_protocol/modbus_uart/Kconfig"
|
||||||
endif
|
endif
|
||||||
|
|
||||||
|
config CONTROL_PROTOCOL_FREEMODBUS_TCP_SERVER
|
||||||
|
bool "Using modbus_tcp_server control protocol"
|
||||||
|
default n
|
||||||
|
select CONTROL_USING_SOCKET
|
||||||
|
select LIB_USING_FREEMODBUS
|
||||||
|
if CONTROL_PROTOCOL_FREEMODBUS_TCP_SERVER
|
||||||
|
source "$APP_DIR/Framework/control/ipc_protocol/freemodbustcpserver/Kconfig"
|
||||||
|
endif
|
||||||
|
|
|
||||||
|
|
@ -6,5 +6,9 @@ ifeq ($(CONFIG_CONTROL_PROTOCOL_MODBUS_UART), y)
|
||||||
SRC_DIR := modbus_uart
|
SRC_DIR := modbus_uart
|
||||||
endif
|
endif
|
||||||
|
|
||||||
|
ifeq ($(CONFIG_CONTROL_PROTOCOL_FREEMODBUS_TCP_SERVER), y)
|
||||||
|
SRC_DIR := freemodbustcpserver
|
||||||
|
endif
|
||||||
|
|
||||||
include $(KERNEL_ROOT)/compiler.mk
|
include $(KERNEL_ROOT)/compiler.mk
|
||||||
|
|
||||||
|
|
|
||||||
|
|
@ -0,0 +1,3 @@
|
||||||
|
SRC_FILES := $(wildcard ./*.c)
|
||||||
|
|
||||||
|
include $(KERNEL_ROOT)/compiler.mk
|
||||||
|
|
@ -0,0 +1,281 @@
|
||||||
|
/*
|
||||||
|
* FreeModbus Libary: Win32 Demo Application
|
||||||
|
* Copyright (C) 2006 Christian Walter <wolti@sil.at>
|
||||||
|
*
|
||||||
|
* This library is free software; you can redistribute it and/or
|
||||||
|
* modify it under the terms of the GNU Lesser General Public
|
||||||
|
* License as published by the Free Software Foundation; either
|
||||||
|
* version 2.1 of the License, or (at your option) any later version.
|
||||||
|
*
|
||||||
|
* This library is distributed in the hope that it will be useful,
|
||||||
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||||
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
||||||
|
* Lesser General Public License for more details.
|
||||||
|
*
|
||||||
|
* You should have received a copy of the GNU Lesser General Public
|
||||||
|
* License along with this library; if not, write to the Free Software
|
||||||
|
* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
|
||||||
|
*
|
||||||
|
* File: $Id$
|
||||||
|
*/
|
||||||
|
|
||||||
|
/**********************************************************
|
||||||
|
* Linux TCP support.
|
||||||
|
* Based on Walter's project.
|
||||||
|
* Modified by Steven Guo <gotop167@163.com>
|
||||||
|
***********************************************************/
|
||||||
|
|
||||||
|
/* ----------------------- Standard C Libs includes --------------------------*/
|
||||||
|
#include <stdio.h>
|
||||||
|
#include <string.h>
|
||||||
|
#include <stdlib.h>
|
||||||
|
#include <unistd.h>
|
||||||
|
#include <errno.h>
|
||||||
|
#include <pthread.h>
|
||||||
|
#include <signal.h>
|
||||||
|
|
||||||
|
/* ----------------------- Modbus includes ----------------------------------*/
|
||||||
|
#include "mb.h"
|
||||||
|
#include "mbport.h"
|
||||||
|
#include "freemodbustcpserver.h"
|
||||||
|
|
||||||
|
/* ----------------------- Defines ------------------------------------------*/
|
||||||
|
#define PROG "freemodbus"
|
||||||
|
|
||||||
|
#define REG_INPUT_START 1000
|
||||||
|
#define REG_INPUT_NREGS 4
|
||||||
|
#define REG_HOLDING_START 2000
|
||||||
|
#define REG_HOLDING_NREGS 10
|
||||||
|
|
||||||
|
/* ----------------------- Static variables ---------------------------------*/
|
||||||
|
static USHORT usRegInputStart = REG_INPUT_START;
|
||||||
|
static USHORT usRegInputBuf[REG_INPUT_NREGS];
|
||||||
|
static USHORT usRegHoldingStart = REG_HOLDING_START;
|
||||||
|
static USHORT usRegHoldingBuf[REG_HOLDING_NREGS];
|
||||||
|
static pthread_mutex_t xLock;
|
||||||
|
static enum ThreadState
|
||||||
|
{
|
||||||
|
STOPPED,
|
||||||
|
RUNNING,
|
||||||
|
SHUTDOWN
|
||||||
|
} ePollThreadState;
|
||||||
|
|
||||||
|
/* ----------------------- Static functions ---------------------------------*/
|
||||||
|
static BOOL bCreatePollingThread( void );
|
||||||
|
static enum ThreadState eGetPollingThreadState( void );
|
||||||
|
static void eSetPollingThreadState( enum ThreadState eNewState );
|
||||||
|
static void* pvPollingThread( void *pvParameter );
|
||||||
|
|
||||||
|
/* ----------------------- Start implementation -----------------------------*/
|
||||||
|
int MBServer()
|
||||||
|
{
|
||||||
|
int iExitCode;
|
||||||
|
CHAR cCh;
|
||||||
|
BOOL bDoExit;
|
||||||
|
usRegHoldingBuf[5] = 123;
|
||||||
|
usRegHoldingBuf[7] = 234;
|
||||||
|
if( eMBTCPInit( MB_TCP_PORT_USE_DEFAULT ) != MB_ENOERR )
|
||||||
|
{
|
||||||
|
fprintf( stderr, "%s: can't initialize modbus stack!\r\n", PROG );
|
||||||
|
iExitCode = EXIT_FAILURE;
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
eSetPollingThreadState( STOPPED );
|
||||||
|
/* CLI interface. */
|
||||||
|
if( bCreatePollingThread( ) != TRUE )
|
||||||
|
{
|
||||||
|
printf( "Can't start protocol stack! Already running?\r\n" );
|
||||||
|
}
|
||||||
|
}
|
||||||
|
printf("%d %d\n",sizeof(usRegHoldingBuf),__LINE__);
|
||||||
|
while(1)
|
||||||
|
{
|
||||||
|
for(int i =0; i<sizeof(usRegHoldingBuf)/2;i++)
|
||||||
|
{
|
||||||
|
printf("poll recv is %3d\n", usRegHoldingBuf[i]);
|
||||||
|
MdelayKTask(100);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
return iExitCode;
|
||||||
|
}
|
||||||
|
|
||||||
|
BOOL bCreatePollingThread( void )
|
||||||
|
{
|
||||||
|
BOOL bResult;
|
||||||
|
pthread_t xThread;
|
||||||
|
if( eGetPollingThreadState( ) == STOPPED )
|
||||||
|
{
|
||||||
|
if( pthread_create( &xThread, NULL, pvPollingThread, NULL ) != 0 )
|
||||||
|
{
|
||||||
|
/* Can't create the polling thread. */
|
||||||
|
bResult = FALSE;
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
bResult = TRUE;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
bResult = FALSE;
|
||||||
|
}
|
||||||
|
return bResult;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
void* pvPollingThread( void *pvParameter )
|
||||||
|
{
|
||||||
|
eSetPollingThreadState( RUNNING );
|
||||||
|
|
||||||
|
if( eMBEnable( ) == MB_ENOERR )
|
||||||
|
{
|
||||||
|
do
|
||||||
|
{
|
||||||
|
if( eMBPoll( ) != MB_ENOERR )
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
while( eGetPollingThreadState( ) != SHUTDOWN );
|
||||||
|
}
|
||||||
|
|
||||||
|
( void )eMBDisable( );
|
||||||
|
|
||||||
|
eSetPollingThreadState( STOPPED );
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
enum ThreadState eGetPollingThreadState( )
|
||||||
|
{
|
||||||
|
enum ThreadState eCurState;
|
||||||
|
|
||||||
|
( void )pthread_mutex_lock( &xLock );
|
||||||
|
eCurState = ePollThreadState;
|
||||||
|
( void )pthread_mutex_unlock( &xLock );
|
||||||
|
|
||||||
|
return eCurState;
|
||||||
|
}
|
||||||
|
|
||||||
|
void eSetPollingThreadState( enum ThreadState eNewState )
|
||||||
|
{
|
||||||
|
( void )pthread_mutex_lock( &xLock );
|
||||||
|
ePollThreadState = eNewState;
|
||||||
|
( void )pthread_mutex_unlock( &xLock );
|
||||||
|
}
|
||||||
|
|
||||||
|
eMBErrorCode eMBRegInputCB( UCHAR * pucRegBuffer, USHORT usAddress, USHORT usNRegs )
|
||||||
|
{
|
||||||
|
eMBErrorCode eStatus = MB_ENOERR;
|
||||||
|
int iRegIndex;
|
||||||
|
|
||||||
|
if( ( usAddress >= REG_INPUT_START )
|
||||||
|
&& ( usAddress + usNRegs <= REG_INPUT_START + REG_INPUT_NREGS ) )
|
||||||
|
{
|
||||||
|
iRegIndex = ( int )( usAddress - usRegInputStart );
|
||||||
|
while( usNRegs > 0 )
|
||||||
|
{
|
||||||
|
*pucRegBuffer++ = ( unsigned char )( usRegInputBuf[iRegIndex] >> 8 );
|
||||||
|
*pucRegBuffer++ = ( unsigned char )( usRegInputBuf[iRegIndex] & 0xFF );
|
||||||
|
iRegIndex++;
|
||||||
|
usNRegs--;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
eStatus = MB_ENOREG;
|
||||||
|
}
|
||||||
|
|
||||||
|
return eStatus;
|
||||||
|
}
|
||||||
|
|
||||||
|
eMBErrorCode eMBRegHoldingCB( UCHAR * pucRegBuffer, USHORT usAddress, USHORT usNRegs, eMBRegisterMode eMode )
|
||||||
|
{
|
||||||
|
eMBErrorCode eStatus = MB_ENOERR;
|
||||||
|
int iRegIndex;
|
||||||
|
|
||||||
|
if( ( usAddress >= REG_HOLDING_START ) &&
|
||||||
|
( usAddress + usNRegs <= REG_HOLDING_START + REG_HOLDING_NREGS ) )
|
||||||
|
{
|
||||||
|
iRegIndex = ( int )( usAddress - usRegHoldingStart );
|
||||||
|
switch ( eMode )
|
||||||
|
{
|
||||||
|
/* Pass current register values to the protocol stack. */
|
||||||
|
case MB_REG_READ:
|
||||||
|
while( usNRegs > 0 )
|
||||||
|
{
|
||||||
|
*pucRegBuffer++ = ( UCHAR ) ( usRegHoldingBuf[iRegIndex] >> 8 );
|
||||||
|
*pucRegBuffer++ = ( UCHAR ) ( usRegHoldingBuf[iRegIndex] & 0xFF );
|
||||||
|
iRegIndex++;
|
||||||
|
usNRegs--;
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
|
||||||
|
/* Update current register values with new values from the
|
||||||
|
* protocol stack. */
|
||||||
|
case MB_REG_WRITE:
|
||||||
|
while( usNRegs > 0 )
|
||||||
|
{
|
||||||
|
usRegHoldingBuf[iRegIndex] = *pucRegBuffer++ << 8;
|
||||||
|
usRegHoldingBuf[iRegIndex] |= *pucRegBuffer++;
|
||||||
|
iRegIndex++;
|
||||||
|
usNRegs--;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
eStatus = MB_ENOREG;
|
||||||
|
}
|
||||||
|
return eStatus;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
eMBErrorCode eMBRegCoilsCB( UCHAR * pucRegBuffer, USHORT usAddress, USHORT usNCoils, eMBRegisterMode eMode )
|
||||||
|
{
|
||||||
|
return MB_ENOREG;
|
||||||
|
}
|
||||||
|
|
||||||
|
eMBErrorCode eMBRegDiscreteCB( UCHAR * pucRegBuffer, USHORT usAddress, USHORT usNDiscrete )
|
||||||
|
{
|
||||||
|
return MB_ENOREG;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @description: Modbus Tcp Server Open
|
||||||
|
* @param control_protocol - control protocol pointer
|
||||||
|
* @return success : 0 error
|
||||||
|
*/
|
||||||
|
int FreeModbusTcpOpen(struct ControlProtocol *control_protocol)
|
||||||
|
{
|
||||||
|
ControlProtocolOpenDef(control_protocol);
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static struct ControlDone FreeModbusTcp_protocol_done =
|
||||||
|
{
|
||||||
|
._open = FreeModbusTcpOpen,
|
||||||
|
._close = NULL,
|
||||||
|
._read = NULL,
|
||||||
|
._write = NULL,
|
||||||
|
._ioctl = NULL,
|
||||||
|
};
|
||||||
|
|
||||||
|
void *ReceivePlcDataTask(void *parameter)
|
||||||
|
{
|
||||||
|
MBServer();
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @description: Modbus Tcp Server Init
|
||||||
|
* @param p_recipe - recipe pointer
|
||||||
|
* @return success : 0 error : -1
|
||||||
|
*/
|
||||||
|
int FreeModbusTcpServerInit(struct ControlRecipe *p_recipe)
|
||||||
|
{
|
||||||
|
p_recipe->done = &FreeModbusTcp_protocol_done;
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
@ -0,0 +1,6 @@
|
||||||
|
#ifndef FREEMODBUSTCP_H
|
||||||
|
#define FREEMODBUSTCP_H
|
||||||
|
|
||||||
|
#include <control_def.h>
|
||||||
|
|
||||||
|
#endif
|
||||||
|
|
@ -0,0 +1,83 @@
|
||||||
|
/*
|
||||||
|
* FreeModbus Libary: BSD Socket Library Port
|
||||||
|
* Copyright (C) 2006 Christian Walter <wolti@sil.at>
|
||||||
|
*
|
||||||
|
* This library is free software; you can redistribute it and/or
|
||||||
|
* modify it under the terms of the GNU Lesser General Public
|
||||||
|
* License as published by the Free Software Foundation; either
|
||||||
|
* version 2.1 of the License, or (at your option) any later version.
|
||||||
|
*
|
||||||
|
* This library is distributed in the hope that it will be useful,
|
||||||
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||||
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
||||||
|
* Lesser General Public License for more details.
|
||||||
|
*
|
||||||
|
* You should have received a copy of the GNU Lesser General Public
|
||||||
|
* License along with this library; if not, write to the Free Software
|
||||||
|
* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
|
||||||
|
*
|
||||||
|
* File: $Id$
|
||||||
|
*/
|
||||||
|
|
||||||
|
/**********************************************************
|
||||||
|
* Linux TCP support.
|
||||||
|
* Based on Walter's project.
|
||||||
|
* Modified by Steven Guo <gotop167@163.com>
|
||||||
|
***********************************************************/
|
||||||
|
|
||||||
|
#ifndef _PORT_H
|
||||||
|
#define _PORT_H
|
||||||
|
|
||||||
|
|
||||||
|
#include <assert.h>
|
||||||
|
|
||||||
|
#define INLINE
|
||||||
|
#define PR_BEGIN_EXTERN_C extern "C" {
|
||||||
|
#define PR_END_EXTERN_C }
|
||||||
|
|
||||||
|
#ifdef __cplusplus
|
||||||
|
PR_BEGIN_EXTERN_C
|
||||||
|
#endif
|
||||||
|
/* ----------------------- Defines ------------------------------------------*/
|
||||||
|
#define ENTER_CRITICAL_SECTION( )
|
||||||
|
#define EXIT_CRITICAL_SECTION( )
|
||||||
|
#define MB_PORT_HAS_CLOSE 1
|
||||||
|
#ifndef TRUE
|
||||||
|
#define TRUE 1
|
||||||
|
#endif
|
||||||
|
#ifndef FALSE
|
||||||
|
#define FALSE 0
|
||||||
|
#endif
|
||||||
|
/* ----------------------- Type definitions ---------------------------------*/
|
||||||
|
typedef int SOCKET;
|
||||||
|
|
||||||
|
#define SOCKET_ERROR (-1)
|
||||||
|
#define INVALID_SOCKET (~0)
|
||||||
|
|
||||||
|
|
||||||
|
typedef char BOOL;
|
||||||
|
typedef unsigned char UCHAR;
|
||||||
|
typedef unsigned char BYTE;
|
||||||
|
typedef char CHAR;
|
||||||
|
typedef unsigned short USHORT;
|
||||||
|
typedef short SHORT;
|
||||||
|
|
||||||
|
typedef unsigned long ULONG;
|
||||||
|
typedef long LONG;
|
||||||
|
typedef enum
|
||||||
|
{
|
||||||
|
MB_LOG_DEBUG,
|
||||||
|
MB_LOG_INFO,
|
||||||
|
MB_LOG_WARN,
|
||||||
|
MB_LOG_ERROR
|
||||||
|
} eMBPortLogLevel;
|
||||||
|
|
||||||
|
/* ----------------------- Function prototypes ------------------------------*/
|
||||||
|
|
||||||
|
void TcpvMBPortLog( eMBPortLogLevel eLevel, const CHAR * szModule, const CHAR * szFmt,
|
||||||
|
... );
|
||||||
|
|
||||||
|
#ifdef __cplusplus
|
||||||
|
PR_END_EXTERN_C
|
||||||
|
#endif
|
||||||
|
#endif
|
||||||
|
|
@ -0,0 +1,72 @@
|
||||||
|
/*
|
||||||
|
* FreeModbus Libary: Win32 Port
|
||||||
|
* Copyright (C) 2006 Christian Walter <wolti@sil.at>
|
||||||
|
*
|
||||||
|
* This library is free software; you can redistribute it and/or
|
||||||
|
* modify it under the terms of the GNU Lesser General Public
|
||||||
|
* License as published by the Free Software Foundation; either
|
||||||
|
* version 2.1 of the License, or (at your option) any later version.
|
||||||
|
*
|
||||||
|
* This library is distributed in the hope that it will be useful,
|
||||||
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||||
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
||||||
|
* Lesser General Public License for more details.
|
||||||
|
*
|
||||||
|
* You should have received a copy of the GNU Lesser General Public
|
||||||
|
* License along with this library; if not, write to the Free Software
|
||||||
|
* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
|
||||||
|
*
|
||||||
|
* File: $Id$
|
||||||
|
*/
|
||||||
|
|
||||||
|
/**********************************************************
|
||||||
|
* Linux TCP support.
|
||||||
|
* Based on Walter's project.
|
||||||
|
* Modified by Steven Guo <gotop167@163.com>
|
||||||
|
***********************************************************/
|
||||||
|
|
||||||
|
/* ----------------------- Modbus includes ----------------------------------*/
|
||||||
|
#include "mb.h"
|
||||||
|
#include "mbport.h"
|
||||||
|
|
||||||
|
/* ----------------------- Variables ----------------------------------------*/
|
||||||
|
static eMBEventType eQueuedEvent;
|
||||||
|
static BOOL xEventInQueue;
|
||||||
|
|
||||||
|
/* ----------------------- Function prototypes ------------------------------*/
|
||||||
|
BOOL xMBPortTCPPool( void );
|
||||||
|
|
||||||
|
/* ----------------------- Start implementation -----------------------------*/
|
||||||
|
BOOL
|
||||||
|
xMBPortEventInit( void )
|
||||||
|
{
|
||||||
|
xEventInQueue = FALSE;
|
||||||
|
return TRUE;
|
||||||
|
}
|
||||||
|
|
||||||
|
BOOL
|
||||||
|
xMBPortEventPost( eMBEventType eEvent )
|
||||||
|
{
|
||||||
|
xEventInQueue = TRUE;
|
||||||
|
eQueuedEvent = eEvent;
|
||||||
|
return TRUE;
|
||||||
|
}
|
||||||
|
|
||||||
|
BOOL
|
||||||
|
xMBPortEventGet( eMBEventType * eEvent )
|
||||||
|
{
|
||||||
|
BOOL xEventHappened = FALSE;
|
||||||
|
|
||||||
|
if( xEventInQueue )
|
||||||
|
{
|
||||||
|
*eEvent = eQueuedEvent;
|
||||||
|
xEventInQueue = FALSE;
|
||||||
|
xEventHappened = TRUE;
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
/* We can't do anything with errors from the pooling module. */
|
||||||
|
( void )xMBPortTCPPool( );
|
||||||
|
}
|
||||||
|
return xEventHappened;
|
||||||
|
}
|
||||||
|
|
@ -0,0 +1,69 @@
|
||||||
|
/*
|
||||||
|
* FreeModbus Libary: Win32 Port
|
||||||
|
* Copyright (C) 2006 Christian Walter <wolti@sil.at>
|
||||||
|
*
|
||||||
|
* This library is free software; you can redistribute it and/or
|
||||||
|
* modify it under the terms of the GNU Lesser General Public
|
||||||
|
* License as published by the Free Software Foundation; either
|
||||||
|
* version 2.1 of the License, or (at your option) any later version.
|
||||||
|
*
|
||||||
|
* This library is distributed in the hope that it will be useful,
|
||||||
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||||
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
||||||
|
* Lesser General Public License for more details.
|
||||||
|
*
|
||||||
|
* You should have received a copy of the GNU Lesser General Public
|
||||||
|
* License along with this library; if not, write to the Free Software
|
||||||
|
* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
|
||||||
|
*
|
||||||
|
* File: $Id$
|
||||||
|
*/
|
||||||
|
|
||||||
|
/**********************************************************
|
||||||
|
* Linux TCP support.
|
||||||
|
* Based on Walter's project.
|
||||||
|
* Modified by Steven Guo <gotop167@163.com>
|
||||||
|
***********************************************************/
|
||||||
|
|
||||||
|
#include <stdio.h>
|
||||||
|
#include <stdlib.h>
|
||||||
|
#include <stdarg.h>
|
||||||
|
|
||||||
|
#include "port.h"
|
||||||
|
|
||||||
|
/* ----------------------- Modbus includes ----------------------------------*/
|
||||||
|
#include "mb.h"
|
||||||
|
#include "mbport.h"
|
||||||
|
#include "mbconfig.h"
|
||||||
|
|
||||||
|
|
||||||
|
BOOL
|
||||||
|
prvMBTCPPortAddressToString( SOCKET xSocket, CHAR * szAddr, USHORT usBufSize )
|
||||||
|
{
|
||||||
|
return TRUE;
|
||||||
|
}
|
||||||
|
|
||||||
|
CHAR *
|
||||||
|
prvMBTCPPortFrameToString( UCHAR * pucFrame, USHORT usFrameLen )
|
||||||
|
{
|
||||||
|
return NULL;
|
||||||
|
}
|
||||||
|
|
||||||
|
CHAR *
|
||||||
|
WsaError2String( int iError )
|
||||||
|
{
|
||||||
|
return NULL;
|
||||||
|
}
|
||||||
|
|
||||||
|
void
|
||||||
|
vMBPortLog( eMBPortLogLevel eLevel, const CHAR * szModule, const CHAR * szFmt, ... )
|
||||||
|
{
|
||||||
|
va_list args;
|
||||||
|
static const CHAR *arszLevel2Str[] = { "DEBUG", "INFO", "WARN", "ERROR" };
|
||||||
|
|
||||||
|
fprintf( stderr, "%s: %s: ", arszLevel2Str[eLevel], szModule );
|
||||||
|
|
||||||
|
va_start( args, szFmt );
|
||||||
|
fprintf( stderr, szFmt, args );
|
||||||
|
va_end( args );
|
||||||
|
}
|
||||||
|
|
@ -0,0 +1,367 @@
|
||||||
|
/*
|
||||||
|
* FreeModbus Libary: Win32 Port
|
||||||
|
* Copyright (C) 2006 Christian Walter <wolti@sil.at>
|
||||||
|
*
|
||||||
|
* This library is free software; you can redistribute it and/or
|
||||||
|
* modify it under the terms of the GNU Lesser General Public
|
||||||
|
* License as published by the Free Software Foundation; either
|
||||||
|
* version 2.1 of the License, or (at your option) any later version.
|
||||||
|
*
|
||||||
|
* This library is distributed in the hope that it will be useful,
|
||||||
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||||
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
||||||
|
* Lesser General Public License for more details.
|
||||||
|
*
|
||||||
|
* You should have received a copy of the GNU Lesser General Public
|
||||||
|
* License along with this library; if not, write to the Free Software
|
||||||
|
* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
|
||||||
|
*
|
||||||
|
* File: $Id$
|
||||||
|
*/
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Design Notes:
|
||||||
|
*
|
||||||
|
* The xMBPortTCPInit function allocates a socket and binds the socket to
|
||||||
|
* all available interfaces ( bind with INADDR_ANY ). In addition it
|
||||||
|
* creates an array of event objects which is used to check the state of
|
||||||
|
* the clients. On event object is used to handle new connections or
|
||||||
|
* closed ones. The other objects are used on a per client basis for
|
||||||
|
* processing.
|
||||||
|
*/
|
||||||
|
|
||||||
|
/**********************************************************
|
||||||
|
* Linux TCP support.
|
||||||
|
* Based on Walter's project.
|
||||||
|
* Modified by Steven Guo <gotop167@163.com>
|
||||||
|
***********************************************************/
|
||||||
|
|
||||||
|
#include <stdio.h>
|
||||||
|
#include <sys/types.h>
|
||||||
|
#include <sockets.h>
|
||||||
|
#include <string.h>
|
||||||
|
#include <unistd.h>
|
||||||
|
#include <errno.h>
|
||||||
|
#include <time.h>
|
||||||
|
#include "port.h"
|
||||||
|
|
||||||
|
/* ----------------------- Modbus includes ----------------------------------*/
|
||||||
|
#include "mb.h"
|
||||||
|
#include "mbport.h"
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
/* ----------------------- MBAP Header --------------------------------------*/
|
||||||
|
#define MB_TCP_UID 6
|
||||||
|
#define MB_TCP_LEN 4
|
||||||
|
#define MB_TCP_FUNC 7
|
||||||
|
|
||||||
|
/* ----------------------- Defines -----------------------------------------*/
|
||||||
|
#define MB_TCP_DEFAULT_PORT 502 /* TCP listening port. */
|
||||||
|
#define MB_TCP_POOL_TIMEOUT 50 /* pool timeout for event waiting. */
|
||||||
|
#define MB_TCP_READ_TIMEOUT 1000 /* Maximum timeout to wait for packets. */
|
||||||
|
#define MB_TCP_READ_CYCLE 100 /* Time between checking for new data. */
|
||||||
|
|
||||||
|
#define MB_TCP_DEBUG 1 /* Set to 1 for additional debug output. */
|
||||||
|
|
||||||
|
#define MB_TCP_BUF_SIZE ( 256 + 7 ) /* Must hold a complete Modbus TCP frame. */
|
||||||
|
|
||||||
|
#define EV_CONNECTION 0
|
||||||
|
#define EV_CLIENT 1
|
||||||
|
#define EV_NEVENTS EV_CLIENT + 1
|
||||||
|
|
||||||
|
/* ----------------------- Static variables ---------------------------------*/
|
||||||
|
SOCKET xListenSocket;
|
||||||
|
SOCKET xClientSocket = INVALID_SOCKET;
|
||||||
|
static fd_set allset;
|
||||||
|
|
||||||
|
static UCHAR aucTCPBuf[MB_TCP_BUF_SIZE];
|
||||||
|
static USHORT usTCPBufPos;
|
||||||
|
static USHORT usTCPFrameBytesLeft;
|
||||||
|
|
||||||
|
/* ----------------------- External functions -------------------------------*/
|
||||||
|
CHAR *WsaError2String( int dwError );
|
||||||
|
|
||||||
|
/* ----------------------- Static functions ---------------------------------*/
|
||||||
|
BOOL prvMBTCPPortAddressToString( SOCKET xSocket, CHAR * szAddr, USHORT usBufSize );
|
||||||
|
CHAR *prvMBTCPPortFrameToString( UCHAR * pucFrame, USHORT usFrameLen );
|
||||||
|
static BOOL prvbMBPortAcceptClient( void );
|
||||||
|
static void prvvMBPortReleaseClient( void );
|
||||||
|
|
||||||
|
|
||||||
|
/* ----------------------- Begin implementation -----------------------------*/
|
||||||
|
|
||||||
|
BOOL
|
||||||
|
xMBTCPPortInit( USHORT usTCPPort )
|
||||||
|
{
|
||||||
|
USHORT usPort;
|
||||||
|
struct sockaddr_in serveraddr;
|
||||||
|
|
||||||
|
if( usTCPPort == 0 )
|
||||||
|
{
|
||||||
|
usPort = MB_TCP_DEFAULT_PORT;
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
usPort = ( USHORT ) usTCPPort;
|
||||||
|
}
|
||||||
|
memset( &serveraddr, 0, sizeof( serveraddr ) );
|
||||||
|
serveraddr.sin_family = AF_INET;
|
||||||
|
serveraddr.sin_addr.s_addr = htonl( INADDR_ANY );
|
||||||
|
serveraddr.sin_port = htons( usPort );
|
||||||
|
if( ( xListenSocket = socket( AF_INET, SOCK_STREAM, IPPROTO_TCP ) ) == -1 )
|
||||||
|
{
|
||||||
|
fprintf( stderr, "Create socket failed.\r\n" );
|
||||||
|
return FALSE;
|
||||||
|
}
|
||||||
|
else if( bind( xListenSocket, ( struct sockaddr * )&serveraddr, sizeof( serveraddr ) ) == -1 )
|
||||||
|
{
|
||||||
|
perror("bind");
|
||||||
|
fprintf( stderr, "Bind socket failed.\r\n" );
|
||||||
|
return FALSE;
|
||||||
|
}
|
||||||
|
else if( listen( xListenSocket, 5 ) == -1 )
|
||||||
|
{
|
||||||
|
fprintf( stderr, "Listen socket failed.\r\n" );
|
||||||
|
return FALSE;
|
||||||
|
}
|
||||||
|
FD_ZERO( &allset );
|
||||||
|
FD_SET( xListenSocket, &allset );
|
||||||
|
return TRUE;
|
||||||
|
}
|
||||||
|
|
||||||
|
void
|
||||||
|
vMBTCPPortClose( )
|
||||||
|
{
|
||||||
|
// Close all client sockets.
|
||||||
|
if( xClientSocket != SOCKET_ERROR )
|
||||||
|
{
|
||||||
|
prvvMBPortReleaseClient( );
|
||||||
|
}
|
||||||
|
// Close the listener socket.
|
||||||
|
if( xListenSocket != SOCKET_ERROR )
|
||||||
|
{
|
||||||
|
close( xListenSocket );
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
void
|
||||||
|
vMBTCPPortDisable( void )
|
||||||
|
{
|
||||||
|
/* Close all client sockets. */
|
||||||
|
if( xClientSocket != SOCKET_ERROR )
|
||||||
|
{
|
||||||
|
prvvMBPortReleaseClient( );
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
/*! \ingroup port_win32tcp
|
||||||
|
*
|
||||||
|
* \brief Pool the listening socket and currently connected Modbus TCP clients
|
||||||
|
* for new events.
|
||||||
|
* \internal
|
||||||
|
*
|
||||||
|
* This function checks if new clients want to connect or if already connected
|
||||||
|
* clients are sending requests. If a new client is connected and there are
|
||||||
|
* still client slots left (The current implementation supports only one)
|
||||||
|
* then the connection is accepted and an event object for the new client
|
||||||
|
* socket is activated (See prvbMBPortAcceptClient() ).
|
||||||
|
* Events for already existing clients in \c FD_READ and \c FD_CLOSE. In case of
|
||||||
|
* an \c FD_CLOSE the client connection is released (See prvvMBPortReleaseClient() ).
|
||||||
|
* In case of an \c FD_READ command the existing data is read from the client
|
||||||
|
* and if a complete frame has been received the Modbus Stack is notified.
|
||||||
|
*
|
||||||
|
* \return FALSE in case of an internal I/O error. For example if the internal
|
||||||
|
* event objects are in an invalid state. Note that this does not include any
|
||||||
|
* client errors. In all other cases returns TRUE.
|
||||||
|
*/
|
||||||
|
BOOL
|
||||||
|
xMBPortTCPPool( void )
|
||||||
|
{
|
||||||
|
int n;
|
||||||
|
fd_set fread;
|
||||||
|
struct timeval tval;
|
||||||
|
|
||||||
|
tval.tv_sec = 0;
|
||||||
|
tval.tv_usec = 5000;
|
||||||
|
int ret;
|
||||||
|
USHORT usLength;
|
||||||
|
|
||||||
|
if( xClientSocket == INVALID_SOCKET )
|
||||||
|
{
|
||||||
|
/* Accept to client */
|
||||||
|
if( ( n = select( xListenSocket + 1, &allset, NULL, NULL, NULL ) ) < 0 )
|
||||||
|
{
|
||||||
|
if( errno == EINTR )
|
||||||
|
{
|
||||||
|
;
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
if( FD_ISSET( xListenSocket, &allset ) )
|
||||||
|
{
|
||||||
|
( void )prvbMBPortAcceptClient( );
|
||||||
|
}
|
||||||
|
}
|
||||||
|
while( TRUE )
|
||||||
|
{
|
||||||
|
FD_ZERO( &fread );
|
||||||
|
FD_SET( xClientSocket, &fread );
|
||||||
|
if( ( ( ret = select( xClientSocket + 1, &fread, NULL, NULL, &tval ) ) == SOCKET_ERROR )
|
||||||
|
|| !ret )
|
||||||
|
{
|
||||||
|
continue;
|
||||||
|
}
|
||||||
|
if( ret > 0 )
|
||||||
|
{
|
||||||
|
if( FD_ISSET( xClientSocket, &fread ) )
|
||||||
|
{
|
||||||
|
if( ( ( ret =
|
||||||
|
recv( xClientSocket, &aucTCPBuf[usTCPBufPos], usTCPFrameBytesLeft,
|
||||||
|
0 ) ) == SOCKET_ERROR ) || ( !ret ) )
|
||||||
|
{
|
||||||
|
close( xClientSocket );
|
||||||
|
xClientSocket = INVALID_SOCKET;
|
||||||
|
return TRUE;
|
||||||
|
}
|
||||||
|
usTCPBufPos += ret;
|
||||||
|
usTCPFrameBytesLeft -= ret;
|
||||||
|
if( usTCPBufPos >= MB_TCP_FUNC )
|
||||||
|
{
|
||||||
|
/* Length is a byte count of Modbus PDU (function code + data) and the
|
||||||
|
* unit identifier. */
|
||||||
|
usLength = aucTCPBuf[MB_TCP_LEN] << 8U;
|
||||||
|
usLength |= aucTCPBuf[MB_TCP_LEN + 1];
|
||||||
|
|
||||||
|
/* Is the frame already complete. */
|
||||||
|
if( usTCPBufPos < ( MB_TCP_UID + usLength ) )
|
||||||
|
{
|
||||||
|
usTCPFrameBytesLeft = usLength + MB_TCP_UID - usTCPBufPos;
|
||||||
|
}
|
||||||
|
/* The frame is complete. */
|
||||||
|
else if( usTCPBufPos == ( MB_TCP_UID + usLength ) )
|
||||||
|
{
|
||||||
|
( void )xMBPortEventPost( EV_FRAME_RECEIVED );
|
||||||
|
return TRUE;
|
||||||
|
}
|
||||||
|
/* This can not happend because we always calculate the number of bytes
|
||||||
|
* to receive. */
|
||||||
|
else
|
||||||
|
{
|
||||||
|
assert( usTCPBufPos <= ( MB_TCP_UID + usLength ) );
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
return TRUE;
|
||||||
|
}
|
||||||
|
|
||||||
|
/*!
|
||||||
|
* \ingroup port_win32tcp
|
||||||
|
* \brief Receives parts of a Modbus TCP frame and if complete notifies
|
||||||
|
* the protocol stack.
|
||||||
|
* \internal
|
||||||
|
*
|
||||||
|
* This function reads a complete Modbus TCP frame from the protocol stack.
|
||||||
|
* It starts by reading the header with an initial request size for
|
||||||
|
* usTCPFrameBytesLeft = MB_TCP_FUNC. If the header is complete the
|
||||||
|
* number of bytes left can be calculated from it (See Length in MBAP header).
|
||||||
|
* Further read calls are issued until the frame is complete.
|
||||||
|
*
|
||||||
|
* \return \c TRUE if part of a Modbus TCP frame could be processed. In case
|
||||||
|
* of a communication error the function returns \c FALSE.
|
||||||
|
*/
|
||||||
|
|
||||||
|
BOOL
|
||||||
|
xMBTCPPortGetRequest( UCHAR ** ppucMBTCPFrame, USHORT * usTCPLength )
|
||||||
|
{
|
||||||
|
*ppucMBTCPFrame = &aucTCPBuf[0];
|
||||||
|
*usTCPLength = usTCPBufPos;
|
||||||
|
|
||||||
|
/* Reset the buffer. */
|
||||||
|
usTCPBufPos = 0;
|
||||||
|
usTCPFrameBytesLeft = MB_TCP_FUNC;
|
||||||
|
return TRUE;
|
||||||
|
}
|
||||||
|
|
||||||
|
BOOL
|
||||||
|
xMBTCPPortSendResponse( const UCHAR * pucMBTCPFrame, USHORT usTCPLength )
|
||||||
|
{
|
||||||
|
BOOL bFrameSent = FALSE;
|
||||||
|
BOOL bAbort = FALSE;
|
||||||
|
int res;
|
||||||
|
int iBytesSent = 0;
|
||||||
|
int iTimeOut = MB_TCP_READ_TIMEOUT;
|
||||||
|
|
||||||
|
do
|
||||||
|
{
|
||||||
|
res = send( xClientSocket, &pucMBTCPFrame[iBytesSent], usTCPLength - iBytesSent, 0 );
|
||||||
|
switch ( res )
|
||||||
|
{
|
||||||
|
case -1:
|
||||||
|
if( iTimeOut > 0 )
|
||||||
|
{
|
||||||
|
iTimeOut -= MB_TCP_READ_CYCLE;
|
||||||
|
// usleep( MB_TCP_READ_CYCLE );
|
||||||
|
// PrivTaskDelay( MB_TCP_READ_CYCLE );
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
bAbort = TRUE;
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
case 0:
|
||||||
|
prvvMBPortReleaseClient( );
|
||||||
|
bAbort = TRUE;
|
||||||
|
break;
|
||||||
|
default:
|
||||||
|
iBytesSent += res;
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
while( ( iBytesSent != usTCPLength ) && !bAbort );
|
||||||
|
|
||||||
|
bFrameSent = iBytesSent == usTCPLength ? TRUE : FALSE;
|
||||||
|
|
||||||
|
return bFrameSent;
|
||||||
|
}
|
||||||
|
|
||||||
|
void
|
||||||
|
prvvMBPortReleaseClient( )
|
||||||
|
{
|
||||||
|
( void )recv( xClientSocket, &aucTCPBuf[0], MB_TCP_BUF_SIZE, 0 );
|
||||||
|
|
||||||
|
( void )close( xClientSocket );
|
||||||
|
xClientSocket = INVALID_SOCKET;
|
||||||
|
}
|
||||||
|
|
||||||
|
BOOL
|
||||||
|
prvbMBPortAcceptClient( )
|
||||||
|
{
|
||||||
|
SOCKET xNewSocket;
|
||||||
|
BOOL bOkay;
|
||||||
|
|
||||||
|
/* Check if we can handle a new connection. */
|
||||||
|
|
||||||
|
if( xClientSocket != INVALID_SOCKET )
|
||||||
|
{
|
||||||
|
fprintf( stderr, "can't accept new client. all connections in use.\n" );
|
||||||
|
bOkay = FALSE;
|
||||||
|
}
|
||||||
|
else if( ( xNewSocket = accept( xListenSocket, NULL, NULL ) ) == INVALID_SOCKET )
|
||||||
|
{
|
||||||
|
bOkay = FALSE;
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
xClientSocket = xNewSocket;
|
||||||
|
usTCPBufPos = 0;
|
||||||
|
usTCPFrameBytesLeft = MB_TCP_FUNC;
|
||||||
|
bOkay = TRUE;
|
||||||
|
}
|
||||||
|
return bOkay;
|
||||||
|
}
|
||||||
|
|
@ -0,0 +1,13 @@
|
||||||
|
{
|
||||||
|
"device_id": 1,
|
||||||
|
"device_name": "freemodbustcp",
|
||||||
|
"communication_type": 0,
|
||||||
|
"socket_config": {
|
||||||
|
"local_ip": "192.168.250.233",
|
||||||
|
"gateway": "192.168.250.1",
|
||||||
|
"netmask": "255.255.255.0",
|
||||||
|
"port": 502
|
||||||
|
},
|
||||||
|
"protocol_type": 2,
|
||||||
|
"read_period": 100
|
||||||
|
}
|
||||||
|
|
@ -447,7 +447,7 @@ int ModbusTcpProtocolFormatCmd(struct ControlRecipe *p_recipe, ProtocolFormatInf
|
||||||
p_read_item_data);
|
p_read_item_data);
|
||||||
|
|
||||||
ControlPrintfList("CMD", modbustcp_read_item->data_info.base_data_info.p_command, modbustcp_read_item->data_info.base_data_info.command_length);
|
ControlPrintfList("CMD", modbustcp_read_item->data_info.base_data_info.p_command, modbustcp_read_item->data_info.base_data_info.command_length);
|
||||||
protocol_format_info->last_item_size = GetValueTypeMemorySize(modbustcp_read_item->value_type);
|
protocol_format_info->last_item_size = GetValueTypeMemorySize(modbustcp_read_item->value_type,1);
|
||||||
|
|
||||||
last_item_size += protocol_format_info->last_item_size;
|
last_item_size += protocol_format_info->last_item_size;
|
||||||
|
|
||||||
|
|
|
||||||
|
|
@ -398,7 +398,7 @@ int ModbusUartProtocolFormatCmd(struct ControlRecipe *p_recipe, ProtocolFormatIn
|
||||||
p_read_item_data);
|
p_read_item_data);
|
||||||
|
|
||||||
ControlPrintfList("CMD", modbusuart_read_item->data_info.base_data_info.p_command, modbusuart_read_item->data_info.base_data_info.command_length);
|
ControlPrintfList("CMD", modbusuart_read_item->data_info.base_data_info.p_command, modbusuart_read_item->data_info.base_data_info.command_length);
|
||||||
protocol_format_info->last_item_size = GetValueTypeMemorySize(modbusuart_read_item->value_type);
|
protocol_format_info->last_item_size = GetValueTypeMemorySize(modbusuart_read_item->value_type,1);
|
||||||
|
|
||||||
last_item_size += protocol_format_info->last_item_size;
|
last_item_size += protocol_format_info->last_item_size;
|
||||||
|
|
||||||
|
|
|
||||||
|
|
@ -420,7 +420,7 @@ int FinsProtocolFormatCmd(struct ControlRecipe *p_recipe, ProtocolFormatInfo *pr
|
||||||
p_read_item_data);
|
p_read_item_data);
|
||||||
|
|
||||||
ControlPrintfList("CMD", fins_read_item->data_info.base_data_info.p_command, fins_read_item->data_info.base_data_info.command_length);
|
ControlPrintfList("CMD", fins_read_item->data_info.base_data_info.p_command, fins_read_item->data_info.base_data_info.command_length);
|
||||||
protocol_format_info->last_item_size = GetValueTypeMemorySize(fins_read_item->value_type);
|
protocol_format_info->last_item_size = GetValueTypeMemorySize(fins_read_item->value_type,1);
|
||||||
|
|
||||||
last_item_size += protocol_format_info->last_item_size;
|
last_item_size += protocol_format_info->last_item_size;
|
||||||
|
|
||||||
|
|
|
||||||
|
|
@ -810,7 +810,7 @@ int MelsecProtocolFormatCmd(struct ControlRecipe *p_recipe, ProtocolFormatInfo *
|
||||||
ret = MelsecInitialDataInfo(melsec_read_item, p_read_item_data);
|
ret = MelsecInitialDataInfo(melsec_read_item, p_read_item_data);
|
||||||
|
|
||||||
ControlPrintfList("CMD", melsec_read_item->data_info.base_data_info.p_command, melsec_read_item->data_info.base_data_info.command_length);
|
ControlPrintfList("CMD", melsec_read_item->data_info.base_data_info.p_command, melsec_read_item->data_info.base_data_info.command_length);
|
||||||
protocol_format_info->last_item_size = GetValueTypeMemorySize(melsec_read_item->value_type);
|
protocol_format_info->last_item_size = GetValueTypeMemorySize(melsec_read_item->value_type,1);
|
||||||
|
|
||||||
last_item_size += protocol_format_info->last_item_size;
|
last_item_size += protocol_format_info->last_item_size;
|
||||||
|
|
||||||
|
|
|
||||||
|
|
@ -133,7 +133,7 @@ int8_t ReadPlcDataByRecipe(struct ControlRecipe *p_recipe)
|
||||||
}
|
}
|
||||||
TS7DataItem data_info = ((S7ReadItem*)p_read_item + i)->data_info;
|
TS7DataItem data_info = ((S7ReadItem*)p_read_item + i)->data_info;
|
||||||
Cli_ReadMultiVars(s7_plc, &data_info, 1);
|
Cli_ReadMultiVars(s7_plc, &data_info, 1);
|
||||||
uint16_t Size = GetValueTypeMemorySize(((S7ReadItem*)p_read_item + i)->value_type);
|
uint16_t Size = GetValueTypeMemorySize(((S7ReadItem*)p_read_item + i)->value_type,data_info.Amount);
|
||||||
ControlPrintfList("S7 RECV", data_info.pdata,Size);
|
ControlPrintfList("S7 RECV", data_info.pdata,Size);
|
||||||
PushDataIntoStack(s7_data,data_info.pdata,Size);
|
PushDataIntoStack(s7_data,data_info.pdata,Size);
|
||||||
PrivTaskDelay(100);
|
PrivTaskDelay(100);
|
||||||
|
|
@ -196,7 +196,7 @@ static uint8_t InitialS7ReadItem(S7ReadItem* p_read_item, cJSON* read_item_json,
|
||||||
printf("value_type is %d, amount is %d, start is %04d, db_number is %d, area is 0x%03x, wordlen is %d.\n",
|
printf("value_type is %d, amount is %d, start is %04d, db_number is %d, area is 0x%03x, wordlen is %d.\n",
|
||||||
p_read_item->value_type, p_data_info->Amount, p_data_info->Start, p_data_info->DBNumber,
|
p_read_item->value_type, p_data_info->Amount, p_data_info->Start, p_data_info->DBNumber,
|
||||||
p_data_info->Area, p_data_info->WordLen);
|
p_data_info->Area, p_data_info->WordLen);
|
||||||
return GetValueTypeMemorySize(p_read_item->value_type);
|
return GetValueTypeMemorySize(p_read_item->value_type, p_data_info->Amount);
|
||||||
}
|
}
|
||||||
|
|
||||||
/**
|
/**
|
||||||
|
|
|
||||||
|
|
@ -55,6 +55,7 @@ typedef enum
|
||||||
PROTOCOL_MELSEC_3E_IQ_R,
|
PROTOCOL_MELSEC_3E_IQ_R,
|
||||||
PROTOCOL_MELSEC_1C,
|
PROTOCOL_MELSEC_1C,
|
||||||
PROTOCOL_MELSEC_3C,
|
PROTOCOL_MELSEC_3C,
|
||||||
|
PROTOCOL_FREEMODBUS_TCP_SERVER,
|
||||||
PROTOCOL_END
|
PROTOCOL_END
|
||||||
}ProtocolType;
|
}ProtocolType;
|
||||||
|
|
||||||
|
|
|
||||||
|
|
@ -49,6 +49,10 @@ extern int ModbusUartProtocolInit(struct ControlRecipe *p_recipe);
|
||||||
extern int S7ProtocolInit(struct ControlRecipe *p_recipe);
|
extern int S7ProtocolInit(struct ControlRecipe *p_recipe);
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
|
#ifdef CONTROL_PROTOCOL_FREEMODBUS_TCP_SERVER
|
||||||
|
extern int FreeModbusTcpServerInit(struct ControlRecipe *p_recipe);
|
||||||
|
#endif
|
||||||
|
|
||||||
/*
|
/*
|
||||||
CONTROL FRAMEWORK READ DATA FORMAT:
|
CONTROL FRAMEWORK READ DATA FORMAT:
|
||||||
| HEAD |device_id|read data length|read item count| data |
|
| HEAD |device_id|read data length|read item count| data |
|
||||||
|
|
@ -88,6 +92,10 @@ static struct ControlProtocolInitParam protocol_init[] =
|
||||||
{ PROTOCOL_S7, S7ProtocolInit },
|
{ PROTOCOL_S7, S7ProtocolInit },
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
|
#ifdef CONTROL_PROTOCOL_FREEMODBUS_TCP_SERVER
|
||||||
|
{ PROTOCOL_FREEMODBUS_TCP_SERVER, FreeModbusTcpServerInit },
|
||||||
|
#endif
|
||||||
|
|
||||||
{ PROTOCOL_END, NULL },
|
{ PROTOCOL_END, NULL },
|
||||||
};
|
};
|
||||||
|
|
||||||
|
|
@ -143,7 +151,8 @@ static uint16_t GetRecipeTotalDataLength(cJSON* read_item_list_json)
|
||||||
for (uint16_t read_item_index = 0; read_item_index < read_item_count; read_item_index++) {
|
for (uint16_t read_item_index = 0; read_item_index < read_item_count; read_item_index++) {
|
||||||
cJSON* read_item_json = cJSON_GetArrayItem(read_item_list_json, read_item_index);
|
cJSON* read_item_json = cJSON_GetArrayItem(read_item_list_json, read_item_index);
|
||||||
UniformValueType value_type = cJSON_GetObjectItem(read_item_json, "value_type")->valueint;
|
UniformValueType value_type = cJSON_GetObjectItem(read_item_json, "value_type")->valueint;
|
||||||
total_data_length += GetValueTypeMemorySize(value_type);
|
int value_num = cJSON_GetObjectItem(read_item_json, "amount")->valueint;
|
||||||
|
total_data_length += GetValueTypeMemorySize(value_type, value_num);
|
||||||
}
|
}
|
||||||
return total_data_length;
|
return total_data_length;
|
||||||
}
|
}
|
||||||
|
|
@ -345,26 +354,26 @@ int ControlProtocolCloseDef(void)
|
||||||
* @param uniform_value_type - uniform value type
|
* @param uniform_value_type - uniform value type
|
||||||
* @return success : size error : 0
|
* @return success : size error : 0
|
||||||
*/
|
*/
|
||||||
uint8_t GetValueTypeMemorySize(UniformValueType uniform_value_type)
|
uint8_t GetValueTypeMemorySize(UniformValueType uniform_value_type,int value_num)
|
||||||
{
|
{
|
||||||
switch (uniform_value_type)
|
switch (uniform_value_type)
|
||||||
{
|
{
|
||||||
case UNIFORM_BOOL:
|
case UNIFORM_BOOL:
|
||||||
case UNIFORM_INT8:
|
case UNIFORM_INT8:
|
||||||
case UNIFORM_UINT8:
|
case UNIFORM_UINT8:
|
||||||
return 1;
|
return 1* value_num;
|
||||||
break;
|
break;
|
||||||
case UNIFORM_INT16:
|
case UNIFORM_INT16:
|
||||||
case UNIFORM_UINT16:
|
case UNIFORM_UINT16:
|
||||||
return 2;
|
return 2* value_num;
|
||||||
break;
|
break;
|
||||||
case UNIFORM_INT32:
|
case UNIFORM_INT32:
|
||||||
case UNIFORM_UINT32:
|
case UNIFORM_UINT32:
|
||||||
case UNIFORM_FLOAT:
|
case UNIFORM_FLOAT:
|
||||||
return 4;
|
return 4* value_num;
|
||||||
break;
|
break;
|
||||||
case UNIFORM_DOUBLE:
|
case UNIFORM_DOUBLE:
|
||||||
return 8;
|
return 8* value_num;
|
||||||
break;
|
break;
|
||||||
default:
|
default:
|
||||||
break;
|
break;
|
||||||
|
|
|
||||||
|
|
@ -130,7 +130,7 @@ struct ControlRecipe
|
||||||
};
|
};
|
||||||
|
|
||||||
/*Get Value Type Memory Size*/
|
/*Get Value Type Memory Size*/
|
||||||
uint8_t GetValueTypeMemorySize(UniformValueType uniform_value_type);
|
uint8_t GetValueTypeMemorySize(UniformValueType uniform_value_type,int value_num);
|
||||||
|
|
||||||
/*Get basic information from recipe file*/
|
/*Get basic information from recipe file*/
|
||||||
int RecipeBasicInformation(struct ControlRecipe *p_recipe, cJSON *p_recipe_file_json);
|
int RecipeBasicInformation(struct ControlRecipe *p_recipe, cJSON *p_recipe_file_json);
|
||||||
|
|
|
||||||
|
|
@ -15,4 +15,5 @@ menu "app lib"
|
||||||
source "$APP_DIR/lib/embedded_database/Kconfig"
|
source "$APP_DIR/lib/embedded_database/Kconfig"
|
||||||
source "$APP_DIR/lib/lorawan/Kconfig"
|
source "$APP_DIR/lib/lorawan/Kconfig"
|
||||||
source "$APP_DIR/lib/mqtt/Kconfig"
|
source "$APP_DIR/lib/mqtt/Kconfig"
|
||||||
|
source "$APP_DIR/lib/freemodbus/Kconfig"
|
||||||
endmenu
|
endmenu
|
||||||
|
|
|
||||||
|
|
@ -22,4 +22,8 @@ ifeq ($(CONFIG_TOOL_USING_MQTT),y)
|
||||||
SRC_DIR += mqtt
|
SRC_DIR += mqtt
|
||||||
endif
|
endif
|
||||||
|
|
||||||
|
ifeq ($(CONFIG_LIB_USING_FREEMODBUS),y)
|
||||||
|
SRC_DIR += freemodbus
|
||||||
|
endif
|
||||||
|
|
||||||
include $(KERNEL_ROOT)/compiler.mk
|
include $(KERNEL_ROOT)/compiler.mk
|
||||||
|
|
|
||||||
|
|
@ -0,0 +1,5 @@
|
||||||
|
menu "lib using freemodbus"
|
||||||
|
menuconfig LIB_USING_FREEMODBUS
|
||||||
|
bool "USING freemodbus"
|
||||||
|
default n
|
||||||
|
endmenu
|
||||||
|
|
@ -0,0 +1,3 @@
|
||||||
|
SRC_FILES := $(wildcard ./*.c)
|
||||||
|
|
||||||
|
include $(KERNEL_ROOT)/compiler.mk
|
||||||
|
|
@ -0,0 +1,411 @@
|
||||||
|
/*
|
||||||
|
* FreeModbus Libary: A portable Modbus implementation for Modbus ASCII/RTU.
|
||||||
|
* Copyright (c) 2006-2018 Christian Walter <cwalter@embedded-solutions.at>
|
||||||
|
* All rights reserved.
|
||||||
|
*
|
||||||
|
* Redistribution and use in source and binary forms, with or without
|
||||||
|
* modification, are permitted provided that the following conditions
|
||||||
|
* are met:
|
||||||
|
* 1. Redistributions of source code must retain the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer.
|
||||||
|
* 2. Redistributions in binary form must reproduce the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer in the
|
||||||
|
* documentation and/or other materials provided with the distribution.
|
||||||
|
* 3. The name of the author may not be used to endorse or promote products
|
||||||
|
* derived from this software without specific prior written permission.
|
||||||
|
*
|
||||||
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
|
||||||
|
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
|
||||||
|
* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
|
||||||
|
* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
|
||||||
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
|
||||||
|
* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
||||||
|
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
||||||
|
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
||||||
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
|
||||||
|
* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||||||
|
*
|
||||||
|
*/
|
||||||
|
|
||||||
|
/* ----------------------- System includes ----------------------------------*/
|
||||||
|
#include "stdlib.h"
|
||||||
|
#include "string.h"
|
||||||
|
|
||||||
|
/* ----------------------- Platform includes --------------------------------*/
|
||||||
|
#include "port.h"
|
||||||
|
|
||||||
|
/* ----------------------- Modbus includes ----------------------------------*/
|
||||||
|
#include "mb.h"
|
||||||
|
#include "mbconfig.h"
|
||||||
|
#include "mbframe.h"
|
||||||
|
#include "mbproto.h"
|
||||||
|
#include "mbfunc.h"
|
||||||
|
|
||||||
|
#include "mbport.h"
|
||||||
|
#if MB_RTU_ENABLED == 1
|
||||||
|
#include "mbrtu.h"
|
||||||
|
#endif
|
||||||
|
#if MB_ASCII_ENABLED == 1
|
||||||
|
#include "mbascii.h"
|
||||||
|
#endif
|
||||||
|
#if MB_TCP_ENABLED == 1
|
||||||
|
#include "mbtcp.h"
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#ifndef MB_PORT_HAS_CLOSE
|
||||||
|
#define MB_PORT_HAS_CLOSE 0
|
||||||
|
#endif
|
||||||
|
|
||||||
|
/* ----------------------- Static variables ---------------------------------*/
|
||||||
|
|
||||||
|
static UCHAR ucMBAddress;
|
||||||
|
static eMBMode eMBCurrentMode;
|
||||||
|
|
||||||
|
static enum
|
||||||
|
{
|
||||||
|
STATE_ENABLED,
|
||||||
|
STATE_DISABLED,
|
||||||
|
STATE_NOT_INITIALIZED
|
||||||
|
} eMBState = STATE_NOT_INITIALIZED;
|
||||||
|
|
||||||
|
/* Functions pointer which are initialized in eMBInit( ). Depending on the
|
||||||
|
* mode (RTU or ASCII) the are set to the correct implementations.
|
||||||
|
*/
|
||||||
|
static peMBFrameSend peMBFrameSendCur;
|
||||||
|
static pvMBFrameStart pvMBFrameStartCur;
|
||||||
|
static pvMBFrameStop pvMBFrameStopCur;
|
||||||
|
static peMBFrameReceive peMBFrameReceiveCur;
|
||||||
|
static pvMBFrameClose pvMBFrameCloseCur;
|
||||||
|
|
||||||
|
/* Callback functions required by the porting layer. They are called when
|
||||||
|
* an external event has happend which includes a timeout or the reception
|
||||||
|
* or transmission of a character.
|
||||||
|
*/
|
||||||
|
BOOL( *pxMBFrameCBByteReceived ) ( void );
|
||||||
|
BOOL( *pxMBFrameCBTransmitterEmpty ) ( void );
|
||||||
|
BOOL( *pxMBPortCBTimerExpired ) ( void );
|
||||||
|
|
||||||
|
BOOL( *pxMBFrameCBReceiveFSMCur ) ( void );
|
||||||
|
BOOL( *pxMBFrameCBTransmitFSMCur ) ( void );
|
||||||
|
|
||||||
|
/* An array of Modbus functions handlers which associates Modbus function
|
||||||
|
* codes with implementing functions.
|
||||||
|
*/
|
||||||
|
static xMBFunctionHandler xFuncHandlers[MB_FUNC_HANDLERS_MAX] = {
|
||||||
|
#if MB_FUNC_OTHER_REP_SLAVEID_ENABLED > 0
|
||||||
|
{MB_FUNC_OTHER_REPORT_SLAVEID, eMBFuncReportSlaveID},
|
||||||
|
#endif
|
||||||
|
#if MB_FUNC_READ_INPUT_ENABLED > 0
|
||||||
|
{MB_FUNC_READ_INPUT_REGISTER, eMBFuncReadInputRegister},
|
||||||
|
#endif
|
||||||
|
#if MB_FUNC_READ_HOLDING_ENABLED > 0
|
||||||
|
{MB_FUNC_READ_HOLDING_REGISTER, eMBFuncReadHoldingRegister},
|
||||||
|
#endif
|
||||||
|
#if MB_FUNC_WRITE_MULTIPLE_HOLDING_ENABLED > 0
|
||||||
|
{MB_FUNC_WRITE_MULTIPLE_REGISTERS, eMBFuncWriteMultipleHoldingRegister},
|
||||||
|
#endif
|
||||||
|
#if MB_FUNC_WRITE_HOLDING_ENABLED > 0
|
||||||
|
{MB_FUNC_WRITE_REGISTER, eMBFuncWriteHoldingRegister},
|
||||||
|
#endif
|
||||||
|
#if MB_FUNC_READWRITE_HOLDING_ENABLED > 0
|
||||||
|
{MB_FUNC_READWRITE_MULTIPLE_REGISTERS, eMBFuncReadWriteMultipleHoldingRegister},
|
||||||
|
#endif
|
||||||
|
#if MB_FUNC_READ_COILS_ENABLED > 0
|
||||||
|
{MB_FUNC_READ_COILS, eMBFuncReadCoils},
|
||||||
|
#endif
|
||||||
|
#if MB_FUNC_WRITE_COIL_ENABLED > 0
|
||||||
|
{MB_FUNC_WRITE_SINGLE_COIL, eMBFuncWriteCoil},
|
||||||
|
#endif
|
||||||
|
#if MB_FUNC_WRITE_MULTIPLE_COILS_ENABLED > 0
|
||||||
|
{MB_FUNC_WRITE_MULTIPLE_COILS, eMBFuncWriteMultipleCoils},
|
||||||
|
#endif
|
||||||
|
#if MB_FUNC_READ_DISCRETE_INPUTS_ENABLED > 0
|
||||||
|
{MB_FUNC_READ_DISCRETE_INPUTS, eMBFuncReadDiscreteInputs},
|
||||||
|
#endif
|
||||||
|
};
|
||||||
|
|
||||||
|
/* ----------------------- Start implementation -----------------------------*/
|
||||||
|
eMBErrorCode
|
||||||
|
eMBInit( eMBMode eMode, UCHAR ucSlaveAddress, UCHAR ucPort, ULONG ulBaudRate, eMBParity eParity )
|
||||||
|
{
|
||||||
|
eMBErrorCode eStatus = MB_ENOERR;
|
||||||
|
|
||||||
|
/* check preconditions */
|
||||||
|
if( ( ucSlaveAddress == MB_ADDRESS_BROADCAST ) ||
|
||||||
|
( ucSlaveAddress < MB_ADDRESS_MIN ) || ( ucSlaveAddress > MB_ADDRESS_MAX ) )
|
||||||
|
{
|
||||||
|
eStatus = MB_EINVAL;
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
ucMBAddress = ucSlaveAddress;
|
||||||
|
|
||||||
|
switch ( eMode )
|
||||||
|
{
|
||||||
|
#if MB_RTU_ENABLED > 0
|
||||||
|
case MB_RTU:
|
||||||
|
pvMBFrameStartCur = eMBRTUStart;
|
||||||
|
pvMBFrameStopCur = eMBRTUStop;
|
||||||
|
peMBFrameSendCur = eMBRTUSend;
|
||||||
|
peMBFrameReceiveCur = eMBRTUReceive;
|
||||||
|
pvMBFrameCloseCur = MB_PORT_HAS_CLOSE ? vMBPortClose : NULL;
|
||||||
|
pxMBFrameCBByteReceived = xMBRTUReceiveFSM;
|
||||||
|
pxMBFrameCBTransmitterEmpty = xMBRTUTransmitFSM;
|
||||||
|
pxMBPortCBTimerExpired = xMBRTUTimerT35Expired;
|
||||||
|
|
||||||
|
eStatus = eMBRTUInit( ucMBAddress, ucPort, ulBaudRate, eParity );
|
||||||
|
break;
|
||||||
|
#endif
|
||||||
|
#if MB_ASCII_ENABLED > 0
|
||||||
|
case MB_ASCII:
|
||||||
|
pvMBFrameStartCur = eMBASCIIStart;
|
||||||
|
pvMBFrameStopCur = eMBASCIIStop;
|
||||||
|
peMBFrameSendCur = eMBASCIISend;
|
||||||
|
peMBFrameReceiveCur = eMBASCIIReceive;
|
||||||
|
pvMBFrameCloseCur = MB_PORT_HAS_CLOSE ? vMBPortClose : NULL;
|
||||||
|
pxMBFrameCBByteReceived = xMBASCIIReceiveFSM;
|
||||||
|
pxMBFrameCBTransmitterEmpty = xMBASCIITransmitFSM;
|
||||||
|
pxMBPortCBTimerExpired = xMBASCIITimerT1SExpired;
|
||||||
|
|
||||||
|
eStatus = eMBASCIIInit( ucMBAddress, ucPort, ulBaudRate, eParity );
|
||||||
|
break;
|
||||||
|
#endif
|
||||||
|
default:
|
||||||
|
eStatus = MB_EINVAL;
|
||||||
|
}
|
||||||
|
|
||||||
|
if( eStatus == MB_ENOERR )
|
||||||
|
{
|
||||||
|
if( !xMBPortEventInit( ) )
|
||||||
|
{
|
||||||
|
/* port dependent event module initalization failed. */
|
||||||
|
eStatus = MB_EPORTERR;
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
eMBCurrentMode = eMode;
|
||||||
|
eMBState = STATE_DISABLED;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
return eStatus;
|
||||||
|
}
|
||||||
|
|
||||||
|
#if MB_TCP_ENABLED > 0
|
||||||
|
eMBErrorCode
|
||||||
|
eMBTCPInit( USHORT ucTCPPort )
|
||||||
|
{
|
||||||
|
eMBErrorCode eStatus = MB_ENOERR;
|
||||||
|
|
||||||
|
if( ( eStatus = eMBTCPDoInit( ucTCPPort ) ) != MB_ENOERR )
|
||||||
|
{
|
||||||
|
eMBState = STATE_DISABLED;
|
||||||
|
}
|
||||||
|
else if( !xMBPortEventInit( ) )
|
||||||
|
{
|
||||||
|
/* Port dependent event module initalization failed. */
|
||||||
|
eStatus = MB_EPORTERR;
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
pvMBFrameStartCur = eMBTCPStart;
|
||||||
|
pvMBFrameStopCur = eMBTCPStop;
|
||||||
|
peMBFrameReceiveCur = eMBTCPReceive;
|
||||||
|
peMBFrameSendCur = eMBTCPSend;
|
||||||
|
pvMBFrameCloseCur = MB_PORT_HAS_CLOSE ? vMBTCPPortClose : NULL;
|
||||||
|
ucMBAddress = MB_TCP_PSEUDO_ADDRESS;
|
||||||
|
eMBCurrentMode = MB_TCP;
|
||||||
|
eMBState = STATE_DISABLED;
|
||||||
|
}
|
||||||
|
return eStatus;
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
|
eMBErrorCode
|
||||||
|
eMBRegisterCB( UCHAR ucFunctionCode, pxMBFunctionHandler pxHandler )
|
||||||
|
{
|
||||||
|
int i;
|
||||||
|
eMBErrorCode eStatus;
|
||||||
|
|
||||||
|
if( ( 0 < ucFunctionCode ) && ( ucFunctionCode <= 127 ) )
|
||||||
|
{
|
||||||
|
ENTER_CRITICAL_SECTION( );
|
||||||
|
if( pxHandler != NULL )
|
||||||
|
{
|
||||||
|
for( i = 0; i < MB_FUNC_HANDLERS_MAX; i++ )
|
||||||
|
{
|
||||||
|
if( ( xFuncHandlers[i].pxHandler == NULL ) ||
|
||||||
|
( xFuncHandlers[i].pxHandler == pxHandler ) )
|
||||||
|
{
|
||||||
|
xFuncHandlers[i].ucFunctionCode = ucFunctionCode;
|
||||||
|
xFuncHandlers[i].pxHandler = pxHandler;
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
eStatus = ( i != MB_FUNC_HANDLERS_MAX ) ? MB_ENOERR : MB_ENORES;
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
for( i = 0; i < MB_FUNC_HANDLERS_MAX; i++ )
|
||||||
|
{
|
||||||
|
if( xFuncHandlers[i].ucFunctionCode == ucFunctionCode )
|
||||||
|
{
|
||||||
|
xFuncHandlers[i].ucFunctionCode = 0;
|
||||||
|
xFuncHandlers[i].pxHandler = NULL;
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
/* Remove can't fail. */
|
||||||
|
eStatus = MB_ENOERR;
|
||||||
|
}
|
||||||
|
EXIT_CRITICAL_SECTION( );
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
eStatus = MB_EINVAL;
|
||||||
|
}
|
||||||
|
return eStatus;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
eMBErrorCode
|
||||||
|
eMBClose( void )
|
||||||
|
{
|
||||||
|
eMBErrorCode eStatus = MB_ENOERR;
|
||||||
|
|
||||||
|
if( eMBState == STATE_DISABLED )
|
||||||
|
{
|
||||||
|
if( pvMBFrameCloseCur != NULL )
|
||||||
|
{
|
||||||
|
pvMBFrameCloseCur( );
|
||||||
|
}
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
eStatus = MB_EILLSTATE;
|
||||||
|
}
|
||||||
|
return eStatus;
|
||||||
|
}
|
||||||
|
|
||||||
|
eMBErrorCode
|
||||||
|
eMBEnable( void )
|
||||||
|
{
|
||||||
|
eMBErrorCode eStatus = MB_ENOERR;
|
||||||
|
|
||||||
|
if( eMBState == STATE_DISABLED )
|
||||||
|
{
|
||||||
|
/* Activate the protocol stack. */
|
||||||
|
pvMBFrameStartCur( );
|
||||||
|
eMBState = STATE_ENABLED;
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
eStatus = MB_EILLSTATE;
|
||||||
|
}
|
||||||
|
return eStatus;
|
||||||
|
}
|
||||||
|
|
||||||
|
eMBErrorCode
|
||||||
|
eMBDisable( void )
|
||||||
|
{
|
||||||
|
eMBErrorCode eStatus;
|
||||||
|
|
||||||
|
if( eMBState == STATE_ENABLED )
|
||||||
|
{
|
||||||
|
pvMBFrameStopCur( );
|
||||||
|
eMBState = STATE_DISABLED;
|
||||||
|
eStatus = MB_ENOERR;
|
||||||
|
}
|
||||||
|
else if( eMBState == STATE_DISABLED )
|
||||||
|
{
|
||||||
|
eStatus = MB_ENOERR;
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
eStatus = MB_EILLSTATE;
|
||||||
|
}
|
||||||
|
return eStatus;
|
||||||
|
}
|
||||||
|
|
||||||
|
eMBErrorCode
|
||||||
|
eMBPoll( void )
|
||||||
|
{
|
||||||
|
static UCHAR *ucMBFrame;
|
||||||
|
static UCHAR ucRcvAddress;
|
||||||
|
static UCHAR ucFunctionCode;
|
||||||
|
static USHORT usLength;
|
||||||
|
static eMBException eException;
|
||||||
|
|
||||||
|
int i;
|
||||||
|
eMBErrorCode eStatus = MB_ENOERR;
|
||||||
|
eMBEventType eEvent;
|
||||||
|
|
||||||
|
/* Check if the protocol stack is ready. */
|
||||||
|
if( eMBState != STATE_ENABLED )
|
||||||
|
{
|
||||||
|
return MB_EILLSTATE;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Check if there is a event available. If not return control to caller.
|
||||||
|
* Otherwise we will handle the event. */
|
||||||
|
if( xMBPortEventGet( &eEvent ) == TRUE )
|
||||||
|
{
|
||||||
|
switch ( eEvent )
|
||||||
|
{
|
||||||
|
case EV_READY:
|
||||||
|
break;
|
||||||
|
|
||||||
|
case EV_FRAME_RECEIVED:
|
||||||
|
eStatus = peMBFrameReceiveCur( &ucRcvAddress, &ucMBFrame, &usLength );
|
||||||
|
if( eStatus == MB_ENOERR )
|
||||||
|
{
|
||||||
|
/* Check if the frame is for us. If not ignore the frame. */
|
||||||
|
if( ( ucRcvAddress == ucMBAddress ) || ( ucRcvAddress == MB_ADDRESS_BROADCAST ) )
|
||||||
|
{
|
||||||
|
( void )xMBPortEventPost( EV_EXECUTE );
|
||||||
|
}
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
|
||||||
|
case EV_EXECUTE:
|
||||||
|
ucFunctionCode = ucMBFrame[MB_PDU_FUNC_OFF];
|
||||||
|
eException = MB_EX_ILLEGAL_FUNCTION;
|
||||||
|
for( i = 0; i < MB_FUNC_HANDLERS_MAX; i++ )
|
||||||
|
{
|
||||||
|
/* No more function handlers registered. Abort. */
|
||||||
|
if( xFuncHandlers[i].ucFunctionCode == 0 )
|
||||||
|
{
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
else if( xFuncHandlers[i].ucFunctionCode == ucFunctionCode )
|
||||||
|
{
|
||||||
|
eException = xFuncHandlers[i].pxHandler( ucMBFrame, &usLength );
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
/* If the request was not sent to the broadcast address we
|
||||||
|
* return a reply. */
|
||||||
|
if( ucRcvAddress != MB_ADDRESS_BROADCAST )
|
||||||
|
{
|
||||||
|
if( eException != MB_EX_NONE )
|
||||||
|
{
|
||||||
|
/* An exception occured. Build an error frame. */
|
||||||
|
usLength = 0;
|
||||||
|
ucMBFrame[usLength++] = ( UCHAR )( ucFunctionCode | MB_FUNC_ERROR );
|
||||||
|
ucMBFrame[usLength++] = eException;
|
||||||
|
}
|
||||||
|
if( ( eMBCurrentMode == MB_ASCII ) && MB_ASCII_TIMEOUT_WAIT_BEFORE_SEND_MS )
|
||||||
|
{
|
||||||
|
vMBPortTimersDelay( MB_ASCII_TIMEOUT_WAIT_BEFORE_SEND_MS );
|
||||||
|
}
|
||||||
|
eStatus = peMBFrameSendCur( ucMBAddress, ucMBFrame, usLength );
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
|
||||||
|
case EV_FRAME_SENT:
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
return MB_ENOERR;
|
||||||
|
}
|
||||||
|
|
@ -0,0 +1,416 @@
|
||||||
|
/*
|
||||||
|
* FreeModbus Libary: A portable Modbus implementation for Modbus ASCII/RTU.
|
||||||
|
* Copyright (c) 2006-2018 Christian Walter <cwalter@embedded-solutions.at>
|
||||||
|
* All rights reserved.
|
||||||
|
*
|
||||||
|
* Redistribution and use in source and binary forms, with or without
|
||||||
|
* modification, are permitted provided that the following conditions
|
||||||
|
* are met:
|
||||||
|
* 1. Redistributions of source code must retain the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer.
|
||||||
|
* 2. Redistributions in binary form must reproduce the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer in the
|
||||||
|
* documentation and/or other materials provided with the distribution.
|
||||||
|
* 3. The name of the author may not be used to endorse or promote products
|
||||||
|
* derived from this software without specific prior written permission.
|
||||||
|
*
|
||||||
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
|
||||||
|
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
|
||||||
|
* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
|
||||||
|
* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
|
||||||
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
|
||||||
|
* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
||||||
|
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
||||||
|
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
||||||
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
|
||||||
|
* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||||||
|
*
|
||||||
|
*/
|
||||||
|
|
||||||
|
#ifndef _MB_H
|
||||||
|
#define _MB_H
|
||||||
|
|
||||||
|
#include "port.h"
|
||||||
|
|
||||||
|
#ifdef __cplusplus
|
||||||
|
PR_BEGIN_EXTERN_C
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#include "mbport.h"
|
||||||
|
#include "mbproto.h"
|
||||||
|
|
||||||
|
/*! \defgroup modbus Modbus
|
||||||
|
* \code #include "mb.h" \endcode
|
||||||
|
*
|
||||||
|
* This module defines the interface for the application. It contains
|
||||||
|
* the basic functions and types required to use the Modbus protocol stack.
|
||||||
|
* A typical application will want to call eMBInit() first. If the device
|
||||||
|
* is ready to answer network requests it must then call eMBEnable() to activate
|
||||||
|
* the protocol stack. In the main loop the function eMBPoll() must be called
|
||||||
|
* periodically. The time interval between pooling depends on the configured
|
||||||
|
* Modbus timeout. If an RTOS is available a separate task should be created
|
||||||
|
* and the task should always call the function eMBPoll().
|
||||||
|
*
|
||||||
|
* \code
|
||||||
|
* // Initialize protocol stack in RTU mode for a slave with address 10 = 0x0A
|
||||||
|
* eMBInit( MB_RTU, 0x0A, 38400, MB_PAR_EVEN );
|
||||||
|
* // Enable the Modbus Protocol Stack.
|
||||||
|
* eMBEnable( );
|
||||||
|
* for( ;; )
|
||||||
|
* {
|
||||||
|
* // Call the main polling loop of the Modbus protocol stack.
|
||||||
|
* eMBPoll( );
|
||||||
|
* ...
|
||||||
|
* }
|
||||||
|
* \endcode
|
||||||
|
*/
|
||||||
|
|
||||||
|
/* ----------------------- Defines ------------------------------------------*/
|
||||||
|
|
||||||
|
/*! \ingroup modbus
|
||||||
|
* \brief Use the default Modbus TCP port (502)
|
||||||
|
*/
|
||||||
|
#define MB_TCP_PORT_USE_DEFAULT 0
|
||||||
|
|
||||||
|
/* ----------------------- Type definitions ---------------------------------*/
|
||||||
|
|
||||||
|
/*! \ingroup modbus
|
||||||
|
* \brief Modbus serial transmission modes (RTU/ASCII).
|
||||||
|
*
|
||||||
|
* Modbus serial supports two transmission modes. Either ASCII or RTU. RTU
|
||||||
|
* is faster but has more hardware requirements and requires a network with
|
||||||
|
* a low jitter. ASCII is slower and more reliable on slower links (E.g. modems)
|
||||||
|
*/
|
||||||
|
typedef enum
|
||||||
|
{
|
||||||
|
MB_RTU, /*!< RTU transmission mode. */
|
||||||
|
MB_ASCII, /*!< ASCII transmission mode. */
|
||||||
|
MB_TCP /*!< TCP mode. */
|
||||||
|
} eMBMode;
|
||||||
|
|
||||||
|
/*! \ingroup modbus
|
||||||
|
* \brief If register should be written or read.
|
||||||
|
*
|
||||||
|
* This value is passed to the callback functions which support either
|
||||||
|
* reading or writing register values. Writing means that the application
|
||||||
|
* registers should be updated and reading means that the modbus protocol
|
||||||
|
* stack needs to know the current register values.
|
||||||
|
*
|
||||||
|
* \see eMBRegHoldingCB( ), eMBRegCoilsCB( ), eMBRegDiscreteCB( ) and
|
||||||
|
* eMBRegInputCB( ).
|
||||||
|
*/
|
||||||
|
typedef enum
|
||||||
|
{
|
||||||
|
MB_REG_READ, /*!< Read register values and pass to protocol stack. */
|
||||||
|
MB_REG_WRITE /*!< Update register values. */
|
||||||
|
} eMBRegisterMode;
|
||||||
|
|
||||||
|
/*! \ingroup modbus
|
||||||
|
* \brief Errorcodes used by all function in the protocol stack.
|
||||||
|
*/
|
||||||
|
typedef enum
|
||||||
|
{
|
||||||
|
MB_ENOERR, /*!< no error. */
|
||||||
|
MB_ENOREG, /*!< illegal register address. */
|
||||||
|
MB_EINVAL, /*!< illegal argument. */
|
||||||
|
MB_EPORTERR, /*!< porting layer error. */
|
||||||
|
MB_ENORES, /*!< insufficient resources. */
|
||||||
|
MB_EIO, /*!< I/O error. */
|
||||||
|
MB_EILLSTATE, /*!< protocol stack in illegal state. */
|
||||||
|
MB_ETIMEDOUT /*!< timeout error occurred. */
|
||||||
|
} eMBErrorCode;
|
||||||
|
|
||||||
|
|
||||||
|
/* ----------------------- Function prototypes ------------------------------*/
|
||||||
|
/*! \ingroup modbus
|
||||||
|
* \brief Initialize the Modbus protocol stack.
|
||||||
|
*
|
||||||
|
* This functions initializes the ASCII or RTU module and calls the
|
||||||
|
* init functions of the porting layer to prepare the hardware. Please
|
||||||
|
* note that the receiver is still disabled and no Modbus frames are
|
||||||
|
* processed until eMBEnable( ) has been called.
|
||||||
|
*
|
||||||
|
* \param eMode If ASCII or RTU mode should be used.
|
||||||
|
* \param ucSlaveAddress The slave address. Only frames sent to this
|
||||||
|
* address or to the broadcast address are processed.
|
||||||
|
* \param ucPort The port to use. E.g. 1 for COM1 on windows. This value
|
||||||
|
* is platform dependent and some ports simply choose to ignore it.
|
||||||
|
* \param ulBaudRate The baudrate. E.g. 19200. Supported baudrates depend
|
||||||
|
* on the porting layer.
|
||||||
|
* \param eParity Parity used for serial transmission.
|
||||||
|
*
|
||||||
|
* \return If no error occurs the function returns eMBErrorCode::MB_ENOERR.
|
||||||
|
* The protocol is then in the disabled state and ready for activation
|
||||||
|
* by calling eMBEnable( ). Otherwise one of the following error codes
|
||||||
|
* is returned:
|
||||||
|
* - eMBErrorCode::MB_EINVAL If the slave address was not valid. Valid
|
||||||
|
* slave addresses are in the range 1 - 247.
|
||||||
|
* - eMBErrorCode::MB_EPORTERR IF the porting layer returned an error.
|
||||||
|
*/
|
||||||
|
eMBErrorCode eMBInit( eMBMode eMode, UCHAR ucSlaveAddress,
|
||||||
|
UCHAR ucPort, ULONG ulBaudRate, eMBParity eParity );
|
||||||
|
|
||||||
|
/*! \ingroup modbus
|
||||||
|
* \brief Initialize the Modbus protocol stack for Modbus TCP.
|
||||||
|
*
|
||||||
|
* This function initializes the Modbus TCP Module. Please note that
|
||||||
|
* frame processing is still disabled until eMBEnable( ) is called.
|
||||||
|
*
|
||||||
|
* \param usTCPPort The TCP port to listen on.
|
||||||
|
* \return If the protocol stack has been initialized correctly the function
|
||||||
|
* returns eMBErrorCode::MB_ENOERR. Otherwise one of the following error
|
||||||
|
* codes is returned:
|
||||||
|
* - eMBErrorCode::MB_EINVAL If the slave address was not valid. Valid
|
||||||
|
* slave addresses are in the range 1 - 247.
|
||||||
|
* - eMBErrorCode::MB_EPORTERR IF the porting layer returned an error.
|
||||||
|
*/
|
||||||
|
eMBErrorCode eMBTCPInit( USHORT usTCPPort );
|
||||||
|
|
||||||
|
/*! \ingroup modbus
|
||||||
|
* \brief Release resources used by the protocol stack.
|
||||||
|
*
|
||||||
|
* This function disables the Modbus protocol stack and release all
|
||||||
|
* hardware resources. It must only be called when the protocol stack
|
||||||
|
* is disabled.
|
||||||
|
*
|
||||||
|
* \note Note all ports implement this function. A port which wants to
|
||||||
|
* get an callback must define the macro MB_PORT_HAS_CLOSE to 1.
|
||||||
|
*
|
||||||
|
* \return If the resources where released it return eMBErrorCode::MB_ENOERR.
|
||||||
|
* If the protocol stack is not in the disabled state it returns
|
||||||
|
* eMBErrorCode::MB_EILLSTATE.
|
||||||
|
*/
|
||||||
|
eMBErrorCode eMBClose( void );
|
||||||
|
|
||||||
|
/*! \ingroup modbus
|
||||||
|
* \brief Enable the Modbus protocol stack.
|
||||||
|
*
|
||||||
|
* This function enables processing of Modbus frames. Enabling the protocol
|
||||||
|
* stack is only possible if it is in the disabled state.
|
||||||
|
*
|
||||||
|
* \return If the protocol stack is now in the state enabled it returns
|
||||||
|
* eMBErrorCode::MB_ENOERR. If it was not in the disabled state it
|
||||||
|
* return eMBErrorCode::MB_EILLSTATE.
|
||||||
|
*/
|
||||||
|
eMBErrorCode eMBEnable( void );
|
||||||
|
|
||||||
|
/*! \ingroup modbus
|
||||||
|
* \brief Disable the Modbus protocol stack.
|
||||||
|
*
|
||||||
|
* This function disables processing of Modbus frames.
|
||||||
|
*
|
||||||
|
* \return If the protocol stack has been disabled it returns
|
||||||
|
* eMBErrorCode::MB_ENOERR. If it was not in the enabled state it returns
|
||||||
|
* eMBErrorCode::MB_EILLSTATE.
|
||||||
|
*/
|
||||||
|
eMBErrorCode eMBDisable( void );
|
||||||
|
|
||||||
|
/*! \ingroup modbus
|
||||||
|
* \brief The main pooling loop of the Modbus protocol stack.
|
||||||
|
*
|
||||||
|
* This function must be called periodically. The timer interval required
|
||||||
|
* is given by the application dependent Modbus slave timeout. Internally the
|
||||||
|
* function calls xMBPortEventGet() and waits for an event from the receiver or
|
||||||
|
* transmitter state machines.
|
||||||
|
*
|
||||||
|
* \return If the protocol stack is not in the enabled state the function
|
||||||
|
* returns eMBErrorCode::MB_EILLSTATE. Otherwise it returns
|
||||||
|
* eMBErrorCode::MB_ENOERR.
|
||||||
|
*/
|
||||||
|
eMBErrorCode eMBPoll( void );
|
||||||
|
|
||||||
|
/*! \ingroup modbus
|
||||||
|
* \brief Configure the slave id of the device.
|
||||||
|
*
|
||||||
|
* This function should be called when the Modbus function <em>Report Slave ID</em>
|
||||||
|
* is enabled ( By defining MB_FUNC_OTHER_REP_SLAVEID_ENABLED in mbconfig.h ).
|
||||||
|
*
|
||||||
|
* \param ucSlaveID Values is returned in the <em>Slave ID</em> byte of the
|
||||||
|
* <em>Report Slave ID</em> response.
|
||||||
|
* \param xIsRunning If TRUE the <em>Run Indicator Status</em> byte is set to 0xFF.
|
||||||
|
* otherwise the <em>Run Indicator Status</em> is 0x00.
|
||||||
|
* \param pucAdditional Values which should be returned in the <em>Additional</em>
|
||||||
|
* bytes of the <em> Report Slave ID</em> response.
|
||||||
|
* \param usAdditionalLen Length of the buffer <code>pucAdditonal</code>.
|
||||||
|
*
|
||||||
|
* \return If the static buffer defined by MB_FUNC_OTHER_REP_SLAVEID_BUF in
|
||||||
|
* mbconfig.h is to small it returns eMBErrorCode::MB_ENORES. Otherwise
|
||||||
|
* it returns eMBErrorCode::MB_ENOERR.
|
||||||
|
*/
|
||||||
|
eMBErrorCode eMBSetSlaveID( UCHAR ucSlaveID, BOOL xIsRunning,
|
||||||
|
UCHAR const *pucAdditional,
|
||||||
|
USHORT usAdditionalLen );
|
||||||
|
|
||||||
|
/*! \ingroup modbus
|
||||||
|
* \brief Registers a callback handler for a given function code.
|
||||||
|
*
|
||||||
|
* This function registers a new callback handler for a given function code.
|
||||||
|
* The callback handler supplied is responsible for interpreting the Modbus PDU and
|
||||||
|
* the creation of an appropriate response. In case of an error it should return
|
||||||
|
* one of the possible Modbus exceptions which results in a Modbus exception frame
|
||||||
|
* sent by the protocol stack.
|
||||||
|
*
|
||||||
|
* \param ucFunctionCode The Modbus function code for which this handler should
|
||||||
|
* be registers. Valid function codes are in the range 1 to 127.
|
||||||
|
* \param pxHandler The function handler which should be called in case
|
||||||
|
* such a frame is received. If \c NULL a previously registered function handler
|
||||||
|
* for this function code is removed.
|
||||||
|
*
|
||||||
|
* \return eMBErrorCode::MB_ENOERR if the handler has been installed. If no
|
||||||
|
* more resources are available it returns eMBErrorCode::MB_ENORES. In this
|
||||||
|
* case the values in mbconfig.h should be adjusted. If the argument was not
|
||||||
|
* valid it returns eMBErrorCode::MB_EINVAL.
|
||||||
|
*/
|
||||||
|
eMBErrorCode eMBRegisterCB( UCHAR ucFunctionCode,
|
||||||
|
pxMBFunctionHandler pxHandler );
|
||||||
|
|
||||||
|
/* ----------------------- Callback -----------------------------------------*/
|
||||||
|
|
||||||
|
/*! \defgroup modbus_registers Modbus Registers
|
||||||
|
* \code #include "mb.h" \endcode
|
||||||
|
* The protocol stack does not internally allocate any memory for the
|
||||||
|
* registers. This makes the protocol stack very small and also usable on
|
||||||
|
* low end targets. In addition the values don't have to be in the memory
|
||||||
|
* and could for example be stored in a flash.<br>
|
||||||
|
* Whenever the protocol stack requires a value it calls one of the callback
|
||||||
|
* function with the register address and the number of registers to read
|
||||||
|
* as an argument. The application should then read the actual register values
|
||||||
|
* (for example the ADC voltage) and should store the result in the supplied
|
||||||
|
* buffer.<br>
|
||||||
|
* If the protocol stack wants to update a register value because a write
|
||||||
|
* register function was received a buffer with the new register values is
|
||||||
|
* passed to the callback function. The function should then use these values
|
||||||
|
* to update the application register values.
|
||||||
|
*/
|
||||||
|
|
||||||
|
/*! \ingroup modbus_registers
|
||||||
|
* \brief Callback function used if the value of a <em>Input Register</em>
|
||||||
|
* is required by the protocol stack. The starting register address is given
|
||||||
|
* by \c usAddress and the last register is given by <tt>usAddress +
|
||||||
|
* usNRegs - 1</tt>.
|
||||||
|
*
|
||||||
|
* \param pucRegBuffer A buffer where the callback function should write
|
||||||
|
* the current value of the modbus registers to.
|
||||||
|
* \param usAddress The starting address of the register. Input registers
|
||||||
|
* are in the range 1 - 65535.
|
||||||
|
* \param usNRegs Number of registers the callback function must supply.
|
||||||
|
*
|
||||||
|
* \return The function must return one of the following error codes:
|
||||||
|
* - eMBErrorCode::MB_ENOERR If no error occurred. In this case a normal
|
||||||
|
* Modbus response is sent.
|
||||||
|
* - eMBErrorCode::MB_ENOREG If the application can not supply values
|
||||||
|
* for registers within this range. In this case a
|
||||||
|
* <b>ILLEGAL DATA ADDRESS</b> exception frame is sent as a response.
|
||||||
|
* - eMBErrorCode::MB_ETIMEDOUT If the requested register block is
|
||||||
|
* currently not available and the application dependent response
|
||||||
|
* timeout would be violated. In this case a <b>SLAVE DEVICE BUSY</b>
|
||||||
|
* exception is sent as a response.
|
||||||
|
* - eMBErrorCode::MB_EIO If an unrecoverable error occurred. In this case
|
||||||
|
* a <b>SLAVE DEVICE FAILURE</b> exception is sent as a response.
|
||||||
|
*/
|
||||||
|
eMBErrorCode eMBRegInputCB( UCHAR * pucRegBuffer, USHORT usAddress,
|
||||||
|
USHORT usNRegs );
|
||||||
|
|
||||||
|
/*! \ingroup modbus_registers
|
||||||
|
* \brief Callback function used if a <em>Holding Register</em> value is
|
||||||
|
* read or written by the protocol stack. The starting register address
|
||||||
|
* is given by \c usAddress and the last register is given by
|
||||||
|
* <tt>usAddress + usNRegs - 1</tt>.
|
||||||
|
*
|
||||||
|
* \param pucRegBuffer If the application registers values should be updated the
|
||||||
|
* buffer points to the new registers values. If the protocol stack needs
|
||||||
|
* to now the current values the callback function should write them into
|
||||||
|
* this buffer.
|
||||||
|
* \param usAddress The starting address of the register.
|
||||||
|
* \param usNRegs Number of registers to read or write.
|
||||||
|
* \param eMode If eMBRegisterMode::MB_REG_WRITE the application register
|
||||||
|
* values should be updated from the values in the buffer. For example
|
||||||
|
* this would be the case when the Modbus master has issued an
|
||||||
|
* <b>WRITE SINGLE REGISTER</b> command.
|
||||||
|
* If the value eMBRegisterMode::MB_REG_READ the application should copy
|
||||||
|
* the current values into the buffer \c pucRegBuffer.
|
||||||
|
*
|
||||||
|
* \return The function must return one of the following error codes:
|
||||||
|
* - eMBErrorCode::MB_ENOERR If no error occurred. In this case a normal
|
||||||
|
* Modbus response is sent.
|
||||||
|
* - eMBErrorCode::MB_ENOREG If the application can not supply values
|
||||||
|
* for registers within this range. In this case a
|
||||||
|
* <b>ILLEGAL DATA ADDRESS</b> exception frame is sent as a response.
|
||||||
|
* - eMBErrorCode::MB_ETIMEDOUT If the requested register block is
|
||||||
|
* currently not available and the application dependent response
|
||||||
|
* timeout would be violated. In this case a <b>SLAVE DEVICE BUSY</b>
|
||||||
|
* exception is sent as a response.
|
||||||
|
* - eMBErrorCode::MB_EIO If an unrecoverable error occurred. In this case
|
||||||
|
* a <b>SLAVE DEVICE FAILURE</b> exception is sent as a response.
|
||||||
|
*/
|
||||||
|
eMBErrorCode eMBRegHoldingCB( UCHAR * pucRegBuffer, USHORT usAddress,
|
||||||
|
USHORT usNRegs, eMBRegisterMode eMode );
|
||||||
|
|
||||||
|
/*! \ingroup modbus_registers
|
||||||
|
* \brief Callback function used if a <em>Coil Register</em> value is
|
||||||
|
* read or written by the protocol stack. If you are going to use
|
||||||
|
* this function you might use the functions xMBUtilSetBits( ) and
|
||||||
|
* xMBUtilGetBits( ) for working with bitfields.
|
||||||
|
*
|
||||||
|
* \param pucRegBuffer The bits are packed in bytes where the first coil
|
||||||
|
* starting at address \c usAddress is stored in the LSB of the
|
||||||
|
* first byte in the buffer <code>pucRegBuffer</code>.
|
||||||
|
* If the buffer should be written by the callback function unused
|
||||||
|
* coil values (I.e. if not a multiple of eight coils is used) should be set
|
||||||
|
* to zero.
|
||||||
|
* \param usAddress The first coil number.
|
||||||
|
* \param usNCoils Number of coil values requested.
|
||||||
|
* \param eMode If eMBRegisterMode::MB_REG_WRITE the application values should
|
||||||
|
* be updated from the values supplied in the buffer \c pucRegBuffer.
|
||||||
|
* If eMBRegisterMode::MB_REG_READ the application should store the current
|
||||||
|
* values in the buffer \c pucRegBuffer.
|
||||||
|
*
|
||||||
|
* \return The function must return one of the following error codes:
|
||||||
|
* - eMBErrorCode::MB_ENOERR If no error occurred. In this case a normal
|
||||||
|
* Modbus response is sent.
|
||||||
|
* - eMBErrorCode::MB_ENOREG If the application does not map an coils
|
||||||
|
* within the requested address range. In this case a
|
||||||
|
* <b>ILLEGAL DATA ADDRESS</b> is sent as a response.
|
||||||
|
* - eMBErrorCode::MB_ETIMEDOUT If the requested register block is
|
||||||
|
* currently not available and the application dependent response
|
||||||
|
* timeout would be violated. In this case a <b>SLAVE DEVICE BUSY</b>
|
||||||
|
* exception is sent as a response.
|
||||||
|
* - eMBErrorCode::MB_EIO If an unrecoverable error occurred. In this case
|
||||||
|
* a <b>SLAVE DEVICE FAILURE</b> exception is sent as a response.
|
||||||
|
*/
|
||||||
|
eMBErrorCode eMBRegCoilsCB( UCHAR * pucRegBuffer, USHORT usAddress,
|
||||||
|
USHORT usNCoils, eMBRegisterMode eMode );
|
||||||
|
|
||||||
|
/*! \ingroup modbus_registers
|
||||||
|
* \brief Callback function used if a <em>Input Discrete Register</em> value is
|
||||||
|
* read by the protocol stack.
|
||||||
|
*
|
||||||
|
* If you are going to use his function you might use the functions
|
||||||
|
* xMBUtilSetBits( ) and xMBUtilGetBits( ) for working with bitfields.
|
||||||
|
*
|
||||||
|
* \param pucRegBuffer The buffer should be updated with the current
|
||||||
|
* coil values. The first discrete input starting at \c usAddress must be
|
||||||
|
* stored at the LSB of the first byte in the buffer. If the requested number
|
||||||
|
* is not a multiple of eight the remaining bits should be set to zero.
|
||||||
|
* \param usAddress The starting address of the first discrete input.
|
||||||
|
* \param usNDiscrete Number of discrete input values.
|
||||||
|
* \return The function must return one of the following error codes:
|
||||||
|
* - eMBErrorCode::MB_ENOERR If no error occurred. In this case a normal
|
||||||
|
* Modbus response is sent.
|
||||||
|
* - eMBErrorCode::MB_ENOREG If no such discrete inputs exists.
|
||||||
|
* In this case a <b>ILLEGAL DATA ADDRESS</b> exception frame is sent
|
||||||
|
* as a response.
|
||||||
|
* - eMBErrorCode::MB_ETIMEDOUT If the requested register block is
|
||||||
|
* currently not available and the application dependent response
|
||||||
|
* timeout would be violated. In this case a <b>SLAVE DEVICE BUSY</b>
|
||||||
|
* exception is sent as a response.
|
||||||
|
* - eMBErrorCode::MB_EIO If an unrecoverable error occurred. In this case
|
||||||
|
* a <b>SLAVE DEVICE FAILURE</b> exception is sent as a response.
|
||||||
|
*/
|
||||||
|
eMBErrorCode eMBRegDiscreteCB( UCHAR * pucRegBuffer, USHORT usAddress,
|
||||||
|
USHORT usNDiscrete );
|
||||||
|
|
||||||
|
#ifdef __cplusplus
|
||||||
|
PR_END_EXTERN_C
|
||||||
|
#endif
|
||||||
|
#endif
|
||||||
|
|
@ -0,0 +1,131 @@
|
||||||
|
/*
|
||||||
|
* FreeModbus Libary: A portable Modbus implementation for Modbus ASCII/RTU.
|
||||||
|
* Copyright (c) 2006-2018 Christian Walter <cwalter@embedded-solutions.at>
|
||||||
|
* All rights reserved.
|
||||||
|
*
|
||||||
|
* Redistribution and use in source and binary forms, with or without
|
||||||
|
* modification, are permitted provided that the following conditions
|
||||||
|
* are met:
|
||||||
|
* 1. Redistributions of source code must retain the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer.
|
||||||
|
* 2. Redistributions in binary form must reproduce the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer in the
|
||||||
|
* documentation and/or other materials provided with the distribution.
|
||||||
|
* 3. The name of the author may not be used to endorse or promote products
|
||||||
|
* derived from this software without specific prior written permission.
|
||||||
|
*
|
||||||
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
|
||||||
|
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
|
||||||
|
* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
|
||||||
|
* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
|
||||||
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
|
||||||
|
* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
||||||
|
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
||||||
|
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
||||||
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
|
||||||
|
* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||||||
|
*
|
||||||
|
*/
|
||||||
|
|
||||||
|
#ifndef _MB_CONFIG_H
|
||||||
|
#define _MB_CONFIG_H
|
||||||
|
|
||||||
|
#ifdef __cplusplus
|
||||||
|
PR_BEGIN_EXTERN_C
|
||||||
|
#endif
|
||||||
|
/* ----------------------- Defines ------------------------------------------*/
|
||||||
|
/*! \defgroup modbus_cfg Modbus Configuration
|
||||||
|
*
|
||||||
|
* Most modules in the protocol stack are completly optional and can be
|
||||||
|
* excluded. This is specially important if target resources are very small
|
||||||
|
* and program memory space should be saved.<br>
|
||||||
|
*
|
||||||
|
* All of these settings are available in the file <code>mbconfig.h</code>
|
||||||
|
*/
|
||||||
|
/*! \addtogroup modbus_cfg
|
||||||
|
* @{
|
||||||
|
*/
|
||||||
|
/*! \brief If Modbus ASCII support is enabled. */
|
||||||
|
#define MB_ASCII_ENABLED ( 0 )
|
||||||
|
|
||||||
|
/*! \brief If Modbus RTU support is enabled. */
|
||||||
|
#define MB_RTU_ENABLED ( 0 )
|
||||||
|
|
||||||
|
/*! \brief If Modbus TCP support is enabled. */
|
||||||
|
#define MB_TCP_ENABLED ( 1 )
|
||||||
|
|
||||||
|
/*! \brief The character timeout value for Modbus ASCII.
|
||||||
|
*
|
||||||
|
* The character timeout value is not fixed for Modbus ASCII and is therefore
|
||||||
|
* a configuration option. It should be set to the maximum expected delay
|
||||||
|
* time of the network.
|
||||||
|
*/
|
||||||
|
#define MB_ASCII_TIMEOUT_SEC ( 1 )
|
||||||
|
|
||||||
|
/*! \brief Timeout to wait in ASCII prior to enabling transmitter.
|
||||||
|
*
|
||||||
|
* If defined the function calls vMBPortSerialDelay with the argument
|
||||||
|
* MB_ASCII_TIMEOUT_WAIT_BEFORE_SEND_MS to allow for a delay before
|
||||||
|
* the serial transmitter is enabled. This is required because some
|
||||||
|
* targets are so fast that there is no time between receiving and
|
||||||
|
* transmitting the frame. If the master is to slow with enabling its
|
||||||
|
* receiver then he will not receive the response correctly.
|
||||||
|
*/
|
||||||
|
#ifndef MB_ASCII_TIMEOUT_WAIT_BEFORE_SEND_MS
|
||||||
|
#define MB_ASCII_TIMEOUT_WAIT_BEFORE_SEND_MS ( 0 )
|
||||||
|
#endif
|
||||||
|
|
||||||
|
/*! \brief Maximum number of Modbus functions codes the protocol stack
|
||||||
|
* should support.
|
||||||
|
*
|
||||||
|
* The maximum number of supported Modbus functions must be greater than
|
||||||
|
* the sum of all enabled functions in this file and custom function
|
||||||
|
* handlers. If set to small adding more functions will fail.
|
||||||
|
*/
|
||||||
|
#define MB_FUNC_HANDLERS_MAX ( 16 )
|
||||||
|
|
||||||
|
/*! \brief Number of bytes which should be allocated for the <em>Report Slave ID
|
||||||
|
* </em>command.
|
||||||
|
*
|
||||||
|
* This number limits the maximum size of the additional segment in the
|
||||||
|
* report slave id function. See eMBSetSlaveID( ) for more information on
|
||||||
|
* how to set this value. It is only used if MB_FUNC_OTHER_REP_SLAVEID_ENABLED
|
||||||
|
* is set to <code>1</code>.
|
||||||
|
*/
|
||||||
|
#define MB_FUNC_OTHER_REP_SLAVEID_BUF ( 32 )
|
||||||
|
|
||||||
|
/*! \brief If the <em>Report Slave ID</em> function should be enabled. */
|
||||||
|
#define MB_FUNC_OTHER_REP_SLAVEID_ENABLED ( 1 )
|
||||||
|
|
||||||
|
/*! \brief If the <em>Read Input Registers</em> function should be enabled. */
|
||||||
|
#define MB_FUNC_READ_INPUT_ENABLED ( 1 )
|
||||||
|
|
||||||
|
/*! \brief If the <em>Read Holding Registers</em> function should be enabled. */
|
||||||
|
#define MB_FUNC_READ_HOLDING_ENABLED ( 1 )
|
||||||
|
|
||||||
|
/*! \brief If the <em>Write Single Register</em> function should be enabled. */
|
||||||
|
#define MB_FUNC_WRITE_HOLDING_ENABLED ( 1 )
|
||||||
|
|
||||||
|
/*! \brief If the <em>Write Multiple registers</em> function should be enabled. */
|
||||||
|
#define MB_FUNC_WRITE_MULTIPLE_HOLDING_ENABLED ( 1 )
|
||||||
|
|
||||||
|
/*! \brief If the <em>Read Coils</em> function should be enabled. */
|
||||||
|
#define MB_FUNC_READ_COILS_ENABLED ( 1 )
|
||||||
|
|
||||||
|
/*! \brief If the <em>Write Coils</em> function should be enabled. */
|
||||||
|
#define MB_FUNC_WRITE_COIL_ENABLED ( 1 )
|
||||||
|
|
||||||
|
/*! \brief If the <em>Write Multiple Coils</em> function should be enabled. */
|
||||||
|
#define MB_FUNC_WRITE_MULTIPLE_COILS_ENABLED ( 1 )
|
||||||
|
|
||||||
|
/*! \brief If the <em>Read Discrete Inputs</em> function should be enabled. */
|
||||||
|
#define MB_FUNC_READ_DISCRETE_INPUTS_ENABLED ( 1 )
|
||||||
|
|
||||||
|
/*! \brief If the <em>Read/Write Multiple Registers</em> function should be enabled. */
|
||||||
|
#define MB_FUNC_READWRITE_HOLDING_ENABLED ( 1 )
|
||||||
|
|
||||||
|
/*! @} */
|
||||||
|
#ifdef __cplusplus
|
||||||
|
PR_END_EXTERN_C
|
||||||
|
#endif
|
||||||
|
#endif
|
||||||
|
|
@ -0,0 +1,86 @@
|
||||||
|
/*
|
||||||
|
* FreeModbus Libary: A portable Modbus implementation for Modbus ASCII/RTU.
|
||||||
|
* Copyright (c) 2006-2018 Christian Walter <cwalter@embedded-solutions.at>
|
||||||
|
* All rights reserved.
|
||||||
|
*
|
||||||
|
* Redistribution and use in source and binary forms, with or without
|
||||||
|
* modification, are permitted provided that the following conditions
|
||||||
|
* are met:
|
||||||
|
* 1. Redistributions of source code must retain the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer.
|
||||||
|
* 2. Redistributions in binary form must reproduce the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer in the
|
||||||
|
* documentation and/or other materials provided with the distribution.
|
||||||
|
* 3. The name of the author may not be used to endorse or promote products
|
||||||
|
* derived from this software without specific prior written permission.
|
||||||
|
*
|
||||||
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
|
||||||
|
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
|
||||||
|
* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
|
||||||
|
* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
|
||||||
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
|
||||||
|
* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
||||||
|
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
||||||
|
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
||||||
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
|
||||||
|
* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||||||
|
*
|
||||||
|
*/
|
||||||
|
|
||||||
|
#ifndef _MB_FRAME_H
|
||||||
|
#define _MB_FRAME_H
|
||||||
|
|
||||||
|
#ifdef __cplusplus
|
||||||
|
PR_BEGIN_EXTERN_C
|
||||||
|
#endif
|
||||||
|
|
||||||
|
/*!
|
||||||
|
* Constants which defines the format of a modbus frame. The example is
|
||||||
|
* shown for a Modbus RTU/ASCII frame. Note that the Modbus PDU is not
|
||||||
|
* dependent on the underlying transport.
|
||||||
|
*
|
||||||
|
* <code>
|
||||||
|
* <------------------------ MODBUS SERIAL LINE PDU (1) ------------------->
|
||||||
|
* <----------- MODBUS PDU (1') ---------------->
|
||||||
|
* +-----------+---------------+----------------------------+-------------+
|
||||||
|
* | Address | Function Code | Data | CRC/LRC |
|
||||||
|
* +-----------+---------------+----------------------------+-------------+
|
||||||
|
* | | | |
|
||||||
|
* (2) (3/2') (3') (4)
|
||||||
|
*
|
||||||
|
* (1) ... MB_SER_PDU_SIZE_MAX = 256
|
||||||
|
* (2) ... MB_SER_PDU_ADDR_OFF = 0
|
||||||
|
* (3) ... MB_SER_PDU_PDU_OFF = 1
|
||||||
|
* (4) ... MB_SER_PDU_SIZE_CRC = 2
|
||||||
|
*
|
||||||
|
* (1') ... MB_PDU_SIZE_MAX = 253
|
||||||
|
* (2') ... MB_PDU_FUNC_OFF = 0
|
||||||
|
* (3') ... MB_PDU_DATA_OFF = 1
|
||||||
|
* </code>
|
||||||
|
*/
|
||||||
|
|
||||||
|
/* ----------------------- Defines ------------------------------------------*/
|
||||||
|
#define MB_PDU_SIZE_MAX 253 /*!< Maximum size of a PDU. */
|
||||||
|
#define MB_PDU_SIZE_MIN 1 /*!< Function Code */
|
||||||
|
#define MB_PDU_FUNC_OFF 0 /*!< Offset of function code in PDU. */
|
||||||
|
#define MB_PDU_DATA_OFF 1 /*!< Offset for response data in PDU. */
|
||||||
|
|
||||||
|
/* ----------------------- Prototypes 0-------------------------------------*/
|
||||||
|
typedef void ( *pvMBFrameStart ) ( void );
|
||||||
|
|
||||||
|
typedef void ( *pvMBFrameStop ) ( void );
|
||||||
|
|
||||||
|
typedef eMBErrorCode( *peMBFrameReceive ) ( UCHAR * pucRcvAddress,
|
||||||
|
UCHAR ** pucFrame,
|
||||||
|
USHORT * pusLength );
|
||||||
|
|
||||||
|
typedef eMBErrorCode( *peMBFrameSend ) ( UCHAR slaveAddress,
|
||||||
|
const UCHAR * pucFrame,
|
||||||
|
USHORT usLength );
|
||||||
|
|
||||||
|
typedef void( *pvMBFrameClose ) ( void );
|
||||||
|
|
||||||
|
#ifdef __cplusplus
|
||||||
|
PR_END_EXTERN_C
|
||||||
|
#endif
|
||||||
|
#endif
|
||||||
|
|
@ -0,0 +1,79 @@
|
||||||
|
/*
|
||||||
|
* FreeModbus Libary: A portable Modbus implementation for Modbus ASCII/RTU.
|
||||||
|
* Copyright (c) 2006-2018 Christian Walter <cwalter@embedded-solutions.at>
|
||||||
|
* All rights reserved.
|
||||||
|
*
|
||||||
|
* Redistribution and use in source and binary forms, with or without
|
||||||
|
* modification, are permitted provided that the following conditions
|
||||||
|
* are met:
|
||||||
|
* 1. Redistributions of source code must retain the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer.
|
||||||
|
* 2. Redistributions in binary form must reproduce the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer in the
|
||||||
|
* documentation and/or other materials provided with the distribution.
|
||||||
|
* 3. The name of the author may not be used to endorse or promote products
|
||||||
|
* derived from this software without specific prior written permission.
|
||||||
|
*
|
||||||
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
|
||||||
|
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
|
||||||
|
* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
|
||||||
|
* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
|
||||||
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
|
||||||
|
* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
||||||
|
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
||||||
|
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
||||||
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
|
||||||
|
* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||||||
|
*
|
||||||
|
*/
|
||||||
|
|
||||||
|
#ifndef _MB_FUNC_H
|
||||||
|
#define _MB_FUNC_H
|
||||||
|
|
||||||
|
#ifdef __cplusplus
|
||||||
|
PR_BEGIN_EXTERN_C
|
||||||
|
#endif
|
||||||
|
#if MB_FUNC_OTHER_REP_SLAVEID_BUF > 0
|
||||||
|
eMBException eMBFuncReportSlaveID( UCHAR * pucFrame, USHORT * usLen );
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#if MB_FUNC_READ_INPUT_ENABLED > 0
|
||||||
|
eMBException eMBFuncReadInputRegister( UCHAR * pucFrame, USHORT * usLen );
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#if MB_FUNC_READ_HOLDING_ENABLED > 0
|
||||||
|
eMBException eMBFuncReadHoldingRegister( UCHAR * pucFrame, USHORT * usLen );
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#if MB_FUNC_WRITE_HOLDING_ENABLED > 0
|
||||||
|
eMBException eMBFuncWriteHoldingRegister( UCHAR * pucFrame, USHORT * usLen );
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#if MB_FUNC_WRITE_MULTIPLE_HOLDING_ENABLED > 0
|
||||||
|
eMBException eMBFuncWriteMultipleHoldingRegister( UCHAR * pucFrame, USHORT * usLen );
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#if MB_FUNC_READ_COILS_ENABLED > 0
|
||||||
|
eMBException eMBFuncReadCoils( UCHAR * pucFrame, USHORT * usLen );
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#if MB_FUNC_WRITE_COIL_ENABLED > 0
|
||||||
|
eMBException eMBFuncWriteCoil( UCHAR * pucFrame, USHORT * usLen );
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#if MB_FUNC_WRITE_MULTIPLE_COILS_ENABLED > 0
|
||||||
|
eMBException eMBFuncWriteMultipleCoils( UCHAR * pucFrame, USHORT * usLen );
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#if MB_FUNC_READ_DISCRETE_INPUTS_ENABLED > 0
|
||||||
|
eMBException eMBFuncReadDiscreteInputs( UCHAR * pucFrame, USHORT * usLen );
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#if MB_FUNC_READWRITE_HOLDING_ENABLED > 0
|
||||||
|
eMBException eMBFuncReadWriteMultipleHoldingRegister( UCHAR * pucFrame, USHORT * usLen );
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#ifdef __cplusplus
|
||||||
|
PR_END_EXTERN_C
|
||||||
|
#endif
|
||||||
|
#endif
|
||||||
|
|
@ -0,0 +1,269 @@
|
||||||
|
/*
|
||||||
|
* FreeModbus Libary: A portable Modbus implementation for Modbus ASCII/RTU.
|
||||||
|
* Copyright (c) 2006-2018 Christian Walter <cwalter@embedded-solutions.at>
|
||||||
|
* All rights reserved.
|
||||||
|
*
|
||||||
|
* Redistribution and use in source and binary forms, with or without
|
||||||
|
* modification, are permitted provided that the following conditions
|
||||||
|
* are met:
|
||||||
|
* 1. Redistributions of source code must retain the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer.
|
||||||
|
* 2. Redistributions in binary form must reproduce the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer in the
|
||||||
|
* documentation and/or other materials provided with the distribution.
|
||||||
|
* 3. The name of the author may not be used to endorse or promote products
|
||||||
|
* derived from this software without specific prior written permission.
|
||||||
|
*
|
||||||
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
|
||||||
|
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
|
||||||
|
* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
|
||||||
|
* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
|
||||||
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
|
||||||
|
* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
||||||
|
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
||||||
|
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
||||||
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
|
||||||
|
* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||||||
|
*
|
||||||
|
*/
|
||||||
|
|
||||||
|
/* ----------------------- System includes ----------------------------------*/
|
||||||
|
#include "stdlib.h"
|
||||||
|
#include "string.h"
|
||||||
|
|
||||||
|
/* ----------------------- Platform includes --------------------------------*/
|
||||||
|
#include "port.h"
|
||||||
|
|
||||||
|
/* ----------------------- Modbus includes ----------------------------------*/
|
||||||
|
#include "mb.h"
|
||||||
|
#include "mbframe.h"
|
||||||
|
#include "mbproto.h"
|
||||||
|
#include "mbconfig.h"
|
||||||
|
|
||||||
|
/* ----------------------- Defines ------------------------------------------*/
|
||||||
|
#define MB_PDU_FUNC_READ_ADDR_OFF ( MB_PDU_DATA_OFF )
|
||||||
|
#define MB_PDU_FUNC_READ_COILCNT_OFF ( MB_PDU_DATA_OFF + 2 )
|
||||||
|
#define MB_PDU_FUNC_READ_SIZE ( 4 )
|
||||||
|
#define MB_PDU_FUNC_READ_COILCNT_MAX ( 0x07D0 )
|
||||||
|
|
||||||
|
#define MB_PDU_FUNC_WRITE_ADDR_OFF ( MB_PDU_DATA_OFF )
|
||||||
|
#define MB_PDU_FUNC_WRITE_VALUE_OFF ( MB_PDU_DATA_OFF + 2 )
|
||||||
|
#define MB_PDU_FUNC_WRITE_SIZE ( 4 )
|
||||||
|
|
||||||
|
#define MB_PDU_FUNC_WRITE_MUL_ADDR_OFF ( MB_PDU_DATA_OFF )
|
||||||
|
#define MB_PDU_FUNC_WRITE_MUL_COILCNT_OFF ( MB_PDU_DATA_OFF + 2 )
|
||||||
|
#define MB_PDU_FUNC_WRITE_MUL_BYTECNT_OFF ( MB_PDU_DATA_OFF + 4 )
|
||||||
|
#define MB_PDU_FUNC_WRITE_MUL_VALUES_OFF ( MB_PDU_DATA_OFF + 5 )
|
||||||
|
#define MB_PDU_FUNC_WRITE_MUL_SIZE_MIN ( 5 )
|
||||||
|
#define MB_PDU_FUNC_WRITE_MUL_COILCNT_MAX ( 0x07B0 )
|
||||||
|
|
||||||
|
/* ----------------------- Static functions ---------------------------------*/
|
||||||
|
eMBException prveMBError2Exception( eMBErrorCode eErrorCode );
|
||||||
|
|
||||||
|
/* ----------------------- Start implementation -----------------------------*/
|
||||||
|
|
||||||
|
#if MB_FUNC_READ_COILS_ENABLED > 0
|
||||||
|
|
||||||
|
eMBException
|
||||||
|
eMBFuncReadCoils( UCHAR * pucFrame, USHORT * usLen )
|
||||||
|
{
|
||||||
|
USHORT usRegAddress;
|
||||||
|
USHORT usCoilCount;
|
||||||
|
UCHAR ucNBytes;
|
||||||
|
UCHAR *pucFrameCur;
|
||||||
|
|
||||||
|
eMBException eStatus = MB_EX_NONE;
|
||||||
|
eMBErrorCode eRegStatus;
|
||||||
|
|
||||||
|
if( *usLen == ( MB_PDU_FUNC_READ_SIZE + MB_PDU_SIZE_MIN ) )
|
||||||
|
{
|
||||||
|
usRegAddress = ( USHORT )( pucFrame[MB_PDU_FUNC_READ_ADDR_OFF] << 8 );
|
||||||
|
usRegAddress |= ( USHORT )( pucFrame[MB_PDU_FUNC_READ_ADDR_OFF + 1] );
|
||||||
|
usRegAddress++;
|
||||||
|
|
||||||
|
usCoilCount = ( USHORT )( pucFrame[MB_PDU_FUNC_READ_COILCNT_OFF] << 8 );
|
||||||
|
usCoilCount |= ( USHORT )( pucFrame[MB_PDU_FUNC_READ_COILCNT_OFF + 1] );
|
||||||
|
|
||||||
|
/* Check if the number of registers to read is valid. If not
|
||||||
|
* return Modbus illegal data value exception.
|
||||||
|
*/
|
||||||
|
if( ( usCoilCount >= 1 ) &&
|
||||||
|
( usCoilCount < MB_PDU_FUNC_READ_COILCNT_MAX ) )
|
||||||
|
{
|
||||||
|
/* Set the current PDU data pointer to the beginning. */
|
||||||
|
pucFrameCur = &pucFrame[MB_PDU_FUNC_OFF];
|
||||||
|
*usLen = MB_PDU_FUNC_OFF;
|
||||||
|
|
||||||
|
/* First byte contains the function code. */
|
||||||
|
*pucFrameCur++ = MB_FUNC_READ_COILS;
|
||||||
|
*usLen += 1;
|
||||||
|
|
||||||
|
/* Test if the quantity of coils is a multiple of 8. If not last
|
||||||
|
* byte is only partially field with unused coils set to zero. */
|
||||||
|
if( ( usCoilCount & 0x0007 ) != 0 )
|
||||||
|
{
|
||||||
|
ucNBytes = ( UCHAR )( usCoilCount / 8 + 1 );
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
ucNBytes = ( UCHAR )( usCoilCount / 8 );
|
||||||
|
}
|
||||||
|
*pucFrameCur++ = ucNBytes;
|
||||||
|
*usLen += 1;
|
||||||
|
|
||||||
|
eRegStatus =
|
||||||
|
eMBRegCoilsCB( pucFrameCur, usRegAddress, usCoilCount,
|
||||||
|
MB_REG_READ );
|
||||||
|
|
||||||
|
/* If an error occured convert it into a Modbus exception. */
|
||||||
|
if( eRegStatus != MB_ENOERR )
|
||||||
|
{
|
||||||
|
eStatus = prveMBError2Exception( eRegStatus );
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
/* The response contains the function code, the starting address
|
||||||
|
* and the quantity of registers. We reuse the old values in the
|
||||||
|
* buffer because they are still valid. */
|
||||||
|
*usLen += ucNBytes;;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
eStatus = MB_EX_ILLEGAL_DATA_VALUE;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
/* Can't be a valid read coil register request because the length
|
||||||
|
* is incorrect. */
|
||||||
|
eStatus = MB_EX_ILLEGAL_DATA_VALUE;
|
||||||
|
}
|
||||||
|
return eStatus;
|
||||||
|
}
|
||||||
|
|
||||||
|
#if MB_FUNC_WRITE_COIL_ENABLED > 0
|
||||||
|
eMBException
|
||||||
|
eMBFuncWriteCoil( UCHAR * pucFrame, USHORT * usLen )
|
||||||
|
{
|
||||||
|
USHORT usRegAddress;
|
||||||
|
UCHAR ucBuf[2];
|
||||||
|
|
||||||
|
eMBException eStatus = MB_EX_NONE;
|
||||||
|
eMBErrorCode eRegStatus;
|
||||||
|
|
||||||
|
if( *usLen == ( MB_PDU_FUNC_WRITE_SIZE + MB_PDU_SIZE_MIN ) )
|
||||||
|
{
|
||||||
|
usRegAddress = ( USHORT )( pucFrame[MB_PDU_FUNC_WRITE_ADDR_OFF] << 8 );
|
||||||
|
usRegAddress |= ( USHORT )( pucFrame[MB_PDU_FUNC_WRITE_ADDR_OFF + 1] );
|
||||||
|
usRegAddress++;
|
||||||
|
|
||||||
|
if( ( pucFrame[MB_PDU_FUNC_WRITE_VALUE_OFF + 1] == 0x00 ) &&
|
||||||
|
( ( pucFrame[MB_PDU_FUNC_WRITE_VALUE_OFF] == 0xFF ) ||
|
||||||
|
( pucFrame[MB_PDU_FUNC_WRITE_VALUE_OFF] == 0x00 ) ) )
|
||||||
|
{
|
||||||
|
ucBuf[1] = 0;
|
||||||
|
if( pucFrame[MB_PDU_FUNC_WRITE_VALUE_OFF] == 0xFF )
|
||||||
|
{
|
||||||
|
ucBuf[0] = 1;
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
ucBuf[0] = 0;
|
||||||
|
}
|
||||||
|
eRegStatus =
|
||||||
|
eMBRegCoilsCB( &ucBuf[0], usRegAddress, 1, MB_REG_WRITE );
|
||||||
|
|
||||||
|
/* If an error occured convert it into a Modbus exception. */
|
||||||
|
if( eRegStatus != MB_ENOERR )
|
||||||
|
{
|
||||||
|
eStatus = prveMBError2Exception( eRegStatus );
|
||||||
|
}
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
eStatus = MB_EX_ILLEGAL_DATA_VALUE;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
/* Can't be a valid write coil register request because the length
|
||||||
|
* is incorrect. */
|
||||||
|
eStatus = MB_EX_ILLEGAL_DATA_VALUE;
|
||||||
|
}
|
||||||
|
return eStatus;
|
||||||
|
}
|
||||||
|
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#if MB_FUNC_WRITE_MULTIPLE_COILS_ENABLED > 0
|
||||||
|
eMBException
|
||||||
|
eMBFuncWriteMultipleCoils( UCHAR * pucFrame, USHORT * usLen )
|
||||||
|
{
|
||||||
|
USHORT usRegAddress;
|
||||||
|
USHORT usCoilCnt;
|
||||||
|
UCHAR ucByteCount;
|
||||||
|
UCHAR ucByteCountVerify;
|
||||||
|
|
||||||
|
eMBException eStatus = MB_EX_NONE;
|
||||||
|
eMBErrorCode eRegStatus;
|
||||||
|
|
||||||
|
if( *usLen > ( MB_PDU_FUNC_WRITE_SIZE + MB_PDU_SIZE_MIN ) )
|
||||||
|
{
|
||||||
|
usRegAddress = ( USHORT )( pucFrame[MB_PDU_FUNC_WRITE_MUL_ADDR_OFF] << 8 );
|
||||||
|
usRegAddress |= ( USHORT )( pucFrame[MB_PDU_FUNC_WRITE_MUL_ADDR_OFF + 1] );
|
||||||
|
usRegAddress++;
|
||||||
|
|
||||||
|
usCoilCnt = ( USHORT )( pucFrame[MB_PDU_FUNC_WRITE_MUL_COILCNT_OFF] << 8 );
|
||||||
|
usCoilCnt |= ( USHORT )( pucFrame[MB_PDU_FUNC_WRITE_MUL_COILCNT_OFF + 1] );
|
||||||
|
|
||||||
|
ucByteCount = pucFrame[MB_PDU_FUNC_WRITE_MUL_BYTECNT_OFF];
|
||||||
|
|
||||||
|
/* Compute the number of expected bytes in the request. */
|
||||||
|
if( ( usCoilCnt & 0x0007 ) != 0 )
|
||||||
|
{
|
||||||
|
ucByteCountVerify = ( UCHAR )( usCoilCnt / 8 + 1 );
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
ucByteCountVerify = ( UCHAR )( usCoilCnt / 8 );
|
||||||
|
}
|
||||||
|
|
||||||
|
if( ( usCoilCnt >= 1 ) &&
|
||||||
|
( usCoilCnt <= MB_PDU_FUNC_WRITE_MUL_COILCNT_MAX ) &&
|
||||||
|
( ucByteCountVerify == ucByteCount ) )
|
||||||
|
{
|
||||||
|
eRegStatus =
|
||||||
|
eMBRegCoilsCB( &pucFrame[MB_PDU_FUNC_WRITE_MUL_VALUES_OFF],
|
||||||
|
usRegAddress, usCoilCnt, MB_REG_WRITE );
|
||||||
|
|
||||||
|
/* If an error occured convert it into a Modbus exception. */
|
||||||
|
if( eRegStatus != MB_ENOERR )
|
||||||
|
{
|
||||||
|
eStatus = prveMBError2Exception( eRegStatus );
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
/* The response contains the function code, the starting address
|
||||||
|
* and the quantity of registers. We reuse the old values in the
|
||||||
|
* buffer because they are still valid. */
|
||||||
|
*usLen = MB_PDU_FUNC_WRITE_MUL_BYTECNT_OFF;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
eStatus = MB_EX_ILLEGAL_DATA_VALUE;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
/* Can't be a valid write coil register request because the length
|
||||||
|
* is incorrect. */
|
||||||
|
eStatus = MB_EX_ILLEGAL_DATA_VALUE;
|
||||||
|
}
|
||||||
|
return eStatus;
|
||||||
|
}
|
||||||
|
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#endif
|
||||||
|
|
@ -0,0 +1,28 @@
|
||||||
|
/*
|
||||||
|
* FreeModbus Libary: A portable Modbus implementation for Modbus ASCII/RTU.
|
||||||
|
* Copyright (c) 2006-2018 Christian Walter <cwalter@embedded-solutions.at>
|
||||||
|
* All rights reserved.
|
||||||
|
*
|
||||||
|
* Redistribution and use in source and binary forms, with or without
|
||||||
|
* modification, are permitted provided that the following conditions
|
||||||
|
* are met:
|
||||||
|
* 1. Redistributions of source code must retain the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer.
|
||||||
|
* 2. Redistributions in binary form must reproduce the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer in the
|
||||||
|
* documentation and/or other materials provided with the distribution.
|
||||||
|
* 3. The name of the author may not be used to endorse or promote products
|
||||||
|
* derived from this software without specific prior written permission.
|
||||||
|
*
|
||||||
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
|
||||||
|
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
|
||||||
|
* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
|
||||||
|
* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
|
||||||
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
|
||||||
|
* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
||||||
|
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
||||||
|
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
||||||
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
|
||||||
|
* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||||||
|
*
|
||||||
|
*/
|
||||||
|
|
@ -0,0 +1,133 @@
|
||||||
|
/*
|
||||||
|
* FreeModbus Libary: A portable Modbus implementation for Modbus ASCII/RTU.
|
||||||
|
* Copyright (c) 2006-2018 Christian Walter <cwalter@embedded-solutions.at>
|
||||||
|
* All rights reserved.
|
||||||
|
*
|
||||||
|
* Redistribution and use in source and binary forms, with or without
|
||||||
|
* modification, are permitted provided that the following conditions
|
||||||
|
* are met:
|
||||||
|
* 1. Redistributions of source code must retain the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer.
|
||||||
|
* 2. Redistributions in binary form must reproduce the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer in the
|
||||||
|
* documentation and/or other materials provided with the distribution.
|
||||||
|
* 3. The name of the author may not be used to endorse or promote products
|
||||||
|
* derived from this software without specific prior written permission.
|
||||||
|
*
|
||||||
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
|
||||||
|
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
|
||||||
|
* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
|
||||||
|
* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
|
||||||
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
|
||||||
|
* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
||||||
|
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
||||||
|
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
||||||
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
|
||||||
|
* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||||||
|
*
|
||||||
|
*/
|
||||||
|
|
||||||
|
/* ----------------------- System includes ----------------------------------*/
|
||||||
|
#include "stdlib.h"
|
||||||
|
#include "string.h"
|
||||||
|
|
||||||
|
/* ----------------------- Platform includes --------------------------------*/
|
||||||
|
#include "port.h"
|
||||||
|
|
||||||
|
/* ----------------------- Modbus includes ----------------------------------*/
|
||||||
|
#include "mb.h"
|
||||||
|
#include "mbframe.h"
|
||||||
|
#include "mbproto.h"
|
||||||
|
#include "mbconfig.h"
|
||||||
|
|
||||||
|
/* ----------------------- Defines ------------------------------------------*/
|
||||||
|
#define MB_PDU_FUNC_READ_ADDR_OFF ( MB_PDU_DATA_OFF )
|
||||||
|
#define MB_PDU_FUNC_READ_DISCCNT_OFF ( MB_PDU_DATA_OFF + 2 )
|
||||||
|
#define MB_PDU_FUNC_READ_SIZE ( 4 )
|
||||||
|
#define MB_PDU_FUNC_READ_DISCCNT_MAX ( 0x07D0 )
|
||||||
|
|
||||||
|
/* ----------------------- Static functions ---------------------------------*/
|
||||||
|
eMBException prveMBError2Exception( eMBErrorCode eErrorCode );
|
||||||
|
|
||||||
|
/* ----------------------- Start implementation -----------------------------*/
|
||||||
|
|
||||||
|
#if MB_FUNC_READ_COILS_ENABLED > 0
|
||||||
|
|
||||||
|
eMBException
|
||||||
|
eMBFuncReadDiscreteInputs( UCHAR * pucFrame, USHORT * usLen )
|
||||||
|
{
|
||||||
|
USHORT usRegAddress;
|
||||||
|
USHORT usDiscreteCnt;
|
||||||
|
UCHAR ucNBytes;
|
||||||
|
UCHAR *pucFrameCur;
|
||||||
|
|
||||||
|
eMBException eStatus = MB_EX_NONE;
|
||||||
|
eMBErrorCode eRegStatus;
|
||||||
|
|
||||||
|
if( *usLen == ( MB_PDU_FUNC_READ_SIZE + MB_PDU_SIZE_MIN ) )
|
||||||
|
{
|
||||||
|
usRegAddress = ( USHORT )( pucFrame[MB_PDU_FUNC_READ_ADDR_OFF] << 8 );
|
||||||
|
usRegAddress |= ( USHORT )( pucFrame[MB_PDU_FUNC_READ_ADDR_OFF + 1] );
|
||||||
|
usRegAddress++;
|
||||||
|
|
||||||
|
usDiscreteCnt = ( USHORT )( pucFrame[MB_PDU_FUNC_READ_DISCCNT_OFF] << 8 );
|
||||||
|
usDiscreteCnt |= ( USHORT )( pucFrame[MB_PDU_FUNC_READ_DISCCNT_OFF + 1] );
|
||||||
|
|
||||||
|
/* Check if the number of registers to read is valid. If not
|
||||||
|
* return Modbus illegal data value exception.
|
||||||
|
*/
|
||||||
|
if( ( usDiscreteCnt >= 1 ) &&
|
||||||
|
( usDiscreteCnt < MB_PDU_FUNC_READ_DISCCNT_MAX ) )
|
||||||
|
{
|
||||||
|
/* Set the current PDU data pointer to the beginning. */
|
||||||
|
pucFrameCur = &pucFrame[MB_PDU_FUNC_OFF];
|
||||||
|
*usLen = MB_PDU_FUNC_OFF;
|
||||||
|
|
||||||
|
/* First byte contains the function code. */
|
||||||
|
*pucFrameCur++ = MB_FUNC_READ_DISCRETE_INPUTS;
|
||||||
|
*usLen += 1;
|
||||||
|
|
||||||
|
/* Test if the quantity of coils is a multiple of 8. If not last
|
||||||
|
* byte is only partially field with unused coils set to zero. */
|
||||||
|
if( ( usDiscreteCnt & 0x0007 ) != 0 )
|
||||||
|
{
|
||||||
|
ucNBytes = ( UCHAR ) ( usDiscreteCnt / 8 + 1 );
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
ucNBytes = ( UCHAR ) ( usDiscreteCnt / 8 );
|
||||||
|
}
|
||||||
|
*pucFrameCur++ = ucNBytes;
|
||||||
|
*usLen += 1;
|
||||||
|
|
||||||
|
eRegStatus =
|
||||||
|
eMBRegDiscreteCB( pucFrameCur, usRegAddress, usDiscreteCnt );
|
||||||
|
|
||||||
|
/* If an error occured convert it into a Modbus exception. */
|
||||||
|
if( eRegStatus != MB_ENOERR )
|
||||||
|
{
|
||||||
|
eStatus = prveMBError2Exception( eRegStatus );
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
/* The response contains the function code, the starting address
|
||||||
|
* and the quantity of registers. We reuse the old values in the
|
||||||
|
* buffer because they are still valid. */
|
||||||
|
*usLen += ucNBytes;;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
eStatus = MB_EX_ILLEGAL_DATA_VALUE;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
/* Can't be a valid read coil register request because the length
|
||||||
|
* is incorrect. */
|
||||||
|
eStatus = MB_EX_ILLEGAL_DATA_VALUE;
|
||||||
|
}
|
||||||
|
return eStatus;
|
||||||
|
}
|
||||||
|
|
||||||
|
#endif
|
||||||
|
|
@ -0,0 +1,307 @@
|
||||||
|
/*
|
||||||
|
* FreeModbus Libary: A portable Modbus implementation for Modbus ASCII/RTU.
|
||||||
|
* Copyright (c) 2006-2018 Christian Walter <cwalter@embedded-solutions.at>
|
||||||
|
* All rights reserved.
|
||||||
|
*
|
||||||
|
* Redistribution and use in source and binary forms, with or without
|
||||||
|
* modification, are permitted provided that the following conditions
|
||||||
|
* are met:
|
||||||
|
* 1. Redistributions of source code must retain the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer.
|
||||||
|
* 2. Redistributions in binary form must reproduce the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer in the
|
||||||
|
* documentation and/or other materials provided with the distribution.
|
||||||
|
* 3. The name of the author may not be used to endorse or promote products
|
||||||
|
* derived from this software without specific prior written permission.
|
||||||
|
*
|
||||||
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
|
||||||
|
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
|
||||||
|
* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
|
||||||
|
* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
|
||||||
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
|
||||||
|
* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
||||||
|
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
||||||
|
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
||||||
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
|
||||||
|
* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||||||
|
*
|
||||||
|
*/
|
||||||
|
|
||||||
|
/* ----------------------- System includes ----------------------------------*/
|
||||||
|
#include "stdlib.h"
|
||||||
|
#include "string.h"
|
||||||
|
|
||||||
|
/* ----------------------- Platform includes --------------------------------*/
|
||||||
|
#include "port.h"
|
||||||
|
|
||||||
|
/* ----------------------- Modbus includes ----------------------------------*/
|
||||||
|
#include "mb.h"
|
||||||
|
#include "mbframe.h"
|
||||||
|
#include "mbproto.h"
|
||||||
|
#include "mbconfig.h"
|
||||||
|
|
||||||
|
/* ----------------------- Defines ------------------------------------------*/
|
||||||
|
#define MB_PDU_FUNC_READ_ADDR_OFF ( MB_PDU_DATA_OFF + 0)
|
||||||
|
#define MB_PDU_FUNC_READ_REGCNT_OFF ( MB_PDU_DATA_OFF + 2 )
|
||||||
|
#define MB_PDU_FUNC_READ_SIZE ( 4 )
|
||||||
|
#define MB_PDU_FUNC_READ_REGCNT_MAX ( 0x007D )
|
||||||
|
|
||||||
|
#define MB_PDU_FUNC_WRITE_ADDR_OFF ( MB_PDU_DATA_OFF + 0)
|
||||||
|
#define MB_PDU_FUNC_WRITE_VALUE_OFF ( MB_PDU_DATA_OFF + 2 )
|
||||||
|
#define MB_PDU_FUNC_WRITE_SIZE ( 4 )
|
||||||
|
|
||||||
|
#define MB_PDU_FUNC_WRITE_MUL_ADDR_OFF ( MB_PDU_DATA_OFF + 0 )
|
||||||
|
#define MB_PDU_FUNC_WRITE_MUL_REGCNT_OFF ( MB_PDU_DATA_OFF + 2 )
|
||||||
|
#define MB_PDU_FUNC_WRITE_MUL_BYTECNT_OFF ( MB_PDU_DATA_OFF + 4 )
|
||||||
|
#define MB_PDU_FUNC_WRITE_MUL_VALUES_OFF ( MB_PDU_DATA_OFF + 5 )
|
||||||
|
#define MB_PDU_FUNC_WRITE_MUL_SIZE_MIN ( 5 )
|
||||||
|
#define MB_PDU_FUNC_WRITE_MUL_REGCNT_MAX ( 0x0078 )
|
||||||
|
|
||||||
|
#define MB_PDU_FUNC_READWRITE_READ_ADDR_OFF ( MB_PDU_DATA_OFF + 0 )
|
||||||
|
#define MB_PDU_FUNC_READWRITE_READ_REGCNT_OFF ( MB_PDU_DATA_OFF + 2 )
|
||||||
|
#define MB_PDU_FUNC_READWRITE_WRITE_ADDR_OFF ( MB_PDU_DATA_OFF + 4 )
|
||||||
|
#define MB_PDU_FUNC_READWRITE_WRITE_REGCNT_OFF ( MB_PDU_DATA_OFF + 6 )
|
||||||
|
#define MB_PDU_FUNC_READWRITE_BYTECNT_OFF ( MB_PDU_DATA_OFF + 8 )
|
||||||
|
#define MB_PDU_FUNC_READWRITE_WRITE_VALUES_OFF ( MB_PDU_DATA_OFF + 9 )
|
||||||
|
#define MB_PDU_FUNC_READWRITE_SIZE_MIN ( 9 )
|
||||||
|
|
||||||
|
/* ----------------------- Static functions ---------------------------------*/
|
||||||
|
eMBException prveMBError2Exception( eMBErrorCode eErrorCode );
|
||||||
|
|
||||||
|
/* ----------------------- Start implementation -----------------------------*/
|
||||||
|
|
||||||
|
#if MB_FUNC_WRITE_HOLDING_ENABLED > 0
|
||||||
|
|
||||||
|
eMBException
|
||||||
|
eMBFuncWriteHoldingRegister( UCHAR * pucFrame, USHORT * usLen )
|
||||||
|
{
|
||||||
|
USHORT usRegAddress;
|
||||||
|
eMBException eStatus = MB_EX_NONE;
|
||||||
|
eMBErrorCode eRegStatus;
|
||||||
|
|
||||||
|
if( *usLen == ( MB_PDU_FUNC_WRITE_SIZE + MB_PDU_SIZE_MIN ) )
|
||||||
|
{
|
||||||
|
usRegAddress = ( USHORT )( pucFrame[MB_PDU_FUNC_WRITE_ADDR_OFF] << 8 );
|
||||||
|
usRegAddress |= ( USHORT )( pucFrame[MB_PDU_FUNC_WRITE_ADDR_OFF + 1] );
|
||||||
|
usRegAddress++;
|
||||||
|
|
||||||
|
/* Make callback to update the value. */
|
||||||
|
eRegStatus = eMBRegHoldingCB( &pucFrame[MB_PDU_FUNC_WRITE_VALUE_OFF],
|
||||||
|
usRegAddress, 1, MB_REG_WRITE );
|
||||||
|
|
||||||
|
/* If an error occured convert it into a Modbus exception. */
|
||||||
|
if( eRegStatus != MB_ENOERR )
|
||||||
|
{
|
||||||
|
eStatus = prveMBError2Exception( eRegStatus );
|
||||||
|
}
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
/* Can't be a valid request because the length is incorrect. */
|
||||||
|
eStatus = MB_EX_ILLEGAL_DATA_VALUE;
|
||||||
|
}
|
||||||
|
return eStatus;
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#if MB_FUNC_WRITE_MULTIPLE_HOLDING_ENABLED > 0
|
||||||
|
eMBException
|
||||||
|
eMBFuncWriteMultipleHoldingRegister( UCHAR * pucFrame, USHORT * usLen )
|
||||||
|
{
|
||||||
|
USHORT usRegAddress;
|
||||||
|
USHORT usRegCount;
|
||||||
|
UCHAR ucRegByteCount;
|
||||||
|
|
||||||
|
eMBException eStatus = MB_EX_NONE;
|
||||||
|
eMBErrorCode eRegStatus;
|
||||||
|
|
||||||
|
if( *usLen >= ( MB_PDU_FUNC_WRITE_MUL_SIZE_MIN + MB_PDU_SIZE_MIN ) )
|
||||||
|
{
|
||||||
|
usRegAddress = ( USHORT )( pucFrame[MB_PDU_FUNC_WRITE_MUL_ADDR_OFF] << 8 );
|
||||||
|
usRegAddress |= ( USHORT )( pucFrame[MB_PDU_FUNC_WRITE_MUL_ADDR_OFF + 1] );
|
||||||
|
usRegAddress++;
|
||||||
|
|
||||||
|
usRegCount = ( USHORT )( pucFrame[MB_PDU_FUNC_WRITE_MUL_REGCNT_OFF] << 8 );
|
||||||
|
usRegCount |= ( USHORT )( pucFrame[MB_PDU_FUNC_WRITE_MUL_REGCNT_OFF + 1] );
|
||||||
|
|
||||||
|
ucRegByteCount = pucFrame[MB_PDU_FUNC_WRITE_MUL_BYTECNT_OFF];
|
||||||
|
|
||||||
|
if( ( usRegCount >= 1 ) &&
|
||||||
|
( usRegCount <= MB_PDU_FUNC_WRITE_MUL_REGCNT_MAX ) &&
|
||||||
|
( ucRegByteCount == ( UCHAR ) ( 2 * usRegCount ) ) )
|
||||||
|
{
|
||||||
|
/* Make callback to update the register values. */
|
||||||
|
eRegStatus =
|
||||||
|
eMBRegHoldingCB( &pucFrame[MB_PDU_FUNC_WRITE_MUL_VALUES_OFF],
|
||||||
|
usRegAddress, usRegCount, MB_REG_WRITE );
|
||||||
|
|
||||||
|
/* If an error occured convert it into a Modbus exception. */
|
||||||
|
if( eRegStatus != MB_ENOERR )
|
||||||
|
{
|
||||||
|
eStatus = prveMBError2Exception( eRegStatus );
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
/* The response contains the function code, the starting
|
||||||
|
* address and the quantity of registers. We reuse the
|
||||||
|
* old values in the buffer because they are still valid.
|
||||||
|
*/
|
||||||
|
*usLen = MB_PDU_FUNC_WRITE_MUL_BYTECNT_OFF;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
eStatus = MB_EX_ILLEGAL_DATA_VALUE;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
/* Can't be a valid request because the length is incorrect. */
|
||||||
|
eStatus = MB_EX_ILLEGAL_DATA_VALUE;
|
||||||
|
}
|
||||||
|
return eStatus;
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#if MB_FUNC_READ_HOLDING_ENABLED > 0
|
||||||
|
|
||||||
|
eMBException
|
||||||
|
eMBFuncReadHoldingRegister( UCHAR * pucFrame, USHORT * usLen )
|
||||||
|
{
|
||||||
|
USHORT usRegAddress;
|
||||||
|
USHORT usRegCount;
|
||||||
|
UCHAR *pucFrameCur;
|
||||||
|
|
||||||
|
eMBException eStatus = MB_EX_NONE;
|
||||||
|
eMBErrorCode eRegStatus;
|
||||||
|
|
||||||
|
if( *usLen == ( MB_PDU_FUNC_READ_SIZE + MB_PDU_SIZE_MIN ) )
|
||||||
|
{
|
||||||
|
usRegAddress = ( USHORT )( pucFrame[MB_PDU_FUNC_READ_ADDR_OFF] << 8 );
|
||||||
|
usRegAddress |= ( USHORT )( pucFrame[MB_PDU_FUNC_READ_ADDR_OFF + 1] );
|
||||||
|
usRegAddress++;
|
||||||
|
|
||||||
|
usRegCount = ( USHORT )( pucFrame[MB_PDU_FUNC_READ_REGCNT_OFF] << 8 );
|
||||||
|
usRegCount = ( USHORT )( pucFrame[MB_PDU_FUNC_READ_REGCNT_OFF + 1] );
|
||||||
|
|
||||||
|
/* Check if the number of registers to read is valid. If not
|
||||||
|
* return Modbus illegal data value exception.
|
||||||
|
*/
|
||||||
|
if( ( usRegCount >= 1 ) && ( usRegCount <= MB_PDU_FUNC_READ_REGCNT_MAX ) )
|
||||||
|
{
|
||||||
|
/* Set the current PDU data pointer to the beginning. */
|
||||||
|
pucFrameCur = &pucFrame[MB_PDU_FUNC_OFF];
|
||||||
|
*usLen = MB_PDU_FUNC_OFF;
|
||||||
|
|
||||||
|
/* First byte contains the function code. */
|
||||||
|
*pucFrameCur++ = MB_FUNC_READ_HOLDING_REGISTER;
|
||||||
|
*usLen += 1;
|
||||||
|
|
||||||
|
/* Second byte in the response contain the number of bytes. */
|
||||||
|
*pucFrameCur++ = ( UCHAR ) ( usRegCount * 2 );
|
||||||
|
*usLen += 1;
|
||||||
|
|
||||||
|
/* Make callback to fill the buffer. */
|
||||||
|
eRegStatus = eMBRegHoldingCB( pucFrameCur, usRegAddress, usRegCount, MB_REG_READ );
|
||||||
|
/* If an error occured convert it into a Modbus exception. */
|
||||||
|
if( eRegStatus != MB_ENOERR )
|
||||||
|
{
|
||||||
|
eStatus = prveMBError2Exception( eRegStatus );
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
*usLen += usRegCount * 2;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
eStatus = MB_EX_ILLEGAL_DATA_VALUE;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
/* Can't be a valid request because the length is incorrect. */
|
||||||
|
eStatus = MB_EX_ILLEGAL_DATA_VALUE;
|
||||||
|
}
|
||||||
|
return eStatus;
|
||||||
|
}
|
||||||
|
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#if MB_FUNC_READWRITE_HOLDING_ENABLED > 0
|
||||||
|
|
||||||
|
eMBException
|
||||||
|
eMBFuncReadWriteMultipleHoldingRegister( UCHAR * pucFrame, USHORT * usLen )
|
||||||
|
{
|
||||||
|
USHORT usRegReadAddress;
|
||||||
|
USHORT usRegReadCount;
|
||||||
|
USHORT usRegWriteAddress;
|
||||||
|
USHORT usRegWriteCount;
|
||||||
|
UCHAR ucRegWriteByteCount;
|
||||||
|
UCHAR *pucFrameCur;
|
||||||
|
|
||||||
|
eMBException eStatus = MB_EX_NONE;
|
||||||
|
eMBErrorCode eRegStatus;
|
||||||
|
|
||||||
|
if( *usLen >= ( MB_PDU_FUNC_READWRITE_SIZE_MIN + MB_PDU_SIZE_MIN ) )
|
||||||
|
{
|
||||||
|
usRegReadAddress = ( USHORT )( pucFrame[MB_PDU_FUNC_READWRITE_READ_ADDR_OFF] << 8U );
|
||||||
|
usRegReadAddress |= ( USHORT )( pucFrame[MB_PDU_FUNC_READWRITE_READ_ADDR_OFF + 1] );
|
||||||
|
usRegReadAddress++;
|
||||||
|
|
||||||
|
usRegReadCount = ( USHORT )( pucFrame[MB_PDU_FUNC_READWRITE_READ_REGCNT_OFF] << 8U );
|
||||||
|
usRegReadCount |= ( USHORT )( pucFrame[MB_PDU_FUNC_READWRITE_READ_REGCNT_OFF + 1] );
|
||||||
|
|
||||||
|
usRegWriteAddress = ( USHORT )( pucFrame[MB_PDU_FUNC_READWRITE_WRITE_ADDR_OFF] << 8U );
|
||||||
|
usRegWriteAddress |= ( USHORT )( pucFrame[MB_PDU_FUNC_READWRITE_WRITE_ADDR_OFF + 1] );
|
||||||
|
usRegWriteAddress++;
|
||||||
|
|
||||||
|
usRegWriteCount = ( USHORT )( pucFrame[MB_PDU_FUNC_READWRITE_WRITE_REGCNT_OFF] << 8U );
|
||||||
|
usRegWriteCount |= ( USHORT )( pucFrame[MB_PDU_FUNC_READWRITE_WRITE_REGCNT_OFF + 1] );
|
||||||
|
|
||||||
|
ucRegWriteByteCount = pucFrame[MB_PDU_FUNC_READWRITE_BYTECNT_OFF];
|
||||||
|
|
||||||
|
if( ( usRegReadCount >= 1 ) && ( usRegReadCount <= 0x7D ) &&
|
||||||
|
( usRegWriteCount >= 1 ) && ( usRegWriteCount <= 0x79 ) &&
|
||||||
|
( ( 2 * usRegWriteCount ) == ucRegWriteByteCount ) )
|
||||||
|
{
|
||||||
|
/* Make callback to update the register values. */
|
||||||
|
eRegStatus = eMBRegHoldingCB( &pucFrame[MB_PDU_FUNC_READWRITE_WRITE_VALUES_OFF],
|
||||||
|
usRegWriteAddress, usRegWriteCount, MB_REG_WRITE );
|
||||||
|
|
||||||
|
if( eRegStatus == MB_ENOERR )
|
||||||
|
{
|
||||||
|
/* Set the current PDU data pointer to the beginning. */
|
||||||
|
pucFrameCur = &pucFrame[MB_PDU_FUNC_OFF];
|
||||||
|
*usLen = MB_PDU_FUNC_OFF;
|
||||||
|
|
||||||
|
/* First byte contains the function code. */
|
||||||
|
*pucFrameCur++ = MB_FUNC_READWRITE_MULTIPLE_REGISTERS;
|
||||||
|
*usLen += 1;
|
||||||
|
|
||||||
|
/* Second byte in the response contain the number of bytes. */
|
||||||
|
*pucFrameCur++ = ( UCHAR ) ( usRegReadCount * 2 );
|
||||||
|
*usLen += 1;
|
||||||
|
|
||||||
|
/* Make the read callback. */
|
||||||
|
eRegStatus =
|
||||||
|
eMBRegHoldingCB( pucFrameCur, usRegReadAddress, usRegReadCount, MB_REG_READ );
|
||||||
|
if( eRegStatus == MB_ENOERR )
|
||||||
|
{
|
||||||
|
*usLen += 2 * usRegReadCount;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
if( eRegStatus != MB_ENOERR )
|
||||||
|
{
|
||||||
|
eStatus = prveMBError2Exception( eRegStatus );
|
||||||
|
}
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
eStatus = MB_EX_ILLEGAL_DATA_VALUE;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
return eStatus;
|
||||||
|
}
|
||||||
|
|
||||||
|
#endif
|
||||||
|
|
@ -0,0 +1,121 @@
|
||||||
|
/*
|
||||||
|
* FreeModbus Libary: A portable Modbus implementation for Modbus ASCII/RTU.
|
||||||
|
* Copyright (c) 2006-2018 Christian Walter <cwalter@embedded-solutions.at>
|
||||||
|
* All rights reserved.
|
||||||
|
*
|
||||||
|
* Redistribution and use in source and binary forms, with or without
|
||||||
|
* modification, are permitted provided that the following conditions
|
||||||
|
* are met:
|
||||||
|
* 1. Redistributions of source code must retain the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer.
|
||||||
|
* 2. Redistributions in binary form must reproduce the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer in the
|
||||||
|
* documentation and/or other materials provided with the distribution.
|
||||||
|
* 3. The name of the author may not be used to endorse or promote products
|
||||||
|
* derived from this software without specific prior written permission.
|
||||||
|
*
|
||||||
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
|
||||||
|
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
|
||||||
|
* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
|
||||||
|
* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
|
||||||
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
|
||||||
|
* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
||||||
|
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
||||||
|
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
||||||
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
|
||||||
|
* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||||||
|
*
|
||||||
|
*/
|
||||||
|
|
||||||
|
/* ----------------------- System includes ----------------------------------*/
|
||||||
|
#include "stdlib.h"
|
||||||
|
#include "string.h"
|
||||||
|
|
||||||
|
/* ----------------------- Platform includes --------------------------------*/
|
||||||
|
#include "port.h"
|
||||||
|
|
||||||
|
/* ----------------------- Modbus includes ----------------------------------*/
|
||||||
|
#include "mb.h"
|
||||||
|
#include "mbframe.h"
|
||||||
|
#include "mbproto.h"
|
||||||
|
#include "mbconfig.h"
|
||||||
|
|
||||||
|
/* ----------------------- Defines ------------------------------------------*/
|
||||||
|
#define MB_PDU_FUNC_READ_ADDR_OFF ( MB_PDU_DATA_OFF )
|
||||||
|
#define MB_PDU_FUNC_READ_REGCNT_OFF ( MB_PDU_DATA_OFF + 2 )
|
||||||
|
#define MB_PDU_FUNC_READ_SIZE ( 4 )
|
||||||
|
#define MB_PDU_FUNC_READ_REGCNT_MAX ( 0x007D )
|
||||||
|
|
||||||
|
#define MB_PDU_FUNC_READ_RSP_BYTECNT_OFF ( MB_PDU_DATA_OFF )
|
||||||
|
|
||||||
|
/* ----------------------- Static functions ---------------------------------*/
|
||||||
|
eMBException prveMBError2Exception( eMBErrorCode eErrorCode );
|
||||||
|
|
||||||
|
/* ----------------------- Start implementation -----------------------------*/
|
||||||
|
#if MB_FUNC_READ_INPUT_ENABLED > 0
|
||||||
|
|
||||||
|
eMBException
|
||||||
|
eMBFuncReadInputRegister( UCHAR * pucFrame, USHORT * usLen )
|
||||||
|
{
|
||||||
|
USHORT usRegAddress;
|
||||||
|
USHORT usRegCount;
|
||||||
|
UCHAR *pucFrameCur;
|
||||||
|
|
||||||
|
eMBException eStatus = MB_EX_NONE;
|
||||||
|
eMBErrorCode eRegStatus;
|
||||||
|
|
||||||
|
if( *usLen == ( MB_PDU_FUNC_READ_SIZE + MB_PDU_SIZE_MIN ) )
|
||||||
|
{
|
||||||
|
usRegAddress = ( USHORT )( pucFrame[MB_PDU_FUNC_READ_ADDR_OFF] << 8 );
|
||||||
|
usRegAddress |= ( USHORT )( pucFrame[MB_PDU_FUNC_READ_ADDR_OFF + 1] );
|
||||||
|
usRegAddress++;
|
||||||
|
|
||||||
|
usRegCount = ( USHORT )( pucFrame[MB_PDU_FUNC_READ_REGCNT_OFF] << 8 );
|
||||||
|
usRegCount |= ( USHORT )( pucFrame[MB_PDU_FUNC_READ_REGCNT_OFF + 1] );
|
||||||
|
|
||||||
|
/* Check if the number of registers to read is valid. If not
|
||||||
|
* return Modbus illegal data value exception.
|
||||||
|
*/
|
||||||
|
if( ( usRegCount >= 1 )
|
||||||
|
&& ( usRegCount < MB_PDU_FUNC_READ_REGCNT_MAX ) )
|
||||||
|
{
|
||||||
|
/* Set the current PDU data pointer to the beginning. */
|
||||||
|
pucFrameCur = &pucFrame[MB_PDU_FUNC_OFF];
|
||||||
|
*usLen = MB_PDU_FUNC_OFF;
|
||||||
|
|
||||||
|
/* First byte contains the function code. */
|
||||||
|
*pucFrameCur++ = MB_FUNC_READ_INPUT_REGISTER;
|
||||||
|
*usLen += 1;
|
||||||
|
|
||||||
|
/* Second byte in the response contain the number of bytes. */
|
||||||
|
*pucFrameCur++ = ( UCHAR )( usRegCount * 2 );
|
||||||
|
*usLen += 1;
|
||||||
|
|
||||||
|
eRegStatus =
|
||||||
|
eMBRegInputCB( pucFrameCur, usRegAddress, usRegCount );
|
||||||
|
|
||||||
|
/* If an error occured convert it into a Modbus exception. */
|
||||||
|
if( eRegStatus != MB_ENOERR )
|
||||||
|
{
|
||||||
|
eStatus = prveMBError2Exception( eRegStatus );
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
*usLen += usRegCount * 2;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
eStatus = MB_EX_ILLEGAL_DATA_VALUE;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
/* Can't be a valid read input register request because the length
|
||||||
|
* is incorrect. */
|
||||||
|
eStatus = MB_EX_ILLEGAL_DATA_VALUE;
|
||||||
|
}
|
||||||
|
return eStatus;
|
||||||
|
}
|
||||||
|
|
||||||
|
#endif
|
||||||
|
|
@ -0,0 +1,87 @@
|
||||||
|
/*
|
||||||
|
* FreeModbus Libary: A portable Modbus implementation for Modbus ASCII/RTU.
|
||||||
|
* Copyright (c) 2006-2018 Christian Walter <cwalter@embedded-solutions.at>
|
||||||
|
* All rights reserved.
|
||||||
|
*
|
||||||
|
* Redistribution and use in source and binary forms, with or without
|
||||||
|
* modification, are permitted provided that the following conditions
|
||||||
|
* are met:
|
||||||
|
* 1. Redistributions of source code must retain the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer.
|
||||||
|
* 2. Redistributions in binary form must reproduce the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer in the
|
||||||
|
* documentation and/or other materials provided with the distribution.
|
||||||
|
* 3. The name of the author may not be used to endorse or promote products
|
||||||
|
* derived from this software without specific prior written permission.
|
||||||
|
*
|
||||||
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
|
||||||
|
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
|
||||||
|
* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
|
||||||
|
* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
|
||||||
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
|
||||||
|
* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
||||||
|
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
||||||
|
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
||||||
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
|
||||||
|
* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||||||
|
*
|
||||||
|
*/
|
||||||
|
|
||||||
|
/* ----------------------- System includes ----------------------------------*/
|
||||||
|
#include "stdlib.h"
|
||||||
|
#include "string.h"
|
||||||
|
|
||||||
|
/* ----------------------- Platform includes --------------------------------*/
|
||||||
|
#include "port.h"
|
||||||
|
|
||||||
|
/* ----------------------- Modbus includes ----------------------------------*/
|
||||||
|
#include "mb.h"
|
||||||
|
#include "mbframe.h"
|
||||||
|
#include "mbproto.h"
|
||||||
|
#include "mbconfig.h"
|
||||||
|
|
||||||
|
#if MB_FUNC_OTHER_REP_SLAVEID_ENABLED > 0
|
||||||
|
|
||||||
|
/* ----------------------- Static variables ---------------------------------*/
|
||||||
|
static UCHAR ucMBSlaveID[MB_FUNC_OTHER_REP_SLAVEID_BUF];
|
||||||
|
static USHORT usMBSlaveIDLen;
|
||||||
|
|
||||||
|
/* ----------------------- Start implementation -----------------------------*/
|
||||||
|
|
||||||
|
eMBErrorCode
|
||||||
|
eMBSetSlaveID( UCHAR ucSlaveID, BOOL xIsRunning,
|
||||||
|
UCHAR const *pucAdditional, USHORT usAdditionalLen )
|
||||||
|
{
|
||||||
|
eMBErrorCode eStatus = MB_ENOERR;
|
||||||
|
|
||||||
|
/* the first byte and second byte in the buffer is reserved for
|
||||||
|
* the parameter ucSlaveID and the running flag. The rest of
|
||||||
|
* the buffer is available for additional data. */
|
||||||
|
if( usAdditionalLen + 2 < MB_FUNC_OTHER_REP_SLAVEID_BUF )
|
||||||
|
{
|
||||||
|
usMBSlaveIDLen = 0;
|
||||||
|
ucMBSlaveID[usMBSlaveIDLen++] = ucSlaveID;
|
||||||
|
ucMBSlaveID[usMBSlaveIDLen++] = ( UCHAR )( xIsRunning ? 0xFF : 0x00 );
|
||||||
|
if( usAdditionalLen > 0 )
|
||||||
|
{
|
||||||
|
memcpy( &ucMBSlaveID[usMBSlaveIDLen], pucAdditional,
|
||||||
|
( size_t )usAdditionalLen );
|
||||||
|
usMBSlaveIDLen += usAdditionalLen;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
eStatus = MB_ENORES;
|
||||||
|
}
|
||||||
|
return eStatus;
|
||||||
|
}
|
||||||
|
|
||||||
|
eMBException
|
||||||
|
eMBFuncReportSlaveID( UCHAR * pucFrame, USHORT * usLen )
|
||||||
|
{
|
||||||
|
memcpy( &pucFrame[MB_PDU_DATA_OFF], &ucMBSlaveID[0], ( size_t )usMBSlaveIDLen );
|
||||||
|
*usLen = ( USHORT )( MB_PDU_DATA_OFF + usMBSlaveIDLen );
|
||||||
|
return MB_EX_NONE;
|
||||||
|
}
|
||||||
|
|
||||||
|
#endif
|
||||||
|
|
@ -0,0 +1,128 @@
|
||||||
|
/*
|
||||||
|
* FreeModbus Libary: A portable Modbus implementation for Modbus ASCII/RTU.
|
||||||
|
* Copyright (c) 2006-2018 Christian Walter <cwalter@embedded-solutions.at>
|
||||||
|
* All rights reserved.
|
||||||
|
*
|
||||||
|
* Redistribution and use in source and binary forms, with or without
|
||||||
|
* modification, are permitted provided that the following conditions
|
||||||
|
* are met:
|
||||||
|
* 1. Redistributions of source code must retain the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer.
|
||||||
|
* 2. Redistributions in binary form must reproduce the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer in the
|
||||||
|
* documentation and/or other materials provided with the distribution.
|
||||||
|
* 3. The name of the author may not be used to endorse or promote products
|
||||||
|
* derived from this software without specific prior written permission.
|
||||||
|
*
|
||||||
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
|
||||||
|
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
|
||||||
|
* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
|
||||||
|
* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
|
||||||
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
|
||||||
|
* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
||||||
|
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
||||||
|
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
||||||
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
|
||||||
|
* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||||||
|
*
|
||||||
|
*/
|
||||||
|
|
||||||
|
#ifndef _MB_PORT_H
|
||||||
|
#define _MB_PORT_H
|
||||||
|
|
||||||
|
#ifdef __cplusplus
|
||||||
|
PR_BEGIN_EXTERN_C
|
||||||
|
#endif
|
||||||
|
|
||||||
|
/* ----------------------- Type definitions ---------------------------------*/
|
||||||
|
|
||||||
|
typedef enum
|
||||||
|
{
|
||||||
|
EV_READY, /*!< Startup finished. */
|
||||||
|
EV_FRAME_RECEIVED, /*!< Frame received. */
|
||||||
|
EV_EXECUTE, /*!< Execute function. */
|
||||||
|
EV_FRAME_SENT /*!< Frame sent. */
|
||||||
|
} eMBEventType;
|
||||||
|
|
||||||
|
/*! \ingroup modbus
|
||||||
|
* \brief Parity used for characters in serial mode.
|
||||||
|
*
|
||||||
|
* The parity which should be applied to the characters sent over the serial
|
||||||
|
* link. Please note that this values are actually passed to the porting
|
||||||
|
* layer and therefore not all parity modes might be available.
|
||||||
|
*/
|
||||||
|
typedef enum
|
||||||
|
{
|
||||||
|
MB_PAR_NONE, /*!< No parity. */
|
||||||
|
MB_PAR_ODD, /*!< Odd parity. */
|
||||||
|
MB_PAR_EVEN /*!< Even parity. */
|
||||||
|
} eMBParity;
|
||||||
|
|
||||||
|
/* ----------------------- Supporting functions -----------------------------*/
|
||||||
|
BOOL xMBPortEventInit( void );
|
||||||
|
|
||||||
|
BOOL xMBPortEventPost( eMBEventType eEvent );
|
||||||
|
|
||||||
|
BOOL xMBPortEventGet( /*@out@ */ eMBEventType * eEvent );
|
||||||
|
|
||||||
|
/* ----------------------- Serial port functions ----------------------------*/
|
||||||
|
|
||||||
|
BOOL xMBPortSerialInit( UCHAR ucPort, ULONG ulBaudRate,
|
||||||
|
UCHAR ucDataBits, eMBParity eParity );
|
||||||
|
|
||||||
|
void vMBPortClose( void );
|
||||||
|
|
||||||
|
void xMBPortSerialClose( void );
|
||||||
|
|
||||||
|
void vMBPortSerialEnable( BOOL xRxEnable, BOOL xTxEnable );
|
||||||
|
|
||||||
|
BOOL xMBPortSerialGetByte( CHAR * pucByte );
|
||||||
|
|
||||||
|
BOOL xMBPortSerialPutByte( CHAR ucByte );
|
||||||
|
|
||||||
|
/* ----------------------- Timers functions ---------------------------------*/
|
||||||
|
BOOL xMBPortTimersInit( USHORT usTimeOut50us );
|
||||||
|
|
||||||
|
void xMBPortTimersClose( void );
|
||||||
|
|
||||||
|
void vMBPortTimersEnable( void );
|
||||||
|
|
||||||
|
void vMBPortTimersDisable( void );
|
||||||
|
|
||||||
|
void vMBPortTimersDelay( USHORT usTimeOutMS );
|
||||||
|
|
||||||
|
/* ----------------------- Callback for the protocol stack ------------------*/
|
||||||
|
|
||||||
|
/*!
|
||||||
|
* \brief Callback function for the porting layer when a new byte is
|
||||||
|
* available.
|
||||||
|
*
|
||||||
|
* Depending upon the mode this callback function is used by the RTU or
|
||||||
|
* ASCII transmission layers. In any case a call to xMBPortSerialGetByte()
|
||||||
|
* must immediately return a new character.
|
||||||
|
*
|
||||||
|
* \return <code>TRUE</code> if a event was posted to the queue because
|
||||||
|
* a new byte was received. The port implementation should wake up the
|
||||||
|
* tasks which are currently blocked on the eventqueue.
|
||||||
|
*/
|
||||||
|
extern BOOL( *pxMBFrameCBByteReceived ) ( void );
|
||||||
|
|
||||||
|
extern BOOL( *pxMBFrameCBTransmitterEmpty ) ( void );
|
||||||
|
|
||||||
|
extern BOOL( *pxMBPortCBTimerExpired ) ( void );
|
||||||
|
|
||||||
|
/* ----------------------- TCP port functions -------------------------------*/
|
||||||
|
BOOL xMBTCPPortInit( USHORT usTCPPort );
|
||||||
|
|
||||||
|
void vMBTCPPortClose( void );
|
||||||
|
|
||||||
|
void vMBTCPPortDisable( void );
|
||||||
|
|
||||||
|
BOOL xMBTCPPortGetRequest( UCHAR **ppucMBTCPFrame, USHORT * usTCPLength );
|
||||||
|
|
||||||
|
BOOL xMBTCPPortSendResponse( const UCHAR *pucMBTCPFrame, USHORT usTCPLength );
|
||||||
|
|
||||||
|
#ifdef __cplusplus
|
||||||
|
PR_END_EXTERN_C
|
||||||
|
#endif
|
||||||
|
#endif
|
||||||
|
|
@ -0,0 +1,82 @@
|
||||||
|
/*
|
||||||
|
* FreeModbus Libary: A portable Modbus implementation for Modbus ASCII/RTU.
|
||||||
|
* Copyright (c) 2006-2018 Christian Walter <cwalter@embedded-solutions.at>
|
||||||
|
* All rights reserved.
|
||||||
|
*
|
||||||
|
* Redistribution and use in source and binary forms, with or without
|
||||||
|
* modification, are permitted provided that the following conditions
|
||||||
|
* are met:
|
||||||
|
* 1. Redistributions of source code must retain the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer.
|
||||||
|
* 2. Redistributions in binary form must reproduce the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer in the
|
||||||
|
* documentation and/or other materials provided with the distribution.
|
||||||
|
* 3. The name of the author may not be used to endorse or promote products
|
||||||
|
* derived from this software without specific prior written permission.
|
||||||
|
*
|
||||||
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
|
||||||
|
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
|
||||||
|
* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
|
||||||
|
* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
|
||||||
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
|
||||||
|
* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
||||||
|
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
||||||
|
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
||||||
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
|
||||||
|
* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||||||
|
*
|
||||||
|
*/
|
||||||
|
|
||||||
|
#ifndef _MB_PROTO_H
|
||||||
|
#define _MB_PROTO_H
|
||||||
|
|
||||||
|
#ifdef __cplusplus
|
||||||
|
PR_BEGIN_EXTERN_C
|
||||||
|
#endif
|
||||||
|
/* ----------------------- Defines ------------------------------------------*/
|
||||||
|
#define MB_ADDRESS_BROADCAST ( 0 ) /*! Modbus broadcast address. */
|
||||||
|
#define MB_ADDRESS_MIN ( 1 ) /*! Smallest possible slave address. */
|
||||||
|
#define MB_ADDRESS_MAX ( 247 ) /*! Biggest possible slave address. */
|
||||||
|
#define MB_FUNC_NONE ( 0 )
|
||||||
|
#define MB_FUNC_READ_COILS ( 1 )
|
||||||
|
#define MB_FUNC_READ_DISCRETE_INPUTS ( 2 )
|
||||||
|
#define MB_FUNC_WRITE_SINGLE_COIL ( 5 )
|
||||||
|
#define MB_FUNC_WRITE_MULTIPLE_COILS ( 15 )
|
||||||
|
#define MB_FUNC_READ_HOLDING_REGISTER ( 3 )
|
||||||
|
#define MB_FUNC_READ_INPUT_REGISTER ( 4 )
|
||||||
|
#define MB_FUNC_WRITE_REGISTER ( 6 )
|
||||||
|
#define MB_FUNC_WRITE_MULTIPLE_REGISTERS ( 16 )
|
||||||
|
#define MB_FUNC_READWRITE_MULTIPLE_REGISTERS ( 23 )
|
||||||
|
#define MB_FUNC_DIAG_READ_EXCEPTION ( 7 )
|
||||||
|
#define MB_FUNC_DIAG_DIAGNOSTIC ( 8 )
|
||||||
|
#define MB_FUNC_DIAG_GET_COM_EVENT_CNT ( 11 )
|
||||||
|
#define MB_FUNC_DIAG_GET_COM_EVENT_LOG ( 12 )
|
||||||
|
#define MB_FUNC_OTHER_REPORT_SLAVEID ( 17 )
|
||||||
|
#define MB_FUNC_ERROR ( 128 )
|
||||||
|
/* ----------------------- Type definitions ---------------------------------*/
|
||||||
|
typedef enum
|
||||||
|
{
|
||||||
|
MB_EX_NONE = 0x00,
|
||||||
|
MB_EX_ILLEGAL_FUNCTION = 0x01,
|
||||||
|
MB_EX_ILLEGAL_DATA_ADDRESS = 0x02,
|
||||||
|
MB_EX_ILLEGAL_DATA_VALUE = 0x03,
|
||||||
|
MB_EX_SLAVE_DEVICE_FAILURE = 0x04,
|
||||||
|
MB_EX_ACKNOWLEDGE = 0x05,
|
||||||
|
MB_EX_SLAVE_BUSY = 0x06,
|
||||||
|
MB_EX_MEMORY_PARITY_ERROR = 0x08,
|
||||||
|
MB_EX_GATEWAY_PATH_FAILED = 0x0A,
|
||||||
|
MB_EX_GATEWAY_TGT_FAILED = 0x0B
|
||||||
|
} eMBException;
|
||||||
|
|
||||||
|
typedef eMBException( *pxMBFunctionHandler ) ( UCHAR * pucFrame, USHORT * pusLength );
|
||||||
|
|
||||||
|
typedef struct
|
||||||
|
{
|
||||||
|
UCHAR ucFunctionCode;
|
||||||
|
pxMBFunctionHandler pxHandler;
|
||||||
|
} xMBFunctionHandler;
|
||||||
|
|
||||||
|
#ifdef __cplusplus
|
||||||
|
PR_END_EXTERN_C
|
||||||
|
#endif
|
||||||
|
#endif
|
||||||
|
|
@ -0,0 +1,157 @@
|
||||||
|
/*
|
||||||
|
* FreeModbus Libary: A portable Modbus implementation for Modbus ASCII/RTU.
|
||||||
|
* Copyright (c) 2006-2018 Christian Walter <cwalter@embedded-solutions.at>
|
||||||
|
* All rights reserved.
|
||||||
|
*
|
||||||
|
* Redistribution and use in source and binary forms, with or without
|
||||||
|
* modification, are permitted provided that the following conditions
|
||||||
|
* are met:
|
||||||
|
* 1. Redistributions of source code must retain the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer.
|
||||||
|
* 2. Redistributions in binary form must reproduce the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer in the
|
||||||
|
* documentation and/or other materials provided with the distribution.
|
||||||
|
* 3. The name of the author may not be used to endorse or promote products
|
||||||
|
* derived from this software without specific prior written permission.
|
||||||
|
*
|
||||||
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
|
||||||
|
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
|
||||||
|
* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
|
||||||
|
* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
|
||||||
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
|
||||||
|
* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
||||||
|
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
||||||
|
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
||||||
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
|
||||||
|
* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||||||
|
*
|
||||||
|
*/
|
||||||
|
|
||||||
|
/* ----------------------- System includes ----------------------------------*/
|
||||||
|
#include "stdlib.h"
|
||||||
|
#include "string.h"
|
||||||
|
|
||||||
|
/* ----------------------- Platform includes --------------------------------*/
|
||||||
|
#include "port.h"
|
||||||
|
|
||||||
|
/* ----------------------- Modbus includes ----------------------------------*/
|
||||||
|
#include "mb.h"
|
||||||
|
#include "mbconfig.h"
|
||||||
|
#include "mbtcp.h"
|
||||||
|
#include "mbframe.h"
|
||||||
|
#include "mbport.h"
|
||||||
|
|
||||||
|
#if MB_TCP_ENABLED > 0
|
||||||
|
|
||||||
|
/* ----------------------- Defines ------------------------------------------*/
|
||||||
|
|
||||||
|
/* ----------------------- MBAP Header --------------------------------------*/
|
||||||
|
/*
|
||||||
|
*
|
||||||
|
* <------------------------ MODBUS TCP/IP ADU(1) ------------------------->
|
||||||
|
* <----------- MODBUS PDU (1') ---------------->
|
||||||
|
* +-----------+---------------+------------------------------------------+
|
||||||
|
* | TID | PID | Length | UID |Code | Data |
|
||||||
|
* +-----------+---------------+------------------------------------------+
|
||||||
|
* | | | | |
|
||||||
|
* (2) (3) (4) (5) (6)
|
||||||
|
*
|
||||||
|
* (2) ... MB_TCP_TID = 0 (Transaction Identifier - 2 Byte)
|
||||||
|
* (3) ... MB_TCP_PID = 2 (Protocol Identifier - 2 Byte)
|
||||||
|
* (4) ... MB_TCP_LEN = 4 (Number of bytes - 2 Byte)
|
||||||
|
* (5) ... MB_TCP_UID = 6 (Unit Identifier - 1 Byte)
|
||||||
|
* (6) ... MB_TCP_FUNC = 7 (Modbus Function Code)
|
||||||
|
*
|
||||||
|
* (1) ... Modbus TCP/IP Application Data Unit
|
||||||
|
* (1') ... Modbus Protocol Data Unit
|
||||||
|
*/
|
||||||
|
|
||||||
|
#define MB_TCP_TID 0
|
||||||
|
#define MB_TCP_PID 2
|
||||||
|
#define MB_TCP_LEN 4
|
||||||
|
#define MB_TCP_UID 6
|
||||||
|
#define MB_TCP_FUNC 7
|
||||||
|
|
||||||
|
#define MB_TCP_PROTOCOL_ID 0 /* 0 = Modbus Protocol */
|
||||||
|
|
||||||
|
|
||||||
|
/* ----------------------- Start implementation -----------------------------*/
|
||||||
|
eMBErrorCode
|
||||||
|
eMBTCPDoInit( USHORT ucTCPPort )
|
||||||
|
{
|
||||||
|
eMBErrorCode eStatus = MB_ENOERR;
|
||||||
|
|
||||||
|
if( xMBTCPPortInit( ucTCPPort ) == FALSE )
|
||||||
|
{
|
||||||
|
eStatus = MB_EPORTERR;
|
||||||
|
}
|
||||||
|
return eStatus;
|
||||||
|
}
|
||||||
|
|
||||||
|
void
|
||||||
|
eMBTCPStart( void )
|
||||||
|
{
|
||||||
|
}
|
||||||
|
|
||||||
|
void
|
||||||
|
eMBTCPStop( void )
|
||||||
|
{
|
||||||
|
/* Make sure that no more clients are connected. */
|
||||||
|
vMBTCPPortDisable( );
|
||||||
|
}
|
||||||
|
|
||||||
|
eMBErrorCode
|
||||||
|
eMBTCPReceive( UCHAR * pucRcvAddress, UCHAR ** ppucFrame, USHORT * pusLength )
|
||||||
|
{
|
||||||
|
eMBErrorCode eStatus = MB_EIO;
|
||||||
|
UCHAR *pucMBTCPFrame;
|
||||||
|
USHORT usLength;
|
||||||
|
USHORT usPID;
|
||||||
|
|
||||||
|
if( xMBTCPPortGetRequest( &pucMBTCPFrame, &usLength ) != FALSE )
|
||||||
|
{
|
||||||
|
usPID = pucMBTCPFrame[MB_TCP_PID] << 8U;
|
||||||
|
usPID |= pucMBTCPFrame[MB_TCP_PID + 1];
|
||||||
|
|
||||||
|
if( usPID == MB_TCP_PROTOCOL_ID )
|
||||||
|
{
|
||||||
|
*ppucFrame = &pucMBTCPFrame[MB_TCP_FUNC];
|
||||||
|
*pusLength = usLength - MB_TCP_FUNC;
|
||||||
|
eStatus = MB_ENOERR;
|
||||||
|
|
||||||
|
/* Modbus TCP does not use any addresses. Fake the source address such
|
||||||
|
* that the processing part deals with this frame.
|
||||||
|
*/
|
||||||
|
*pucRcvAddress = MB_TCP_PSEUDO_ADDRESS;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
eStatus = MB_EIO;
|
||||||
|
}
|
||||||
|
return eStatus;
|
||||||
|
}
|
||||||
|
|
||||||
|
eMBErrorCode
|
||||||
|
eMBTCPSend( UCHAR _unused, const UCHAR * pucFrame, USHORT usLength )
|
||||||
|
{
|
||||||
|
eMBErrorCode eStatus = MB_ENOERR;
|
||||||
|
UCHAR *pucMBTCPFrame = ( UCHAR * ) pucFrame - MB_TCP_FUNC;
|
||||||
|
USHORT usTCPLength = usLength + MB_TCP_FUNC;
|
||||||
|
|
||||||
|
/* The MBAP header is already initialized because the caller calls this
|
||||||
|
* function with the buffer returned by the previous call. Therefore we
|
||||||
|
* only have to update the length in the header. Note that the length
|
||||||
|
* header includes the size of the Modbus PDU and the UID Byte. Therefore
|
||||||
|
* the length is usLength plus one.
|
||||||
|
*/
|
||||||
|
pucMBTCPFrame[MB_TCP_LEN] = ( usLength + 1 ) >> 8U;
|
||||||
|
pucMBTCPFrame[MB_TCP_LEN + 1] = ( usLength + 1 ) & 0xFF;
|
||||||
|
if( xMBTCPPortSendResponse( pucMBTCPFrame, usTCPLength ) == FALSE )
|
||||||
|
{
|
||||||
|
eStatus = MB_EIO;
|
||||||
|
}
|
||||||
|
return eStatus;
|
||||||
|
}
|
||||||
|
|
||||||
|
#endif
|
||||||
|
|
@ -0,0 +1,52 @@
|
||||||
|
/*
|
||||||
|
* FreeModbus Libary: A portable Modbus implementation for Modbus ASCII/RTU.
|
||||||
|
* Copyright (c) 2006-2018 Christian Walter <cwalter@embedded-solutions.at>
|
||||||
|
* All rights reserved.
|
||||||
|
*
|
||||||
|
* Redistribution and use in source and binary forms, with or without
|
||||||
|
* modification, are permitted provided that the following conditions
|
||||||
|
* are met:
|
||||||
|
* 1. Redistributions of source code must retain the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer.
|
||||||
|
* 2. Redistributions in binary form must reproduce the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer in the
|
||||||
|
* documentation and/or other materials provided with the distribution.
|
||||||
|
* 3. The name of the author may not be used to endorse or promote products
|
||||||
|
* derived from this software without specific prior written permission.
|
||||||
|
*
|
||||||
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
|
||||||
|
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
|
||||||
|
* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
|
||||||
|
* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
|
||||||
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
|
||||||
|
* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
||||||
|
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
||||||
|
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
||||||
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
|
||||||
|
* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||||||
|
*
|
||||||
|
*/
|
||||||
|
|
||||||
|
#ifndef _MB_TCP_H
|
||||||
|
#define _MB_TCP_H
|
||||||
|
|
||||||
|
#ifdef __cplusplus
|
||||||
|
PR_BEGIN_EXTERN_C
|
||||||
|
#endif
|
||||||
|
|
||||||
|
/* ----------------------- Defines ------------------------------------------*/
|
||||||
|
#define MB_TCP_PSEUDO_ADDRESS 255
|
||||||
|
|
||||||
|
/* ----------------------- Function prototypes ------------------------------*/
|
||||||
|
eMBErrorCode eMBTCPDoInit( USHORT ucTCPPort );
|
||||||
|
void eMBTCPStart( void );
|
||||||
|
void eMBTCPStop( void );
|
||||||
|
eMBErrorCode eMBTCPReceive( UCHAR * pucRcvAddress, UCHAR ** pucFrame,
|
||||||
|
USHORT * pusLength );
|
||||||
|
eMBErrorCode eMBTCPSend( UCHAR _unused, const UCHAR * pucFrame,
|
||||||
|
USHORT usLength );
|
||||||
|
|
||||||
|
#ifdef __cplusplus
|
||||||
|
PR_END_EXTERN_C
|
||||||
|
#endif
|
||||||
|
#endif
|
||||||
|
|
@ -0,0 +1,140 @@
|
||||||
|
/*
|
||||||
|
* FreeModbus Libary: A portable Modbus implementation for Modbus ASCII/RTU.
|
||||||
|
* Copyright (c) 2006-2018 Christian Walter <cwalter@embedded-solutions.at>
|
||||||
|
* All rights reserved.
|
||||||
|
*
|
||||||
|
* Redistribution and use in source and binary forms, with or without
|
||||||
|
* modification, are permitted provided that the following conditions
|
||||||
|
* are met:
|
||||||
|
* 1. Redistributions of source code must retain the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer.
|
||||||
|
* 2. Redistributions in binary form must reproduce the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer in the
|
||||||
|
* documentation and/or other materials provided with the distribution.
|
||||||
|
* 3. The name of the author may not be used to endorse or promote products
|
||||||
|
* derived from this software without specific prior written permission.
|
||||||
|
*
|
||||||
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
|
||||||
|
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
|
||||||
|
* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
|
||||||
|
* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
|
||||||
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
|
||||||
|
* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
||||||
|
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
||||||
|
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
||||||
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
|
||||||
|
* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||||||
|
*
|
||||||
|
*/
|
||||||
|
|
||||||
|
/* ----------------------- System includes ----------------------------------*/
|
||||||
|
#include "stdlib.h"
|
||||||
|
#include "string.h"
|
||||||
|
|
||||||
|
/* ----------------------- Platform includes --------------------------------*/
|
||||||
|
#include "port.h"
|
||||||
|
|
||||||
|
/* ----------------------- Modbus includes ----------------------------------*/
|
||||||
|
#include "mb.h"
|
||||||
|
#include "mbproto.h"
|
||||||
|
|
||||||
|
/* ----------------------- Defines ------------------------------------------*/
|
||||||
|
#define BITS_UCHAR 8U
|
||||||
|
|
||||||
|
/* ----------------------- Start implementation -----------------------------*/
|
||||||
|
void
|
||||||
|
xMBUtilSetBits( UCHAR * ucByteBuf, USHORT usBitOffset, UCHAR ucNBits,
|
||||||
|
UCHAR ucValue )
|
||||||
|
{
|
||||||
|
USHORT usWordBuf;
|
||||||
|
USHORT usMask;
|
||||||
|
USHORT usByteOffset;
|
||||||
|
USHORT usNPreBits;
|
||||||
|
USHORT usValue = ucValue;
|
||||||
|
|
||||||
|
assert( ucNBits <= 8 );
|
||||||
|
assert( ( size_t )BITS_UCHAR == sizeof( UCHAR ) * 8 );
|
||||||
|
|
||||||
|
/* Calculate byte offset for first byte containing the bit values starting
|
||||||
|
* at usBitOffset. */
|
||||||
|
usByteOffset = ( USHORT )( ( usBitOffset ) / BITS_UCHAR );
|
||||||
|
|
||||||
|
/* How many bits precede our bits to set. */
|
||||||
|
usNPreBits = ( USHORT )( usBitOffset - usByteOffset * BITS_UCHAR );
|
||||||
|
|
||||||
|
/* Move bit field into position over bits to set */
|
||||||
|
usValue <<= usNPreBits;
|
||||||
|
|
||||||
|
/* Prepare a mask for setting the new bits. */
|
||||||
|
usMask = ( USHORT )( ( 1 << ( USHORT ) ucNBits ) - 1 );
|
||||||
|
usMask <<= usBitOffset - usByteOffset * BITS_UCHAR;
|
||||||
|
|
||||||
|
/* copy bits into temporary storage. */
|
||||||
|
usWordBuf = ucByteBuf[usByteOffset];
|
||||||
|
usWordBuf |= ucByteBuf[usByteOffset + 1] << BITS_UCHAR;
|
||||||
|
|
||||||
|
/* Zero out bit field bits and then or value bits into them. */
|
||||||
|
usWordBuf = ( USHORT )( ( usWordBuf & ( ~usMask ) ) | usValue );
|
||||||
|
|
||||||
|
/* move bits back into storage */
|
||||||
|
ucByteBuf[usByteOffset] = ( UCHAR )( usWordBuf & 0xFF );
|
||||||
|
ucByteBuf[usByteOffset + 1] = ( UCHAR )( usWordBuf >> BITS_UCHAR );
|
||||||
|
}
|
||||||
|
|
||||||
|
UCHAR
|
||||||
|
xMBUtilGetBits( UCHAR * ucByteBuf, USHORT usBitOffset, UCHAR ucNBits )
|
||||||
|
{
|
||||||
|
USHORT usWordBuf;
|
||||||
|
USHORT usMask;
|
||||||
|
USHORT usByteOffset;
|
||||||
|
USHORT usNPreBits;
|
||||||
|
|
||||||
|
/* Calculate byte offset for first byte containing the bit values starting
|
||||||
|
* at usBitOffset. */
|
||||||
|
usByteOffset = ( USHORT )( ( usBitOffset ) / BITS_UCHAR );
|
||||||
|
|
||||||
|
/* How many bits precede our bits to set. */
|
||||||
|
usNPreBits = ( USHORT )( usBitOffset - usByteOffset * BITS_UCHAR );
|
||||||
|
|
||||||
|
/* Prepare a mask for setting the new bits. */
|
||||||
|
usMask = ( USHORT )( ( 1 << ( USHORT ) ucNBits ) - 1 );
|
||||||
|
|
||||||
|
/* copy bits into temporary storage. */
|
||||||
|
usWordBuf = ucByteBuf[usByteOffset];
|
||||||
|
usWordBuf |= ucByteBuf[usByteOffset + 1] << BITS_UCHAR;
|
||||||
|
|
||||||
|
/* throw away unneeded bits. */
|
||||||
|
usWordBuf >>= usNPreBits;
|
||||||
|
|
||||||
|
/* mask away bits above the requested bitfield. */
|
||||||
|
usWordBuf &= usMask;
|
||||||
|
|
||||||
|
return ( UCHAR ) usWordBuf;
|
||||||
|
}
|
||||||
|
|
||||||
|
eMBException
|
||||||
|
prveMBError2Exception( eMBErrorCode eErrorCode )
|
||||||
|
{
|
||||||
|
eMBException eStatus;
|
||||||
|
|
||||||
|
switch ( eErrorCode )
|
||||||
|
{
|
||||||
|
case MB_ENOERR:
|
||||||
|
eStatus = MB_EX_NONE;
|
||||||
|
break;
|
||||||
|
|
||||||
|
case MB_ENOREG:
|
||||||
|
eStatus = MB_EX_ILLEGAL_DATA_ADDRESS;
|
||||||
|
break;
|
||||||
|
|
||||||
|
case MB_ETIMEDOUT:
|
||||||
|
eStatus = MB_EX_SLAVE_BUSY;
|
||||||
|
break;
|
||||||
|
|
||||||
|
default:
|
||||||
|
eStatus = MB_EX_SLAVE_DEVICE_FAILURE;
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
|
||||||
|
return eStatus;
|
||||||
|
}
|
||||||
|
|
@ -0,0 +1,107 @@
|
||||||
|
/*
|
||||||
|
* FreeModbus Libary: A portable Modbus implementation for Modbus ASCII/RTU.
|
||||||
|
* Copyright (c) 2006-2018 Christian Walter <cwalter@embedded-solutions.at>
|
||||||
|
* All rights reserved.
|
||||||
|
*
|
||||||
|
* Redistribution and use in source and binary forms, with or without
|
||||||
|
* modification, are permitted provided that the following conditions
|
||||||
|
* are met:
|
||||||
|
* 1. Redistributions of source code must retain the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer.
|
||||||
|
* 2. Redistributions in binary form must reproduce the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer in the
|
||||||
|
* documentation and/or other materials provided with the distribution.
|
||||||
|
* 3. The name of the author may not be used to endorse or promote products
|
||||||
|
* derived from this software without specific prior written permission.
|
||||||
|
*
|
||||||
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
|
||||||
|
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
|
||||||
|
* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
|
||||||
|
* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
|
||||||
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
|
||||||
|
* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
||||||
|
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
||||||
|
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
||||||
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
|
||||||
|
* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||||||
|
*
|
||||||
|
*/
|
||||||
|
|
||||||
|
#ifndef _MB_UTILS_H
|
||||||
|
#define _MB_UTILS_H
|
||||||
|
|
||||||
|
#ifdef __cplusplus
|
||||||
|
PR_BEGIN_EXTERN_C
|
||||||
|
#endif
|
||||||
|
/*! \defgroup modbus_utils Utilities
|
||||||
|
*
|
||||||
|
* This module contains some utility functions which can be used by
|
||||||
|
* the application. It includes some special functions for working with
|
||||||
|
* bitfields backed by a character array buffer.
|
||||||
|
*
|
||||||
|
*/
|
||||||
|
/*! \addtogroup modbus_utils
|
||||||
|
* @{
|
||||||
|
*/
|
||||||
|
/*! \brief Function to set bits in a byte buffer.
|
||||||
|
*
|
||||||
|
* This function allows the efficient use of an array to implement bitfields.
|
||||||
|
* The array used for storing the bits must always be a multiple of two
|
||||||
|
* bytes. Up to eight bits can be set or cleared in one operation.
|
||||||
|
*
|
||||||
|
* \param ucByteBuf A buffer where the bit values are stored. Must be a
|
||||||
|
* multiple of 2 bytes. No length checking is performed and if
|
||||||
|
* usBitOffset / 8 is greater than the size of the buffer memory contents
|
||||||
|
* is overwritten.
|
||||||
|
* \param usBitOffset The starting address of the bits to set. The first
|
||||||
|
* bit has the offset 0.
|
||||||
|
* \param ucNBits Number of bits to modify. The value must always be smaller
|
||||||
|
* than 8.
|
||||||
|
* \param ucValues Thew new values for the bits. The value for the first bit
|
||||||
|
* starting at <code>usBitOffset</code> is the LSB of the value
|
||||||
|
* <code>ucValues</code>
|
||||||
|
*
|
||||||
|
* \code
|
||||||
|
* ucBits[2] = {0, 0};
|
||||||
|
*
|
||||||
|
* // Set bit 4 to 1 (read: set 1 bit starting at bit offset 4 to value 1)
|
||||||
|
* xMBUtilSetBits( ucBits, 4, 1, 1 );
|
||||||
|
*
|
||||||
|
* // Set bit 7 to 1 and bit 8 to 0.
|
||||||
|
* xMBUtilSetBits( ucBits, 7, 2, 0x01 );
|
||||||
|
*
|
||||||
|
* // Set bits 8 - 11 to 0x05 and bits 12 - 15 to 0x0A;
|
||||||
|
* xMBUtilSetBits( ucBits, 8, 8, 0x5A);
|
||||||
|
* \endcode
|
||||||
|
*/
|
||||||
|
void xMBUtilSetBits( UCHAR * ucByteBuf, USHORT usBitOffset,
|
||||||
|
UCHAR ucNBits, UCHAR ucValues );
|
||||||
|
|
||||||
|
/*! \brief Function to read bits in a byte buffer.
|
||||||
|
*
|
||||||
|
* This function is used to extract up bit values from an array. Up to eight
|
||||||
|
* bit values can be extracted in one step.
|
||||||
|
*
|
||||||
|
* \param ucByteBuf A buffer where the bit values are stored.
|
||||||
|
* \param usBitOffset The starting address of the bits to set. The first
|
||||||
|
* bit has the offset 0.
|
||||||
|
* \param ucNBits Number of bits to modify. The value must always be smaller
|
||||||
|
* than 8.
|
||||||
|
*
|
||||||
|
* \code
|
||||||
|
* UCHAR ucBits[2] = {0, 0};
|
||||||
|
* UCHAR ucResult;
|
||||||
|
*
|
||||||
|
* // Extract the bits 3 - 10.
|
||||||
|
* ucResult = xMBUtilGetBits( ucBits, 3, 8 );
|
||||||
|
* \endcode
|
||||||
|
*/
|
||||||
|
UCHAR xMBUtilGetBits( UCHAR * ucByteBuf, USHORT usBitOffset,
|
||||||
|
UCHAR ucNBits );
|
||||||
|
|
||||||
|
/*! @} */
|
||||||
|
|
||||||
|
#ifdef __cplusplus
|
||||||
|
PR_END_EXTERN_C
|
||||||
|
#endif
|
||||||
|
#endif
|
||||||
Loading…
Reference in New Issue