blob: 8da82efa0431752400f69bf1a26b8e18e95bfa18 [file] [log] [blame]
Harald Welte879ee412020-02-14 14:21:33 +01001/* (C) 2018-2020 by Harald Welte <laforge@gnumonks.org>
Harald Welte3dcdd202019-03-09 13:06:46 +01002 *
3 * All Rights Reserved
4 *
5 * SPDX-License-Identifier: GPL-2.0+
6 *
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License as published by
9 * the Free Software Foundation; either version 2 of the License, or
10 * (at your option) any later version.
11 *
12 * This program is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU General Public License for more details.
16 *
Harald Welte3dcdd202019-03-09 13:06:46 +010017 */
Harald Welte2ff0ab92018-08-17 22:10:49 +020018
Harald Welte0e968cc2020-02-22 18:16:16 +010019/* This file contains code shared among all remsim client applications,
20 * including the ifd-handler, which is not an executable program with a main()
21 * function or command line parsing, but a shared library */
22
Harald Welte2ff0ab92018-08-17 22:10:49 +020023#include <errno.h>
24#include <string.h>
Harald Welte228af8a2019-03-08 22:20:21 +010025
Harald Welte2ff0ab92018-08-17 22:10:49 +020026#include <talloc.h>
27
Harald Welte2ff0ab92018-08-17 22:10:49 +020028#include <osmocom/core/fsm.h>
29#include <osmocom/core/utils.h>
30#include <osmocom/core/logging.h>
Harald Welte2ff0ab92018-08-17 22:10:49 +020031
32#include "rspro_util.h"
Harald Welte24173fb2018-08-24 20:37:28 +020033#include "client.h"
Harald Welte61d98e92019-03-03 15:43:07 +010034#include "debug.h"
Harald Welte2ff0ab92018-08-17 22:10:49 +020035
Harald Welte0e968cc2020-02-22 18:16:16 +010036struct client_config *client_config_init(void *ctx)
37{
38 struct client_config *cfg = talloc_zero(ctx, struct client_config);
39 if (!cfg)
40 return NULL;
41
42 cfg->server_host = talloc_strdup(cfg, "127.0.0.1");
43 cfg->server_port = 9998;
44 cfg->client_id = -1;
45 cfg->client_slot = -1;
46 cfg->gsmtap_host = talloc_strdup(cfg, "127.0.0.1");
47 cfg->keep_running = false;
48
49 cfg->usb.vendor_id = -1;
50 cfg->usb.product_id = -1;
51 cfg->usb.config_id = -1;
52 cfg->usb.if_num = -1;
53 cfg->usb.altsetting = 0;
54 cfg->usb.addr = -1;
55 cfg->usb.path = NULL;
56
57 cfg->atr.data[0] = 0x3B;
58 cfg->atr.data[1] = 0x00; // the shortest simplest ATR possible
59 cfg->atr.len = 2;
60
61 return cfg;
62};
63
Harald Welted5a87292020-02-13 16:44:56 +010064static int bankd_handle_rx(struct rspro_server_conn *bankdc, const RsproPDU_t *pdu)
Harald Welte2ff0ab92018-08-17 22:10:49 +020065{
Harald Welte0e968cc2020-02-22 18:16:16 +010066 struct bankd_client *bc = bankdc2bankd_client(bankdc);
67
Harald Welte24173fb2018-08-24 20:37:28 +020068 switch (pdu->msg.present) {
69 case RsproPDUchoice_PR_connectClientRes:
Harald Weltee56f2b92019-03-02 17:02:13 +010070 /* Store 'identity' of bankd to in peer_comp_id */
Harald Welted5a87292020-02-13 16:44:56 +010071 rspro_comp_id_retrieve(&bankdc->peer_comp_id, &pdu->msg.choice.connectClientRes.identity);
72 osmo_fsm_inst_dispatch(bankdc->fi, SRVC_E_CLIENT_CONN_RES, (void *) pdu);
Harald Welte24173fb2018-08-24 20:37:28 +020073 break;
Harald Welted5a87292020-02-13 16:44:56 +010074 case RsproPDUchoice_PR_tpduCardToModem:
Harald Welte0e968cc2020-02-22 18:16:16 +010075 return osmo_fsm_inst_dispatch(bc->main_fi, MF_E_BANKD_TPDU, (void *) pdu);
Harald Welted5a87292020-02-13 16:44:56 +010076 case RsproPDUchoice_PR_setAtrReq:
Harald Welte0e968cc2020-02-22 18:16:16 +010077 return osmo_fsm_inst_dispatch(bc->main_fi, MF_E_BANKD_ATR, (void *) pdu);
78 case RsproPDUchoice_PR_bankSlotStatusInd:
79 return osmo_fsm_inst_dispatch(bc->main_fi, MF_E_BANKD_SLOT_STATUS, (void *) pdu);
Harald Welte24173fb2018-08-24 20:37:28 +020080 default:
Harald Welted5a87292020-02-13 16:44:56 +010081 LOGPFSML(bankdc->fi, LOGL_ERROR, "Unknown/Unsupported RSPRO PDU %s\n",
82 rspro_msgt_name(pdu));
Harald Welte24173fb2018-08-24 20:37:28 +020083 return -1;
84 }
85
86 return 0;
Harald Welte2ff0ab92018-08-17 22:10:49 +020087}
88
Harald Weltee56f2b92019-03-02 17:02:13 +010089/* handle incoming messages from server */
90static int srvc_handle_rx(struct rspro_server_conn *srvc, const RsproPDU_t *pdu)
91{
Harald Welte8e46ab62020-02-14 12:55:43 +010092 struct bankd_client *bc = srvc2bankd_client(srvc);
Harald Weltee56f2b92019-03-02 17:02:13 +010093 RsproPDU_t *resp;
94
95 switch (pdu->msg.present) {
96 case RsproPDUchoice_PR_connectClientRes:
97 /* Store 'identity' of server in srvc->peer_comp_id */
98 rspro_comp_id_retrieve(&srvc->peer_comp_id, &pdu->msg.choice.connectClientRes.identity);
99 osmo_fsm_inst_dispatch(srvc->fi, SRVC_E_CLIENT_CONN_RES, (void *) pdu);
100 break;
Harald Welted571a3e2019-03-11 22:09:50 +0100101 case RsproPDUchoice_PR_configClientIdReq:
Harald Weltee56f2b92019-03-02 17:02:13 +0100102 /* store/set the clientID as instructed by the server */
Harald Welte8e46ab62020-02-14 12:55:43 +0100103 if (!srvc->clslot)
104 srvc->clslot = talloc_zero(srvc, ClientSlot_t);
105 *srvc->clslot = pdu->msg.choice.configClientIdReq.clientSlot;
106 if (!bc->bankd_conn.clslot)
107 bc->bankd_conn.clslot = talloc_zero(bc, ClientSlot_t);
108 *bc->bankd_conn.clslot = *bc->srv_conn.clslot;
Harald Welted571a3e2019-03-11 22:09:50 +0100109 /* send response to server */
110 resp = rspro_gen_ConfigClientIdRes(ResultCode_ok);
111 server_conn_send_rspro(srvc, resp);
112 break;
113 case RsproPDUchoice_PR_configClientBankReq:
Harald Welte0e968cc2020-02-22 18:16:16 +0100114 osmo_fsm_inst_dispatch(bc->main_fi, MF_E_SRVC_CONFIG_BANK, (void *) pdu);
Harald Weltee56f2b92019-03-02 17:02:13 +0100115 break;
116 default:
Harald Welte8d8d4f12019-03-27 22:50:39 +0100117 LOGPFSML(srvc->fi, LOGL_ERROR, "Unknown/Unsupported RSPRO PDU type: %s\n",
118 rspro_msgt_name(pdu));
Harald Weltee56f2b92019-03-02 17:02:13 +0100119 return -1;
120 }
121
122 return 0;
123}
124
Harald Welte0e968cc2020-02-22 18:16:16 +0100125struct bankd_client *remsim_client_create(void *ctx, const char *name, const char *software,
126 struct client_config *cfg)
Harald Welte879ee412020-02-14 14:21:33 +0100127{
128 struct bankd_client *bc = talloc_zero(ctx, struct bankd_client);
129 struct rspro_server_conn *srvc, *bankdc;
130 int rc;
131
132 if (!bc)
133 return NULL;
134
Harald Welte0e968cc2020-02-22 18:16:16 +0100135 bc->cfg = cfg;
136
137 bc->main_fi = main_fsm_alloc(bc, bc);
138 if (!bc->main_fi) {
Harald Welte7293e7b2021-12-08 21:29:11 +0100139 LOGP(DMAIN, LOGL_FATAL, "Unable to create main client FSM: %s\n", strerror(errno));
Harald Welte0e968cc2020-02-22 18:16:16 +0100140 exit(1);
141 }
142
143 remsim_client_set_clslot(bc, cfg->client_id, cfg->client_slot);
144
Harald Welte879ee412020-02-14 14:21:33 +0100145 /* create and [attempt to] establish connection to remsim-server */
146 srvc = &bc->srv_conn;
Harald Welte0e968cc2020-02-22 18:16:16 +0100147 srvc->server_host = cfg->server_host;
148 srvc->server_port = cfg->server_port;
Harald Welte879ee412020-02-14 14:21:33 +0100149 srvc->handle_rx = srvc_handle_rx;
150 srvc->own_comp_id.type = ComponentType_remsimClient;
151 OSMO_STRLCPY_ARRAY(srvc->own_comp_id.name, name);
152 OSMO_STRLCPY_ARRAY(srvc->own_comp_id.software, software);
153 OSMO_STRLCPY_ARRAY(srvc->own_comp_id.sw_version, PACKAGE_VERSION);
154
155 rc = server_conn_fsm_alloc(bc, srvc);
156 if (rc < 0) {
Harald Welte7293e7b2021-12-08 21:29:11 +0100157 LOGP(DMAIN, LOGL_FATAL, "Unable to create Server conn FSM: %s\n", strerror(errno));
Harald Welte879ee412020-02-14 14:21:33 +0100158 exit(1);
159 }
Harald Welte0e968cc2020-02-22 18:16:16 +0100160 osmo_fsm_inst_change_parent(srvc->fi, bc->main_fi, MF_E_SRVC_LOST);
161 srvc->parent_conn_evt = MF_E_SRVC_CONNECTED;
162 srvc->parent_disc_evt = MF_E_SRVC_LOST;
Harald Welte879ee412020-02-14 14:21:33 +0100163
164 bankdc = &bc->bankd_conn;
165 /* server_host / server_port are configured from remsim-server */
166 bankdc->handle_rx = bankd_handle_rx;
167 memcpy(&bankdc->own_comp_id, &srvc->own_comp_id, sizeof(bankdc->own_comp_id));
168 rc = server_conn_fsm_alloc(bc, bankdc);
169 if (rc < 0) {
Harald Welte7293e7b2021-12-08 21:29:11 +0100170 LOGP(DMAIN, LOGL_FATAL, "Unable to connect bankd conn FSM: %s\n", strerror(errno));
Harald Welte879ee412020-02-14 14:21:33 +0100171 exit(1);
172 }
173 osmo_fsm_inst_update_id(bankdc->fi, "bankd");
Harald Welte0e968cc2020-02-22 18:16:16 +0100174 osmo_fsm_inst_change_parent(bankdc->fi, bc->main_fi, MF_E_BANKD_LOST);
175 bankdc->parent_conn_evt = MF_E_BANKD_CONNECTED;
176 bankdc->parent_disc_evt = MF_E_BANKD_LOST;
Harald Welte879ee412020-02-14 14:21:33 +0100177
178 return bc;
179}
180
181void remsim_client_set_clslot(struct bankd_client *bc, int client_id, int slot_nr)
182{
183 if (!bc->srv_conn.clslot) {
184 bc->srv_conn.clslot = talloc_zero(bc, ClientSlot_t);
185 OSMO_ASSERT(bc->srv_conn.clslot);
186 }
187
188 if (!bc->bankd_conn.clslot) {
189 bc->bankd_conn.clslot = talloc_zero(bc, ClientSlot_t);
190 OSMO_ASSERT(bc->bankd_conn.clslot);
191 }
192
193 if (client_id >= 0) {
194 bc->srv_conn.clslot->clientId = client_id;
195 bc->bankd_conn.clslot->clientId = client_id;
196 }
197
198 if (slot_nr >= 0) {
199 bc->srv_conn.clslot->slotNr = slot_nr;
200 bc->bankd_conn.clslot->slotNr = slot_nr;
201 }
202}