| |
| #include <osmocom/core/linuxlist.h> |
| #include <osmocom/core/talloc.h> |
| #include <osmocom/core/utils.h> |
| #include <osmocom/core/fsm.h> |
| #include <osmocom/core/logging.h> |
| |
| #include <csv.h> |
| |
| #include "bankd.h" |
| #include "rspro_util.h" |
| |
| /*********************************************************************** |
| * RSPRO bank/slot-id <-> PCSC Reader name mapping |
| ***********************************************************************/ |
| |
| struct pcsc_slot_name { |
| struct llist_head list; |
| /* RSPRO bank slot number */ |
| struct bank_slot slot; |
| /* String name of the reader in PC/SC world */ |
| const char *name; |
| }; |
| |
| enum parser_state_name { |
| ST_NONE, |
| ST_BANK_NR, |
| ST_SLOT_NR, |
| ST_PCSC_NAME, |
| }; |
| struct parser_state { |
| struct bankd *bankd; |
| enum parser_state_name state; |
| struct pcsc_slot_name *cur; |
| }; |
| |
| |
| static void parser_state_init(struct parser_state *ps) |
| { |
| ps->state = ST_BANK_NR; |
| ps->cur = NULL; |
| } |
| |
| static void cb1(void *s, size_t len, void *data) |
| { |
| char *field = (char *) s; |
| struct parser_state *ps = data; |
| |
| switch (ps->state) { |
| case ST_BANK_NR: |
| OSMO_ASSERT(!ps->cur); |
| ps->cur = talloc_zero(ps->bankd, struct pcsc_slot_name); |
| OSMO_ASSERT(ps->cur); |
| ps->cur->slot.bank_id = atoi(field); |
| ps->state = ST_SLOT_NR; |
| break; |
| case ST_SLOT_NR: |
| OSMO_ASSERT(ps->cur); |
| ps->cur->slot.slot_nr = atoi(field); |
| ps->state = ST_PCSC_NAME; |
| break; |
| case ST_PCSC_NAME: |
| OSMO_ASSERT(ps->cur); |
| ps->cur->name = talloc_strdup(ps->cur, field); |
| break; |
| default: |
| OSMO_ASSERT(0); |
| } |
| } |
| |
| static void cb2(int c, void *data) |
| { |
| struct parser_state *ps = data; |
| struct pcsc_slot_name *sn = ps->cur; |
| |
| printf("PC/SC slot name: %u/%u -> '%s'\n", sn->slot.bank_id, sn->slot.slot_nr, sn->name); |
| llist_add_tail(&sn->list, &ps->bankd->pcsc_slot_names); |
| |
| ps->state = ST_BANK_NR; |
| ps->cur = NULL; |
| } |
| |
| int bankd_pcsc_read_slotnames(struct bankd *bankd, const char *csv_file) |
| { |
| FILE *fp; |
| struct csv_parser p; |
| char buf[1024]; |
| size_t bytes_read; |
| struct parser_state ps; |
| |
| if (csv_init(&p, CSV_APPEND_NULL) != 0) |
| return -1; |
| |
| fp = fopen(csv_file, "rb"); |
| if (!fp) |
| return -1; |
| |
| parser_state_init(&ps); |
| ps.bankd = bankd; |
| |
| while ((bytes_read = fread(buf, 1, sizeof(buf), fp)) > 0) { |
| if (csv_parse(&p, buf, bytes_read, cb1, cb2, &ps) != bytes_read) { |
| fprintf(stderr, "Error parsing CSV: %s\n", csv_strerror(csv_error(&p))); |
| fclose(fp); |
| return -1; |
| } |
| } |
| |
| csv_fini(&p, cb1, cb2, &ps); |
| fclose(fp); |
| csv_free(&p); |
| |
| return 0; |
| } |
| |
| const char *bankd_pcsc_get_slot_name(struct bankd *bankd, const struct bank_slot *slot) |
| { |
| struct pcsc_slot_name *cur; |
| |
| llist_for_each_entry(cur, &bankd->pcsc_slot_names, list) { |
| if (bank_slot_equals(&cur->slot, slot)) |
| return cur->name; |
| } |
| return NULL; |
| } |
| |
| |
| /*********************************************************************** |
| * SCard related FSM |
| ***********************************************************************/ |
| |
| #define S(x) (1 << (x)) |
| |
| #define T2_TIMEOUT_SECS 10 |
| #define T1_TIMEOUT_SECS 10 |
| |
| enum sc_fsm_states { |
| SC_ST_CARD_ABSENT, |
| SC_ST_CARD_PRESENT, |
| }; |
| |
| static const struct value_string sc_fsm_event_names[] = { |
| { SC_E_CONNECT_CMD, "CONNECT_CMD" }, |
| { SC_E_DISCONNECT_CMD, "DISCONNECT_CMD" }, |
| { SC_E_TPDU_CMD, "TPDU_CMD" }, |
| { 0, NULL } |
| }; |
| |
| /* an attempt at SCardConnect */ |
| static void attempt_sc_connect(struct osmo_fsm_inst *fi) |
| { |
| struct bankd_worker *worker = fi->priv; |
| LONG rc; |
| DWORD protocol; |
| |
| /* another attempt at SCardConnect */ |
| rc = SCardConnect(worker->reader.pcsc.hContext, worker->reader.name, |
| SCARD_SHARE_EXCLUSIVE, SCARD_PROTOCOL_T0, |
| &worker->reader.pcsc.hCard, &protocol); |
| if (rc == SCARD_S_SUCCESS) { |
| osmo_fsm_inst_state_chg(fi, SC_ST_CARD_PRESENT, T2_TIMEOUT_SECS, 2); |
| /* FIXME: inform client */ |
| } else { |
| /* schedule the next SCardConnect request */ |
| osmo_timer_schedule(&fi->timer, T1_TIMEOUT_SECS, 1); |
| } |
| } |
| |
| /* no card currently present; attempt to re-connect via timer if asked to */ |
| static void sc_st_card_absent(struct osmo_fsm_inst *fi, uint32_t event, void *data) |
| { |
| struct bankd_worker *worker = fi->priv; |
| const struct TpduModemToCard *mdm2sim; |
| const RsproPDU_t *pdu, *pdu_resp; |
| |
| switch (event) { |
| case SC_E_CONNECT_CMD: |
| attempt_sc_connect(fi); |
| break; |
| case SC_E_TPDU_CMD: |
| pdu = data; |
| mdm2sim = &pdu->msg.choice.tpduModemToCard; |
| /* reject transceiving the PDU; we're not connected */ |
| #if 0 |
| pdu_resp = rspro_gen_TpduCard2Modem(&mdm2sim->toBankSlot, &mdm2sim->fromClientSlot, |
| rx_buf, rx_buf_len); |
| worker_send_rspro(worker, pdu_resp); |
| #endif |
| break; |
| default: |
| OSMO_ASSERT(0); |
| } |
| } |
| |
| static void sc_st_card_present(struct osmo_fsm_inst *fi, uint32_t event, void *data) |
| { |
| struct bankd_worker *worker = fi->priv; |
| const RsproPDU_t *pdu; |
| LONG rc; |
| |
| switch (event) { |
| case SC_E_TPDU_CMD: |
| /* transceive an APDU */ |
| pdu = data; |
| worker_handle_tpduModemToCard(worker, pdu); |
| break; |
| case SC_E_DISCONNECT_CMD: |
| rc = SCardDisconnect(worker->reader.pcsc.hCard, SCARD_UNPOWER_CARD); |
| /* FIXME: evaluate rc */ |
| osmo_fsm_inst_state_chg(fi, SC_ST_CARD_ABSENT, 0, 0); |
| break; |
| default: |
| OSMO_ASSERT(0); |
| } |
| } |
| |
| static int sc_timer_cb(struct osmo_fsm_inst *fi) |
| { |
| struct bankd_worker *worker = fi->priv; |
| char reader_name[32]; |
| uint8_t atr[32]; |
| DWORD reader_state, protocol; |
| DWORD atr_len = sizeof(atr); |
| DWORD reader_name_len = sizeof(atr); |
| LONG rc; |
| |
| switch (fi->T) { |
| case 1: |
| attempt_sc_connect(fi); |
| break; |
| case 2: |
| /* another iteration of SCardStatus */ |
| rc = SCardStatus(worker->reader.pcsc.hCard, reader_name, &reader_name_len, |
| &reader_state, &protocol, atr, &atr_len); |
| if (rc == SCARD_S_SUCCESS) { |
| RsproPDU_t *pdu = NULL; |
| /* Determine any changes in state, and if so, report to client */ |
| if (reader_state != worker->reader.pcsc.dwState) { |
| worker->reader.pcsc.dwState = reader_state; |
| /* FIXME: inform client */ |
| //pdu = rspro_gen_SetAtrReq(foo, bar, worker->atr, worker->atr_len); |
| //worker_send_rspro(worker, pdu); |
| } |
| if (atr_len != worker->atr_len || memcmp(atr, worker->atr, atr_len)) { |
| ClientSlot_t clslot = client_slot2asn(&worker->client.clslot); |
| OSMO_ASSERT(atr_len < sizeof(worker->atr)); |
| memcpy(worker->atr, atr, atr_len); |
| worker->atr_len = atr_len; |
| /* inform client */ |
| pdu = rspro_gen_SetAtrReq(&clslot, worker->atr, worker->atr_len); |
| worker_send_rspro(worker, pdu); |
| } |
| /* schedule the next SCardStatus request */ |
| osmo_timer_schedule(&fi->timer, T2_TIMEOUT_SECS, 0); |
| } else |
| osmo_fsm_inst_state_chg(fi, SC_ST_CARD_ABSENT, T1_TIMEOUT_SECS, 1); |
| break; |
| default: |
| OSMO_ASSERT(0); |
| } |
| return 0; |
| } |
| |
| static const struct osmo_fsm_state sc_fsm_states[] = { |
| [SC_ST_CARD_ABSENT] = { |
| .in_event_mask = S(SC_E_CONNECT_CMD) | S(SC_E_DISCONNECT_CMD) | S(SC_E_TPDU_CMD), |
| .out_state_mask = S(SC_ST_CARD_PRESENT) | S(SC_ST_CARD_ABSENT), |
| .name = "CARD_ABSENT", |
| .action = sc_st_card_absent, |
| }, |
| [SC_ST_CARD_PRESENT] = { |
| .in_event_mask = S(SC_E_DISCONNECT_CMD) | S(SC_E_TPDU_CMD), |
| .out_state_mask = S(SC_ST_CARD_PRESENT) | S(SC_ST_CARD_ABSENT), |
| .name = "CART_PRESENT", |
| .action = sc_st_card_present, |
| }, |
| }; |
| |
| static struct osmo_fsm sc_fsm = { |
| .name = "SC", |
| .states = sc_fsm_states, |
| .num_states = ARRAY_SIZE(sc_fsm_states), |
| .timer_cb = sc_timer_cb, |
| .event_names = sc_fsm_event_names, |
| }; |
| |
| static bool fsm_initialized = false; |
| |
| struct osmo_fsm_inst *sc_fsm_alloc(struct bankd_worker *worker) |
| { |
| struct osmo_fsm_inst *fi; |
| char num[8]; |
| |
| if (!fsm_initialized) { |
| osmo_fsm_register(&sc_fsm); |
| fsm_initialized = true; |
| } |
| |
| snprintf(num, 8, "%d", worker->num); |
| |
| fi = osmo_fsm_inst_alloc(&sc_fsm, worker, worker, LOGL_DEBUG, num); |
| |
| osmo_fsm_inst_dispatch(fi, SC_E_CONNECT_CMD, NULL); |
| |
| return fi; |
| } |