Category

Development Platform
Home > SourceCode/Document > Windows Develop > Communication > View Code
mbutils.c
Package: FreeModBus.rar　[view]
Upload User: kongshuqi
Upload Date: 2013-10-09
Package Size: 59k
Code Size: 4k
Category:

Communication

Development Platform:

Visual C++

mbutils.c：Code Content
  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.   */
  20. /* ----------------------- System includes ----------------------------------*/
  21. #include "stdlib.h"
  22. #include "string.h"
  24. /* ----------------------- Platform includes --------------------------------*/
  25. #include "port.h"
  27. /* ----------------------- Modbus includes ----------------------------------*/
  28. #include "mb.h"
  29. #include "mbproto.h"
  31. /* ----------------------- Defines ------------------------------------------*/
  32. #define BITS_UCHAR      8U
  34. /* ----------------------- Start implementation -----------------------------*/
  35. void
  36. xMBUtilSetBits( UCHAR * ucByteBuf, USHORT usBitOffset, UCHAR ucNBits,
  37.                 UCHAR ucValue )
  38. {
  39.     USHORT          usWordBuf;
  40.     USHORT          usMask;
  41.     USHORT          usByteOffset;
  42.     USHORT          usNPreBits;
  43.     USHORT          usValue = ucValue;
  45.     assert( ucNBits <= 8 );
  46.     assert( ( size_t )BITS_UCHAR == sizeof( UCHAR ) * 8 );
  48.     /* Calculate byte offset for first byte containing the bit values starting
  49.      * at usBitOffset. */
  50.     usByteOffset = ( USHORT )( ( usBitOffset ) / BITS_UCHAR );
  52.     /* How many bits precede our bits to set. */
  53.     usNPreBits = ( USHORT )( usBitOffset - usByteOffset * BITS_UCHAR );
  55.     /* Move bit field into position over bits to set */
  56.     usValue <<= usNPreBits;
  58.     /* Prepare a mask for setting the new bits. */
  59.     usMask = ( USHORT )( ( 1 << ( USHORT ) ucNBits ) - 1 );
  60.     usMask <<= usBitOffset - usByteOffset * BITS_UCHAR;
  62.     /* copy bits into temporary storage. */
  63.     usWordBuf = ucByteBuf[usByteOffset];
  64.     usWordBuf |= ucByteBuf[usByteOffset + 1] << BITS_UCHAR;
  66.     /* Zero out bit field bits and then or value bits into them. */
  67.     usWordBuf = ( usWordBuf & ( ~usMask ) ) | usValue;
  69.     /* move bits back into storage */
  70.     ucByteBuf[usByteOffset] = ( UCHAR )( usWordBuf & 0xFF );
  71.     ucByteBuf[usByteOffset + 1] = usWordBuf >> BITS_UCHAR;
  72. }
  74. UCHAR
  75. xMBUtilGetBits( UCHAR * ucByteBuf, USHORT usBitOffset, UCHAR ucNBits )
  76. {
  77.     USHORT          usWordBuf;
  78.     USHORT          usMask;
  79.     USHORT          usByteOffset;
  80.     USHORT          usNPreBits;
  82.     /* Calculate byte offset for first byte containing the bit values starting
  83.      * at usBitOffset. */
  84.     usByteOffset = ( USHORT )( ( usBitOffset ) / BITS_UCHAR );
  86.     /* How many bits precede our bits to set. */
  87.     usNPreBits = ( USHORT )( usBitOffset - usByteOffset * BITS_UCHAR );
  89.     /* Prepare a mask for setting the new bits. */
  90.     usMask = ( USHORT )( ( 1 << ( USHORT ) ucNBits ) - 1 );
  92.     /* copy bits into temporary storage. */
  93.     usWordBuf = ucByteBuf[usByteOffset];
  94.     usWordBuf |= ucByteBuf[usByteOffset + 1] << BITS_UCHAR;
  96.     /* throw away unneeded bits. */
  97.     usWordBuf >>= usNPreBits;
  99.     /* mask away bits above the requested bitfield. */
  100.     usWordBuf &= usMask;
  102.     return ( UCHAR ) usWordBuf;
  103. }
  105. eMBException
  106. prveMBError2Exception( eMBErrorCode eErrorCode )
  107. {
  108.     eMBException    eStatus;
  110.     switch ( eErrorCode )
  111.     {
  112.         case MB_ENOERR:
  113.             eStatus = MB_EX_NONE;
  114.             break;
  116.         case MB_ENOREG:
  117.             eStatus = MB_EX_ILLEGAL_DATA_ADDRESS;
  118.             break;
  120.         case MB_ETIMEDOUT:
  121.             eStatus = MB_EX_SLAVE_BUSY;
  122.             break;
  124.         default:
  125.             eStatus = MB_EX_SLAVE_DEVICE_FAILURE;
  126.             break;
  127.     }
  129.     return eStatus;
  130. }