blob: deea45363a154863f5ec6b5b5cb869ce65825170 [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
Harald Weltef30ff9e2019-03-30 19:17:37 +0100403struct rspro_client_conn *_client_conn_by_slot(struct rspro_server *srv, const struct client_slot *cslot)
404{
405 struct rspro_client_conn *conn;
406 llist_for_each_entry(conn, &srv->clients, list) {
407 if (client_slot_equals(&conn->client.slot, cslot))
408 return conn;
409 }
410 return NULL;
411}
412struct rspro_client_conn *client_conn_by_slot(struct rspro_server *srv, const struct client_slot *cslot)
413{
414 struct rspro_client_conn *conn;
415 pthread_rwlock_rdlock(&srv->rwlock);
416 conn = _client_conn_by_slot(srv, cslot);
417 pthread_rwlock_unlock(&srv->rwlock);
418 return conn;
419}
420
Harald Weltef5a0fa32019-03-03 15:44:18 +0100421struct rspro_client_conn *_bankd_conn_by_id(struct rspro_server *srv, uint16_t bank_id)
422{
423 struct rspro_client_conn *conn;
424 llist_for_each_entry(conn, &srv->banks, list) {
425 if (conn->bank.bank_id == bank_id)
426 return conn;
427 }
428 return NULL;
429}
430struct rspro_client_conn *bankd_conn_by_id(struct rspro_server *srv, uint16_t bank_id)
431{
432 struct rspro_client_conn *conn;
433 pthread_rwlock_rdlock(&srv->rwlock);
434 conn = _bankd_conn_by_id(srv, bank_id);
435 pthread_rwlock_unlock(&srv->rwlock);
436 return conn;
437}
438
439static int handle_rx_rspro(struct rspro_client_conn *conn, const RsproPDU_t *pdu)
440{
Harald Welteb49ac9c2019-03-09 20:36:07 +0100441 LOGPFSM(conn->fi, "Rx RSPRO %s\n", rspro_msgt_name(pdu));
442
Harald Weltef5a0fa32019-03-03 15:44:18 +0100443 switch (pdu->msg.present) {
444 case RsproPDUchoice_PR_connectClientReq:
445 osmo_fsm_inst_dispatch(conn->fi, CLNTC_E_CLIENT_CONN, (void *)pdu);
446 break;
447 case RsproPDUchoice_PR_connectBankReq:
448 osmo_fsm_inst_dispatch(conn->fi, CLNTC_E_BANK_CONN, (void *)pdu);
449 break;
450 case RsproPDUchoice_PR_createMappingRes:
451 osmo_fsm_inst_dispatch(conn->fi, CLNTC_E_CREATE_MAP_RES, (void *)pdu);
452 break;
453 case RsproPDUchoice_PR_removeMappingRes:
454 osmo_fsm_inst_dispatch(conn->fi, CLNTC_E_REMOVE_MAP_RES, (void *)pdu);
455 break;
Harald Welted571a3e2019-03-11 22:09:50 +0100456 case RsproPDUchoice_PR_configClientIdRes:
Harald Weltee5c77732019-03-07 23:58:24 +0100457 osmo_fsm_inst_dispatch(conn->fi, CLNTC_E_CONFIG_CL_RES, (void *)pdu);
458 break;
Harald Welte19dee082019-03-31 10:53:45 +0200459 case RsproPDUchoice_PR_configClientBankRes:
460 /* TODO: store somewhere that client has ACKed? */
461 break;
Harald Weltef5a0fa32019-03-03 15:44:18 +0100462 default:
Harald Welte19dee082019-03-31 10:53:45 +0200463 LOGPFSML(conn->fi, LOGL_ERROR, "Received unknown/unimplemented RSPRO msg_type %s\n",
464 rspro_msgt_name(pdu));
Harald Weltef5a0fa32019-03-03 15:44:18 +0100465 return -1;
466 }
467 return 0;
468}
469
470/* data was received from one of the client connections to the RSPRO socket */
471static int sock_read_cb(struct ipa_server_conn *peer, struct msgb *msg)
472{
473 struct ipaccess_head *hh = (struct ipaccess_head *) msg->data;
474 struct ipaccess_head_ext *he = (struct ipaccess_head_ext *) msgb_l2(msg);
475 struct rspro_client_conn *conn = peer->data;
476 RsproPDU_t *pdu;
477 int rc;
478
479 if (msgb_length(msg) < sizeof(*hh))
480 goto invalid;
481 msg->l2h = &hh->data[0];
Harald Welte7bfcc652019-03-08 16:55:01 +0100482 switch (hh->proto) {
483 case IPAC_PROTO_IPACCESS:
484 rc = ipa_server_conn_ccm(peer, msg);
Harald Welte15b75e12019-03-08 16:55:46 +0100485 if (rc < 0)
486 break;
487 switch (hh->data[0]) {
488 case IPAC_MSGT_PONG:
489 ipa_keepalive_fsm_pong_received(conn->keepalive_fi);
490 rc = 0;
491 break;
492 default:
493 break;
494 }
Harald Welte7bfcc652019-03-08 16:55:01 +0100495 break;
496 case IPAC_PROTO_OSMO:
497 if (!he || msgb_l2len(msg)< sizeof(*he))
498 goto invalid;
499 msg->l2h = &he->data[0];
Harald Weltef5a0fa32019-03-03 15:44:18 +0100500
Harald Welte7bfcc652019-03-08 16:55:01 +0100501 switch (he->proto) {
502 case IPAC_PROTO_EXT_RSPRO:
503 pdu = rspro_dec_msg(msg);
504 if (!pdu)
505 goto invalid;
Harald Weltef5a0fa32019-03-03 15:44:18 +0100506
Harald Welte7bfcc652019-03-08 16:55:01 +0100507 rc = handle_rx_rspro(conn, pdu);
508 ASN_STRUCT_FREE(asn_DEF_RsproPDU, pdu);
509 break;
510 default:
511 goto invalid;
512 }
513 break;
514 default:
Harald Weltef5a0fa32019-03-03 15:44:18 +0100515 goto invalid;
Harald Welte7bfcc652019-03-08 16:55:01 +0100516 }
Harald Weltef5a0fa32019-03-03 15:44:18 +0100517 return rc;
518
519invalid:
520 msgb_free(msg);
521 return -1;
522}
523
524static int sock_closed_cb(struct ipa_server_conn *peer)
525{
526 struct rspro_client_conn *conn = peer->data;
527 if (conn->fi)
528 osmo_fsm_inst_dispatch(conn->fi, CLNTC_E_TCP_DOWN, NULL);
529 /* FIXME: who cleans up conn? */
530 /* ipa server code relases 'peer' just after this */
531 return 0;
532}
533
Harald Welte15b75e12019-03-08 16:55:46 +0100534static const struct ipa_keepalive_params ka_params = {
535 .interval = 30,
536 .wait_for_resp = 10,
537};
538
Harald Weltef5a0fa32019-03-03 15:44:18 +0100539/* a new TCP connection was accepted on the RSPRO server socket */
540static int accept_cb(struct ipa_server_link *link, int fd)
541{
542 struct rspro_server *srv = link->data;
543 struct rspro_client_conn *conn;
544
545 conn = talloc_zero(srv, struct rspro_client_conn);
546 OSMO_ASSERT(conn);
547
548 conn->srv = srv;
549 /* don't allocate peer under 'conn', as it must survive 'conn' during teardown */
550 conn->peer = ipa_server_conn_create(link, link, fd, sock_read_cb, sock_closed_cb, conn);
551 if (!conn->peer)
552 goto out_err;
553
554 /* don't allocate 'fi' as slave from 'conn', as 'fi' needs to survive 'conn' during
555 * teardown */
556 conn->fi = server_client_fsm_alloc(srv, conn);
557 if (!conn->fi)
558 goto out_err_conn;
559
Harald Welte15b75e12019-03-08 16:55:46 +0100560 /* use ipa_keepalive_fsm to periodically send an IPA_PING and expect a PONG in response */
561 conn->keepalive_fi = ipa_server_conn_alloc_keepalive_fsm(conn->peer, &ka_params, NULL);
562 if (!conn->keepalive_fi)
563 goto out_err_fi;
564 /* ensure parent is notified once keepalive FSM instance is dying */
565 osmo_fsm_inst_change_parent(conn->keepalive_fi, conn->fi, CLNTC_E_KA_TIMEOUT);
566 ipa_keepalive_fsm_start(conn->keepalive_fi);
567
Harald Weltef5a0fa32019-03-03 15:44:18 +0100568 INIT_LLIST_HEAD(&conn->bank.maps_new);
569 INIT_LLIST_HEAD(&conn->bank.maps_unack);
570 INIT_LLIST_HEAD(&conn->bank.maps_active);
571 INIT_LLIST_HEAD(&conn->bank.maps_delreq);
572 INIT_LLIST_HEAD(&conn->bank.maps_deleting);
573
574 pthread_rwlock_wrlock(&conn->srv->rwlock);
575 llist_add_tail(&conn->list, &srv->connections);
576 pthread_rwlock_unlock(&conn->srv->rwlock);
577
578 osmo_fsm_inst_dispatch(conn->fi, CLNTC_E_TCP_UP, NULL);
579 return 0;
580
Harald Welte15b75e12019-03-08 16:55:46 +0100581out_err_fi:
582 osmo_fsm_inst_term(conn->fi, OSMO_FSM_TERM_ERROR, NULL);
Harald Weltef5a0fa32019-03-03 15:44:18 +0100583out_err_conn:
584 ipa_server_conn_destroy(conn->peer);
585 /* the above will free 'conn' down the chain */
586 return -1;
587out_err:
588 talloc_free(conn);
589 return -1;
590}
591
592/* call-back if we were triggered by a rest_api thread */
593int event_fd_cb(struct osmo_fd *ofd, unsigned int what)
594{
595 struct rspro_server *srv = ofd->data;
596 struct rspro_client_conn *conn;
597 bool non_empty_new, non_empty_del;
598 uint64_t value;
599 int rc;
600
601 /* read from the socket to "confirm" the event and make it non-readable again */
602 rc = read(ofd->fd, &value, 8);
603 if (rc < 8) {
604 fprintf(stderr, "Error reading eventfd: %d\n", rc);
605 return rc;
606 }
607
608 printf("rspro_server: Event FD arrived, checking for any pending work\n");
609
610 pthread_rwlock_rdlock(&srv->rwlock);
611 llist_for_each_entry(conn, &srv->banks, list) {
612 slotmaps_rdlock(srv->slotmaps);
613 non_empty_new = llist_empty(&conn->bank.maps_new);
614 non_empty_del = llist_empty(&conn->bank.maps_delreq);
615 slotmaps_unlock(srv->slotmaps);
616
617 /* trigger FSM to send any pending new/deleted maps */
618 if (non_empty_new || non_empty_del)
619 osmo_fsm_inst_dispatch(conn->fi, CLNTC_E_PUSH, NULL);
620 }
621 pthread_rwlock_unlock(&srv->rwlock);
622
623 return 0;
624}
625
626/* unlink all slotmaps from any of the lists of this conn->bank.maps_* */
627static void _unlink_all_slotmaps(struct rspro_client_conn *conn)
628{
629 struct slot_mapping *smap, *smap2;
630
631 llist_for_each_entry_safe(smap, smap2, &conn->bank.maps_new, bank_list) {
632 /* unlink from list and keep in state NEW */
633 _slotmap_state_change(smap, SLMAP_S_NEW, NULL);
634 }
635 llist_for_each_entry_safe(smap, smap2, &conn->bank.maps_unack, bank_list) {
636 /* unlink from list and change to state NEW */
637 _slotmap_state_change(smap, SLMAP_S_NEW, NULL);
638 }
639 llist_for_each_entry_safe(smap, smap2, &conn->bank.maps_active, 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_delreq, bank_list) {
644 /* unlink from list and delete */
645 _slotmap_del(smap->maps, smap);
646 }
647 llist_for_each_entry_safe(smap, smap2, &conn->bank.maps_deleting, bank_list) {
648 /* unlink from list and delete */
649 _slotmap_del(smap->maps, smap);
650 }
651}
652
653/* only to be used by the FSM cleanup. */
654static void rspro_client_conn_destroy(struct rspro_client_conn *conn)
655{
656 /* this will internally call closed_cb() which will dispatch a TCP_DOWN event */
657 ipa_server_conn_destroy(conn->peer);
658 conn->peer = NULL;
659
660 /* ensure all slotmaps are unlinked + returned to NEW or deleted */
661 slotmaps_wrlock(conn->srv->slotmaps);
662 _unlink_all_slotmaps(conn);
663 slotmaps_unlock(conn->srv->slotmaps);
664
665 pthread_rwlock_wrlock(&conn->srv->rwlock);
666 llist_del(&conn->list);
667 pthread_rwlock_unlock(&conn->srv->rwlock);
668
669 talloc_free(conn);
670}
671
672
673struct rspro_server *rspro_server_create(void *ctx, const char *host, uint16_t port)
674
675{
676 struct rspro_server *srv = talloc_zero(ctx, struct rspro_server);
677 OSMO_ASSERT(srv);
678
679 pthread_rwlock_init(&srv->rwlock, NULL);
680 pthread_rwlock_wrlock(&srv->rwlock);
681 INIT_LLIST_HEAD(&srv->connections);
682 INIT_LLIST_HEAD(&srv->clients);
683 INIT_LLIST_HEAD(&srv->banks);
684 pthread_rwlock_unlock(&srv->rwlock);
685
686 srv->link = ipa_server_link_create(ctx, NULL, host, port, accept_cb, srv);
687 ipa_server_link_open(srv->link);
688
689 return srv;
690}
691
692void rspro_server_destroy(struct rspro_server *srv)
693{
694 /* FIXME: clear all lists */
695
696 ipa_server_link_destroy(srv->link);
697 srv->link = NULL;
698 talloc_free(srv);
699}