port freemodbus

git-svn-id: https://rt-thread.googlecode.com/svn/trunk@582 bbd45198-f89e-11dd-88c7-29a3b14d5316

net/freemodbus/SConscript

@@ -0,0 +1,33 @@
+Import('env')
+Import('rtconfig')
+Import('RTT_ROOT')
+
+src_local = Split("""
+modbus/mb.c
+modbus/mbmaster.c
+modbus/ascii/mbascii.c
+modbus/functions/mbfunccoils.c
+modbus/functions/mbfuncdiag.c
+modbus/functions/mbfuncdisc.c
+modbus/functions/mbfuncholding.c
+modbus/functions/mbfuncinput.c
+modbus/functions/mbfuncother.c
+modbus/functions/mbutils.c
+modbus/port/demo.c
+modbus/port/port.c
+modbus/port/portevent.c
+modbus/port/portserial.c
+modbus/port/porttimer.c
+modbus/rtu/mbcrc.c
+modbus/rtu/mbrtu.c
+modbus/tcp/mbtcp.c
+""")
+
+# The set of source files associated with this SConscript file.
+path = [RTT_ROOT + '/net/freemodbus/modbus/include', RTT_ROOT + '/net/freemodbus/modbus/port', RTT_ROOT + '/net/freemodbus/modbus/rtu', RTT_ROOT + '/net/freemodbus/modbus/ascii']
+
+env.Append(CPPPATH = path)
+
+obj = env.Object(src_local)
+
+Return('obj')

net/freemodbus/modbus/mbmaster.c

@@ -0,0 +1,68 @@
+/*
+ * File      : mbmaster.c
+ * This file is part of freemodbus in RT-Thread RTOS
+ * COPYRIGHT (C) 2006 - 2009, RT-Thread Development Team
+ *
+ * The license and distribution terms for this file may be
+ * found in the file LICENSE in this distribution or at
+ * http://www.rt-thread.org/license/LICENSE
+ *
+ * Change Logs:
+ * Date           Author       Notes
+ * 2010-04-04     yi.qiu      first version
+ */
+ 
+/* ----------------------- Platform includes --------------------------------*/
+#include "rtthread.h"
+#include "port.h"
+
+/* ----------------------- Modbus includes ----------------------------------*/
+#include "mb.h"
+#include "mbconfig.h"
+#include "mbframe.h"
+#include "mbproto.h"
+#include "mbfunc.h"
+
+eMBErrorCode eMBMReadHoldingRegisters  (UCHAR ucSlaveAddress, USHORT usRegStartAddress, 
+			UBYTE ubNRegs, USHORT arusBufferOut[]) 
+{
+	static UCHAR ucMBFrame[5];
+	eMBErrorCode eStatus = MB_ENOERR;
+	eMBEventType eEvent;
+	static UCHAR ucRcvAddress;
+	static USHORT usLength;
+
+	/* make up request frame */	
+	ucMBFrame[0] = MB_FUNC_READ_HOLDING_REGISTER;
+	ucMBFrame[1] = (UCHAR)(usRegStartAddress >> 8);
+	ucMBFrame[2] = (UCHAR)(usRegStartAddress);
+	ucMBFrame[3] = (UCHAR)(ubNRegs >> 8);
+	ucMBFrame[4] = (UCHAR)(ubNRegs);	
+
+	 
+		rt_kprintf("send frame [%x%x%x%x%x]\n", 
+		ucMBFrame[0], ucMBFrame[1], ucMBFrame[2], ucMBFrame[3], ucMBFrame[4]); 
+	
+	
+	/* send request frame to slave device */
+	eStatus = eMBRTUSend( ucSlaveAddress, ucMBFrame, 5 );
+
+	/* wait on receive event */
+	if( xMBPortEventGet( &eEvent ) == TRUE )
+	{		
+		eStatus = eMBRTUReceive( &ucRcvAddress, &ucMBFrame, &usLength );
+		if( eStatus == MB_ENOERR )
+		{
+			/* Check if the frame is for us. If not ignore the frame. */
+			if( ( ucRcvAddress == ucSlaveAddress ) || ( ucRcvAddress == MB_ADDRESS_BROADCAST ) )
+			{
+				/* parse and restore data */
+				rt_kprintf("parse and restore date here\n");
+			}
+		}
+	}
+	else eStatus = MB_ETIMEDOUT;
+
+	return eStatus;
+}
+

net/freemodbus/modbus/port/demo.c

