- Added capabilities to parse and send extended length APDUs. This does not
work proberly with libccid, so it is disabled at the moment - unpower card only on PC_to_RDR_IccPowerOff git-svn-id: https://vsmartcard.svn.sourceforge.net/svnroot/vsmartcard@266 96b47cad-a561-4643-ad3b-153ac7d7599c
This commit is contained in:
@@ -80,13 +80,13 @@ int build_apdu(sc_context_t *ctx, const u8 *buf, size_t len, sc_apdu_t *apdu)
|
||||
const u8 *p;
|
||||
size_t len0;
|
||||
|
||||
if (!buf || !apdu)
|
||||
return SC_ERROR_INVALID_ARGUMENTS;
|
||||
if (!buf || !apdu)
|
||||
return SC_ERROR_INVALID_ARGUMENTS;
|
||||
|
||||
len0 = len;
|
||||
if (len < 4) {
|
||||
sc_error(ctx, "APDU too short (must be at least 4 bytes)");
|
||||
return SC_ERROR_INVALID_DATA;
|
||||
sc_error(ctx, "APDU too short (must be at least 4 bytes)");
|
||||
return SC_ERROR_INVALID_DATA;
|
||||
}
|
||||
|
||||
memset(apdu, 0, sizeof(*apdu));
|
||||
@@ -97,30 +97,68 @@ int build_apdu(sc_context_t *ctx, const u8 *buf, size_t len, sc_apdu_t *apdu)
|
||||
apdu->p2 = *p++;
|
||||
len -= 4;
|
||||
if (len > 1) {
|
||||
apdu->lc = *p++;
|
||||
len--;
|
||||
apdu->data = p;
|
||||
apdu->datalen = apdu->lc;
|
||||
if (len < apdu->lc) {
|
||||
sc_error(ctx, "APDU too short (need %lu bytes)\n",
|
||||
(unsigned long) apdu->lc - len);
|
||||
return SC_ERROR_INVALID_DATA;
|
||||
}
|
||||
len -= apdu->lc;
|
||||
p += apdu->lc;
|
||||
if (len) {
|
||||
apdu->le = *p++;
|
||||
if (apdu->le == 0)
|
||||
apdu->le = 256;
|
||||
len--;
|
||||
apdu->cse = SC_APDU_CASE_4_SHORT;
|
||||
/* case 2 with le=0 and case 4 with lc=0 are the only short APDUs,
|
||||
* where the next byte is 0. Their length (without header) is 1 and
|
||||
* 2 respectively */
|
||||
if (*p == 0 && len > 2) {
|
||||
/* ...must be an extended length APDU */
|
||||
p++;
|
||||
apdu->lc = (*p++)<<8;
|
||||
apdu->lc += *p++;
|
||||
len -= 3;
|
||||
if (len < apdu->lc) {
|
||||
sc_error(ctx, "APDU too short (need %lu bytes)\n",
|
||||
(unsigned long) apdu->lc - len);
|
||||
return SC_ERROR_INVALID_DATA;
|
||||
}
|
||||
len -= apdu->lc;
|
||||
p += apdu->lc;
|
||||
if (len) {
|
||||
if (*p++ != 0) {
|
||||
sc_error(ctx, "Extended APDU needs Lc, that begins with 0x00)\n",
|
||||
(unsigned long) apdu->lc - len);
|
||||
return SC_ERROR_INVALID_DATA;
|
||||
}
|
||||
apdu->le = (*p++)<<8;
|
||||
apdu->le += *p++;
|
||||
if (apdu->le == 0)
|
||||
apdu->le = 0xffff;
|
||||
len -= 3;
|
||||
apdu->cse = SC_APDU_CASE_4_EXT;
|
||||
} else {
|
||||
apdu->cse = SC_APDU_CASE_3_EXT;
|
||||
}
|
||||
if (len) {
|
||||
sc_error(ctx, "APDU too long (%lu bytes extra)\n",
|
||||
(unsigned long) len);
|
||||
return SC_ERROR_INVALID_DATA;
|
||||
}
|
||||
} else {
|
||||
apdu->cse = SC_APDU_CASE_3_SHORT;
|
||||
}
|
||||
if (len) {
|
||||
sc_error(ctx, "APDU too long (%lu bytes extra)\n",
|
||||
(unsigned long) len);
|
||||
return SC_ERROR_INVALID_DATA;
|
||||
apdu->lc = *p++;
|
||||
len--;
|
||||
apdu->data = p;
|
||||
apdu->datalen = apdu->lc;
|
||||
if (len < apdu->lc) {
|
||||
sc_error(ctx, "APDU too short (need %lu bytes)\n",
|
||||
(unsigned long) apdu->lc - len);
|
||||
return SC_ERROR_INVALID_DATA;
|
||||
}
|
||||
len -= apdu->lc;
|
||||
p += apdu->lc;
|
||||
if (len) {
|
||||
apdu->le = *p++;
|
||||
if (apdu->le == 0)
|
||||
apdu->le = 0xff;
|
||||
len--;
|
||||
apdu->cse = SC_APDU_CASE_4_SHORT;
|
||||
} else {
|
||||
apdu->cse = SC_APDU_CASE_3_SHORT;
|
||||
}
|
||||
if (len) {
|
||||
sc_error(ctx, "APDU too long (%lu bytes extra)\n",
|
||||
(unsigned long) len);
|
||||
return SC_ERROR_INVALID_DATA;
|
||||
}
|
||||
}
|
||||
} else if (len == 1) {
|
||||
apdu->le = *p++;
|
||||
@@ -132,12 +170,12 @@ int build_apdu(sc_context_t *ctx, const u8 *buf, size_t len, sc_apdu_t *apdu)
|
||||
apdu->cse = SC_APDU_CASE_1;
|
||||
}
|
||||
|
||||
apdu->flags = SC_APDU_FLAGS_NO_GET_RESP|SC_APDU_FLAGS_NO_RETRY_WL;
|
||||
apdu->flags = SC_APDU_FLAGS_NO_GET_RESP|SC_APDU_FLAGS_NO_RETRY_WL;
|
||||
|
||||
sc_debug(ctx, "APDU, %d bytes:\tins=%02x p1=%02x p2=%02x",
|
||||
(unsigned int) len0, apdu->ins, apdu->p1, apdu->p2);
|
||||
sc_debug(ctx, "APDU, %d bytes:\tins=%02x p1=%02x p2=%02x",
|
||||
(unsigned int) len0, apdu->ins, apdu->p1, apdu->p2);
|
||||
|
||||
return SC_SUCCESS;
|
||||
return SC_SUCCESS;
|
||||
}
|
||||
|
||||
void _bin_log(sc_context_t *ctx, int type, const char *file, int line,
|
||||
|
||||
Reference in New Issue
Block a user