-
Notifications
You must be signed in to change notification settings - Fork 6
/
Copy pathp11proxy.c
111 lines (105 loc) · 2.96 KB
/
p11proxy.c
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
/* Benjamin DELPY `gentilkiwi`
http://blog.gentilkiwi.com
Licence : https://creativecommons.org/licenses/by/4.0/
*/
#include "p11proxy.h"
static CK_FUNCTION_LIST funcList;
static CK_FUNCTION_LIST_PTR funcListPtr = &funcList;
CK_RV CK_CALL_SPEC HOOK_C_GetFunctionList(CK_FUNCTION_LIST_PTR_PTR ppFunctionList)
{
CK_RV rv;
CK_FUNCTION_LIST_PTR ptr;
rv = C_GetFunctionList(&ptr);
if(rv == CKR_OK)
{
funcList = *ptr;
funcList.C_GetFunctionList = HOOK_C_GetFunctionList;
funcList.C_InitToken = HOOK_C_InitToken;
funcList.C_Login = HOOK_C_Login;
funcList.C_SetPIN = HOOK_C_SetPIN;
*ppFunctionList = funcListPtr;
}
return rv;
}
CK_RV CK_CALL_SPEC HOOK_C_InitToken(CK_SLOT_ID slotID, CK_UTF8CHAR_PTR pPin, CK_ULONG ulPinLen, CK_UTF8CHAR_PTR pLabel)
{
CK_RV rv;
CK_BYTE_PTR puk;
CK_ULONG pukLen;
rv = AdaptPukToValidPuk(pPin, ulPinLen, &puk, &pukLen);
if(rv == CKR_OK)
{
rv = C_InitToken(slotID, puk, pukLen, pLabel);
FreeValidPuk(puk);
}
return rv;
}
CK_RV CK_CALL_SPEC HOOK_C_Login(CK_SESSION_HANDLE hSession, CK_USER_TYPE userType, CK_UTF8CHAR_PTR pPin, CK_ULONG ulPinLen)
{
CK_RV rv;
CK_BYTE_PTR puk;
CK_ULONG pukLen;
if(userType != CKU_SO)
rv = C_Login(hSession, userType, pPin, ulPinLen);
else
{
rv = AdaptPukToValidPuk(pPin, ulPinLen, &puk, &pukLen);
if(rv == CKR_OK)
{
rv = C_Login(hSession, userType, puk, pukLen);
FreeValidPuk(puk);
}
}
return rv;
}
CK_RV CK_CALL_SPEC HOOK_C_SetPIN(CK_SESSION_HANDLE hSession, CK_UTF8CHAR_PTR pOldPin, CK_ULONG ulOldLen, CK_UTF8CHAR_PTR pNewPin, CK_ULONG ulNewLen)
{
CK_RV rv;
CK_SESSION_INFO info;
CK_BYTE_PTR oldPuk, newPuk;
CK_ULONG oldPukLen, newPukLen;
rv = C_GetSessionInfo(hSession, &info);
if(rv == CKR_OK)
{
if(info.state != CKS_RW_SO_FUNCTIONS)
rv = C_SetPIN(hSession, pOldPin, ulOldLen, pNewPin, ulNewLen);
else
{
rv = AdaptPukToValidPuk(pOldPin, ulOldLen, &oldPuk, &oldPukLen);
if(rv == CKR_OK)
{
rv = AdaptPukToValidPuk(pNewPin, ulNewLen, &newPuk, &newPukLen);
if(rv == CKR_OK)
{
rv = C_SetPIN(hSession, oldPuk, oldPukLen, newPuk, newPukLen);
FreeValidPuk(newPuk);
}
FreeValidPuk(oldPuk);
}
}
}
return rv;
}
CK_RV AdaptPukToValidPuk(CK_UTF8CHAR_PTR pPuk, CK_ULONG ulPukLen, CK_UTF8CHAR_PTR *ppValidPuk, CK_ULONG *pulValidPukLen)
{
CK_RV status = CKR_OK;
*ppValidPuk = NULL;
*pulValidPukLen = 0;
if(pPuk && ulPukLen)
{
*pulValidPukLen = max(ulPukLen, 24);
if(*ppValidPuk = (CK_UTF8CHAR_PTR) LocalAlloc(LPTR, *pulValidPukLen)) // 0x00 inside
{
if(!(((ulPukLen == sizeof(ULONG)) && (*((PULONG) pPuk) == '0000')) || ((ulPukLen == sizeof(ULONGLONG)) && (*((PULONGLONG) pPuk) == 0x3030303030303030)))) // keep 24*0x00
RtlCopyMemory(*ppValidPuk, pPuk, ulPukLen);
}
else status = CKR_HOST_MEMORY;
}
return status;
}
void FreeValidPuk(CK_UTF8CHAR_PTR pValidPuk)
{
if(pValidPuk)
LocalFree(pValidPuk);
}