@@ -0,0 +1,84 @@
+/*
+ * File      : demo.c
+ * This file is part of freemodbus in RT-Thread RTOS
+ * COPYRIGHT (C) 2006 - 2009, RT-Thread Development Team
+ *
+ * The license and distribution terms for this file may be
+ * found in the file LICENSE in this distribution or at
+ * http://www.rt-thread.org/license/LICENSE
+ *
+ * Change Logs:
+ * Date           Author       Notes
+ * 2010-04-04     yi.qiu      first version
+ */
+ 
+/* ----------------------- Platform includes --------------------------------*/
+#include <rtthread.h>
+#include "port.h"
+
+/* ----------------------- Modbus includes ----------------------------------*/
+#include "mb.h"
+#include "mbconfig.h"
+#include "mbframe.h"
+#include "mbproto.h"
+#include "mbfunc.h"
+
+void rt_modbus_thread_entry(void* parameter)
+{
+	eMBErrorCode eStatus;
+	USHORT buf[100];
+		
+	eStatus = eMBInit( MB_RTU, 0x0A, 0, 115200, MB_PAR_EVEN );
+
+	/* Enable the Modbus Protocol Stack. */
+	eStatus = eMBEnable(  );
+	rt_thread_delay(50);
+	
+	while(1)
+	{
+
+		eMBMReadHoldingRegisters(0x0A, 0x10000, 0x1, buf);
+		rt_kprintf("stop\n");
+		rt_thread_delay(100);
+		
+		//while(1);
+	}
+}
+
+int modbus_demo_init(void)
+{
+	rt_thread_t modbus_thread;
+
+	modbus_thread = rt_thread_create("modbus",
+								rt_modbus_thread_entry, RT_NULL,
+								2048, 20, 20);
+
+	if (modbus_thread != RT_NULL)
+		rt_thread_startup(modbus_thread);
+
+	return 0;
+}
+
+eMBErrorCode eMBRegInputCB( UCHAR * pucRegBuffer, USHORT usAddress, USHORT usNRegs )
+{
+	return MB_ENOREG;
+}
+
+eMBErrorCode eMBRegHoldingCB( UCHAR * pucRegBuffer, USHORT usAddress, USHORT usNRegs,
+			eMBRegisterMode eMode )
+{
+	return MB_ENOREG;
+}
+
+
+eMBErrorCode eMBRegCoilsCB( UCHAR * pucRegBuffer, USHORT usAddress, USHORT usNCoils,
+			eMBRegisterMode eMode )
+{
+	return MB_ENOREG;
+}
+
+eMBErrorCode eMBRegDiscreteCB( UCHAR * pucRegBuffer, USHORT usAddress, USHORT usNDiscrete )
+{
+	return MB_ENOREG;
+}
+

net/freemodbus/modbus/port/port.c

@@ -0,0 +1,34 @@
+/*
+ * File      : porttimer.c
+ * This file is part of freemodbus in RT-Thread RTOS
+ * COPYRIGHT (C) 2006 - 2009, RT-Thread Development Team
+ *
+ * The license and distribution terms for this file may be
+ * found in the file LICENSE in this distribution or at
+ * http://www.rt-thread.org/license/LICENSE
+ *
+ * Change Logs:
+ * Date           Author       Notes
+ * 2010-04-04     yi.qiu      first version
+ */
+ 
+/* ----------------------- System includes --------------------------------*/
+#include <rtthread.h>
+#include <rthw.h>
+
+/* ----------------------- Modbus includes ----------------------------------*/
+
+/* ----------------------- Variables ----------------------------------------*/
+static int level;
+
+/* ----------------------- Start implementation -----------------------------*/
+void EnterCriticalSection(void)
+{
+	level = rt_hw_interrupt_disable();
+}
+
+void ExitCriticalSection(void)
+{
+	rt_hw_interrupt_enable(level);
+}
+

net/freemodbus/modbus/port/port.h

@@ -0,0 +1,57 @@
+/*
+ * FreeModbus Libary: BARE 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: port.h,v 1.1 2007/04/24 23:15:18 wolti Exp $
+ */
+
+#ifndef _PORT_H
+#define _PORT_H
+
+#include <rtthread.h>
+
+#define INLINE
+#define PR_BEGIN_EXTERN_C           extern "C" {
+#define PR_END_EXTERN_C             }
+
+#define assert(x) RT_ASSERT(x)
+#define ENTER_CRITICAL_SECTION()	EnterCriticalSection()
+#define EXIT_CRITICAL_SECTION()		ExitCriticalSection()
+
+void EnterCriticalSection( void );
+void ExitCriticalSection( void );
+
+typedef rt_uint8_t BOOL;
+typedef unsigned char UBYTE;
+typedef unsigned char UCHAR;
+typedef char CHAR;
+
+typedef rt_uint16_t USHORT;
+typedef rt_int16_t SHORT;
+
+typedef rt_uint32_t ULONG;
+typedef rt_int32_t LONG;
+
+#ifndef TRUE
+#define TRUE            1
+#endif
+
+#ifndef FALSE
+#define FALSE           0
+#endif
+
+#endif

