mbfuncother.c
上传用户:kongshuqi
上传日期:2013-10-09
资源大小:59k
文件大小:3k
源码类别:

通讯编程

开发平台:

Visual C++

  1.  /*
  2.   * FreeRTOS Modbus Libary: A Modbus serial implementation for FreeRTOS
  3.   * Copyright (C) 2006 Christian Walter <wolti@sil.at>
  4.   *
  5.   * This library is free software; you can redistribute it and/or
  6.   * modify it under the terms of the GNU Lesser General Public
  7.   * License as published by the Free Software Foundation; either
  8.   * version 2.1 of the License, or (at your option) any later version.
  9.   *
  10.   * This library is distributed in the hope that it will be useful,
  11.   * but WITHOUT ANY WARRANTY; without even the implied warranty of
  12.   * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  13.   * Lesser General Public License for more details.
  14.   *
  15.   * You should have received a copy of the GNU Lesser General Public
  16.   * License along with this library; if not, write to the Free Software
  17.   * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
  18.   */
  19. /* ----------------------- System includes ----------------------------------*/
  20. #include "stdlib.h"
  21. #include "string.h"
  22. /* ----------------------- Platform includes --------------------------------*/
  23. #include "port.h"
  24. /* ----------------------- Modbus includes ----------------------------------*/
  25. #include "mb.h"
  26. #include "mbframe.h"
  27. #include "mbproto.h"
  28. #include "mbconfig.h"
  29. #if MB_FUNC_OTHER_REP_SLAVEID_ENABLED > 0
  30. /* ----------------------- Static variables ---------------------------------*/
  31. static UCHAR    ucMBSlaveID[MB_FUNC_OTHER_REP_SLAVEID_BUF];
  32. static USHORT   usMBSlaveIDLen;
  33. /* ----------------------- Start implementation -----------------------------*/
  34. eMBErrorCode
  35. eMBSetSlaveID( UCHAR ucSlaveID, BOOL xIsRunning,
  36.                UCHAR const *pucAdditional, USHORT usAdditionalLen )
  37. {
  38.     eMBErrorCode    eStatus = MB_ENOERR;
  39.     /* the first byte and second byte in the buffer is reserved for
  40.      * the parameter ucSlaveID and the running flag. The rest of
  41.      * the buffer is available for additional data. */
  42.     if( usAdditionalLen + 2 < MB_FUNC_OTHER_REP_SLAVEID_BUF )
  43.     {
  44.         usMBSlaveIDLen = 0;
  45.         ucMBSlaveID[usMBSlaveIDLen++] = ucSlaveID;
  46.         ucMBSlaveID[usMBSlaveIDLen++] = ( UCHAR )( xIsRunning ? 0xFF : 0x00 );
  47.         if( usAdditionalLen > 0 )
  48.         {
  49.             memcpy( &ucMBSlaveID[usMBSlaveIDLen], pucAdditional,
  50.                     ( size_t )usAdditionalLen );
  51.             usMBSlaveIDLen += usAdditionalLen;
  52.         }
  53.     }
  54.     else
  55.     {
  56.         eStatus = MB_ENORES;
  57.     }
  58.     return eStatus;
  59. }
  60. eMBException
  61. eMBFuncReportSlaveID( UCHAR * pucFrame, USHORT * usLen )
  62. {
  63.     memcpy( &pucFrame[MB_PDU_DATA_OFF], &ucMBSlaveID[0], ( size_t )usMBSlaveIDLen );
  64.     *usLen = ( USHORT )( MB_PDU_DATA_OFF + usMBSlaveIDLen );
  65.     return MB_EX_NONE;
  66. }
  67. #endif