windows-xp/Source/XPSP1/NT/net/irda/irxfer/store.cxx

//+-------------------------------------------------------------------------
//
//  Microsoft Windows
//
//  Copyright (C) Microsoft Corporation, 1997 - 1999
//
//  File:       store.cxx
//
//--------------------------------------------------------------------------

#include "precomp.h"


#define cbSTORE_OVERHEAD    ( 3*sizeof(DWORD) )


LPSTORE Store_New( DWORD dwStoreSize )
{
    LPSTORE lpStore;

    lpStore = (LPSTORE) MemAlloc( cbSTORE_OVERHEAD + dwStoreSize );

    if( lpStore )
    {
        lpStore->dwSize = dwStoreSize;
        Store_Empty( lpStore );
    }

    return lpStore;
}


BOOL Store_Empty( LPSTORE lpStore )
{
    if( !lpStore )
        {
        return FALSE;
        }

    DbgLog1( SEV_FUNCTION, "Store_Empty: Remove: %ld bytes", lpStore->dwUsed );

    lpStore->dwUsed      = 0;
    lpStore->dwOutOffset = 0;

    return TRUE;
}


BOOL Store_AddData( LPSTORE lpStore, LPVOID lpvData, DWORD dwDataSize )
{
    // have enough room for new data?
    if( lpStore->dwUsed + dwDataSize > lpStore->dwSize )
        {
        DbgLog3( SEV_ERROR,
                 "Store_AddData: not enough room, used %d new %d size %d",
                 lpStore->dwUsed, dwDataSize, lpStore->dwSize );
        return FALSE;
        }

    CopyMemory( (LPVOID)( &(lpStore->ab1Store[lpStore->dwUsed]) ),
                lpvData,
                dwDataSize );

    lpStore->dwUsed += dwDataSize;

    DbgLog1( SEV_INFO, "Store_AddData: dwUsed: %ld bytes", lpStore->dwUsed );

    return TRUE;
}


DWORD Store_GetDataUsed( LPSTORE lpStore )
{
    return lpStore->dwUsed;
}

DWORD
Store_GetSize(
    LPSTORE lpStore
    )
{
    return lpStore->dwSize;
}



VOID Store_RemoveData( LPSTORE lpStore, DWORD dwLen )
{
    DbgLog1( SEV_FUNCTION, "Store_RemoveData: Remove: %ld bytes", dwLen );

    if( dwLen > lpStore->dwUsed )
        {
        Store_Empty( lpStore );
        return;
        }

    lpStore->dwUsed -= dwLen;
    lpStore->dwOutOffset  = 0L;

    if (lpStore->dwUsed)
        {
        CopyMemory( (LPVOID)( lpStore->ab1Store ),
                    (LPVOID)( &(lpStore->ab1Store[dwLen]) ),
                    lpStore->dwUsed );
        }

    DbgLog1( SEV_FUNCTION, "Store_RemoveData: dwUsed: %d", lpStore->dwUsed );
}

BOOL Store_GetData1Byte( LPSTORE lpStore, LPBYTE1 pb1 )
{
    if( !pb1 )
        return FALSE;

    if( lpStore->dwOutOffset + sizeof(*pb1) > lpStore->dwUsed )
        {
        DbgLog2( SEV_ERROR,
                 "Store_GetData: get 1 failed, used %d, offset %d",
                 lpStore->dwUsed, lpStore->dwOutOffset );
        return FALSE;
        }

    *pb1 = *( (LPBYTE1)(lpStore->ab1Store + lpStore->dwOutOffset) );

    lpStore->dwOutOffset += sizeof( *pb1 );

    return TRUE;
}


BOOL Store_GetData2Byte( LPSTORE lpStore, LPBYTE2 pb2 )
{
    if( !pb2 )
        return FALSE;

    if( lpStore->dwOutOffset + sizeof(*pb2) > lpStore->dwUsed )
        {
        DbgLog2( SEV_ERROR,
                 "Store_GetData: get 2 failed, used %d, offset %d",
                 lpStore->dwUsed, lpStore->dwOutOffset );
        return FALSE;
        }

    CopyMemory(pb2,lpStore->ab1Store + lpStore->dwOutOffset, sizeof(*pb2));

//    *pb2 = *( (LPBYTE2)(lpStore->ab1Store + lpStore->dwOutOffset) );

    ChangeByteOrder( (LPBYTE1)pb2, sizeof(*pb2), sizeof(*pb2) );

    lpStore->dwOutOffset += sizeof( *pb2 );

    return TRUE;
}


BOOL Store_GetData4Byte( LPSTORE lpStore, LPBYTE4 pb4 )
{
    if( !pb4 )
        return FALSE;

    if( lpStore->dwOutOffset + sizeof(*pb4) > lpStore->dwUsed )
        {
        DbgLog2( SEV_ERROR,
                 "Store_GetData: get 4 failed, used %d, offset %d",
                 lpStore->dwUsed, lpStore->dwOutOffset );
        return FALSE;
        }

    CopyMemory(pb4,lpStore->ab1Store + lpStore->dwOutOffset, sizeof(*pb4));

//    *pb4 = *( (LPBYTE4)(lpStore->ab1Store + lpStore->dwOutOffset) );

    ChangeByteOrder( (LPBYTE1)pb4, sizeof(*pb4), sizeof(*pb4) );

    lpStore->dwOutOffset += sizeof( *pb4 );

    return TRUE;
}

