blob: 1b228cb407b1a1ff10cf3ff9933a302cb531c6e1 [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
22static void client_slot2rspro(ClientSlot_t *out, const struct client_slot *in)
23{
24 out->clientId = in->client_id;
25 out->slotNr = in->slot_nr;
26}
27
Harald Weltee5c77732019-03-07 23:58:24 +010028static void rspro2client_slot(struct client_slot *out, const ClientSlot_t *in)
29{
30 out->client_id = in->clientId;
31 out->slot_nr = in->slotNr;
32}
33
Harald Weltef5a0fa32019-03-03 15:44:18 +010034static void bank_slot2rspro(BankSlot_t *out, const struct bank_slot *in)
35{
36 out->bankId = in->bank_id;
37 out->slotNr = in->slot_nr;
38}
39
40static RsproPDU_t *slotmap2CreateMappingReq(const struct slot_mapping *slotmap)
41{
42 ClientSlot_t clslot;
43 BankSlot_t bslot;
44
45 client_slot2rspro(&clslot, &slotmap->client);
46 bank_slot2rspro(&bslot, &slotmap->bank);
47
48 return rspro_gen_CreateMappingReq(&clslot, &bslot);
49}
50
51static RsproPDU_t *slotmap2RemoveMappingReq(const struct slot_mapping *slotmap)
52{
53 ClientSlot_t clslot;
54 BankSlot_t bslot;
55
56 client_slot2rspro(&clslot, &slotmap->client);
57 bank_slot2rspro(&bslot, &slotmap->bank);
58
59 return rspro_gen_RemoveMappingReq(&clslot, &bslot);
60}
61
62
63static void client_conn_send(struct rspro_client_conn *conn, RsproPDU_t *pdu)
64{
65 struct msgb *msg_tx = rspro_enc_msg(pdu);
66 if (!msg_tx) {
67 ASN_STRUCT_FREE(asn_DEF_RsproPDU, pdu);
68 return;
69 }
70 ipa_prepend_header_ext(msg_tx, IPAC_PROTO_EXT_RSPRO);
71 ipa_msg_push_header(msg_tx, IPAC_PROTO_OSMO);
72 ipa_server_conn_send(conn->peer, msg_tx);
73}
74
75
76/***********************************************************************
77 * per-client connection FSM
78 ***********************************************************************/
79
80static void rspro_client_conn_destroy(struct rspro_client_conn *conn);
81
82enum remsim_server_client_fsm_state {
83 CLNTC_ST_INIT,
84 CLNTC_ST_ESTABLISHED,
Harald Weltee5c77732019-03-07 23:58:24 +010085 CLNTC_ST_WAIT_CONF_RES, /* waiting for ConfigClientRes */
Harald Weltef5a0fa32019-03-03 15:44:18 +010086 CLNTC_ST_CONNECTED,
87};
88
89enum remsim_server_client_event {
90 CLNTC_E_TCP_UP,
91 CLNTC_E_CLIENT_CONN, /* Connect{Client,Bank}Req received */
92 CLNTC_E_BANK_CONN,
93 CLNTC_E_TCP_DOWN,
Harald Welte15b75e12019-03-08 16:55:46 +010094 CLNTC_E_KA_TIMEOUT,
Harald Weltef5a0fa32019-03-03 15:44:18 +010095 CLNTC_E_CREATE_MAP_RES, /* CreateMappingRes received */
96 CLNTC_E_REMOVE_MAP_RES, /* RemoveMappingRes received */
Harald Weltee5c77732019-03-07 23:58:24 +010097 CLNTC_E_CONFIG_CL_RES, /* ConfigClientRes received */
Harald Weltef5a0fa32019-03-03 15:44:18 +010098 CLNTC_E_PUSH, /* drain maps_new or maps_delreq */
99};
100
101static const struct value_string server_client_event_names[] = {
102 OSMO_VALUE_STRING(CLNTC_E_TCP_UP),
103 OSMO_VALUE_STRING(CLNTC_E_CLIENT_CONN),
104 OSMO_VALUE_STRING(CLNTC_E_BANK_CONN),
105 OSMO_VALUE_STRING(CLNTC_E_TCP_DOWN),
Harald Welte15b75e12019-03-08 16:55:46 +0100106 OSMO_VALUE_STRING(CLNTC_E_KA_TIMEOUT),
Harald Weltef5a0fa32019-03-03 15:44:18 +0100107 OSMO_VALUE_STRING(CLNTC_E_CREATE_MAP_RES),
108 OSMO_VALUE_STRING(CLNTC_E_REMOVE_MAP_RES),
Harald Weltee5c77732019-03-07 23:58:24 +0100109 OSMO_VALUE_STRING(CLNTC_E_CONFIG_CL_RES),
Harald Weltef5a0fa32019-03-03 15:44:18 +0100110 OSMO_VALUE_STRING(CLNTC_E_PUSH),
111 { 0, NULL }
112};
113
114static void clnt_st_init(struct osmo_fsm_inst *fi, uint32_t event, void *data)
115{
116 switch (event) {
117 case CLNTC_E_TCP_UP:
118 osmo_fsm_inst_state_chg(fi, CLNTC_ST_ESTABLISHED, 10, 1);
119 break;
120 default:
121 OSMO_ASSERT(0);
122 }
123}
124
125static void clnt_st_established(struct osmo_fsm_inst *fi, uint32_t event, void *data)
126{
127 struct rspro_client_conn *conn = fi->priv;
128 const RsproPDU_t *pdu = data;
129 const ConnectClientReq_t *cclreq = NULL;
130 const ConnectBankReq_t *cbreq = NULL;
131 RsproPDU_t *resp = NULL;
132
133 switch (event) {
134 case CLNTC_E_CLIENT_CONN:
135 cclreq = &pdu->msg.choice.connectClientReq;
136 /* save the [remote] component identity in 'conn' */
137 rspro_comp_id_retrieve(&conn->comp_id, &cclreq->identity);
138 if (conn->comp_id.type != ComponentType_remsimClient) {
139 LOGPFSM(fi, "ConnectClientReq from identity != Client ?!?\n");
140 osmo_fsm_inst_term(fi, OSMO_FSM_TERM_ERROR, NULL);
141 }
Harald Weltee5c77732019-03-07 23:58:24 +0100142 if (!cclreq->clientSlot) {
143#if 0
144 /* FIXME: determine ClientID */
145 resp = rspro_gen_ConnectClientRes(&conn->srv->comp_id, ResultCode_ok);
146 client_conn_send(conn, resp);
147 osmo_fsm_inst_state_chg(fi, CLNTC_ST_WAIT_CL_CONF_RES, 3, 30);
148#else
149 /* FIXME: the original plan was to dynamically assign a ClientID
150 * from server to client here. Send ConfigReq and transition to
151 * CLNTC_ST_WAIT_CONF_RES */
152 LOGPFSM(fi, "ConnectClientReq without ClientId not supported yet!\n");
153 osmo_fsm_inst_term(fi, OSMO_FSM_TERM_ERROR, NULL);
154#endif
155 } else {
156 /* FIXME: check for unique-ness */
157 rspro2client_slot(&conn->client.slot, cclreq->clientSlot);
158 osmo_fsm_inst_update_id_f(fi, "C%u:%u", conn->client.slot.client_id,
159 conn->client.slot.slot_nr);
160 resp = rspro_gen_ConnectClientRes(&conn->srv->comp_id, ResultCode_ok);
161 client_conn_send(conn, resp);
162 osmo_fsm_inst_state_chg(fi, CLNTC_ST_CONNECTED, 0, 0);
163 }
Harald Weltef5a0fa32019-03-03 15:44:18 +0100164
165 /* reparent us from srv->connections to srv->clients */
166 pthread_rwlock_wrlock(&conn->srv->rwlock);
167 llist_del(&conn->list);
168 llist_add_tail(&conn->list, &conn->srv->clients);
169 pthread_rwlock_unlock(&conn->srv->rwlock);
Harald Weltef5a0fa32019-03-03 15:44:18 +0100170 break;
171 case CLNTC_E_BANK_CONN:
172 cbreq = &pdu->msg.choice.connectBankReq;
173 /* save the [remote] component identity in 'conn' */
174 rspro_comp_id_retrieve(&conn->comp_id, &cbreq->identity);
175 if (conn->comp_id.type != ComponentType_remsimBankd) {
176 LOGPFSM(fi, "ConnectBankReq from identity != Bank ?!?\n");
177 osmo_fsm_inst_term(fi, OSMO_FSM_TERM_ERROR, NULL);
178 }
Harald Weltee5c77732019-03-07 23:58:24 +0100179 /* FIXME: check for unique-ness */
Harald Weltef5a0fa32019-03-03 15:44:18 +0100180 conn->bank.bank_id = cbreq->bankId;
181 conn->bank.num_slots = cbreq->numberOfSlots;
182 osmo_fsm_inst_update_id_f(fi, "B%u", conn->bank.bank_id);
183
184 /* reparent us from srv->connections to srv->banks */
185 pthread_rwlock_wrlock(&conn->srv->rwlock);
186 llist_del(&conn->list);
187 llist_add_tail(&conn->list, &conn->srv->banks);
188 pthread_rwlock_unlock(&conn->srv->rwlock);
189
190 /* send response to bank first */
191 resp = rspro_gen_ConnectBankRes(&conn->srv->comp_id, ResultCode_ok);
192 client_conn_send(conn, resp);
193
194 /* the state change will associate any pre-existing slotmaps */
195 osmo_fsm_inst_state_chg(fi, CLNTC_ST_CONNECTED, 0, 0);
196
197 osmo_fsm_inst_dispatch(fi, CLNTC_E_PUSH, NULL);
198 break;
199 default:
200 OSMO_ASSERT(0);
201 }
202}
203
Harald Weltee5c77732019-03-07 23:58:24 +0100204static void clnt_st_wait_cl_conf_res(struct osmo_fsm_inst *fi, uint32_t event, void *data)
205{
206 switch (event) {
207 case CLNTC_E_CONFIG_CL_RES:
208 osmo_fsm_inst_state_chg(fi, CLNTC_ST_CONNECTED, 0, 0);
209 break;
210 default:
211 OSMO_ASSERT(0);
212 }
213}
Harald Weltef5a0fa32019-03-03 15:44:18 +0100214
215static void clnt_st_connected_cl_onenter(struct osmo_fsm_inst *fi, uint32_t prev_state)
216{
217#if 0
218 struct rspro_client_conn *conn = fi->priv;
219 ClientSlot_t clslot;
220 RsproPDU_t *pdu;
221
222 /* send configuration to this new client */
223 client_slot2rspro(&clslot, FIXME);
224 pdu = rspro_gen_ConfigClientReq(&clslot, bankd_ip, bankd_port);
225 client_conn_send(conn, pdu);
226#endif
227}
228
229static void clnt_st_connected_bk_onenter(struct osmo_fsm_inst *fi, uint32_t prev_state)
230{
231 struct rspro_client_conn *conn = fi->priv;
232 struct slotmaps *slotmaps = conn->srv->slotmaps;
233 struct slot_mapping *map;
234
235 LOGPFSM(fi, "Associating pre-existing slotmaps (if any)\n");
236 /* Link all known mappings to this new bank */
237 slotmaps_wrlock(slotmaps);
238 llist_for_each_entry(map, &slotmaps->mappings, list) {
239 if (map->bank.bank_id == conn->bank.bank_id)
240 _slotmap_state_change(map, SLMAP_S_NEW, &conn->bank.maps_new);
241 }
242 slotmaps_unlock(slotmaps);
243}
244
245static void clnt_st_connected_onenter(struct osmo_fsm_inst *fi, uint32_t prev_state)
246{
247 struct rspro_client_conn *conn = fi->priv;
248 switch (conn->comp_id.type) {
249 case ComponentType_remsimClient:
250 clnt_st_connected_cl_onenter(fi, prev_state);
251 break;
252 case ComponentType_remsimBankd:
253 clnt_st_connected_bk_onenter(fi, prev_state);
254 break;
255 default:
256 OSMO_ASSERT(0);
257 }
258}
259
260static void clnt_st_connected(struct osmo_fsm_inst *fi, uint32_t event, void *data)
261{
262 struct rspro_client_conn *conn = fi->priv;
263 struct slotmaps *slotmaps = conn->srv->slotmaps;
264 const struct RsproPDU_t *rx = NULL;
265 struct slot_mapping *map, *map2;
266
267 switch (event) {
268 case CLNTC_E_CREATE_MAP_RES:
269 rx = data;
270 slotmaps_wrlock(slotmaps);
271 /* FIXME: resolve map by pdu->tag */
272 /* as hack use first element of conn->maps_unack */
273 map = llist_first_entry(&conn->bank.maps_unack, struct slot_mapping, bank_list);
274 if (!map) {
275 slotmaps_unlock(slotmaps);
276 LOGPFSM(fi, "CreateMapRes but no unacknowledged map");
277 break;
278 }
279 _slotmap_state_change(map, SLMAP_S_ACTIVE, &conn->bank.maps_active);
280 slotmaps_unlock(slotmaps);
281 break;
282 case CLNTC_E_REMOVE_MAP_RES:
283 rx = data;
284 slotmaps_wrlock(slotmaps);
285 /* FIXME: resolve map by pdu->tag */
286 /* as hack use first element of conn->maps_deleting */
287 map = llist_first_entry(&conn->bank.maps_deleting, struct slot_mapping, bank_list);
288 if (!map) {
289 slotmaps_unlock(slotmaps);
290 LOGPFSM(fi, "RemoveMapRes but no unacknowledged map");
291 break;
292 }
293 slotmaps_unlock(slotmaps);
294 /* slotmap_del() will remove it from both global and bank list */
295 slotmap_del(map->maps, map);
296 break;
297 case CLNTC_E_PUSH:
298 slotmaps_wrlock(slotmaps);
299 /* send any pending create requests */
300 llist_for_each_entry_safe(map, map2, &conn->bank.maps_new, bank_list) {
301 RsproPDU_t *pdu = slotmap2CreateMappingReq(map);
302 client_conn_send(conn, pdu);
303 _slotmap_state_change(map, SLMAP_S_UNACKNOWLEDGED, &conn->bank.maps_unack);
304 }
305 /* send any pending delete requests */
306 llist_for_each_entry_safe(map, map2, &conn->bank.maps_delreq, bank_list) {
307 RsproPDU_t *pdu = slotmap2RemoveMappingReq(map);
308 client_conn_send(conn, pdu);
309 _slotmap_state_change(map, SLMAP_S_DELETING, &conn->bank.maps_deleting);
310 }
311 slotmaps_unlock(slotmaps);
312 break;
313 default:
314 OSMO_ASSERT(0);
315 }
316}
317
318static void clnt_allstate_action(struct osmo_fsm_inst *fi, uint32_t event, void *data)
319{
320 struct rspro_client_conn *conn = fi->priv;
321
322 switch (event) {
323 case CLNTC_E_TCP_DOWN:
324 osmo_fsm_inst_term(fi, OSMO_FSM_TERM_REGULAR, NULL);
325 break;
Harald Welte15b75e12019-03-08 16:55:46 +0100326 case CLNTC_E_KA_TIMEOUT:
327 osmo_fsm_inst_term(fi, OSMO_FSM_TERM_REGULAR, NULL);
328 break;
Harald Weltef5a0fa32019-03-03 15:44:18 +0100329 default:
330 OSMO_ASSERT(0);
331 }
332}
333
334static int server_client_fsm_timer_cb(struct osmo_fsm_inst *fi)
335{
336 struct rspro_client_conn *conn = fi->priv;
337
338 switch (fi->T) {
339 case 1:
340 /* No ClientConnectReq received:disconnect */
341 return 1; /* ask core to terminate FSM */
342 default:
343 OSMO_ASSERT(0);
344 }
345 return 0;
346}
347
348static void server_client_cleanup(struct osmo_fsm_inst *fi, enum osmo_fsm_term_cause cause)
349{
350 struct rspro_client_conn *conn = fi->priv;
351 /* this call will destroy the IPA connection, which will in turn call closed_cb()
352 * which will try to deliver a E_TCP_DOWN event. Clear conn->fi to avoid that loop */
353 conn->fi = NULL;
354 rspro_client_conn_destroy(conn);
355}
356
357static const struct osmo_fsm_state server_client_fsm_states[] = {
358 [CLNTC_ST_INIT] = {
359 .name = "INIT",
360 .in_event_mask = S(CLNTC_E_TCP_UP),
361 .out_state_mask = S(CLNTC_ST_ESTABLISHED),
362 .action = clnt_st_init,
363 },
364 [CLNTC_ST_ESTABLISHED] = {
365 .name = "ESTABLISHED",
366 .in_event_mask = S(CLNTC_E_CLIENT_CONN) | S(CLNTC_E_BANK_CONN),
Harald Weltee5c77732019-03-07 23:58:24 +0100367 .out_state_mask = S(CLNTC_ST_CONNECTED) | S(CLNTC_ST_WAIT_CONF_RES),
Harald Weltef5a0fa32019-03-03 15:44:18 +0100368 .action = clnt_st_established,
369 },
Harald Weltee5c77732019-03-07 23:58:24 +0100370 [CLNTC_ST_WAIT_CONF_RES] = {
371 .name = "WAIT_CONFIG_RES",
372 .in_event_mask = S(CLNTC_E_CONFIG_CL_RES),
373 .out_state_mask = S(CLNTC_ST_CONNECTED),
374 .action = clnt_st_wait_cl_conf_res,
375 },
Harald Weltef5a0fa32019-03-03 15:44:18 +0100376 [CLNTC_ST_CONNECTED] = {
377 .name = "CONNECTED",
378 .in_event_mask = S(CLNTC_E_CREATE_MAP_RES) | S(CLNTC_E_REMOVE_MAP_RES) |
379 S(CLNTC_E_PUSH),
380 .action = clnt_st_connected,
381 .onenter = clnt_st_connected_onenter,
382 },
383};
384
385static struct osmo_fsm remsim_server_client_fsm = {
386 .name = "SERVER_CONN",
387 .states = server_client_fsm_states,
388 .num_states = ARRAY_SIZE(server_client_fsm_states),
389 .allstate_event_mask = S(CLNTC_E_TCP_DOWN),
390 .allstate_action = clnt_allstate_action,
391 .cleanup = server_client_cleanup,
392 .timer_cb = server_client_fsm_timer_cb,
393 .log_subsys = DMAIN,
394 .event_names = server_client_event_names,
395};
396
397struct osmo_fsm_inst *server_client_fsm_alloc(void *ctx, struct rspro_client_conn *conn)
398{
399 //const char *id = osmo_sock_get_name2(conn->peer->ofd.fd);
400 return osmo_fsm_inst_alloc(&remsim_server_client_fsm, ctx, conn, LOGL_DEBUG, NULL);
401}
402
403
404static __attribute__((constructor)) void on_dso_load(void)
405{
406 osmo_fsm_register(&remsim_server_client_fsm);
407}
408
409
410/***********************************************************************
411 * IPA RSPRO Server
412 ***********************************************************************/
413
414struct rspro_client_conn *_bankd_conn_by_id(struct rspro_server *srv, uint16_t bank_id)
415{
416 struct rspro_client_conn *conn;
417 llist_for_each_entry(conn, &srv->banks, list) {
418 if (conn->bank.bank_id == bank_id)
419 return conn;
420 }
421 return NULL;
422}
423struct rspro_client_conn *bankd_conn_by_id(struct rspro_server *srv, uint16_t bank_id)
424{
425 struct rspro_client_conn *conn;
426 pthread_rwlock_rdlock(&srv->rwlock);
427 conn = _bankd_conn_by_id(srv, bank_id);
428 pthread_rwlock_unlock(&srv->rwlock);
429 return conn;
430}
431
432static int handle_rx_rspro(struct rspro_client_conn *conn, const RsproPDU_t *pdu)
433{
434 switch (pdu->msg.present) {
435 case RsproPDUchoice_PR_connectClientReq:
436 osmo_fsm_inst_dispatch(conn->fi, CLNTC_E_CLIENT_CONN, (void *)pdu);
437 break;
438 case RsproPDUchoice_PR_connectBankReq:
439 osmo_fsm_inst_dispatch(conn->fi, CLNTC_E_BANK_CONN, (void *)pdu);
440 break;
441 case RsproPDUchoice_PR_createMappingRes:
442 osmo_fsm_inst_dispatch(conn->fi, CLNTC_E_CREATE_MAP_RES, (void *)pdu);
443 break;
444 case RsproPDUchoice_PR_removeMappingRes:
445 osmo_fsm_inst_dispatch(conn->fi, CLNTC_E_REMOVE_MAP_RES, (void *)pdu);
446 break;
Harald Weltee5c77732019-03-07 23:58:24 +0100447 case RsproPDUchoice_PR_configClientRes:
448 osmo_fsm_inst_dispatch(conn->fi, CLNTC_E_CONFIG_CL_RES, (void *)pdu);
449 break;
Harald Weltef5a0fa32019-03-03 15:44:18 +0100450 default:
451 LOGPFSML(conn->fi, LOGL_ERROR, "Received unknown/unimplemented RSPRO msg_type %d\n",
452 pdu->msg.present);
453 return -1;
454 }
455 return 0;
456}
457
458/* data was received from one of the client connections to the RSPRO socket */
459static int sock_read_cb(struct ipa_server_conn *peer, struct msgb *msg)
460{
461 struct ipaccess_head *hh = (struct ipaccess_head *) msg->data;
462 struct ipaccess_head_ext *he = (struct ipaccess_head_ext *) msgb_l2(msg);
463 struct rspro_client_conn *conn = peer->data;
464 RsproPDU_t *pdu;
465 int rc;
466
467 if (msgb_length(msg) < sizeof(*hh))
468 goto invalid;
469 msg->l2h = &hh->data[0];
Harald Welte7bfcc652019-03-08 16:55:01 +0100470 switch (hh->proto) {
471 case IPAC_PROTO_IPACCESS:
472 rc = ipa_server_conn_ccm(peer, msg);
Harald Welte15b75e12019-03-08 16:55:46 +0100473 if (rc < 0)
474 break;
475 switch (hh->data[0]) {
476 case IPAC_MSGT_PONG:
477 ipa_keepalive_fsm_pong_received(conn->keepalive_fi);
478 rc = 0;
479 break;
480 default:
481 break;
482 }
Harald Welte7bfcc652019-03-08 16:55:01 +0100483 break;
484 case IPAC_PROTO_OSMO:
485 if (!he || msgb_l2len(msg)< sizeof(*he))
486 goto invalid;
487 msg->l2h = &he->data[0];
Harald Weltef5a0fa32019-03-03 15:44:18 +0100488
Harald Welte7bfcc652019-03-08 16:55:01 +0100489 switch (he->proto) {
490 case IPAC_PROTO_EXT_RSPRO:
491 pdu = rspro_dec_msg(msg);
492 if (!pdu)
493 goto invalid;
Harald Weltef5a0fa32019-03-03 15:44:18 +0100494
Harald Welte7bfcc652019-03-08 16:55:01 +0100495 rc = handle_rx_rspro(conn, pdu);
496 ASN_STRUCT_FREE(asn_DEF_RsproPDU, pdu);
497 break;
498 default:
499 goto invalid;
500 }
501 break;
502 default:
Harald Weltef5a0fa32019-03-03 15:44:18 +0100503 goto invalid;
Harald Welte7bfcc652019-03-08 16:55:01 +0100504 }
Harald Weltef5a0fa32019-03-03 15:44:18 +0100505 return rc;
506
507invalid:
508 msgb_free(msg);
509 return -1;
510}
511
512static int sock_closed_cb(struct ipa_server_conn *peer)
513{
514 struct rspro_client_conn *conn = peer->data;
515 if (conn->fi)
516 osmo_fsm_inst_dispatch(conn->fi, CLNTC_E_TCP_DOWN, NULL);
517 /* FIXME: who cleans up conn? */
518 /* ipa server code relases 'peer' just after this */
519 return 0;
520}
521
Harald Welte15b75e12019-03-08 16:55:46 +0100522static const struct ipa_keepalive_params ka_params = {
523 .interval = 30,
524 .wait_for_resp = 10,
525};
526
Harald Weltef5a0fa32019-03-03 15:44:18 +0100527/* a new TCP connection was accepted on the RSPRO server socket */
528static int accept_cb(struct ipa_server_link *link, int fd)
529{
530 struct rspro_server *srv = link->data;
531 struct rspro_client_conn *conn;
532
533 conn = talloc_zero(srv, struct rspro_client_conn);
534 OSMO_ASSERT(conn);
535
536 conn->srv = srv;
537 /* don't allocate peer under 'conn', as it must survive 'conn' during teardown */
538 conn->peer = ipa_server_conn_create(link, link, fd, sock_read_cb, sock_closed_cb, conn);
539 if (!conn->peer)
540 goto out_err;
541
542 /* don't allocate 'fi' as slave from 'conn', as 'fi' needs to survive 'conn' during
543 * teardown */
544 conn->fi = server_client_fsm_alloc(srv, conn);
545 if (!conn->fi)
546 goto out_err_conn;
547
Harald Welte15b75e12019-03-08 16:55:46 +0100548 /* use ipa_keepalive_fsm to periodically send an IPA_PING and expect a PONG in response */
549 conn->keepalive_fi = ipa_server_conn_alloc_keepalive_fsm(conn->peer, &ka_params, NULL);
550 if (!conn->keepalive_fi)
551 goto out_err_fi;
552 /* ensure parent is notified once keepalive FSM instance is dying */
553 osmo_fsm_inst_change_parent(conn->keepalive_fi, conn->fi, CLNTC_E_KA_TIMEOUT);
554 ipa_keepalive_fsm_start(conn->keepalive_fi);
555
Harald Weltef5a0fa32019-03-03 15:44:18 +0100556 INIT_LLIST_HEAD(&conn->bank.maps_new);
557 INIT_LLIST_HEAD(&conn->bank.maps_unack);
558 INIT_LLIST_HEAD(&conn->bank.maps_active);
559 INIT_LLIST_HEAD(&conn->bank.maps_delreq);
560 INIT_LLIST_HEAD(&conn->bank.maps_deleting);
561
562 pthread_rwlock_wrlock(&conn->srv->rwlock);
563 llist_add_tail(&conn->list, &srv->connections);
564 pthread_rwlock_unlock(&conn->srv->rwlock);
565
566 osmo_fsm_inst_dispatch(conn->fi, CLNTC_E_TCP_UP, NULL);
567 return 0;
568
Harald Welte15b75e12019-03-08 16:55:46 +0100569out_err_fi:
570 osmo_fsm_inst_term(conn->fi, OSMO_FSM_TERM_ERROR, NULL);
Harald Weltef5a0fa32019-03-03 15:44:18 +0100571out_err_conn:
572 ipa_server_conn_destroy(conn->peer);
573 /* the above will free 'conn' down the chain */
574 return -1;
575out_err:
576 talloc_free(conn);
577 return -1;
578}
579
580/* call-back if we were triggered by a rest_api thread */
581int event_fd_cb(struct osmo_fd *ofd, unsigned int what)
582{
583 struct rspro_server *srv = ofd->data;
584 struct rspro_client_conn *conn;
585 bool non_empty_new, non_empty_del;
586 uint64_t value;
587 int rc;
588
589 /* read from the socket to "confirm" the event and make it non-readable again */
590 rc = read(ofd->fd, &value, 8);
591 if (rc < 8) {
592 fprintf(stderr, "Error reading eventfd: %d\n", rc);
593 return rc;
594 }
595
596 printf("rspro_server: Event FD arrived, checking for any pending work\n");
597
598 pthread_rwlock_rdlock(&srv->rwlock);
599 llist_for_each_entry(conn, &srv->banks, list) {
600 slotmaps_rdlock(srv->slotmaps);
601 non_empty_new = llist_empty(&conn->bank.maps_new);
602 non_empty_del = llist_empty(&conn->bank.maps_delreq);
603 slotmaps_unlock(srv->slotmaps);
604
605 /* trigger FSM to send any pending new/deleted maps */
606 if (non_empty_new || non_empty_del)
607 osmo_fsm_inst_dispatch(conn->fi, CLNTC_E_PUSH, NULL);
608 }
609 pthread_rwlock_unlock(&srv->rwlock);
610
611 return 0;
612}
613
614/* unlink all slotmaps from any of the lists of this conn->bank.maps_* */
615static void _unlink_all_slotmaps(struct rspro_client_conn *conn)
616{
617 struct slot_mapping *smap, *smap2;
618
619 llist_for_each_entry_safe(smap, smap2, &conn->bank.maps_new, bank_list) {
620 /* unlink from list and keep in state NEW */
621 _slotmap_state_change(smap, SLMAP_S_NEW, NULL);
622 }
623 llist_for_each_entry_safe(smap, smap2, &conn->bank.maps_unack, bank_list) {
624 /* unlink from list and change to state NEW */
625 _slotmap_state_change(smap, SLMAP_S_NEW, NULL);
626 }
627 llist_for_each_entry_safe(smap, smap2, &conn->bank.maps_active, bank_list) {
628 /* unlink from list and change to state NEW */
629 _slotmap_state_change(smap, SLMAP_S_NEW, NULL);
630 }
631 llist_for_each_entry_safe(smap, smap2, &conn->bank.maps_delreq, bank_list) {
632 /* unlink from list and delete */
633 _slotmap_del(smap->maps, smap);
634 }
635 llist_for_each_entry_safe(smap, smap2, &conn->bank.maps_deleting, bank_list) {
636 /* unlink from list and delete */
637 _slotmap_del(smap->maps, smap);
638 }
639}
640
641/* only to be used by the FSM cleanup. */
642static void rspro_client_conn_destroy(struct rspro_client_conn *conn)
643{
644 /* this will internally call closed_cb() which will dispatch a TCP_DOWN event */
645 ipa_server_conn_destroy(conn->peer);
646 conn->peer = NULL;
647
648 /* ensure all slotmaps are unlinked + returned to NEW or deleted */
649 slotmaps_wrlock(conn->srv->slotmaps);
650 _unlink_all_slotmaps(conn);
651 slotmaps_unlock(conn->srv->slotmaps);
652
653 pthread_rwlock_wrlock(&conn->srv->rwlock);
654 llist_del(&conn->list);
655 pthread_rwlock_unlock(&conn->srv->rwlock);
656
657 talloc_free(conn);
658}
659
660
661struct rspro_server *rspro_server_create(void *ctx, const char *host, uint16_t port)
662
663{
664 struct rspro_server *srv = talloc_zero(ctx, struct rspro_server);
665 OSMO_ASSERT(srv);
666
667 pthread_rwlock_init(&srv->rwlock, NULL);
668 pthread_rwlock_wrlock(&srv->rwlock);
669 INIT_LLIST_HEAD(&srv->connections);
670 INIT_LLIST_HEAD(&srv->clients);
671 INIT_LLIST_HEAD(&srv->banks);
672 pthread_rwlock_unlock(&srv->rwlock);
673
674 srv->link = ipa_server_link_create(ctx, NULL, host, port, accept_cb, srv);
675 ipa_server_link_open(srv->link);
676
677 return srv;
678}
679
680void rspro_server_destroy(struct rspro_server *srv)
681{
682 /* FIXME: clear all lists */
683
684 ipa_server_link_destroy(srv->link);
685 srv->link = NULL;
686 talloc_free(srv);
687}