blob: 0dd45d4ab818b54eee196969212cf3741a3c7837 [file] [log] [blame]
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +02001/* NS-over-IP proxy */
2
Harald Weltee5209642020-12-05 19:59:45 +01003/* (C) 2010-2020 by Harald Welte <laforge@gnumonks.org>
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +02004 * (C) 2010-2013 by On-Waves
5 * (C) 2013 by Holger Hans Peter Freyther
6 * All Rights Reserved
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 <unistd.h>
24#include <stdio.h>
25#include <stdlib.h>
26#include <string.h>
27#include <getopt.h>
28#include <errno.h>
29#include <sys/fcntl.h>
30#include <sys/stat.h>
31#include <arpa/inet.h>
32#include <time.h>
33
Harald Welted2fef952020-12-05 00:31:07 +010034#include <osmocom/core/hashtable.h>
Daniel Willmann8f407b12020-12-02 19:33:50 +010035#include <osmocom/core/logging.h>
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +020036#include <osmocom/core/talloc.h>
37#include <osmocom/core/select.h>
38#include <osmocom/core/rate_ctr.h>
39#include <osmocom/core/stats.h>
40
Alexander Couzens951e1332020-09-22 13:21:46 +020041#include <osmocom/gprs/gprs_ns2.h>
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +020042#include <osmocom/gprs/gprs_bssgp.h>
Alexander Couzens951e1332020-09-22 13:21:46 +020043#include <osmocom/gprs/gprs_bssgp_bss.h>
Harald Weltee5209642020-12-05 19:59:45 +010044#include <osmocom/gprs/bssgp_bvc_fsm.h>
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +020045
46#include <osmocom/gsm/gsm_utils.h>
47
48#include <osmocom/sgsn/signal.h>
49#include <osmocom/sgsn/debug.h>
50#include <osmocom/sgsn/gprs_gb_parse.h>
51#include <osmocom/sgsn/gb_proxy.h>
52
53#include <osmocom/sgsn/gprs_llc.h>
54#include <osmocom/gsm/protocol/gsm_04_08_gprs.h>
55#include <osmocom/sgsn/gprs_utils.h>
56
57extern void *tall_sgsn_ctx;
58
59static const struct rate_ctr_desc global_ctr_description[] = {
60 { "inv-bvci", "Invalid BVC Identifier " },
61 { "inv-lai", "Invalid Location Area Identifier" },
62 { "inv-rai", "Invalid Routing Area Identifier " },
63 { "inv-nsei", "No BVC established for NSEI " },
64 { "proto-err:bss", "BSSGP protocol error (BSS )" },
65 { "proto-err:sgsn", "BSSGP protocol error (SGSN)" },
66 { "not-supp:bss", "Feature not supported (BSS )" },
67 { "not-supp:sgsn", "Feature not supported (SGSN)" },
68 { "restart:sgsn", "Restarted RESET procedure (SGSN)" },
69 { "tx-err:sgsn", "NS Transmission error (SGSN)" },
70 { "error", "Other error " },
71 { "mod-peer-err", "Patch error: no peer " },
72};
73
74static const struct rate_ctr_group_desc global_ctrg_desc = {
75 .group_name_prefix = "gbproxy:global",
76 .group_description = "GBProxy Global Statistics",
77 .num_ctr = ARRAY_SIZE(global_ctr_description),
78 .ctr_desc = global_ctr_description,
79 .class_id = OSMO_STATS_CLASS_GLOBAL,
80};
81
Harald Welte560bdb32020-12-04 22:24:47 +010082static int gbprox_relay2peer(struct msgb *old_msg, struct gbproxy_bvc *bvc,
Daniel Willmann35f7d332020-11-03 21:11:45 +010083 uint16_t ns_bvci);
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +020084
Harald Weltea0f70732020-12-05 17:50:23 +010085
Harald Welteec0f8012020-12-06 16:32:01 +010086/* generate BVC-STATUS message with cause value derived from TLV-parser error */
87static int tx_status_from_tlvp(enum osmo_tlv_parser_error tlv_p_err, struct msgb *orig_msg)
88{
89 uint8_t bssgp_cause;
90 switch (tlv_p_err) {
91 case OSMO_TLVP_ERR_MAND_IE_MISSING:
92 bssgp_cause = BSSGP_CAUSE_MISSING_MAND_IE;
93 break;
94 default:
95 bssgp_cause = BSSGP_CAUSE_PROTO_ERR_UNSPEC;
96 }
97 return bssgp_tx_status(bssgp_cause, NULL, orig_msg);
98}
99
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200100/* strip off the NS header */
101static void strip_ns_hdr(struct msgb *msg)
102{
103 int strip_len = msgb_bssgph(msg) - msg->data;
104 msgb_pull(msg, strip_len);
105}
106
Harald Weltee5209642020-12-05 19:59:45 +0100107#if 0
Harald Welte560bdb32020-12-04 22:24:47 +0100108/* feed a message down the NS-VC associated with the specified bvc */
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200109static int gbprox_relay2sgsn(struct gbproxy_config *cfg, struct msgb *old_msg,
110 uint16_t ns_bvci, uint16_t sgsn_nsei)
111{
112 /* create a copy of the message so the old one can
113 * be free()d safely when we return from gbprox_rcvmsg() */
Alexander Couzens951e1332020-09-22 13:21:46 +0200114 struct gprs_ns2_inst *nsi = cfg->nsi;
115 struct osmo_gprs_ns2_prim nsp = {};
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200116 struct msgb *msg = bssgp_msgb_copy(old_msg, "msgb_relay2sgsn");
117 int rc;
118
Daniel Willmann3696dce2020-12-02 16:08:02 +0100119 DEBUGP(DGPRS, "NSE(%05u/BSS)-BVC(%05u) proxying BTS->SGSN NSE(%05u/SGSN)\n",
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200120 msgb_nsei(msg), ns_bvci, sgsn_nsei);
121
Alexander Couzens951e1332020-09-22 13:21:46 +0200122 nsp.bvci = ns_bvci;
123 nsp.nsei = sgsn_nsei;
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200124
125 strip_ns_hdr(msg);
Alexander Couzens951e1332020-09-22 13:21:46 +0200126 osmo_prim_init(&nsp.oph, SAP_NS, PRIM_NS_UNIT_DATA,
127 PRIM_OP_REQUEST, msg);
128 rc = gprs_ns2_recv_prim(nsi, &nsp.oph);
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200129 if (rc < 0)
130 rate_ctr_inc(&cfg->ctrg->ctr[GBPROX_GLOB_CTR_TX_ERR_SGSN]);
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200131 return rc;
132}
Harald Weltee5209642020-12-05 19:59:45 +0100133#endif
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200134
Daniel Willmann76205712020-11-30 17:08:58 +0100135/* feed a message down the NSE */
136static int gbprox_relay2nse(struct msgb *old_msg, struct gbproxy_nse *nse,
Daniel Willmann35f7d332020-11-03 21:11:45 +0100137 uint16_t ns_bvci)
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200138{
Daniel Willmanne50550e2020-11-26 18:19:21 +0100139 OSMO_ASSERT(nse);
140 OSMO_ASSERT(nse->cfg);
141
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200142 /* create a copy of the message so the old one can
143 * be free()d safely when we return from gbprox_rcvmsg() */
Daniel Willmanne50550e2020-11-26 18:19:21 +0100144 struct gprs_ns2_inst *nsi = nse->cfg->nsi;
Alexander Couzens951e1332020-09-22 13:21:46 +0200145 struct osmo_gprs_ns2_prim nsp = {};
Daniel Willmann76205712020-11-30 17:08:58 +0100146 struct msgb *msg = bssgp_msgb_copy(old_msg, "msgb_relay2nse");
Harald Weltefe059582020-11-18 12:01:46 +0100147 uint32_t tlli;
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200148 int rc;
149
Daniel Willmann3696dce2020-12-02 16:08:02 +0100150 DEBUGP(DGPRS, "NSE(%05u/SGSN)-BVC(%05u) proxying SGSN->BSS NSE(%05u/BSS)\n",
Daniel Willmanne50550e2020-11-26 18:19:21 +0100151 msgb_nsei(msg), ns_bvci, nse->nsei);
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200152
Alexander Couzens951e1332020-09-22 13:21:46 +0200153 nsp.bvci = ns_bvci;
Daniel Willmanne50550e2020-11-26 18:19:21 +0100154 nsp.nsei = nse->nsei;
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200155
156 /* Strip the old NS header, it will be replaced with a new one */
157 strip_ns_hdr(msg);
158
Harald Weltefe059582020-11-18 12:01:46 +0100159 /* TS 48.018 Section 5.4.2: The link selector parameter is
160 * defined in 3GPP TS 48.016. At one side of the Gb interface,
161 * all BSSGP UNITDATA PDUs related to an MS shall be passed with
162 * the same LSP, e.g. the LSP contains the MS's TLLI, to the
163 * underlying network service. */
164 if (gprs_gb_parse_tlli(msgb_data(msg), msgb_length(msg), &tlli) == 1)
165 nsp.u.unitdata.link_selector = tlli;
166
Alexander Couzens951e1332020-09-22 13:21:46 +0200167 osmo_prim_init(&nsp.oph, SAP_NS, PRIM_NS_UNIT_DATA,
168 PRIM_OP_REQUEST, msg);
169 rc = gprs_ns2_recv_prim(nsi, &nsp.oph);
Daniel Willmann76205712020-11-30 17:08:58 +0100170 /* FIXME: We need a counter group for gbproxy_nse */
171 //if (rc < 0)
Harald Welte560bdb32020-12-04 22:24:47 +0100172 // rate_ctr_inc(&bvc->ctrg->ctr[GBPROX_PEER_CTR_TX_ERR]);
Daniel Willmann76205712020-11-30 17:08:58 +0100173
174 return rc;
175}
176
Harald Welte560bdb32020-12-04 22:24:47 +0100177/* feed a message down the NS-VC associated with the specified bvc */
178static int gbprox_relay2peer(struct msgb *old_msg, struct gbproxy_bvc *bvc,
Daniel Willmann76205712020-11-30 17:08:58 +0100179 uint16_t ns_bvci)
180{
181 int rc;
Harald Welte560bdb32020-12-04 22:24:47 +0100182 struct gbproxy_nse *nse = bvc->nse;
Daniel Willmann76205712020-11-30 17:08:58 +0100183 OSMO_ASSERT(nse);
184
185 rc = gbprox_relay2nse(old_msg, nse, ns_bvci);
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200186 if (rc < 0)
Harald Welte560bdb32020-12-04 22:24:47 +0100187 rate_ctr_inc(&bvc->ctrg->ctr[GBPROX_PEER_CTR_TX_ERR]);
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200188
189 return rc;
190}
191
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200192int bssgp_prim_cb(struct osmo_prim_hdr *oph, void *ctx)
193{
194 return 0;
195}
196
Harald Weltee5209642020-12-05 19:59:45 +0100197
198/***********************************************************************
199 * PTP BVC handling
200 ***********************************************************************/
201
202/* route an uplink message on a PTP-BVC to a SGSN using the TLLI */
203static int gbprox_bss2sgsn_tlli(struct gbproxy_cell *cell, struct msgb *msg, uint32_t tlli,
204 bool sig_bvci)
205{
206 struct gbproxy_bvc *sgsn_bvc;
207 unsigned int i;
208
209 /* FIXME: derive NRI from TLLI */
210 /* FIXME: find the SGSN for that NRI */
211
212 /* HACK: we currently simply pick the first SGSN we find */
213 for (i = 0; i < ARRAY_SIZE(cell->sgsn_bvc); i++) {
214 sgsn_bvc = cell->sgsn_bvc[i];
215 if (sgsn_bvc)
216 return gbprox_relay2peer(msg, sgsn_bvc, sig_bvci ? 0 : sgsn_bvc->bvci);
217 }
218 return 0;
219}
220
221static int gbprox_bss2sgsn_null_nri(struct gbproxy_cell *cell, struct msgb *msg)
222{
223 struct gbproxy_bvc *sgsn_bvc;
224 unsigned int i;
225
226 /* FIXME: find the SGSN for that NRI */
227
228 /* HACK: we currently simply pick the first SGSN we find */
229 for (i = 0; i < ARRAY_SIZE(cell->sgsn_bvc); i++) {
230 sgsn_bvc = cell->sgsn_bvc[i];
231 if (sgsn_bvc)
232 return gbprox_relay2peer(msg, sgsn_bvc, sgsn_bvc->bvci);
233 }
234 return 0;
235}
236
237
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200238/* Receive an incoming PTP message from a BSS-side NS-VC */
Harald Weltee5209642020-12-05 19:59:45 +0100239static int gbprox_rx_ptp_from_bss(struct gbproxy_nse *nse, struct msgb *msg, uint16_t ns_bvci)
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200240{
Harald Welte278dd272020-12-06 13:35:24 +0100241 struct bssgp_normal_hdr *bgph = (struct bssgp_normal_hdr *) msgb_bssgph(msg);
Harald Weltee5209642020-12-05 19:59:45 +0100242 const char *pdut_name = osmo_tlv_prot_msg_name(&osmo_pdef_bssgp, bgph->pdu_type);
243 struct gbproxy_bvc *bss_bvc;
244 struct tlv_parsed tp;
245 char log_pfx[32];
246 uint32_t tlli;
247 int rc;
248
249 snprintf(log_pfx, sizeof(log_pfx), "NSE(%05u/BSS)-BVC(%05u/??)", nse->nsei, ns_bvci);
250
251 LOGP(DGPRS, LOGL_DEBUG, "%s Rx %s\n", log_pfx, pdut_name);
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200252
Daniel Willmann06331ac2020-12-10 17:59:46 +0100253 if (ns_bvci == 0 || ns_bvci == 1) {
Harald Weltee5209642020-12-05 19:59:45 +0100254 LOGP(DGPRS, LOGL_NOTICE, "%s BVCI=%05u is not PTP\n", log_pfx, ns_bvci);
Harald Welte278dd272020-12-06 13:35:24 +0100255 return bssgp_tx_status(BSSGP_CAUSE_PROTO_ERR_UNSPEC, NULL, msg);
256 }
257
258 if (!(bssgp_pdu_type_flags(bgph->pdu_type) & BSSGP_PDUF_PTP)) {
Harald Weltee5209642020-12-05 19:59:45 +0100259 LOGP(DGPRS, LOGL_NOTICE, "%s %s not allowed in PTP BVC\n", log_pfx, pdut_name);
Harald Welte278dd272020-12-06 13:35:24 +0100260 return bssgp_tx_status(BSSGP_CAUSE_PROTO_ERR_UNSPEC, NULL, msg);
261 }
262
263 if (!(bssgp_pdu_type_flags(bgph->pdu_type) & BSSGP_PDUF_UL)) {
Harald Weltee5209642020-12-05 19:59:45 +0100264 LOGP(DGPRS, LOGL_NOTICE, "%s %s not allowed in uplink direction\n", log_pfx, pdut_name);
Harald Welte278dd272020-12-06 13:35:24 +0100265 return bssgp_tx_status(BSSGP_CAUSE_PROTO_ERR_UNSPEC, NULL, msg);
266 }
267
Harald Weltee5209642020-12-05 19:59:45 +0100268 bss_bvc = gbproxy_bvc_by_bvci(nse, ns_bvci);
269 if (!bss_bvc) {
270 LOGP(DGPRS, LOGL_NOTICE, "%s %s - Didn't find BVC for PTP message, discarding\n",
271 log_pfx, pdut_name);
272 return bssgp_tx_status(BSSGP_CAUSE_UNKNOWN_BVCI, &ns_bvci, msg);
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200273 }
274
Harald Weltee5209642020-12-05 19:59:45 +0100275 /* UL_UNITDATA has a different header than all other uplink PDUs */
276 if (bgph->pdu_type == BSSGP_PDUT_UL_UNITDATA) {
277 const struct bssgp_ud_hdr *budh = (struct bssgp_ud_hdr *) msgb_bssgph(msg);
278 if (msgb_bssgp_len(msg) < sizeof(*budh))
279 return bssgp_tx_status(BSSGP_CAUSE_INV_MAND_INF, NULL, msg);
280 rc = osmo_tlv_prot_parse(&osmo_pdef_bssgp, &tp, 1, bgph->pdu_type, budh->data,
281 msgb_bssgp_len(msg) - sizeof(*budh), 0, 0, DGPRS, log_pfx);
282 /* populate TLLI from the fixed headser into the TLV-parsed array so later code
283 * doesn't have to worry where the TLLI came from */
284 tp.lv[BSSGP_IE_TLLI].len = 4;
285 tp.lv[BSSGP_IE_TLLI].val = (const uint8_t *) &budh->tlli;
286 } else {
287 rc = osmo_tlv_prot_parse(&osmo_pdef_bssgp, &tp, 1, bgph->pdu_type, bgph->data,
288 msgb_bssgp_len(msg) - sizeof(*bgph), 0, 0, DGPRS, log_pfx);
289 }
290 if (rc < 0) {
291 rate_ctr_inc(&nse->cfg->ctrg->ctr[GBPROX_GLOB_CTR_PROTO_ERR_BSS]);
292 return tx_status_from_tlvp(rc, msg);
293 }
Harald Welte85a40272020-12-08 21:43:22 +0100294 /* hack to get both msg + tlv_parsed passed via osmo_fsm_inst_dispatch */
295 msgb_bcid(msg) = (void *)&tp;
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200296
Harald Weltee5209642020-12-05 19:59:45 +0100297 switch (bgph->pdu_type) {
298 case BSSGP_PDUT_UL_UNITDATA:
299 case BSSGP_PDUT_RA_CAPA_UPDATE:
300 case BSSGP_PDUT_FLOW_CONTROL_MS:
301 case BSSGP_PDUT_DOWNLOAD_BSS_PFC:
302 case BSSGP_PDUT_CREATE_BSS_PFC_ACK:
303 case BSSGP_PDUT_CREATE_BSS_PFC_NACK:
304 case BSSGP_PDUT_MODIFY_BSS_PFC_ACK:
305 case BSSGP_PDUT_DELETE_BSS_PFC_ACK:
306 case BSSGP_PDUT_FLOW_CONTROL_PFC:
307 case BSSGP_PDUT_DELETE_BSS_PFC_REQ:
308 case BSSGP_PDUT_PS_HO_REQUIRED:
309 case BSSGP_PDUT_PS_HO_REQUEST_ACK:
310 case BSSGP_PDUT_PS_HO_REQUEST_NACK:
311 case BSSGP_PDUT_PS_HO_COMPLETE:
312 case BSSGP_PDUT_PS_HO_CANCEL:
313 /* We can route based on TLLI-NRI */
314 tlli = osmo_load32be(TLVP_VAL(&tp, BSSGP_IE_TLLI));
315 rc = gbprox_bss2sgsn_tlli(bss_bvc->cell, msg, tlli, false);
316 break;
317 case BSSGP_PDUT_RADIO_STATUS:
318 if (TLVP_PRESENT(&tp, BSSGP_IE_TLLI)) {
319 tlli = osmo_load32be(TLVP_VAL(&tp, BSSGP_IE_TLLI));
320 rc = gbprox_bss2sgsn_tlli(bss_bvc->cell, msg, tlli, false);
321 } else if (TLVP_PRESENT(&tp, BSSGP_IE_TMSI)) {
322 /* we treat the TMSI like a TLLI and extract the NRI from it */
323 tlli = osmo_load32be(TLVP_VAL(&tp, BSSGP_IE_TMSI));
324 rc = gbprox_bss2sgsn_tlli(bss_bvc->cell, msg, tlli, false);
325 } else if (TLVP_PRESENT(&tp, BSSGP_IE_IMSI)) {
326 rc = gbprox_bss2sgsn_null_nri(bss_bvc->cell, msg);
327 } else
328 LOGPBVC(bss_bvc, LOGL_ERROR, "Rx RADIO-STATUS without any of the conditional IEs\n");
329 break;
330 case BSSGP_PDUT_DUMMY_PAGING_PS_RESP:
331 case BSSGP_PDUT_PAGING_PS_REJECT:
332 /* TODO: Implement via state tracking of PAGING-PS + DUMMY_PAGING_PS */
333 LOGPBVC(bss_bvc, LOGL_ERROR, "Rx %s: Implementation missing\n", pdut_name);
334 break;
335 case BSSGP_PDUT_FLOW_CONTROL_BVC:
Harald Welte85a40272020-12-08 21:43:22 +0100336 osmo_fsm_inst_dispatch(bss_bvc->fi, BSSGP_BVCFSM_E_RX_FC_BVC, msg);
Harald Weltee5209642020-12-05 19:59:45 +0100337 break;
338 case BSSGP_PDUT_STATUS:
339 /* TODO: Implement by inspecting the contained PDU */
340 if (!TLVP_PRESENT(&tp, BSSGP_IE_PDU_IN_ERROR))
341 break;
342 LOGPBVC(bss_bvc, LOGL_ERROR, "Rx %s: Implementation missing\n", pdut_name);
343 break;
344 }
345
346 return 0;
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200347}
348
349/* Receive an incoming PTP message from a SGSN-side NS-VC */
Harald Weltee5209642020-12-05 19:59:45 +0100350static int gbprox_rx_ptp_from_sgsn(struct gbproxy_nse *nse, struct msgb *msg, uint16_t ns_bvci)
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200351{
Harald Welte278dd272020-12-06 13:35:24 +0100352 struct bssgp_normal_hdr *bgph = (struct bssgp_normal_hdr *) msgb_bssgph(msg);
Harald Weltee5209642020-12-05 19:59:45 +0100353 const char *pdut_name = osmo_tlv_prot_msg_name(&osmo_pdef_bssgp, bgph->pdu_type);
354 struct gbproxy_bvc *sgsn_bvc, *bss_bvc;
Harald Welte85a40272020-12-08 21:43:22 +0100355 struct tlv_parsed tp;
Harald Weltee5209642020-12-05 19:59:45 +0100356 char log_pfx[32];
Harald Welte85a40272020-12-08 21:43:22 +0100357 int rc;
Harald Weltee5209642020-12-05 19:59:45 +0100358
359 snprintf(log_pfx, sizeof(log_pfx), "NSE(%05u/SGSN)-BVC(%05u/??)", nse->nsei, ns_bvci);
360
361 LOGP(DGPRS, LOGL_DEBUG, "%s Rx %s\n", log_pfx, pdut_name);
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200362
Daniel Willmann06331ac2020-12-10 17:59:46 +0100363 if (ns_bvci == 0 || ns_bvci == 1) {
Harald Weltee5209642020-12-05 19:59:45 +0100364 LOGP(DGPRS, LOGL_NOTICE, "%s BVCI is not PTP\n", log_pfx);
Harald Welte278dd272020-12-06 13:35:24 +0100365 return bssgp_tx_status(BSSGP_CAUSE_PROTO_ERR_UNSPEC, NULL, msg);
366 }
367
368 if (!(bssgp_pdu_type_flags(bgph->pdu_type) & BSSGP_PDUF_PTP)) {
Harald Weltee5209642020-12-05 19:59:45 +0100369 LOGP(DGPRS, LOGL_NOTICE, "%s %s not allowed in PTP BVC\n", log_pfx, pdut_name);
Harald Welte278dd272020-12-06 13:35:24 +0100370 return bssgp_tx_status(BSSGP_CAUSE_PROTO_ERR_UNSPEC, NULL, msg);
371 }
372
373 if (!(bssgp_pdu_type_flags(bgph->pdu_type) & BSSGP_PDUF_DL)) {
Harald Weltee5209642020-12-05 19:59:45 +0100374 LOGP(DGPRS, LOGL_NOTICE, "%s %s not allowed in downlink direction\n", log_pfx, pdut_name);
Harald Welte278dd272020-12-06 13:35:24 +0100375 return bssgp_tx_status(BSSGP_CAUSE_PROTO_ERR_UNSPEC, NULL, msg);
376 }
377
Harald Weltee5209642020-12-05 19:59:45 +0100378 sgsn_bvc = gbproxy_bvc_by_bvci(nse, ns_bvci);
379 if (!sgsn_bvc) {
380 LOGP(DGPRS, LOGL_NOTICE, "%s %s - Didn't find BVC for for PTP message, discarding\n",
381 log_pfx, pdut_name);
382 rate_ctr_inc(&nse->cfg->ctrg-> ctr[GBPROX_GLOB_CTR_INV_BVCI]);
383 return bssgp_tx_status(BSSGP_CAUSE_UNKNOWN_BVCI, &ns_bvci, msg);
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200384 }
385
Harald Weltee5209642020-12-05 19:59:45 +0100386 if (!bssgp_bvc_fsm_is_unblocked(sgsn_bvc->fi)) {
387 LOGPBVC(sgsn_bvc, LOGL_NOTICE, "Rx %s: Dropping on blocked BVC\n", pdut_name);
388 rate_ctr_inc(&sgsn_bvc->ctrg->ctr[GBPROX_PEER_CTR_DROPPED]);
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200389 return bssgp_tx_status(BSSGP_CAUSE_BVCI_BLOCKED, &ns_bvci, msg);
390 }
Harald Welte85a40272020-12-08 21:43:22 +0100391
392 /* DL_UNITDATA has a different header than all other uplink PDUs */
393 if (bgph->pdu_type == BSSGP_PDUT_DL_UNITDATA) {
394 const struct bssgp_ud_hdr *budh = (struct bssgp_ud_hdr *) msgb_bssgph(msg);
395 if (msgb_bssgp_len(msg) < sizeof(*budh))
396 return bssgp_tx_status(BSSGP_CAUSE_INV_MAND_INF, NULL, msg);
397 rc = osmo_tlv_prot_parse(&osmo_pdef_bssgp, &tp, 1, bgph->pdu_type, budh->data,
398 msgb_bssgp_len(msg) - sizeof(*budh), 0, 0, DGPRS, log_pfx);
399 /* populate TLLI from the fixed headser into the TLV-parsed array so later code
400 * doesn't have to worry where the TLLI came from */
401 tp.lv[BSSGP_IE_TLLI].len = 4;
402 tp.lv[BSSGP_IE_TLLI].val = (const uint8_t *) &budh->tlli;
403 } else {
404 rc = osmo_tlv_prot_parse(&osmo_pdef_bssgp, &tp, 1, bgph->pdu_type, bgph->data,
405 msgb_bssgp_len(msg) - sizeof(*bgph), 0, 0, DGPRS, log_pfx);
406 }
407 if (rc < 0) {
408 rate_ctr_inc(&nse->cfg->ctrg->ctr[GBPROX_GLOB_CTR_PROTO_ERR_BSS]);
409 return tx_status_from_tlvp(rc, msg);
410 }
411 /* hack to get both msg + tlv_parsed passed via osmo_fsm_inst_dispatch */
412 msgb_bcid(msg) = (void *)&tp;
413
Harald Weltee5209642020-12-05 19:59:45 +0100414 OSMO_ASSERT(sgsn_bvc->cell);
415 bss_bvc = sgsn_bvc->cell->bss_bvc;
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200416
Harald Welte85a40272020-12-08 21:43:22 +0100417 switch (bgph->pdu_type) {
418 case BSSGP_PDUT_FLOW_CONTROL_BVC_ACK:
419 return osmo_fsm_inst_dispatch(sgsn_bvc->fi, BSSGP_BVCFSM_E_RX_FC_BVC_ACK, msg);
420 default:
421 return gbprox_relay2peer(msg, bss_bvc, bss_bvc->bvci);
422 }
423
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200424}
425
Harald Weltee5209642020-12-05 19:59:45 +0100426/***********************************************************************
427 * BVC FSM call-backs
428 ***********************************************************************/
Harald Welte7df1e5a2020-12-02 22:53:26 +0100429
Harald Weltee5209642020-12-05 19:59:45 +0100430/* helper function to dispatch a FSM event to all SGSN-side BVC FSMs of a cell */
431static void dispatch_to_all_sgsn_bvc(struct gbproxy_cell *cell, uint32_t event, void *priv)
432{
433 unsigned int i;
434
435 for (i = 0; i < ARRAY_SIZE(cell->sgsn_bvc); i++) {
436 struct gbproxy_bvc *sgsn_bvc = cell->sgsn_bvc[i];
437 if (!sgsn_bvc)
438 continue;
439 osmo_fsm_inst_dispatch(sgsn_bvc->fi, event, priv);
440 }
441}
442
443/* BVC FSM informs us about a BSS-side reset of the signaling BVC */
444static void bss_sig_bvc_reset_notif(uint16_t nsei, uint16_t bvci, const struct gprs_ra_id *ra_id,
445 uint16_t cell_id, uint8_t cause, void *priv)
446{
447 struct gbproxy_bvc *sig_bvc = priv;
448 struct gbproxy_nse *nse = sig_bvc->nse;
449 struct gbproxy_bvc *ptp_bvc;
450 unsigned int i;
451
452 /* BLOCK all SGSN-side PTP BVC within this NSE */
453 hash_for_each(nse->bvcs, i, ptp_bvc, list) {
454 if (ptp_bvc == sig_bvc)
455 continue;
456 OSMO_ASSERT(ptp_bvc->cell);
457
458 dispatch_to_all_sgsn_bvc(ptp_bvc->cell, BSSGP_BVCFSM_E_REQ_BLOCK, &cause);
Harald Weltef9e149b2020-12-02 23:29:38 +0100459 }
Harald Welte7df1e5a2020-12-02 22:53:26 +0100460
Harald Weltee5209642020-12-05 19:59:45 +0100461 /* Delete all BSS-side PTP BVC within this NSE */
462 gbproxy_cleanup_bvcs(nse, 0);
463
464 /* TODO: we keep the "CELL" around for now, re-connecting it to
465 * any (later) new PTP-BVC for that BVCI. Not sure if that's the
466 * best idea ? */
467}
468
469/* forward declaration */
470static const struct bssgp_bvc_fsm_ops sgsn_ptp_bvc_fsm_ops;
471
472static const struct bssgp_bvc_fsm_ops bss_sig_bvc_fsm_ops = {
473 .reset_notification = bss_sig_bvc_reset_notif,
474};
475
476/* BVC FSM informs us about a BSS-side reset of a PTP BVC */
477static void bss_ptp_bvc_reset_notif(uint16_t nsei, uint16_t bvci, const struct gprs_ra_id *ra_id,
478 uint16_t cell_id, uint8_t cause, void *priv)
479{
480 struct gbproxy_bvc *bvc = priv;
481 struct gbproxy_config *cfg = bvc->nse->cfg;
482 unsigned int i;
483
484 OSMO_ASSERT(bvci != 0);
485
486 if (!bvc->cell) {
487 /* see if we have a CELL dangling around */
488 bvc->cell = gbproxy_cell_by_bvci(cfg, bvci);
489 if (bvc->cell) {
490 /* the CELL already exists. This means either it * was created before at an
491 * earlier PTP BVC-RESET, or that there are non-unique BVCIs and hence a
492 * malconfiguration */
493 if (bvc->cell->bss_bvc) {
494 LOGPBVC(bvc, LOGL_NOTICE, "Rx BVC-RESET via this NSE, but CELL already "
495 "has BVC on NSEI=%05u\n", bvc->cell->bss_bvc->nse->nsei);
496 LOGPBVC(bvc->cell->bss_bvc, LOGL_NOTICE, "Destroying due to conflicting "
497 "BVCI configuration (new NSEI=%05u)!\n", bvc->nse->nsei);
498 gbproxy_bvc_free(bvc->cell->bss_bvc);
499 }
500 bvc->cell->bss_bvc = bvc;
501 }
502 }
503
504 if (!bvc->cell) {
505 struct gbproxy_nse *sgsn_nse;
506 /* if we end up here, it means this is the first time we received a BVC-RESET
507 * for this BVC. We need to create the 'cell' data structure and the SGSN-side
508 * BVC counterparts */
509
510 bvc->cell = gbproxy_cell_alloc(cfg, bvci);
511 OSMO_ASSERT(bvc->cell);
Harald Welteee0cc812020-12-12 14:22:32 +0100512 memcpy(bvc->cell->ra, bvc->ra, sizeof(bvc->cell->ra));
Harald Weltee5209642020-12-05 19:59:45 +0100513
514 /* link us to the cell and vice-versa */
515 bvc->cell->bss_bvc = bvc;
516
517 /* allocate the SGSN-side BVCs within the cell, and reset them */
518 hash_for_each(cfg->sgsn_nses, i, sgsn_nse, list) {
519 struct gbproxy_bvc *sgsn_bvc = gbproxy_bvc_by_bvci(sgsn_nse, bvci);
520 if (sgsn_bvc)
521 OSMO_ASSERT(!sgsn_bvc->cell);
522
523 if (!sgsn_bvc) {
524 sgsn_bvc = gbproxy_bvc_alloc(sgsn_nse, bvci);
525 OSMO_ASSERT(sgsn_bvc);
526
527 sgsn_bvc->cell = bvc->cell;
Harald Welteee0cc812020-12-12 14:22:32 +0100528 memcpy(sgsn_bvc->ra, bvc->cell->ra, sizeof(sgsn_bvc->ra));
Harald Weltee5209642020-12-05 19:59:45 +0100529 sgsn_bvc->fi = bssgp_bvc_fsm_alloc_ptp_bss(sgsn_bvc, cfg->nsi, sgsn_nse->nsei,
530 bvci, ra_id, cell_id);
531 OSMO_ASSERT(sgsn_bvc->fi);
532 bssgp_bvc_fsm_set_ops(sgsn_bvc->fi, &sgsn_ptp_bvc_fsm_ops, sgsn_bvc);
533
534 gbproxy_cell_add_sgsn_bvc(bvc->cell, sgsn_bvc);
535 } else {
536 OSMO_ASSERT(sgsn_bvc->cell == bvc->cell);
537 }
538 }
539 }
540
541 /* Trigger outbound BVC-RESET procedure toward each SGSN */
542 dispatch_to_all_sgsn_bvc(bvc->cell, BSSGP_BVCFSM_E_REQ_RESET, &cause);
543}
544
545/* BVC FSM informs us about a BSS-side FSM state change */
546static void bss_ptp_bvc_state_chg_notif(uint16_t nsei, uint16_t bvci, int old_state, int state, void *priv)
547{
548 struct gbproxy_bvc *bvc = priv;
549 struct gbproxy_cell *cell = bvc->cell;
550 uint8_t cause = bssgp_bvc_fsm_get_block_cause(bvc->fi);
551
552 /* we have just been created but due to callback ordering the cell is not associated */
553 if (!cell)
554 return;
555
556 switch (state) {
557 case BSSGP_BVCFSM_S_BLOCKED:
558 /* block the corresponding SGSN-side PTP BVCs */
559 dispatch_to_all_sgsn_bvc(cell, BSSGP_BVCFSM_E_REQ_BLOCK, &cause);
560 break;
561 case BSSGP_BVCFSM_S_UNBLOCKED:
562 /* unblock the corresponding SGSN-side PTP BVCs */
563 dispatch_to_all_sgsn_bvc(cell, BSSGP_BVCFSM_E_REQ_UNBLOCK, NULL);
564 break;
565 }
566}
567
Harald Welte85a40272020-12-08 21:43:22 +0100568/* BVC FSM informs us about BVC-FC PDU receive */
569static void bss_ptp_bvc_fc_bvc(uint16_t nsei, uint16_t bvci, const struct bssgp2_flow_ctrl *fc, void *priv)
570{
571 struct gbproxy_bvc *bss_bvc = priv;
572 struct gbproxy_cell *cell = bss_bvc->cell;
573
574 if (!cell)
575 return;
576
577 /* FIXME: actually split the bandwidth among the SGSNs! */
578
579 dispatch_to_all_sgsn_bvc(cell, BSSGP_BVCFSM_E_REQ_FC_BVC, (void *) fc);
580}
581
Harald Weltee5209642020-12-05 19:59:45 +0100582static const struct bssgp_bvc_fsm_ops bss_ptp_bvc_fsm_ops = {
583 .reset_notification = bss_ptp_bvc_reset_notif,
584 .state_chg_notification = bss_ptp_bvc_state_chg_notif,
Harald Welte85a40272020-12-08 21:43:22 +0100585 .rx_fc_bvc = bss_ptp_bvc_fc_bvc,
Harald Weltee5209642020-12-05 19:59:45 +0100586};
587
588/* BVC FSM informs us about a SGSN-side reset of a PTP BVC */
589static void sgsn_ptp_bvc_reset_notif(uint16_t nsei, uint16_t bvci, const struct gprs_ra_id *ra_id,
590 uint16_t cell_id, uint8_t cause, void *priv)
591{
592 struct gbproxy_bvc *bvc = priv;
593
594 if (!bvc->cell) {
595 LOGPBVC(bvc, LOGL_ERROR, "RESET of PTP BVC on SGSN side for which we have no BSS?\n");
596 return;
597 }
598
599 OSMO_ASSERT(bvc->cell->bss_bvc);
600
601 /* request reset of BSS-facing PTP-BVC */
602 osmo_fsm_inst_dispatch(bvc->cell->bss_bvc->fi, BSSGP_BVCFSM_E_REQ_RESET, &cause);
603}
604
605static const struct bssgp_bvc_fsm_ops sgsn_ptp_bvc_fsm_ops = {
606 .reset_notification = sgsn_ptp_bvc_reset_notif,
607};
608
609/* BVC FSM informs us about a SGSN-side reset of the signaling BVC */
610static void sgsn_sig_bvc_reset_notif(uint16_t nsei, uint16_t bvci, const struct gprs_ra_id *ra_id,
611 uint16_t cell_id, uint8_t cause, void *priv)
612{
613 struct gbproxy_bvc *bvc = priv;
614 struct gbproxy_config *cfg = bvc->nse->cfg;
615 struct gbproxy_nse *bss_nse;
616 unsigned int i;
617
618 /* delete all SGSN-side PTP BVC for this SGSN */
619 gbproxy_cleanup_bvcs(bvc->nse, 0);
620 /* FIXME: what to do about the cells? */
621 /* FIXME: do we really want to RESET all signaling BVC on the BSS and affect all other SGSN? */
622
623 /* we need to trigger generating a reset procedure towards each BSS side signaling BVC */
624 hash_for_each(cfg->bss_nses, i, bss_nse, list) {
625 struct gbproxy_bvc *bss_bvc = gbproxy_bvc_by_bvci(bss_nse, 0);
626 if (!bss_bvc) {
627 LOGPNSE(bss_nse, LOGL_ERROR, "Doesn't have BVC with BVCI=0 ?!?\n");
628 continue;
629 }
630 osmo_fsm_inst_dispatch(bss_bvc->fi, BSSGP_BVCFSM_E_REQ_RESET, &cause);
631 }
632}
633
634const struct bssgp_bvc_fsm_ops sgsn_sig_bvc_fsm_ops = {
635 .reset_notification = sgsn_sig_bvc_reset_notif,
636};
637
638/***********************************************************************
639 * Signaling BVC handling
640 ***********************************************************************/
641
642/* process a BVC-RESET message from the BSS side */
643static int rx_bvc_reset_from_bss(struct gbproxy_nse *nse, struct msgb *msg, struct tlv_parsed *tp)
644{
645 struct gbproxy_bvc *from_bvc = NULL;
646 uint16_t bvci = ntohs(tlvp_val16_unal(tp, BSSGP_IE_BVCI));
647 uint32_t features = 0; // FIXME: make configurable
648
649 LOGPNSE(nse, LOGL_INFO, "Rx BVC-RESET (BVCI=%05u)\n", bvci);
650
Harald Welte314647b2020-12-02 23:03:22 +0100651 if (bvci == 0) {
652 /* If we receive a BVC reset on the signalling endpoint, we
653 * don't want the SGSN to reset, as the signalling endpoint
654 * is common for all point-to-point BVCs (and thus all BTS) */
Harald Welte324f0652020-12-02 23:06:37 +0100655
Harald Weltee5209642020-12-05 19:59:45 +0100656 from_bvc = gbproxy_bvc_by_bvci(nse, 0);
Harald Welte560bdb32020-12-04 22:24:47 +0100657 if (!from_bvc) {
Harald Weltee5209642020-12-05 19:59:45 +0100658 from_bvc = gbproxy_bvc_alloc(nse, 0);
659 OSMO_ASSERT(from_bvc);
660 from_bvc->fi = bssgp_bvc_fsm_alloc_sig_sgsn(from_bvc, nse->cfg->nsi, nse->nsei, features);
661 if (!from_bvc->fi) {
662 LOGPNSE(nse, LOGL_ERROR, "Cannot allocate SIG-BVC FSM\n");
663 gbproxy_bvc_free(from_bvc);
664 return -ENOMEM;
Harald Welte7df1e5a2020-12-02 22:53:26 +0100665 }
Harald Weltee5209642020-12-05 19:59:45 +0100666 bssgp_bvc_fsm_set_ops(from_bvc->fi, &bss_sig_bvc_fsm_ops, from_bvc);
667 }
668 } else {
669 from_bvc = gbproxy_bvc_by_bvci(nse, bvci);
670 if (!from_bvc) {
Harald Welte7df1e5a2020-12-02 22:53:26 +0100671 /* if a PTP-BVC is reset, and we don't know that
Harald Welte560bdb32020-12-04 22:24:47 +0100672 * PTP-BVCI yet, we should allocate a new bvc */
673 from_bvc = gbproxy_bvc_alloc(nse, bvci);
674 OSMO_ASSERT(from_bvc);
Harald Weltee5209642020-12-05 19:59:45 +0100675 from_bvc->fi = bssgp_bvc_fsm_alloc_ptp_sgsn(from_bvc, nse->cfg->nsi,
676 nse->nsei, bvci);
677 if (!from_bvc->fi) {
678 LOGPNSE(nse, LOGL_ERROR, "Cannot allocate SIG-BVC FSM\n");
679 gbproxy_bvc_free(from_bvc);
680 return -ENOMEM;
681 }
682 bssgp_bvc_fsm_set_ops(from_bvc->fi, &bss_ptp_bvc_fsm_ops, from_bvc);
Harald Welte7df1e5a2020-12-02 22:53:26 +0100683 }
Harald Weltee5209642020-12-05 19:59:45 +0100684#if 0
Harald Welte7df1e5a2020-12-02 22:53:26 +0100685 /* Could have moved to a different NSE */
Harald Welte560bdb32020-12-04 22:24:47 +0100686 if (!check_bvc_nsei(from_bvc, nsei)) {
687 LOGPBVC(from_bvc, LOGL_NOTICE, "moving bvc to NSE(%05u)\n", nsei);
Harald Welte7df1e5a2020-12-02 22:53:26 +0100688
Harald Weltee5209642020-12-05 19:59:45 +0100689 struct gbproxy_nse *nse_new = gbproxy_nse_by_nsei(cfg, nsei, false);
Harald Welte7df1e5a2020-12-02 22:53:26 +0100690 if (!nse_new) {
691 LOGP(DGPRS, LOGL_NOTICE, "NSE(%05u) Got PtP BVC reset before signalling reset for "
692 "BVCI=%05u\n", bvci, nsei);
693 bssgp_tx_status(BSSGP_CAUSE_PDU_INCOMP_STATE, NULL, msg);
694 return 0;
695 }
696
Harald Welte560bdb32020-12-04 22:24:47 +0100697 /* Move bvc to different NSE */
698 gbproxy_bvc_move(from_bvc, nse_new);
Harald Welte7df1e5a2020-12-02 22:53:26 +0100699 }
Harald Weltee5209642020-12-05 19:59:45 +0100700#endif
701 /* FIXME: do we need this, if it happens within FSM? */
Harald Welte173a1822020-12-03 15:36:59 +0100702 if (TLVP_PRES_LEN(tp, BSSGP_IE_CELL_ID, 8)) {
Harald Welte7df1e5a2020-12-02 22:53:26 +0100703 struct gprs_ra_id raid;
704 /* We have a Cell Identifier present in this
705 * PDU, this means we can extend our local
706 * state information about this particular cell
707 * */
Harald Welte560bdb32020-12-04 22:24:47 +0100708 memcpy(from_bvc->ra, TLVP_VAL(tp, BSSGP_IE_CELL_ID), sizeof(from_bvc->ra));
709 gsm48_parse_ra(&raid, from_bvc->ra);
710 LOGPBVC(from_bvc, LOGL_INFO, "Cell ID %s\n", osmo_rai_name(&raid));
Harald Welte7df1e5a2020-12-02 22:53:26 +0100711 }
Harald Welte7df1e5a2020-12-02 22:53:26 +0100712 }
Harald Weltee5209642020-12-05 19:59:45 +0100713 /* hand into FSM for further processing */
714 osmo_fsm_inst_dispatch(from_bvc->fi, BSSGP_BVCFSM_E_RX_RESET, msg);
715 return 0;
Harald Welte7df1e5a2020-12-02 22:53:26 +0100716}
717
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200718/* Receive an incoming signalling message from a BSS-side NS-VC */
Harald Weltee5209642020-12-05 19:59:45 +0100719static int gbprox_rx_sig_from_bss(struct gbproxy_nse *nse, struct msgb *msg, uint16_t ns_bvci)
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200720{
721 struct bssgp_normal_hdr *bgph = (struct bssgp_normal_hdr *) msgb_bssgph(msg);
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200722 uint8_t pdu_type = bgph->pdu_type;
Harald Weltee5209642020-12-05 19:59:45 +0100723 const char *pdut_name = osmo_tlv_prot_msg_name(&osmo_pdef_bssgp, bgph->pdu_type);
724 struct tlv_parsed tp;
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200725 int data_len = msgb_bssgp_len(msg) - sizeof(*bgph);
Harald Welte560bdb32020-12-04 22:24:47 +0100726 struct gbproxy_bvc *from_bvc = NULL;
Harald Welteec0f8012020-12-06 16:32:01 +0100727 char log_pfx[32];
Harald Weltee5209642020-12-05 19:59:45 +0100728 uint16_t ptp_bvci;
729 uint32_t tlli;
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200730 int rc;
731
Harald Weltee5209642020-12-05 19:59:45 +0100732 snprintf(log_pfx, sizeof(log_pfx), "NSE(%05u/BSS)-BVC(%05u/??)", nse->nsei, ns_bvci);
733
734 LOGP(DGPRS, LOGL_DEBUG, "%s Rx %s\n", log_pfx, pdut_name);
Harald Welteec0f8012020-12-06 16:32:01 +0100735
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200736 if (ns_bvci != 0 && ns_bvci != 1) {
Harald Weltee5209642020-12-05 19:59:45 +0100737 LOGP(DGPRS, LOGL_NOTICE, "%s %s BVCI=%05u is not signalling\n", log_pfx, pdut_name, ns_bvci);
Harald Welte278dd272020-12-06 13:35:24 +0100738 return bssgp_tx_status(BSSGP_CAUSE_PROTO_ERR_UNSPEC, NULL, msg);
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200739 }
740
Harald Welte278dd272020-12-06 13:35:24 +0100741 if (!(bssgp_pdu_type_flags(pdu_type) & BSSGP_PDUF_SIG)) {
Harald Weltee5209642020-12-05 19:59:45 +0100742 LOGP(DGPRS, LOGL_NOTICE, "%s %s not allowed in signalling BVC\n", log_pfx, pdut_name);
Harald Welte278dd272020-12-06 13:35:24 +0100743 return bssgp_tx_status(BSSGP_CAUSE_PROTO_ERR_UNSPEC, NULL, msg);
744 }
745
746 if (!(bssgp_pdu_type_flags(pdu_type) & BSSGP_PDUF_UL)) {
Harald Weltee5209642020-12-05 19:59:45 +0100747 LOGP(DGPRS, LOGL_NOTICE, "%s %s not allowed in uplink direction\n", log_pfx, pdut_name);
Harald Welte278dd272020-12-06 13:35:24 +0100748 return bssgp_tx_status(BSSGP_CAUSE_PROTO_ERR_UNSPEC, NULL, msg);
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200749 }
750
Harald Welteec0f8012020-12-06 16:32:01 +0100751 rc = osmo_tlv_prot_parse(&osmo_pdef_bssgp, &tp, 1, pdu_type, bgph->data, data_len, 0, 0,
752 DGPRS, log_pfx);
753 if (rc < 0) {
Harald Weltee5209642020-12-05 19:59:45 +0100754 rate_ctr_inc(&nse->cfg->ctrg->ctr[GBPROX_GLOB_CTR_PROTO_ERR_BSS]);
Harald Welteec0f8012020-12-06 16:32:01 +0100755 return tx_status_from_tlvp(rc, msg);
756 }
Harald Weltee5209642020-12-05 19:59:45 +0100757 /* hack to get both msg + tlv_parsed passed via osmo_fsm_inst_dispatch */
758 msgb_bcid(msg) = (void *)&tp;
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200759
Harald Weltee5209642020-12-05 19:59:45 +0100760 /* special case handling for some PDU types */
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200761 switch (pdu_type) {
Harald Weltee5209642020-12-05 19:59:45 +0100762 case BSSGP_PDUT_BVC_RESET:
763 /* resolve or create gbproxy_bvc + handlei n BVC-FSM */
764 ptp_bvci = ntohs(tlvp_val16_unal(&tp, BSSGP_IE_BVCI));
765 return rx_bvc_reset_from_bss(nse, msg, &tp);
766 case BSSGP_PDUT_BVC_RESET_ACK:
767 ptp_bvci = ntohs(tlvp_val16_unal(&tp, BSSGP_IE_BVCI));
768 from_bvc = gbproxy_bvc_by_bvci(nse, ptp_bvci);
Harald Welte560bdb32020-12-04 22:24:47 +0100769 if (!from_bvc)
770 goto err_no_bvc;
Harald Weltee5209642020-12-05 19:59:45 +0100771 return osmo_fsm_inst_dispatch(from_bvc->fi, BSSGP_BVCFSM_E_RX_RESET_ACK, msg);
772 case BSSGP_PDUT_BVC_BLOCK:
773 ptp_bvci = ntohs(tlvp_val16_unal(&tp, BSSGP_IE_BVCI));
774 from_bvc = gbproxy_bvc_by_bvci(nse, ptp_bvci);
775 if (!from_bvc)
776 goto err_no_bvc;
777 return osmo_fsm_inst_dispatch(from_bvc->fi, BSSGP_BVCFSM_E_RX_BLOCK, msg);
778 case BSSGP_PDUT_BVC_UNBLOCK:
779 ptp_bvci = ntohs(tlvp_val16_unal(&tp, BSSGP_IE_BVCI));
780 from_bvc = gbproxy_bvc_by_bvci(nse, ptp_bvci);
781 if (!from_bvc)
782 goto err_no_bvc;
783 return osmo_fsm_inst_dispatch(from_bvc->fi, BSSGP_BVCFSM_E_RX_UNBLOCK, msg);
784 case BSSGP_PDUT_SUSPEND:
785 case BSSGP_PDUT_RESUME:
786 /* FIXME: Implement TLLI Cache. Every SUSPEND/RESUME we must
787 * take record of the TLLI->BVC mapping so we can map
788 * back from TLLI->BVC when the SUSPEND/RESUME-ACK
789 * arrives. Cache should have a timeout of 1-3 seconds
790 * and the ACK should explicitly delete entries. */
791#if 0
792 /* TODO: Validate the RAI for consistency with the RAI
793 * we expect for any of the BVC within this BSS side NSE */
794 memcpy(ra, TLVP_VAL(&tp, BSSGP_IE_ROUTEING_AREA), sizeof(from_bvc->ra));
Harald Welte560bdb32020-12-04 22:24:47 +0100795 gsm48_parse_ra(&raid, from_bvc->ra);
Harald Weltee5209642020-12-05 19:59:45 +0100796#endif
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200797 break;
Harald Weltee5209642020-12-05 19:59:45 +0100798 case BSSGP_PDUT_STATUS:
799 /* FIXME: inspect the erroneous PDU IE (if any) and check
800 * if we can extract a TLLI/RNI to route it to the correct SGSN */
801 break;
802 case BSSGP_PDUT_RAN_INFO:
803 case BSSGP_PDUT_RAN_INFO_REQ:
804 case BSSGP_PDUT_RAN_INFO_ACK:
805 case BSSGP_PDUT_RAN_INFO_ERROR:
806 case BSSGP_PDUT_RAN_INFO_APP_ERROR:
807 /* FIXME: route based in RIM Routing IE */
808 rc = bssgp_tx_status(BSSGP_CAUSE_PDU_INCOMP_FEAT, NULL, msg);
809 break;
810 case BSSGP_PDUT_LLC_DISCARD:
811 case BSSGP_PDUT_FLUSH_LL_ACK:
812 /* route based on BVCI + TLLI */
813 ptp_bvci = ntohs(tlvp_val16_unal(&tp, BSSGP_IE_BVCI));
814 tlli = osmo_load32be(TLVP_VAL(&tp, BSSGP_IE_TLLI));
815 from_bvc = gbproxy_bvc_by_bvci(nse, ptp_bvci);
816 if (!from_bvc)
817 goto err_no_bvc;
818 gbprox_bss2sgsn_tlli(from_bvc->cell, msg, tlli, true);
819 break;
820 default:
821 LOGPNSE(nse, LOGL_ERROR, "Rx %s: Implementation missing\n", pdut_name);
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200822 break;
823 }
824
Harald Weltee5209642020-12-05 19:59:45 +0100825 return rc;
Harald Welte560bdb32020-12-04 22:24:47 +0100826err_no_bvc:
Harald Weltee5209642020-12-05 19:59:45 +0100827 LOGPNSE(nse, LOGL_ERROR, "Rx %s: cannot find BVC for BVCI=%05u\n", pdut_name, ptp_bvci);
828 rate_ctr_inc(&nse->cfg->ctrg->ctr[GBPROX_GLOB_CTR_INV_NSEI]);
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200829 return bssgp_tx_status(BSSGP_CAUSE_INV_MAND_INF, NULL, msg);
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200830}
831
832/* Receive paging request from SGSN, we need to relay to proper BSS */
Harald Weltee5209642020-12-05 19:59:45 +0100833static int gbprox_rx_paging(struct gbproxy_nse *nse, struct msgb *msg, const char *pdut_name,
834 struct tlv_parsed *tp, uint16_t ns_bvci)
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200835{
Harald Weltee5209642020-12-05 19:59:45 +0100836 struct gbproxy_config *cfg = nse->cfg;
837 struct gbproxy_bvc *sgsn_bvc, *bss_bvc;
Daniel Willmann76205712020-11-30 17:08:58 +0100838 unsigned int n_nses = 0;
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200839 int errctr = GBPROX_GLOB_CTR_PROTO_ERR_SGSN;
Harald Welte8b4c7942020-12-05 10:14:49 +0100840 int i, j;
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200841
Daniel Willmanne50550e2020-11-26 18:19:21 +0100842 /* FIXME: Handle paging logic to only page each matching NSE */
843
Harald Welte173a1822020-12-03 15:36:59 +0100844 if (TLVP_PRES_LEN(tp, BSSGP_IE_BVCI, 2)) {
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200845 uint16_t bvci = ntohs(tlvp_val16_unal(tp, BSSGP_IE_BVCI));
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200846 errctr = GBPROX_GLOB_CTR_OTHER_ERR;
Harald Weltee5209642020-12-05 19:59:45 +0100847 sgsn_bvc = gbproxy_bvc_by_bvci(nse, bvci);
848 if (!sgsn_bvc) {
849 LOGPNSE(nse, LOGL_NOTICE, "Rx %s: unable to route: BVCI=%05u unknown\n",
850 pdut_name, bvci);
Harald Welte3d1bd4d2020-11-23 15:14:20 +0100851 rate_ctr_inc(&cfg->ctrg->ctr[errctr]);
852 return -EINVAL;
853 }
Harald Weltee5209642020-12-05 19:59:45 +0100854 LOGPBVC(sgsn_bvc, LOGL_INFO, "Rx %s: routing by BVCI\n", pdut_name);
855 return gbprox_relay2peer(msg, sgsn_bvc->cell->bss_bvc, ns_bvci);
Harald Welte173a1822020-12-03 15:36:59 +0100856 } else if (TLVP_PRES_LEN(tp, BSSGP_IE_ROUTEING_AREA, 6)) {
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200857 errctr = GBPROX_GLOB_CTR_INV_RAI;
Harald Welte560bdb32020-12-04 22:24:47 +0100858 /* iterate over all bvcs and dispatch the paging to each matching one */
Harald Welted2fef952020-12-05 00:31:07 +0100859 hash_for_each(cfg->bss_nses, i, nse, list) {
Harald Weltee5209642020-12-05 19:59:45 +0100860 hash_for_each(nse->bvcs, j, bss_bvc, list) {
861 if (!memcmp(bss_bvc->ra, TLVP_VAL(tp, BSSGP_IE_ROUTEING_AREA), 6)) {
862 LOGPNSE(nse, LOGL_INFO, "Rx %s: routing to NSE (RAI match)\n",
863 pdut_name);
864 gbprox_relay2peer(msg, bss_bvc, ns_bvci);
Daniel Willmann76205712020-11-30 17:08:58 +0100865 n_nses++;
866 /* Only send it once to each NSE */
867 break;
Daniel Willmanne50550e2020-11-26 18:19:21 +0100868 }
Harald Welte3d1bd4d2020-11-23 15:14:20 +0100869 }
870 }
Harald Welte173a1822020-12-03 15:36:59 +0100871 } else if (TLVP_PRES_LEN(tp, BSSGP_IE_LOCATION_AREA, 5)) {
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200872 errctr = GBPROX_GLOB_CTR_INV_LAI;
Harald Welte560bdb32020-12-04 22:24:47 +0100873 /* iterate over all bvcs and dispatch the paging to each matching one */
Harald Welted2fef952020-12-05 00:31:07 +0100874 hash_for_each(cfg->bss_nses, i, nse, list) {
Harald Weltee5209642020-12-05 19:59:45 +0100875 hash_for_each(nse->bvcs, j, bss_bvc, list) {
876 if (!memcmp(bss_bvc->ra, TLVP_VAL(tp, BSSGP_IE_LOCATION_AREA), 5)) {
877 LOGPNSE(nse, LOGL_INFO, "Rx %s: routing to NSE (LAI match)\n",
878 pdut_name);
879 gbprox_relay2peer(msg, bss_bvc, ns_bvci);
Daniel Willmann76205712020-11-30 17:08:58 +0100880 n_nses++;
881 /* Only send it once to each NSE */
882 break;
Daniel Willmanne50550e2020-11-26 18:19:21 +0100883 }
Harald Welte3d1bd4d2020-11-23 15:14:20 +0100884 }
885 }
Harald Welte173a1822020-12-03 15:36:59 +0100886 } else if (TLVP_PRES_LEN(tp, BSSGP_IE_BSS_AREA_ID, 1)) {
Harald Welte560bdb32020-12-04 22:24:47 +0100887 /* iterate over all bvcs and dispatch the paging to each matching one */
Harald Welted2fef952020-12-05 00:31:07 +0100888 hash_for_each(cfg->bss_nses, i, nse, list) {
Harald Weltee5209642020-12-05 19:59:45 +0100889 hash_for_each(nse->bvcs, j, bss_bvc, list) {
890 LOGPNSE(nse, LOGL_INFO, "Rx %s:routing to NSE (broadcast)\n", pdut_name);
891 gbprox_relay2peer(msg, bss_bvc, ns_bvci);
Daniel Willmann76205712020-11-30 17:08:58 +0100892 n_nses++;
893 /* Only send it once to each NSE */
894 break;
Daniel Willmanne50550e2020-11-26 18:19:21 +0100895 }
Harald Welte53ee2062020-11-24 11:31:13 +0100896 }
897 } else {
Harald Weltee5209642020-12-05 19:59:45 +0100898 LOGPNSE(nse, LOGL_ERROR, "BSSGP PAGING: unable to route, missing IE\n");
Harald Welte53ee2062020-11-24 11:31:13 +0100899 rate_ctr_inc(&cfg->ctrg->ctr[errctr]);
900 }
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200901
Daniel Willmann76205712020-11-30 17:08:58 +0100902 if (n_nses == 0) {
Harald Weltee5209642020-12-05 19:59:45 +0100903 LOGPNSE(nse, LOGL_ERROR, "BSSGP PAGING: unable to route, no destination found\n");
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200904 rate_ctr_inc(&cfg->ctrg->ctr[errctr]);
905 return -EINVAL;
906 }
Harald Welte3d1bd4d2020-11-23 15:14:20 +0100907 return 0;
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200908}
909
910/* Receive an incoming BVC-RESET message from the SGSN */
Harald Weltee5209642020-12-05 19:59:45 +0100911static int rx_bvc_reset_from_sgsn(struct gbproxy_nse *nse, struct msgb *msg, struct tlv_parsed *tp,
912 uint16_t ns_bvci)
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200913{
Harald Weltee5209642020-12-05 19:59:45 +0100914 uint16_t ptp_bvci = ntohs(tlvp_val16_unal(tp, BSSGP_IE_BVCI));
915 struct gbproxy_bvc *from_bvc;
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200916
Harald Weltee5209642020-12-05 19:59:45 +0100917 LOGPNSE(nse, LOGL_INFO, "Rx BVC-RESET (BVCI=%05u)\n", ptp_bvci);
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200918
Harald Weltee5209642020-12-05 19:59:45 +0100919 if (ptp_bvci == 0) {
920 from_bvc = gbproxy_bvc_by_bvci(nse, 0);
921 OSMO_ASSERT(from_bvc);
922 osmo_fsm_inst_dispatch(from_bvc->fi, BSSGP_BVCFSM_E_RX_RESET, msg);
923 } else {
924 from_bvc = gbproxy_bvc_by_bvci(nse, ptp_bvci);
925 if (!from_bvc) {
926 LOGPNSE(nse, LOGL_ERROR, "Rx BVC-RESET BVCI=%05u: Cannot find BVC\n", ptp_bvci);
927 rate_ctr_inc(&nse->cfg->ctrg->ctr[GBPROX_GLOB_CTR_INV_BVCI]);
928 return bssgp_tx_status(BSSGP_CAUSE_UNKNOWN_BVCI, &ptp_bvci, msg);
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200929 }
Harald Weltee5209642020-12-05 19:59:45 +0100930 osmo_fsm_inst_dispatch(from_bvc->fi, BSSGP_BVCFSM_E_RX_RESET, msg);
Daniel Willmanne50550e2020-11-26 18:19:21 +0100931 }
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200932
933 return 0;
934}
935
936/* Receive an incoming signalling message from the SGSN-side NS-VC */
Harald Weltedbef0aa2020-12-07 17:48:11 +0100937static int gbprox_rx_sig_from_sgsn(struct gbproxy_nse *nse, struct msgb *msg, uint16_t ns_bvci)
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200938{
Harald Weltedbef0aa2020-12-07 17:48:11 +0100939 struct bssgp_normal_hdr *bgph = (struct bssgp_normal_hdr *) msgb_bssgph(msg);
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200940 uint8_t pdu_type = bgph->pdu_type;
Harald Weltee5209642020-12-05 19:59:45 +0100941 const char *pdut_name = osmo_tlv_prot_msg_name(&osmo_pdef_bssgp, bgph->pdu_type);
942 struct gbproxy_config *cfg = nse->cfg;
943 struct gbproxy_bvc *sgsn_bvc;
944 struct tlv_parsed tp;
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200945 int data_len;
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200946 uint16_t bvci;
Harald Welteec0f8012020-12-06 16:32:01 +0100947 char log_pfx[32];
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200948 int rc = 0;
949 int cause;
Harald Welted2fef952020-12-05 00:31:07 +0100950 int i;
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200951
Harald Weltee5209642020-12-05 19:59:45 +0100952 snprintf(log_pfx, sizeof(log_pfx), "NSE(%05u/SGSN)-BVC(%05u/??)", nse->nsei, ns_bvci);
953
954 LOGP(DGPRS, LOGL_DEBUG, "%s Rx %s\n", log_pfx, pdut_name);
Harald Welteec0f8012020-12-06 16:32:01 +0100955
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200956 if (ns_bvci != 0 && ns_bvci != 1) {
Harald Welteec0f8012020-12-06 16:32:01 +0100957 LOGP(DGPRS, LOGL_NOTICE, "%s BVCI=%05u is not signalling\n", log_pfx, ns_bvci);
Harald Weltedbef0aa2020-12-07 17:48:11 +0100958 return bssgp_tx_status(BSSGP_CAUSE_PROTO_ERR_UNSPEC, NULL, msg);
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200959 }
960
Harald Welte278dd272020-12-06 13:35:24 +0100961 if (!(bssgp_pdu_type_flags(pdu_type) & BSSGP_PDUF_SIG)) {
Harald Weltee5209642020-12-05 19:59:45 +0100962 LOGP(DGPRS, LOGL_NOTICE, "%s %s not allowed in signalling BVC\n", log_pfx, pdut_name);
Harald Weltedbef0aa2020-12-07 17:48:11 +0100963 return bssgp_tx_status(BSSGP_CAUSE_PROTO_ERR_UNSPEC, NULL, msg);
Harald Welte278dd272020-12-06 13:35:24 +0100964 }
965
966 if (!(bssgp_pdu_type_flags(pdu_type) & BSSGP_PDUF_DL)) {
Harald Weltee5209642020-12-05 19:59:45 +0100967 LOGP(DGPRS, LOGL_NOTICE, "%s %s not allowed in downlink direction\n", log_pfx, pdut_name);
Harald Weltedbef0aa2020-12-07 17:48:11 +0100968 return bssgp_tx_status(BSSGP_CAUSE_PROTO_ERR_UNSPEC, NULL, msg);
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200969 }
970
Harald Weltedbef0aa2020-12-07 17:48:11 +0100971 data_len = msgb_bssgp_len(msg) - sizeof(*bgph);
Harald Welteec0f8012020-12-06 16:32:01 +0100972
973 rc = osmo_tlv_prot_parse(&osmo_pdef_bssgp, &tp, 1, pdu_type, bgph->data, data_len, 0, 0,
974 DGPRS, log_pfx);
975 if (rc < 0) {
976 rc = tx_status_from_tlvp(rc, msg);
Harald Welteec0f8012020-12-06 16:32:01 +0100977 rate_ctr_inc(&cfg->ctrg->ctr[GBPROX_GLOB_CTR_PROTO_ERR_SGSN]);
978 return rc;
979 }
Harald Weltee5209642020-12-05 19:59:45 +0100980 /* hack to get both msg + tlv_parsed passed via osmo_fsm_inst_dispatch */
981 msgb_bcid(msg) = (void *)&tp;
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200982
983 switch (pdu_type) {
984 case BSSGP_PDUT_BVC_RESET:
Harald Weltee5209642020-12-05 19:59:45 +0100985 /* resolve or create ggbproxy_bvc + handle in BVC-FSM */
986 bvci = ntohs(tlvp_val16_unal(&tp, BSSGP_IE_BVCI));
987 rc = rx_bvc_reset_from_sgsn(nse, msg, &tp, ns_bvci);
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +0200988 break;
989 case BSSGP_PDUT_BVC_RESET_ACK:
Daniel Willmann8489e7a2020-11-03 21:12:42 +0100990 bvci = ntohs(tlvp_val16_unal(&tp, BSSGP_IE_BVCI));
Harald Weltee5209642020-12-05 19:59:45 +0100991 sgsn_bvc = gbproxy_bvc_by_bvci(nse, bvci);
992 if (!sgsn_bvc)
993 goto err_no_bvc;
994 rc = osmo_fsm_inst_dispatch(sgsn_bvc->fi, BSSGP_BVCFSM_E_RX_RESET_ACK, msg);
995 break;
996 case BSSGP_PDUT_BVC_BLOCK_ACK:
997 bvci = ntohs(tlvp_val16_unal(&tp, BSSGP_IE_BVCI));
998 sgsn_bvc = gbproxy_bvc_by_bvci(nse, bvci);
999 if (!sgsn_bvc)
1000 goto err_no_bvc;
1001 rc = osmo_fsm_inst_dispatch(sgsn_bvc->fi, BSSGP_BVCFSM_E_RX_BLOCK_ACK, msg);
1002 break;
1003 case BSSGP_PDUT_BVC_UNBLOCK_ACK:
1004 bvci = ntohs(tlvp_val16_unal(&tp, BSSGP_IE_BVCI));
1005 sgsn_bvc = gbproxy_bvc_by_bvci(nse, bvci);
1006 if (!sgsn_bvc)
1007 goto err_no_bvc;
1008 rc = osmo_fsm_inst_dispatch(sgsn_bvc->fi, BSSGP_BVCFSM_E_RX_UNBLOCK_ACK, msg);
Daniel Willmann8489e7a2020-11-03 21:12:42 +01001009 break;
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +02001010 case BSSGP_PDUT_FLUSH_LL:
1011 /* simple case: BVCI IE is mandatory */
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +02001012 bvci = ntohs(tlvp_val16_unal(&tp, BSSGP_IE_BVCI));
Harald Weltee5209642020-12-05 19:59:45 +01001013 sgsn_bvc = gbproxy_bvc_by_bvci(nse, bvci);
1014 if (!sgsn_bvc)
1015 goto err_no_bvc;
1016 if (sgsn_bvc->cell && sgsn_bvc->cell->bss_bvc)
1017 rc = gbprox_relay2peer(msg, sgsn_bvc->cell->bss_bvc, ns_bvci);
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +02001018 break;
1019 case BSSGP_PDUT_PAGING_PS:
1020 case BSSGP_PDUT_PAGING_CS:
1021 /* process the paging request (LAI/RAI lookup) */
Harald Weltee5209642020-12-05 19:59:45 +01001022 rc = gbprox_rx_paging(nse, msg, pdut_name, &tp, ns_bvci);
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +02001023 break;
1024 case BSSGP_PDUT_STATUS:
1025 /* Some exception has occurred */
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +02001026 cause = *TLVP_VAL(&tp, BSSGP_IE_CAUSE);
Harald Weltee5209642020-12-05 19:59:45 +01001027 LOGPNSE(nse, LOGL_NOTICE, "Rx STATUS cause=0x%02x(%s) ", cause,
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +02001028 bssgp_cause_str(cause));
Harald Welte173a1822020-12-03 15:36:59 +01001029 if (TLVP_PRES_LEN(&tp, BSSGP_IE_BVCI, 2)) {
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +02001030 bvci = ntohs(tlvp_val16_unal(&tp, BSSGP_IE_BVCI));
Daniel Willmann3696dce2020-12-02 16:08:02 +01001031 LOGPC(DGPRS, LOGL_NOTICE, "BVCI=%05u\n", bvci);
Harald Weltee5209642020-12-05 19:59:45 +01001032 sgsn_bvc = gbproxy_bvc_by_bvci(nse, bvci);
1033 /* don't send STATUS in response to STATUS if !bvc */
1034 if (sgsn_bvc && sgsn_bvc->cell && sgsn_bvc->cell->bss_bvc)
1035 rc = gbprox_relay2peer(msg, sgsn_bvc->cell->bss_bvc, ns_bvci);
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +02001036 } else
1037 LOGPC(DGPRS, LOGL_NOTICE, "\n");
1038 break;
1039 /* those only exist in the SGSN -> BSS direction */
1040 case BSSGP_PDUT_SUSPEND_ACK:
1041 case BSSGP_PDUT_SUSPEND_NACK:
1042 case BSSGP_PDUT_RESUME_ACK:
1043 case BSSGP_PDUT_RESUME_NACK:
Harald Weltee5209642020-12-05 19:59:45 +01001044 /* FIXME: handle based on TLLI cache. The RA-ID is not a unique
1045 * criterion, so we have to rely on the TLLI->BVC state created
1046 * while processing the SUSPEND/RESUME in uplink */
1047 /* FIXME: route to SGSN baed on NRI derived from TLLI */
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +02001048 break;
1049 case BSSGP_PDUT_SGSN_INVOKE_TRACE:
Harald Welte7479c4d2020-12-02 20:06:04 +01001050 case BSSGP_PDUT_OVERLOAD:
Harald Weltee5209642020-12-05 19:59:45 +01001051 LOGPNSE(nse, LOGL_DEBUG, "Rx %s: broadcasting\n", pdut_name);
Harald Welte560bdb32020-12-04 22:24:47 +01001052 /* broadcast to all BSS-side bvcs */
Harald Welted2fef952020-12-05 00:31:07 +01001053 hash_for_each(cfg->bss_nses, i, nse, list) {
Harald Welte7479c4d2020-12-02 20:06:04 +01001054 gbprox_relay2nse(msg, nse, 0);
1055 }
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +02001056 break;
Harald Weltee5209642020-12-05 19:59:45 +01001057 case BSSGP_PDUT_RAN_INFO:
1058 case BSSGP_PDUT_RAN_INFO_REQ:
1059 case BSSGP_PDUT_RAN_INFO_ACK:
1060 case BSSGP_PDUT_RAN_INFO_ERROR:
1061 case BSSGP_PDUT_RAN_INFO_APP_ERROR:
1062 /* FIXME: route based in RIM Routing IE */
Harald Weltedbef0aa2020-12-07 17:48:11 +01001063 rc = bssgp_tx_status(BSSGP_CAUSE_PDU_INCOMP_FEAT, NULL, msg);
Harald Weltee5209642020-12-05 19:59:45 +01001064 break;
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +02001065 default:
Harald Weltee5209642020-12-05 19:59:45 +01001066 LOGPNSE(nse, LOGL_NOTICE, "Rx %s: Not supported\n", pdut_name);
1067 rate_ctr_inc(&cfg->ctrg->ctr[GBPROX_GLOB_CTR_PROTO_ERR_SGSN]);
Harald Weltedbef0aa2020-12-07 17:48:11 +01001068 rc = bssgp_tx_status(BSSGP_CAUSE_PROTO_ERR_UNSPEC, NULL, msg);
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +02001069 break;
1070 }
1071
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +02001072 return rc;
Harald Weltee5209642020-12-05 19:59:45 +01001073
Harald Welte560bdb32020-12-04 22:24:47 +01001074err_no_bvc:
Harald Weltee5209642020-12-05 19:59:45 +01001075 LOGPNSE(nse, LOGL_ERROR, "Rx %s: Cannot find BVC\n", pdut_name);
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +02001076 rate_ctr_inc(&cfg->ctrg-> ctr[GBPROX_GLOB_CTR_INV_RAI]);
Harald Weltedbef0aa2020-12-07 17:48:11 +01001077 return bssgp_tx_status(BSSGP_CAUSE_INV_MAND_INF, NULL, msg);
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +02001078}
1079
Harald Weltee5209642020-12-05 19:59:45 +01001080
1081/***********************************************************************
1082 * libosmogb NS/BSSGP integration
1083 ***********************************************************************/
1084
Alexander Couzens951e1332020-09-22 13:21:46 +02001085int gbprox_bssgp_send_cb(void *ctx, struct msgb *msg)
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +02001086{
1087 int rc;
Alexander Couzens951e1332020-09-22 13:21:46 +02001088 struct gbproxy_config *cfg = (struct gbproxy_config *) ctx;
1089 struct gprs_ns2_inst *nsi = cfg->nsi;
1090 struct osmo_gprs_ns2_prim nsp = {};
1091
1092 nsp.bvci = msgb_bvci(msg);
1093 nsp.nsei = msgb_nsei(msg);
1094
1095 osmo_prim_init(&nsp.oph, SAP_NS, PRIM_NS_UNIT_DATA, PRIM_OP_REQUEST, msg);
1096 rc = gprs_ns2_recv_prim(nsi, &nsp.oph);
1097
1098 return rc;
1099}
1100
1101/* Main input function for Gb proxy */
1102int gbprox_rcvmsg(void *ctx, struct msgb *msg)
1103{
Alexander Couzens951e1332020-09-22 13:21:46 +02001104 struct gbproxy_config *cfg = (struct gbproxy_config *) ctx;
Harald Weltee5209642020-12-05 19:59:45 +01001105 uint16_t ns_bvci = msgb_bvci(msg);
1106 uint16_t nsei = msgb_nsei(msg);
1107 struct gbproxy_nse *nse;
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +02001108
Harald Welte278dd272020-12-06 13:35:24 +01001109 /* ensure minimum length to decode PCU type */
1110 if (msgb_bssgp_len(msg) < sizeof(struct bssgp_normal_hdr))
1111 return bssgp_tx_status(BSSGP_CAUSE_SEM_INCORR_PDU, NULL, msg);
1112
Harald Weltee5209642020-12-05 19:59:45 +01001113 nse = gbproxy_nse_by_nsei(cfg, nsei, NSE_F_SGSN);
1114 if (nse) {
1115 if (ns_bvci == 0 || ns_bvci == 1)
1116 return gbprox_rx_sig_from_sgsn(nse, msg, ns_bvci);
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +02001117 else
Harald Weltee5209642020-12-05 19:59:45 +01001118 return gbprox_rx_ptp_from_sgsn(nse, msg, ns_bvci);
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +02001119 }
1120
Harald Weltee5209642020-12-05 19:59:45 +01001121 nse = gbproxy_nse_by_nsei(cfg, nsei, NSE_F_BSS);
1122 if (!nse) {
1123 LOGP(DGPRS, LOGL_NOTICE, "NSE(%05u/BSS) not known -> allocating\n", nsei);
1124 nse = gbproxy_nse_alloc(cfg, nsei, false);
1125 }
1126 if (nse) {
1127 if (ns_bvci == 0 || ns_bvci == 1)
1128 return gbprox_rx_sig_from_bss(nse, msg, ns_bvci);
1129 else
1130 return gbprox_rx_ptp_from_bss(nse, msg, ns_bvci);
1131 }
1132
1133 return 0;
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +02001134}
1135
Alexander Couzens951e1332020-09-22 13:21:46 +02001136/* TODO: What about handling:
1137 * NS_AFF_CAUSE_VC_FAILURE,
1138 NS_AFF_CAUSE_VC_RECOVERY,
1139 NS_AFF_CAUSE_FAILURE,
1140 NS_AFF_CAUSE_RECOVERY,
1141 osmocom own causes
1142 NS_AFF_CAUSE_SNS_CONFIGURED,
1143 NS_AFF_CAUSE_SNS_FAILURE,
1144 */
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +02001145
Alexander Couzens951e1332020-09-22 13:21:46 +02001146void gprs_ns_prim_status_cb(struct gbproxy_config *cfg, struct osmo_gprs_ns2_prim *nsp)
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +02001147{
Harald Welte560bdb32020-12-04 22:24:47 +01001148 /* TODO: bss nsei available/unavailable bssgp_tx_simple_bvci(BSSGP_PDUT_BVC_BLOCK, nsvc->nsei, bvc->bvci, 0);
Alexander Couzens951e1332020-09-22 13:21:46 +02001149 * TODO: sgsn nsei available/unavailable
1150 */
Harald Weltee5209642020-12-05 19:59:45 +01001151
Harald Welte560bdb32020-12-04 22:24:47 +01001152 struct gbproxy_bvc *bvc;
Harald Weltee5209642020-12-05 19:59:45 +01001153 struct gbproxy_nse *sgsn_nse;
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +02001154
Alexander Couzens951e1332020-09-22 13:21:46 +02001155 switch (nsp->u.status.cause) {
1156 case NS_AFF_CAUSE_SNS_FAILURE:
1157 case NS_AFF_CAUSE_SNS_CONFIGURED:
1158 break;
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +02001159
Alexander Couzens951e1332020-09-22 13:21:46 +02001160 case NS_AFF_CAUSE_RECOVERY:
1161 LOGP(DPCU, LOGL_NOTICE, "NS-NSE %d became available\n", nsp->nsei);
Harald Weltee5209642020-12-05 19:59:45 +01001162 sgsn_nse = gbproxy_nse_by_nsei(cfg, nsp->nsei, NSE_F_SGSN);
1163 if (sgsn_nse) {
1164 uint8_t cause = BSSGP_CAUSE_OML_INTERV;
1165 bvc = gbproxy_bvc_by_bvci(sgsn_nse, 0);
1166 if (bvc)
1167 osmo_fsm_inst_dispatch(bvc->fi, BSSGP_BVCFSM_E_REQ_RESET, &cause);
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +02001168 }
Alexander Couzens951e1332020-09-22 13:21:46 +02001169 break;
1170 case NS_AFF_CAUSE_FAILURE:
Harald Weltee5209642020-12-05 19:59:45 +01001171#if 0
Harald Weltea0f70732020-12-05 17:50:23 +01001172 if (gbproxy_is_sgsn_nsei(cfg, nsp->nsei)) {
Alexander Couzens951e1332020-09-22 13:21:46 +02001173 /* sgsn */
1174 /* TODO: BSVC: block all PtP towards bss */
1175 rate_ctr_inc(&cfg->ctrg->
1176 ctr[GBPROX_GLOB_CTR_RESTART_RESET_SGSN]);
1177 } else {
Daniel Willmanne50550e2020-11-26 18:19:21 +01001178 /* bss became unavailable
1179 * TODO: Block all BVC belonging to that NSE */
Harald Welte560bdb32020-12-04 22:24:47 +01001180 bvc = gbproxy_bvc_by_nsei(cfg, nsp->nsei);
1181 if (!bvc) {
Alexander Couzens951e1332020-09-22 13:21:46 +02001182 /* TODO: use primitive name + status cause name */
Harald Welte560bdb32020-12-04 22:24:47 +01001183 LOGP(DGPRS, LOGL_NOTICE, "Received ns2 primitive %d for unknown bvc NSEI=%u\n",
Alexander Couzens951e1332020-09-22 13:21:46 +02001184 nsp->u.status.cause, nsp->nsei);
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +02001185 break;
1186 }
Alexander Couzens951e1332020-09-22 13:21:46 +02001187
Harald Welte560bdb32020-12-04 22:24:47 +01001188 if (!bvc->blocked)
Alexander Couzens951e1332020-09-22 13:21:46 +02001189 break;
Harald Weltee5209642020-12-05 19:59:45 +01001190 hash_for_each(cfg->sgsn_nses, _sgsn, sgsn_nse, list) {
1191 bssgp_tx_simple_bvci(BSSGP_PDUT_BVC_BLOCK, sgsn_nse->nsei, bvc->bvci, 0);
1192 }
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +02001193 }
Harald Weltee5209642020-12-05 19:59:45 +01001194#endif
Alexander Couzens951e1332020-09-22 13:21:46 +02001195 LOGP(DPCU, LOGL_NOTICE, "NS-NSE %d became unavailable\n", nsp->nsei);
1196 break;
1197 default:
Harald Welte95cf9fb2020-11-30 10:55:22 +01001198 LOGP(DPCU, LOGL_NOTICE, "NS: Unknown NS-STATUS.ind cause=%s from NS\n",
1199 gprs_ns2_aff_cause_prim_str(nsp->u.status.cause));
Alexander Couzens951e1332020-09-22 13:21:46 +02001200 break;
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +02001201 }
Alexander Couzens951e1332020-09-22 13:21:46 +02001202}
1203
Alexander Couzens951e1332020-09-22 13:21:46 +02001204/* called by the ns layer */
1205int gprs_ns2_prim_cb(struct osmo_prim_hdr *oph, void *ctx)
1206{
1207 struct osmo_gprs_ns2_prim *nsp;
1208 struct gbproxy_config *cfg = (struct gbproxy_config *) ctx;
Daniel Willmann8f407b12020-12-02 19:33:50 +01001209 uintptr_t bvci;
Alexander Couzens951e1332020-09-22 13:21:46 +02001210 int rc = 0;
1211
1212 if (oph->sap != SAP_NS)
1213 return 0;
1214
1215 nsp = container_of(oph, struct osmo_gprs_ns2_prim, oph);
1216
1217 if (oph->operation != PRIM_OP_INDICATION) {
Harald Welte95cf9fb2020-11-30 10:55:22 +01001218 LOGP(DPCU, LOGL_NOTICE, "NS: Unexpected primitive operation %s from NS\n",
1219 get_value_string(osmo_prim_op_names, oph->operation));
Alexander Couzens951e1332020-09-22 13:21:46 +02001220 return 0;
1221 }
1222
1223 switch (oph->primitive) {
1224 case PRIM_NS_UNIT_DATA:
Daniel Willmann8f407b12020-12-02 19:33:50 +01001225
Alexander Couzens951e1332020-09-22 13:21:46 +02001226 /* hand the message into the BSSGP implementation */
1227 msgb_bssgph(oph->msg) = oph->msg->l3h;
1228 msgb_bvci(oph->msg) = nsp->bvci;
1229 msgb_nsei(oph->msg) = nsp->nsei;
Daniel Willmann8f407b12020-12-02 19:33:50 +01001230 bvci = nsp->bvci | BVC_LOG_CTX_FLAG;
Alexander Couzens951e1332020-09-22 13:21:46 +02001231
Daniel Willmann8f407b12020-12-02 19:33:50 +01001232 log_set_context(LOG_CTX_GB_BVC, (void *)bvci);
Alexander Couzens951e1332020-09-22 13:21:46 +02001233 rc = gbprox_rcvmsg(cfg, oph->msg);
Daniel Willmannb6550102020-11-04 17:32:56 +01001234 msgb_free(oph->msg);
Alexander Couzens951e1332020-09-22 13:21:46 +02001235 break;
1236 case PRIM_NS_STATUS:
1237 gprs_ns_prim_status_cb(cfg, nsp);
1238 break;
1239 default:
Harald Welte95cf9fb2020-11-30 10:55:22 +01001240 LOGP(DPCU, LOGL_NOTICE, "NS: Unknown prim %s %s from NS\n",
1241 gprs_ns2_prim_str(oph->primitive),
1242 get_value_string(osmo_prim_op_names, oph->operation));
Alexander Couzens951e1332020-09-22 13:21:46 +02001243 break;
1244 }
1245
1246 return rc;
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +02001247}
1248
1249void gbprox_reset(struct gbproxy_config *cfg)
1250{
Harald Welted2fef952020-12-05 00:31:07 +01001251 struct gbproxy_nse *nse;
1252 struct hlist_node *ntmp;
Harald Welte8b4c7942020-12-05 10:14:49 +01001253 int i, j;
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +02001254
Harald Welted2fef952020-12-05 00:31:07 +01001255 hash_for_each_safe(cfg->bss_nses, i, ntmp, nse, list) {
Harald Welte8b4c7942020-12-05 10:14:49 +01001256 struct gbproxy_bvc *bvc;
1257 struct hlist_node *tmp;
1258 hash_for_each_safe(nse->bvcs, j, tmp, bvc, list)
Harald Welte560bdb32020-12-04 22:24:47 +01001259 gbproxy_bvc_free(bvc);
Daniel Willmanne50550e2020-11-26 18:19:21 +01001260
1261 gbproxy_nse_free(nse);
1262 }
Harald Weltee5209642020-12-05 19:59:45 +01001263 /* FIXME: cells */
1264 /* FIXME: SGSN side BVCs (except signaling) */
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +02001265
1266 rate_ctr_group_free(cfg->ctrg);
1267 gbproxy_init_config(cfg);
1268}
1269
1270int gbproxy_init_config(struct gbproxy_config *cfg)
1271{
1272 struct timespec tp;
1273
Harald Welted2fef952020-12-05 00:31:07 +01001274 hash_init(cfg->bss_nses);
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +02001275 cfg->ctrg = rate_ctr_group_alloc(tall_sgsn_ctx, &global_ctrg_desc, 0);
1276 if (!cfg->ctrg) {
1277 LOGP(DGPRS, LOGL_ERROR, "Cannot allocate global counter group!\n");
1278 return -1;
1279 }
1280 osmo_clock_gettime(CLOCK_REALTIME, &tp);
Harald Weltec169de42020-12-07 13:12:13 +01001281 osmo_fsm_log_timeouts(true);
Pau Espin Pedrol1ddefb12019-08-30 19:48:34 +02001282
1283 return 0;
1284}