vsmartcard/ccid/src/scutil.c

/*
 * Copyright (C) 2010 Frank Morgner
 *
 * This file is part of ccid.
 *
 * ccid is free software: you can redistribute it and/or modify it under the
 * terms of the GNU General Public License as published by the Free Software
 * Foundation, either version 3 of the License, or (at your option) any later
 * version.
 *
 * ccid is distributed in the hope that it will be useful, but WITHOUT ANY
 * WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS
 * FOR A PARTICULAR PURPOSE.  See the GNU General Public License for more
 * details.
 *
 * You should have received a copy of the GNU General Public License along with
 * ccid.  If not, see <http://www.gnu.org/licenses/>.
 */
#include "scutil.h"
#include <stdio.h>
#include <string.h>
#include <opensc/log.h>

int initialize(int reader_id, const char *cdriver, int verbose,
        sc_context_t **ctx, sc_reader_t **reader)
{
    unsigned int i, reader_count;

    if (!ctx || !reader)
        return SC_ERROR_INVALID_ARGUMENTS;

    int r = sc_context_create(ctx, NULL);
    if (r < 0) {
        printf("Failed to create initial context: %s", sc_strerror(r));
        return r;
    }

    if (cdriver != NULL) {
        r = sc_set_card_driver(*ctx, cdriver);
        if (r < 0) {
            sc_error(*ctx, "Card driver '%s' not found!\n", cdriver);
            return r;
        }
    }

    (*ctx)->debug = verbose;

    reader_count = sc_ctx_get_reader_count(*ctx);

    if (reader_count == 0)
        return SC_ERROR_NO_READERS_FOUND;

    if (reader_id < 0) {
        /* Automatically try to skip to a reader with a card if reader not specified */
        for (i = 0; i < reader_count; i++) {
            *reader = sc_ctx_get_reader(*ctx, i);
            if (sc_detect_card_presence(*reader, 0) & SC_SLOT_CARD_PRESENT) {
                reader_id = i;
                sc_debug(*ctx, "Using reader with a card: %s", (*reader)->name);
                break;
            }
        }
        if (reader_id >= reader_count) {
            /* no reader found, use the first */
            reader_id = 0;
        }
    }

    if (reader_id >= reader_count)
        return SC_ERROR_NO_READERS_FOUND;

    *reader = sc_ctx_get_reader(*ctx, reader_id);

    return SC_SUCCESS;
}


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;

	len0 = len;
	if (len < 4) {
		sc_error(ctx, "APDU too short (must be at least 4 bytes)");
		return SC_ERROR_INVALID_DATA;
	}

	memset(apdu, 0, sizeof(*apdu));
	p = buf;
	apdu->cla = *p++;
	apdu->ins = *p++;
	apdu->p1 = *p++;
	apdu->p2 = *p++;
	len -= 4;
	if (len > 1) {
		/* 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->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++;
		if (apdu->le == 0)
			apdu->le = 256;
		len--;
		apdu->cse = SC_APDU_CASE_2_SHORT;
	} else {
		apdu->cse = SC_APDU_CASE_1;
	}

	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);

	return SC_SUCCESS;
}

void _bin_log(sc_context_t *ctx, int type, const char *file, int line,
        const char *func, const char *label, const u8 *data, size_t len,
        FILE *f)
{
    char buf[1024];

    if (data)
        sc_hex_dump(ctx, data, len, buf, sizeof buf);
    else
        buf[0] = 0;
    if (!f) {
        sc_do_log(ctx, type, file, line, func,
                "\n%s (%u byte%s):\n%s"
                "======================================================================",
                label, len, len==1?"":"s", buf);
    } else {
        fprintf(f, "%s (%u byte%s):\n%s"
                "======================================================================\n",
                label, len, len==1?"":"s", buf);
    }
}