BOOL Store_GetDataUuid( LPSTORE lpStore, UUID * pb )
{
    if( !pb )
        return FALSE;

    if( lpStore->dwOutOffset + sizeof(*pb) > lpStore->dwUsed )
        {
        DbgLog2( SEV_ERROR,
                 "Store_GetData: get UUID failed, used %d, offset %d",
                 lpStore->dwUsed, lpStore->dwOutOffset );
        return FALSE;
        }

    CopyMemory(pb,lpStore->ab1Store + lpStore->dwOutOffset, sizeof(*pb));
//    *pb = *( (UUID *)(lpStore->ab1Store + lpStore->dwOutOffset) );

    ChangeByteOrder( &pb->Data1, sizeof(pb->Data1), sizeof(pb->Data1) );
    ChangeByteOrder( &pb->Data2, sizeof(pb->Data2), sizeof(pb->Data2) );
    ChangeByteOrder( &pb->Data3, sizeof(pb->Data3), sizeof(pb->Data3) );

    lpStore->dwOutOffset += sizeof( UUID );

    return TRUE;
}


BOOL Store_GetDataWsz( LPSTORE lpStore, LPWSTR wsz, DWORD BufferLength )
{
    LPWSTR lpwsz = (LPWSTR)(lpStore->ab1Store + lpStore->dwOutOffset);
    INT    nLen  = CbWsz(lpwsz);

    if( !wsz || BufferLength < (DWORD) nLen)
        return FALSE;

    if( lpStore->dwOutOffset + nLen > lpStore->dwUsed )
        {
        DbgLog2( SEV_ERROR,
                 "Store_GetData: get Unicode string failed, used %d, offset %d",
                 lpStore->dwUsed, lpStore->dwOutOffset );
        return FALSE;
        }

    wcsncpy( wsz, lpwsz, BufferLength / sizeof(WCHAR) );

    lpStore->dwOutOffset += nLen;

    ChangeByteOrder( (LPBYTE1)wsz, sizeof(WCHAR), nLen );

    return TRUE;
}


LPVOID Store_GetDataPtr( LPSTORE lpStore )
{
    return (lpStore->ab1Store + lpStore->dwOutOffset);
}


VOID Store_SkipData( LPSTORE lpStore, INT nSize )
{
    lpStore->dwOutOffset += nSize;
}


BOOL Store_PokeData( LPSTORE lpStore, DWORD dwOffset, LPVOID lpvData, DWORD dwDataSize )
{
    if( dwOffset + dwDataSize > lpStore->dwUsed )
        return FALSE;

    // NOTE: data must be atomic
    ChangeByteOrder( (unsigned char *) lpvData, dwDataSize, dwDataSize );

    CopyMemory(
        lpStore->ab1Store + dwOffset,
        lpvData,
        dwDataSize
    );

    return TRUE;
}


BOOL Store_AddData1Byte( LPSTORE lpStore, BYTE1 b1 )
{
    return Store_AddData( lpStore, &b1, sizeof(b1) );
}


BOOL Store_AddData2Byte( LPSTORE lpStore, BYTE2 b2 )
{
    ChangeByteOrder( (LPBYTE1)&b2, sizeof(b2), sizeof(b2) );

    return Store_AddData( lpStore, &b2, sizeof(b2) );
}


BOOL Store_AddData4Byte( LPSTORE lpStore, BYTE4 b4 )
{
    ChangeByteOrder( (LPBYTE1)&b4, sizeof(b4), sizeof(b4) );

    return Store_AddData( lpStore, (LPBYTE1)&b4, sizeof(b4) );
}

BOOL Store_AddDataUuid( LPSTORE lpStore, UUID * puuid )
{
    UUID uuid = *puuid;

    ChangeByteOrder( &uuid.Data1, sizeof(uuid.Data1), sizeof(uuid.Data1) );
    ChangeByteOrder( &uuid.Data2, sizeof(uuid.Data2), sizeof(uuid.Data2) );
    ChangeByteOrder( &uuid.Data3, sizeof(uuid.Data3), sizeof(uuid.Data3) );

    return Store_AddData( lpStore, &uuid, sizeof(UUID) );
}


BOOL Store_AddDataWsz( LPSTORE lpStore, LPWSTR wsz )
{
    INT   nLen = CbWsz( wsz );
    WCHAR wszCopy[MAX_PATH];

    SzCpyW( wszCopy, wsz );

    ChangeByteOrder( (LPBYTE1)wszCopy, sizeof(WCHAR), nLen );

    return Store_AddData( lpStore, wszCopy, nLen );
}


VOID Store_Delete( LPSTORE *lplpStore )
{
    if( lplpStore && *lplpStore )
        {
        MemFree( *lplpStore );
        *lplpStore = 0;
        }
}


