client: Add new osmo-remsim-client-shell binary
This is a remsim-client with an interactive 'shell', where the user can type in C-APDUs in hex formats, which will be sent to the bankd / SIM-card. Responses received from SIM Card via bankd will be printed in return. Change-Id: I636505fd9741833ccf5cbd1bcac30f7b9aa94425
This commit is contained in:
parent
d5a8729291
commit
1200c820f0
|
@ -4,10 +4,11 @@ AM_CFLAGS = -Wall -I$(top_srcdir)/include -I/$(top_builddir)/include -I$(top_src
|
||||||
$(OSMOSIMTRACE2_CFLAGS) \
|
$(OSMOSIMTRACE2_CFLAGS) \
|
||||||
-I$(top_srcdir)/include/osmocom/rspro
|
-I$(top_srcdir)/include/osmocom/rspro
|
||||||
|
|
||||||
bin_PROGRAMS = osmo-remsim-client-st2 remsim-client
|
bin_PROGRAMS = osmo-remsim-client-st2 osmo-remsim-client-shell
|
||||||
|
|
||||||
remsim_client_SOURCES = remsim_client.c ../rspro_client_fsm.c ../debug.c
|
osmo_remsim_client_shell_SOURCES = user_shell.c \
|
||||||
remsim_client_LDADD = $(OSMOCORE_LIBS) $(OSMOGSM_LIBS) $(OSMOABIS_LIBS) \
|
remsim_client.c ../rspro_client_fsm.c ../debug.c
|
||||||
|
osmo_remsim_client_shell_LDADD = $(OSMOCORE_LIBS) $(OSMOGSM_LIBS) $(OSMOABIS_LIBS) \
|
||||||
$(top_builddir)/src/libosmo-rspro.la
|
$(top_builddir)/src/libosmo-rspro.la
|
||||||
|
|
||||||
osmo_remsim_client_st2_SOURCES = simtrace2-remsim_client.c \
|
osmo_remsim_client_st2_SOURCES = simtrace2-remsim_client.c \
|
||||||
|
|
|
@ -56,3 +56,10 @@ struct bankd_client {
|
||||||
struct client_config *cfg;
|
struct client_config *cfg;
|
||||||
struct cardem_inst *cardem;
|
struct cardem_inst *cardem;
|
||||||
};
|
};
|
||||||
|
|
||||||
|
|
||||||
|
extern struct bankd_client *g_client;
|
||||||
|
|
||||||
|
extern int client_user_bankd_handle_rx(struct rspro_server_conn *bankdc, const RsproPDU_t *pdu);
|
||||||
|
|
||||||
|
extern int client_user_main(struct bankd_client *g_client);
|
||||||
|
|
|
@ -52,6 +52,7 @@ static int bankd_handle_rx(struct rspro_server_conn *bankdc, const RsproPDU_t *p
|
||||||
break;
|
break;
|
||||||
case RsproPDUchoice_PR_tpduCardToModem:
|
case RsproPDUchoice_PR_tpduCardToModem:
|
||||||
case RsproPDUchoice_PR_setAtrReq:
|
case RsproPDUchoice_PR_setAtrReq:
|
||||||
|
return client_user_bankd_handle_rx(bankdc, pdu);
|
||||||
default:
|
default:
|
||||||
LOGPFSML(bankdc->fi, LOGL_ERROR, "Unknown/Unsupported RSPRO PDU %s\n",
|
LOGPFSML(bankdc->fi, LOGL_ERROR, "Unknown/Unsupported RSPRO PDU %s\n",
|
||||||
rspro_msgt_name(pdu));
|
rspro_msgt_name(pdu));
|
||||||
|
@ -61,7 +62,7 @@ static int bankd_handle_rx(struct rspro_server_conn *bankdc, const RsproPDU_t *p
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
static struct bankd_client *g_client;
|
struct bankd_client *g_client;
|
||||||
static void *g_tall_ctx;
|
static void *g_tall_ctx;
|
||||||
void __thread *talloc_asn1_ctx;
|
void __thread *talloc_asn1_ctx;
|
||||||
int asn_debug;
|
int asn_debug;
|
||||||
|
@ -161,7 +162,7 @@ static void handle_options(int argc, char **argv)
|
||||||
g_client->srv_conn.clslot = talloc_zero(g_client, ClientSlot_t);
|
g_client->srv_conn.clslot = talloc_zero(g_client, ClientSlot_t);
|
||||||
g_client->srv_conn.clslot->clientId = atoi(optarg);
|
g_client->srv_conn.clslot->clientId = atoi(optarg);
|
||||||
break;
|
break;
|
||||||
case 's':
|
case 'n':
|
||||||
if (!g_client->srv_conn.clslot)
|
if (!g_client->srv_conn.clslot)
|
||||||
g_client->srv_conn.clslot = talloc_zero(g_client, ClientSlot_t);
|
g_client->srv_conn.clslot = talloc_zero(g_client, ClientSlot_t);
|
||||||
g_client->srv_conn.clslot->slotNr = atoi(optarg);
|
g_client->srv_conn.clslot->slotNr = atoi(optarg);
|
||||||
|
@ -185,6 +186,7 @@ int main(int argc, char **argv)
|
||||||
|
|
||||||
g_client = talloc_zero(g_tall_ctx, struct bankd_client);
|
g_client = talloc_zero(g_tall_ctx, struct bankd_client);
|
||||||
|
|
||||||
|
/* create and [attempt to] establish connection to remsim-server */
|
||||||
srvc = &g_client->srv_conn;
|
srvc = &g_client->srv_conn;
|
||||||
srvc->server_host = "localhost";
|
srvc->server_host = "localhost";
|
||||||
srvc->server_port = 9998;
|
srvc->server_port = 9998;
|
||||||
|
@ -208,6 +210,11 @@ int main(int argc, char **argv)
|
||||||
asn_debug = 0;
|
asn_debug = 0;
|
||||||
|
|
||||||
bankdc = &g_client->bankd_conn;
|
bankdc = &g_client->bankd_conn;
|
||||||
|
if (srvc->clslot) {
|
||||||
|
bankdc->clslot = talloc_zero(g_client, ClientSlot_t);
|
||||||
|
*bankdc->clslot = *srvc->clslot;
|
||||||
|
}
|
||||||
|
|
||||||
/* server_host / server_port are configured from remsim-server */
|
/* server_host / server_port are configured from remsim-server */
|
||||||
bankdc->handle_rx = bankd_handle_rx;
|
bankdc->handle_rx = bankd_handle_rx;
|
||||||
memcpy(&bankdc->own_comp_id, &srvc->own_comp_id, sizeof(bankdc->own_comp_id));
|
memcpy(&bankdc->own_comp_id, &srvc->own_comp_id, sizeof(bankdc->own_comp_id));
|
||||||
|
@ -216,8 +223,7 @@ int main(int argc, char **argv)
|
||||||
fprintf(stderr, "Unable to connect bankd conn FSM: %s\n", strerror(errno));
|
fprintf(stderr, "Unable to connect bankd conn FSM: %s\n", strerror(errno));
|
||||||
exit(1);
|
exit(1);
|
||||||
}
|
}
|
||||||
|
osmo_fsm_inst_update_id(bankdc->fi, "bankd");
|
||||||
|
|
||||||
while (1) {
|
client_user_main(g_client);
|
||||||
osmo_select_main(0);
|
|
||||||
}
|
|
||||||
}
|
}
|
||||||
|
|
|
@ -94,7 +94,7 @@ struct cardem_inst {
|
||||||
/* global GSMTAP instance */
|
/* global GSMTAP instance */
|
||||||
static struct gsmtap_inst *g_gti;
|
static struct gsmtap_inst *g_gti;
|
||||||
|
|
||||||
static struct bankd_client *g_client;
|
struct bankd_client *g_client;
|
||||||
static void *g_tall_ctx;
|
static void *g_tall_ctx;
|
||||||
void __thread *talloc_asn1_ctx;
|
void __thread *talloc_asn1_ctx;
|
||||||
int asn_debug;
|
int asn_debug;
|
||||||
|
|
|
@ -0,0 +1,159 @@
|
||||||
|
#include <errno.h>
|
||||||
|
#include <unistd.h>
|
||||||
|
|
||||||
|
#include <osmocom/core/select.h>
|
||||||
|
|
||||||
|
#include "client.h"
|
||||||
|
|
||||||
|
/* This is a remsim-client with an interactive 'shell', where the user
|
||||||
|
* can type in C-APDUs in hex formats, which will be sent to the bankd /
|
||||||
|
* SIM-card. Responses received from SIM Card via bankd will be printed
|
||||||
|
* in return. */
|
||||||
|
|
||||||
|
|
||||||
|
/***********************************************************************
|
||||||
|
* Incoming RSPRO messages from bank-daemon (SIM card)
|
||||||
|
***********************************************************************/
|
||||||
|
|
||||||
|
static int bankd_handle_tpduCardToModem(struct bankd_client *bc, const RsproPDU_t *pdu)
|
||||||
|
{
|
||||||
|
OSMO_ASSERT(pdu);
|
||||||
|
OSMO_ASSERT(RsproPDUchoice_PR_tpduCardToModem == pdu->msg.present);
|
||||||
|
|
||||||
|
const struct TpduCardToModem *card2modem = &pdu->msg.choice.tpduCardToModem;
|
||||||
|
|
||||||
|
printf("R-APDU: %s\n", osmo_hexdump(card2modem->data.buf, card2modem->data.size));
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int bankd_handle_setAtrReq(struct bankd_client *bc, const RsproPDU_t *pdu)
|
||||||
|
{
|
||||||
|
RsproPDU_t *resp;
|
||||||
|
|
||||||
|
OSMO_ASSERT(pdu);
|
||||||
|
OSMO_ASSERT(RsproPDUchoice_PR_setAtrReq == pdu->msg.present);
|
||||||
|
|
||||||
|
printf("SET_ATR: %s\n", osmo_hexdump(pdu->msg.choice.setAtrReq.atr.buf,
|
||||||
|
pdu->msg.choice.setAtrReq.atr.size));
|
||||||
|
|
||||||
|
resp = rspro_gen_SetAtrRes(ResultCode_ok);
|
||||||
|
if (!resp)
|
||||||
|
return -ENOMEM;
|
||||||
|
server_conn_send_rspro(&bc->bankd_conn, resp);
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
int client_user_bankd_handle_rx(struct rspro_server_conn *bankdc, const RsproPDU_t *pdu)
|
||||||
|
{
|
||||||
|
switch (pdu->msg.present) {
|
||||||
|
case RsproPDUchoice_PR_tpduCardToModem:
|
||||||
|
bankd_handle_tpduCardToModem(g_client, pdu);
|
||||||
|
break;
|
||||||
|
case RsproPDUchoice_PR_setAtrReq:
|
||||||
|
bankd_handle_setAtrReq(g_client, pdu);
|
||||||
|
break;
|
||||||
|
default:
|
||||||
|
OSMO_ASSERT(0);
|
||||||
|
}
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
/***********************************************************************
|
||||||
|
* Incoming command from the user application (stdin shell in our case)
|
||||||
|
***********************************************************************/
|
||||||
|
|
||||||
|
struct stdin_state {
|
||||||
|
struct osmo_fd ofd;
|
||||||
|
struct msgb *rx_msg;
|
||||||
|
};
|
||||||
|
|
||||||
|
/* called every time a command on stdin was received */
|
||||||
|
static void handle_stdin_command(struct stdin_state *ss, char *cmd)
|
||||||
|
{
|
||||||
|
RsproPDU_t *pdu;
|
||||||
|
BankSlot_t bslot;
|
||||||
|
uint8_t buf[1024];
|
||||||
|
int rc;
|
||||||
|
|
||||||
|
bank_slot2rspro(&bslot, &g_client->bankd_slot);
|
||||||
|
|
||||||
|
OSMO_ASSERT(ss->rx_msg);
|
||||||
|
|
||||||
|
printf("stdin: `%s'\n", cmd);
|
||||||
|
|
||||||
|
if (!strcasecmp(cmd, "RESET")) {
|
||||||
|
/* reset the [remote] card */
|
||||||
|
pdu = rspro_gen_ClientSlotStatusInd(g_client->srv_conn.clslot, &bslot,
|
||||||
|
true, false, false, true);
|
||||||
|
server_conn_send_rspro(&g_client->bankd_conn, pdu);
|
||||||
|
} else {
|
||||||
|
/* we assume the user has entered a C-APDU as hex string. parse + send */
|
||||||
|
rc = osmo_hexparse(cmd, buf, sizeof(buf));
|
||||||
|
if (rc < 0) {
|
||||||
|
fprintf(stderr, "ERROR parsing C-APDU `%s'!\n", cmd);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
if (!g_client->srv_conn.clslot) {
|
||||||
|
fprintf(stderr, "Cannot send command; no client slot\n");
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Send CMD APDU to [remote] card */
|
||||||
|
pdu = rspro_gen_TpduModem2Card(g_client->srv_conn.clslot, &bslot, buf, rc);
|
||||||
|
server_conn_send_rspro(&g_client->bankd_conn, pdu);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
/* call-back function for stdin read. Gather bytes in buffer until CR/LF received */
|
||||||
|
static int stdin_fd_cb(struct osmo_fd *ofd, unsigned int what)
|
||||||
|
{
|
||||||
|
struct stdin_state *ss = ofd->data;
|
||||||
|
char *cur;
|
||||||
|
int rc, i;
|
||||||
|
|
||||||
|
OSMO_ASSERT(what & OSMO_FD_READ);
|
||||||
|
|
||||||
|
if (!ss->rx_msg) {
|
||||||
|
ss->rx_msg = msgb_alloc(1024, "stdin");
|
||||||
|
OSMO_ASSERT(ss->rx_msg);
|
||||||
|
}
|
||||||
|
|
||||||
|
cur = (char *) ss->rx_msg->tail;
|
||||||
|
rc = read(ofd->fd, cur, msgb_tailroom(ss->rx_msg));
|
||||||
|
if (rc < 0)
|
||||||
|
return rc;
|
||||||
|
msgb_put(ss->rx_msg, rc);
|
||||||
|
|
||||||
|
for (i = 0; i < rc; i++) {
|
||||||
|
if (cur[i] == '\r' || cur[i] == '\n') {
|
||||||
|
cur[i] = '\0';
|
||||||
|
/* dispatch the command */
|
||||||
|
handle_stdin_command(ss, cur);
|
||||||
|
/* FIXME: possibly other commands */
|
||||||
|
msgb_free(ss->rx_msg);
|
||||||
|
ss->rx_msg = NULL;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
/* main function */
|
||||||
|
int client_user_main(struct bankd_client *g_client)
|
||||||
|
{
|
||||||
|
struct stdin_state ss;
|
||||||
|
|
||||||
|
/* register stdin file descriptor with osmocom select loop abstraction */
|
||||||
|
memset(&ss, 0, sizeof(ss));
|
||||||
|
osmo_fd_setup(&ss.ofd, fileno(stdin), OSMO_FD_READ, &stdin_fd_cb, &ss, 0);
|
||||||
|
osmo_fd_register(&ss.ofd);
|
||||||
|
|
||||||
|
while (1) {
|
||||||
|
osmo_select_main(0);
|
||||||
|
}
|
||||||
|
}
|
Loading…
Reference in New Issue