#include <stdio.h>
#include "winscard.h"

#define MAXIMUM_READERS  4

SCARDCONTEXT		hContext;
SCARDHANDLE			hCard;
SCARD_IO_REQUEST	ioRequest;
SCARD_READERSTATE	ReaderState[MAXIMUM_READERS];
DWORD				hProtocol;

WORD APDU(BYTE cla, BYTE ins, BYTE p1, BYTE p2, BYTE lc, BYTE le, BYTE *data) 
{
	DWORD cLength, rLength, i, Sc;
	BYTE cAPDU[100], rAPDU[100];
    	
	cAPDU[0] = cla;
	cAPDU[1] = ins;
	cAPDU[2] = p1;
	cAPDU[3] = p2;
	cAPDU[4] = (lc > 0) ? lc : le;

	printf("APDU Command:\t%02X %02X %02X %02X %02X", cAPDU[0],cAPDU[1],cAPDU[2],cAPDU[3],(lc > 0) ? lc : le);
	if (lc)
		{
		for (i = 0; i < lc; i++)
			{
			cAPDU[5+i] = data[i];
			printf(" %02X", data[i]);
			}
		cLength = 5+lc;
		}
	else
		cLength = 5;
	printf("\n");

	rLength = sizeof(rAPDU);

	Sc = SCardTransmit(hCard, SCARD_PCI_T0, cAPDU, cLength, &ioRequest, rAPDU, &rLength);
	printf("SCardTransmit() %s\n",(Sc == SCARD_S_SUCCESS)?"OK":"Failed");
	if (rLength)
		{
		printf("APDU Response:\t");
		for (i = 0; i < rLength; i++)
			{
			printf(" %02X", rAPDU[i]);
			}
		printf("\n");
		}
	return(MAKEWORD(rAPDU[rLength-1], rAPDU[rLength-2]));
}

// Main function
int main(int argc, char* argv[])
{
	DWORD Sc, IFDsLen;
	LPSTR df = "\x01\x00"; 
	LPSTR csn = NULL;
	WORD SW;
	LPSTR 	lpstrRdr, lpstrReader;
	DWORD 	dwIndex=0;
	DWORD  i = 0;

    Sc = SCardEstablishContext(SCARD_SCOPE_SYSTEM, 0, 0, &hContext);
	printf("SCardEstablishContext() %s\n",(Sc == SCARD_S_SUCCESS)?"OK":"Failed");
	
	Sc = SCardListReaders(hContext,NULL,NULL,&IFDsLen);

	if (Sc == SCARD_S_SUCCESS)
		{
		// Now, allocate memory for the list and get it
		lpstrRdr = malloc(IFDsLen);
		memset(lpstrRdr,0,IFDsLen);

		Sc = SCardListReaders(hContext,NULL,lpstrRdr,&IFDsLen);
		printf("Readers list\n");
		lpstrReader = lpstrRdr;
		do 	{
			printf("\t%d - %s\n", i, lpstrReader);
			dwIndex = strlen(lpstrReader);
			if(i<MAXIMUM_READERS)
				{
				ReaderState[i].szReader = lpstrReader;
				ReaderState[i].dwCurrentState = SCARD_STATE_UNAWARE;
				}
			i++;
			lpstrReader += dwIndex + 1;
			} while( *lpstrReader != '\0');

		printf("\n");
		}
	//
	Sc = SCardConnect(hContext,ReaderState[0].szReader,SCARD_SHARE_DIRECT,SCARD_PROTOCOL_T0,&hCard,&hProtocol);
	printf("SCardConnect() %s\n",(Sc == SCARD_S_SUCCESS)?"OK":"Failed");
	memcpy(&ioRequest, SCARD_PCI_T0, sizeof(ioRequest));

	// Select DF 01 00
	SW = APDU(0x00, 0xA4, 0x01, 0x0C, 0x02, 0x00, df);
	// Read EF 01 01 (CSN)
	SW = APDU(0x00, 0xB0, 0x81, 0x00, 0x00, 0x08, csn);
	// Disconnect from the card
	Sc = SCardDisconnect(hCard, SCARD_LEAVE_CARD);
	Sc = SCardReleaseContext(hContext);
}
