ModbusTCP - Modbus RTU/ASCII/TCP with lwip TCP working parti…

Users » tmav123 » Code » ModbusTCP

Athanassios Mavrogeorgiadis / Mbed 2 deprecated ModbusTCP

Modbus RTU/ASCII/TCP with lwip TCP working partial, but with errors (retransmitions)

ModBus/mbutils.cpp@0:f54e9507171b, 2011-12-05 (annotated)

Committer:: tmav123
Date:: Mon Dec 05 22:49:02 2011 +0000
Revision:: 0:f54e9507171b

Who changed what in which revision?

User	Revision	Line number	New contents of line
tmav123	0:f54e9507171b	1	/*
tmav123	0:f54e9507171b	2	* FreeModbus Libary: A portable Modbus implementation for Modbus ASCII/RTU.
tmav123	0:f54e9507171b	3	* Copyright (c) 2006 Christian Walter <wolti@sil.at>
tmav123	0:f54e9507171b	4	* All rights reserved.
tmav123	0:f54e9507171b	5	*
tmav123	0:f54e9507171b	6	* Redistribution and use in source and binary forms, with or without
tmav123	0:f54e9507171b	7	* modification, are permitted provided that the following conditions
tmav123	0:f54e9507171b	8	* are met:
tmav123	0:f54e9507171b	9	* 1. Redistributions of source code must retain the above copyright
tmav123	0:f54e9507171b	10	* notice, this list of conditions and the following disclaimer.
tmav123	0:f54e9507171b	11	* 2. Redistributions in binary form must reproduce the above copyright
tmav123	0:f54e9507171b	12	* notice, this list of conditions and the following disclaimer in the
tmav123	0:f54e9507171b	13	* documentation and/or other materials provided with the distribution.
tmav123	0:f54e9507171b	14	* 3. The name of the author may not be used to endorse or promote products
tmav123	0:f54e9507171b	15	* derived from this software without specific prior written permission.
tmav123	0:f54e9507171b	16	*
tmav123	0:f54e9507171b	17	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
tmav123	0:f54e9507171b	18	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
tmav123	0:f54e9507171b	19	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
tmav123	0:f54e9507171b	20	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
tmav123	0:f54e9507171b	21	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
tmav123	0:f54e9507171b	22	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
tmav123	0:f54e9507171b	23	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
tmav123	0:f54e9507171b	24	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
tmav123	0:f54e9507171b	25	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
tmav123	0:f54e9507171b	26	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
tmav123	0:f54e9507171b	27	*
tmav123	0:f54e9507171b	28	* File: $Id: mbutils.c,v 1.6 2007/02/18 23:49:07 wolti Exp $
tmav123	0:f54e9507171b	29	*/
tmav123	0:f54e9507171b	30
tmav123	0:f54e9507171b	31	/* ----------------------- System includes ----------------------------------*/
tmav123	0:f54e9507171b	32	#include "stdlib.h"
tmav123	0:f54e9507171b	33	#include "string.h"
tmav123	0:f54e9507171b	34
tmav123	0:f54e9507171b	35	/* ----------------------- Platform includes --------------------------------*/
tmav123	0:f54e9507171b	36	#include "port.h"
tmav123	0:f54e9507171b	37
tmav123	0:f54e9507171b	38	/* ----------------------- Modbus includes ----------------------------------*/
tmav123	0:f54e9507171b	39	#include "mb.h"
tmav123	0:f54e9507171b	40	#include "mbproto.h"
tmav123	0:f54e9507171b	41
tmav123	0:f54e9507171b	42	/* ----------------------- Defines ------------------------------------------*/
tmav123	0:f54e9507171b	43	#define BITS_UCHAR 8U
tmav123	0:f54e9507171b	44
tmav123	0:f54e9507171b	45	/* ----------------------- Start implementation -----------------------------*/
tmav123	0:f54e9507171b	46	void
tmav123	0:f54e9507171b	47	xMBUtilSetBits( UCHAR * ucByteBuf, USHORT usBitOffset, UCHAR ucNBits,
tmav123	0:f54e9507171b	48	UCHAR ucValue )
tmav123	0:f54e9507171b	49	{
tmav123	0:f54e9507171b	50	USHORT usWordBuf;
tmav123	0:f54e9507171b	51	USHORT usMask;
tmav123	0:f54e9507171b	52	USHORT usByteOffset;
tmav123	0:f54e9507171b	53	USHORT usNPreBits;
tmav123	0:f54e9507171b	54	USHORT usValue = ucValue;
tmav123	0:f54e9507171b	55
tmav123	0:f54e9507171b	56	assert( ucNBits <= 8 );
tmav123	0:f54e9507171b	57	assert( ( size_t )BITS_UCHAR == sizeof( UCHAR ) * 8 );
tmav123	0:f54e9507171b	58
tmav123	0:f54e9507171b	59	/* Calculate byte offset for first byte containing the bit values starting
tmav123	0:f54e9507171b	60	* at usBitOffset. */
tmav123	0:f54e9507171b	61	usByteOffset = ( USHORT )( ( usBitOffset ) / BITS_UCHAR );
tmav123	0:f54e9507171b	62
tmav123	0:f54e9507171b	63	/* How many bits precede our bits to set. */
tmav123	0:f54e9507171b	64	usNPreBits = ( USHORT )( usBitOffset - usByteOffset * BITS_UCHAR );
tmav123	0:f54e9507171b	65
tmav123	0:f54e9507171b	66	/* Move bit field into position over bits to set */
tmav123	0:f54e9507171b	67	usValue <<= usNPreBits;
tmav123	0:f54e9507171b	68
tmav123	0:f54e9507171b	69	/* Prepare a mask for setting the new bits. */
tmav123	0:f54e9507171b	70	usMask = ( USHORT )( ( 1 << ( USHORT ) ucNBits ) - 1 );
tmav123	0:f54e9507171b	71	usMask <<= usBitOffset - usByteOffset * BITS_UCHAR;
tmav123	0:f54e9507171b	72
tmav123	0:f54e9507171b	73	/* copy bits into temporary storage. */
tmav123	0:f54e9507171b	74	usWordBuf = ucByteBuf[usByteOffset];
tmav123	0:f54e9507171b	75	usWordBuf \|= ucByteBuf[usByteOffset + 1] << BITS_UCHAR;
tmav123	0:f54e9507171b	76
tmav123	0:f54e9507171b	77	/* Zero out bit field bits and then or value bits into them. */
tmav123	0:f54e9507171b	78	usWordBuf = ( USHORT )( ( usWordBuf & ( ~usMask ) ) \| usValue );
tmav123	0:f54e9507171b	79
tmav123	0:f54e9507171b	80	/* move bits back into storage */
tmav123	0:f54e9507171b	81	ucByteBuf[usByteOffset] = ( UCHAR )( usWordBuf & 0xFF );
tmav123	0:f54e9507171b	82	ucByteBuf[usByteOffset + 1] = ( UCHAR )( usWordBuf >> BITS_UCHAR );
tmav123	0:f54e9507171b	83	}
tmav123	0:f54e9507171b	84
tmav123	0:f54e9507171b	85	UCHAR
tmav123	0:f54e9507171b	86	xMBUtilGetBits( UCHAR * ucByteBuf, USHORT usBitOffset, UCHAR ucNBits )
tmav123	0:f54e9507171b	87	{
tmav123	0:f54e9507171b	88	USHORT usWordBuf;
tmav123	0:f54e9507171b	89	USHORT usMask;
tmav123	0:f54e9507171b	90	USHORT usByteOffset;
tmav123	0:f54e9507171b	91	USHORT usNPreBits;
tmav123	0:f54e9507171b	92
tmav123	0:f54e9507171b	93	/* Calculate byte offset for first byte containing the bit values starting
tmav123	0:f54e9507171b	94	* at usBitOffset. */
tmav123	0:f54e9507171b	95	usByteOffset = ( USHORT )( ( usBitOffset ) / BITS_UCHAR );
tmav123	0:f54e9507171b	96
tmav123	0:f54e9507171b	97	/* How many bits precede our bits to set. */
tmav123	0:f54e9507171b	98	usNPreBits = ( USHORT )( usBitOffset - usByteOffset * BITS_UCHAR );
tmav123	0:f54e9507171b	99
tmav123	0:f54e9507171b	100	/* Prepare a mask for setting the new bits. */
tmav123	0:f54e9507171b	101	usMask = ( USHORT )( ( 1 << ( USHORT ) ucNBits ) - 1 );
tmav123	0:f54e9507171b	102
tmav123	0:f54e9507171b	103	/* copy bits into temporary storage. */
tmav123	0:f54e9507171b	104	usWordBuf = ucByteBuf[usByteOffset];
tmav123	0:f54e9507171b	105	usWordBuf \|= ucByteBuf[usByteOffset + 1] << BITS_UCHAR;
tmav123	0:f54e9507171b	106
tmav123	0:f54e9507171b	107	/* throw away unneeded bits. */
tmav123	0:f54e9507171b	108	usWordBuf >>= usNPreBits;
tmav123	0:f54e9507171b	109
tmav123	0:f54e9507171b	110	/* mask away bits above the requested bitfield. */
tmav123	0:f54e9507171b	111	usWordBuf &= usMask;
tmav123	0:f54e9507171b	112
tmav123	0:f54e9507171b	113	return ( UCHAR ) usWordBuf;
tmav123	0:f54e9507171b	114	}
tmav123	0:f54e9507171b	115
tmav123	0:f54e9507171b	116	eMBException
tmav123	0:f54e9507171b	117	prveMBError2Exception( eMBErrorCode eErrorCode )
tmav123	0:f54e9507171b	118	{
tmav123	0:f54e9507171b	119	eMBException eStatus;
tmav123	0:f54e9507171b	120
tmav123	0:f54e9507171b	121	switch ( eErrorCode )
tmav123	0:f54e9507171b	122	{
tmav123	0:f54e9507171b	123	case MB_ENOERR:
tmav123	0:f54e9507171b	124	eStatus = MB_EX_NONE;
tmav123	0:f54e9507171b	125	break;
tmav123	0:f54e9507171b	126
tmav123	0:f54e9507171b	127	case MB_ENOREG:
tmav123	0:f54e9507171b	128	eStatus = MB_EX_ILLEGAL_DATA_ADDRESS;
tmav123	0:f54e9507171b	129	break;
tmav123	0:f54e9507171b	130
tmav123	0:f54e9507171b	131	case MB_ETIMEDOUT:
tmav123	0:f54e9507171b	132	eStatus = MB_EX_SLAVE_BUSY;
tmav123	0:f54e9507171b	133	break;
tmav123	0:f54e9507171b	134
tmav123	0:f54e9507171b	135	default:
tmav123	0:f54e9507171b	136	eStatus = MB_EX_SLAVE_DEVICE_FAILURE;
tmav123	0:f54e9507171b	137	break;
tmav123	0:f54e9507171b	138	}
tmav123	0:f54e9507171b	139
tmav123	0:f54e9507171b	140	return eStatus;
tmav123	0:f54e9507171b	141	}

Repository toolbox

Export to desktop IDE

Build repository

Repository details

Type:	Program
Mbed OS support:	Mbed 2 deprecated
Created:	05 Dec 2011
Imports:	271
Forks:	0
Commits:	1
Dependents:	0
Dependencies:	2
Followers:	17

ModBus/mbutils.cpp@0:f54e9507171b, 2011-12-05 (annotated)

Who changed what in which revision?

Repository toolbox

Repository details

Important Information for this Arm website

Access Warning