blob: 2026d1a0356ad52a8a1d37bc2d229a8683356d4f [file] [log] [blame]
Harald Welte9f75c352010-04-30 20:26:32 +02001/* NS-over-IP proxy */
2
3/* (C) 2010 by Harald Welte <laforge@gnumonks.org>
Holger Hans Peter Freyther90267a92013-10-23 11:24:17 +02004 * (C) 2010-2013 by On-Waves
5 * (C) 2013 by Holger Hans Peter Freyther
Harald Welte9f75c352010-04-30 20:26:32 +02006 * All Rights Reserved
7 *
8 * This program is free software; you can redistribute it and/or modify
Harald Welte9af6ddf2011-01-01 15:25:50 +01009 * 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
Harald Welte9f75c352010-04-30 20:26:32 +020011 * (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
Harald Welte9af6ddf2011-01-01 15:25:50 +010016 * GNU Affero General Public License for more details.
Harald Welte9f75c352010-04-30 20:26:32 +020017 *
Harald Welte9af6ddf2011-01-01 15:25:50 +010018 * 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/>.
Harald Welte9f75c352010-04-30 20:26:32 +020020 *
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>
Harald Welte7fc98222010-05-11 10:15:42 +020031#include <arpa/inet.h>
Jacob Erlbeck7c101d92014-06-06 18:49:23 +020032#include <time.h>
Harald Welte9f75c352010-04-30 20:26:32 +020033
Pablo Neira Ayuso136f4532011-03-22 16:47:59 +010034#include <osmocom/core/talloc.h>
35#include <osmocom/core/select.h>
Jacob Erlbeckbc555742013-10-18 14:34:55 +020036#include <osmocom/core/rate_ctr.h>
37
Harald Welteea34a4e2012-06-16 14:59:56 +080038#include <osmocom/gprs/gprs_ns.h>
39#include <osmocom/gprs/gprs_bssgp.h>
40
Jacob Erlbeck7c101d92014-06-06 18:49:23 +020041#include <osmocom/gsm/gsm_utils.h>
42
Harald Welte9f75c352010-04-30 20:26:32 +020043#include <openbsc/signal.h>
44#include <openbsc/debug.h>
Jacob Erlbeck9114bee2014-08-19 12:21:01 +020045#include <openbsc/gprs_gb_parse.h>
Harald Welte672f5c42010-05-03 18:54:58 +020046#include <openbsc/gb_proxy.h>
Harald Welte9f75c352010-04-30 20:26:32 +020047
Jacob Erlbeck67a44452014-05-19 10:14:58 +020048#include <openbsc/gprs_llc.h>
49#include <openbsc/gsm_04_08.h>
50#include <openbsc/gsm_04_08_gprs.h>
Holger Hans Peter Freyther7127b022014-08-04 11:52:52 +020051#include <openbsc/gprs_utils.h>
Jacob Erlbeck67a44452014-05-19 10:14:58 +020052
Jacob Erlbeckbc555742013-10-18 14:34:55 +020053static const struct rate_ctr_desc global_ctr_description[] = {
54 { "inv-bvci", "Invalid BVC Identifier " },
Jacob Erlbeck8f503592014-06-02 10:49:00 +020055 { "inv-lai", "Invalid Location Area Identifier" },
56 { "inv-rai", "Invalid Routing Area Identifier " },
Jacob Erlbeckbc555742013-10-18 14:34:55 +020057 { "inv-nsei", "No BVC established for NSEI " },
58 { "proto-err.bss", "BSSGP protocol error (BSS )" },
59 { "proto-err.sgsn", "BSSGP protocol error (SGSN)" },
60 { "not-supp.bss", "Feature not supported (BSS )" },
61 { "not-supp.sgsn", "Feature not supported (SGSN)" },
62 { "restart.sgsn", "Restarted RESET procedure (SGSN)" },
63 { "tx-err.sgsn", "NS Transmission error (SGSN)" },
64 { "error", "Other error " },
Jacob Erlbeck006c0382014-05-27 13:49:04 +020065 { "mod-peer-err", "Patch error: no peer " },
Jacob Erlbeckbc555742013-10-18 14:34:55 +020066};
67
68static const struct rate_ctr_group_desc global_ctrg_desc = {
69 .group_name_prefix = "gbproxy.global",
70 .group_description = "GBProxy Global Statistics",
71 .num_ctr = ARRAY_SIZE(global_ctr_description),
72 .ctr_desc = global_ctr_description,
73};
74
Jacob Erlbeck5f4ef322014-08-22 17:10:01 +020075static int gbprox_relay2peer(struct msgb *old_msg, struct gbproxy_peer *peer,
76 uint16_t ns_bvci);
77static int gbprox_relay2sgsn(struct gbproxy_config *cfg, struct msgb *old_msg,
Jacob Erlbeckf4d60c82014-08-26 14:47:15 +020078 uint16_t ns_bvci, uint16_t sgsn_nsei);
Jacob Erlbeck5f4ef322014-08-22 17:10:01 +020079
Holger Hans Peter Freyther1ddd9e52014-08-04 11:35:32 +020080static int check_peer_nsei(struct gbproxy_peer *peer, uint16_t nsei)
Jacob Erlbeckbc555742013-10-18 14:34:55 +020081{
82 if (peer->nsei != nsei) {
83 LOGP(DGPRS, LOGL_NOTICE, "Peer entry doesn't match current NSEI "
84 "BVCI=%u via NSEI=%u (expected NSEI=%u)\n",
85 peer->bvci, nsei, peer->nsei);
86 rate_ctr_inc(&peer->ctrg->ctr[GBPROX_PEER_CTR_INV_NSEI]);
Jacob Erlbeck64cb9242013-10-24 12:48:56 +020087 return 0;
Jacob Erlbeckbc555742013-10-18 14:34:55 +020088 }
89
Jacob Erlbeck64cb9242013-10-24 12:48:56 +020090 return 1;
Jacob Erlbeckbc555742013-10-18 14:34:55 +020091}
92
Harald Welte69619e32010-05-03 19:05:10 +020093/* strip off the NS header */
94static void strip_ns_hdr(struct msgb *msg)
95{
96 int strip_len = msgb_bssgph(msg) - msg->data;
97 msgb_pull(msg, strip_len);
98}
99
Jacob Erlbeck5f4ef322014-08-22 17:10:01 +0200100/* Transmit Chapter 9.2.10 Identity Request */
101static void gprs_put_identity_req(struct msgb *msg, uint8_t id_type)
102{
103 struct gsm48_hdr *gh;
104
105 id_type &= GSM_MI_TYPE_MASK;
106
107 gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh) + 1);
108 gh->proto_discr = GSM48_PDISC_MM_GPRS;
109 gh->msg_type = GSM48_MT_GMM_ID_REQ;
110 gh->data[0] = id_type;
111}
112
113static void gprs_push_llc_ui(struct msgb *msg,
114 int is_uplink, unsigned sapi, unsigned nu)
115{
116 const uint8_t e_bit = 0;
117 const uint8_t pm_bit = 1;
118 const uint8_t cr_bit = is_uplink ? 0 : 1;
Jacob Erlbeck5f4ef322014-08-22 17:10:01 +0200119 uint8_t *llc;
120 uint8_t *fcs_field;
121 uint32_t fcs;
122
123 nu &= 0x01ff; /* 9 Bit */
124
125 llc = msgb_push(msg, 3);
126 llc[0] = (cr_bit << 6) | (sapi & 0x0f);
127 llc[1] = 0xc0 | (nu >> 6); /* UI frame */
128 llc[2] = (nu << 2) | ((e_bit & 1) << 1) | (pm_bit & 1);
129
130 fcs = gprs_llc_fcs(llc, msgb_length(msg));
131 fcs_field = msgb_put(msg, 3);
132 fcs_field[0] = (uint8_t)(fcs >> 0);
133 fcs_field[1] = (uint8_t)(fcs >> 8);
134 fcs_field[2] = (uint8_t)(fcs >> 16);
135}
136
137static void gprs_push_bssgp_dl_unitdata(struct msgb *msg,
138 uint32_t tlli)
139{
140 struct bssgp_ud_hdr *budh;
141 uint8_t *llc = msgb_data(msg);
142 size_t llc_size = msgb_length(msg);
143 const size_t llc_ie_hdr_size = 3;
144 const uint8_t qos_profile[] = {0x00, 0x50, 0x20}; /* hard-coded */
145 const uint8_t lifetime[] = {0x02, 0x58}; /* 6s hard-coded */
146
147 const size_t bssgp_overhead = sizeof(*budh) +
148 TVLV_GROSS_LEN(sizeof(lifetime)) + llc_ie_hdr_size;
149 uint8_t *ie;
150 uint32_t tlli_be = htonl(tlli);
151
152 budh = (struct bssgp_ud_hdr *)msgb_push(msg, bssgp_overhead);
153
154 budh->pdu_type = BSSGP_PDUT_DL_UNITDATA;
155 memcpy(&budh->tlli, &tlli_be, sizeof(budh->tlli));
156 memcpy(&budh->qos_profile, qos_profile, sizeof(budh->qos_profile));
157
158 ie = budh->data;
159 tvlv_put(ie, BSSGP_IE_PDU_LIFETIME, sizeof(lifetime), lifetime);
160 ie += TVLV_GROSS_LEN(sizeof(lifetime));
161
162 /* Note: Add alignment before the LLC IE if inserting other IE */
163
164 *(ie++) = BSSGP_IE_LLC_PDU;
165 *(ie++) = llc_size / 256;
166 *(ie++) = llc_size % 256;
167
168 OSMO_ASSERT(ie == llc);
169
170 msgb_bssgph(msg) = (uint8_t *)budh;
171 msgb_tlli(msg) = tlli;
172}
173
Jacob Erlbeck12496dd2014-08-18 15:41:41 +0200174/* update peer according to the BSS message */
175static void gbprox_update_current_raid(uint8_t *raid_enc,
176 struct gbproxy_peer *peer,
177 const char *log_text)
Jacob Erlbeck67a44452014-05-19 10:14:58 +0200178{
Holger Hans Peter Freyther1ddd9e52014-08-04 11:35:32 +0200179 struct gbproxy_patch_state *state = &peer->patch_state;
Jacob Erlbeck67a44452014-05-19 10:14:58 +0200180 const int old_local_mcc = state->local_mcc;
181 const int old_local_mnc = state->local_mnc;
Jacob Erlbeck12496dd2014-08-18 15:41:41 +0200182 struct gprs_ra_id raid;
183
184 if (!raid_enc)
185 return;
186
187 gsm48_parse_ra(&raid, raid_enc);
188
189 /* save source side MCC/MNC */
190 if (!peer->cfg->core_mcc || raid.mcc == peer->cfg->core_mcc) {
191 state->local_mcc = 0;
192 } else {
193 state->local_mcc = raid.mcc;
194 }
195
196 if (!peer->cfg->core_mnc || raid.mnc == peer->cfg->core_mnc) {
197 state->local_mnc = 0;
198 } else {
199 state->local_mnc = raid.mnc;
200 }
201
202 if (old_local_mcc != state->local_mcc ||
203 old_local_mnc != state->local_mnc)
204 LOGP(DGPRS, LOGL_NOTICE,
205 "Patching RAID %sactivated, msg: %s, "
206 "local: %d-%d, core: %d-%d\n",
207 state->local_mcc || state->local_mnc ?
208 "" : "de",
209 log_text,
210 state->local_mcc, state->local_mnc,
211 peer->cfg->core_mcc, peer->cfg->core_mnc);
212}
213
Jacob Erlbeck9114bee2014-08-19 12:21:01 +0200214uint32_t gbproxy_make_bss_ptmsi(struct gbproxy_peer *peer,
215 uint32_t sgsn_ptmsi)
Jacob Erlbeck9057bc32014-08-12 16:30:30 +0200216{
Jacob Erlbeck0d376712014-08-11 19:12:24 +0200217 uint32_t bss_ptmsi;
218 if (!peer->cfg->patch_ptmsi) {
219 bss_ptmsi = sgsn_ptmsi;
220 } else {
221 do {
222 bss_ptmsi = rand_r(&peer->cfg->bss_ptmsi_state);
223 bss_ptmsi = bss_ptmsi | 0xC0000000;
224
Jacob Erlbeck9114bee2014-08-19 12:21:01 +0200225 if (gbproxy_find_tlli_by_ptmsi(peer, bss_ptmsi))
Jacob Erlbeck0d376712014-08-11 19:12:24 +0200226 bss_ptmsi = GSM_RESERVED_TMSI;
227 } while (bss_ptmsi == GSM_RESERVED_TMSI);
228 }
229
230 return bss_ptmsi;
Jacob Erlbeck9057bc32014-08-12 16:30:30 +0200231}
232
Jacob Erlbeck9114bee2014-08-19 12:21:01 +0200233uint32_t gbproxy_make_sgsn_tlli(struct gbproxy_peer *peer,
234 struct gbproxy_tlli_info *tlli_info,
235 uint32_t bss_tlli)
Jacob Erlbeck9057bc32014-08-12 16:30:30 +0200236{
Jacob Erlbeck0d376712014-08-11 19:12:24 +0200237 uint32_t sgsn_tlli;
238 if (!peer->cfg->patch_ptmsi) {
239 sgsn_tlli = bss_tlli;
240 } else if (tlli_info->sgsn_tlli.ptmsi != GSM_RESERVED_TMSI) {
241 sgsn_tlli = gprs_tmsi2tlli(tlli_info->sgsn_tlli.ptmsi,
242 TLLI_FOREIGN);
243 } else {
244 do {
245 /* create random TLLI, 0b01111xxx... */
246 sgsn_tlli = rand_r(&peer->cfg->sgsn_tlli_state);
247 sgsn_tlli = (sgsn_tlli & 0x7fffffff) | 0x78000000;
248
Jacob Erlbeck9114bee2014-08-19 12:21:01 +0200249 if (gbproxy_find_tlli_by_sgsn_tlli(peer, sgsn_tlli))
Jacob Erlbeck0d376712014-08-11 19:12:24 +0200250 sgsn_tlli = 0;
251 } while (!sgsn_tlli);
252 }
253 return sgsn_tlli;
Jacob Erlbeck9057bc32014-08-12 16:30:30 +0200254}
255
Jacob Erlbeck9057bc32014-08-12 16:30:30 +0200256/* patch BSSGP message */
Jacob Erlbeck5f4ef322014-08-22 17:10:01 +0200257static int gbprox_process_bssgp_ul(struct gbproxy_config *cfg,
258 struct msgb *msg,
259 struct gbproxy_peer *peer)
Jacob Erlbeckc8128822014-08-07 16:07:24 +0200260{
Jacob Erlbeck9114bee2014-08-19 12:21:01 +0200261 struct gprs_gb_parse_context parse_ctx = {0};
Jacob Erlbeck2db25122014-08-06 12:41:31 +0200262 int rc;
Jacob Erlbeckc8128822014-08-07 16:07:24 +0200263 int len_change = 0;
Jacob Erlbeck7b821d02014-08-08 08:37:37 +0200264 time_t now;
Jacob Erlbeck9057bc32014-08-12 16:30:30 +0200265 struct gbproxy_tlli_info *tlli_info = NULL;
Jacob Erlbeckcabd24b2014-08-27 12:51:07 +0200266 uint32_t sgsn_nsei = cfg->nsip_sgsn_nsei;
267 int send_msg_directly = 0;
Jacob Erlbeck2db25122014-08-06 12:41:31 +0200268
Jacob Erlbeck5f4ef322014-08-22 17:10:01 +0200269 if (!cfg->core_mcc && !cfg->core_mnc && !cfg->core_apn &&
270 !cfg->acquire_imsi)
271 return 1;
Jacob Erlbeck2db25122014-08-06 12:41:31 +0200272
Jacob Erlbeck9057bc32014-08-12 16:30:30 +0200273 parse_ctx.to_bss = 0;
274
275 /* Parse BSSGP/LLC */
Jacob Erlbeck9114bee2014-08-19 12:21:01 +0200276 rc = gprs_gb_parse_bssgp(msgb_bssgph(msg), msgb_bssgp_len(msg),
277 &parse_ctx);
Jacob Erlbeck9057bc32014-08-12 16:30:30 +0200278
279 if (!rc) {
280 if (!parse_ctx.need_decryption) {
281 LOGP(DGPRS, LOGL_ERROR,
Jacob Erlbeck643d5222014-08-18 17:26:04 +0200282 "NSEI=%u(BSS) patching: "
283 "failed to parse BSSGP/GMM message\n",
284 msgb_nsei(msg));
Jacob Erlbeck5f4ef322014-08-22 17:10:01 +0200285 return 0;
Jacob Erlbeck9057bc32014-08-12 16:30:30 +0200286 }
287 }
288
289 /* Get peer */
290 if (!peer && msgb_bvci(msg) >= 2)
Jacob Erlbeck5f1faa32014-08-21 10:01:30 +0200291 peer = gbproxy_peer_by_bvci(cfg, msgb_bvci(msg));
Jacob Erlbeck9057bc32014-08-12 16:30:30 +0200292
293 if (!peer)
Jacob Erlbeck5f1faa32014-08-21 10:01:30 +0200294 peer = gbproxy_peer_by_nsei(cfg, msgb_nsei(msg));
Jacob Erlbeck9057bc32014-08-12 16:30:30 +0200295
296 if (!peer)
Jacob Erlbeck5f1faa32014-08-21 10:01:30 +0200297 peer = gbproxy_peer_by_bssgp_tlv(cfg, &parse_ctx.bssgp_tp);
Jacob Erlbeck9057bc32014-08-12 16:30:30 +0200298
299 if (!peer) {
300 LOGP(DLLC, LOGL_INFO,
301 "NSEI=%d(BSS) patching: didn't find peer for message, "
302 "PDU %d\n",
303 msgb_nsei(msg), parse_ctx.pdu_type);
304 /* Increment counter */
305 rate_ctr_inc(&cfg->ctrg->ctr[GBPROX_GLOB_CTR_PATCH_PEER_ERR]);
Jacob Erlbeck5f4ef322014-08-22 17:10:01 +0200306 return 0;
Jacob Erlbeck9057bc32014-08-12 16:30:30 +0200307 }
308
309 now = time(NULL);
310
Jacob Erlbeck12496dd2014-08-18 15:41:41 +0200311 if (parse_ctx.bssgp_raid_enc && parse_ctx.old_raid_enc &&
312 memcmp(parse_ctx.bssgp_raid_enc, parse_ctx.old_raid_enc, 6) == 0)
313 parse_ctx.old_raid_matches = 1;
314
315 gbprox_update_current_raid(parse_ctx.bssgp_raid_enc, peer,
316 parse_ctx.llc_msg_name);
317
Jacob Erlbeck9114bee2014-08-19 12:21:01 +0200318 if (parse_ctx.g48_hdr) {
319 switch (parse_ctx.g48_hdr->msg_type) {
320 case GSM48_MT_GMM_ATTACH_REQ:
321 rate_ctr_inc(&peer->ctrg->ctr[GBPROX_PEER_CTR_ATTACH_REQS]);
322 break;
Jacob Erlbeck9057bc32014-08-12 16:30:30 +0200323
Jacob Erlbeck9114bee2014-08-19 12:21:01 +0200324 default:
325 break;
326 }
327 }
Jacob Erlbeck9057bc32014-08-12 16:30:30 +0200328
Jacob Erlbeck9114bee2014-08-19 12:21:01 +0200329 gprs_gb_log_parse_context(&parse_ctx, "BSSGP");
330
331 tlli_info = gbproxy_update_tlli_state_ul(peer, now, &parse_ctx);
332
Jacob Erlbeckcabd24b2014-08-27 12:51:07 +0200333 if (tlli_info && tlli_info->enable_patching && cfg->route_to_sgsn2) {
334 sgsn_nsei = cfg->nsip_sgsn2_nsei;
335 send_msg_directly = 1;
336 }
337
Jacob Erlbeck5f4ef322014-08-22 17:10:01 +0200338 if (tlli_info && tlli_info->imsi_acq_pending && parse_ctx.g48_hdr &&
339 parse_ctx.g48_hdr->proto_discr == GSM48_PDISC_MM_GPRS &&
340 parse_ctx.g48_hdr->msg_type == GSM48_MT_GMM_ID_RESP &&
341 parse_ctx.imsi_len > 0) {
342 struct msgb *stored_msg;
343 /* Got identity response with IMSI, assuming the request had
344 * been generated by the gbproxy */
345
346 LOGP(DLLC, LOGL_DEBUG,
347 "NSEI=%d(BSS) IMSI acquisition succeeded, "
348 "flushing stored messages\n",
349 msgb_nsei(msg));
350
351 /* TODO: Patch and flush stored messages towards the SGSN */
352 while ((stored_msg = msgb_dequeue(&tlli_info->stored_msgs))) {
353 struct gprs_gb_parse_context tmp_parse_ctx = {0};
354 tmp_parse_ctx.to_bss = 0;
355 len_change = 0;
356
357 gprs_gb_parse_bssgp(msgb_bssgph(stored_msg),
358 msgb_bssgp_len(stored_msg),
359 &tmp_parse_ctx);
360 gbproxy_patch_bssgp(msg, msgb_bssgph(stored_msg),
361 msgb_bssgp_len(stored_msg),
362 peer, tlli_info, &len_change,
363 &tmp_parse_ctx);
364
365 gbproxy_update_tlli_state_after(peer, tlli_info, now,
366 &tmp_parse_ctx);
367
Jacob Erlbeckf4d60c82014-08-26 14:47:15 +0200368 rc = gbprox_relay2sgsn(cfg, stored_msg, msgb_bvci(msg),
Jacob Erlbeckcabd24b2014-08-27 12:51:07 +0200369 sgsn_nsei);
Jacob Erlbeck5f4ef322014-08-22 17:10:01 +0200370
371 if (rc < 0)
372 LOGP(DLLC, LOGL_ERROR,
373 "NSEI=%d(BSS) failed to send stored message "
374 "(%s)\n",
375 msgb_nsei(msg),
376 parse_ctx.llc_msg_name ? parse_ctx.llc_msg_name : "BSSGP");
377 msgb_free(stored_msg);
378 }
379
380 tlli_info->imsi_acq_pending = 0;
381
382 return 0;
383 }
384
385 if (tlli_info && tlli_info->imsi_acq_pending) {
386 struct msgb *stored_msg;
387
388 LOGP(DLLC, LOGL_DEBUG,
389 "NSEI=%d(BSS) IMSI acquisition in progess, "
390 "storing message (%s)\n",
391 msgb_nsei(msg),
392 parse_ctx.llc_msg_name ? parse_ctx.llc_msg_name : "BSSGP");
393
394 /* Enqueue unpatched messages */
395 stored_msg = gprs_msgb_copy(msg, "process_bssgp_ul");
396 msgb_enqueue(&tlli_info->stored_msgs, stored_msg);
397
398 /* TODO: Timeout, retransmit IDENT REQ if expired */
399 return 0;
400 }
401
402 if (cfg->acquire_imsi && tlli_info && tlli_info->mi_data_len == 0) {
403 struct msgb *idreq_msg;
404 struct msgb *stored_msg = gprs_msgb_copy(msg, "process_bssgp_ul");
405
406 LOGP(DLLC, LOGL_DEBUG,
407 "NSEI=%d(BSS) IMSI is required but not available, "
408 "storing message (%s)\n",
409 msgb_nsei(msg),
410 parse_ctx.llc_msg_name ? parse_ctx.llc_msg_name : "BSSGP");
411
412 /* Enqueue message */
413 msgb_enqueue(&tlli_info->stored_msgs, stored_msg);
414
415 /* Send IDENT REQ */
416 idreq_msg = gsm48_msgb_alloc();
417 gprs_put_identity_req(idreq_msg, GSM_MI_TYPE_IMSI);
418 gprs_push_llc_ui(idreq_msg, 0, GPRS_SAPI_GMM,
419 /* TODO: use a real N(U) */0);
420 gprs_push_bssgp_dl_unitdata(idreq_msg, tlli_info->tlli.current);
421 gbprox_relay2peer(idreq_msg, peer, msgb_bvci(msg));
422 msgb_free(idreq_msg);
423
424 tlli_info->imsi_acq_pending = 1;
425
426 return 0;
427 }
428
429
Jacob Erlbeck9114bee2014-08-19 12:21:01 +0200430 gbproxy_patch_bssgp(msg, msgb_bssgph(msg), msgb_bssgp_len(msg),
431 peer, tlli_info, &len_change, &parse_ctx);
432
433 gbproxy_update_tlli_state_after(peer, tlli_info, now, &parse_ctx);
Jacob Erlbeck9057bc32014-08-12 16:30:30 +0200434
Jacob Erlbeckcabd24b2014-08-27 12:51:07 +0200435 if (send_msg_directly) {
436 /* Send message directly to the selected SGSN */
437 rc = gbprox_relay2sgsn(cfg, msg, msgb_bvci(msg), sgsn_nsei);
438 /* Don't let the calling code handle the transmission */
439 return 0;
440 }
441
Jacob Erlbeck5f4ef322014-08-22 17:10:01 +0200442 return 1;
Jacob Erlbeck9057bc32014-08-12 16:30:30 +0200443}
444
445/* patch BSSGP message to use core_mcc/mnc on the SGSN side */
446static void gbprox_process_bssgp_dl(struct gbproxy_config *cfg,
447 struct msgb *msg,
448 struct gbproxy_peer *peer)
449{
Jacob Erlbeck9114bee2014-08-19 12:21:01 +0200450 struct gprs_gb_parse_context parse_ctx = {0};
Jacob Erlbeck9057bc32014-08-12 16:30:30 +0200451 int rc;
452 int len_change = 0;
453 time_t now;
454 struct gbproxy_tlli_info *tlli_info = NULL;
455
456 parse_ctx.to_bss = 1;
Jacob Erlbeck2db25122014-08-06 12:41:31 +0200457
Jacob Erlbeck9114bee2014-08-19 12:21:01 +0200458 rc = gprs_gb_parse_bssgp(msgb_bssgph(msg), msgb_bssgp_len(msg),
459 &parse_ctx);
Jacob Erlbeck2db25122014-08-06 12:41:31 +0200460
461 if (!rc) {
462 if (!parse_ctx.need_decryption) {
463 LOGP(DGPRS, LOGL_ERROR,
Jacob Erlbeck643d5222014-08-18 17:26:04 +0200464 "NSEI=%u(SGSN) patching: "
465 "failed to parse BSSGP/GMM message\n",
466 msgb_nsei(msg));
Jacob Erlbeck2db25122014-08-06 12:41:31 +0200467 return;
468 }
469 }
Jacob Erlbeck67a44452014-05-19 10:14:58 +0200470
Jacob Erlbeck006c0382014-05-27 13:49:04 +0200471 if (!peer && msgb_bvci(msg) >= 2)
Jacob Erlbeck5f1faa32014-08-21 10:01:30 +0200472 peer = gbproxy_peer_by_bvci(cfg, msgb_bvci(msg));
Jacob Erlbeck006c0382014-05-27 13:49:04 +0200473
Jacob Erlbeck006c0382014-05-27 13:49:04 +0200474 if (!peer)
Jacob Erlbeck5f1faa32014-08-21 10:01:30 +0200475 peer = gbproxy_peer_by_bssgp_tlv(cfg, &parse_ctx.bssgp_tp);
Jacob Erlbeck006c0382014-05-27 13:49:04 +0200476
477 if (!peer) {
478 LOGP(DLLC, LOGL_INFO,
Jacob Erlbeck9057bc32014-08-12 16:30:30 +0200479 "NSEI=%d(SGSN) patching: didn't find peer for message, "
Jacob Erlbeck006c0382014-05-27 13:49:04 +0200480 "PDU %d\n",
Jacob Erlbeck9057bc32014-08-12 16:30:30 +0200481 msgb_nsei(msg), parse_ctx.pdu_type);
Jacob Erlbeck006c0382014-05-27 13:49:04 +0200482 /* Increment counter */
Holger Hans Peter Freythereece6272014-08-04 15:42:36 +0200483 rate_ctr_inc(&cfg->ctrg->ctr[GBPROX_GLOB_CTR_PATCH_PEER_ERR]);
Jacob Erlbeck006c0382014-05-27 13:49:04 +0200484 return;
485 }
486
Jacob Erlbeck7b821d02014-08-08 08:37:37 +0200487 now = time(NULL);
488
Jacob Erlbeck9114bee2014-08-19 12:21:01 +0200489 if (parse_ctx.g48_hdr) {
490 switch (parse_ctx.g48_hdr->msg_type) {
491 case GSM48_MT_GMM_ATTACH_REJ:
492 rate_ctr_inc(&peer->ctrg->ctr[GBPROX_PEER_CTR_ATTACH_REJS]);
493 break;
Jacob Erlbeck91fb6802014-05-28 10:59:10 +0200494
Jacob Erlbeck9114bee2014-08-19 12:21:01 +0200495 default:
496 break;
497 }
498 }
Jacob Erlbeck2db25122014-08-06 12:41:31 +0200499
Jacob Erlbeck9114bee2014-08-19 12:21:01 +0200500 gprs_gb_log_parse_context(&parse_ctx, "BSSGP");
501
502 tlli_info = gbproxy_update_tlli_state_dl(peer, now, &parse_ctx);
503
504 gbproxy_patch_bssgp(msg, msgb_bssgph(msg), msgb_bssgp_len(msg),
505 peer, tlli_info, &len_change, &parse_ctx);
506
507 gbproxy_update_tlli_state_after(peer, tlli_info, now, &parse_ctx);
Jacob Erlbeck2db25122014-08-06 12:41:31 +0200508
Jacob Erlbeck03551e52014-06-27 19:56:05 +0200509 return;
Jacob Erlbeck67a44452014-05-19 10:14:58 +0200510}
511
Harald Welte9f75c352010-04-30 20:26:32 +0200512/* feed a message down the NS-VC associated with the specified peer */
Holger Hans Peter Freythereece6272014-08-04 15:42:36 +0200513static int gbprox_relay2sgsn(struct gbproxy_config *cfg, struct msgb *old_msg,
Jacob Erlbeckf4d60c82014-08-26 14:47:15 +0200514 uint16_t ns_bvci, uint16_t sgsn_nsei)
Harald Welte672f5c42010-05-03 18:54:58 +0200515{
Harald Welte39d0bb52010-05-12 18:10:25 +0000516 /* create a copy of the message so the old one can
517 * be free()d safely when we return from gbprox_rcvmsg() */
Holger Hans Peter Freyther7127b022014-08-04 11:52:52 +0200518 struct msgb *msg = gprs_msgb_copy(old_msg, "msgb_relay2sgsn");
Jacob Erlbeckbc555742013-10-18 14:34:55 +0200519 int rc;
Harald Welte39d0bb52010-05-12 18:10:25 +0000520
Harald Weltee9ea2692010-05-11 20:20:13 +0200521 DEBUGP(DGPRS, "NSEI=%u proxying BTS->SGSN (NS_BVCI=%u, NSEI=%u)\n",
Jacob Erlbeckf4d60c82014-08-26 14:47:15 +0200522 msgb_nsei(msg), ns_bvci, sgsn_nsei);
Harald Welte44c48302010-05-03 19:22:32 +0200523
Harald Welte672f5c42010-05-03 18:54:58 +0200524 msgb_bvci(msg) = ns_bvci;
Jacob Erlbeckf4d60c82014-08-26 14:47:15 +0200525 msgb_nsei(msg) = sgsn_nsei;
Harald Welte672f5c42010-05-03 18:54:58 +0200526
Harald Welte69619e32010-05-03 19:05:10 +0200527 strip_ns_hdr(msg);
528
Jacob Erlbeckbc555742013-10-18 14:34:55 +0200529 rc = gprs_ns_sendmsg(bssgp_nsi, msg);
530 if (rc < 0)
Holger Hans Peter Freythereece6272014-08-04 15:42:36 +0200531 rate_ctr_inc(&cfg->ctrg->ctr[GBPROX_GLOB_CTR_TX_ERR_SGSN]);
Jacob Erlbeckbc555742013-10-18 14:34:55 +0200532
533 return rc;
Harald Welte672f5c42010-05-03 18:54:58 +0200534}
535
Harald Welte672f5c42010-05-03 18:54:58 +0200536/* feed a message down the NS-VC associated with the specified peer */
Holger Hans Peter Freyther1ddd9e52014-08-04 11:35:32 +0200537static int gbprox_relay2peer(struct msgb *old_msg, struct gbproxy_peer *peer,
Harald Welte9f75c352010-04-30 20:26:32 +0200538 uint16_t ns_bvci)
539{
Harald Welte39d0bb52010-05-12 18:10:25 +0000540 /* create a copy of the message so the old one can
541 * be free()d safely when we return from gbprox_rcvmsg() */
Holger Hans Peter Freyther7127b022014-08-04 11:52:52 +0200542 struct msgb *msg = gprs_msgb_copy(old_msg, "msgb_relay2peer");
Jacob Erlbeckbc555742013-10-18 14:34:55 +0200543 int rc;
Harald Welte39d0bb52010-05-12 18:10:25 +0000544
Harald Welte0ab535b2010-05-13 10:34:56 +0200545 DEBUGP(DGPRS, "NSEI=%u proxying SGSN->BSS (NS_BVCI=%u, NSEI=%u)\n",
Jacob Erlbecke75fec62013-10-15 12:00:27 +0200546 msgb_nsei(msg), ns_bvci, peer->nsei);
Harald Welte44c48302010-05-03 19:22:32 +0200547
Harald Welte9f75c352010-04-30 20:26:32 +0200548 msgb_bvci(msg) = ns_bvci;
Jacob Erlbecke75fec62013-10-15 12:00:27 +0200549 msgb_nsei(msg) = peer->nsei;
Harald Welte9f75c352010-04-30 20:26:32 +0200550
Harald Welte0ab535b2010-05-13 10:34:56 +0200551 /* Strip the old NS header, it will be replaced with a new one */
Harald Welte69619e32010-05-03 19:05:10 +0200552 strip_ns_hdr(msg);
553
Jacob Erlbeckbc555742013-10-18 14:34:55 +0200554 rc = gprs_ns_sendmsg(bssgp_nsi, msg);
555 if (rc < 0)
556 rate_ctr_inc(&peer->ctrg->ctr[GBPROX_PEER_CTR_TX_ERR]);
557
558 return rc;
Harald Welte9f75c352010-04-30 20:26:32 +0200559}
560
Holger Hans Peter Freythereece6272014-08-04 15:42:36 +0200561static int block_unblock_peer(struct gbproxy_config *cfg, uint16_t ptp_bvci, uint8_t pdu_type)
Harald Welte36f98d92011-02-06 13:09:29 +0100562{
Holger Hans Peter Freyther1ddd9e52014-08-04 11:35:32 +0200563 struct gbproxy_peer *peer;
Harald Welte36f98d92011-02-06 13:09:29 +0100564
Jacob Erlbeck5f1faa32014-08-21 10:01:30 +0200565 peer = gbproxy_peer_by_bvci(cfg, ptp_bvci);
Harald Welte36f98d92011-02-06 13:09:29 +0100566 if (!peer) {
567 LOGP(DGPRS, LOGL_ERROR, "BVCI=%u: Cannot find BSS\n",
568 ptp_bvci);
Holger Hans Peter Freythereece6272014-08-04 15:42:36 +0200569 rate_ctr_inc(&cfg->ctrg->ctr[GBPROX_GLOB_CTR_INV_BVCI]);
Harald Welte36f98d92011-02-06 13:09:29 +0100570 return -ENOENT;
571 }
572
573 switch (pdu_type) {
574 case BSSGP_PDUT_BVC_BLOCK_ACK:
575 peer->blocked = 1;
Jacob Erlbeckbc555742013-10-18 14:34:55 +0200576 rate_ctr_inc(&peer->ctrg->ctr[GBPROX_PEER_CTR_BLOCKED]);
Harald Welte36f98d92011-02-06 13:09:29 +0100577 break;
578 case BSSGP_PDUT_BVC_UNBLOCK_ACK:
579 peer->blocked = 0;
Jacob Erlbeckbc555742013-10-18 14:34:55 +0200580 rate_ctr_inc(&peer->ctrg->ctr[GBPROX_PEER_CTR_UNBLOCKED]);
Harald Welte36f98d92011-02-06 13:09:29 +0100581 break;
582 default:
583 break;
584 }
585 return 0;
586}
587
Harald Welte9f75c352010-04-30 20:26:32 +0200588/* Send a message to a peer identified by ptp_bvci but using ns_bvci
589 * in the NS hdr */
Holger Hans Peter Freythereece6272014-08-04 15:42:36 +0200590static int gbprox_relay2bvci(struct gbproxy_config *cfg, struct msgb *msg, uint16_t ptp_bvci,
Harald Welte9f75c352010-04-30 20:26:32 +0200591 uint16_t ns_bvci)
592{
Holger Hans Peter Freyther1ddd9e52014-08-04 11:35:32 +0200593 struct gbproxy_peer *peer;
Harald Welte9f75c352010-04-30 20:26:32 +0200594
Jacob Erlbeck5f1faa32014-08-21 10:01:30 +0200595 peer = gbproxy_peer_by_bvci(cfg, ptp_bvci);
Harald Welte1c77c6e2010-05-03 21:37:11 +0200596 if (!peer) {
Harald Welte4cf12e92010-05-13 14:14:56 +0200597 LOGP(DGPRS, LOGL_ERROR, "BVCI=%u: Cannot find BSS\n",
Harald Welte1c77c6e2010-05-03 21:37:11 +0200598 ptp_bvci);
Holger Hans Peter Freythereece6272014-08-04 15:42:36 +0200599 rate_ctr_inc(&cfg->ctrg->ctr[GBPROX_GLOB_CTR_INV_BVCI]);
Harald Welte9f75c352010-04-30 20:26:32 +0200600 return -ENOENT;
Harald Welte1c77c6e2010-05-03 21:37:11 +0200601 }
Harald Welte9f75c352010-04-30 20:26:32 +0200602
Harald Welte69619e32010-05-03 19:05:10 +0200603 return gbprox_relay2peer(msg, peer, ns_bvci);
Harald Welte9f75c352010-04-30 20:26:32 +0200604}
605
Harald Welteb1fd9022012-06-17 12:16:31 +0800606int bssgp_prim_cb(struct osmo_prim_hdr *oph, void *ctx)
607{
608 return 0;
609}
610
Jacob Erlbeck46f1d6f2014-08-21 13:45:04 +0200611/* Receive an incoming PTP message from a BSS-side NS-VC */
612static int gbprox_rx_ptp_from_bss(struct gbproxy_config *cfg,
613 struct msgb *msg, uint16_t nsei,
614 uint16_t nsvci, uint16_t ns_bvci)
615{
616 struct gbproxy_peer *peer;
Jacob Erlbeckc1c57d32014-08-28 13:20:39 +0200617 struct bssgp_normal_hdr *bgph = (struct bssgp_normal_hdr *) msgb_bssgph(msg);
618 uint8_t pdu_type = bgph->pdu_type;
Jacob Erlbeck5f4ef322014-08-22 17:10:01 +0200619 int rc;
Jacob Erlbeck46f1d6f2014-08-21 13:45:04 +0200620
621 peer = gbproxy_peer_by_bvci(cfg, ns_bvci);
622
623 if (peer)
624 check_peer_nsei(peer, nsei);
625
Jacob Erlbeck5f4ef322014-08-22 17:10:01 +0200626 rc = gbprox_process_bssgp_ul(cfg, msg, peer);
627 if (!rc)
628 return 0;
Jacob Erlbeck46f1d6f2014-08-21 13:45:04 +0200629
Jacob Erlbeckc1c57d32014-08-28 13:20:39 +0200630 switch (pdu_type) {
631 case BSSGP_PDUT_FLOW_CONTROL_BVC:
632 if (!cfg->route_to_sgsn2)
633 break;
634
635 /* Send a copy to the secondary SGSN */
636 gbprox_relay2sgsn(cfg, msg, ns_bvci, cfg->nsip_sgsn2_nsei);
637 break;
638 default:
639 break;
640 }
641
642
Jacob Erlbeckf4d60c82014-08-26 14:47:15 +0200643 return gbprox_relay2sgsn(cfg, msg, ns_bvci, cfg->nsip_sgsn_nsei);
Jacob Erlbeck46f1d6f2014-08-21 13:45:04 +0200644}
645
646/* Receive an incoming PTP message from a SGSN-side NS-VC */
647static int gbprox_rx_ptp_from_sgsn(struct gbproxy_config *cfg,
648 struct msgb *msg, uint16_t nsei,
649 uint16_t nsvci, uint16_t ns_bvci)
650{
651 struct gbproxy_peer *peer;
Jacob Erlbeckc1c57d32014-08-28 13:20:39 +0200652 struct bssgp_normal_hdr *bgph = (struct bssgp_normal_hdr *) msgb_bssgph(msg);
653 uint8_t pdu_type = bgph->pdu_type;
Jacob Erlbeck46f1d6f2014-08-21 13:45:04 +0200654
655 peer = gbproxy_peer_by_bvci(cfg, ns_bvci);
656
Jacob Erlbeck4b663ac2014-08-21 15:07:11 +0200657 /* Send status messages before patching */
658
Jacob Erlbeck46f1d6f2014-08-21 13:45:04 +0200659 if (!peer) {
660 LOGP(DGPRS, LOGL_INFO, "Didn't find peer for "
661 "BVCI=%u for message from NSVC=%u/NSEI=%u (SGSN)\n",
662 ns_bvci, nsvci, nsei);
663 rate_ctr_inc(&cfg->ctrg->
664 ctr[GBPROX_GLOB_CTR_INV_BVCI]);
665 return bssgp_tx_status(BSSGP_CAUSE_UNKNOWN_BVCI,
666 &ns_bvci, msg);
667 }
668
669 if (peer->blocked) {
670 LOGP(DGPRS, LOGL_NOTICE, "Dropping PDU for "
671 "blocked BVCI=%u via NSVC=%u/NSEI=%u\n",
672 ns_bvci, nsvci, nsei);
673 rate_ctr_inc(&peer->ctrg->ctr[GBPROX_PEER_CTR_DROPPED]);
674 return bssgp_tx_status(BSSGP_CAUSE_BVCI_BLOCKED, NULL, msg);
675 }
676
Jacob Erlbeckc1c57d32014-08-28 13:20:39 +0200677 switch (pdu_type) {
678 case BSSGP_PDUT_FLOW_CONTROL_BVC_ACK:
679 case BSSGP_PDUT_BVC_BLOCK_ACK:
680 case BSSGP_PDUT_BVC_UNBLOCK_ACK:
681 if (cfg->route_to_sgsn2 && nsei == cfg->nsip_sgsn2_nsei)
682 /* Hide ACKs from the secondary SGSN, the primary SGSN
683 * is responsible to send them. */
684 return 0;
685 break;
686 default:
687 break;
688 }
689
Jacob Erlbeck4b663ac2014-08-21 15:07:11 +0200690 /* Optionally patch the message */
691 gbprox_process_bssgp_dl(cfg, msg, peer);
692
Jacob Erlbeck46f1d6f2014-08-21 13:45:04 +0200693 return gbprox_relay2peer(msg, peer, ns_bvci);
694}
695
Harald Welte9f75c352010-04-30 20:26:32 +0200696/* Receive an incoming signalling message from a BSS-side NS-VC */
Holger Hans Peter Freythereece6272014-08-04 15:42:36 +0200697static int gbprox_rx_sig_from_bss(struct gbproxy_config *cfg,
698 struct msgb *msg, uint16_t nsei,
Harald Welte9f75c352010-04-30 20:26:32 +0200699 uint16_t ns_bvci)
700{
Harald Welteca3620a2010-05-03 16:30:59 +0200701 struct bssgp_normal_hdr *bgph = (struct bssgp_normal_hdr *) msgb_bssgph(msg);
Harald Welte9f75c352010-04-30 20:26:32 +0200702 struct tlv_parsed tp;
703 uint8_t pdu_type = bgph->pdu_type;
Harald Welteca3620a2010-05-03 16:30:59 +0200704 int data_len = msgb_bssgp_len(msg) - sizeof(*bgph);
Holger Hans Peter Freyther1ddd9e52014-08-04 11:35:32 +0200705 struct gbproxy_peer *from_peer = NULL;
Harald Welte70f38d22010-05-01 12:10:57 +0200706 struct gprs_ra_id raid;
Jacob Erlbeckc1c57d32014-08-28 13:20:39 +0200707 int copy_to_sgsn2 = 0;
Jacob Erlbeck59300642014-09-08 09:04:01 +0200708 int rc;
Harald Welte9f75c352010-04-30 20:26:32 +0200709
Harald Weltec471d3d2011-02-06 17:13:12 +0100710 if (ns_bvci != 0 && ns_bvci != 1) {
Harald Welte4cf12e92010-05-13 14:14:56 +0200711 LOGP(DGPRS, LOGL_NOTICE, "NSEI=%u BVCI=%u is not signalling\n",
Jacob Erlbecke75fec62013-10-15 12:00:27 +0200712 nsei, ns_bvci);
Harald Welte9f75c352010-04-30 20:26:32 +0200713 return -EINVAL;
714 }
715
716 /* we actually should never see those two for BVCI == 0, but double-check
717 * just to make sure */
718 if (pdu_type == BSSGP_PDUT_UL_UNITDATA ||
719 pdu_type == BSSGP_PDUT_DL_UNITDATA) {
Harald Welte44c48302010-05-03 19:22:32 +0200720 LOGP(DGPRS, LOGL_NOTICE, "NSEI=%u UNITDATA not allowed in "
Jacob Erlbecke75fec62013-10-15 12:00:27 +0200721 "signalling\n", nsei);
Harald Welte9f75c352010-04-30 20:26:32 +0200722 return -EINVAL;
723 }
724
725 bssgp_tlv_parse(&tp, bgph->data, data_len);
726
727 switch (pdu_type) {
728 case BSSGP_PDUT_SUSPEND:
729 case BSSGP_PDUT_RESUME:
Jacob Erlbeck8f503592014-06-02 10:49:00 +0200730 /* We implement RAI snooping during SUSPEND/RESUME, since it
731 * establishes a relationsip between BVCI/peer and the routeing
732 * area identification. The snooped information is then used
733 * for routing the {SUSPEND,RESUME}_[N]ACK back to the correct
734 * BSSGP */
Harald Welte9f75c352010-04-30 20:26:32 +0200735 if (!TLVP_PRESENT(&tp, BSSGP_IE_ROUTEING_AREA))
736 goto err_mand_ie;
Jacob Erlbeck5f1faa32014-08-21 10:01:30 +0200737 from_peer = gbproxy_peer_by_nsei(cfg, nsei);
Harald Welte9f75c352010-04-30 20:26:32 +0200738 if (!from_peer)
739 goto err_no_peer;
Harald Welte1174c082010-05-12 00:07:29 +0200740 memcpy(from_peer->ra, TLVP_VAL(&tp, BSSGP_IE_ROUTEING_AREA),
741 sizeof(from_peer->ra));
Harald Welte7fc98222010-05-11 10:15:42 +0200742 gsm48_parse_ra(&raid, from_peer->ra);
Harald Welte4cf12e92010-05-13 14:14:56 +0200743 LOGP(DGPRS, LOGL_INFO, "NSEI=%u BSSGP SUSPEND/RESUME "
Jacob Erlbeck8f503592014-06-02 10:49:00 +0200744 "RAI snooping: RAI %u-%u-%u-%u behind BVCI=%u\n",
Jacob Erlbecke75fec62013-10-15 12:00:27 +0200745 nsei, raid.mcc, raid.mnc, raid.lac,
746 raid.rac , from_peer->bvci);
Harald Welte9f75c352010-04-30 20:26:32 +0200747 /* FIXME: This only supports one BSS per RA */
748 break;
Harald Welte44c48302010-05-03 19:22:32 +0200749 case BSSGP_PDUT_BVC_RESET:
750 /* If we receive a BVC reset on the signalling endpoint, we
751 * don't want the SGSN to reset, as the signalling endpoint
752 * is common for all point-to-point BVCs (and thus all BTS) */
753 if (TLVP_PRESENT(&tp, BSSGP_IE_BVCI)) {
Holger Hans Peter Freytherffd68562012-09-04 20:42:20 +0200754 uint16_t bvci = ntohs(tlvp_val16_unal(&tp, BSSGP_IE_BVCI));
Harald Welte72953b82010-05-12 00:20:41 +0200755 LOGP(DGPRS, LOGL_INFO, "NSEI=%u Rx BVC RESET (BVCI=%u)\n",
Jacob Erlbecke75fec62013-10-15 12:00:27 +0200756 nsei, bvci);
Harald Welte44c48302010-05-03 19:22:32 +0200757 if (bvci == 0) {
758 /* FIXME: only do this if SGSN is alive! */
Harald Weltee9ea2692010-05-11 20:20:13 +0200759 LOGP(DGPRS, LOGL_INFO, "NSEI=%u Tx fake "
Jacob Erlbecke75fec62013-10-15 12:00:27 +0200760 "BVC RESET ACK of BVCI=0\n", nsei);
Harald Welte44c48302010-05-03 19:22:32 +0200761 return bssgp_tx_simple_bvci(BSSGP_PDUT_BVC_RESET_ACK,
Jacob Erlbecke75fec62013-10-15 12:00:27 +0200762 nsei, 0, ns_bvci);
Harald Welte1174c082010-05-12 00:07:29 +0200763 }
Jacob Erlbeck5f1faa32014-08-21 10:01:30 +0200764 from_peer = gbproxy_peer_by_bvci(cfg, bvci);
Harald Welte1174c082010-05-12 00:07:29 +0200765 if (!from_peer) {
Harald Welte1c77c6e2010-05-03 21:37:11 +0200766 /* if a PTP-BVC is reset, and we don't know that
767 * PTP-BVCI yet, we should allocate a new peer */
768 LOGP(DGPRS, LOGL_INFO, "Allocationg new peer for "
Jacob Erlbecke75fec62013-10-15 12:00:27 +0200769 "BVCI=%u via NSEI=%u\n", bvci, nsei);
Holger Hans Peter Freyther0196c992014-08-04 17:10:08 +0200770 from_peer = gbproxy_peer_alloc(cfg, bvci);
Jacob Erlbecke75fec62013-10-15 12:00:27 +0200771 from_peer->nsei = nsei;
Harald Welte44c48302010-05-03 19:22:32 +0200772 }
Jacob Erlbeck64cb9242013-10-24 12:48:56 +0200773
774 if (!check_peer_nsei(from_peer, nsei))
775 from_peer->nsei = nsei;
776
Harald Welte1174c082010-05-12 00:07:29 +0200777 if (TLVP_PRESENT(&tp, BSSGP_IE_CELL_ID)) {
778 struct gprs_ra_id raid;
779 /* We have a Cell Identifier present in this
780 * PDU, this means we can extend our local
781 * state information about this particular cell
782 * */
783 memcpy(from_peer->ra,
784 TLVP_VAL(&tp, BSSGP_IE_CELL_ID),
785 sizeof(from_peer->ra));
786 gsm48_parse_ra(&raid, from_peer->ra);
787 LOGP(DGPRS, LOGL_INFO, "NSEI=%u/BVCI=%u "
Jacob Erlbecke75fec62013-10-15 12:00:27 +0200788 "Cell ID %u-%u-%u-%u\n", nsei,
Harald Welte1174c082010-05-12 00:07:29 +0200789 bvci, raid.mcc, raid.mnc, raid.lac,
790 raid.rac);
791 }
Jacob Erlbeckc1c57d32014-08-28 13:20:39 +0200792 if (cfg->route_to_sgsn2)
793 copy_to_sgsn2 = 1;
Harald Welte44c48302010-05-03 19:22:32 +0200794 }
795 break;
Harald Welte9f75c352010-04-30 20:26:32 +0200796 }
797
Harald Weltee9ea2692010-05-11 20:20:13 +0200798 /* Normally, we can simply pass on all signalling messages from BSS to
799 * SGSN */
Jacob Erlbeck59300642014-09-08 09:04:01 +0200800 rc = gbprox_process_bssgp_ul(cfg, msg, from_peer);
801 if (!rc)
802 return 0;
Jacob Erlbeckc1c57d32014-08-28 13:20:39 +0200803
804 if (copy_to_sgsn2)
805 gbprox_relay2sgsn(cfg, msg, ns_bvci, cfg->nsip_sgsn2_nsei);
806
Jacob Erlbeckf4d60c82014-08-26 14:47:15 +0200807 return gbprox_relay2sgsn(cfg, msg, ns_bvci, cfg->nsip_sgsn_nsei);
Harald Welte9f75c352010-04-30 20:26:32 +0200808err_no_peer:
Jacob Erlbeckc5085f92013-10-18 13:04:48 +0200809 LOGP(DGPRS, LOGL_ERROR, "NSEI=%u(BSS) cannot find peer based on NSEI\n",
Jacob Erlbecke75fec62013-10-15 12:00:27 +0200810 nsei);
Holger Hans Peter Freythereece6272014-08-04 15:42:36 +0200811 rate_ctr_inc(&cfg->ctrg->ctr[GBPROX_GLOB_CTR_INV_NSEI]);
Harald Welte0a4050c2010-05-11 10:01:17 +0200812 return bssgp_tx_status(BSSGP_CAUSE_UNKNOWN_BVCI, NULL, msg);
Harald Welte9f75c352010-04-30 20:26:32 +0200813err_mand_ie:
Harald Welte0a4050c2010-05-11 10:01:17 +0200814 LOGP(DGPRS, LOGL_ERROR, "NSEI=%u(BSS) missing mandatory RA IE\n",
Jacob Erlbecke75fec62013-10-15 12:00:27 +0200815 nsei);
Holger Hans Peter Freythereece6272014-08-04 15:42:36 +0200816 rate_ctr_inc(&cfg->ctrg->ctr[GBPROX_GLOB_CTR_PROTO_ERR_BSS]);
Harald Welte0a4050c2010-05-11 10:01:17 +0200817 return bssgp_tx_status(BSSGP_CAUSE_MISSING_MAND_IE, NULL, msg);
Harald Welte9f75c352010-04-30 20:26:32 +0200818}
819
820/* Receive paging request from SGSN, we need to relay to proper BSS */
Holger Hans Peter Freythereece6272014-08-04 15:42:36 +0200821static int gbprox_rx_paging(struct gbproxy_config *cfg, struct msgb *msg, struct tlv_parsed *tp,
Jacob Erlbecke75fec62013-10-15 12:00:27 +0200822 uint32_t nsei, uint16_t ns_bvci)
Harald Welte9f75c352010-04-30 20:26:32 +0200823{
Holger Hans Peter Freyther1ddd9e52014-08-04 11:35:32 +0200824 struct gbproxy_peer *peer = NULL;
Jacob Erlbeckbc555742013-10-18 14:34:55 +0200825 int errctr = GBPROX_GLOB_CTR_PROTO_ERR_SGSN;
Harald Welte9f75c352010-04-30 20:26:32 +0200826
Harald Welte4cf12e92010-05-13 14:14:56 +0200827 LOGP(DGPRS, LOGL_INFO, "NSEI=%u(SGSN) BSSGP PAGING ",
Jacob Erlbecke75fec62013-10-15 12:00:27 +0200828 nsei);
Harald Welte9f75c352010-04-30 20:26:32 +0200829 if (TLVP_PRESENT(tp, BSSGP_IE_BVCI)) {
Holger Hans Peter Freytherffd68562012-09-04 20:42:20 +0200830 uint16_t bvci = ntohs(tlvp_val16_unal(tp, BSSGP_IE_BVCI));
Harald Welte4cf12e92010-05-13 14:14:56 +0200831 LOGPC(DGPRS, LOGL_INFO, "routing by BVCI to peer BVCI=%u\n",
832 bvci);
Jacob Erlbeckbc555742013-10-18 14:34:55 +0200833 errctr = GBPROX_GLOB_CTR_OTHER_ERR;
Harald Welte9f75c352010-04-30 20:26:32 +0200834 } else if (TLVP_PRESENT(tp, BSSGP_IE_ROUTEING_AREA)) {
Jacob Erlbeck5f1faa32014-08-21 10:01:30 +0200835 peer = gbproxy_peer_by_rai(cfg, TLVP_VAL(tp, BSSGP_IE_ROUTEING_AREA));
Jacob Erlbeck8f503592014-06-02 10:49:00 +0200836 LOGPC(DGPRS, LOGL_INFO, "routing by RAI to peer BVCI=%u\n",
Holger Hans Peter Freyther62eaf542010-06-08 16:30:24 +0800837 peer ? peer->bvci : -1);
Jacob Erlbeck8f503592014-06-02 10:49:00 +0200838 errctr = GBPROX_GLOB_CTR_INV_RAI;
Harald Welte9f75c352010-04-30 20:26:32 +0200839 } else if (TLVP_PRESENT(tp, BSSGP_IE_LOCATION_AREA)) {
Jacob Erlbeck5f1faa32014-08-21 10:01:30 +0200840 peer = gbproxy_peer_by_lai(cfg, TLVP_VAL(tp, BSSGP_IE_LOCATION_AREA));
Jacob Erlbeck8f503592014-06-02 10:49:00 +0200841 LOGPC(DGPRS, LOGL_INFO, "routing by LAI to peer BVCI=%u\n",
Holger Hans Peter Freyther62eaf542010-06-08 16:30:24 +0800842 peer ? peer->bvci : -1);
Jacob Erlbeck8f503592014-06-02 10:49:00 +0200843 errctr = GBPROX_GLOB_CTR_INV_LAI;
Harald Welte9f75c352010-04-30 20:26:32 +0200844 } else
Harald Welte4cf12e92010-05-13 14:14:56 +0200845 LOGPC(DGPRS, LOGL_INFO, "\n");
846
847 if (!peer) {
848 LOGP(DGPRS, LOGL_ERROR, "NSEI=%u(SGSN) BSSGP PAGING: "
Jacob Erlbecke75fec62013-10-15 12:00:27 +0200849 "unable to route, missing IE\n", nsei);
Holger Hans Peter Freythereece6272014-08-04 15:42:36 +0200850 rate_ctr_inc(&cfg->ctrg->ctr[errctr]);
Harald Welte9f75c352010-04-30 20:26:32 +0200851 return -EINVAL;
Harald Welte4cf12e92010-05-13 14:14:56 +0200852 }
853 return gbprox_relay2peer(msg, peer, ns_bvci);
Harald Welte9f75c352010-04-30 20:26:32 +0200854}
855
Harald Welte0a4050c2010-05-11 10:01:17 +0200856/* Receive an incoming BVC-RESET message from the SGSN */
Holger Hans Peter Freythereece6272014-08-04 15:42:36 +0200857static int rx_reset_from_sgsn(struct gbproxy_config *cfg,
Jacob Erlbeck4b663ac2014-08-21 15:07:11 +0200858 struct msgb *orig_msg,
Holger Hans Peter Freythereece6272014-08-04 15:42:36 +0200859 struct msgb *msg, struct tlv_parsed *tp,
860 uint32_t nsei, uint16_t ns_bvci)
Harald Welte0a4050c2010-05-11 10:01:17 +0200861{
Holger Hans Peter Freyther1ddd9e52014-08-04 11:35:32 +0200862 struct gbproxy_peer *peer;
Harald Welte0a4050c2010-05-11 10:01:17 +0200863 uint16_t ptp_bvci;
864
865 if (!TLVP_PRESENT(tp, BSSGP_IE_BVCI)) {
Holger Hans Peter Freythereece6272014-08-04 15:42:36 +0200866 rate_ctr_inc(&cfg->ctrg->
Jacob Erlbeckbc555742013-10-18 14:34:55 +0200867 ctr[GBPROX_GLOB_CTR_PROTO_ERR_SGSN]);
Harald Welte0a4050c2010-05-11 10:01:17 +0200868 return bssgp_tx_status(BSSGP_CAUSE_MISSING_MAND_IE,
Jacob Erlbeck4b663ac2014-08-21 15:07:11 +0200869 NULL, orig_msg);
Harald Welte0a4050c2010-05-11 10:01:17 +0200870 }
Holger Hans Peter Freytherffd68562012-09-04 20:42:20 +0200871 ptp_bvci = ntohs(tlvp_val16_unal(tp, BSSGP_IE_BVCI));
Harald Welte0a4050c2010-05-11 10:01:17 +0200872
873 if (ptp_bvci >= 2) {
874 /* A reset for a PTP BVC was received, forward it to its
875 * respective peer */
Jacob Erlbeck5f1faa32014-08-21 10:01:30 +0200876 peer = gbproxy_peer_by_bvci(cfg, ptp_bvci);
Harald Welte0a4050c2010-05-11 10:01:17 +0200877 if (!peer) {
Harald Welte4cf12e92010-05-13 14:14:56 +0200878 LOGP(DGPRS, LOGL_ERROR, "NSEI=%u BVCI=%u: Cannot find BSS\n",
Jacob Erlbecke75fec62013-10-15 12:00:27 +0200879 nsei, ptp_bvci);
Holger Hans Peter Freythereece6272014-08-04 15:42:36 +0200880 rate_ctr_inc(&cfg->ctrg->
Jacob Erlbeckbc555742013-10-18 14:34:55 +0200881 ctr[GBPROX_GLOB_CTR_INV_BVCI]);
Harald Welte0a4050c2010-05-11 10:01:17 +0200882 return bssgp_tx_status(BSSGP_CAUSE_UNKNOWN_BVCI,
Jacob Erlbeck4b663ac2014-08-21 15:07:11 +0200883 NULL, orig_msg);
Harald Welte0a4050c2010-05-11 10:01:17 +0200884 }
885 return gbprox_relay2peer(msg, peer, ns_bvci);
886 }
887
888 /* A reset for the Signalling entity has been received
889 * from the SGSN. As the signalling BVCI is shared
890 * among all the BSS's that we multiplex, it needs to
891 * be relayed */
Holger Hans Peter Freythereece6272014-08-04 15:42:36 +0200892 llist_for_each_entry(peer, &cfg->bts_peers, list)
Harald Welte0a4050c2010-05-11 10:01:17 +0200893 gbprox_relay2peer(msg, peer, ns_bvci);
894
895 return 0;
896}
897
Harald Welte9f75c352010-04-30 20:26:32 +0200898/* Receive an incoming signalling message from the SGSN-side NS-VC */
Holger Hans Peter Freythereece6272014-08-04 15:42:36 +0200899static int gbprox_rx_sig_from_sgsn(struct gbproxy_config *cfg,
Jacob Erlbeck4b663ac2014-08-21 15:07:11 +0200900 struct msgb *orig_msg, uint32_t nsei,
Holger Hans Peter Freythereece6272014-08-04 15:42:36 +0200901 uint16_t ns_bvci)
Harald Welte9f75c352010-04-30 20:26:32 +0200902{
Jacob Erlbeck4b663ac2014-08-21 15:07:11 +0200903 struct bssgp_normal_hdr *bgph =
904 (struct bssgp_normal_hdr *) msgb_bssgph(orig_msg);
Harald Welte9f75c352010-04-30 20:26:32 +0200905 struct tlv_parsed tp;
906 uint8_t pdu_type = bgph->pdu_type;
Jacob Erlbeck4b663ac2014-08-21 15:07:11 +0200907 int data_len;
Holger Hans Peter Freyther1ddd9e52014-08-04 11:35:32 +0200908 struct gbproxy_peer *peer;
Harald Welte9f75c352010-04-30 20:26:32 +0200909 uint16_t bvci;
Jacob Erlbeck4b663ac2014-08-21 15:07:11 +0200910 struct msgb *msg;
Harald Welte9f75c352010-04-30 20:26:32 +0200911 int rc = 0;
912
Harald Weltec471d3d2011-02-06 17:13:12 +0100913 if (ns_bvci != 0 && ns_bvci != 1) {
Harald Welte4cf12e92010-05-13 14:14:56 +0200914 LOGP(DGPRS, LOGL_NOTICE, "NSEI=%u(SGSN) BVCI=%u is not "
Jacob Erlbecke75fec62013-10-15 12:00:27 +0200915 "signalling\n", nsei, ns_bvci);
Harald Welte0a4050c2010-05-11 10:01:17 +0200916 /* FIXME: Send proper error message */
Harald Welte9f75c352010-04-30 20:26:32 +0200917 return -EINVAL;
918 }
919
920 /* we actually should never see those two for BVCI == 0, but double-check
921 * just to make sure */
922 if (pdu_type == BSSGP_PDUT_UL_UNITDATA ||
923 pdu_type == BSSGP_PDUT_DL_UNITDATA) {
Harald Welte44c48302010-05-03 19:22:32 +0200924 LOGP(DGPRS, LOGL_NOTICE, "NSEI=%u(SGSN) UNITDATA not allowed in "
Jacob Erlbecke75fec62013-10-15 12:00:27 +0200925 "signalling\n", nsei);
Jacob Erlbeck4b663ac2014-08-21 15:07:11 +0200926 return bssgp_tx_status(BSSGP_CAUSE_PROTO_ERR_UNSPEC, NULL, orig_msg);
Harald Welte9f75c352010-04-30 20:26:32 +0200927 }
928
Jacob Erlbeck4b663ac2014-08-21 15:07:11 +0200929 msg = gprs_msgb_copy(orig_msg, "rx_sig_from_sgsn");
930 gbprox_process_bssgp_dl(cfg, msg, NULL);
931 /* Update message info */
932 bgph = (struct bssgp_normal_hdr *) msgb_bssgph(msg);
933 data_len = msgb_bssgp_len(orig_msg) - sizeof(*bgph);
Harald Welte9f75c352010-04-30 20:26:32 +0200934 rc = bssgp_tlv_parse(&tp, bgph->data, data_len);
935
936 switch (pdu_type) {
Harald Welte0a4050c2010-05-11 10:01:17 +0200937 case BSSGP_PDUT_BVC_RESET:
Jacob Erlbeck4b663ac2014-08-21 15:07:11 +0200938 rc = rx_reset_from_sgsn(cfg, msg, orig_msg, &tp, nsei, ns_bvci);
Harald Welte0a4050c2010-05-11 10:01:17 +0200939 break;
Harald Welte9f75c352010-04-30 20:26:32 +0200940 case BSSGP_PDUT_BVC_RESET_ACK:
Jacob Erlbeckc1c57d32014-08-28 13:20:39 +0200941 if (cfg->route_to_sgsn2 && nsei == cfg->nsip_sgsn2_nsei)
942 break;
943 /* fall through */
944 case BSSGP_PDUT_FLUSH_LL:
Harald Welte9f75c352010-04-30 20:26:32 +0200945 /* simple case: BVCI IE is mandatory */
946 if (!TLVP_PRESENT(&tp, BSSGP_IE_BVCI))
947 goto err_mand_ie;
Holger Hans Peter Freytherffd68562012-09-04 20:42:20 +0200948 bvci = ntohs(tlvp_val16_unal(&tp, BSSGP_IE_BVCI));
Holger Hans Peter Freythereece6272014-08-04 15:42:36 +0200949 rc = gbprox_relay2bvci(cfg, msg, bvci, ns_bvci);
Harald Welte9f75c352010-04-30 20:26:32 +0200950 break;
951 case BSSGP_PDUT_PAGING_PS:
952 case BSSGP_PDUT_PAGING_CS:
Jacob Erlbeck8f503592014-06-02 10:49:00 +0200953 /* process the paging request (LAI/RAI lookup) */
Holger Hans Peter Freythereece6272014-08-04 15:42:36 +0200954 rc = gbprox_rx_paging(cfg, msg, &tp, nsei, ns_bvci);
Harald Welte9f75c352010-04-30 20:26:32 +0200955 break;
956 case BSSGP_PDUT_STATUS:
Harald Welte0a4050c2010-05-11 10:01:17 +0200957 /* Some exception has occurred */
Harald Welte44c48302010-05-03 19:22:32 +0200958 LOGP(DGPRS, LOGL_NOTICE,
Jacob Erlbecke75fec62013-10-15 12:00:27 +0200959 "NSEI=%u(SGSN) BSSGP STATUS ", nsei);
Harald Welte0a4050c2010-05-11 10:01:17 +0200960 if (!TLVP_PRESENT(&tp, BSSGP_IE_CAUSE)) {
961 LOGPC(DGPRS, LOGL_NOTICE, "\n");
962 goto err_mand_ie;
963 }
964 LOGPC(DGPRS, LOGL_NOTICE,
965 "cause=0x%02x(%s) ", *TLVP_VAL(&tp, BSSGP_IE_CAUSE),
966 bssgp_cause_str(*TLVP_VAL(&tp, BSSGP_IE_CAUSE)));
967 if (TLVP_PRESENT(&tp, BSSGP_IE_BVCI)) {
Holger Hans Peter Freytherffd68562012-09-04 20:42:20 +0200968 uint16_t bvci = tlvp_val16_unal(&tp, BSSGP_IE_BVCI);
Harald Welte0a4050c2010-05-11 10:01:17 +0200969 LOGPC(DGPRS, LOGL_NOTICE,
Holger Hans Peter Freytherffd68562012-09-04 20:42:20 +0200970 "BVCI=%u\n", ntohs(bvci));
Harald Welte0a4050c2010-05-11 10:01:17 +0200971 } else
972 LOGPC(DGPRS, LOGL_NOTICE, "\n");
Harald Welte9f75c352010-04-30 20:26:32 +0200973 break;
974 /* those only exist in the SGSN -> BSS direction */
975 case BSSGP_PDUT_SUSPEND_ACK:
976 case BSSGP_PDUT_SUSPEND_NACK:
977 case BSSGP_PDUT_RESUME_ACK:
978 case BSSGP_PDUT_RESUME_NACK:
Jacob Erlbeck8f503592014-06-02 10:49:00 +0200979 /* RAI IE is mandatory */
Harald Welte9f75c352010-04-30 20:26:32 +0200980 if (!TLVP_PRESENT(&tp, BSSGP_IE_ROUTEING_AREA))
981 goto err_mand_ie;
Jacob Erlbeck5f1faa32014-08-21 10:01:30 +0200982 peer = gbproxy_peer_by_rai(cfg, TLVP_VAL(&tp, BSSGP_IE_ROUTEING_AREA));
Harald Welte9f75c352010-04-30 20:26:32 +0200983 if (!peer)
984 goto err_no_peer;
Harald Welte69619e32010-05-03 19:05:10 +0200985 rc = gbprox_relay2peer(msg, peer, ns_bvci);
Harald Welte9f75c352010-04-30 20:26:32 +0200986 break;
Harald Welte36f98d92011-02-06 13:09:29 +0100987 case BSSGP_PDUT_BVC_BLOCK_ACK:
988 case BSSGP_PDUT_BVC_UNBLOCK_ACK:
989 if (!TLVP_PRESENT(&tp, BSSGP_IE_BVCI))
990 goto err_mand_ie;
Holger Hans Peter Freytherffd68562012-09-04 20:42:20 +0200991 bvci = ntohs(tlvp_val16_unal(&tp, BSSGP_IE_BVCI));
Harald Welte36f98d92011-02-06 13:09:29 +0100992 if (bvci == 0) {
993 LOGP(DGPRS, LOGL_NOTICE, "NSEI=%u(SGSN) BSSGP "
Jacob Erlbecke75fec62013-10-15 12:00:27 +0200994 "%sBLOCK_ACK for signalling BVCI ?!?\n", nsei,
Harald Welte36f98d92011-02-06 13:09:29 +0100995 pdu_type == BSSGP_PDUT_BVC_UNBLOCK_ACK ? "UN":"");
996 /* should we send STATUS ? */
Holger Hans Peter Freythereece6272014-08-04 15:42:36 +0200997 rate_ctr_inc(&cfg->ctrg->
Jacob Erlbeckbc555742013-10-18 14:34:55 +0200998 ctr[GBPROX_GLOB_CTR_INV_BVCI]);
Harald Welte36f98d92011-02-06 13:09:29 +0100999 } else {
1000 /* Mark BVC as (un)blocked */
Holger Hans Peter Freythereece6272014-08-04 15:42:36 +02001001 block_unblock_peer(cfg, bvci, pdu_type);
Harald Welte36f98d92011-02-06 13:09:29 +01001002 }
Holger Hans Peter Freythereece6272014-08-04 15:42:36 +02001003 rc = gbprox_relay2bvci(cfg, msg, bvci, ns_bvci);
Harald Welte36f98d92011-02-06 13:09:29 +01001004 break;
Harald Welte9f75c352010-04-30 20:26:32 +02001005 case BSSGP_PDUT_SGSN_INVOKE_TRACE:
Harald Welte44c48302010-05-03 19:22:32 +02001006 LOGP(DGPRS, LOGL_ERROR,
Jacob Erlbecke75fec62013-10-15 12:00:27 +02001007 "NSEI=%u(SGSN) BSSGP INVOKE TRACE not supported\n",nsei);
Holger Hans Peter Freythereece6272014-08-04 15:42:36 +02001008 rate_ctr_inc(&cfg->ctrg->
Jacob Erlbeckbc555742013-10-18 14:34:55 +02001009 ctr[GBPROX_GLOB_CTR_NOT_SUPPORTED_SGSN]);
Jacob Erlbeck4b663ac2014-08-21 15:07:11 +02001010 rc = bssgp_tx_status(BSSGP_CAUSE_PDU_INCOMP_FEAT, NULL, orig_msg);
Harald Welte9f75c352010-04-30 20:26:32 +02001011 break;
1012 default:
Harald Welte72953b82010-05-12 00:20:41 +02001013 LOGP(DGPRS, LOGL_NOTICE, "BSSGP PDU type 0x%02x unknown\n",
1014 pdu_type);
Holger Hans Peter Freythereece6272014-08-04 15:42:36 +02001015 rate_ctr_inc(&cfg->ctrg->
Jacob Erlbeckbc555742013-10-18 14:34:55 +02001016 ctr[GBPROX_GLOB_CTR_PROTO_ERR_SGSN]);
Jacob Erlbeck4b663ac2014-08-21 15:07:11 +02001017 rc = bssgp_tx_status(BSSGP_CAUSE_PROTO_ERR_UNSPEC, NULL, orig_msg);
Harald Welte9f75c352010-04-30 20:26:32 +02001018 break;
1019 }
1020
Jacob Erlbeck4b663ac2014-08-21 15:07:11 +02001021 msgb_free(msg);
1022
Harald Welte9f75c352010-04-30 20:26:32 +02001023 return rc;
1024err_mand_ie:
Harald Welte1c77c6e2010-05-03 21:37:11 +02001025 LOGP(DGPRS, LOGL_ERROR, "NSEI=%u(SGSN) missing mandatory IE\n",
Jacob Erlbecke75fec62013-10-15 12:00:27 +02001026 nsei);
Holger Hans Peter Freythereece6272014-08-04 15:42:36 +02001027 rate_ctr_inc(&cfg->ctrg->
Jacob Erlbeckbc555742013-10-18 14:34:55 +02001028 ctr[GBPROX_GLOB_CTR_PROTO_ERR_SGSN]);
Jacob Erlbeck4b663ac2014-08-21 15:07:11 +02001029 msgb_free(msg);
1030 return bssgp_tx_status(BSSGP_CAUSE_MISSING_MAND_IE, NULL, orig_msg);
Harald Welte9f75c352010-04-30 20:26:32 +02001031err_no_peer:
Jacob Erlbeck8f503592014-06-02 10:49:00 +02001032 LOGP(DGPRS, LOGL_ERROR, "NSEI=%u(SGSN) cannot find peer based on RAI\n",
Jacob Erlbecke75fec62013-10-15 12:00:27 +02001033 nsei);
Holger Hans Peter Freythereece6272014-08-04 15:42:36 +02001034 rate_ctr_inc(&cfg->ctrg-> ctr[GBPROX_GLOB_CTR_INV_RAI]);
Jacob Erlbeck4b663ac2014-08-21 15:07:11 +02001035 msgb_free(msg);
1036 return bssgp_tx_status(BSSGP_CAUSE_UNKNOWN_BVCI, NULL, orig_msg);
Harald Welte9f75c352010-04-30 20:26:32 +02001037}
1038
Jacob Erlbeckf4d60c82014-08-26 14:47:15 +02001039static int gbproxy_is_sgsn_nsei(struct gbproxy_config *cfg, uint16_t nsei)
1040{
1041 return nsei == cfg->nsip_sgsn_nsei ||
1042 (cfg->route_to_sgsn2 && nsei == cfg->nsip_sgsn2_nsei);
1043}
1044
Harald Welte9f75c352010-04-30 20:26:32 +02001045/* Main input function for Gb proxy */
Holger Hans Peter Freythereece6272014-08-04 15:42:36 +02001046int gbprox_rcvmsg(struct gbproxy_config *cfg, struct msgb *msg, uint16_t nsei,
1047 uint16_t ns_bvci, uint16_t nsvci)
Harald Welte9f75c352010-04-30 20:26:32 +02001048{
Harald Welte672f5c42010-05-03 18:54:58 +02001049 int rc;
Jacob Erlbeckf4d60c82014-08-26 14:47:15 +02001050 int remote_end_is_sgsn = gbproxy_is_sgsn_nsei(cfg, nsei);
Harald Welte9f75c352010-04-30 20:26:32 +02001051
1052 /* Only BVCI=0 messages need special treatment */
1053 if (ns_bvci == 0 || ns_bvci == 1) {
Jacob Erlbecke75fec62013-10-15 12:00:27 +02001054 if (remote_end_is_sgsn)
Holger Hans Peter Freythereece6272014-08-04 15:42:36 +02001055 rc = gbprox_rx_sig_from_sgsn(cfg, msg, nsei, ns_bvci);
Harald Welte9f75c352010-04-30 20:26:32 +02001056 else
Holger Hans Peter Freythereece6272014-08-04 15:42:36 +02001057 rc = gbprox_rx_sig_from_bss(cfg, msg, nsei, ns_bvci);
Harald Welte672f5c42010-05-03 18:54:58 +02001058 } else {
Jacob Erlbeck46f1d6f2014-08-21 13:45:04 +02001059 /* All other BVCI are PTP */
1060 if (remote_end_is_sgsn)
1061 rc = gbprox_rx_ptp_from_sgsn(cfg, msg, nsei, nsvci,
1062 ns_bvci);
1063 else
1064 rc = gbprox_rx_ptp_from_bss(cfg, msg, nsei, nsvci,
1065 ns_bvci);
Harald Welte9f75c352010-04-30 20:26:32 +02001066 }
1067
Harald Welte672f5c42010-05-03 18:54:58 +02001068 return rc;
Harald Welte9f75c352010-04-30 20:26:32 +02001069}
Harald Welte85801d02010-05-11 05:49:43 +02001070
Harald Welte1ccbf442010-05-14 11:53:08 +00001071int gbprox_reset_persistent_nsvcs(struct gprs_ns_inst *nsi)
1072{
1073 struct gprs_nsvc *nsvc;
1074
1075 llist_for_each_entry(nsvc, &nsi->gprs_nsvcs, list) {
1076 if (!nsvc->persistent)
1077 continue;
1078 gprs_nsvc_reset(nsvc, NS_CAUSE_OM_INTERVENTION);
1079 }
1080 return 0;
1081}
1082
Harald Weltec1c1dd22010-05-11 06:34:24 +02001083/* Signal handler for signals from NS layer */
1084int gbprox_signal(unsigned int subsys, unsigned int signal,
1085 void *handler_data, void *signal_data)
1086{
Holger Hans Peter Freythereece6272014-08-04 15:42:36 +02001087 struct gbproxy_config *cfg = handler_data;
Harald Weltec1c1dd22010-05-11 06:34:24 +02001088 struct ns_signal_data *nssd = signal_data;
1089 struct gprs_nsvc *nsvc = nssd->nsvc;
Holger Hans Peter Freyther1ddd9e52014-08-04 11:35:32 +02001090 struct gbproxy_peer *peer;
Jacob Erlbeckf4d60c82014-08-26 14:47:15 +02001091 int remote_end_is_sgsn = gbproxy_is_sgsn_nsei(cfg, nsvc->nsei);
Harald Weltec1c1dd22010-05-11 06:34:24 +02001092
Harald Weltea6a20b42012-06-16 16:40:42 +08001093 if (subsys != SS_L_NS)
Harald Weltec1c1dd22010-05-11 06:34:24 +02001094 return 0;
1095
Jacob Erlbeckf4d60c82014-08-26 14:47:15 +02001096 if (signal == S_NS_RESET && remote_end_is_sgsn) {
Harald Weltef69c0592010-05-11 18:29:44 +02001097 /* We have received a NS-RESET from the NSEI and NSVC
1098 * of the SGSN. This might happen with SGSN that start
1099 * their own NS-RESET procedure without waiting for our
1100 * NS-RESET */
1101 nsvc->remote_end_is_sgsn = 1;
1102 }
1103
Harald Welteb778d2c2010-05-12 13:28:25 +00001104 if (signal == S_NS_ALIVE_EXP && nsvc->remote_end_is_sgsn) {
1105 LOGP(DGPRS, LOGL_NOTICE, "Tns alive expired too often, "
1106 "re-starting RESET procedure\n");
Holger Hans Peter Freythereece6272014-08-04 15:42:36 +02001107 rate_ctr_inc(&cfg->ctrg->
Jacob Erlbeckbc555742013-10-18 14:34:55 +02001108 ctr[GBPROX_GLOB_CTR_RESTART_RESET_SGSN]);
Harald Weltee6599ee2012-06-17 12:25:53 +08001109 gprs_ns_nsip_connect(nsvc->nsi, &nsvc->ip.bts_addr,
1110 nsvc->nsei, nsvc->nsvci);
Harald Welteb778d2c2010-05-12 13:28:25 +00001111 }
1112
Harald Welte5e106d72011-02-06 16:33:29 +01001113 if (!nsvc->remote_end_is_sgsn) {
1114 /* from BSS to SGSN */
Jacob Erlbeck5f1faa32014-08-21 10:01:30 +02001115 peer = gbproxy_peer_by_nsei(cfg, nsvc->nsei);
Harald Welte5e106d72011-02-06 16:33:29 +01001116 if (!peer) {
1117 LOGP(DGPRS, LOGL_NOTICE, "signal %u for unknown peer "
1118 "NSEI=%u/NSVCI=%u\n", signal, nsvc->nsei,
1119 nsvc->nsvci);
1120 return 0;
1121 }
Harald Weltec1c1dd22010-05-11 06:34:24 +02001122 switch (signal) {
1123 case S_NS_RESET:
Harald Weltec1c1dd22010-05-11 06:34:24 +02001124 case S_NS_BLOCK:
Harald Welte5e106d72011-02-06 16:33:29 +01001125 if (!peer->blocked)
1126 break;
1127 LOGP(DGPRS, LOGL_NOTICE, "Converting NS_RESET from "
1128 "NSEI=%u/NSVCI=%u into BSSGP_BVC_BLOCK to SGSN\n",
1129 nsvc->nsei, nsvc->nsvci);
1130 bssgp_tx_simple_bvci(BSSGP_PDUT_BVC_BLOCK, nsvc->nsei,
1131 peer->bvci, 0);
Harald Weltec1c1dd22010-05-11 06:34:24 +02001132 break;
Harald Welte5e106d72011-02-06 16:33:29 +01001133 }
1134 } else {
Jacob Erlbecke75fec62013-10-15 12:00:27 +02001135 /* Forward this message to all NS-VC to BSS */
Holger Hans Peter Freythereece6272014-08-04 15:42:36 +02001136 struct gprs_ns_inst *nsi = cfg->nsi;
Jacob Erlbecke75fec62013-10-15 12:00:27 +02001137 struct gprs_nsvc *next_nsvc;
1138
1139 llist_for_each_entry(next_nsvc, &nsi->gprs_nsvcs, list) {
1140 if (next_nsvc->remote_end_is_sgsn)
1141 continue;
1142
1143 /* Note that the following does not start the full
1144 * procedures including timer based retransmissions. */
Harald Welte5e106d72011-02-06 16:33:29 +01001145 switch (signal) {
1146 case S_NS_RESET:
Jacob Erlbecke75fec62013-10-15 12:00:27 +02001147 gprs_ns_tx_reset(next_nsvc, nssd->cause);
Harald Welte5e106d72011-02-06 16:33:29 +01001148 break;
1149 case S_NS_BLOCK:
Jacob Erlbecke75fec62013-10-15 12:00:27 +02001150 gprs_ns_tx_block(next_nsvc, nssd->cause);
Harald Welte5e106d72011-02-06 16:33:29 +01001151 break;
1152 case S_NS_UNBLOCK:
Jacob Erlbecke75fec62013-10-15 12:00:27 +02001153 gprs_ns_tx_unblock(next_nsvc);
Harald Welte5e106d72011-02-06 16:33:29 +01001154 break;
1155 }
Harald Weltec1c1dd22010-05-11 06:34:24 +02001156 }
1157 }
1158 return 0;
1159}
1160
Holger Hans Peter Freythereece6272014-08-04 15:42:36 +02001161void gbprox_reset(struct gbproxy_config *cfg)
Jacob Erlbeck72b401f2013-10-24 12:48:55 +02001162{
Holger Hans Peter Freyther1ddd9e52014-08-04 11:35:32 +02001163 struct gbproxy_peer *peer, *tmp;
Jacob Erlbeck72b401f2013-10-24 12:48:55 +02001164
Holger Hans Peter Freythereece6272014-08-04 15:42:36 +02001165 llist_for_each_entry_safe(peer, tmp, &cfg->bts_peers, list)
Holger Hans Peter Freyther0196c992014-08-04 17:10:08 +02001166 gbproxy_peer_free(peer);
Jacob Erlbeck72b401f2013-10-24 12:48:55 +02001167
Holger Hans Peter Freythereece6272014-08-04 15:42:36 +02001168 rate_ctr_group_free(cfg->ctrg);
1169 gbproxy_init_config(cfg);
Jacob Erlbeck72b401f2013-10-24 12:48:55 +02001170}
1171
Holger Hans Peter Freyther18739ea2014-08-04 11:10:09 +02001172int gbproxy_init_config(struct gbproxy_config *cfg)
Jacob Erlbeck4211d792013-10-24 12:48:23 +02001173{
Jacob Erlbeck0d376712014-08-11 19:12:24 +02001174 struct timespec tp;
Holger Hans Peter Freyther18739ea2014-08-04 11:10:09 +02001175 INIT_LLIST_HEAD(&cfg->bts_peers);
Holger Hans Peter Freythera7027a02014-08-04 11:19:56 +02001176 cfg->ctrg = rate_ctr_group_alloc(tall_bsc_ctx, &global_ctrg_desc, 0);
Jacob Erlbeck0d376712014-08-11 19:12:24 +02001177 clock_gettime(CLOCK_REALTIME, &tp);
1178 cfg->bss_ptmsi_state = tp.tv_sec + tp.tv_nsec;
1179 cfg->sgsn_tlli_state = tp.tv_sec - tp.tv_nsec;
Holger Hans Peter Freyther18739ea2014-08-04 11:10:09 +02001180 return 0;
Jacob Erlbeck4211d792013-10-24 12:48:23 +02001181}