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

通讯编程

开发平台:

Visual C++

  1. /*
  2.  * FreeModbus Libary: Win32 Port
  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.  * File: $Id: portother.c,v 1.1 2006/06/25 00:20:19 wolti Exp $
  20.  */
  21. #include <stdio.h>
  22. #include <stdlib.h>
  23. #include "winsock2.h"
  24. #include "port.h"
  25. /* ----------------------- Modbus includes ----------------------------------*/
  26. #include "mb.h"
  27. #include "mbport.h"
  28. #include "mbconfig.h"
  29. BOOL
  30. prvMBTCPPortAddressToString( SOCKET xSocket, LPTSTR szAddr, USHORT usBufSize )
  31. {
  32.     BOOL            bOkay;
  33.     SOCKADDR_IN     xClientAddr;
  34.     int             iAddrLen = sizeof( SOCKADDR_IN );
  35.     DWORD           dwBufSize = usBufSize;
  36.     assert( ( szAddr != NULL ) && ( usBufSize > 0 ) );
  37.     if( getsockname( xSocket, ( SOCKADDR * ) & xClientAddr, &iAddrLen ) == SOCKET_ERROR )
  38.     {
  39.         bOkay = FALSE;
  40.     }
  41.     else if( WSAAddressToString( ( SOCKADDR * ) & xClientAddr, iAddrLen, NULL, szAddr,
  42.                                  &dwBufSize ) == SOCKET_ERROR )
  43.     {
  44.         bOkay = FALSE;
  45.     }
  46.     else
  47.     {
  48.         bOkay = TRUE;
  49.     }
  50.     return bOkay;
  51. }
  52. LPTSTR
  53. prvMBTCPPortFrameToString( UCHAR * pucFrame, USHORT usFrameLen )
  54. {
  55.     LPTSTR          szBuf;
  56.     int             i;
  57.     int             res;
  58.     int             szBufPos = 0;
  59.     int             szBufLength = usFrameLen + 128;
  60.     assert( ( pucFrame != NULL ) );
  61.     szBuf = malloc( szBufLength * sizeof( TCHAR ) );
  62.     if( szBuf != NULL )
  63.     {
  64.         for( i = 0; i < usFrameLen; i++ )
  65.         {
  66.             /* Print some additional frame information. */
  67.             switch ( i )
  68.             {
  69.             case 0:            /* TID = Transaction Identifier. */
  70.                 res = _sntprintf_s( &szBuf[szBufPos], szBufLength, _TRUNCATE, _T( "| TID = " ) );
  71.                 break;
  72.             case 2:            /* PID = Protocol Identifier. */
  73.                 res = _sntprintf_s( &szBuf[szBufPos], szBufLength, _TRUNCATE, _T( " | PID = " ) );
  74.                 break;
  75.             case 4:            /* Length */
  76.                 res = _sntprintf_s( &szBuf[szBufPos], szBufLength, _TRUNCATE, _T( " | LEN = " ) );
  77.                 break;
  78.             case 6:            /* UID = Unit Identifier. */
  79.                 res = _sntprintf_s( &szBuf[szBufPos], szBufLength, _TRUNCATE, _T( " | UID = " ) );
  80.                 break;
  81.             case 7:            /* MB Function Code. */
  82.                 res = _sntprintf_s( &szBuf[szBufPos], szBufLength, _TRUNCATE, _T( " || FUNC = " ) );
  83.                 break;
  84.             case 8:            /* MB PDU rest. */
  85.                 res = _sntprintf_s( &szBuf[szBufPos], szBufLength, _TRUNCATE, _T( " | DATA = " ) );
  86.                 break;
  87.             default:
  88.                 res = 0;
  89.                 break;
  90.             }
  91.             if( res == -1 )
  92.             {
  93.                 break;
  94.             }
  95.             else if( res != 0 )
  96.             {
  97.                 szBufPos += res;
  98.                 szBufLength -= res;
  99.             }
  100.             /* Print the data. */
  101.             res = _sntprintf_s( &szBuf[szBufPos], szBufLength, _TRUNCATE, _T( "%02X" ),
  102.                                 pucFrame[i] );
  103.             if( res == -1 )
  104.             {
  105.                 break;
  106.             }
  107.             szBufPos += res;
  108.             szBufLength -= res;
  109.         }
  110.         if( res != -1 )
  111.         {
  112.             /* Append an end of frame string. */
  113.             res = _sntprintf_s( &szBuf[szBufPos], szBufLength, _TRUNCATE, _T( " |" ), pucFrame[i] );
  114.         }
  115.         if( res == -1 )
  116.         {
  117.             free( szBuf );
  118.             szBuf = NULL;
  119.         }
  120.     }
  121.     return szBuf;
  122. }
  123. TCHAR          *
  124. WsaError2String( DWORD dwError )
  125. {
  126.     static TCHAR    szUserBuf[512];
  127.     static LPTSTR   szErrorMsg = _T( "internal error" );
  128.     LPTSTR          lpMsgBuf = NULL;
  129.     DWORD           dwLength;
  130.     dwLength = FormatMessage( FORMAT_MESSAGE_ALLOCATE_BUFFER |
  131.                               FORMAT_MESSAGE_FROM_SYSTEM,
  132.                               NULL,
  133.                               dwError,
  134.                               MAKELANGID( LANG_NEUTRAL, SUBLANG_DEFAULT ),
  135.                               ( LPTSTR ) & lpMsgBuf, 0, NULL );
  136.     if( dwLength == 0 )
  137.     {
  138.         lpMsgBuf = _T( "internal error" );
  139.     }
  140.     _tcsnccpy_s( szUserBuf, _countof( szUserBuf ), lpMsgBuf, _tcslen( lpMsgBuf ) );
  141.     LocalFree( lpMsgBuf );
  142.     return szUserBuf;
  143. }
  144. void
  145. vMBPortLog( eMBPortLogLevel eLevel, const TCHAR * szModule, const TCHAR * szFmt, ... )
  146. {
  147.     va_list         args;
  148.     static const LPTSTR arszLevel2Str[] =
  149.         { _T( "DEBUG" ), _T( "INFO" ), _T( "WARN" ), _T( "ERROR" ) };
  150.     _ftprintf( stderr, _T( "%s: %s: " ), arszLevel2Str[eLevel], szModule );
  151.     va_start( args, szFmt );
  152.     _vftprintf( stderr, szFmt, args );
  153.     va_end( args );
  154. }