net/freemodbus/modbus/port/portevent.c

@@ -0,0 +1,55 @@
+/*
+ * File      : portevent.c
+ * This file is part of freemodbus in RT-Thread RTOS
+ * COPYRIGHT (C) 2006 - 2009, RT-Thread Development Team
+ *
+ * The license and distribution terms for this file may be
+ * found in the file LICENSE in this distribution or at
+ * http://www.rt-thread.org/license/LICENSE
+ *
+ * Change Logs:
+ * Date           Author       Notes
+ * 2010-04-04     yi.qiu      first version
+ */
+
+/* ----------------------- Modbus includes ----------------------------------*/
+#include <rtthread.h>
+
+#include "mb.h"
+#include "mbport.h"
+
+/* ----------------------- Variables ----------------------------------------*/
+static struct rt_event event;
+
+/* ----------------------- Start implementation -----------------------------*/
+BOOL xMBPortEventInit( void )
+{
+	rt_event_init(&event, "modbus", RT_IPC_FLAG_FIFO);
+
+	return TRUE;
+}
+
+BOOL xMBPortEventPost( eMBEventType eEvent )
+{
+	/* only care abot EV_FRAME_RECEIVED event */
+	if(eEvent == EV_FRAME_RECEIVED)
+		rt_event_send(&event, 1<<eEvent);
+
+	return TRUE;
+}
+
+BOOL xMBPortEventGet( eMBEventType * eEvent )
+{
+	rt_uint32_t e;
+	rt_int32_t time_out = 100/(1000/RT_TICK_PER_SECOND);
+		
+	if(rt_event_recv(&event, (1<<EV_FRAME_RECEIVED),
+			RT_EVENT_FLAG_AND | RT_EVENT_FLAG_CLEAR,
+			time_out, &e) == RT_EOK)
+	{
+		*eEvent = EV_FRAME_RECEIVED;
+		return TRUE;
+	}		
+	else return FALSE;
+}
+

net/freemodbus/modbus/port/portserial.c

@@ -0,0 +1,143 @@
+/*
+ * File      : portserial.c
+ * This file is part of freemodbus in RT-Thread RTOS
+ * COPYRIGHT (C) 2006 - 2009, RT-Thread Development Team
+ *
+ * The license and distribution terms for this file may be
+ * found in the file LICENSE in this distribution or at
+ * http://www.rt-thread.org/license/LICENSE
+ *
+ * Change Logs:
+ * Date           Author       Notes
+ * 2010-04-04     yi.qiu      first version
+ */
+ 
+#include <rtthread.h>
+
+#include "port.h"
+#include "serial.h"
+
+/* ----------------------- Modbus includes ----------------------------------*/
+#include "mb.h"
+#include "mbport.h"
+
+#define UART1	((struct uartport *)U1BASE)
+
+/* ----------------------- static functions ---------------------------------*/
+static void rt_serial1_handler(int vector);
+static void prvvUARTTxReadyISR(void);
+static void prvvUARTRxISR(void);
+extern rt_uint32_t PCLK;
+
+/* ----------------------- Start implementation -----------------------------*/
+void vMBPortSerialEnable( BOOL xRxEnable, BOOL xTxEnable )
+{
+	if( xRxEnable )
+	{
+		INTSUBMSK  &= ~(BIT_SUB_RXD1);
+	}
+	else
+	{
+		INTSUBMSK |= (BIT_SUB_RXD1);
+	}
+	if( xTxEnable )
+	{
+		INTSUBMSK &= ~(BIT_SUB_TXD1);
+		prvvUARTTxReadyISR();
+	}
+	else
+	{
+		INTSUBMSK |= (BIT_SUB_TXD1);
+	}
+}
+
+void vMBPortClose( void )
+{
+	/* null */
+}
+
+BOOL xMBPortSerialInit( UCHAR ucPORT, ULONG ulBaudRate, UCHAR ucDataBits, eMBParity eParity )
+{
+   	int i;
+
+	/* FIFO enable, Tx/Rx FIFO clear */
+	UART1->ufcon = 0x0;
+	/* disable the flow control */
+	UART1->umcon = 0x0;
+	/* Normal,No parity,1 stop,8 bit */
+	UART1->ulcon = 0x3;
+	/*
+	 * tx=level,rx=edge,disable timeout int.,enable rx error int.
+	 * normal,interrupt or polling
+	 */
+	UART1->ucon = 0x245;
+	/* Set uart0 bps */
+	UART1->ubrd = (rt_int32_t)(PCLK / (ulBaudRate * 16)) - 1;
+
+	for (i = 0; i < 100; i++);
+
+	SUBSRCPND |= BIT_SUB_RXD1;
+	SUBSRCPND |= BIT_SUB_TXD1;
+
+	rt_hw_interrupt_install(INTUART1, rt_serial1_handler, RT_NULL);
+	rt_hw_interrupt_umask(INTUART1);
+
+	return TRUE;
+}
+
+BOOL xMBPortSerialPutByte( CHAR ucByte )
+{
+	/* wait for room in the transmit FIFO */
+	while(!(USTAT1 & USTAT_TXB_EMPTY));
+
+	UTXH1 = (UCHAR)ucByte;
+	
+	return TRUE;
+}
+
+BOOL xMBPortSerialGetByte( CHAR * pucByte )
+{
+	while ((USTAT1 & USTAT_RCV_READY) == 0);
+
+	*pucByte = URXB1;
+
+	return TRUE;
+}
+
+static void rt_serial1_handler(int vector)
+{	
+
+	if (SUBSRCPND & BIT_SUB_RXD1)
+	{			
+		SUBSRCPND |= BIT_SUB_RXD1;
+		prvvUARTRxISR();
+	}	
+	if (SUBSRCPND & BIT_SUB_TXD1)
+	{	
+		SUBSRCPND |= BIT_SUB_TXD1;	
+		prvvUARTTxReadyISR();
+	}	
+}
+
+/* 
+ * Create an interrupt handler for the transmit buffer empty interrupt
+ * (or an equivalent) for your target processor. This function should then
+ * call pxMBFrameCBTransmitterEmpty( ) which tells the protocol stack that
+ * a new character can be sent. The protocol stack will then call 
+ * xMBPortSerialPutByte( ) to send the character.
+ */
+static void prvvUARTTxReadyISR( void )
+{
+	pxMBFrameCBTransmitterEmpty(  );
+}
+
+/* 
+ * Create an interrupt handler for the receive interrupt for your target
+ * processor. This function should then call pxMBFrameCBByteReceived( ). The
+ * protocol stack will then call xMBPortSerialGetByte( ) to retrieve the
+ * character.
+ */
+static void prvvUARTRxISR( void )
+{
+	pxMBFrameCBByteReceived(  );
+}

