ModbusTCP_light - ModbusTCP Light This version utilize lwIP librar…

Users » paleskyjp » Code » ModbusTCP_light

Yuji Hosogaya / Mbed 2 deprecated ModbusTCP_light

ModbusTCP Light This version utilize lwIP library with the minimal implementation of Modbus TCP. Error processing hasn\\\'t been implemented yet.

Dependencies: mbed lwip

main.cpp@1:59cee932f289, 2012-03-16 (annotated)

Committer:: paleskyjp
Date:: Fri Mar 16 08:38:12 2012 +0000
Revision:: 1:59cee932f289
Parent:: 0:8ee5ec4bcec2

Who changed what in which revision?

User	Revision	Line number	New contents of line
paleskyjp	0:8ee5ec4bcec2	1	/*
paleskyjp	0:8ee5ec4bcec2	2	* FreeModbus Libary: BARE Demo Application
paleskyjp	0:8ee5ec4bcec2	3	* Copyright (C) 2006 Christian Walter <wolti@sil.at>
paleskyjp	0:8ee5ec4bcec2	4	*
paleskyjp	0:8ee5ec4bcec2	5	* This program is free software; you can redistribute it and/or modify
paleskyjp	0:8ee5ec4bcec2	6	* it under the terms of the GNU General Public License as published by
paleskyjp	0:8ee5ec4bcec2	7	* the Free Software Foundation; either version 2 of the License, or
paleskyjp	0:8ee5ec4bcec2	8	* (at your option) any later version.
paleskyjp	0:8ee5ec4bcec2	9	*
paleskyjp	0:8ee5ec4bcec2	10	* This program is distributed in the hope that it will be useful,
paleskyjp	0:8ee5ec4bcec2	11	* but WITHOUT ANY WARRANTY; without even the implied warranty of
paleskyjp	0:8ee5ec4bcec2	12	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
paleskyjp	0:8ee5ec4bcec2	13	* GNU General Public License for more details.
paleskyjp	0:8ee5ec4bcec2	14	*
paleskyjp	0:8ee5ec4bcec2	15	* You should have received a copy of the GNU General Public License
paleskyjp	0:8ee5ec4bcec2	16	* along with this program; if not, write to the Free Software
paleskyjp	0:8ee5ec4bcec2	17	* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
paleskyjp	0:8ee5ec4bcec2	18	*
paleskyjp	0:8ee5ec4bcec2	19	* File: $Id: demo.c,v 1.1 2006/08/22 21:35:13 wolti Exp $
paleskyjp	0:8ee5ec4bcec2	20
paleskyjp	0:8ee5ec4bcec2	21	* modified from: Thanassis Mavrogeorgiadis 5-12-2011
paleskyjp	0:8ee5ec4bcec2	22	* modified by Yuji Hosogaya 3-16-2012
paleskyjp	0:8ee5ec4bcec2	23	*/
paleskyjp	0:8ee5ec4bcec2	24	#include "mbtcp.h"
paleskyjp	0:8ee5ec4bcec2	25
paleskyjp	0:8ee5ec4bcec2	26	Serial pc(USBTX, USBRX);
paleskyjp	0:8ee5ec4bcec2	27
paleskyjp	0:8ee5ec4bcec2	28	/* ----------------------- Defines ------------------------------------------*/
paleskyjp	0:8ee5ec4bcec2	29	#define REG_INPUT_START 1001
paleskyjp	0:8ee5ec4bcec2	30	#define REG_INPUT_NREGS 4
paleskyjp	0:8ee5ec4bcec2	31
paleskyjp	0:8ee5ec4bcec2	32	#define REG_HOLDING_START 2001
paleskyjp	0:8ee5ec4bcec2	33	#define REG_HOLDING_NREGS 130
paleskyjp	0:8ee5ec4bcec2	34
paleskyjp	0:8ee5ec4bcec2	35	#define REG_COIL_START (3000+1)
paleskyjp	0:8ee5ec4bcec2	36	#define REG_COIL_NREGS 8
paleskyjp	0:8ee5ec4bcec2	37	#define REG_COIL_BYTES REG_COIL_NREGS/8
paleskyjp	0:8ee5ec4bcec2	38
paleskyjp	0:8ee5ec4bcec2	39	#define REG_DISC_START (4000+1)
paleskyjp	0:8ee5ec4bcec2	40	#define REG_DISC_NREGS 8
paleskyjp	0:8ee5ec4bcec2	41	#define REG_DISC_BYTES REG_DISC_NREGS/8
paleskyjp	0:8ee5ec4bcec2	42
paleskyjp	0:8ee5ec4bcec2	43	#define SLAVE_ID 0x0A
paleskyjp	0:8ee5ec4bcec2	44
paleskyjp	0:8ee5ec4bcec2	45	/* ----------------------- Static variables ---------------------------------*/
paleskyjp	0:8ee5ec4bcec2	46	static USHORT usRegInputStart = REG_INPUT_START;
paleskyjp	0:8ee5ec4bcec2	47	static USHORT usRegInputBuf[REG_INPUT_NREGS]={0x0123,0x4567,0x89AB,0xCDEF};
paleskyjp	0:8ee5ec4bcec2	48	static USHORT usRegHoldingStart = REG_HOLDING_START;
paleskyjp	0:8ee5ec4bcec2	49	static USHORT usRegHoldingBuf[REG_HOLDING_NREGS]={0x0123,0x4567,0x89AB,0xCDEF,0xDEAD,0xBEEF,0xDEAD,0xBEEF,0xDEAD,0xBEEF};
paleskyjp	0:8ee5ec4bcec2	50	static USHORT usRegCoilStart = REG_COIL_START;
paleskyjp	0:8ee5ec4bcec2	51	static UCHAR usRegCoilBuf[REG_COIL_BYTES]={0xA5};
paleskyjp	0:8ee5ec4bcec2	52	static USHORT usRegDiscStart = REG_DISC_START;
paleskyjp	0:8ee5ec4bcec2	53	static UCHAR usRegDiscBuf[REG_DISC_BYTES]={0x5A};
paleskyjp	0:8ee5ec4bcec2	54
paleskyjp	0:8ee5ec4bcec2	55	/* ----------------------- Start implementation -----------------------------*/
paleskyjp	0:8ee5ec4bcec2	56
paleskyjp	0:8ee5ec4bcec2	57	int main() {
paleskyjp	0:8ee5ec4bcec2	58	pc.baud(115200);
paleskyjp	0:8ee5ec4bcec2	59	mb_init();
paleskyjp	0:8ee5ec4bcec2	60
paleskyjp	0:8ee5ec4bcec2	61	while(1) {
paleskyjp	0:8ee5ec4bcec2	62	device_poll();
paleskyjp	0:8ee5ec4bcec2	63	}
paleskyjp	0:8ee5ec4bcec2	64	}
paleskyjp	0:8ee5ec4bcec2	65
paleskyjp	0:8ee5ec4bcec2	66	eMBErrorCode
paleskyjp	0:8ee5ec4bcec2	67	eMBRegInputCB( UCHAR * pucRegBuffer, USHORT usAddress, USHORT usNRegs )
paleskyjp	0:8ee5ec4bcec2	68	{
paleskyjp	0:8ee5ec4bcec2	69	eMBErrorCode eStatus = MB_ENOERR;
paleskyjp	0:8ee5ec4bcec2	70	int iRegIndex;
paleskyjp	0:8ee5ec4bcec2	71
paleskyjp	0:8ee5ec4bcec2	72	if( ( usAddress >= REG_INPUT_START )
paleskyjp	0:8ee5ec4bcec2	73	&& ( usAddress + usNRegs <= REG_INPUT_START + REG_INPUT_NREGS ) )
paleskyjp	0:8ee5ec4bcec2	74	{
paleskyjp	0:8ee5ec4bcec2	75	iRegIndex = ( int )( usAddress - usRegInputStart );
paleskyjp	0:8ee5ec4bcec2	76	while( usNRegs > 0 )
paleskyjp	0:8ee5ec4bcec2	77	{
paleskyjp	0:8ee5ec4bcec2	78	*pucRegBuffer++ = ( unsigned char )( usRegInputBuf[iRegIndex] >> 8 );
paleskyjp	0:8ee5ec4bcec2	79	*pucRegBuffer++ = ( unsigned char )( usRegInputBuf[iRegIndex] & 0xFF );
paleskyjp	0:8ee5ec4bcec2	80	iRegIndex++;
paleskyjp	0:8ee5ec4bcec2	81	usNRegs--;
paleskyjp	0:8ee5ec4bcec2	82	}
paleskyjp	0:8ee5ec4bcec2	83	}
paleskyjp	0:8ee5ec4bcec2	84	else
paleskyjp	0:8ee5ec4bcec2	85	{
paleskyjp	0:8ee5ec4bcec2	86	eStatus = MB_ENOREG;
paleskyjp	0:8ee5ec4bcec2	87	}
paleskyjp	0:8ee5ec4bcec2	88	return eStatus;
paleskyjp	0:8ee5ec4bcec2	89	}
paleskyjp	0:8ee5ec4bcec2	90
paleskyjp	0:8ee5ec4bcec2	91	eMBErrorCode
paleskyjp	0:8ee5ec4bcec2	92	eMBRegHoldingCB( UCHAR * pucRegBuffer, USHORT usAddress, USHORT usNRegs, eMBRegisterMode eMode )
paleskyjp	0:8ee5ec4bcec2	93	{
paleskyjp	0:8ee5ec4bcec2	94	eMBErrorCode eStatus = MB_ENOERR;
paleskyjp	0:8ee5ec4bcec2	95	int iRegIndex;
paleskyjp	0:8ee5ec4bcec2	96
paleskyjp	0:8ee5ec4bcec2	97	if( ( usAddress >= REG_HOLDING_START ) &&
paleskyjp	0:8ee5ec4bcec2	98	( usAddress + usNRegs <= REG_HOLDING_START + REG_HOLDING_NREGS ) )
paleskyjp	0:8ee5ec4bcec2	99	{
paleskyjp	0:8ee5ec4bcec2	100	iRegIndex = ( int )( usAddress - usRegHoldingStart );
paleskyjp	0:8ee5ec4bcec2	101	switch ( eMode )
paleskyjp	0:8ee5ec4bcec2	102	{
paleskyjp	0:8ee5ec4bcec2	103	/* Pass current register values to the protocol stack. */
paleskyjp	0:8ee5ec4bcec2	104	case MB_REG_READ:
paleskyjp	0:8ee5ec4bcec2	105	while( usNRegs > 0 )
paleskyjp	0:8ee5ec4bcec2	106	{
paleskyjp	0:8ee5ec4bcec2	107	*pucRegBuffer++ = ( UCHAR ) ( usRegHoldingBuf[iRegIndex] >> 8 );
paleskyjp	0:8ee5ec4bcec2	108	*pucRegBuffer++ = ( UCHAR ) ( usRegHoldingBuf[iRegIndex] & 0xFF );
paleskyjp	0:8ee5ec4bcec2	109	iRegIndex++;
paleskyjp	0:8ee5ec4bcec2	110	usNRegs--;
paleskyjp	0:8ee5ec4bcec2	111	}
paleskyjp	0:8ee5ec4bcec2	112	break;
paleskyjp	0:8ee5ec4bcec2	113
paleskyjp	0:8ee5ec4bcec2	114	/* Update current register values with new values from the
paleskyjp	0:8ee5ec4bcec2	115	* protocol stack. */
paleskyjp	0:8ee5ec4bcec2	116	case MB_REG_WRITE:
paleskyjp	0:8ee5ec4bcec2	117	while( usNRegs > 0 )
paleskyjp	0:8ee5ec4bcec2	118	{
paleskyjp	0:8ee5ec4bcec2	119	usRegHoldingBuf[iRegIndex] = *pucRegBuffer++ << 8;
paleskyjp	0:8ee5ec4bcec2	120	usRegHoldingBuf[iRegIndex] \|= *pucRegBuffer++;
paleskyjp	0:8ee5ec4bcec2	121	iRegIndex++;
paleskyjp	0:8ee5ec4bcec2	122	usNRegs--;
paleskyjp	0:8ee5ec4bcec2	123	}
paleskyjp	0:8ee5ec4bcec2	124	}
paleskyjp	0:8ee5ec4bcec2	125	}
paleskyjp	0:8ee5ec4bcec2	126	else
paleskyjp	0:8ee5ec4bcec2	127	{
paleskyjp	0:8ee5ec4bcec2	128	eStatus = MB_ENOREG;
paleskyjp	0:8ee5ec4bcec2	129	}
paleskyjp	0:8ee5ec4bcec2	130	return eStatus;
paleskyjp	0:8ee5ec4bcec2	131	}
paleskyjp	0:8ee5ec4bcec2	132
paleskyjp	0:8ee5ec4bcec2	133	/*
paleskyjp	0:8ee5ec4bcec2	134	* Following implementation is not actually checked.
paleskyjp	0:8ee5ec4bcec2	135	*/
paleskyjp	0:8ee5ec4bcec2	136
paleskyjp	0:8ee5ec4bcec2	137	eMBErrorCode
paleskyjp	0:8ee5ec4bcec2	138	eMBRegCoilsCB( UCHAR * pucRegBuffer, USHORT usAddress, USHORT usNCoils, eMBRegisterMode eMode )
paleskyjp	0:8ee5ec4bcec2	139	{
paleskyjp	0:8ee5ec4bcec2	140	eMBErrorCode eStatus = MB_ENOERR;
paleskyjp	0:8ee5ec4bcec2	141	int iIntRegIndex;
paleskyjp	0:8ee5ec4bcec2	142	int iIntBufNum;
paleskyjp	0:8ee5ec4bcec2	143	int iIntBitNum;
paleskyjp	0:8ee5ec4bcec2	144	int iExtRegIndex=0;
paleskyjp	0:8ee5ec4bcec2	145	int iExtBufNum;
paleskyjp	0:8ee5ec4bcec2	146	int iExtBitNum;
paleskyjp	0:8ee5ec4bcec2	147	UCHAR ucTemp;
paleskyjp	0:8ee5ec4bcec2	148	if( ( usAddress >= REG_COIL_START )
paleskyjp	0:8ee5ec4bcec2	149	&& ( usAddress + usNCoils <= REG_COIL_START + REG_COIL_NREGS ) )
paleskyjp	0:8ee5ec4bcec2	150	{
paleskyjp	0:8ee5ec4bcec2	151	iIntRegIndex = ( int )( usAddress - usRegCoilStart );
paleskyjp	0:8ee5ec4bcec2	152
paleskyjp	0:8ee5ec4bcec2	153	while( usNCoils > 0 )
paleskyjp	0:8ee5ec4bcec2	154	{
paleskyjp	0:8ee5ec4bcec2	155	iIntBufNum=iIntRegIndex/8;
paleskyjp	0:8ee5ec4bcec2	156	iIntBitNum=iIntRegIndex%8;
paleskyjp	0:8ee5ec4bcec2	157	iExtBufNum=iExtRegIndex/8;
paleskyjp	0:8ee5ec4bcec2	158	iExtBitNum=iExtRegIndex%8;
paleskyjp	0:8ee5ec4bcec2	159
paleskyjp	0:8ee5ec4bcec2	160	switch ( eMode )
paleskyjp	0:8ee5ec4bcec2	161	{
paleskyjp	0:8ee5ec4bcec2	162	case MB_REG_READ:
paleskyjp	0:8ee5ec4bcec2	163	// Read coils
paleskyjp	0:8ee5ec4bcec2	164	if(iExtBitNum==0){
paleskyjp	0:8ee5ec4bcec2	165	pucRegBuffer[iExtBufNum]=0;
paleskyjp	0:8ee5ec4bcec2	166	}
paleskyjp	0:8ee5ec4bcec2	167	ucTemp=(usRegCoilBuf[iIntBufNum]>>iIntBitNum) & 1;
paleskyjp	0:8ee5ec4bcec2	168	pucRegBuffer[iExtBufNum]\|=ucTemp<<iExtBitNum;
paleskyjp	0:8ee5ec4bcec2	169	break;
paleskyjp	0:8ee5ec4bcec2	170
paleskyjp	0:8ee5ec4bcec2	171	case MB_REG_WRITE:
paleskyjp	0:8ee5ec4bcec2	172	// Write coils
paleskyjp	0:8ee5ec4bcec2	173	ucTemp=usRegCoilBuf[iIntBufNum]&(~(1<<iIntBitNum));
paleskyjp	0:8ee5ec4bcec2	174	ucTemp\|=((pucRegBuffer[iExtBufNum]>>iExtBitNum) & 1)<<iIntBitNum;
paleskyjp	0:8ee5ec4bcec2	175	usRegCoilBuf[iIntBufNum]=ucTemp;
paleskyjp	0:8ee5ec4bcec2	176	break;
paleskyjp	0:8ee5ec4bcec2	177	}
paleskyjp	0:8ee5ec4bcec2	178	iIntRegIndex++;
paleskyjp	0:8ee5ec4bcec2	179	iExtRegIndex++;
paleskyjp	0:8ee5ec4bcec2	180	usNCoils--;
paleskyjp	0:8ee5ec4bcec2	181
paleskyjp	0:8ee5ec4bcec2	182	}
paleskyjp	0:8ee5ec4bcec2	183	}
paleskyjp	0:8ee5ec4bcec2	184	else
paleskyjp	0:8ee5ec4bcec2	185	{
paleskyjp	0:8ee5ec4bcec2	186	eStatus = MB_ENOREG;
paleskyjp	0:8ee5ec4bcec2	187	}
paleskyjp	0:8ee5ec4bcec2	188
paleskyjp	0:8ee5ec4bcec2	189	return eStatus;
paleskyjp	0:8ee5ec4bcec2	190	}
paleskyjp	0:8ee5ec4bcec2	191
paleskyjp	0:8ee5ec4bcec2	192	eMBErrorCode
paleskyjp	0:8ee5ec4bcec2	193	eMBRegDiscreteCB( UCHAR * pucRegBuffer, USHORT usAddress, USHORT usNDiscrete )
paleskyjp	0:8ee5ec4bcec2	194	{
paleskyjp	0:8ee5ec4bcec2	195	eMBErrorCode eStatus = MB_ENOERR;
paleskyjp	0:8ee5ec4bcec2	196	int iIntRegIndex;
paleskyjp	0:8ee5ec4bcec2	197	int iIntBufNum;
paleskyjp	0:8ee5ec4bcec2	198	int iIntBitNum;
paleskyjp	0:8ee5ec4bcec2	199	int iExtRegIndex=0;
paleskyjp	0:8ee5ec4bcec2	200	int iExtBufNum;
paleskyjp	0:8ee5ec4bcec2	201	int iExtBitNum;
paleskyjp	0:8ee5ec4bcec2	202	UCHAR ucTemp;
paleskyjp	0:8ee5ec4bcec2	203	if( ( usAddress >= REG_DISC_START )
paleskyjp	0:8ee5ec4bcec2	204	&& ( usAddress + usNDiscrete <= REG_DISC_START + REG_DISC_NREGS ) )
paleskyjp	0:8ee5ec4bcec2	205	{
paleskyjp	0:8ee5ec4bcec2	206	iIntRegIndex = ( int )( usAddress - usRegDiscStart );
paleskyjp	0:8ee5ec4bcec2	207
paleskyjp	0:8ee5ec4bcec2	208	while( usNDiscrete > 0 )
paleskyjp	0:8ee5ec4bcec2	209	{
paleskyjp	0:8ee5ec4bcec2	210	iIntBufNum=iIntRegIndex/8;
paleskyjp	0:8ee5ec4bcec2	211	iIntBitNum=iIntRegIndex%8;
paleskyjp	0:8ee5ec4bcec2	212	iExtBufNum=iExtRegIndex/8;
paleskyjp	0:8ee5ec4bcec2	213	iExtBitNum=iExtRegIndex%8;
paleskyjp	0:8ee5ec4bcec2	214
paleskyjp	0:8ee5ec4bcec2	215	// Read discrete inputs
paleskyjp	0:8ee5ec4bcec2	216	if(iExtBitNum==0){
paleskyjp	0:8ee5ec4bcec2	217	pucRegBuffer[iExtBufNum]=0;
paleskyjp	0:8ee5ec4bcec2	218	}
paleskyjp	0:8ee5ec4bcec2	219	ucTemp=(usRegDiscBuf[iIntBufNum]>>iIntBitNum) & 1;
paleskyjp	0:8ee5ec4bcec2	220	pucRegBuffer[iExtBufNum]\|=ucTemp<<iExtBitNum;
paleskyjp	0:8ee5ec4bcec2	221
paleskyjp	0:8ee5ec4bcec2	222	iIntRegIndex++;
paleskyjp	0:8ee5ec4bcec2	223	iExtRegIndex++;
paleskyjp	0:8ee5ec4bcec2	224	usNDiscrete--;
paleskyjp	0:8ee5ec4bcec2	225
paleskyjp	0:8ee5ec4bcec2	226	}
paleskyjp	0:8ee5ec4bcec2	227	}
paleskyjp	0:8ee5ec4bcec2	228	else
paleskyjp	0:8ee5ec4bcec2	229	{
paleskyjp	0:8ee5ec4bcec2	230	eStatus = MB_ENOREG;
paleskyjp	0:8ee5ec4bcec2	231	}
paleskyjp	0:8ee5ec4bcec2	232
paleskyjp	0:8ee5ec4bcec2	233	return eStatus;
paleskyjp	0:8ee5ec4bcec2	234	}

Repository toolbox

Export to desktop IDE

Build repository

Repository details

Type:	Program
Mbed OS support:	Mbed 2 deprecated
Created:	16 Mar 2012
Imports:	201
Forks:	0
Commits:	2
Dependents:	0
Dependencies:	2
Followers:	14

main.cpp@1:59cee932f289, 2012-03-16 (annotated)

Who changed what in which revision?

Repository toolbox

Repository details

Important Information for this Arm website

Access Warning