450e6a81ab
git-svn-id: https://vsmartcard.svn.sourceforge.net/svnroot/vsmartcard@20 96b47cad-a561-4643-ad3b-153ac7d7599c
906 lines
33 KiB
C
906 lines
33 KiB
C
#include <winscard.h>
|
||
#include <stdint.h>
|
||
#include <string.h>
|
||
#include <stdlib.h>
|
||
#include <stdio.h>
|
||
#include <asm/byteorder.h>
|
||
|
||
#include "ccid.h"
|
||
|
||
|
||
SCARDCONTEXT hcontext = 0;
|
||
SCARDHANDLE hcard = 0;
|
||
SCARD_READERSTATE rstate;
|
||
DWORD dwActiveProtocol;
|
||
char reader_name[MAX_READERNAME];
|
||
int reader_num;
|
||
|
||
char* perform_initialization(int num)
|
||
{
|
||
char *readers, *str;
|
||
DWORD size;
|
||
LONG r;
|
||
|
||
reader_num = num;
|
||
r = SCardEstablishContext(SCARD_SCOPE_SYSTEM, NULL, NULL, &hcontext);
|
||
if (r != SCARD_S_SUCCESS) {
|
||
fprintf(stderr, "pc/sc error: %s\n", pcsc_stringify_error(r));
|
||
SCardReleaseContext(hcontext);
|
||
return NULL;
|
||
}
|
||
r = SCardListReaders(hcontext, NULL, NULL, &size);
|
||
if (size == 0)
|
||
r = SCARD_E_UNKNOWN_READER;
|
||
if (r != SCARD_S_SUCCESS) {
|
||
fprintf(stderr, "pc/sc error: %s\n", pcsc_stringify_error(r));
|
||
SCardReleaseContext(hcontext);
|
||
return NULL;
|
||
}
|
||
|
||
/* get all readers */
|
||
readers = (char *) malloc(size);
|
||
if (readers == NULL) {
|
||
fprintf(stderr, "pc/sc error: %s\n",
|
||
pcsc_stringify_error(SCARD_E_NO_MEMORY));
|
||
SCardReleaseContext(hcontext);
|
||
return NULL;
|
||
}
|
||
r = SCardListReaders(hcontext, NULL, readers, &size);
|
||
if (r != SCARD_S_SUCCESS) {
|
||
free(readers);
|
||
fprintf(stderr, "pc/sc error: %s\n", pcsc_stringify_error(r));
|
||
SCardReleaseContext(hcontext);
|
||
return NULL;
|
||
}
|
||
|
||
/* name of reader number num */
|
||
str = readers;
|
||
for (size = 0; size < num; size++) {
|
||
/* go to the next name */
|
||
str += strlen(str) + 1;
|
||
|
||
/* no more readers available? */
|
||
if (strlen(str) == 0) {
|
||
free(readers);
|
||
fprintf(stderr, "pc/sc error: %s\n",
|
||
pcsc_stringify_error(SCARD_E_UNKNOWN_READER));
|
||
SCardReleaseContext(hcontext);
|
||
return NULL;
|
||
}
|
||
}
|
||
strncpy(reader_name, str, MAX_READERNAME);
|
||
free(readers);
|
||
|
||
rstate.dwCurrentState = SCARD_STATE_UNAWARE;
|
||
rstate.dwEventState = SCARD_STATE_UNAWARE;
|
||
rstate.szReader = reader_name;
|
||
|
||
return reader_name;
|
||
}
|
||
|
||
|
||
int perform_shutdown()
|
||
{
|
||
SCardDisconnect(hcard, SCARD_UNPOWER_CARD);
|
||
hcard = 0;
|
||
rstate.dwCurrentState = SCARD_STATE_UNAWARE;
|
||
rstate.dwEventState = SCARD_STATE_UNAWARE;
|
||
return SCardReleaseContext(hcontext);
|
||
}
|
||
|
||
__u8 get_bError(LONG pcsc_result)
|
||
{
|
||
switch (pcsc_result) {
|
||
case SCARD_S_SUCCESS : /**< No error was encountered. */
|
||
// Command not supported
|
||
return 0;
|
||
case SCARD_E_CANCELLED : /**< The action was cancelled by an SCardCancel request. */
|
||
fprintf(stderr, "CMD_ABORTED\n");
|
||
return 0xFF;
|
||
case SCARD_E_INVALID_HANDLE : /**< The supplied handle was invalid. */
|
||
case SCARD_E_NO_SMARTCARD : /**< The operation requires a Smart Card, but no Smart Card is currently in the device. */
|
||
case SCARD_E_UNKNOWN_CARD : /**< The specified smart card name is not recognized. */
|
||
case SCARD_E_NOT_READY : /**< The reader or smart card is not ready to accept commands. */
|
||
case SCARD_W_UNRESPONSIVE_CARD : /**< The smart card is not responding to a reset. */
|
||
case SCARD_W_UNPOWERED_CARD : /**< Power has been removed from the smart card, so that further communication is not possible. */
|
||
case SCARD_W_REMOVED_CARD : /**< The smart card has been removed, so further communication is not possible. */
|
||
fprintf(stderr, "ICC_MUTE\n");
|
||
return 0xFE;
|
||
case SCARD_E_SHARING_VIOLATION : /**< The smart card cannot be accessed because of other connections outstanding. */
|
||
fprintf(stderr, "CMD_SLOT_BUSY\n");
|
||
return 0xE0;
|
||
case SCARD_E_PROTO_MISMATCH : /**< The requested protocols are incompatible with the protocol currently in use with the smart card. */
|
||
fprintf(stderr, "ICC_PROTOCOL_NOT_SUPPORTED\n");
|
||
return 0xF6;
|
||
// case SCARD_F_INTERNAL_ERROR : /**< An internal consistency check failed. */
|
||
// case SCARD_E_INVALID_PARAMETER : /**< One or more of the supplied parameters could not be properly interpreted. */
|
||
// case SCARD_E_INVALID_TARGET : /**< Registry startup information is missing or invalid. */
|
||
// case SCARD_E_NO_MEMORY : /**< Not enough memory available to complete this command. */
|
||
// case SCARD_F_WAITED_TOO_LONG : /**< An internal consistency timer has expired. */
|
||
// case SCARD_E_INSUFFICIENT_BUFFER : /**< The data buffer to receive returned data is too small for the returned data. */
|
||
// case SCARD_E_UNKNOWN_READER : /**< The specified reader name is not recognized. */
|
||
// case SCARD_E_TIMEOUT : /**< The user-specified timeout value has expired. */
|
||
// case SCARD_E_CANT_DISPOSE : /**< The system could not dispose of the media in the requested manner. */
|
||
// case SCARD_E_INVALID_VALUE : /**< One or more of the supplied parameters values could not be properly interpreted. */
|
||
// case SCARD_E_SYSTEM_CANCELLED : /**< The action was cancelled by the system, presumably to log off or shut down. */
|
||
// case SCARD_F_COMM_ERROR : /**< An internal communications error has been detected. */
|
||
// case SCARD_F_UNKNOWN_ERROR : /**< An internal error has been detected, but the source is unknown. */
|
||
// case SCARD_E_INVALID_ATR : /**< An ATR obtained from the registry is not a valid ATR string. */
|
||
// case SCARD_E_NOT_TRANSACTED : /**< An attempt was made to end a non-existent transaction. */
|
||
// case SCARD_E_READER_UNAVAILABLE : /**< The specified reader is not currently available for use. */
|
||
// case SCARD_W_UNSUPPORTED_CARD : /**< The reader cannot communicate with the card, due to ATR string configuration conflicts. */
|
||
// case SCARD_W_RESET_CARD : /**< The smart card has been reset, so any shared state information is invalid. */
|
||
// case SCARD_E_PCI_TOO_SMALL : /**< The PCI Receive buffer was too small. */
|
||
// case SCARD_E_READER_UNSUPPORTED : /**< The reader driver does not meet minimal requirements for support. */
|
||
// case SCARD_E_DUPLICATE_READER : /**< The reader driver did not produce a unique reader name. */
|
||
// case SCARD_E_CARD_UNSUPPORTED : /**< The smart card does not meet minimal requirements for support. */
|
||
// case SCARD_E_NO_SERVICE : /**< The Smart card resource manager is not running. */
|
||
// case SCARD_E_SERVICE_STOPPED : /**< The Smart card resource manager has shut down. */
|
||
// case SCARD_E_NO_READERS_AVAILABLE : /**< Cannot find a smart card reader. */
|
||
default:
|
||
fprintf(stderr, "HW_ERROR\n");
|
||
return 0xFB;
|
||
}
|
||
}
|
||
|
||
__u8 get_bStatus(LONG pcsc_result)
|
||
{
|
||
__u8 bStatus = 0;
|
||
|
||
if (rstate.dwEventState & SCARD_STATE_PRESENT) {
|
||
if (rstate.dwEventState & SCARD_STATE_MUTE ||
|
||
rstate.dwEventState & SCARD_STATE_UNPOWERED) {
|
||
// inactive
|
||
fprintf(stderr, "card inactive\n");
|
||
bStatus = 1;
|
||
} else {
|
||
// active
|
||
/*fprintf(stderr, "card active\n");*/
|
||
bStatus = 0;
|
||
}
|
||
} else {
|
||
// absent
|
||
/*fprintf(stderr, "card absent\n");*/
|
||
bStatus = 2;
|
||
if (hcard != 0) {
|
||
pcsc_result = SCardDisconnect(hcard, SCARD_UNPOWER_CARD);
|
||
hcard = 0;
|
||
}
|
||
}
|
||
|
||
if (pcsc_result != SCARD_S_SUCCESS) {
|
||
bStatus |= (1<<6);
|
||
fprintf(stderr, "pc/sc error: %s\n", pcsc_stringify_error(pcsc_result));
|
||
}
|
||
|
||
return bStatus;
|
||
}
|
||
|
||
RDR_to_PC_SlotStatus_t get_RDR_to_PC_SlotStatus(__u8 bSlot, __u8 bSeq,
|
||
LONG pcsc_result)
|
||
{
|
||
RDR_to_PC_SlotStatus_t result;
|
||
|
||
result.bMessageType = 0x81;
|
||
result.dwLength = __constant_cpu_to_le32(0);
|
||
result.bSlot = bSlot;
|
||
result.bSeq = bSeq;
|
||
result.bStatus = get_bStatus(pcsc_result);
|
||
result.bError = get_bError(pcsc_result);
|
||
result.bClockStatus = 0;
|
||
|
||
return result;
|
||
}
|
||
|
||
RDR_to_PC_DataBlock_t get_RDR_to_PC_DataBlock(__u8 bSlot, __u8 bSeq,
|
||
LONG pcsc_result, __le32 dwLength)
|
||
{
|
||
RDR_to_PC_DataBlock_t result;
|
||
|
||
result.bMessageType = 0x80;
|
||
result.dwLength = dwLength;
|
||
result.bSlot = bSlot;
|
||
result.bSeq = bSeq;
|
||
result.bStatus = get_bStatus(pcsc_result);
|
||
result.bError = get_bError(pcsc_result);
|
||
result.bChainParameter = 0;
|
||
|
||
return result;
|
||
}
|
||
|
||
RDR_to_PC_SlotStatus_t
|
||
perform_PC_to_RDR_GetSlotStatus(const PC_to_RDR_GetSlotStatus_t request)
|
||
{
|
||
if ( request.bMessageType != 0x65 ||
|
||
request.dwLength != __constant_cpu_to_le32(0) ||
|
||
request.bSlot != 0 ||
|
||
request.abRFU1 != 0 ||
|
||
request.abRFU2 != 0)
|
||
fprintf(stderr, "warning: malformed PC_to_RDR_GetSlotStatus\n");
|
||
|
||
return get_RDR_to_PC_SlotStatus(request.bSlot, request.bSeq,
|
||
SCardGetStatusChange(hcontext, 1, &rstate, 1));
|
||
}
|
||
|
||
RDR_to_PC_SlotStatus_t
|
||
perform_PC_to_RDR_IccPowerOn(const PC_to_RDR_IccPowerOn_t request, char ** pATR)
|
||
{
|
||
if ( request.bMessageType != 0x62 ||
|
||
request.dwLength != __constant_cpu_to_le32(0) ||
|
||
request.bSlot != 0 ||
|
||
!( request.bPowerSelect == 0 ||
|
||
request.bPowerSelect & ccid_desc.bVoltageSupport ) ||
|
||
request.abRFU != 0)
|
||
fprintf(stderr, "warning: malformed PC_to_RDR_IccPowerOn\n");
|
||
|
||
LONG pcsc_result;
|
||
if (hcard) {
|
||
pcsc_result = SCardReconnect(hcard, SCARD_SHARE_EXCLUSIVE,
|
||
SCARD_PROTOCOL_T0|SCARD_PROTOCOL_T1, SCARD_LEAVE_CARD,
|
||
&dwActiveProtocol);
|
||
} else {
|
||
pcsc_result = SCardConnect(hcontext, reader_name,
|
||
SCARD_SHARE_EXCLUSIVE, SCARD_PROTOCOL_T0|SCARD_PROTOCOL_T1,
|
||
&hcard, &dwActiveProtocol);
|
||
}
|
||
if (pcsc_result == SCARD_S_SUCCESS)
|
||
pcsc_result = SCardGetStatusChange(hcontext, 1, &rstate, 1);
|
||
|
||
RDR_to_PC_SlotStatus_t result = get_RDR_to_PC_SlotStatus(request.bSlot,
|
||
request.bSeq, pcsc_result);
|
||
|
||
if (pcsc_result != SCARD_S_SUCCESS) {
|
||
*pATR = NULL;
|
||
result.dwLength = __constant_cpu_to_le32(0);
|
||
} else {
|
||
*pATR = (char*) rstate.rgbAtr;
|
||
result.dwLength = __cpu_to_le32(rstate.cbAtr);
|
||
}
|
||
|
||
return result;
|
||
}
|
||
RDR_to_PC_SlotStatus_t
|
||
perform_PC_to_RDR_IccPowerOff(const PC_to_RDR_IccPowerOff_t request)
|
||
{
|
||
if ( request.bMessageType != 0x63 ||
|
||
request.dwLength != __constant_cpu_to_le32(0) ||
|
||
request.bSlot != 0 ||
|
||
request.abRFU1 != 0 ||
|
||
request.abRFU2 != 0)
|
||
fprintf(stderr, "warning: malformed PC_to_RDR_IccPowerOff\n");
|
||
|
||
LONG result = SCardDisconnect(hcard, SCARD_UNPOWER_CARD);
|
||
hcard = 0;
|
||
if (result == SCARD_E_INVALID_HANDLE) {
|
||
result = SCardGetStatusChange(hcontext, 1, &rstate, 1);
|
||
}
|
||
|
||
return get_RDR_to_PC_SlotStatus(request.bSlot, request.bSeq, result);
|
||
}
|
||
|
||
RDR_to_PC_DataBlock_t
|
||
perform_PC_to_RDR_XfrBlock(const PC_to_RDR_XfrBlock_t request, const __u8*
|
||
abDataIn, __u8** abDataOut)
|
||
{
|
||
if ( request.bMessageType != 0x6F ||
|
||
request.bSlot != 0 ||
|
||
request.bBWI != 0)
|
||
fprintf(stderr, "warning: malformed PC_to_RDR_XfrBlock\n");
|
||
|
||
DWORD dwRecvLength = MAX_BUFFER_SIZE;
|
||
*abDataOut = (__u8 *) malloc(dwRecvLength);
|
||
if (*abDataOut == NULL) {
|
||
return get_RDR_to_PC_DataBlock(request.bSlot, request.bSeq,
|
||
SCARD_E_NO_MEMORY, __constant_cpu_to_le32(0));
|
||
}
|
||
|
||
LPCSCARD_IO_REQUEST pioSendPci;
|
||
if (dwActiveProtocol == SCARD_PROTOCOL_T0)
|
||
pioSendPci = SCARD_PCI_T0;
|
||
else
|
||
pioSendPci = SCARD_PCI_T1;
|
||
int pcsc_result = SCardTransmit(hcard, pioSendPci, abDataIn,
|
||
__le32_to_cpu(request.dwLength), NULL, *abDataOut, &dwRecvLength);
|
||
|
||
return get_RDR_to_PC_DataBlock(request.bSlot, request.bSeq,
|
||
pcsc_result, __cpu_to_le32(dwRecvLength));
|
||
}
|
||
|
||
|
||
RDR_to_PC_Parameters_t
|
||
get_RDR_to_PC_Parameters(__u8 bSlot, __u8 bSeq, LONG pcsc_result, __u8
|
||
**abProtocolDataStructure)
|
||
{
|
||
RDR_to_PC_Parameters_t result;
|
||
|
||
result.bMessageType = 0x82;
|
||
result.bSlot = bSlot;
|
||
result.bSeq = bSeq;
|
||
if (pcsc_result == SCARD_S_SUCCESS) {
|
||
if (dwActiveProtocol == SCARD_PROTOCOL_T0) {
|
||
result.bProtocolNum = 0;
|
||
*abProtocolDataStructure = (__u8 *) malloc(sizeof
|
||
(abProtocolDataStructure_T0_t));
|
||
if (*abProtocolDataStructure) {
|
||
fprintf (stderr, "T0\n");
|
||
result.dwLength = __constant_cpu_to_le32(sizeof
|
||
(abProtocolDataStructure_T0_t));
|
||
abProtocolDataStructure_T0_t * t0 =
|
||
*(abProtocolDataStructure_T0_t**) abProtocolDataStructure;
|
||
/* values taken from ISO 7816-3 defaults
|
||
* FIXME analyze ATR to get values */
|
||
t0->bmFindexDindex = 1<<4| // index to table 7 ISO 7816-3 (Fi)
|
||
1; // index to table 8 ISO 7816-3 (Di)
|
||
t0->bmTCCKST0 = 0<<1; // convention (direct)
|
||
t0->bGuardTimeT0 = 0xFF;
|
||
t0->bWaitingIntegerT0 = 0x10;
|
||
t0->bClockStop = 0; // (not allowed)
|
||
} else {
|
||
// error malloc
|
||
result.dwLength = __constant_cpu_to_le32(0);
|
||
*abProtocolDataStructure = NULL;
|
||
pcsc_result = SCARD_E_INSUFFICIENT_BUFFER;
|
||
}
|
||
} else {
|
||
result.bProtocolNum = 1;
|
||
*abProtocolDataStructure = (__u8 *) malloc(sizeof
|
||
(abProtocolDataStructure_T1_t));
|
||
if (*abProtocolDataStructure) {
|
||
fprintf (stderr, "T1\n");
|
||
result.dwLength = __constant_cpu_to_le32(sizeof
|
||
(abProtocolDataStructure_T1_t));
|
||
abProtocolDataStructure_T1_t * t1 =
|
||
*(abProtocolDataStructure_T1_t**) abProtocolDataStructure;
|
||
/* values taken from OpenPGP-card
|
||
* FIXME analyze ATR to get values */
|
||
t1->bmFindexDindex = 1<<4| // index to table 7 ISO 7816-3 (Fi)
|
||
3; // index to table 8 ISO 7816-3 (Di)
|
||
t1->bmTCCKST1 = 0| // checksum type (CRC)
|
||
0<<1| // convention (direct)
|
||
0x10;
|
||
t1->bGuardTimeT1 = 0xFF;
|
||
t1->bWaitingIntegersT1 = 4<<4| // BWI
|
||
5; // CWI
|
||
t1->bClockStop = 0; // (not allowed)
|
||
t1->bIFSC = 0x80;
|
||
t1->bNadValue = 0; // see 7816-3 9.4.2.1 (only default value)
|
||
} else {
|
||
// error malloc
|
||
result.dwLength = __constant_cpu_to_le32(0);
|
||
*abProtocolDataStructure = NULL;
|
||
pcsc_result = SCARD_E_INSUFFICIENT_BUFFER;
|
||
}
|
||
}
|
||
} else {
|
||
result.dwLength = __constant_cpu_to_le32(0);
|
||
*abProtocolDataStructure = NULL;
|
||
}
|
||
result.bStatus = get_bStatus(pcsc_result);
|
||
result.bError = get_bError(pcsc_result);
|
||
|
||
return result;
|
||
}
|
||
|
||
RDR_to_PC_Parameters_t
|
||
perform_PC_to_RDR_GetParamters(const PC_to_RDR_GetParameters_t request,
|
||
__u8** abProtocolDataStructure)
|
||
{
|
||
if ( request.bMessageType != 0x6C ||
|
||
request.dwLength != __constant_cpu_to_le32(0) ||
|
||
request.bSlot != 0)
|
||
fprintf(stderr, "warning: malformed PC_to_RDR_GetParamters\n");
|
||
|
||
LONG pcsc_result = SCardReconnect(hcard, SCARD_SHARE_EXCLUSIVE,
|
||
SCARD_PROTOCOL_T0|SCARD_PROTOCOL_T1, SCARD_LEAVE_CARD,
|
||
&dwActiveProtocol);
|
||
|
||
return get_RDR_to_PC_Parameters(request.bSlot, request.bSeq,
|
||
pcsc_result, abProtocolDataStructure);
|
||
}
|
||
|
||
RDR_to_PC_DataBlock_t
|
||
perform_PC_to_RDR_Secure(const PC_to_RDR_Secure_t request,
|
||
const __u8* abData, __u8** abDataOut)
|
||
{
|
||
/* only short APDUs supported so Lc is always the fiths byte */
|
||
if ( request.bMessageType != 0x69 ||
|
||
request.bSlot != 0)
|
||
fprintf(stderr, "warning: malformed PC_to_RDR_Secure\n");
|
||
|
||
if (request.wLevelParameter != __constant_cpu_to_le16(0)) {
|
||
fprintf(stderr, "warning: Only APDUs, that begin and end with this command are supported.\n");
|
||
return get_RDR_to_PC_DataBlock(request.bSlot, request.bSeq,
|
||
SCARD_E_READER_UNSUPPORTED, __constant_cpu_to_le32(0));
|
||
}
|
||
|
||
printf(":");
|
||
|
||
__u8 PINMin, PINMax, bmPINLengthFormat, bmPINBlockString, bmFormatString;
|
||
__u8 *abPINApdu;
|
||
uint32_t apdulen;
|
||
abPINDataStucture_Verification_t *verify = NULL;
|
||
abPINDataStucture_Modification_t *modify = NULL;
|
||
switch (*abData) { // first byte of abData is bPINOperation
|
||
case 0x00:
|
||
// PIN Verification
|
||
verify = (abPINDataStucture_Verification_t *)
|
||
(abData + sizeof(__u8));
|
||
PINMin = verify->wPINMaxExtraDigit >> 8;
|
||
PINMax = verify->wPINMaxExtraDigit & 0x00ff;
|
||
bmPINLengthFormat = verify->bmPINLengthFormat;
|
||
bmPINBlockString = verify->bmPINBlockString;
|
||
bmFormatString = verify->bmFormatString;
|
||
abPINApdu = (__u8*) verify + sizeof(*verify);
|
||
apdulen = __le32_to_cpu(request.dwLength) - sizeof(*verify) - sizeof(__u8);
|
||
break;
|
||
case 0x01:
|
||
// PIN Modification
|
||
modify = (abPINDataStucture_Modification_t *)
|
||
(abData + sizeof(__u8));
|
||
PINMin = modify->wPINMaxExtraDigit >> 8;
|
||
PINMax = modify->wPINMaxExtraDigit & 0x00ff;
|
||
bmPINLengthFormat = modify->bmPINLengthFormat;
|
||
bmPINBlockString = modify->bmPINBlockString;
|
||
bmFormatString = modify->bmFormatString;
|
||
abPINApdu = (__u8*) modify + sizeof(*modify);
|
||
apdulen = __le32_to_cpu(request.dwLength) - sizeof(*modify) - sizeof(__u8);
|
||
break;
|
||
case 0x04:
|
||
// Cancel PIN function
|
||
default:
|
||
fprintf(stderr, "warning: unknown pin operation\n");
|
||
return get_RDR_to_PC_DataBlock(request.bSlot, request.bSeq,
|
||
SCARD_E_READER_UNSUPPORTED, __constant_cpu_to_le32(0));
|
||
}
|
||
|
||
// copy the apdu
|
||
__u8 *apdu = (__u8*) malloc(apdulen);
|
||
if (!apdu) {
|
||
return get_RDR_to_PC_DataBlock(request.bSlot, request.bSeq,
|
||
SCARD_E_NO_MEMORY, __constant_cpu_to_le32(0));
|
||
}
|
||
memcpy(apdu, abPINApdu, apdulen);
|
||
|
||
// TODO
|
||
char *pin = "1234";
|
||
|
||
__u8 *p;
|
||
/* if system units are bytes or bits */
|
||
uint8_t bytes = bmFormatString >> 7;
|
||
/* PIN position after format in the APDU command (relative to the first
|
||
* data after Lc). The position is based on the system units’ type
|
||
* indicator (maximum1111 for fifteen system units */
|
||
uint8_t pos = (bmFormatString >> 3) & 0xf;
|
||
/* Right or left justify data */
|
||
uint8_t right = (bmFormatString >> 2) & 1;
|
||
/* Bit wise for the PIN format type */
|
||
uint8_t type = bmFormatString & 2;
|
||
|
||
uint8_t pinlen = strnlen(pin, PINMax + 1);
|
||
if (pinlen > PINMax) {
|
||
fprintf(stderr, "warning: PIN was too long, "
|
||
"should be between %d and %d\n", PINMin, PINMax);
|
||
return get_RDR_to_PC_DataBlock(request.bSlot, request.bSeq,
|
||
SCARD_F_INTERNAL_ERROR, __constant_cpu_to_le32(0));
|
||
}
|
||
|
||
/* Size in bits of the PIN length inserted in the APDU command. */
|
||
uint8_t lenlen = bmPINBlockString >> 4;
|
||
/* PIN block size in bytes after justification and formatting. */
|
||
uint8_t blocksize = bmPINBlockString & 0xf;
|
||
/* PIN length position in the APDU command */
|
||
uint8_t lenshift = bmPINLengthFormat & 0xf;
|
||
if (lenlen) {
|
||
/* write PIN Length */
|
||
if (lenlen == 8) {
|
||
if (bytes) {
|
||
p = apdu + 5 + lenshift;
|
||
} else {
|
||
if (lenshift == 0)
|
||
p = apdu + 5;
|
||
if (lenshift == 8)
|
||
p = apdu + 5 + 1;
|
||
else {
|
||
fprintf(stderr, "warning: PIN Block too complex, aborting\n");
|
||
return get_RDR_to_PC_DataBlock(request.bSlot, request.bSeq,
|
||
SCARD_F_INTERNAL_ERROR,
|
||
__constant_cpu_to_le32(0));
|
||
}
|
||
}
|
||
*p = pinlen;
|
||
}
|
||
|
||
fprintf(stderr, "warning: PIN Block too complex, aborting\n");
|
||
return get_RDR_to_PC_DataBlock(request.bSlot, request.bSeq,
|
||
SCARD_F_INTERNAL_ERROR, __constant_cpu_to_le32(0));
|
||
}
|
||
|
||
uint8_t justify;
|
||
if (right)
|
||
justify = blocksize - pinlen;
|
||
else
|
||
justify = 0;
|
||
|
||
if (bytes) {
|
||
p = apdu + 5 + pos + justify;
|
||
} else {
|
||
if (pos == 0)
|
||
p = apdu + 5 + justify;
|
||
else if (pos == 8)
|
||
p = apdu + 5 + 1 + justify;
|
||
else {
|
||
fprintf(stderr, "warning: PIN Block too complex, aborting\n");
|
||
return get_RDR_to_PC_DataBlock(request.bSlot, request.bSeq,
|
||
SCARD_F_INTERNAL_ERROR,
|
||
__constant_cpu_to_le32(0));
|
||
}
|
||
}
|
||
|
||
while (*pin) {
|
||
uint8_t c;
|
||
switch (type) {
|
||
case 0:
|
||
// binary
|
||
switch (*pin) {
|
||
case '0':
|
||
c = 0x00;
|
||
break;
|
||
case '1':
|
||
c = 0x01;
|
||
break;
|
||
case '2':
|
||
c = 0x02;
|
||
break;
|
||
case '3':
|
||
c = 0x03;
|
||
break;
|
||
case '4':
|
||
c = 0x04;
|
||
break;
|
||
case '5':
|
||
c = 0x05;
|
||
break;
|
||
case '6':
|
||
c = 0x06;
|
||
break;
|
||
case '7':
|
||
c = 0x07;
|
||
break;
|
||
case '8':
|
||
c = 0x08;
|
||
break;
|
||
case '9':
|
||
c = 0x09;
|
||
break;
|
||
default:
|
||
fprintf(stderr, "warning: PIN character %c not supported, aborting", *pin);
|
||
return get_RDR_to_PC_DataBlock(request.bSlot,
|
||
request.bSeq, SCARD_F_INTERNAL_ERROR,
|
||
__constant_cpu_to_le32(0));
|
||
}
|
||
break;
|
||
case 1:
|
||
// BCD
|
||
fprintf(stderr, "warning: BCD format not supported, aborting");
|
||
return get_RDR_to_PC_DataBlock(request.bSlot, request.bSeq,
|
||
SCARD_F_INTERNAL_ERROR, __constant_cpu_to_le32(0));
|
||
case 2:
|
||
// ASCII
|
||
c = *pin;
|
||
break;
|
||
default:
|
||
fprintf(stderr, "warning: unknown formatting, aborting");
|
||
return get_RDR_to_PC_DataBlock(request.bSlot, request.bSeq,
|
||
SCARD_F_INTERNAL_ERROR, __constant_cpu_to_le32(0));
|
||
}
|
||
*p = c;
|
||
p++;
|
||
pin++;
|
||
}
|
||
|
||
|
||
DWORD dwRecvLength = MAX_BUFFER_SIZE;
|
||
*abDataOut = (__u8 *) malloc(dwRecvLength);
|
||
if (*abDataOut == NULL) {
|
||
return get_RDR_to_PC_DataBlock(request.bSlot, request.bSeq,
|
||
SCARD_E_NO_MEMORY, __constant_cpu_to_le32(0));
|
||
}
|
||
|
||
LPCSCARD_IO_REQUEST pioSendPci;
|
||
if (dwActiveProtocol == SCARD_PROTOCOL_T0)
|
||
pioSendPci = SCARD_PCI_T0;
|
||
else
|
||
pioSendPci = SCARD_PCI_T1;
|
||
int pcsc_result = SCardTransmit(hcard, pioSendPci, apdu, apdulen, NULL,
|
||
*abDataOut, &dwRecvLength);
|
||
|
||
return get_RDR_to_PC_DataBlock(request.bSlot, request.bSeq,
|
||
pcsc_result, __cpu_to_le32(dwRecvLength));
|
||
}
|
||
|
||
RDR_to_PC_NotifySlotChange_t
|
||
get_RDR_to_PC_NotifySlotChange ()
|
||
{
|
||
RDR_to_PC_NotifySlotChange_t result;
|
||
result.bMessageType = 0x50;
|
||
result.bmSlotICCState = 0; // no change
|
||
|
||
DWORD current = rstate.dwEventState;
|
||
if (SCARD_S_SUCCESS != SCardGetStatusChange(hcontext, 1, &rstate, 1)) {
|
||
fprintf(stderr, "state changed: error\n");
|
||
result.bmSlotICCState = 2; // changed (error)
|
||
} else if (!(current & rstate.dwEventState)) {
|
||
fprintf(stderr, "state changed\n");
|
||
result.bmSlotICCState = 2; // changed
|
||
}
|
||
|
||
return result;
|
||
}
|
||
|
||
RDR_to_PC_SlotStatus_t
|
||
perform_unknown(const PC_to_RDR_GetSlotStatus_t request)
|
||
{
|
||
RDR_to_PC_SlotStatus_t result;
|
||
switch (request.bMessageType) {
|
||
case 0x62:
|
||
case 0x6F:
|
||
case 0x69:
|
||
result.bMessageType = 0x80;
|
||
break;
|
||
case 0x63:
|
||
case 0x65:
|
||
case 0x6E:
|
||
case 0x6A:
|
||
case 0x71:
|
||
case 0x72:
|
||
result.bMessageType = 0x81;
|
||
break;
|
||
case 0x61:
|
||
case 0x6C:
|
||
case 0x6D:
|
||
result.bMessageType = 0x82;
|
||
break;
|
||
case 0x6B:
|
||
result.bMessageType = 0x83;
|
||
break;
|
||
case 0x73:
|
||
result.bMessageType = 0x84;
|
||
break;
|
||
default:
|
||
fprintf(stderr, "unknown message type\n");
|
||
result.bMessageType = 0;
|
||
}
|
||
result.dwLength = __constant_cpu_to_le32(0);
|
||
result.bSlot = request.bSlot,
|
||
result.bSeq = request.bSeq;
|
||
result.bStatus = get_bStatus(SCARD_F_UNKNOWN_ERROR);
|
||
result.bError = 0;
|
||
result.bClockStatus = 0;
|
||
|
||
return result;
|
||
}
|
||
|
||
int parse_ccid(const __u8* inbuf, __u8** outbuf)
|
||
{
|
||
if (inbuf == NULL)
|
||
return 0;
|
||
int result = -1;
|
||
if (SCardIsValidContext(hcontext) != SCARD_S_SUCCESS) {
|
||
if (perform_initialization(reader_num) == NULL)
|
||
goto error;
|
||
}
|
||
|
||
switch (*inbuf) {
|
||
case 0x62:
|
||
{ fprintf(stderr, "PC_to_RDR_IccPowerOn\n");
|
||
|
||
char* atr;
|
||
PC_to_RDR_IccPowerOn_t input =
|
||
*(PC_to_RDR_IccPowerOn_t*) inbuf;
|
||
RDR_to_PC_SlotStatus_t output =
|
||
perform_PC_to_RDR_IccPowerOn(input, &atr);
|
||
|
||
result = sizeof output + __le32_to_cpu(output.dwLength);
|
||
*outbuf = realloc(*outbuf, result);
|
||
if (*outbuf == NULL) {
|
||
result = -1;
|
||
break;
|
||
}
|
||
|
||
memcpy(*outbuf, &output, sizeof output);
|
||
memcpy(*outbuf + sizeof output, atr,
|
||
__le32_to_cpu(output.dwLength));
|
||
} break;
|
||
|
||
case 0x63:
|
||
{ fprintf(stderr, "PC_to_RDR_IccPowerOff\n");
|
||
|
||
PC_to_RDR_IccPowerOff_t input =
|
||
*(PC_to_RDR_IccPowerOff_t*) inbuf;
|
||
RDR_to_PC_SlotStatus_t output =
|
||
perform_PC_to_RDR_IccPowerOff(input);
|
||
|
||
result = sizeof output;
|
||
*outbuf = realloc(*outbuf, result);
|
||
if (*outbuf == NULL) {
|
||
result = -1;
|
||
break;
|
||
}
|
||
|
||
memcpy(*outbuf, &output, sizeof output);
|
||
} break;
|
||
|
||
case 0x65:
|
||
{ /*fprintf(stderr, "PC_to_RDR_GetSlotStatus\n");*/
|
||
|
||
PC_to_RDR_GetSlotStatus_t input =
|
||
*(PC_to_RDR_GetSlotStatus_t*) inbuf;
|
||
RDR_to_PC_SlotStatus_t output =
|
||
perform_PC_to_RDR_GetSlotStatus(input);
|
||
|
||
result = sizeof output;
|
||
*outbuf = realloc(*outbuf, result);
|
||
if (*outbuf == NULL) {
|
||
result = -1;
|
||
break;
|
||
}
|
||
|
||
memcpy(*outbuf, &output, sizeof output);
|
||
} break;
|
||
|
||
case 0x6F:
|
||
{ fprintf(stderr, "PC_to_RDR_XfrBlock\n");
|
||
|
||
__u8* rapdu;
|
||
PC_to_RDR_XfrBlock_t input = *(PC_to_RDR_XfrBlock_t*) inbuf;
|
||
RDR_to_PC_DataBlock_t output =
|
||
perform_PC_to_RDR_XfrBlock(input, inbuf + sizeof input,
|
||
&rapdu);
|
||
|
||
result = sizeof output + __le32_to_cpu(output.dwLength);
|
||
*outbuf = realloc(*outbuf, result);
|
||
if (*outbuf == NULL) {
|
||
free(rapdu);
|
||
result = -1;
|
||
break;
|
||
}
|
||
|
||
memcpy(*outbuf, &output, sizeof output);
|
||
memcpy(*outbuf + sizeof output, rapdu,
|
||
__le32_to_cpu(output.dwLength));
|
||
free(rapdu);
|
||
} break;
|
||
|
||
case 0x6C:
|
||
{ fprintf(stderr, "PC_to_RDR_GetParameters\n");
|
||
|
||
__u8* abProtocolDataStructure;
|
||
PC_to_RDR_GetParameters_t input = *(PC_to_RDR_GetParameters_t*)
|
||
inbuf;
|
||
RDR_to_PC_Parameters_t output = perform_PC_to_RDR_GetParamters(
|
||
input, &abProtocolDataStructure );
|
||
|
||
result = sizeof output + __le32_to_cpu(output.dwLength);
|
||
*outbuf = realloc(*outbuf, result);
|
||
if (*outbuf == NULL) {
|
||
if (abProtocolDataStructure)
|
||
free(abProtocolDataStructure);
|
||
result = -1;
|
||
break;
|
||
}
|
||
|
||
memcpy(*outbuf, &output, sizeof output);
|
||
memcpy(*outbuf + sizeof output, abProtocolDataStructure,
|
||
__le32_to_cpu(output.dwLength));
|
||
if (abProtocolDataStructure)
|
||
free(abProtocolDataStructure);
|
||
} break;
|
||
|
||
case 0x69:
|
||
{ fprintf(stderr, "PC_to_RDR_Secure\n");
|
||
|
||
__u8* rapdu;
|
||
PC_to_RDR_Secure_t input = *(PC_to_RDR_Secure_t *) inbuf;
|
||
RDR_to_PC_DataBlock_t output =
|
||
perform_PC_to_RDR_Secure(input, inbuf + sizeof input,
|
||
&rapdu);
|
||
|
||
result = sizeof output + __le32_to_cpu(output.dwLength);
|
||
*outbuf = realloc(*outbuf, result);
|
||
if (*outbuf == NULL) {
|
||
free(rapdu);
|
||
result = -1;
|
||
break;
|
||
}
|
||
|
||
memcpy(*outbuf, &output, sizeof output);
|
||
memcpy(*outbuf + sizeof output, rapdu,
|
||
__le32_to_cpu(output.dwLength));
|
||
free(rapdu);
|
||
} break;
|
||
|
||
default:
|
||
error:
|
||
{ fprintf(stderr, "unknown ccid command: 0x%4X\n", *inbuf);
|
||
|
||
PC_to_RDR_GetSlotStatus_t input =
|
||
*(PC_to_RDR_GetSlotStatus_t*) inbuf;
|
||
RDR_to_PC_SlotStatus_t output =
|
||
perform_unknown(input);
|
||
|
||
result = sizeof output;
|
||
*outbuf = realloc(*outbuf, result);
|
||
if (*outbuf == NULL) {
|
||
result = -1;
|
||
break;
|
||
}
|
||
|
||
memcpy(*outbuf, &output, sizeof output);
|
||
}
|
||
}
|
||
|
||
return result;
|
||
}
|
||
|
||
int parse_ccid_control(struct usb_ctrlrequest *setup, __u8 **outbuf)
|
||
{
|
||
int result = -1;
|
||
__u16 value, index, length;
|
||
|
||
value = __le16_to_cpu(setup->wValue);
|
||
index = __le16_to_cpu(setup->wIndex);
|
||
length = __le16_to_cpu(setup->wLength);
|
||
if (setup->bRequestType == USB_REQ_CCID)
|
||
switch(setup->bRequest) {
|
||
case CCID_CONTROL_ABORT:
|
||
{
|
||
fprintf(stderr, "ABORT\n");
|
||
if (length != 0x00) {
|
||
fprintf(stderr, "warning: malformed ABORT\n");
|
||
}
|
||
result = SCardCancel(hcontext);
|
||
if (result != SCARD_S_SUCCESS)
|
||
fprintf(stderr, "pc/sc error: %s\n",
|
||
pcsc_stringify_error(result));
|
||
result = 0;
|
||
} break;
|
||
case CCID_CONTROL_GET_CLOCK_FREQUENCIES:
|
||
{
|
||
fprintf(stderr, "GET_CLOCK_FREQUENCIES\n");
|
||
if (value != 0x00) {
|
||
fprintf(stderr,
|
||
"warning: malformed GET_CLOCK_FREQUENCIES\n");
|
||
}
|
||
|
||
result = sizeof(__le32);
|
||
*outbuf = realloc(*outbuf, result);
|
||
if (*outbuf == NULL) {
|
||
result = -1;
|
||
break;
|
||
}
|
||
__le32 clock = ccid_desc.dwDefaultClock;
|
||
memcpy(*outbuf, &clock, sizeof (__le32));
|
||
} break;
|
||
case CCID_CONTROL_GET_DATA_RATES:
|
||
{
|
||
fprintf(stderr, "GET_DATA_RATES\n");
|
||
if (value != 0x00) {
|
||
fprintf(stderr, "warning: malformed GET_DATA_RATES\n");
|
||
}
|
||
|
||
result = sizeof (__le32);
|
||
*outbuf = realloc(*outbuf, result);
|
||
if (*outbuf == NULL) {
|
||
result = -1;
|
||
break;
|
||
}
|
||
__le32 drate = ccid_desc.dwDataRate;
|
||
memcpy(*outbuf, &drate, sizeof (__le32));
|
||
} break;
|
||
default:
|
||
printf("unknown status setup->bRequest == %d", setup->bRequest);
|
||
}
|
||
|
||
return result;
|
||
}
|