initial commit related to CCID device/firmware implementation
The CCID core here shall be rather generic, and combined with the
hardware specific bits for (initially) the sysmoOCTSIM target.
Change-Id: I2789f7fcdb1b24c6ef47c7f37f4889f90acfd698
diff --git a/ccid/ccid_device.c b/ccid/ccid_device.c
new file mode 100644
index 0000000..c81f177
--- /dev/null
+++ b/ccid/ccid_device.c
@@ -0,0 +1,370 @@
+#include <stdlib.h>
+#include <stdio.h>
+#include <unistd.h>
+#include <assert.h>
+
+#include <osmocom/core/msgb.h>
+#include <osmocom/core/utils.h>
+
+#include "ccid_proto.h"
+
+#define NR_SLOTS 8
+
+struct ccid_slot {
+ struct ccid_instance *ci;
+ uint8_t slot_nr;
+ bool icc_present;
+ bool icc_powered;
+ bool icc_in_reset;
+};
+
+struct ccid_ops {
+ int (*send)(struct ccid_instance *ci, struct msgb *msg);
+};
+
+struct ccid_instance {
+ struct ccid_slot slot[NR_SLOTS];
+ struct ccid_ops ops;
+};
+
+#define msgb_ccid_out(x) (union ccid_pc_to_rdr *)msgb_data(x)
+#define msgb_ccid_in(x) (union ccid_rdr_to_pc *)msgb_data(x)
+
+static struct ccid_slot *get_ccid_slot(struct ccid_instance *ci, uint8_t slot_nr)
+{
+ if (slot_nr >= sizeof(ci->slot))
+ return NULL;
+ else
+ return &ci->slot[slot_nr]
+}
+
+static uint8_t get_icc_status(const struct ccid_slot *cs)
+{
+ if (cs->icc_present && cs->icc_powered && !cs->icc_in_reset)
+ return CCID_ICC_STATUS_PRES_ACT;
+ else if (!cs->icc_present)
+ return CCID_ICC_STATUS_NO_ICC;
+ else
+ return CCID_ICC_STATUS_PRES_INACT;
+}
+
+#define SET_HDR(x, msg_type, slot, seq) do { \
+ (x)->hdr.bMessageType = msg_type; \
+ (x)->hdr.dwLength = 0; \
+ (x)->hdr.bSlot = slot; \
+ (x)->hdr.bSeq = seq; \
+ } while (0)
+
+#define SET_HDR_IN(x, msg_type, slot, seq, status, error) do { \
+ SET_HDR(&(x)->hdr, msg_type, slot, seq); \
+ (x)->hdr.bStatus = status; \
+ (x)->hdr.bError = error; \
+ } while (0)
+
+/***********************************************************************
+ * Message generation / sending
+ ***********************************************************************/
+
+static struct msgb *ccid_msgb_alloc(void)
+{
+ struct msgb *msg = msgb_alloc("ccid");
+ OSMO_ASSERT(msg);
+ return msg;
+}
+
+static int ccid_send(struct ccid_instance *ci, struct msgb *msg)
+{
+ return ci->ops.send_in(ci, msg);
+}
+
+static int ccid_slot_send(struct ccid_slot *cs, struct msgb *msg)
+{
+ const struct ccid_header *ch = (const struct ccid_header *) msgb_ccid_in(msg);
+
+ /* patch bSlotNr into message */
+ ch->hdr.bSlot = cs->slot_nr;
+ return ccid_send(cs->ci, msg);
+}
+
+
+/* Section 6.2.1 */
+static struct msgb *ccid_gen_data_block(struct ccid_slot *cs, uint8_t seq, uint8_t cmd_sts,
+ enum ccid_error_code err, const uint8_t *data,
+ uint32_t data_len)
+{
+ struct msgb *msg = ccid_msgb_alloc();
+ struct ccid_rdr_to_pc_data_block *db = msgb_put(msg, sizeof(*db) + data_len);
+ uint8_t sts = (cmd_sts & CCID_CMD_STATUS_MASK) | get_icc_status(cs);
+
+ SET_HDR_IN(db, RDR_to_PC_DataBlock, cs->slot_nr, seq, sts, err);
+ db->hdr.dwLength = cpu_to_le32(data_len);
+ memcpy(db->abData, data, data_len);
+ return msg;
+}
+
+/* Section 6.2.2 */
+static struct msgb *ccid_gen_slot_status(struct ccid_slot *cs, uint8_t seq, uint8_t cmd_sts,
+ enum ccid_error_code err)
+{
+ struct msgb *msg = ccid_msgb_alloc();
+ struct ccid_rdr_to_pc_slot_status *ss = msgb_put(msg, sizeof(*ss));
+ uint8_t sts = (cmd_sts & CCID_CMD_STATUS_MASK) | get_icc_status(cs);
+
+ SET_HDR_IN(ss, RDR_to_PC_SlotStatus, cs->slot_nr, seq, sts, err);
+ return msg;
+}
+
+/* Section 6.2.3 */
+/* TODO */
+
+/* Section 6.2.4 */
+static struct msgb *ccid_gen_escape(struct ccid_slot *cs, uint8_t seq, uint8_t cmd_sts,
+ enum ccid_error_code err, const uint8_t *data,
+ uint32_t data_len)
+{
+ struct msgb *msg = ccid_msgb_alloc();
+ struct ccid_rdr_to_pc_escape *esc = msgb_put(msg, sizeof(*esc) + data_len);
+ uint8_t sts = (cmd_sts & CCID_CMD_STATUS_MASK) | get_icc_status(cs);
+
+ SET_HDR_IN(esc, RDR_to_PC_Escape, cs->slot_nr, seq, sts, err);
+ esc->hdr.dwLength = cpu_to_le32(data_len);
+ memcpy(esc->abData, data, data_len);
+ return msg;
+}
+
+/* Section 6.2.5 */
+static struct msgb *ccid_gen_clock_and_rate(struct ccid_slot *cs, uint8_t seq, uint8_t cmd_sts,
+ enum ccid_error_code err, uint32_t clock_khz, uint32_t rate_bps)
+{
+ struct msgb *msg = ccid_msgb_alloc();
+ struct ccid_rdr_to_pc_data_rate_and_clock *drc = msgb_put(msg, sizeof(*drc));
+ uint8_t sts = (cmd_sts & CCID_CMD_STATUS_MASK) | get_icc_status(cs);
+
+ SET_HDR_IN(drc, RDR_to_PC_DataRateAndClockFrequency, cs->slot_nr, seq, sts, err);
+ drc->dwLength = cpu_to_le32(8); /* Message-specific data length (wtf?) */
+ drc->dwClockFrequency = cpu_to_le32(clock_khz); /* kHz */
+ drc->dwDataRate = cpu_to_le32(rate_bps); /* bps */
+ return msg;
+}
+
+
+
+#if 0
+static struct msgb *gen_err_resp(struct ccid_instance *ci, enum ccid_msg_type msg_type,
+ enum ccid_error_code err_code)
+{
+ struct c
+}
+#endif
+
+/***********************************************************************
+ * Message reception / parsing
+ ***********************************************************************/
+
+/* Section 6.1.3 */
+static int ccid_handle_get_slot_status(struct ccid_slot *cs, struct msgb *msg)
+{
+ const union ccid_pc_to_rdr *u = msgb_ccid_out(msg);
+ struct msgb *resp;
+
+ resp = ccid_gen_slot_status(cs, u->get_slot_status.hdr.bSeq, CCID_CMD_STATUS_OK, 0);
+
+ return ccid_send(cs->ci, resp);
+}
+
+
+/* Section 6.1.1 */
+static int ccid_handle_icc_power_on(struct ccid_slot *cs, struct msgb *msg)
+{
+ const union ccid_pc_to_rdr *u = msgb_ccid_out(msg);
+ struct msgb *resp;
+
+ /* TODO: send actual ATR; handle error cases */
+ /* TODO: handle this asynchronously */
+ resp = ccid_gen_data_block(cs, u->icc_power_on.hdr.hSeq, CCID_CMD_STATUS_OK, 0, NULL, 0);
+
+ return ccid_send(cs->ci, resp);
+}
+
+/* Section 6.1.2 */
+static int ccid_handle_icc_power_off(struct ccid_slot *cs, struct msgb *msg)
+{
+ const union ccid_pc_to_rdr *u = msgb_ccid_out(msg);
+ resp = ccid_gen_slot_status(cs, u->get_slot_status.hdr.bSeq, CCID_CMD_STATUS_OK, 0);
+ return ccid_send(cs->ci, resp);
+}
+
+/* Section 6.1.4 */
+static int ccid_handle_xfr_block(struct ccid_slot *cs, struct msgb *msg)
+{
+ const union ccid_pc_to_rdr *u = msgb_ccid_out(msg);
+ resp = ccid_gen_data_block(cs, u->icc_power_on.hdr.hSeq, CCID_CMD_STATUS_OK, 0, NULL, 0);
+ return ccid_send(cs->ci, resp);
+}
+
+/* Section 6.1.5 */
+static int ccid_handle_get_parameters(struct ccid_slot *cs, struct msgb *msg)
+{
+ const union ccid_pc_to_rdr *u = msgb_ccid_out(msg);
+}
+
+/* Section 6.1.6 */
+static int ccid_handle_reset_parameters(struct ccid_slot *cs, struct msgb *msg)
+{
+ const union ccid_pc_to_rdr *u = msgb_ccid_out(msg);
+}
+
+/* Section 6.1.7 */
+static int ccid_handle_set_parameters(struct ccid_slot *cs, struct msgb *msg)
+{
+ const union ccid_pc_to_rdr *u = msgb_ccid_out(msg);
+}
+
+/* Section 6.1.8 */
+static int ccid_handle_escape(struct ccid_slot *cs, struct msgb *msg)
+{
+ const union ccid_pc_to_rdr *u = msgb_ccid_out(msg);
+}
+
+/* Section 6.1.9 */
+static int ccid_handle_icc_clock(struct ccid_slot *cs, struct msgb *msg)
+{
+ const union ccid_pc_to_rdr *u = msgb_ccid_out(msg);
+ resp = ccid_gen_slot_status(cs, u->get_slot_status.hdr.bSeq, CCID_CMD_STATUS_OK, 0);
+ return ccid_send(cs->ci, resp);
+}
+
+/* Section 6.1.10 */
+static int ccid_handle_t0apdu(struct ccid_slot *cs, struct msgb *msg)
+{
+ const union ccid_pc_to_rdr *u = msgb_ccid_out(msg);
+ resp = ccid_gen_slot_status(cs, u->get_slot_status.hdr.bSeq, CCID_CMD_STATUS_OK, 0);
+ return ccid_send(cs->ci, resp);
+}
+
+/* Section 6.1.11 */
+static int ccid_handle_secure(struct ccid_slot *cs, struct msgb *msg)
+{
+ const union ccid_pc_to_rdr *u = msgb_ccid_out(msg);
+}
+
+/* Section 6.1.12 */
+static int ccid_handle_mechanical(struct ccid_slot *cs, struct msgb *msg)
+{
+ const union ccid_pc_to_rdr *u = msgb_ccid_out(msg);
+ resp = ccid_gen_slot_status(cs, u->get_slot_status.hdr.bSeq, CCID_CMD_STATUS_OK, 0);
+ return ccid_send(cs->ci, resp);
+}
+
+/* Section 6.1.13 */
+static int ccid_handle_abort(struct ccid_slot *cs, struct msgb *msg)
+{
+ const union ccid_pc_to_rdr *u = msgb_ccid_out(msg);
+ resp = ccid_gen_slot_status(cs, u->get_slot_status.hdr.bSeq, CCID_CMD_STATUS_OK, 0);
+ return ccid_send(cs->ci, resp);
+}
+
+/* Section 6.1.14 */
+static int ccid_handle_set_rate_and_clock(struct ccid_slot *cs, struct msgb *msg)
+{
+ const union ccid_pc_to_rdr *u = msgb_ccid(msg);
+}
+
+/* handle data arriving from the host on the OUT endpoint */
+int ccid_handle_out(struct ccid_instance *ci, struct msgb *msg)
+{
+ const union ccid_pc_to_rdr *u = msgb_ccid_out(msg);
+ const struct ccid_header *ch = (const struct ccid_header *) u;
+ unsigned int len = msgb_length(msg);
+ struct ccid_slot *cs;
+
+ if (len < sizeof(*ch)) {
+ /* FIXME */
+ return -1;
+ }
+
+ cs = get_ccid_slot(ci, ch->hdr.bSlot);
+ if (!cs) {
+ /* FIXME */
+ return -1;
+ }
+
+ switch (ch->bMessageType) {
+ case PC_to_RDR_GetSlotStatus:
+ if (len != sizeof(u->get_slot_status))
+ goto short_msg;
+ rc = ccid_handle_get_slot_status(cs, msg);
+ break;
+ case PC_to_RDR_IccPowerOn:
+ if (len != sizeof(u->icc_power_on))
+ goto short_msg;
+ rc = ccid_handle_icc_power_on(cs, msg);
+ break;
+ case PC_to_RDR_IccPowerOff:
+ if (len != sizeof(u->icc_power_off))
+ goto short_msg;
+ rc = ccid_handle_icc_power_off(cs, msg);
+ break;
+ case PC_to_RDR_XfrBlock:
+ if (len < sizeof(u->xfr_block))
+ goto short_msg;
+ rc = ccid_handle_xfr_block(cs, msg);
+ break;
+ case PC_to_RDR_GetParameters:
+ if (len != sizeof(u->get_parameters))
+ goto short_msg;
+ rc = ccid_handle_get_parameters(cs, msg);
+ break;
+ case PC_to_RDR_ResetParameters:
+ if (len != sizeof(u->reset_parameters))
+ goto short_msg;
+ rc = ccid_handle_reset_parameters(cs, msg);
+ break;
+ case PC_to_RDR_SetParameters:
+ if (len != sizeof(u->set_parameters))
+ goto short_msg;
+ rc = ccid_handle_set_parameters(cs, msg);
+ break;
+ case PC_to_RDR_Escape:
+ if (len < sizeof(u->escape))
+ goto short_msg;
+ rc = ccid_handle_escape(cs, msg);
+ break;
+ case PC_to_RDR_IccClock:
+ if (len != sizeof(u->icc_clock))
+ goto short_msg;
+ rc = ccid_handle_icc_clock(cs, msg);
+ break;
+ case PC_to_RDR_T0APDU:
+ if (len != /*FIXME*/ sizeof(u->t0apdu))
+ goto short_msg;
+ rc = ccid_handle_t0_apdu(cs, msg);
+ break;
+ case PC_to_RDR_Secure:
+ if (len < sizeof(u->secure))
+ goto short_msg;
+ rc = ccid_handle_secure(cs, msg);
+ break;
+ case PC_to_RDR_Mechanical:
+ if (len != sizeof(u->mechanical))
+ goto short_msg;
+ rc = ccid_handle_mechanical(cs, msg);
+ break;
+ case PC_to_RDR_Abort:
+ if (len != sizeof(u->abort))
+ goto short_msg;
+ rc = ccid_handle_abort(cs, msg);
+ break;
+ case PC_to_RDR_SetDataRateAndClockFrequency:
+ if (len != sizeof(u->set_rate_and_clock))
+ goto short_msg;
+ rc = ccid_handle_set_rate_and_clock(cs, msg);
+ break;
+ default:
+ FIXME
+ break;
+ }
+ FIXME
+short_msg:
+ FIXME
+}