net/freemodbus/modbus/port/porttimer.c

@@ -0,0 +1,64 @@
+/*
+ * File      : porttimer.c
+ * This file is part of freemodbus in RT-Thread RTOS
+ * COPYRIGHT (C) 2006 - 2009, RT-Thread Development Team
+ *
+ * The license and distribution terms for this file may be
+ * found in the file LICENSE in this distribution or at
+ * http://www.rt-thread.org/license/LICENSE
+ *
+ * Change Logs:
+ * Date           Author       Notes
+ * 2010-04-04     yi.qiu      first version
+ */
+
+/* ----------------------- Platform includes --------------------------------*/
+#include <rtthread.h>
+
+#include <s3c24x0.h>
+#include "port.h"
+
+/* ----------------------- Modbus includes ----------------------------------*/
+#include "mb.h"
+#include "mbport.h"
+
+/* ----------------------- static functions ---------------------------------*/
+static void prvvTIMERExpiredISR( void );
+extern rt_uint32_t PCLK;
+
+/* ----------------------- Start implementation -----------------------------*/
+BOOL xMBPortTimersInit(USHORT usTim1Timerout50us)
+{
+	/* all are interrupt mode,set Timer 3 MUX 1/4 */
+	TCFG1  &= 0xffff0fff;
+	TCFG1  |= 0x00001000;
+
+	TCNTB3 = (rt_int32_t)(usTim1Timerout50us*(PCLK/ (4 *16* 20000))) - 1;
+	/* manual update */
+	TCON = TCON & (~(0x0f<<16)) | (0x02<<16);
+	/* install interrupt handler */
+	rt_hw_interrupt_install(INTTIMER3, prvvTIMERExpiredISR, RT_NULL);
+	rt_hw_interrupt_umask(INTTIMER3);
+
+	/* start timer4, reload */
+	TCON = TCON & (~(0x0f<<16)) | (0x09<<16);
+
+	return TRUE;
+}
+
+void vMBPortTimersEnable(void)
+{
+	/* start timer4, reload */
+	TCON = TCON & (~(0x0f<<16)) | (0x09<<16);
+}
+
+void vMBPortTimersDisable(void)
+{
+	TCON = TCON & (~(0x01<<16));
+}
+
+static void prvvTIMERExpiredISR( void )
+{
+	(void)pxMBPortCBTimerExpired();
+}
+