interface.c

#include "interface.private.h"

#include <stdio.h>
#include <string.h>
#include <stdlib.h>

static int lc(struct apdu_request *apdu, uint8_t cla, uint8_t ins, uint8_t p1, uint8_t p2, uint8_t datalen)
{
    apdu->cla = cla;
    apdu->ins = ins;
    apdu->p1 = p1;
    apdu->p2 = p2;
    apdu->length = datalen;

    return datalen + sizeof(struct apdu_request);
}

static int le(struct apdu_request *apdu, uint8_t cla, uint8_t ins, uint8_t p1, uint8_t p2, uint8_t requestlen)
{
    apdu->cla = cla;
    apdu->ins = ins;
    apdu->p1 = p1;
    apdu->p2 = p2;
    apdu->length = requestlen;

    return sizeof(struct apdu_request);
}

int euicc_apdu_lc(struct euicc_ctx *ctx, struct apdu_request **apdu, uint8_t cla, uint8_t ins, uint8_t p1, uint8_t p2, uint8_t datalen)
{
    *apdu = (struct apdu_request *)&ctx->apdu._internal.request_buffer;
    return lc(*apdu, cla, ins, p1, p2, datalen);
}

int euicc_apdu_le(struct euicc_ctx *ctx, struct apdu_request **apdu, uint8_t cla, uint8_t ins, uint8_t p1, uint8_t p2, uint8_t requestlen)
{
    *apdu = (struct apdu_request *)&ctx->apdu._internal.request_buffer;
    return le(*apdu, cla, ins, p1, p2, requestlen);
}

static void euicc_apdu_request_print(const struct apdu_request *req, uint32_t request_len)
{
    fprintf(stderr, "[DEBUG] [APDU] [TX] CLA: %02X, INS: %02X, P1: %02X, P2: %02X, Lc: %02X, Data: ", req->cla, req->ins, req->p1, req->p2, req->length);
    for (uint32_t i = 0; i < (request_len - sizeof(struct apdu_request)); i++)
        fprintf(stderr, "%02X ", (req->data[i] & 0xFF));
    fprintf(stderr, "\n");
}

static void euicc_apdu_response_print(const struct apdu_response *resp)
{
    fprintf(stderr, "[DEBUG] [APDU] [RX] SW1: %02X, SW2: %02X, Data: ", resp->sw1, resp->sw2);
    for (uint32_t i = 0; i < resp->length; i++)
        fprintf(stderr, "%02X ", (resp->data[i] & 0xFF));
    fprintf(stderr, "\n");
}

int euicc_apdu_transmit(struct euicc_ctx *ctx, struct apdu_response *response, const struct apdu_request *request, uint32_t request_len)
{
    const struct euicc_apdu_interface *in = ctx->apdu.interface;

    memset(response, 0x00, sizeof(*response));

    if (getenv("LIBEUICC_DEBUG_APDU"))
    {
        euicc_apdu_request_print(request, request_len);
    }

    if (in->transmit(ctx, &response->data, &response->length, (uint8_t *)request, request_len) < 0)
        return -1;

    if (response->length < 2)
        return -1;

    response->sw1 = response->data[response->length - 2];
    response->sw2 = response->data[response->length - 1];
    response->length -= 2;

    if (getenv("LIBEUICC_DEBUG_APDU"))
    {
        euicc_apdu_response_print(response);
    }

    return 0;
}

void euicc_apdu_response_free(struct apdu_response *resp)
{
    free(resp->data);
    resp->data = NULL;
    resp->length = 0;
}