mbfuncother.c
上传用户:kongshuqi
上传日期:2013-10-09
资源大小:59k
文件大小:3k
- /*
- * FreeRTOS Modbus Libary: A Modbus serial implementation for FreeRTOS
- * 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
- */
- /* ----------------------- 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