VOID ChangeByteOrder( void * pb1, UINT uAtomSize, UINT uDataSize )
{
    LPBYTE1 pb1Src;
    LPBYTE1 pb1Dst;
    BYTE1   b1Temp;
    UINT    uSwaps;

    // 1 byte atoms don't change order
    if( uAtomSize == 1 )
        return;

    // go atom-by-atom, reversing the order of each byte in each atom
    for(
        pb1Src = LPBYTE1(pb1), pb1Dst = LPBYTE1(pb1) + uAtomSize-1;
        pb1Src < LPBYTE1(pb1) + uDataSize;
        pb1Src += uAtomSize-uSwaps, pb1Dst += uAtomSize+uSwaps
    )
    {
        uSwaps = 0;

        while( pb1Src < pb1Dst )
        {
            b1Temp    = *pb1Src;
            *pb1Src++ = *pb1Dst;
            *pb1Dst-- = b1Temp;

            uSwaps++;
        }
    }
}

void
Store_DumpParameter(
    LPSTORE lpStore,
    BYTE1 parm
    )
{
    unsigned Length;
    unsigned Offset = 0;
    char * name;

    switch (parm)
        {
        case OBEX_PARAM_COUNT:      name = "OBEX_PARAM_COUNT";        break;
        case OBEX_PARAM_NAME:       name = "OBEX_PARAM_NAME";         break;
        case OBEX_PARAM_LENGTH:     name = "OBEX_PARAM_LENGTH";       break;
        case OBEX_PARAM_UNIX_TIME:  name = "OBEX_PARAM_UNIX_TIME";    break;
        case OBEX_PARAM_ISO_TIME:   name = "OBEX_PARAM_ISO_TIME";     break;
        case OBEX_PARAM_BODY:       name = "OBEX_PARAM_BODY";         break;
        case OBEX_PARAM_BODY_END:   name = "OBEX_PARAM_BODY_END";     break;
        case OBEX_PARAM_WHO:        name = "OBEX_PARAM_WHO";          break;
        case PRIVATE_PARAM_WIN32_ERROR: name = "private WIN32_ERROR"; break;
        default:                    name = "unknown";                 break;
        }

    DbgLog2(SEV_INFO, "parameter 0x%x (%s):", parm, name);

    switch (parm & OBEX_PARAM_TYPE_MASK)
        {
        case OBEX_PARAM_UNICODE:
        case OBEX_PARAM_STREAM:
            {
            if (lpStore->dwSize - lpStore->dwOutOffset < 2)
                {
                Length = lpStore->dwSize - lpStore->dwOutOffset;
                }
            else
                {
                DbgLog2(SEV_INFO, "length = %x:%x",  lpStore->ab1Store[lpStore->dwOutOffset], lpStore->ab1Store[lpStore->dwOutOffset+1]);

                Length = (lpStore->ab1Store[lpStore->dwOutOffset] << 8) + lpStore->ab1Store[lpStore->dwOutOffset+1];

                Length -= 3; // on-wire length includes opcode and length field themselves
                Offset = 2;
                }
            break;
            }
        case OBEX_PARAM_1BYTE:
            {
            Length = 1;
            break;
            }
        case OBEX_PARAM_4BYTE:
            {
            Length = 4;
            break;
            }
        default:
            {
            DbgLog( SEV_ERROR, "Store_DumpParameter is broken\n");
            return;
            }
        }

    if ((Length+Offset) > lpStore->dwSize - lpStore->dwOutOffset)
        {
        Length = lpStore->dwSize - lpStore->dwOutOffset - Offset;
        }

    const BYTES_PER_LINE = 16;

    unsigned char *p = (unsigned char *) lpStore->ab1Store + lpStore->dwOutOffset + Offset;

    //
    // 3 chars per byte for hex display, plus an extra space every 4 bytes,
    // plus a byte for the printable representation, plus the \0.
    //
    char Outbuf[BYTES_PER_LINE*3+BYTES_PER_LINE/4+BYTES_PER_LINE+1];
    Outbuf[0] = 0;
    Outbuf[sizeof(Outbuf)-1] = 0;
    char * HexDigits = "0123456789abcdef";

    if (Length < 32) {

        unsigned Index;
        for (Offset=0; Offset < Length; Offset++) {

            Index = Offset % BYTES_PER_LINE;

            if (Index == 0) {

                DbgLog1(SEV_INFO, "   %s", Outbuf);
                memset(Outbuf, ' ', sizeof(Outbuf)-1);
            }

            Outbuf[Index*3+Index/4  ] = HexDigits[p[Offset] / 16];
            Outbuf[Index*3+Index/4+1] = HexDigits[p[Offset] % 16];
            Outbuf[BYTES_PER_LINE*3+BYTES_PER_LINE/4+Index] = iscntrl(p[Offset]) ? '.' : p[Offset];
        }

        DbgLog1(SEV_INFO, "   %s", Outbuf);
        DbgLog(SEV_INFO, "");

    }

}