blob: 3ad257f7355ceadd23c98eb74eb9c6df624164a1 [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);
Harald Welte1c691b12019-03-31 10:58:11 +0200144 osmo_fsm_inst_update_id_f(conn->keepalive_fi, "C%u:%u",
145 conn->client.slot.client_id,
146 conn->client.slot.slot_nr);
Harald Weltee5c77732019-03-07 23:58:24 +0100147 resp = rspro_gen_ConnectClientRes(&conn->srv->comp_id, ResultCode_ok);
148 client_conn_send(conn, resp);
Harald Welte0a64da62019-03-30 17:38:04 +0100149 osmo_fsm_inst_state_chg(fi, CLNTC_ST_CONNECTED_CLIENT, 0, 0);
Harald Weltee5c77732019-03-07 23:58:24 +0100150 }
Harald Weltef5a0fa32019-03-03 15:44:18 +0100151
152 /* reparent us from srv->connections to srv->clients */
153 pthread_rwlock_wrlock(&conn->srv->rwlock);
154 llist_del(&conn->list);
155 llist_add_tail(&conn->list, &conn->srv->clients);
156 pthread_rwlock_unlock(&conn->srv->rwlock);
Harald Weltef5a0fa32019-03-03 15:44:18 +0100157 break;
158 case CLNTC_E_BANK_CONN:
159 cbreq = &pdu->msg.choice.connectBankReq;
160 /* save the [remote] component identity in 'conn' */
161 rspro_comp_id_retrieve(&conn->comp_id, &cbreq->identity);
162 if (conn->comp_id.type != ComponentType_remsimBankd) {
163 LOGPFSM(fi, "ConnectBankReq from identity != Bank ?!?\n");
164 osmo_fsm_inst_term(fi, OSMO_FSM_TERM_ERROR, NULL);
165 }
Harald Weltee5c77732019-03-07 23:58:24 +0100166 /* FIXME: check for unique-ness */
Harald Weltef5a0fa32019-03-03 15:44:18 +0100167 conn->bank.bank_id = cbreq->bankId;
168 conn->bank.num_slots = cbreq->numberOfSlots;
169 osmo_fsm_inst_update_id_f(fi, "B%u", conn->bank.bank_id);
Harald Welte1c691b12019-03-31 10:58:11 +0200170 osmo_fsm_inst_update_id_f(conn->keepalive_fi, "B%u", conn->bank.bank_id);
Harald Weltef5a0fa32019-03-03 15:44:18 +0100171
172 /* reparent us from srv->connections to srv->banks */
173 pthread_rwlock_wrlock(&conn->srv->rwlock);
174 llist_del(&conn->list);
175 llist_add_tail(&conn->list, &conn->srv->banks);
176 pthread_rwlock_unlock(&conn->srv->rwlock);
177
178 /* send response to bank first */
179 resp = rspro_gen_ConnectBankRes(&conn->srv->comp_id, ResultCode_ok);
180 client_conn_send(conn, resp);
181
182 /* the state change will associate any pre-existing slotmaps */
Harald Welte0a64da62019-03-30 17:38:04 +0100183 osmo_fsm_inst_state_chg(fi, CLNTC_ST_CONNECTED_BANKD, 0, 0);
Harald Weltef5a0fa32019-03-03 15:44:18 +0100184
185 osmo_fsm_inst_dispatch(fi, CLNTC_E_PUSH, NULL);
186 break;
187 default:
188 OSMO_ASSERT(0);
189 }
190}
191
Harald Weltee5c77732019-03-07 23:58:24 +0100192static void clnt_st_wait_cl_conf_res(struct osmo_fsm_inst *fi, uint32_t event, void *data)
193{
194 switch (event) {
195 case CLNTC_E_CONFIG_CL_RES:
Harald Welte0a64da62019-03-30 17:38:04 +0100196 osmo_fsm_inst_state_chg(fi, CLNTC_ST_CONNECTED_CLIENT, 0, 0);
Harald Weltee5c77732019-03-07 23:58:24 +0100197 break;
198 default:
199 OSMO_ASSERT(0);
200 }
201}
Harald Weltef5a0fa32019-03-03 15:44:18 +0100202
Harald Welte0a64da62019-03-30 17:38:04 +0100203static void clnt_st_connected_client_onenter(struct osmo_fsm_inst *fi, uint32_t prev_state)
Harald Weltef5a0fa32019-03-03 15:44:18 +0100204{
205#if 0
206 struct rspro_client_conn *conn = fi->priv;
207 ClientSlot_t clslot;
208 RsproPDU_t *pdu;
209
210 /* send configuration to this new client */
211 client_slot2rspro(&clslot, FIXME);
212 pdu = rspro_gen_ConfigClientReq(&clslot, bankd_ip, bankd_port);
213 client_conn_send(conn, pdu);
214#endif
215}
216
Harald Welte0a64da62019-03-30 17:38:04 +0100217static void clnt_st_connected_bankd_onenter(struct osmo_fsm_inst *fi, uint32_t prev_state)
Harald Weltef5a0fa32019-03-03 15:44:18 +0100218{
219 struct rspro_client_conn *conn = fi->priv;
220 struct slotmaps *slotmaps = conn->srv->slotmaps;
221 struct slot_mapping *map;
222
223 LOGPFSM(fi, "Associating pre-existing slotmaps (if any)\n");
224 /* Link all known mappings to this new bank */
225 slotmaps_wrlock(slotmaps);
226 llist_for_each_entry(map, &slotmaps->mappings, list) {
227 if (map->bank.bank_id == conn->bank.bank_id)
228 _slotmap_state_change(map, SLMAP_S_NEW, &conn->bank.maps_new);
229 }
230 slotmaps_unlock(slotmaps);
231}
232
Harald Welte0a64da62019-03-30 17:38:04 +0100233static void clnt_st_connected_client(struct osmo_fsm_inst *fi, uint32_t event, void *data)
Harald Weltef5a0fa32019-03-03 15:44:18 +0100234{
235 struct rspro_client_conn *conn = fi->priv;
Harald Welte0a64da62019-03-30 17:38:04 +0100236 struct slotmaps *slotmaps = conn->srv->slotmaps;
237 const struct RsproPDU_t *rx = NULL;
238
239 switch (event) {
Harald Weltef5a0fa32019-03-03 15:44:18 +0100240 default:
241 OSMO_ASSERT(0);
242 }
243}
244
Harald Welte0a64da62019-03-30 17:38:04 +0100245static void clnt_st_connected_bankd(struct osmo_fsm_inst *fi, uint32_t event, void *data)
Harald Weltef5a0fa32019-03-03 15:44:18 +0100246{
247 struct rspro_client_conn *conn = fi->priv;
248 struct slotmaps *slotmaps = conn->srv->slotmaps;
249 const struct RsproPDU_t *rx = NULL;
250 struct slot_mapping *map, *map2;
251
252 switch (event) {
Harald Welte1b07f7f2019-03-30 17:33:07 +0100253 case CLNTC_E_CREATE_MAP_RES: /* Bankd acknowledges mapping was created */
Harald Weltef5a0fa32019-03-03 15:44:18 +0100254 rx = data;
255 slotmaps_wrlock(slotmaps);
256 /* FIXME: resolve map by pdu->tag */
257 /* as hack use first element of conn->maps_unack */
258 map = llist_first_entry(&conn->bank.maps_unack, struct slot_mapping, bank_list);
259 if (!map) {
260 slotmaps_unlock(slotmaps);
261 LOGPFSM(fi, "CreateMapRes but no unacknowledged map");
262 break;
263 }
264 _slotmap_state_change(map, SLMAP_S_ACTIVE, &conn->bank.maps_active);
265 slotmaps_unlock(slotmaps);
266 break;
Harald Welte1b07f7f2019-03-30 17:33:07 +0100267 case CLNTC_E_REMOVE_MAP_RES: /* Bankd acknowledges mapping was removed */
Harald Weltef5a0fa32019-03-03 15:44:18 +0100268 rx = data;
269 slotmaps_wrlock(slotmaps);
270 /* FIXME: resolve map by pdu->tag */
271 /* as hack use first element of conn->maps_deleting */
272 map = llist_first_entry(&conn->bank.maps_deleting, struct slot_mapping, bank_list);
273 if (!map) {
274 slotmaps_unlock(slotmaps);
275 LOGPFSM(fi, "RemoveMapRes but no unacknowledged map");
276 break;
277 }
278 slotmaps_unlock(slotmaps);
279 /* slotmap_del() will remove it from both global and bank list */
280 slotmap_del(map->maps, map);
281 break;
Harald Welte1b07f7f2019-03-30 17:33:07 +0100282 case CLNTC_E_PUSH: /* check if any create or delete requests are pending */
Harald Weltef5a0fa32019-03-03 15:44:18 +0100283 slotmaps_wrlock(slotmaps);
284 /* send any pending create requests */
285 llist_for_each_entry_safe(map, map2, &conn->bank.maps_new, bank_list) {
286 RsproPDU_t *pdu = slotmap2CreateMappingReq(map);
287 client_conn_send(conn, pdu);
288 _slotmap_state_change(map, SLMAP_S_UNACKNOWLEDGED, &conn->bank.maps_unack);
289 }
290 /* send any pending delete requests */
291 llist_for_each_entry_safe(map, map2, &conn->bank.maps_delreq, bank_list) {
292 RsproPDU_t *pdu = slotmap2RemoveMappingReq(map);
293 client_conn_send(conn, pdu);
294 _slotmap_state_change(map, SLMAP_S_DELETING, &conn->bank.maps_deleting);
295 }
296 slotmaps_unlock(slotmaps);
297 break;
298 default:
299 OSMO_ASSERT(0);
300 }
301}
302
303static void clnt_allstate_action(struct osmo_fsm_inst *fi, uint32_t event, void *data)
304{
305 struct rspro_client_conn *conn = fi->priv;
306
307 switch (event) {
308 case CLNTC_E_TCP_DOWN:
309 osmo_fsm_inst_term(fi, OSMO_FSM_TERM_REGULAR, NULL);
310 break;
Harald Welte15b75e12019-03-08 16:55:46 +0100311 case CLNTC_E_KA_TIMEOUT:
312 osmo_fsm_inst_term(fi, OSMO_FSM_TERM_REGULAR, NULL);
313 break;
Harald Weltef5a0fa32019-03-03 15:44:18 +0100314 default:
315 OSMO_ASSERT(0);
316 }
317}
318
319static int server_client_fsm_timer_cb(struct osmo_fsm_inst *fi)
320{
321 struct rspro_client_conn *conn = fi->priv;
322
323 switch (fi->T) {
324 case 1:
325 /* No ClientConnectReq received:disconnect */
326 return 1; /* ask core to terminate FSM */
327 default:
328 OSMO_ASSERT(0);
329 }
330 return 0;
331}
332
333static void server_client_cleanup(struct osmo_fsm_inst *fi, enum osmo_fsm_term_cause cause)
334{
335 struct rspro_client_conn *conn = fi->priv;
336 /* this call will destroy the IPA connection, which will in turn call closed_cb()
337 * which will try to deliver a E_TCP_DOWN event. Clear conn->fi to avoid that loop */
338 conn->fi = NULL;
339 rspro_client_conn_destroy(conn);
340}
341
342static const struct osmo_fsm_state server_client_fsm_states[] = {
343 [CLNTC_ST_INIT] = {
344 .name = "INIT",
345 .in_event_mask = S(CLNTC_E_TCP_UP),
346 .out_state_mask = S(CLNTC_ST_ESTABLISHED),
347 .action = clnt_st_init,
348 },
349 [CLNTC_ST_ESTABLISHED] = {
350 .name = "ESTABLISHED",
351 .in_event_mask = S(CLNTC_E_CLIENT_CONN) | S(CLNTC_E_BANK_CONN),
Harald Welte0a64da62019-03-30 17:38:04 +0100352 .out_state_mask = S(CLNTC_ST_CONNECTED_CLIENT) | S(CLNTC_ST_WAIT_CONF_RES) |
353 S(CLNTC_ST_CONNECTED_BANKD),
Harald Weltef5a0fa32019-03-03 15:44:18 +0100354 .action = clnt_st_established,
355 },
Harald Weltee5c77732019-03-07 23:58:24 +0100356 [CLNTC_ST_WAIT_CONF_RES] = {
357 .name = "WAIT_CONFIG_RES",
358 .in_event_mask = S(CLNTC_E_CONFIG_CL_RES),
Harald Welte0a64da62019-03-30 17:38:04 +0100359 .out_state_mask = S(CLNTC_ST_CONNECTED_CLIENT),
Harald Weltee5c77732019-03-07 23:58:24 +0100360 .action = clnt_st_wait_cl_conf_res,
361 },
Harald Welte0a64da62019-03-30 17:38:04 +0100362 [CLNTC_ST_CONNECTED_CLIENT] = {
363 .name = "CONNECTED_CLIENT",
364 .in_event_mask = 0,
365 .action = clnt_st_connected_client,
366 .onenter = clnt_st_connected_client_onenter,
367 },
368 [CLNTC_ST_CONNECTED_BANKD] = {
369 .name = "CONNECTED_BANKD",
Harald Weltef5a0fa32019-03-03 15:44:18 +0100370 .in_event_mask = S(CLNTC_E_CREATE_MAP_RES) | S(CLNTC_E_REMOVE_MAP_RES) |
371 S(CLNTC_E_PUSH),
Harald Welte0a64da62019-03-30 17:38:04 +0100372 .action = clnt_st_connected_bankd,
373 .onenter = clnt_st_connected_bankd_onenter,
Harald Weltef5a0fa32019-03-03 15:44:18 +0100374 },
Harald Welte0a64da62019-03-30 17:38:04 +0100375
Harald Weltef5a0fa32019-03-03 15:44:18 +0100376};
377
378static struct osmo_fsm remsim_server_client_fsm = {
379 .name = "SERVER_CONN",
380 .states = server_client_fsm_states,
381 .num_states = ARRAY_SIZE(server_client_fsm_states),
Harald Welte10f7a762019-03-31 12:38:47 +0200382 .allstate_event_mask = S(CLNTC_E_TCP_DOWN) | S(CLNTC_E_KA_TIMEOUT),
Harald Weltef5a0fa32019-03-03 15:44:18 +0100383 .allstate_action = clnt_allstate_action,
384 .cleanup = server_client_cleanup,
385 .timer_cb = server_client_fsm_timer_cb,
386 .log_subsys = DMAIN,
387 .event_names = server_client_event_names,
388};
389
390struct osmo_fsm_inst *server_client_fsm_alloc(void *ctx, struct rspro_client_conn *conn)
391{
392 //const char *id = osmo_sock_get_name2(conn->peer->ofd.fd);
393 return osmo_fsm_inst_alloc(&remsim_server_client_fsm, ctx, conn, LOGL_DEBUG, NULL);
394}
395
396
397static __attribute__((constructor)) void on_dso_load(void)
398{
399 osmo_fsm_register(&remsim_server_client_fsm);
400}
401
402
403/***********************************************************************
404 * IPA RSPRO Server
405 ***********************************************************************/
406
Harald Weltef30ff9e2019-03-30 19:17:37 +0100407struct rspro_client_conn *_client_conn_by_slot(struct rspro_server *srv, const struct client_slot *cslot)
408{
409 struct rspro_client_conn *conn;
410 llist_for_each_entry(conn, &srv->clients, list) {
411 if (client_slot_equals(&conn->client.slot, cslot))
412 return conn;
413 }
414 return NULL;
415}
416struct rspro_client_conn *client_conn_by_slot(struct rspro_server *srv, const struct client_slot *cslot)
417{
418 struct rspro_client_conn *conn;
419 pthread_rwlock_rdlock(&srv->rwlock);
420 conn = _client_conn_by_slot(srv, cslot);
421 pthread_rwlock_unlock(&srv->rwlock);
422 return conn;
423}
424
Harald Weltef5a0fa32019-03-03 15:44:18 +0100425struct rspro_client_conn *_bankd_conn_by_id(struct rspro_server *srv, uint16_t bank_id)
426{
427 struct rspro_client_conn *conn;
428 llist_for_each_entry(conn, &srv->banks, list) {
429 if (conn->bank.bank_id == bank_id)
430 return conn;
431 }
432 return NULL;
433}
434struct rspro_client_conn *bankd_conn_by_id(struct rspro_server *srv, uint16_t bank_id)
435{
436 struct rspro_client_conn *conn;
437 pthread_rwlock_rdlock(&srv->rwlock);
438 conn = _bankd_conn_by_id(srv, bank_id);
439 pthread_rwlock_unlock(&srv->rwlock);
440 return conn;
441}
442
443static int handle_rx_rspro(struct rspro_client_conn *conn, const RsproPDU_t *pdu)
444{
Harald Welteb49ac9c2019-03-09 20:36:07 +0100445 LOGPFSM(conn->fi, "Rx RSPRO %s\n", rspro_msgt_name(pdu));
446
Harald Weltef5a0fa32019-03-03 15:44:18 +0100447 switch (pdu->msg.present) {
448 case RsproPDUchoice_PR_connectClientReq:
449 osmo_fsm_inst_dispatch(conn->fi, CLNTC_E_CLIENT_CONN, (void *)pdu);
450 break;
451 case RsproPDUchoice_PR_connectBankReq:
452 osmo_fsm_inst_dispatch(conn->fi, CLNTC_E_BANK_CONN, (void *)pdu);
453 break;
454 case RsproPDUchoice_PR_createMappingRes:
455 osmo_fsm_inst_dispatch(conn->fi, CLNTC_E_CREATE_MAP_RES, (void *)pdu);
456 break;
457 case RsproPDUchoice_PR_removeMappingRes:
458 osmo_fsm_inst_dispatch(conn->fi, CLNTC_E_REMOVE_MAP_RES, (void *)pdu);
459 break;
Harald Welted571a3e2019-03-11 22:09:50 +0100460 case RsproPDUchoice_PR_configClientIdRes:
Harald Weltee5c77732019-03-07 23:58:24 +0100461 osmo_fsm_inst_dispatch(conn->fi, CLNTC_E_CONFIG_CL_RES, (void *)pdu);
462 break;
Harald Welte19dee082019-03-31 10:53:45 +0200463 case RsproPDUchoice_PR_configClientBankRes:
464 /* TODO: store somewhere that client has ACKed? */
465 break;
Harald Weltef5a0fa32019-03-03 15:44:18 +0100466 default:
Harald Welte19dee082019-03-31 10:53:45 +0200467 LOGPFSML(conn->fi, LOGL_ERROR, "Received unknown/unimplemented RSPRO msg_type %s\n",
468 rspro_msgt_name(pdu));
Harald Weltef5a0fa32019-03-03 15:44:18 +0100469 return -1;
470 }
471 return 0;
472}
473
474/* data was received from one of the client connections to the RSPRO socket */
475static int sock_read_cb(struct ipa_server_conn *peer, struct msgb *msg)
476{
477 struct ipaccess_head *hh = (struct ipaccess_head *) msg->data;
478 struct ipaccess_head_ext *he = (struct ipaccess_head_ext *) msgb_l2(msg);
479 struct rspro_client_conn *conn = peer->data;
480 RsproPDU_t *pdu;
481 int rc;
482
483 if (msgb_length(msg) < sizeof(*hh))
484 goto invalid;
485 msg->l2h = &hh->data[0];
Harald Welte7bfcc652019-03-08 16:55:01 +0100486 switch (hh->proto) {
487 case IPAC_PROTO_IPACCESS:
488 rc = ipa_server_conn_ccm(peer, msg);
Harald Welte15b75e12019-03-08 16:55:46 +0100489 if (rc < 0)
490 break;
491 switch (hh->data[0]) {
492 case IPAC_MSGT_PONG:
493 ipa_keepalive_fsm_pong_received(conn->keepalive_fi);
494 rc = 0;
495 break;
496 default:
497 break;
498 }
Harald Welte7bfcc652019-03-08 16:55:01 +0100499 break;
500 case IPAC_PROTO_OSMO:
501 if (!he || msgb_l2len(msg)< sizeof(*he))
502 goto invalid;
503 msg->l2h = &he->data[0];
Harald Weltef5a0fa32019-03-03 15:44:18 +0100504
Harald Welte7bfcc652019-03-08 16:55:01 +0100505 switch (he->proto) {
506 case IPAC_PROTO_EXT_RSPRO:
507 pdu = rspro_dec_msg(msg);
508 if (!pdu)
509 goto invalid;
Harald Weltef5a0fa32019-03-03 15:44:18 +0100510
Harald Welte7bfcc652019-03-08 16:55:01 +0100511 rc = handle_rx_rspro(conn, pdu);
512 ASN_STRUCT_FREE(asn_DEF_RsproPDU, pdu);
513 break;
514 default:
515 goto invalid;
516 }
517 break;
518 default:
Harald Weltef5a0fa32019-03-03 15:44:18 +0100519 goto invalid;
Harald Welte7bfcc652019-03-08 16:55:01 +0100520 }
Harald Weltef5a0fa32019-03-03 15:44:18 +0100521 return rc;
522
523invalid:
524 msgb_free(msg);
525 return -1;
526}
527
528static int sock_closed_cb(struct ipa_server_conn *peer)
529{
530 struct rspro_client_conn *conn = peer->data;
531 if (conn->fi)
532 osmo_fsm_inst_dispatch(conn->fi, CLNTC_E_TCP_DOWN, NULL);
533 /* FIXME: who cleans up conn? */
534 /* ipa server code relases 'peer' just after this */
535 return 0;
536}
537
Harald Welte15b75e12019-03-08 16:55:46 +0100538static const struct ipa_keepalive_params ka_params = {
539 .interval = 30,
540 .wait_for_resp = 10,
541};
542
Harald Weltef5a0fa32019-03-03 15:44:18 +0100543/* a new TCP connection was accepted on the RSPRO server socket */
544static int accept_cb(struct ipa_server_link *link, int fd)
545{
546 struct rspro_server *srv = link->data;
547 struct rspro_client_conn *conn;
548
549 conn = talloc_zero(srv, struct rspro_client_conn);
550 OSMO_ASSERT(conn);
551
552 conn->srv = srv;
553 /* don't allocate peer under 'conn', as it must survive 'conn' during teardown */
554 conn->peer = ipa_server_conn_create(link, link, fd, sock_read_cb, sock_closed_cb, conn);
555 if (!conn->peer)
556 goto out_err;
557
558 /* don't allocate 'fi' as slave from 'conn', as 'fi' needs to survive 'conn' during
559 * teardown */
560 conn->fi = server_client_fsm_alloc(srv, conn);
561 if (!conn->fi)
562 goto out_err_conn;
563
Harald Welte15b75e12019-03-08 16:55:46 +0100564 /* use ipa_keepalive_fsm to periodically send an IPA_PING and expect a PONG in response */
565 conn->keepalive_fi = ipa_server_conn_alloc_keepalive_fsm(conn->peer, &ka_params, NULL);
566 if (!conn->keepalive_fi)
567 goto out_err_fi;
568 /* ensure parent is notified once keepalive FSM instance is dying */
569 osmo_fsm_inst_change_parent(conn->keepalive_fi, conn->fi, CLNTC_E_KA_TIMEOUT);
570 ipa_keepalive_fsm_start(conn->keepalive_fi);
571
Harald Weltef5a0fa32019-03-03 15:44:18 +0100572 INIT_LLIST_HEAD(&conn->bank.maps_new);
573 INIT_LLIST_HEAD(&conn->bank.maps_unack);
574 INIT_LLIST_HEAD(&conn->bank.maps_active);
575 INIT_LLIST_HEAD(&conn->bank.maps_delreq);
576 INIT_LLIST_HEAD(&conn->bank.maps_deleting);
577
578 pthread_rwlock_wrlock(&conn->srv->rwlock);
579 llist_add_tail(&conn->list, &srv->connections);
580 pthread_rwlock_unlock(&conn->srv->rwlock);
581
582 osmo_fsm_inst_dispatch(conn->fi, CLNTC_E_TCP_UP, NULL);
583 return 0;
584
Harald Welte15b75e12019-03-08 16:55:46 +0100585out_err_fi:
586 osmo_fsm_inst_term(conn->fi, OSMO_FSM_TERM_ERROR, NULL);
Harald Weltef5a0fa32019-03-03 15:44:18 +0100587out_err_conn:
588 ipa_server_conn_destroy(conn->peer);
589 /* the above will free 'conn' down the chain */
590 return -1;
591out_err:
592 talloc_free(conn);
593 return -1;
594}
595
596/* call-back if we were triggered by a rest_api thread */
597int event_fd_cb(struct osmo_fd *ofd, unsigned int what)
598{
599 struct rspro_server *srv = ofd->data;
600 struct rspro_client_conn *conn;
601 bool non_empty_new, non_empty_del;
602 uint64_t value;
603 int rc;
604
605 /* read from the socket to "confirm" the event and make it non-readable again */
606 rc = read(ofd->fd, &value, 8);
607 if (rc < 8) {
608 fprintf(stderr, "Error reading eventfd: %d\n", rc);
609 return rc;
610 }
611
612 printf("rspro_server: Event FD arrived, checking for any pending work\n");
613
614 pthread_rwlock_rdlock(&srv->rwlock);
615 llist_for_each_entry(conn, &srv->banks, list) {
616 slotmaps_rdlock(srv->slotmaps);
617 non_empty_new = llist_empty(&conn->bank.maps_new);
618 non_empty_del = llist_empty(&conn->bank.maps_delreq);
619 slotmaps_unlock(srv->slotmaps);
620
621 /* trigger FSM to send any pending new/deleted maps */
622 if (non_empty_new || non_empty_del)
623 osmo_fsm_inst_dispatch(conn->fi, CLNTC_E_PUSH, NULL);
624 }
625 pthread_rwlock_unlock(&srv->rwlock);
626
627 return 0;
628}
629
630/* unlink all slotmaps from any of the lists of this conn->bank.maps_* */
631static void _unlink_all_slotmaps(struct rspro_client_conn *conn)
632{
633 struct slot_mapping *smap, *smap2;
634
635 llist_for_each_entry_safe(smap, smap2, &conn->bank.maps_new, bank_list) {
636 /* unlink from list and keep in state NEW */
637 _slotmap_state_change(smap, SLMAP_S_NEW, NULL);
638 }
639 llist_for_each_entry_safe(smap, smap2, &conn->bank.maps_unack, bank_list) {
640 /* unlink from list and change to state NEW */
641 _slotmap_state_change(smap, SLMAP_S_NEW, NULL);
642 }
643 llist_for_each_entry_safe(smap, smap2, &conn->bank.maps_active, bank_list) {
644 /* unlink from list and change to state NEW */
645 _slotmap_state_change(smap, SLMAP_S_NEW, NULL);
646 }
647 llist_for_each_entry_safe(smap, smap2, &conn->bank.maps_delreq, bank_list) {
648 /* unlink from list and delete */
649 _slotmap_del(smap->maps, smap);
650 }
651 llist_for_each_entry_safe(smap, smap2, &conn->bank.maps_deleting, bank_list) {
652 /* unlink from list and delete */
653 _slotmap_del(smap->maps, smap);
654 }
655}
656
657/* only to be used by the FSM cleanup. */
658static void rspro_client_conn_destroy(struct rspro_client_conn *conn)
659{
660 /* this will internally call closed_cb() which will dispatch a TCP_DOWN event */
661 ipa_server_conn_destroy(conn->peer);
662 conn->peer = NULL;
663
664 /* ensure all slotmaps are unlinked + returned to NEW or deleted */
665 slotmaps_wrlock(conn->srv->slotmaps);
666 _unlink_all_slotmaps(conn);
667 slotmaps_unlock(conn->srv->slotmaps);
668
669 pthread_rwlock_wrlock(&conn->srv->rwlock);
670 llist_del(&conn->list);
671 pthread_rwlock_unlock(&conn->srv->rwlock);
672
673 talloc_free(conn);
674}
675
676
677struct rspro_server *rspro_server_create(void *ctx, const char *host, uint16_t port)
678
679{
680 struct rspro_server *srv = talloc_zero(ctx, struct rspro_server);
681 OSMO_ASSERT(srv);
682
683 pthread_rwlock_init(&srv->rwlock, NULL);
684 pthread_rwlock_wrlock(&srv->rwlock);
685 INIT_LLIST_HEAD(&srv->connections);
686 INIT_LLIST_HEAD(&srv->clients);
687 INIT_LLIST_HEAD(&srv->banks);
688 pthread_rwlock_unlock(&srv->rwlock);
689
690 srv->link = ipa_server_link_create(ctx, NULL, host, port, accept_cb, srv);
691 ipa_server_link_open(srv->link);
692
693 return srv;
694}
695
696void rspro_server_destroy(struct rspro_server *srv)
697{
698 /* FIXME: clear all lists */
699
700 ipa_server_link_destroy(srv->link);
701 srv->link = NULL;
702 talloc_free(srv);
703}