blob: f4e09e6ba23d3ee27b1cc8e7cda5df3960420645 [file] [log] [blame]
Harald Weltef5a0fa32019-03-03 15:44:18 +01001#include <stdint.h>
2#include <string.h>
3#include <unistd.h>
4#include <pthread.h>
5
6#include <osmocom/core/linuxlist.h>
7#include <osmocom/core/select.h>
8#include <osmocom/core/fsm.h>
9#include <osmocom/core/logging.h>
10#include <osmocom/core/socket.h>
11#include <osmocom/gsm/protocol/ipaccess.h>
12#include <osmocom/abis/ipa.h>
13
14#include <osmocom/rspro/RsproPDU.h>
15
16#include "debug.h"
17#include "rspro_util.h"
18#include "rspro_server.h"
19
20#define S(x) (1 << (x))
21
Harald Weltef5a0fa32019-03-03 15:44:18 +010022static RsproPDU_t *slotmap2CreateMappingReq(const struct slot_mapping *slotmap)
23{
24 ClientSlot_t clslot;
25 BankSlot_t bslot;
26
27 client_slot2rspro(&clslot, &slotmap->client);
28 bank_slot2rspro(&bslot, &slotmap->bank);
29
30 return rspro_gen_CreateMappingReq(&clslot, &bslot);
31}
32
33static RsproPDU_t *slotmap2RemoveMappingReq(const struct slot_mapping *slotmap)
34{
35 ClientSlot_t clslot;
36 BankSlot_t bslot;
37
38 client_slot2rspro(&clslot, &slotmap->client);
39 bank_slot2rspro(&bslot, &slotmap->bank);
40
41 return rspro_gen_RemoveMappingReq(&clslot, &bslot);
42}
43
44
45static void client_conn_send(struct rspro_client_conn *conn, RsproPDU_t *pdu)
46{
47 struct msgb *msg_tx = rspro_enc_msg(pdu);
48 if (!msg_tx) {
49 ASN_STRUCT_FREE(asn_DEF_RsproPDU, pdu);
50 return;
51 }
Harald Welteba781c02019-03-30 17:32:53 +010052 LOGPFSM(conn->fi, "Tx RSPRO %s\n", rspro_msgt_name(pdu));
Harald Weltef5a0fa32019-03-03 15:44:18 +010053 ipa_prepend_header_ext(msg_tx, IPAC_PROTO_EXT_RSPRO);
54 ipa_msg_push_header(msg_tx, IPAC_PROTO_OSMO);
55 ipa_server_conn_send(conn->peer, msg_tx);
56}
57
58
59/***********************************************************************
60 * per-client connection FSM
61 ***********************************************************************/
62
63static void rspro_client_conn_destroy(struct rspro_client_conn *conn);
64
65enum remsim_server_client_fsm_state {
66 CLNTC_ST_INIT,
67 CLNTC_ST_ESTABLISHED,
Harald Weltee5c77732019-03-07 23:58:24 +010068 CLNTC_ST_WAIT_CONF_RES, /* waiting for ConfigClientRes */
Harald Welte0a64da62019-03-30 17:38:04 +010069 CLNTC_ST_CONNECTED_BANKD,
70 CLNTC_ST_CONNECTED_CLIENT,
Harald Weltef5a0fa32019-03-03 15:44:18 +010071};
72
73enum remsim_server_client_event {
74 CLNTC_E_TCP_UP,
75 CLNTC_E_CLIENT_CONN, /* Connect{Client,Bank}Req received */
76 CLNTC_E_BANK_CONN,
77 CLNTC_E_TCP_DOWN,
Harald Welte15b75e12019-03-08 16:55:46 +010078 CLNTC_E_KA_TIMEOUT,
Harald Weltef5a0fa32019-03-03 15:44:18 +010079 CLNTC_E_CREATE_MAP_RES, /* CreateMappingRes received */
80 CLNTC_E_REMOVE_MAP_RES, /* RemoveMappingRes received */
Harald Weltee5c77732019-03-07 23:58:24 +010081 CLNTC_E_CONFIG_CL_RES, /* ConfigClientRes received */
Harald Weltef5a0fa32019-03-03 15:44:18 +010082 CLNTC_E_PUSH, /* drain maps_new or maps_delreq */
83};
84
85static const struct value_string server_client_event_names[] = {
86 OSMO_VALUE_STRING(CLNTC_E_TCP_UP),
87 OSMO_VALUE_STRING(CLNTC_E_CLIENT_CONN),
88 OSMO_VALUE_STRING(CLNTC_E_BANK_CONN),
89 OSMO_VALUE_STRING(CLNTC_E_TCP_DOWN),
Harald Welte15b75e12019-03-08 16:55:46 +010090 OSMO_VALUE_STRING(CLNTC_E_KA_TIMEOUT),
Harald Weltef5a0fa32019-03-03 15:44:18 +010091 OSMO_VALUE_STRING(CLNTC_E_CREATE_MAP_RES),
92 OSMO_VALUE_STRING(CLNTC_E_REMOVE_MAP_RES),
Harald Weltee5c77732019-03-07 23:58:24 +010093 OSMO_VALUE_STRING(CLNTC_E_CONFIG_CL_RES),
Harald Weltef5a0fa32019-03-03 15:44:18 +010094 OSMO_VALUE_STRING(CLNTC_E_PUSH),
95 { 0, NULL }
96};
97
98static void clnt_st_init(struct osmo_fsm_inst *fi, uint32_t event, void *data)
99{
100 switch (event) {
101 case CLNTC_E_TCP_UP:
102 osmo_fsm_inst_state_chg(fi, CLNTC_ST_ESTABLISHED, 10, 1);
103 break;
104 default:
105 OSMO_ASSERT(0);
106 }
107}
108
109static void clnt_st_established(struct osmo_fsm_inst *fi, uint32_t event, void *data)
110{
111 struct rspro_client_conn *conn = fi->priv;
112 const RsproPDU_t *pdu = data;
113 const ConnectClientReq_t *cclreq = NULL;
114 const ConnectBankReq_t *cbreq = NULL;
115 RsproPDU_t *resp = NULL;
116
117 switch (event) {
118 case CLNTC_E_CLIENT_CONN:
119 cclreq = &pdu->msg.choice.connectClientReq;
120 /* save the [remote] component identity in 'conn' */
121 rspro_comp_id_retrieve(&conn->comp_id, &cclreq->identity);
122 if (conn->comp_id.type != ComponentType_remsimClient) {
123 LOGPFSM(fi, "ConnectClientReq from identity != Client ?!?\n");
124 osmo_fsm_inst_term(fi, OSMO_FSM_TERM_ERROR, NULL);
125 }
Harald Weltee5c77732019-03-07 23:58:24 +0100126 if (!cclreq->clientSlot) {
127#if 0
128 /* FIXME: determine ClientID */
129 resp = rspro_gen_ConnectClientRes(&conn->srv->comp_id, ResultCode_ok);
130 client_conn_send(conn, resp);
131 osmo_fsm_inst_state_chg(fi, CLNTC_ST_WAIT_CL_CONF_RES, 3, 30);
132#else
133 /* FIXME: the original plan was to dynamically assign a ClientID
134 * from server to client here. Send ConfigReq and transition to
135 * CLNTC_ST_WAIT_CONF_RES */
136 LOGPFSM(fi, "ConnectClientReq without ClientId not supported yet!\n");
137 osmo_fsm_inst_term(fi, OSMO_FSM_TERM_ERROR, NULL);
138#endif
139 } else {
140 /* FIXME: check for unique-ness */
141 rspro2client_slot(&conn->client.slot, cclreq->clientSlot);
142 osmo_fsm_inst_update_id_f(fi, "C%u:%u", conn->client.slot.client_id,
143 conn->client.slot.slot_nr);
144 resp = rspro_gen_ConnectClientRes(&conn->srv->comp_id, ResultCode_ok);
145 client_conn_send(conn, resp);
Harald Welte0a64da62019-03-30 17:38:04 +0100146 osmo_fsm_inst_state_chg(fi, CLNTC_ST_CONNECTED_CLIENT, 0, 0);
Harald Weltee5c77732019-03-07 23:58:24 +0100147 }
Harald Weltef5a0fa32019-03-03 15:44:18 +0100148
149 /* reparent us from srv->connections to srv->clients */
150 pthread_rwlock_wrlock(&conn->srv->rwlock);
151 llist_del(&conn->list);
152 llist_add_tail(&conn->list, &conn->srv->clients);
153 pthread_rwlock_unlock(&conn->srv->rwlock);
Harald Weltef5a0fa32019-03-03 15:44:18 +0100154 break;
155 case CLNTC_E_BANK_CONN:
156 cbreq = &pdu->msg.choice.connectBankReq;
157 /* save the [remote] component identity in 'conn' */
158 rspro_comp_id_retrieve(&conn->comp_id, &cbreq->identity);
159 if (conn->comp_id.type != ComponentType_remsimBankd) {
160 LOGPFSM(fi, "ConnectBankReq from identity != Bank ?!?\n");
161 osmo_fsm_inst_term(fi, OSMO_FSM_TERM_ERROR, NULL);
162 }
Harald Weltee5c77732019-03-07 23:58:24 +0100163 /* FIXME: check for unique-ness */
Harald Weltef5a0fa32019-03-03 15:44:18 +0100164 conn->bank.bank_id = cbreq->bankId;
165 conn->bank.num_slots = cbreq->numberOfSlots;
166 osmo_fsm_inst_update_id_f(fi, "B%u", conn->bank.bank_id);
167
168 /* reparent us from srv->connections to srv->banks */
169 pthread_rwlock_wrlock(&conn->srv->rwlock);
170 llist_del(&conn->list);
171 llist_add_tail(&conn->list, &conn->srv->banks);
172 pthread_rwlock_unlock(&conn->srv->rwlock);
173
174 /* send response to bank first */
175 resp = rspro_gen_ConnectBankRes(&conn->srv->comp_id, ResultCode_ok);
176 client_conn_send(conn, resp);
177
178 /* the state change will associate any pre-existing slotmaps */
Harald Welte0a64da62019-03-30 17:38:04 +0100179 osmo_fsm_inst_state_chg(fi, CLNTC_ST_CONNECTED_BANKD, 0, 0);
Harald Weltef5a0fa32019-03-03 15:44:18 +0100180
181 osmo_fsm_inst_dispatch(fi, CLNTC_E_PUSH, NULL);
182 break;
183 default:
184 OSMO_ASSERT(0);
185 }
186}
187
Harald Weltee5c77732019-03-07 23:58:24 +0100188static void clnt_st_wait_cl_conf_res(struct osmo_fsm_inst *fi, uint32_t event, void *data)
189{
190 switch (event) {
191 case CLNTC_E_CONFIG_CL_RES:
Harald Welte0a64da62019-03-30 17:38:04 +0100192 osmo_fsm_inst_state_chg(fi, CLNTC_ST_CONNECTED_CLIENT, 0, 0);
Harald Weltee5c77732019-03-07 23:58:24 +0100193 break;
194 default:
195 OSMO_ASSERT(0);
196 }
197}
Harald Weltef5a0fa32019-03-03 15:44:18 +0100198
Harald Welte0a64da62019-03-30 17:38:04 +0100199static void clnt_st_connected_client_onenter(struct osmo_fsm_inst *fi, uint32_t prev_state)
Harald Weltef5a0fa32019-03-03 15:44:18 +0100200{
201#if 0
202 struct rspro_client_conn *conn = fi->priv;
203 ClientSlot_t clslot;
204 RsproPDU_t *pdu;
205
206 /* send configuration to this new client */
207 client_slot2rspro(&clslot, FIXME);
208 pdu = rspro_gen_ConfigClientReq(&clslot, bankd_ip, bankd_port);
209 client_conn_send(conn, pdu);
210#endif
211}
212
Harald Welte0a64da62019-03-30 17:38:04 +0100213static void clnt_st_connected_bankd_onenter(struct osmo_fsm_inst *fi, uint32_t prev_state)
Harald Weltef5a0fa32019-03-03 15:44:18 +0100214{
215 struct rspro_client_conn *conn = fi->priv;
216 struct slotmaps *slotmaps = conn->srv->slotmaps;
217 struct slot_mapping *map;
218
219 LOGPFSM(fi, "Associating pre-existing slotmaps (if any)\n");
220 /* Link all known mappings to this new bank */
221 slotmaps_wrlock(slotmaps);
222 llist_for_each_entry(map, &slotmaps->mappings, list) {
223 if (map->bank.bank_id == conn->bank.bank_id)
224 _slotmap_state_change(map, SLMAP_S_NEW, &conn->bank.maps_new);
225 }
226 slotmaps_unlock(slotmaps);
227}
228
Harald Welte0a64da62019-03-30 17:38:04 +0100229static void clnt_st_connected_client(struct osmo_fsm_inst *fi, uint32_t event, void *data)
Harald Weltef5a0fa32019-03-03 15:44:18 +0100230{
231 struct rspro_client_conn *conn = fi->priv;
Harald Welte0a64da62019-03-30 17:38:04 +0100232 struct slotmaps *slotmaps = conn->srv->slotmaps;
233 const struct RsproPDU_t *rx = NULL;
234
235 switch (event) {
Harald Weltef5a0fa32019-03-03 15:44:18 +0100236 default:
237 OSMO_ASSERT(0);
238 }
239}
240
Harald Welte0a64da62019-03-30 17:38:04 +0100241static void clnt_st_connected_bankd(struct osmo_fsm_inst *fi, uint32_t event, void *data)
Harald Weltef5a0fa32019-03-03 15:44:18 +0100242{
243 struct rspro_client_conn *conn = fi->priv;
244 struct slotmaps *slotmaps = conn->srv->slotmaps;
245 const struct RsproPDU_t *rx = NULL;
246 struct slot_mapping *map, *map2;
247
248 switch (event) {
Harald Welte1b07f7f2019-03-30 17:33:07 +0100249 case CLNTC_E_CREATE_MAP_RES: /* Bankd acknowledges mapping was created */
Harald Weltef5a0fa32019-03-03 15:44:18 +0100250 rx = data;
251 slotmaps_wrlock(slotmaps);
252 /* FIXME: resolve map by pdu->tag */
253 /* as hack use first element of conn->maps_unack */
254 map = llist_first_entry(&conn->bank.maps_unack, struct slot_mapping, bank_list);
255 if (!map) {
256 slotmaps_unlock(slotmaps);
257 LOGPFSM(fi, "CreateMapRes but no unacknowledged map");
258 break;
259 }
260 _slotmap_state_change(map, SLMAP_S_ACTIVE, &conn->bank.maps_active);
261 slotmaps_unlock(slotmaps);
262 break;
Harald Welte1b07f7f2019-03-30 17:33:07 +0100263 case CLNTC_E_REMOVE_MAP_RES: /* Bankd acknowledges mapping was removed */
Harald Weltef5a0fa32019-03-03 15:44:18 +0100264 rx = data;
265 slotmaps_wrlock(slotmaps);
266 /* FIXME: resolve map by pdu->tag */
267 /* as hack use first element of conn->maps_deleting */
268 map = llist_first_entry(&conn->bank.maps_deleting, struct slot_mapping, bank_list);
269 if (!map) {
270 slotmaps_unlock(slotmaps);
271 LOGPFSM(fi, "RemoveMapRes but no unacknowledged map");
272 break;
273 }
274 slotmaps_unlock(slotmaps);
275 /* slotmap_del() will remove it from both global and bank list */
276 slotmap_del(map->maps, map);
277 break;
Harald Welte1b07f7f2019-03-30 17:33:07 +0100278 case CLNTC_E_PUSH: /* check if any create or delete requests are pending */
Harald Weltef5a0fa32019-03-03 15:44:18 +0100279 slotmaps_wrlock(slotmaps);
280 /* send any pending create requests */
281 llist_for_each_entry_safe(map, map2, &conn->bank.maps_new, bank_list) {
282 RsproPDU_t *pdu = slotmap2CreateMappingReq(map);
283 client_conn_send(conn, pdu);
284 _slotmap_state_change(map, SLMAP_S_UNACKNOWLEDGED, &conn->bank.maps_unack);
285 }
286 /* send any pending delete requests */
287 llist_for_each_entry_safe(map, map2, &conn->bank.maps_delreq, bank_list) {
288 RsproPDU_t *pdu = slotmap2RemoveMappingReq(map);
289 client_conn_send(conn, pdu);
290 _slotmap_state_change(map, SLMAP_S_DELETING, &conn->bank.maps_deleting);
291 }
292 slotmaps_unlock(slotmaps);
293 break;
294 default:
295 OSMO_ASSERT(0);
296 }
297}
298
299static void clnt_allstate_action(struct osmo_fsm_inst *fi, uint32_t event, void *data)
300{
301 struct rspro_client_conn *conn = fi->priv;
302
303 switch (event) {
304 case CLNTC_E_TCP_DOWN:
305 osmo_fsm_inst_term(fi, OSMO_FSM_TERM_REGULAR, NULL);
306 break;
Harald Welte15b75e12019-03-08 16:55:46 +0100307 case CLNTC_E_KA_TIMEOUT:
308 osmo_fsm_inst_term(fi, OSMO_FSM_TERM_REGULAR, NULL);
309 break;
Harald Weltef5a0fa32019-03-03 15:44:18 +0100310 default:
311 OSMO_ASSERT(0);
312 }
313}
314
315static int server_client_fsm_timer_cb(struct osmo_fsm_inst *fi)
316{
317 struct rspro_client_conn *conn = fi->priv;
318
319 switch (fi->T) {
320 case 1:
321 /* No ClientConnectReq received:disconnect */
322 return 1; /* ask core to terminate FSM */
323 default:
324 OSMO_ASSERT(0);
325 }
326 return 0;
327}
328
329static void server_client_cleanup(struct osmo_fsm_inst *fi, enum osmo_fsm_term_cause cause)
330{
331 struct rspro_client_conn *conn = fi->priv;
332 /* this call will destroy the IPA connection, which will in turn call closed_cb()
333 * which will try to deliver a E_TCP_DOWN event. Clear conn->fi to avoid that loop */
334 conn->fi = NULL;
335 rspro_client_conn_destroy(conn);
336}
337
338static const struct osmo_fsm_state server_client_fsm_states[] = {
339 [CLNTC_ST_INIT] = {
340 .name = "INIT",
341 .in_event_mask = S(CLNTC_E_TCP_UP),
342 .out_state_mask = S(CLNTC_ST_ESTABLISHED),
343 .action = clnt_st_init,
344 },
345 [CLNTC_ST_ESTABLISHED] = {
346 .name = "ESTABLISHED",
347 .in_event_mask = S(CLNTC_E_CLIENT_CONN) | S(CLNTC_E_BANK_CONN),
Harald Welte0a64da62019-03-30 17:38:04 +0100348 .out_state_mask = S(CLNTC_ST_CONNECTED_CLIENT) | S(CLNTC_ST_WAIT_CONF_RES) |
349 S(CLNTC_ST_CONNECTED_BANKD),
Harald Weltef5a0fa32019-03-03 15:44:18 +0100350 .action = clnt_st_established,
351 },
Harald Weltee5c77732019-03-07 23:58:24 +0100352 [CLNTC_ST_WAIT_CONF_RES] = {
353 .name = "WAIT_CONFIG_RES",
354 .in_event_mask = S(CLNTC_E_CONFIG_CL_RES),
Harald Welte0a64da62019-03-30 17:38:04 +0100355 .out_state_mask = S(CLNTC_ST_CONNECTED_CLIENT),
Harald Weltee5c77732019-03-07 23:58:24 +0100356 .action = clnt_st_wait_cl_conf_res,
357 },
Harald Welte0a64da62019-03-30 17:38:04 +0100358 [CLNTC_ST_CONNECTED_CLIENT] = {
359 .name = "CONNECTED_CLIENT",
360 .in_event_mask = 0,
361 .action = clnt_st_connected_client,
362 .onenter = clnt_st_connected_client_onenter,
363 },
364 [CLNTC_ST_CONNECTED_BANKD] = {
365 .name = "CONNECTED_BANKD",
Harald Weltef5a0fa32019-03-03 15:44:18 +0100366 .in_event_mask = S(CLNTC_E_CREATE_MAP_RES) | S(CLNTC_E_REMOVE_MAP_RES) |
367 S(CLNTC_E_PUSH),
Harald Welte0a64da62019-03-30 17:38:04 +0100368 .action = clnt_st_connected_bankd,
369 .onenter = clnt_st_connected_bankd_onenter,
Harald Weltef5a0fa32019-03-03 15:44:18 +0100370 },
Harald Welte0a64da62019-03-30 17:38:04 +0100371
Harald Weltef5a0fa32019-03-03 15:44:18 +0100372};
373
374static struct osmo_fsm remsim_server_client_fsm = {
375 .name = "SERVER_CONN",
376 .states = server_client_fsm_states,
377 .num_states = ARRAY_SIZE(server_client_fsm_states),
378 .allstate_event_mask = S(CLNTC_E_TCP_DOWN),
379 .allstate_action = clnt_allstate_action,
380 .cleanup = server_client_cleanup,
381 .timer_cb = server_client_fsm_timer_cb,
382 .log_subsys = DMAIN,
383 .event_names = server_client_event_names,
384};
385
386struct osmo_fsm_inst *server_client_fsm_alloc(void *ctx, struct rspro_client_conn *conn)
387{
388 //const char *id = osmo_sock_get_name2(conn->peer->ofd.fd);
389 return osmo_fsm_inst_alloc(&remsim_server_client_fsm, ctx, conn, LOGL_DEBUG, NULL);
390}
391
392
393static __attribute__((constructor)) void on_dso_load(void)
394{
395 osmo_fsm_register(&remsim_server_client_fsm);
396}
397
398
399/***********************************************************************
400 * IPA RSPRO Server
401 ***********************************************************************/
402
403struct rspro_client_conn *_bankd_conn_by_id(struct rspro_server *srv, uint16_t bank_id)
404{
405 struct rspro_client_conn *conn;
406 llist_for_each_entry(conn, &srv->banks, list) {
407 if (conn->bank.bank_id == bank_id)
408 return conn;
409 }
410 return NULL;
411}
412struct rspro_client_conn *bankd_conn_by_id(struct rspro_server *srv, uint16_t bank_id)
413{
414 struct rspro_client_conn *conn;
415 pthread_rwlock_rdlock(&srv->rwlock);
416 conn = _bankd_conn_by_id(srv, bank_id);
417 pthread_rwlock_unlock(&srv->rwlock);
418 return conn;
419}
420
421static int handle_rx_rspro(struct rspro_client_conn *conn, const RsproPDU_t *pdu)
422{
Harald Welteb49ac9c2019-03-09 20:36:07 +0100423 LOGPFSM(conn->fi, "Rx RSPRO %s\n", rspro_msgt_name(pdu));
424
Harald Weltef5a0fa32019-03-03 15:44:18 +0100425 switch (pdu->msg.present) {
426 case RsproPDUchoice_PR_connectClientReq:
427 osmo_fsm_inst_dispatch(conn->fi, CLNTC_E_CLIENT_CONN, (void *)pdu);
428 break;
429 case RsproPDUchoice_PR_connectBankReq:
430 osmo_fsm_inst_dispatch(conn->fi, CLNTC_E_BANK_CONN, (void *)pdu);
431 break;
432 case RsproPDUchoice_PR_createMappingRes:
433 osmo_fsm_inst_dispatch(conn->fi, CLNTC_E_CREATE_MAP_RES, (void *)pdu);
434 break;
435 case RsproPDUchoice_PR_removeMappingRes:
436 osmo_fsm_inst_dispatch(conn->fi, CLNTC_E_REMOVE_MAP_RES, (void *)pdu);
437 break;
Harald Welted571a3e2019-03-11 22:09:50 +0100438 case RsproPDUchoice_PR_configClientIdRes:
Harald Weltee5c77732019-03-07 23:58:24 +0100439 osmo_fsm_inst_dispatch(conn->fi, CLNTC_E_CONFIG_CL_RES, (void *)pdu);
440 break;
Harald Weltef5a0fa32019-03-03 15:44:18 +0100441 default:
442 LOGPFSML(conn->fi, LOGL_ERROR, "Received unknown/unimplemented RSPRO msg_type %d\n",
443 pdu->msg.present);
444 return -1;
445 }
446 return 0;
447}
448
449/* data was received from one of the client connections to the RSPRO socket */
450static int sock_read_cb(struct ipa_server_conn *peer, struct msgb *msg)
451{
452 struct ipaccess_head *hh = (struct ipaccess_head *) msg->data;
453 struct ipaccess_head_ext *he = (struct ipaccess_head_ext *) msgb_l2(msg);
454 struct rspro_client_conn *conn = peer->data;
455 RsproPDU_t *pdu;
456 int rc;
457
458 if (msgb_length(msg) < sizeof(*hh))
459 goto invalid;
460 msg->l2h = &hh->data[0];
Harald Welte7bfcc652019-03-08 16:55:01 +0100461 switch (hh->proto) {
462 case IPAC_PROTO_IPACCESS:
463 rc = ipa_server_conn_ccm(peer, msg);
Harald Welte15b75e12019-03-08 16:55:46 +0100464 if (rc < 0)
465 break;
466 switch (hh->data[0]) {
467 case IPAC_MSGT_PONG:
468 ipa_keepalive_fsm_pong_received(conn->keepalive_fi);
469 rc = 0;
470 break;
471 default:
472 break;
473 }
Harald Welte7bfcc652019-03-08 16:55:01 +0100474 break;
475 case IPAC_PROTO_OSMO:
476 if (!he || msgb_l2len(msg)< sizeof(*he))
477 goto invalid;
478 msg->l2h = &he->data[0];
Harald Weltef5a0fa32019-03-03 15:44:18 +0100479
Harald Welte7bfcc652019-03-08 16:55:01 +0100480 switch (he->proto) {
481 case IPAC_PROTO_EXT_RSPRO:
482 pdu = rspro_dec_msg(msg);
483 if (!pdu)
484 goto invalid;
Harald Weltef5a0fa32019-03-03 15:44:18 +0100485
Harald Welte7bfcc652019-03-08 16:55:01 +0100486 rc = handle_rx_rspro(conn, pdu);
487 ASN_STRUCT_FREE(asn_DEF_RsproPDU, pdu);
488 break;
489 default:
490 goto invalid;
491 }
492 break;
493 default:
Harald Weltef5a0fa32019-03-03 15:44:18 +0100494 goto invalid;
Harald Welte7bfcc652019-03-08 16:55:01 +0100495 }
Harald Weltef5a0fa32019-03-03 15:44:18 +0100496 return rc;
497
498invalid:
499 msgb_free(msg);
500 return -1;
501}
502
503static int sock_closed_cb(struct ipa_server_conn *peer)
504{
505 struct rspro_client_conn *conn = peer->data;
506 if (conn->fi)
507 osmo_fsm_inst_dispatch(conn->fi, CLNTC_E_TCP_DOWN, NULL);
508 /* FIXME: who cleans up conn? */
509 /* ipa server code relases 'peer' just after this */
510 return 0;
511}
512
Harald Welte15b75e12019-03-08 16:55:46 +0100513static const struct ipa_keepalive_params ka_params = {
514 .interval = 30,
515 .wait_for_resp = 10,
516};
517
Harald Weltef5a0fa32019-03-03 15:44:18 +0100518/* a new TCP connection was accepted on the RSPRO server socket */
519static int accept_cb(struct ipa_server_link *link, int fd)
520{
521 struct rspro_server *srv = link->data;
522 struct rspro_client_conn *conn;
523
524 conn = talloc_zero(srv, struct rspro_client_conn);
525 OSMO_ASSERT(conn);
526
527 conn->srv = srv;
528 /* don't allocate peer under 'conn', as it must survive 'conn' during teardown */
529 conn->peer = ipa_server_conn_create(link, link, fd, sock_read_cb, sock_closed_cb, conn);
530 if (!conn->peer)
531 goto out_err;
532
533 /* don't allocate 'fi' as slave from 'conn', as 'fi' needs to survive 'conn' during
534 * teardown */
535 conn->fi = server_client_fsm_alloc(srv, conn);
536 if (!conn->fi)
537 goto out_err_conn;
538
Harald Welte15b75e12019-03-08 16:55:46 +0100539 /* use ipa_keepalive_fsm to periodically send an IPA_PING and expect a PONG in response */
540 conn->keepalive_fi = ipa_server_conn_alloc_keepalive_fsm(conn->peer, &ka_params, NULL);
541 if (!conn->keepalive_fi)
542 goto out_err_fi;
543 /* ensure parent is notified once keepalive FSM instance is dying */
544 osmo_fsm_inst_change_parent(conn->keepalive_fi, conn->fi, CLNTC_E_KA_TIMEOUT);
545 ipa_keepalive_fsm_start(conn->keepalive_fi);
546
Harald Weltef5a0fa32019-03-03 15:44:18 +0100547 INIT_LLIST_HEAD(&conn->bank.maps_new);
548 INIT_LLIST_HEAD(&conn->bank.maps_unack);
549 INIT_LLIST_HEAD(&conn->bank.maps_active);
550 INIT_LLIST_HEAD(&conn->bank.maps_delreq);
551 INIT_LLIST_HEAD(&conn->bank.maps_deleting);
552
553 pthread_rwlock_wrlock(&conn->srv->rwlock);
554 llist_add_tail(&conn->list, &srv->connections);
555 pthread_rwlock_unlock(&conn->srv->rwlock);
556
557 osmo_fsm_inst_dispatch(conn->fi, CLNTC_E_TCP_UP, NULL);
558 return 0;
559
Harald Welte15b75e12019-03-08 16:55:46 +0100560out_err_fi:
561 osmo_fsm_inst_term(conn->fi, OSMO_FSM_TERM_ERROR, NULL);
Harald Weltef5a0fa32019-03-03 15:44:18 +0100562out_err_conn:
563 ipa_server_conn_destroy(conn->peer);
564 /* the above will free 'conn' down the chain */
565 return -1;
566out_err:
567 talloc_free(conn);
568 return -1;
569}
570
571/* call-back if we were triggered by a rest_api thread */
572int event_fd_cb(struct osmo_fd *ofd, unsigned int what)
573{
574 struct rspro_server *srv = ofd->data;
575 struct rspro_client_conn *conn;
576 bool non_empty_new, non_empty_del;
577 uint64_t value;
578 int rc;
579
580 /* read from the socket to "confirm" the event and make it non-readable again */
581 rc = read(ofd->fd, &value, 8);
582 if (rc < 8) {
583 fprintf(stderr, "Error reading eventfd: %d\n", rc);
584 return rc;
585 }
586
587 printf("rspro_server: Event FD arrived, checking for any pending work\n");
588
589 pthread_rwlock_rdlock(&srv->rwlock);
590 llist_for_each_entry(conn, &srv->banks, list) {
591 slotmaps_rdlock(srv->slotmaps);
592 non_empty_new = llist_empty(&conn->bank.maps_new);
593 non_empty_del = llist_empty(&conn->bank.maps_delreq);
594 slotmaps_unlock(srv->slotmaps);
595
596 /* trigger FSM to send any pending new/deleted maps */
597 if (non_empty_new || non_empty_del)
598 osmo_fsm_inst_dispatch(conn->fi, CLNTC_E_PUSH, NULL);
599 }
600 pthread_rwlock_unlock(&srv->rwlock);
601
602 return 0;
603}
604
605/* unlink all slotmaps from any of the lists of this conn->bank.maps_* */
606static void _unlink_all_slotmaps(struct rspro_client_conn *conn)
607{
608 struct slot_mapping *smap, *smap2;
609
610 llist_for_each_entry_safe(smap, smap2, &conn->bank.maps_new, bank_list) {
611 /* unlink from list and keep in state NEW */
612 _slotmap_state_change(smap, SLMAP_S_NEW, NULL);
613 }
614 llist_for_each_entry_safe(smap, smap2, &conn->bank.maps_unack, bank_list) {
615 /* unlink from list and change to state NEW */
616 _slotmap_state_change(smap, SLMAP_S_NEW, NULL);
617 }
618 llist_for_each_entry_safe(smap, smap2, &conn->bank.maps_active, bank_list) {
619 /* unlink from list and change to state NEW */
620 _slotmap_state_change(smap, SLMAP_S_NEW, NULL);
621 }
622 llist_for_each_entry_safe(smap, smap2, &conn->bank.maps_delreq, bank_list) {
623 /* unlink from list and delete */
624 _slotmap_del(smap->maps, smap);
625 }
626 llist_for_each_entry_safe(smap, smap2, &conn->bank.maps_deleting, bank_list) {
627 /* unlink from list and delete */
628 _slotmap_del(smap->maps, smap);
629 }
630}
631
632/* only to be used by the FSM cleanup. */
633static void rspro_client_conn_destroy(struct rspro_client_conn *conn)
634{
635 /* this will internally call closed_cb() which will dispatch a TCP_DOWN event */
636 ipa_server_conn_destroy(conn->peer);
637 conn->peer = NULL;
638
639 /* ensure all slotmaps are unlinked + returned to NEW or deleted */
640 slotmaps_wrlock(conn->srv->slotmaps);
641 _unlink_all_slotmaps(conn);
642 slotmaps_unlock(conn->srv->slotmaps);
643
644 pthread_rwlock_wrlock(&conn->srv->rwlock);
645 llist_del(&conn->list);
646 pthread_rwlock_unlock(&conn->srv->rwlock);
647
648 talloc_free(conn);
649}
650
651
652struct rspro_server *rspro_server_create(void *ctx, const char *host, uint16_t port)
653
654{
655 struct rspro_server *srv = talloc_zero(ctx, struct rspro_server);
656 OSMO_ASSERT(srv);
657
658 pthread_rwlock_init(&srv->rwlock, NULL);
659 pthread_rwlock_wrlock(&srv->rwlock);
660 INIT_LLIST_HEAD(&srv->connections);
661 INIT_LLIST_HEAD(&srv->clients);
662 INIT_LLIST_HEAD(&srv->banks);
663 pthread_rwlock_unlock(&srv->rwlock);
664
665 srv->link = ipa_server_link_create(ctx, NULL, host, port, accept_cb, srv);
666 ipa_server_link_open(srv->link);
667
668 return srv;
669}
670
671void rspro_server_destroy(struct rspro_server *srv)
672{
673 /* FIXME: clear all lists */
674
675 ipa_server_link_destroy(srv->link);
676 srv->link = NULL;
677 talloc_free(srv);
678}