PAM module works
[pam_pcsc_cr.git] / pcsc_cr.c
1 #ifdef HAVE_CONFIG_H
2 # include "config.h"
3 #endif
4 #include <stdio.h>
5 #include <string.h>
6 #include <alloca.h>
7 #include "token.h"
8 #include <reader.h>
9
10 extern struct token_interface ykneo_interface;
11
12 static struct token_interface *types[] = {
13         &ykneo_interface,
14         NULL,
15 };
16
17 SCARD_IO_REQUEST pioSendPci;
18
19 static LONG find_hb(BYTE *atr, DWORD atrsize, BYTE **hb, LPDWORD hbsize)
20 {
21         int i, j, cont;
22         if (atrsize < 2) return SCARD_W_UNSUPPORTED_CARD;
23         switch (atr[0]) {
24         case 0x3B: break;
25         case 0x3F: break;
26         default: return SCARD_W_UNSUPPORTED_CARD;
27         }
28         *hbsize = atr[1]&0x0f;
29         i=1;
30         do {
31                 cont = atr[i]>>4;
32                 for (j = 0; j < 4; j++) if (cont & (0x01 << j)) i++;
33         } while ((cont & 0x08) && (i < atrsize));
34         if ((i + (*hbsize) + 2) != atrsize)
35                 return SCARD_W_UNSUPPORTED_CARD;
36         *hb = atr + i + 1;
37         return SCARD_S_SUCCESS;
38 }
39
40 long pcsc_cr(const unsigned char *chal, const int csize,
41                 unsigned char *resp, int *rsize)
42 {
43         struct token_interface *type;
44         LONG rc;
45         SCARDCONTEXT hContext;
46         LPTSTR readers, rdr;
47         SCARDHANDLE hCard;
48         DWORD nrdrs = SCARD_AUTOALLOCATE, activeproto;
49         BYTE atr[33];
50         DWORD atrsize;
51         BYTE *hb;
52         DWORD hbsize;
53         DWORD lrsize;
54         int i;
55
56         rc = SCardEstablishContext(SCARD_SCOPE_SYSTEM, NULL, NULL, &hContext);
57         if (rc) return rc;
58         rc = SCardListReaders(hContext, NULL, (LPTSTR)&readers, &nrdrs);
59         if (rc) return rc;
60         for (rdr=readers; rdr < readers + nrdrs - 1; rdr += strlen(rdr) + 1) {
61                 rc = SCardConnect(hContext, rdr, SCARD_SHARE_SHARED,
62                         SCARD_PROTOCOL_T0 | SCARD_PROTOCOL_T1,
63                         &hCard, &activeproto);
64                 if (rc) continue;
65                 switch (activeproto) {
66                 case SCARD_PROTOCOL_T0:
67                         pioSendPci = *SCARD_PCI_T0;
68                         break;
69                 case SCARD_PROTOCOL_T1:
70                         pioSendPci = *SCARD_PCI_T1;
71                         break;
72                 }
73                 atrsize = sizeof(atr);
74                 rc = SCardGetAttrib(hCard, SCARD_ATTR_ATR_STRING,
75                         atr, &atrsize);
76                 if (rc) goto disconnect;
77                 rc = find_hb(atr, atrsize, &hb, &hbsize);
78                 if (rc) goto disconnect;
79                 for (i = 0; types[i]; i++) {
80                         type = types[i];
81                         rc = type->check_atr_hb(hb, hbsize);
82                         if (rc == 0) break;
83                 }
84                 if (rc) goto disconnect;
85                 rc = type->prologue(hCard);
86                 if (rc == 0) break;
87         disconnect:
88                 (void)SCardDisconnect(hCard, SCARD_LEAVE_CARD);
89         }
90         if (rc) goto free_out;
91 #if 0
92         char serial[16];
93         memset(serial, 'z', sizeof(serial));
94         serial[sizeof(serial) - 1] - '\0';
95         lrsize = sizeof(serial);
96         rc = type->getserial(hCard, &serial, &lrsize);
97         if (rc) goto disc_free_out;
98         printf("Serial is %s\n", serial);
99 #endif
100         lrsize = *rsize;
101         rc = type->trancieve(hCard, (BYTE*)chal, csize, resp, &lrsize);
102         if (rc) goto disc_free_out;
103         *rsize = lrsize;
104         rc = type->epilogue(hCard);
105 disc_free_out:
106         (void)SCardDisconnect(hCard, SCARD_EJECT_CARD);
107 free_out:
108         (void)SCardFreeMemory(hContext, readers);
109         return rc;
110 }
111
112 char *pcsc_errstr(long err) {
113         return pcsc_stringify_error(err);
114 }
115
116 int pcsc_option(const char *option)
117 {
118         char *name, *key, *val;
119         int i, rc = -1;
120         struct token_interface *type;
121
122         name=(char *)alloca(strlen(option)+1);
123         strcpy(name, option);
124         if ((key = strchr(name, ':'))) *(key++) = '\0';
125         else return -1;
126         if ((val = strchr(key, '='))) *(val++) = '\0';
127         else return -1;
128         if (*val == '\0') return -1;
129         for (i = 0; types[i]; i++) {
130                 type = types[i];
131                 if (!strcmp(type->name,name)) {
132                         rc = type->parse_option(key, val);
133                         break;
134                 }
135         }
136         return rc;
137 }