blob: c1fc0de1366772c5f4584dacbf3f0604ba988dae [file] [log] [blame]
Neels Hofmeyr538d2c52019-01-28 03:51:35 +01001/* FSM to manage multiple connections of an MGW endpoint
2 *
3 * (C) 2018-2019 by sysmocom - s.f.m.c. GmbH <info@sysmocom.de>
4 * All Rights Reserved
5 *
6 * Author: Neels Hofmeyr <neels@hofmeyr.de>
7 *
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU Affero General Public License as published by
10 * the Free Software Foundation; either version 3 of the License, or
11 * (at your option) any later version.
12 *
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU Affero General Public License for more details.
17 *
18 * You should have received a copy of the GNU Affero General Public License
19 * along with this program. If not, see <http://www.gnu.org/licenses/>.
20 *
21 */
22
23#include <sys/socket.h>
24#include <netinet/in.h>
25#include <arpa/inet.h>
26
27#include <osmocom/core/fsm.h>
28#include <osmocom/core/byteswap.h>
29#include <osmocom/core/tdef.h>
Pau Espin Pedrol729bf3e2020-08-28 19:28:07 +020030#include <osmocom/core/sockaddr_str.h>
Neels Hofmeyr538d2c52019-01-28 03:51:35 +010031
32#include <osmocom/mgcp_client/mgcp_client_endpoint_fsm.h>
33
34#define LOG_CI(ci, level, fmt, args...) do { \
35 if (!ci || !ci->ep) \
36 LOGP(DLGLOBAL, level, "(unknown MGW endpoint) " fmt, ## args); \
37 else \
38 LOG_MGCPC_EP(ci->ep, level, "CI[%d] %s%s%s: " fmt, \
39 (int)(ci - ci->ep->ci), \
40 ci->label ? : "-", \
41 ci->mgcp_ci_str[0] ? " CI=" : "", \
42 ci->mgcp_ci_str[0] ? ci->mgcp_ci_str : "", \
43 ## args); \
44 } while(0)
45
46#define LOG_CI_VERB(ci, level, fmt, args...) do { \
47 if (ci->verb_info.addr[0]) \
48 LOG_CI(ci, level, "%s %s:%u: " fmt, \
49 osmo_mgcp_verb_name(ci->verb), ci->verb_info.addr, ci->verb_info.port, \
50 ## args); \
51 else \
52 LOG_CI(ci, level, "%s: " fmt, \
53 osmo_mgcp_verb_name(ci->verb), \
54 ## args); \
55 } while(0)
56
57enum osmo_mgcpc_ep_fsm_state {
58 OSMO_MGCPC_EP_ST_UNUSED = 0,
59 OSMO_MGCPC_EP_ST_WAIT_MGW_RESPONSE,
60 OSMO_MGCPC_EP_ST_IN_USE,
61};
62
63enum osmo_mgcpc_ep_fsm_event {
64 _OSMO_MGCPC_EP_EV_LAST = 0,
65 /* and MGW response events are allocated dynamically */
66};
67
68#define FIRST_CI_EVENT (_OSMO_MGCPC_EP_EV_LAST + (_OSMO_MGCPC_EP_EV_LAST & 1)) /* rounded up to even nr */
69#define USABLE_CI ((32 - FIRST_CI_EVENT)/2)
70#define EV_TO_CI_IDX(event) ((event - FIRST_CI_EVENT) / 2)
71
72#define CI_EV_SUCCESS(ci) (FIRST_CI_EVENT + (((ci) - ci->ep->ci) * 2))
73#define CI_EV_FAILURE(ci) (CI_EV_SUCCESS(ci) + 1)
74
75static struct osmo_fsm osmo_mgcpc_ep_fsm;
76
Neels Hofmeyr3ff71282019-10-29 17:41:20 +010077struct fsm_notify {
Neels Hofmeyrf2bf8dc2019-10-29 17:39:56 +010078 struct llist_head entry;
Neels Hofmeyr3ff71282019-10-29 17:41:20 +010079 struct osmo_fsm_inst *fi;
80 uint32_t success;
81 uint32_t failure;
82 void *data;
83};
84
Neels Hofmeyr538d2c52019-01-28 03:51:35 +010085/*! One connection on an endpoint, corresponding to a connection identifier (CI) as returned by the MGW.
86 * An endpoint has a fixed number of slots of these, which may or may not be in use.
87 */
88struct osmo_mgcpc_ep_ci {
89 struct osmo_mgcpc_ep *ep;
90
91 bool occupied;
92 char label[64];
93 struct osmo_fsm_inst *mgcp_client_fi;
94
95 bool pending;
96 bool sent;
97 enum mgcp_verb verb;
98 struct mgcp_conn_peer verb_info;
Neels Hofmeyr3ff71282019-10-29 17:41:20 +010099 struct fsm_notify notify;
Neels Hofmeyr538d2c52019-01-28 03:51:35 +0100100
101 bool got_port_info;
102 struct mgcp_conn_peer rtp_info;
103 char mgcp_ci_str[MGCP_CONN_ID_LENGTH];
104};
105
106/*! An MGW endpoint with N connections, like "rtpbridge/23@mgw". */
107struct osmo_mgcpc_ep {
108 /*! MGCP client connection to the MGW. */
109 struct mgcp_client *mgcp_client;
110 struct osmo_fsm_inst *fi;
111
112 /*! Endpoint string; at first this might be a wildcard, and upon the first CRCX OK response, this will reflect
113 * the endpoint name returned by the MGW. */
114 char endpoint[MGCP_ENDPOINT_MAXLEN];
115
116 /*! Timeout definitions used for this endpoint, see osmo_mgcpc_ep_fsm_timeouts. */
117 const struct osmo_tdef *T_defs;
118
Neels Hofmeyrc5479fe2019-04-05 01:36:06 +0200119 /*! True as soon as the first CRCX OK is received. The endpoint name may be determined by the first CRCX
120 * response, so to dispatch any other messages, the FSM instance *must* wait for the first CRCX OK to arrive
121 * first. Once the endpoint name is pinpointed, any amount of operations may be dispatched concurrently. */
122 bool first_crcx_complete;
123
Neels Hofmeyr538d2c52019-01-28 03:51:35 +0100124 /*! Endpoint connection slots. Note that each connection has its own set of FSM event numbers to signal success
125 * and failure, depending on its index within this array. See CI_EV_SUCCESS and CI_EV_FAILURE. */
126 struct osmo_mgcpc_ep_ci ci[USABLE_CI];
Neels Hofmeyrf2bf8dc2019-10-29 17:39:56 +0100127
128 /*! Internal use: if a function keeps an fsm_notify for later dispatch while already clearing or re-using the
129 * ci[], the fsm_notify should be kept here to also get canceled by osmo_mgcpc_ep_cancel_notify(). */
130 struct llist_head background_notify;
Neels Hofmeyr538d2c52019-01-28 03:51:35 +0100131};
132
133const struct value_string osmo_mgcp_verb_names[] = {
134 { MGCP_VERB_CRCX, "CRCX" },
135 { MGCP_VERB_MDCX, "MDCX" },
136 { MGCP_VERB_DLCX, "DLCX" },
137 { MGCP_VERB_AUEP, "AUEP" },
138 { MGCP_VERB_RSIP, "RSIP" },
139 {}
140};
141
Neels Hofmeyrc5479fe2019-04-05 01:36:06 +0200142static void osmo_mgcpc_ep_count(struct osmo_mgcpc_ep *ep, int *occupied, int *pending_not_sent,
143 int *waiting_for_response);
144
Neels Hofmeyr538d2c52019-01-28 03:51:35 +0100145static struct osmo_mgcpc_ep_ci *osmo_mgcpc_ep_check_ci(struct osmo_mgcpc_ep_ci *ci)
146{
147 if (!ci)
148 return NULL;
149 if (!ci->ep)
150 return NULL;
151 if (ci < ci->ep->ci || ci >= &ci->ep->ci[USABLE_CI])
152 return NULL;
153 return ci;
154}
155
156static struct osmo_mgcpc_ep_ci *osmo_mgcpc_ep_ci_for_event(struct osmo_mgcpc_ep *ep, uint32_t event)
157{
158 int idx;
159 if (event < FIRST_CI_EVENT)
160 return NULL;
161 idx = EV_TO_CI_IDX(event);
162 if (idx >= sizeof(ep->ci))
163 return NULL;
164 return osmo_mgcpc_ep_check_ci(&ep->ci[idx]);
165}
166
167const char *osmo_mgcpc_ep_name(const struct osmo_mgcpc_ep *ep)
168{
169 if (!ep)
170 return "NULL";
171 if (ep->endpoint[0])
172 return ep->endpoint;
173 return osmo_fsm_inst_name(ep->fi);
174}
175
176const char *mgcp_conn_peer_name(const struct mgcp_conn_peer *info)
177{
178 /* I'd be fine with a smaller buffer and accept truncation, but gcc possibly refuses to build if
179 * this buffer is too small. */
180 static char buf[1024];
181
182 if (!info)
183 return "NULL";
184
185 if (info->endpoint[0]
186 && info->addr[0])
187 snprintf(buf, sizeof(buf), "%s:%s:%u",
188 info->endpoint, info->addr, info->port);
189 else if (info->endpoint[0])
190 snprintf(buf, sizeof(buf), "%s", info->endpoint);
191 else if (info->addr[0])
192 snprintf(buf, sizeof(buf), "%s:%u", info->addr, info->port);
193 else
194 return "empty";
195 return buf;
196}
197
198const char *osmo_mgcpc_ep_ci_name(const struct osmo_mgcpc_ep_ci *ci)
199{
200 const struct mgcp_conn_peer *rtp_info;
201
202 if (!ci)
203 return "NULL";
204
205 rtp_info = osmo_mgcpc_ep_ci_get_rtp_info(ci);
206
207 if (rtp_info)
208 return mgcp_conn_peer_name(rtp_info);
209 return osmo_mgcpc_ep_name(ci->ep);
210}
211
212const char *osmo_mgcpc_ep_ci_id(const struct osmo_mgcpc_ep_ci *ci)
213{
214 if (!ci || !ci->mgcp_ci_str[0])
215 return NULL;
216 return ci->mgcp_ci_str;
217}
218
219static struct value_string osmo_mgcpc_ep_fsm_event_names[33] = {};
220
221static char osmo_mgcpc_ep_fsm_event_name_bufs[32][32] = {};
222
223static void fill_event_names()
224{
225 int i;
226 for (i = 0; i < (ARRAY_SIZE(osmo_mgcpc_ep_fsm_event_names) - 1); i++) {
227 if (i < _OSMO_MGCPC_EP_EV_LAST)
228 continue;
229 if (i < FIRST_CI_EVENT || EV_TO_CI_IDX(i) > USABLE_CI) {
230 osmo_mgcpc_ep_fsm_event_names[i] = (struct value_string){i, "Unused"};
231 continue;
232 }
233 snprintf(osmo_mgcpc_ep_fsm_event_name_bufs[i], sizeof(osmo_mgcpc_ep_fsm_event_name_bufs[i]),
234 "MGW Response for CI #%d", EV_TO_CI_IDX(i));
235 osmo_mgcpc_ep_fsm_event_names[i] = (struct value_string){i, osmo_mgcpc_ep_fsm_event_name_bufs[i]};
236 }
237}
238
239/* T_defs is used to obtain an (Osmocom specific) T2427001: timeout for an MGCP response (note, 2427 corresponds to the
240 * default MGCP port in osmo-mgw). */
241static __attribute__((constructor)) void osmo_mgcpc_ep_fsm_init()
242{
243 OSMO_ASSERT(osmo_fsm_register(&osmo_mgcpc_ep_fsm) == 0);
244 fill_event_names();
245}
246
247struct osmo_mgcpc_ep *osmo_mgcpc_ep_fi_mgwep(struct osmo_fsm_inst *fi)
248{
249 OSMO_ASSERT(fi);
250 OSMO_ASSERT(fi->fsm == &osmo_mgcpc_ep_fsm);
251 OSMO_ASSERT(fi->priv);
252 return fi->priv;
253}
254
255/*! Allocate an osmo_mgcpc_ep FSM.
256 * MGCP messages to set up the endpoint will be sent on the given mgcp_client, as soon as the first
257 * osmo_mgcpc_ep_ci_request() is invoked.
258 *
Neels Hofmeyrca2aec02019-10-04 22:47:31 +0200259 * IMPORTANT: To avoid use-after-free problems, using this FSM requires use of deferred FSM deallocation using
260 * osmo_fsm_set_dealloc_ctx(), e.g. using osmo_select_main_ctx(OTC_SELECT) with osmo_select_main_ctx() as main loop.
261 *
Neels Hofmeyr538d2c52019-01-28 03:51:35 +0100262 * A typical sequence of events would be:
263 *
264 * ep = osmo_mgcpc_ep_alloc(..., mgcp_client_rtpbridge_wildcard(client));
265 * ci_to_ran = osmo_mgcpc_ep_ci_add(ep);
266 * osmo_mgcpc_ep_ci_request(ci_to_ran, MGCP_VERB_CRCX, verb_info,
267 * my_call_fsm, MY_EVENT_MGCP_OK, MY_EVENT_MGCP_FAIL);
268 * ci_to_cn = osmo_mgcpc_ep_ci_add(ep);
269 * osmo_mgcpc_ep_ci_request(ci_to_cn, MGCP_VERB_CRCX, verb_info,
270 * my_call_fsm, MY_EVENT_MGCP_OK, MY_EVENT_MGCP_FAIL);
271 * ...
272 * osmo_mgcpc_ep_ci_request(ci_to_ran, MGCP_VERB_MDCX, ...);
273 * ...
274 * osmo_mgcpc_ep_clear(ep);
275 * ep = NULL;
276 *
277 * \param parent Parent FSM.
278 * \param parent_term_event Event to dispatch to the parent on termination of this FSM instance.
279 * \param mgcp_client Connection to the MGW.
280 * \param T_defs Timeout definitions to be used for FSM states, see osmo_mgcpc_ep_fsm_timeouts.
281 * \param fsm_id FSM instance ID.
282 * \param endpoint_str_fmt The endpoint string format to send to the MGW upon the first CRCX.
283 * See mgcp_client_rtpbridge_wildcard() for "rtpbridge" endpoints.
284 */
285struct osmo_mgcpc_ep *osmo_mgcpc_ep_alloc(struct osmo_fsm_inst *parent, uint32_t parent_term_event,
286 struct mgcp_client *mgcp_client,
287 const struct osmo_tdef *T_defs,
288 const char *fsm_id,
289 const char *endpoint_str_fmt, ...)
290{
291 va_list ap;
292 struct osmo_fsm_inst *fi;
293 struct osmo_mgcpc_ep *ep;
294 int rc;
295
296 if (!mgcp_client)
297 return NULL;
298
299 fi = osmo_fsm_inst_alloc_child(&osmo_mgcpc_ep_fsm, parent, parent_term_event);
300 OSMO_ASSERT(fi);
301
302 osmo_fsm_inst_update_id(fi, fsm_id);
303
304 ep = talloc_zero(fi, struct osmo_mgcpc_ep);
305 OSMO_ASSERT(ep);
306
307 *ep = (struct osmo_mgcpc_ep){
308 .mgcp_client = mgcp_client,
309 .fi = fi,
310 .T_defs = T_defs,
311 };
Neels Hofmeyrf2bf8dc2019-10-29 17:39:56 +0100312 INIT_LLIST_HEAD(&ep->background_notify);
Neels Hofmeyr538d2c52019-01-28 03:51:35 +0100313 fi->priv = ep;
314
315 va_start(ap, endpoint_str_fmt);
316 rc = vsnprintf(ep->endpoint, sizeof(ep->endpoint), endpoint_str_fmt ? : "", ap);
317 va_end(ap);
318
319 if (rc <= 0 || rc >= sizeof(ep->endpoint)) {
320 LOG_MGCPC_EP(ep, LOGL_ERROR, "Endpoint name too long or too short: %s\n",
321 ep->endpoint);
322 osmo_fsm_inst_term(ep->fi, OSMO_FSM_TERM_ERROR, 0);
323 return NULL;
324 }
325
326 return ep;
327}
328
329/*! Add a connection to an endpoint.
330 * Allocate a connection identifier slot in the osmo_mgcpc_ep instance, do not yet dispatch a CRCX.
331 * The CRCX is dispatched only upon the first osmo_mgcpc_ep_ci_request().
332 * \param ep Parent endpoint instance.
333 * \param label_fmt Label for logging.
334 */
335struct osmo_mgcpc_ep_ci *osmo_mgcpc_ep_ci_add(struct osmo_mgcpc_ep *ep,
336 const char *label_fmt, ...)
337{
338 va_list ap;
339 int i;
340 struct osmo_mgcpc_ep_ci *ci;
341
342 for (i = 0; i < USABLE_CI; i++) {
343 ci = &ep->ci[i];
344
345 if (ci->occupied || ci->mgcp_client_fi)
346 continue;
347
348 *ci = (struct osmo_mgcpc_ep_ci){
349 .ep = ep,
350 .occupied = true,
351 };
352 if (label_fmt) {
353 va_start(ap, label_fmt);
354 vsnprintf(ci->label, sizeof(ci->label), label_fmt, ap);
355 va_end(ap);
356 }
357 return ci;
358 }
359
360 LOG_MGCPC_EP(ep, LOGL_ERROR,
361 "Cannot allocate another endpoint, all "
362 OSMO_STRINGIFY_VAL(USABLE_CI) " are in use\n");
363
364 return NULL;
365}
366
367static bool osmo_mgcpc_ep_fsm_check_state_chg_after_response(struct osmo_fsm_inst *fi);
368
369static void on_failure(struct osmo_mgcpc_ep_ci *ci)
370{
Neels Hofmeyrcc0b97e2019-10-01 19:44:10 +0200371 struct osmo_mgcpc_ep *ep = ci->ep;
Neels Hofmeyr3ff71282019-10-29 17:41:20 +0100372 struct fsm_notify notify;
Neels Hofmeyrcc0b97e2019-10-01 19:44:10 +0200373 int i;
Neels Hofmeyr538d2c52019-01-28 03:51:35 +0100374
375 if (!ci->occupied)
376 return;
377
Neels Hofmeyr3ff71282019-10-29 17:41:20 +0100378 /* When dispatching an event for this CI, the user may decide to trigger the next request for this conn right
379 * away. So we must be ready with a cleared *ci. Store the notify separately and clear before dispatching. */
380 notify = ci->notify;
Neels Hofmeyrf2bf8dc2019-10-29 17:39:56 +0100381 /* Register the planned notification in ep->background_notify so we also catch any osmo_mgcpc_ep_cancel_notify()
382 * that might be triggered between clearing the ci and actually dispatching the event. */
383 llist_add(&notify.entry, &ep->background_notify);
Neels Hofmeyr3ff71282019-10-29 17:41:20 +0100384
Neels Hofmeyr538d2c52019-01-28 03:51:35 +0100385 *ci = (struct osmo_mgcpc_ep_ci){
386 .ep = ci->ep,
387 };
388
Neels Hofmeyrcc0b97e2019-10-01 19:44:10 +0200389 /* An MGCP failure typically means the endpoint becomes unusable, cancel all pending request (except DLCX).
390 * Particularly, if two CRCX were scheduled and the first fails, we must no longer dispatch the second CRCX. */
391 for (i = 0; i < ARRAY_SIZE(ep->ci); i++) {
392 struct osmo_mgcpc_ep_ci *other_ci = &ep->ci[i];
393 if (other_ci == ci)
394 continue;
395 if (!other_ci->occupied)
396 continue;
397 if (!other_ci->pending)
398 continue;
399 if (other_ci->sent)
400 continue;
401 if (other_ci->verb == MGCP_VERB_DLCX)
402 continue;
403 /* Just clear the pending request, don't fire more events than below. */
404 other_ci->pending = false;
405 }
406
Neels Hofmeyr538d2c52019-01-28 03:51:35 +0100407 /* If this check has terminated the FSM instance, don't fire any more events to prevent use-after-free problems.
408 * The endpoint FSM does dispatch a term event to its parent, and everything should be cleaned like that. */
Neels Hofmeyrf2bf8dc2019-10-29 17:39:56 +0100409 if (!osmo_mgcpc_ep_fsm_check_state_chg_after_response(ep->fi)) {
410 /* The ep has deallocated, no need to llist_del(&notify.entry) here. */
Neels Hofmeyr538d2c52019-01-28 03:51:35 +0100411 return;
Neels Hofmeyrf2bf8dc2019-10-29 17:39:56 +0100412 }
Neels Hofmeyr538d2c52019-01-28 03:51:35 +0100413
Neels Hofmeyr3ff71282019-10-29 17:41:20 +0100414 if (notify.fi)
415 osmo_fsm_inst_dispatch(notify.fi, notify.failure, notify.data);
Neels Hofmeyrf2bf8dc2019-10-29 17:39:56 +0100416
417 llist_del(&notify.entry);
Neels Hofmeyr538d2c52019-01-28 03:51:35 +0100418}
419
Neels Hofmeyrc5479fe2019-04-05 01:36:06 +0200420static int update_endpoint_name(struct osmo_mgcpc_ep_ci *ci, const char *new_endpoint_name)
421{
422 struct osmo_mgcpc_ep *ep = ci->ep;
423 int rc;
424 int i;
425
426 if (!strcmp(ep->endpoint, new_endpoint_name)) {
427 /* Same endpoint name, nothing to do. */
428 return 0;
429 }
430
431 /* The endpoint name should only change on the very first CRCX response. */
432 if (ep->first_crcx_complete) {
433 LOG_CI(ci, LOGL_ERROR, "Reponse returned mismatching endpoint name."
434 " This is endpoint %s, instead received %s\n",
435 ep->endpoint, new_endpoint_name);
436 on_failure(ci);
437 return -EINVAL;
438 }
439
440 /* This is the first CRCX response, update endpoint name. */
441 rc = OSMO_STRLCPY_ARRAY(ep->endpoint, new_endpoint_name);
442 if (rc <= 0 || rc >= sizeof(ep->endpoint)) {
443 LOG_CI(ci, LOGL_ERROR, "Unable to copy endpoint name %s\n", osmo_quote_str(new_endpoint_name, -1));
444 osmo_mgcpc_ep_ci_dlcx(ci);
445 on_failure(ci);
446 return -ENOSPC;
447 }
448
449 /* Make sure already pending requests use this updated endpoint name. */
450 for (i = 0; i < ARRAY_SIZE(ep->ci); i++) {
451 struct osmo_mgcpc_ep_ci *other_ci = &ep->ci[i];
452 if (!other_ci->occupied)
453 continue;
454 if (!other_ci->pending)
455 continue;
456 if (other_ci->sent)
457 continue;
458 OSMO_STRLCPY_ARRAY(other_ci->verb_info.endpoint, ep->endpoint);
459 }
460 return 0;
461}
462
Neels Hofmeyr538d2c52019-01-28 03:51:35 +0100463static void on_success(struct osmo_mgcpc_ep_ci *ci, void *data)
464{
465 struct mgcp_conn_peer *rtp_info;
466
467 if (!ci->occupied)
468 return;
469
470 ci->pending = false;
471
Pau Espin Pedrol2741d6b2020-09-02 19:31:17 +0200472 rtp_info = data;
473
Neels Hofmeyr538d2c52019-01-28 03:51:35 +0100474 switch (ci->verb) {
475 case MGCP_VERB_CRCX:
476 /* If we sent a wildcarded endpoint name on CRCX, we need to store the resulting endpoint
477 * name here. Also, we receive the MGW's RTP port information. */
Neels Hofmeyr538d2c52019-01-28 03:51:35 +0100478 osmo_strlcpy(ci->mgcp_ci_str, mgcp_conn_get_ci(ci->mgcp_client_fi),
479 sizeof(ci->mgcp_ci_str));
480 if (rtp_info->endpoint[0]) {
Neels Hofmeyrc5479fe2019-04-05 01:36:06 +0200481 /* On errors, this instance might already be deallocated. Make sure to not access anything after
482 * error. */
483 if (update_endpoint_name(ci, rtp_info->endpoint))
Neels Hofmeyr538d2c52019-01-28 03:51:35 +0100484 return;
Neels Hofmeyr538d2c52019-01-28 03:51:35 +0100485 }
Neels Hofmeyrc5479fe2019-04-05 01:36:06 +0200486 ci->ep->first_crcx_complete = true;
Pau Espin Pedrol2741d6b2020-09-02 19:31:17 +0200487 OSMO_ASSERT(rtp_info);
488 /* fall through */
489 case MGCP_VERB_MDCX:
490 /* Always update the received RTP ip/port information, since MGW
491 * may provide new one after remote end params changed */
492 if (rtp_info) {
493 ci->got_port_info = true;
494 ci->rtp_info = *rtp_info;
495 }
Neels Hofmeyr538d2c52019-01-28 03:51:35 +0100496 break;
497
498 default:
499 break;
500 }
501
502 LOG_CI(ci, LOGL_DEBUG, "received successful response to %s: RTP=%s%s\n",
503 osmo_mgcp_verb_name(ci->verb),
504 mgcp_conn_peer_name(ci->got_port_info? &ci->rtp_info : NULL),
Neels Hofmeyr3ff71282019-10-29 17:41:20 +0100505 ci->notify.fi ? "" : " (not sending a notification)");
Neels Hofmeyr538d2c52019-01-28 03:51:35 +0100506
Neels Hofmeyr3ff71282019-10-29 17:41:20 +0100507 if (ci->notify.fi)
508 osmo_fsm_inst_dispatch(ci->notify.fi, ci->notify.success, ci->notify.data);
Neels Hofmeyr538d2c52019-01-28 03:51:35 +0100509
510 osmo_mgcpc_ep_fsm_check_state_chg_after_response(ci->ep->fi);
511}
512
513/*! Return the MGW's RTP port information for this connection, as returned by the last CRCX/MDCX OK message. */
514const struct mgcp_conn_peer *osmo_mgcpc_ep_ci_get_rtp_info(const struct osmo_mgcpc_ep_ci *ci)
515{
516 ci = osmo_mgcpc_ep_check_ci((struct osmo_mgcpc_ep_ci*)ci);
517 if (!ci)
518 return NULL;
519 if (!ci->got_port_info)
520 return NULL;
521 return &ci->rtp_info;
522}
523
524/*! Return the MGW's RTP port information for this connection, as returned by the last CRCX/MDCX OK message. */
525bool osmo_mgcpc_ep_ci_get_crcx_info_to_sockaddr(const struct osmo_mgcpc_ep_ci *ci, struct sockaddr_storage *dest)
526{
527 const struct mgcp_conn_peer *rtp_info;
Pau Espin Pedrol729bf3e2020-08-28 19:28:07 +0200528 int family;
Neels Hofmeyr538d2c52019-01-28 03:51:35 +0100529 struct sockaddr_in *sin;
Pau Espin Pedrol729bf3e2020-08-28 19:28:07 +0200530 struct sockaddr_in6 *sin6;
Neels Hofmeyr538d2c52019-01-28 03:51:35 +0100531
532 rtp_info = osmo_mgcpc_ep_ci_get_rtp_info(ci);
533 if (!rtp_info)
534 return false;
535
Pau Espin Pedrol729bf3e2020-08-28 19:28:07 +0200536 family = osmo_ip_str_type(rtp_info->addr);
537 switch (family) {
538 case AF_INET:
539 sin = (struct sockaddr_in *)dest;
540 sin->sin_family = AF_INET;
541 sin->sin_port = osmo_ntohs(rtp_info->port);
542 if (inet_pton(AF_INET, rtp_info->addr, &sin->sin_addr) != 1)
543 return false;
544 break;
545 case AF_INET6:
546 sin6 = (struct sockaddr_in6 *)dest;
547 sin6->sin6_family = AF_INET6;
548 sin6->sin6_port = osmo_ntohs(rtp_info->port);
549 if (inet_pton(AF_INET6, rtp_info->addr, &sin6->sin6_addr) != 1)
550 return false;
551 break;
552 default:
553 return false;
554 }
Neels Hofmeyr538d2c52019-01-28 03:51:35 +0100555 return true;
556}
557
Pau Espin Pedrol30907dc2019-05-06 11:54:17 +0200558bool osmo_mgcpc_ep_ci_get_crcx_info_to_osmux_cid(const struct osmo_mgcpc_ep_ci *ci, uint8_t* cid)
559{
560 const struct mgcp_conn_peer *rtp_info;
561
562 rtp_info = osmo_mgcpc_ep_ci_get_rtp_info(ci);
563 if (!rtp_info)
564 return false;
565
566 if (!rtp_info->x_osmo_osmux_use)
567 return false;
568
569 *cid = rtp_info->x_osmo_osmux_cid;
570 return true;
571}
Neels Hofmeyr538d2c52019-01-28 03:51:35 +0100572
573static const struct osmo_tdef_state_timeout osmo_mgcpc_ep_fsm_timeouts[32] = {
574 [OSMO_MGCPC_EP_ST_WAIT_MGW_RESPONSE] = { .T=2427001 },
575};
576
577/* Transition to a state, using the T timer defined in assignment_fsm_timeouts.
578 * The actual timeout value is in turn obtained from osmo_mgcpc_ep.T_defs.
579 * Assumes local variable fi exists. */
580#define osmo_mgcpc_ep_fsm_state_chg(state) \
581 osmo_tdef_fsm_inst_state_chg(fi, state, osmo_mgcpc_ep_fsm_timeouts, \
582 ((struct osmo_mgcpc_ep*)fi->priv)->T_defs, 5)
583
584/*! Dispatch an actual CRCX/MDCX/DLCX message for this connection.
Neels Hofmeyrf2bf8dc2019-10-29 17:39:56 +0100585 *
586 * If the 'notify' instance deallocates before it received a notification of event_success or event_failure,
587 * osmo_mgcpc_ep_ci_cancel_notify() or osmo_mgcpc_ep_cancel_notify() must be called. It is not harmful to cancel
588 * notification after an event has been received.
589 *
Neels Hofmeyr538d2c52019-01-28 03:51:35 +0100590 * \param ci Connection identifier as obtained from osmo_mgcpc_ep_ci_add().
591 * \param verb MGCP operation to dispatch.
592 * \param verb_info Parameters for the MGCP operation.
593 * \param notify Peer FSM instance to notify of completed/failed operation.
594 * \param event_success Which event to dispatch to 'notify' upon OK response.
595 * \param event_failure Which event to dispatch to 'notify' upon failure response.
596 * \param notify_data Data pointer to pass to the event dispatch for both success and failure.
597 */
598void osmo_mgcpc_ep_ci_request(struct osmo_mgcpc_ep_ci *ci,
599 enum mgcp_verb verb, const struct mgcp_conn_peer *verb_info,
600 struct osmo_fsm_inst *notify,
601 uint32_t event_success, uint32_t event_failure,
602 void *notify_data)
603{
604 struct osmo_mgcpc_ep *ep;
605 struct osmo_fsm_inst *fi;
606 struct osmo_mgcpc_ep_ci cleared_ci;
607 ci = osmo_mgcpc_ep_check_ci(ci);
608
609 if (!ci) {
610 LOGP(DLGLOBAL, LOGL_ERROR, "Invalid MGW endpoint request: no ci\n");
611 goto dispatch_error;
612 }
613 if (!verb_info && verb != MGCP_VERB_DLCX) {
614 LOG_CI(ci, LOGL_ERROR, "Invalid MGW endpoint request: missing verb details for %s\n",
615 osmo_mgcp_verb_name(verb));
616 goto dispatch_error;
617 }
618 if ((verb < 0) || (verb > MGCP_VERB_RSIP)) {
619 LOG_CI(ci, LOGL_ERROR, "Invalid MGW endpoint request: unknown verb: %s\n",
620 osmo_mgcp_verb_name(verb));
621 goto dispatch_error;
622 }
623
624 ep = ci->ep;
625 fi = ep->fi;
626
627 /* Clear volatile state by explicitly keeping those that should remain. Because we can't assign
628 * the char[] directly, dance through cleared_ci and copy back. */
629 cleared_ci = (struct osmo_mgcpc_ep_ci){
630 .ep = ep,
631 .mgcp_client_fi = ci->mgcp_client_fi,
632 .got_port_info = ci->got_port_info,
633 .rtp_info = ci->rtp_info,
634
635 .occupied = true,
636 /* .pending = true follows below */
637 .verb = verb,
Neels Hofmeyr3ff71282019-10-29 17:41:20 +0100638 .notify = {
639 .fi = notify,
640 .success = event_success,
641 .failure = event_failure,
642 .data = notify_data,
643 }
Neels Hofmeyr538d2c52019-01-28 03:51:35 +0100644 };
645 osmo_strlcpy(cleared_ci.label, ci->label, sizeof(cleared_ci.label));
646 osmo_strlcpy(cleared_ci.mgcp_ci_str, ci->mgcp_ci_str, sizeof(cleared_ci.mgcp_ci_str));
647 *ci = cleared_ci;
648
Neels Hofmeyr3ff71282019-10-29 17:41:20 +0100649 LOG_CI_VERB(ci, LOGL_DEBUG, "notify=%s\n", osmo_fsm_inst_name(ci->notify.fi));
Neels Hofmeyr538d2c52019-01-28 03:51:35 +0100650
651 if (verb_info)
652 ci->verb_info = *verb_info;
653
654 if (ep->endpoint[0]) {
655 if (ci->verb_info.endpoint[0] && strcmp(ci->verb_info.endpoint, ep->endpoint))
656 LOG_CI(ci, LOGL_ERROR,
657 "Warning: Requested %s on endpoint %s, but this CI is on endpoint %s."
658 " Using the proper endpoint instead.\n",
659 osmo_mgcp_verb_name(verb), ci->verb_info.endpoint, ep->endpoint);
660 osmo_strlcpy(ci->verb_info.endpoint, ep->endpoint, sizeof(ci->verb_info.endpoint));
661 }
662
663 switch (ci->verb) {
664 case MGCP_VERB_CRCX:
665 if (ci->mgcp_client_fi) {
666 LOG_CI(ci, LOGL_ERROR, "CRCX can be called only once per MGW endpoint CI\n");
667 on_failure(ci);
668 return;
669 }
670 break;
671
672 case MGCP_VERB_MDCX:
673 if (!ci->mgcp_client_fi) {
674 LOG_CI_VERB(ci, LOGL_ERROR, "The first verb on an unused MGW endpoint CI must be CRCX, not %s\n",
675 osmo_mgcp_verb_name(ci->verb));
676 on_failure(ci);
677 return;
678 }
679 break;
680
681 case MGCP_VERB_DLCX:
682 if (!ci->mgcp_client_fi) {
683 LOG_CI_VERB(ci, LOGL_DEBUG, "Ignoring DLCX on unused MGW endpoint CI\n");
684 return;
685 }
686 break;
687
688 default:
689 LOG_CI(ci, LOGL_ERROR, "This verb is not supported: %s\n", osmo_mgcp_verb_name(ci->verb));
690 on_failure(ci);
691 return;
692 }
693
694 ci->pending = true;
695
696 LOG_CI_VERB(ci, LOGL_DEBUG, "Scheduling\n");
697
698 if (ep->fi->state != OSMO_MGCPC_EP_ST_WAIT_MGW_RESPONSE)
699 osmo_mgcpc_ep_fsm_state_chg(OSMO_MGCPC_EP_ST_WAIT_MGW_RESPONSE);
700
701 return;
702dispatch_error:
703 if (notify)
704 osmo_fsm_inst_dispatch(notify, event_failure, notify_data);
705}
706
Neels Hofmeyrf2bf8dc2019-10-29 17:39:56 +0100707/*! No longer notify for any state changes for any conns of this endpoint.
708 * Useful if the notify instance passed to osmo_mgcpc_ep_ci_request() is about to deallocate.
709 * \param ep The endpoint FSM instance.
710 * \param notify Which target to cancel notification for, if NULL cancel all notifications. */
711void osmo_mgcpc_ep_cancel_notify(struct osmo_mgcpc_ep *ep, struct osmo_fsm_inst *notify)
712{
713 struct fsm_notify *n;
714 int i;
715 for (i = 0; i < ARRAY_SIZE(ep->ci); i++) {
716 struct osmo_mgcpc_ep_ci *ci = &ep->ci[i];
717 if (!notify || ci->notify.fi == notify)
718 ci->notify.fi = NULL;
719 }
720 llist_for_each_entry(n, &ep->background_notify, entry) {
721 if (!notify || n->fi == notify)
722 n->fi = NULL;
723 }
724
725}
726
Neels Hofmeyr923d60b2019-10-29 17:40:08 +0100727/* Return the osmo_mgcpc_ep that this conn belongs to. */
728struct osmo_mgcpc_ep *osmo_mgcpc_ep_ci_ep(struct osmo_mgcpc_ep_ci *conn)
729{
730 if (!conn)
731 return NULL;
732 return conn->ep;
733}
734
Neels Hofmeyr538d2c52019-01-28 03:51:35 +0100735static int send_verb(struct osmo_mgcpc_ep_ci *ci)
736{
737 int rc;
738 struct osmo_mgcpc_ep *ep = ci->ep;
Neels Hofmeyr055ded72019-10-29 17:46:30 +0100739 struct fsm_notify notify;
Neels Hofmeyr538d2c52019-01-28 03:51:35 +0100740
741 if (!ci->occupied || !ci->pending || ci->sent)
742 return 0;
743
744 switch (ci->verb) {
745
746 case MGCP_VERB_CRCX:
747 OSMO_ASSERT(!ci->mgcp_client_fi);
748 LOG_CI_VERB(ci, LOGL_DEBUG, "Sending\n");
749 ci->mgcp_client_fi = mgcp_conn_create(ep->mgcp_client, ep->fi,
750 CI_EV_FAILURE(ci), CI_EV_SUCCESS(ci),
751 &ci->verb_info);
752 ci->sent = true;
753 if (!ci->mgcp_client_fi){
754 LOG_CI_VERB(ci, LOGL_ERROR, "Cannot send\n");
755 on_failure(ci);
Neels Hofmeyrc5479fe2019-04-05 01:36:06 +0200756 return -EINVAL;
Neels Hofmeyr538d2c52019-01-28 03:51:35 +0100757 }
758 osmo_fsm_inst_update_id(ci->mgcp_client_fi, ci->label);
759 break;
760
761 case MGCP_VERB_MDCX:
762 OSMO_ASSERT(ci->mgcp_client_fi);
763 LOG_CI_VERB(ci, LOGL_DEBUG, "Sending\n");
764 rc = mgcp_conn_modify(ci->mgcp_client_fi, CI_EV_SUCCESS(ci), &ci->verb_info);
765 ci->sent = true;
766 if (rc) {
767 LOG_CI_VERB(ci, LOGL_ERROR, "Cannot send (rc=%d %s)\n", rc, strerror(-rc));
768 on_failure(ci);
Neels Hofmeyrc5479fe2019-04-05 01:36:06 +0200769 return -EINVAL;
Neels Hofmeyr538d2c52019-01-28 03:51:35 +0100770 }
771 break;
772
773 case MGCP_VERB_DLCX:
774 LOG_CI(ci, LOGL_DEBUG, "Sending MGCP: %s %s\n",
775 osmo_mgcp_verb_name(ci->verb), ci->mgcp_ci_str);
776 /* The way this is designed, we actually need to forget all about the ci right away. */
777 mgcp_conn_delete(ci->mgcp_client_fi);
Neels Hofmeyr055ded72019-10-29 17:46:30 +0100778 notify = ci->notify;
Neels Hofmeyr538d2c52019-01-28 03:51:35 +0100779 *ci = (struct osmo_mgcpc_ep_ci){
780 .ep = ep,
781 };
Neels Hofmeyr055ded72019-10-29 17:46:30 +0100782 /* When dispatching an event for this CI, the user may decide to trigger the next request for this conn
783 * right away. So we must be ready with a cleared *ci. */
784 if (notify.fi)
785 osmo_fsm_inst_dispatch(notify.fi, notify.success, notify.data);
Neels Hofmeyr538d2c52019-01-28 03:51:35 +0100786 break;
787
788 default:
789 OSMO_ASSERT(false);
790 }
791
792 return 1;
793}
794
795/*! DLCX all connections, terminate the endpoint FSM and free. */
796void osmo_mgcpc_ep_clear(struct osmo_mgcpc_ep *ep)
797{
798 if (!ep)
799 return;
Neels Hofmeyrf2bf8dc2019-10-29 17:39:56 +0100800 osmo_mgcpc_ep_cancel_notify(ep, NULL);
Neels Hofmeyr538d2c52019-01-28 03:51:35 +0100801 osmo_fsm_inst_term(ep->fi, OSMO_FSM_TERM_REGULAR, 0);
802}
803
804static void osmo_mgcpc_ep_count(struct osmo_mgcpc_ep *ep, int *occupied, int *pending_not_sent,
805 int *waiting_for_response)
806{
807 int i;
808
809 if (occupied)
810 *occupied = 0;
811
812 if (pending_not_sent)
813 *pending_not_sent = 0;
814
815 if (waiting_for_response)
816 *waiting_for_response = 0;
817
818 for (i = 0; i < ARRAY_SIZE(ep->ci); i++) {
819 struct osmo_mgcpc_ep_ci *ci = &ep->ci[i];
820 if (ci->occupied) {
821 if (occupied)
822 (*occupied)++;
823 } else
824 continue;
825
826 if (ci->pending)
827 LOG_CI_VERB(ci, LOGL_DEBUG, "%s\n",
828 ci->sent ? "waiting for response" : "waiting to be sent");
829 else
830 LOG_CI_VERB(ci, LOGL_DEBUG, "done (%s)\n", mgcp_conn_peer_name(osmo_mgcpc_ep_ci_get_rtp_info(ci)));
831
832 if (ci->pending && ci->sent)
833 if (waiting_for_response)
834 (*waiting_for_response)++;
835 if (ci->pending && !ci->sent)
836 if (pending_not_sent)
837 (*pending_not_sent)++;
838 }
839}
840
841static bool osmo_mgcpc_ep_fsm_check_state_chg_after_response(struct osmo_fsm_inst *fi)
842{
843 int waiting_for_response;
844 int occupied;
845 struct osmo_mgcpc_ep *ep = osmo_mgcpc_ep_fi_mgwep(fi);
846
847 osmo_mgcpc_ep_count(ep, &occupied, NULL, &waiting_for_response);
848 LOG_MGCPC_EP(ep, LOGL_DEBUG, "CI in use: %d, waiting for response: %d\n", occupied, waiting_for_response);
849
850 if (!occupied) {
851 /* All CI have been released. The endpoint no longer exists. Notify the parent FSM, by
852 * terminating. */
853 osmo_fsm_inst_term(fi, OSMO_FSM_TERM_REGULAR, 0);
854 return false;
855 }
856
857 if (!waiting_for_response) {
858 if (fi->state != OSMO_MGCPC_EP_ST_IN_USE)
859 osmo_mgcpc_ep_fsm_state_chg(OSMO_MGCPC_EP_ST_IN_USE);
860 }
861
862 return true;
863}
864
865static void osmo_mgcpc_ep_fsm_wait_mgw_response_onenter(struct osmo_fsm_inst *fi, uint32_t prev_state)
866{
Neels Hofmeyrc5479fe2019-04-05 01:36:06 +0200867 static int re_enter = 0;
868 int rc;
Neels Hofmeyr538d2c52019-01-28 03:51:35 +0100869 int count = 0;
870 int i;
871 struct osmo_mgcpc_ep *ep = osmo_mgcpc_ep_fi_mgwep(fi);
872
Neels Hofmeyrc5479fe2019-04-05 01:36:06 +0200873 re_enter++;
874 OSMO_ASSERT(re_enter < 10);
875
876 /* The first CRCX gives us the endpoint name in the CRCX response. So we must wait for the first CRCX endpoint
877 * response to come in before sending any other MGCP requests -- otherwise we might end up creating new
878 * endpoints instead of acting on the same. This FSM always sends out N requests and waits for all of them to
879 * complete before sending out new requests. Hence we're safe when the very first time at most one request is
880 * sent (which needs to be a CRCX). */
881
Neels Hofmeyr538d2c52019-01-28 03:51:35 +0100882 for (i = 0; i < ARRAY_SIZE(ep->ci); i++) {
Neels Hofmeyrc5479fe2019-04-05 01:36:06 +0200883 struct osmo_mgcpc_ep_ci *ci = &ep->ci[i];
884
885 /* Make sure that only CRCX get dispatched if no CRCX were sent yet. */
886 if (!ep->first_crcx_complete) {
887 if (ci->occupied && ci->verb != MGCP_VERB_CRCX)
888 continue;
889 }
890
891 rc = send_verb(&ep->ci[i]);
892 /* Need to be careful not to access the instance after failure. Event chains may already have
893 * deallocated this memory. */
894 if (rc < 0)
895 return;
896 if (!rc)
897 continue;
898 count++;
899 /* Make sure that we wait for the first CRCX response before dispatching more requests. */
900 if (!ep->first_crcx_complete)
901 break;
Neels Hofmeyr538d2c52019-01-28 03:51:35 +0100902 }
903
904 LOG_MGCPC_EP(ep, LOGL_DEBUG, "Sent messages: %d\n", count);
Neels Hofmeyrc5479fe2019-04-05 01:36:06 +0200905 if (ep->first_crcx_complete)
906 osmo_mgcpc_ep_fsm_check_state_chg_after_response(fi);
907 re_enter--;
Neels Hofmeyr538d2c52019-01-28 03:51:35 +0100908}
909
910static void osmo_mgcpc_ep_fsm_handle_ci_events(struct osmo_fsm_inst *fi, uint32_t event, void *data)
911{
912 struct osmo_mgcpc_ep_ci *ci;
913 struct osmo_mgcpc_ep *ep = osmo_mgcpc_ep_fi_mgwep(fi);
914 ci = osmo_mgcpc_ep_ci_for_event(ep, event);
915 if (ci) {
916 if (event == CI_EV_SUCCESS(ci))
917 on_success(ci, data);
918 else
919 on_failure(ci);
920 }
921}
922
923static void osmo_mgcpc_ep_fsm_in_use_onenter(struct osmo_fsm_inst *fi, uint32_t prev_state)
924{
925 int pending_not_sent;
926 struct osmo_mgcpc_ep *ep = osmo_mgcpc_ep_fi_mgwep(fi);
927
928 osmo_mgcpc_ep_count(ep, NULL, &pending_not_sent, NULL);
929 if (pending_not_sent)
930 osmo_mgcpc_ep_fsm_state_chg(OSMO_MGCPC_EP_ST_WAIT_MGW_RESPONSE);
931}
932
933#define S(x) (1 << (x))
934
935static const struct osmo_fsm_state osmo_mgcpc_ep_fsm_states[] = {
936 [OSMO_MGCPC_EP_ST_UNUSED] = {
937 .name = "UNUSED",
938 .in_event_mask = 0,
939 .out_state_mask = 0
940 | S(OSMO_MGCPC_EP_ST_WAIT_MGW_RESPONSE)
941 ,
942 },
943 [OSMO_MGCPC_EP_ST_WAIT_MGW_RESPONSE] = {
944 .name = "WAIT_MGW_RESPONSE",
945 .onenter = osmo_mgcpc_ep_fsm_wait_mgw_response_onenter,
946 .action = osmo_mgcpc_ep_fsm_handle_ci_events,
947 .in_event_mask = 0xffffffff,
948 .out_state_mask = 0
949 | S(OSMO_MGCPC_EP_ST_IN_USE)
950 ,
951 },
952 [OSMO_MGCPC_EP_ST_IN_USE] = {
953 .name = "IN_USE",
954 .onenter = osmo_mgcpc_ep_fsm_in_use_onenter,
955 .action = osmo_mgcpc_ep_fsm_handle_ci_events,
956 .in_event_mask = 0xffffffff, /* mgcp_client_fsm may send parent term anytime */
957 .out_state_mask = 0
958 | S(OSMO_MGCPC_EP_ST_WAIT_MGW_RESPONSE)
959 ,
960 },
961};
962
963static int osmo_mgcpc_ep_fsm_timer_cb(struct osmo_fsm_inst *fi)
964{
965 int i;
966 struct osmo_mgcpc_ep *ep = osmo_mgcpc_ep_fi_mgwep(fi);
967
968 switch (fi->T) {
969 default:
970 for (i = 0; i < ARRAY_SIZE(ep->ci); i++) {
971 struct osmo_mgcpc_ep_ci *ci = &ep->ci[i];
972 if (!ci->occupied)
973 continue;
974 if (!(ci->pending && ci->sent))
975 continue;
976 on_failure(ci);
977 }
978 return 0;
979 }
980
981 return 0;
982}
983
984static struct osmo_fsm osmo_mgcpc_ep_fsm = {
Pau Espin Pedrol182ca3b2019-05-08 14:01:20 +0200985 .name = "mgw-endp",
Neels Hofmeyr538d2c52019-01-28 03:51:35 +0100986 .states = osmo_mgcpc_ep_fsm_states,
987 .num_states = ARRAY_SIZE(osmo_mgcpc_ep_fsm_states),
988 .log_subsys = DLMGCP,
989 .event_names = osmo_mgcpc_ep_fsm_event_names,
990 .timer_cb = osmo_mgcpc_ep_fsm_timer_cb,
991 /* The FSM termination will automatically trigger any mgcp_client_fsm instances to DLCX. */
992};