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 }