trunk/OpenPGPminidriver/tlv.c

#include <windows.h>

DWORD getTlvSize(__in PBYTE pbPointer, __in PDWORD pdwOffset)
{
        DWORD dwSize;
        switch(*pbPointer)
        {
        case 0x81:
                *pdwOffset+=2;
                dwSize = pbPointer[1];
                break;
        case 0x82:
                *pdwOffset+=3;
                dwSize = pbPointer[1] * 0x100 + pbPointer[2];
                break;
        default:
                dwSize = *pbPointer;
                *pdwOffset+=1;
                break;
        }
        return dwSize;
}

BOOL find_tlv(__in PBYTE pbData, __in  DWORD dwTlvSearched, __in DWORD dwTotalSize, __out PBYTE *pbDataOut, __out_opt PDWORD pdwSize)
{
        DWORD dwOffset = 0, dwTlv ;
        DWORD dwSize;
        BOOL bFound = FALSE;
        while (dwOffset < dwTotalSize)
        {
                // check the tlv
                // if it begins with 0x5F => tlv of 2 bytes.
                // else 1 byte
                dwTlv = 0;
                if (pbData[dwOffset] == 0x5F)
                {
                        dwTlv = pbData[dwOffset] * 0x100;
                        dwOffset++;
                }
                dwTlv += pbData[dwOffset];
                dwOffset++;
                

                if (dwTlv == dwTlvSearched)
                {
                        // size sequence
                        dwSize = getTlvSize(pbData + dwOffset,&dwOffset);
                        if (pdwSize)
                        {
                                *pdwSize = dwSize;
                        }
                        *pbDataOut = pbData + dwOffset;
                        return TRUE;
                }
                else
                {
                        dwSize = getTlvSize(pbData + dwOffset,&dwOffset);
                        if (dwTlv != 0x73)
                        {
                                dwOffset += dwSize;
                        }
                }
        }
        return FALSE;
}
1	#include <windows.h>
2
3	DWORD getTlvSize(__in PBYTE pbPointer, __in PDWORD pdwOffset)
4	{
5	DWORD dwSize;
6	switch(*pbPointer)
7	{
8	case 0x81:
9	*pdwOffset+=2;
10	dwSize = pbPointer[1];
11	break;
12	case 0x82:
13	*pdwOffset+=3;
14	dwSize = pbPointer[1] * 0x100 + pbPointer[2];
15	break;
16	default:
17	dwSize = *pbPointer;
18	*pdwOffset+=1;
19	break;
20	}
21	return dwSize;
22	}
23
24	BOOL find_tlv(__in PBYTE pbData, __in DWORD dwTlvSearched, __in DWORD dwTotalSize, __out PBYTE *pbDataOut, __out_opt PDWORD pdwSize)
25	{
26	DWORD dwOffset = 0, dwTlv ;
27	DWORD dwSize;
28	BOOL bFound = FALSE;
29	while (dwOffset < dwTotalSize)
30	{
31	// check the tlv
32	// if it begins with 0x5F => tlv of 2 bytes.
33	// else 1 byte
34	dwTlv = 0;
35	if (pbData[dwOffset] == 0x5F)
36	{
37	dwTlv = pbData[dwOffset] * 0x100;
38	dwOffset++;
39	}
40	dwTlv += pbData[dwOffset];
41	dwOffset++;
42
43
44	if (dwTlv == dwTlvSearched)
45	{
46	// size sequence
47	dwSize = getTlvSize(pbData + dwOffset,&dwOffset);
48	if (pdwSize)
49	{
50	*pdwSize = dwSize;
51	}
52	*pbDataOut = pbData + dwOffset;
53	return TRUE;
54	}
55	else
56	{
57	dwSize = getTlvSize(pbData + dwOffset,&dwOffset);
58	if (dwTlv != 0x73)
59	{
60	dwOffset += dwSize;
61	}
62	}
63	}
64	return FALSE;
65	}