blob: b99c455e2a8a84539965eb1eb20f438f062e39fb [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 Freyther85531cc2010-10-06 20:37:09 +08004 * (C) 2010 by On-Waves
Harald Welte9f75c352010-04-30 20:26:32 +02005 * All Rights Reserved
6 *
7 * This program is free software; you can redistribute it and/or modify
Harald Welte9af6ddf2011-01-01 15:25:50 +01008 * it under the terms of the GNU Affero General Public License as published by
9 * the Free Software Foundation; either version 3 of the License, or
Harald Welte9f75c352010-04-30 20:26:32 +020010 * (at your option) any later version.
11 *
12 * This program is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
Harald Welte9af6ddf2011-01-01 15:25:50 +010015 * GNU Affero General Public License for more details.
Harald Welte9f75c352010-04-30 20:26:32 +020016 *
Harald Welte9af6ddf2011-01-01 15:25:50 +010017 * You should have received a copy of the GNU Affero General Public License
18 * along with this program. If not, see <http://www.gnu.org/licenses/>.
Harald Welte9f75c352010-04-30 20:26:32 +020019 *
20 */
21
22#include <unistd.h>
23#include <stdio.h>
24#include <stdlib.h>
25#include <string.h>
26#include <getopt.h>
27#include <errno.h>
28#include <sys/fcntl.h>
29#include <sys/stat.h>
Harald Welte7fc98222010-05-11 10:15:42 +020030#include <arpa/inet.h>
Harald Welte9f75c352010-04-30 20:26:32 +020031
Pablo Neira Ayuso136f4532011-03-22 16:47:59 +010032#include <osmocom/core/talloc.h>
33#include <osmocom/core/select.h>
Harald Welte9f75c352010-04-30 20:26:32 +020034
Harald Welteea34a4e2012-06-16 14:59:56 +080035#include <osmocom/gprs/gprs_ns.h>
36#include <osmocom/gprs/gprs_bssgp.h>
37
Harald Welte9f75c352010-04-30 20:26:32 +020038#include <openbsc/signal.h>
39#include <openbsc/debug.h>
Harald Welte672f5c42010-05-03 18:54:58 +020040#include <openbsc/gb_proxy.h>
Harald Welte9f75c352010-04-30 20:26:32 +020041
42struct gbprox_peer {
43 struct llist_head list;
44
45 /* NS-VC over which we send/receive data to this BVC */
46 struct gprs_nsvc *nsvc;
47
48 /* BVCI used for Point-to-Point to this peer */
49 uint16_t bvci;
Harald Welte36f98d92011-02-06 13:09:29 +010050 int blocked;
Harald Welte9f75c352010-04-30 20:26:32 +020051
52 /* Routeing Area that this peer is part of (raw 04.08 encoding) */
53 uint8_t ra[6];
54};
55
56/* Linked list of all Gb peers (except SGSN) */
57static LLIST_HEAD(gbprox_bts_peers);
58
Harald Welte9f75c352010-04-30 20:26:32 +020059/* Find the gbprox_peer by its BVCI */
60static struct gbprox_peer *peer_by_bvci(uint16_t bvci)
61{
62 struct gbprox_peer *peer;
63 llist_for_each_entry(peer, &gbprox_bts_peers, list) {
64 if (peer->bvci == bvci)
65 return peer;
66 }
67 return NULL;
68}
69
70static struct gbprox_peer *peer_by_nsvc(struct gprs_nsvc *nsvc)
71{
72 struct gbprox_peer *peer;
73 llist_for_each_entry(peer, &gbprox_bts_peers, list) {
74 if (peer->nsvc == nsvc)
75 return peer;
76 }
77 return NULL;
78}
79
80/* look-up a peer by its Routeing Area Code (RAC) */
Harald Welte70f38d22010-05-01 12:10:57 +020081static struct gbprox_peer *peer_by_rac(const uint8_t *ra)
Harald Welte9f75c352010-04-30 20:26:32 +020082{
83 struct gbprox_peer *peer;
84 llist_for_each_entry(peer, &gbprox_bts_peers, list) {
Harald Welte1174c082010-05-12 00:07:29 +020085 if (!memcmp(peer->ra, ra, 6))
Harald Welte9f75c352010-04-30 20:26:32 +020086 return peer;
87 }
88 return NULL;
89}
90
91/* look-up a peer by its Location Area Code (LAC) */
Harald Welte70f38d22010-05-01 12:10:57 +020092static struct gbprox_peer *peer_by_lac(const uint8_t *la)
Harald Welte9f75c352010-04-30 20:26:32 +020093{
94 struct gbprox_peer *peer;
95 llist_for_each_entry(peer, &gbprox_bts_peers, list) {
Harald Welte1174c082010-05-12 00:07:29 +020096 if (!memcmp(peer->ra, la, 5))
Harald Welte9f75c352010-04-30 20:26:32 +020097 return peer;
98 }
99 return NULL;
100}
101
102static struct gbprox_peer *peer_alloc(uint16_t bvci)
103{
104 struct gbprox_peer *peer;
105
106 peer = talloc_zero(tall_bsc_ctx, struct gbprox_peer);
107 if (!peer)
108 return NULL;
109
110 peer->bvci = bvci;
111 llist_add(&peer->list, &gbprox_bts_peers);
112
113 return peer;
114}
115
116static void peer_free(struct gbprox_peer *peer)
117{
118 llist_del(&peer->list);
119 talloc_free(peer);
120}
121
Harald Welte39d0bb52010-05-12 18:10:25 +0000122/* FIXME: this needs to go to libosmocore/msgb.c */
123static struct msgb *msgb_copy(const struct msgb *msg, const char *name)
124{
Harald Welte8645e102012-06-16 16:09:52 +0800125 struct libgb_msgb_cb *old_cb, *new_cb;
Harald Welte39d0bb52010-05-12 18:10:25 +0000126 struct msgb *new_msg;
127
Holger Hans Peter Freyther62d97982010-06-08 18:14:37 +0800128 new_msg = msgb_alloc(msg->data_len, name);
Harald Welte39d0bb52010-05-12 18:10:25 +0000129 if (!new_msg)
130 return NULL;
131
Harald Welte39d0bb52010-05-12 18:10:25 +0000132 /* copy data */
Holger Hans Peter Freyther62d97982010-06-08 18:14:37 +0800133 memcpy(new_msg->_data, msg->_data, new_msg->data_len);
134
135 /* copy header */
136 new_msg->len = msg->len;
137 new_msg->data += msg->data - msg->_data;
138 new_msg->head += msg->head - msg->_data;
139 new_msg->tail += msg->tail - msg->_data;
140
141 new_msg->l1h = new_msg->_data + (msg->l1h - msg->_data);
142 new_msg->l2h = new_msg->_data + (msg->l2h - msg->_data);
143 new_msg->l3h = new_msg->_data + (msg->l3h - msg->_data);
144 new_msg->l4h = new_msg->_data + (msg->l4h - msg->_data);
145
146 /* copy GB specific data */
Harald Welte8645e102012-06-16 16:09:52 +0800147 old_cb = LIBGB_MSGB_CB(msg);
148 new_cb = LIBGB_MSGB_CB(new_msg);
Holger Hans Peter Freyther62d97982010-06-08 18:14:37 +0800149
150 new_cb->bssgph = new_msg->_data + (old_cb->bssgph - msg->_data);
151 new_cb->llch = new_msg->_data + (old_cb->llch - msg->_data);
152
Harald Weltefb9e06f2011-02-06 17:17:05 +0100153 /* bssgp_cell_id is a pointer into the old msgb, so we need to make
154 * it a pointer into the new msgb */
155 new_cb->bssgp_cell_id = new_msg->_data + (old_cb->bssgp_cell_id - msg->_data);
Holger Hans Peter Freyther62d97982010-06-08 18:14:37 +0800156 new_cb->nsei = old_cb->nsei;
157 new_cb->bvci = old_cb->bvci;
158 new_cb->tlli = old_cb->tlli;
Harald Welte39d0bb52010-05-12 18:10:25 +0000159
160 return new_msg;
161}
162
Harald Welte69619e32010-05-03 19:05:10 +0200163/* strip off the NS header */
164static void strip_ns_hdr(struct msgb *msg)
165{
166 int strip_len = msgb_bssgph(msg) - msg->data;
167 msgb_pull(msg, strip_len);
168}
169
Harald Welte9f75c352010-04-30 20:26:32 +0200170/* feed a message down the NS-VC associated with the specified peer */
Harald Welte39d0bb52010-05-12 18:10:25 +0000171static int gbprox_relay2sgsn(struct msgb *old_msg, uint16_t ns_bvci)
Harald Welte672f5c42010-05-03 18:54:58 +0200172{
Harald Welte39d0bb52010-05-12 18:10:25 +0000173 /* create a copy of the message so the old one can
174 * be free()d safely when we return from gbprox_rcvmsg() */
175 struct msgb *msg = msgb_copy(old_msg, "msgb_relay2sgsn");
176
Harald Weltee9ea2692010-05-11 20:20:13 +0200177 DEBUGP(DGPRS, "NSEI=%u proxying BTS->SGSN (NS_BVCI=%u, NSEI=%u)\n",
Harald Welte96f71f22010-05-03 19:28:05 +0200178 msgb_nsei(msg), ns_bvci, gbcfg.nsip_sgsn_nsei);
Harald Welte44c48302010-05-03 19:22:32 +0200179
Harald Welte672f5c42010-05-03 18:54:58 +0200180 msgb_bvci(msg) = ns_bvci;
181 msgb_nsei(msg) = gbcfg.nsip_sgsn_nsei;
182
Harald Welte69619e32010-05-03 19:05:10 +0200183 strip_ns_hdr(msg);
184
Harald Welte0a4050c2010-05-11 10:01:17 +0200185 return gprs_ns_sendmsg(bssgp_nsi, msg);
Harald Welte672f5c42010-05-03 18:54:58 +0200186}
187
Harald Welte672f5c42010-05-03 18:54:58 +0200188/* feed a message down the NS-VC associated with the specified peer */
Harald Welte39d0bb52010-05-12 18:10:25 +0000189static int gbprox_relay2peer(struct msgb *old_msg, struct gbprox_peer *peer,
Harald Welte9f75c352010-04-30 20:26:32 +0200190 uint16_t ns_bvci)
191{
Harald Welte39d0bb52010-05-12 18:10:25 +0000192 /* create a copy of the message so the old one can
193 * be free()d safely when we return from gbprox_rcvmsg() */
194 struct msgb *msg = msgb_copy(old_msg, "msgb_relay2peer");
195
Harald Welte0ab535b2010-05-13 10:34:56 +0200196 DEBUGP(DGPRS, "NSEI=%u proxying SGSN->BSS (NS_BVCI=%u, NSEI=%u)\n",
Harald Welte96f71f22010-05-03 19:28:05 +0200197 msgb_nsei(msg), ns_bvci, peer->nsvc->nsei);
Harald Welte44c48302010-05-03 19:22:32 +0200198
Harald Welte9f75c352010-04-30 20:26:32 +0200199 msgb_bvci(msg) = ns_bvci;
200 msgb_nsei(msg) = peer->nsvc->nsei;
201
Harald Welte0ab535b2010-05-13 10:34:56 +0200202 /* Strip the old NS header, it will be replaced with a new one */
Harald Welte69619e32010-05-03 19:05:10 +0200203 strip_ns_hdr(msg);
204
Harald Welte0a4050c2010-05-11 10:01:17 +0200205 return gprs_ns_sendmsg(bssgp_nsi, msg);
Harald Welte9f75c352010-04-30 20:26:32 +0200206}
207
Harald Welte36f98d92011-02-06 13:09:29 +0100208static int block_unblock_peer(uint16_t ptp_bvci, uint8_t pdu_type)
209{
210 struct gbprox_peer *peer;
211
212 peer = peer_by_bvci(ptp_bvci);
213 if (!peer) {
214 LOGP(DGPRS, LOGL_ERROR, "BVCI=%u: Cannot find BSS\n",
215 ptp_bvci);
216 return -ENOENT;
217 }
218
219 switch (pdu_type) {
220 case BSSGP_PDUT_BVC_BLOCK_ACK:
221 peer->blocked = 1;
222 break;
223 case BSSGP_PDUT_BVC_UNBLOCK_ACK:
224 peer->blocked = 0;
225 break;
226 default:
227 break;
228 }
229 return 0;
230}
231
Harald Welte9f75c352010-04-30 20:26:32 +0200232/* Send a message to a peer identified by ptp_bvci but using ns_bvci
233 * in the NS hdr */
Harald Welte69619e32010-05-03 19:05:10 +0200234static int gbprox_relay2bvci(struct msgb *msg, uint16_t ptp_bvci,
Harald Welte9f75c352010-04-30 20:26:32 +0200235 uint16_t ns_bvci)
236{
237 struct gbprox_peer *peer;
238
239 peer = peer_by_bvci(ptp_bvci);
Harald Welte1c77c6e2010-05-03 21:37:11 +0200240 if (!peer) {
Harald Welte4cf12e92010-05-13 14:14:56 +0200241 LOGP(DGPRS, LOGL_ERROR, "BVCI=%u: Cannot find BSS\n",
Harald Welte1c77c6e2010-05-03 21:37:11 +0200242 ptp_bvci);
Harald Welte9f75c352010-04-30 20:26:32 +0200243 return -ENOENT;
Harald Welte1c77c6e2010-05-03 21:37:11 +0200244 }
Harald Welte9f75c352010-04-30 20:26:32 +0200245
Harald Welte69619e32010-05-03 19:05:10 +0200246 return gbprox_relay2peer(msg, peer, ns_bvci);
Harald Welte9f75c352010-04-30 20:26:32 +0200247}
248
Harald Welteb1fd9022012-06-17 12:16:31 +0800249int bssgp_prim_cb(struct osmo_prim_hdr *oph, void *ctx)
250{
251 return 0;
252}
253
Harald Welte9f75c352010-04-30 20:26:32 +0200254/* Receive an incoming signalling message from a BSS-side NS-VC */
255static int gbprox_rx_sig_from_bss(struct msgb *msg, struct gprs_nsvc *nsvc,
256 uint16_t ns_bvci)
257{
Harald Welteca3620a2010-05-03 16:30:59 +0200258 struct bssgp_normal_hdr *bgph = (struct bssgp_normal_hdr *) msgb_bssgph(msg);
Harald Welte9f75c352010-04-30 20:26:32 +0200259 struct tlv_parsed tp;
260 uint8_t pdu_type = bgph->pdu_type;
Harald Welteca3620a2010-05-03 16:30:59 +0200261 int data_len = msgb_bssgp_len(msg) - sizeof(*bgph);
Harald Welte9f75c352010-04-30 20:26:32 +0200262 struct gbprox_peer *from_peer;
Harald Welte70f38d22010-05-01 12:10:57 +0200263 struct gprs_ra_id raid;
Harald Welte9f75c352010-04-30 20:26:32 +0200264
Harald Weltec471d3d2011-02-06 17:13:12 +0100265 if (ns_bvci != 0 && ns_bvci != 1) {
Harald Welte4cf12e92010-05-13 14:14:56 +0200266 LOGP(DGPRS, LOGL_NOTICE, "NSEI=%u BVCI=%u is not signalling\n",
Harald Welte44c48302010-05-03 19:22:32 +0200267 nsvc->nsei, ns_bvci);
Harald Welte9f75c352010-04-30 20:26:32 +0200268 return -EINVAL;
269 }
270
271 /* we actually should never see those two for BVCI == 0, but double-check
272 * just to make sure */
273 if (pdu_type == BSSGP_PDUT_UL_UNITDATA ||
274 pdu_type == BSSGP_PDUT_DL_UNITDATA) {
Harald Welte44c48302010-05-03 19:22:32 +0200275 LOGP(DGPRS, LOGL_NOTICE, "NSEI=%u UNITDATA not allowed in "
276 "signalling\n", nsvc->nsei);
Harald Welte9f75c352010-04-30 20:26:32 +0200277 return -EINVAL;
278 }
279
280 bssgp_tlv_parse(&tp, bgph->data, data_len);
281
282 switch (pdu_type) {
283 case BSSGP_PDUT_SUSPEND:
284 case BSSGP_PDUT_RESUME:
Harald Welte70f38d22010-05-01 12:10:57 +0200285 /* We implement RAC snooping during SUSPEND/RESUME, since
286 * it establishes a relationsip between BVCI/peer and the
287 * routeing area code. The snooped information is then
288 * used for routing the {SUSPEND,RESUME}_[N]ACK back to
289 * the correct BSSGP */
Harald Welte9f75c352010-04-30 20:26:32 +0200290 if (!TLVP_PRESENT(&tp, BSSGP_IE_ROUTEING_AREA))
291 goto err_mand_ie;
292 from_peer = peer_by_nsvc(nsvc);
293 if (!from_peer)
294 goto err_no_peer;
Harald Welte1174c082010-05-12 00:07:29 +0200295 memcpy(from_peer->ra, TLVP_VAL(&tp, BSSGP_IE_ROUTEING_AREA),
296 sizeof(from_peer->ra));
Harald Welte7fc98222010-05-11 10:15:42 +0200297 gsm48_parse_ra(&raid, from_peer->ra);
Harald Welte4cf12e92010-05-13 14:14:56 +0200298 LOGP(DGPRS, LOGL_INFO, "NSEI=%u BSSGP SUSPEND/RESUME "
299 "RAC snooping: RAC %u-%u-%u-%u behind BVCI=%u, "
300 "NSVCI=%u\n",nsvc->nsei, raid.mcc, raid.mnc, raid.lac,
301 raid.rac , from_peer->bvci, nsvc->nsvci);
Harald Welte9f75c352010-04-30 20:26:32 +0200302 /* FIXME: This only supports one BSS per RA */
303 break;
Harald Welte44c48302010-05-03 19:22:32 +0200304 case BSSGP_PDUT_BVC_RESET:
305 /* If we receive a BVC reset on the signalling endpoint, we
306 * don't want the SGSN to reset, as the signalling endpoint
307 * is common for all point-to-point BVCs (and thus all BTS) */
308 if (TLVP_PRESENT(&tp, BSSGP_IE_BVCI)) {
Holger Hans Peter Freytherffd68562012-09-04 20:42:20 +0200309 uint16_t bvci = ntohs(tlvp_val16_unal(&tp, BSSGP_IE_BVCI));
Harald Welte72953b82010-05-12 00:20:41 +0200310 LOGP(DGPRS, LOGL_INFO, "NSEI=%u Rx BVC RESET (BVCI=%u)\n",
Harald Weltee9ea2692010-05-11 20:20:13 +0200311 nsvc->nsei, bvci);
Harald Welte44c48302010-05-03 19:22:32 +0200312 if (bvci == 0) {
313 /* FIXME: only do this if SGSN is alive! */
Harald Weltee9ea2692010-05-11 20:20:13 +0200314 LOGP(DGPRS, LOGL_INFO, "NSEI=%u Tx fake "
Harald Welte44c48302010-05-03 19:22:32 +0200315 "BVC RESET ACK of BVCI=0\n", nsvc->nsei);
316 return bssgp_tx_simple_bvci(BSSGP_PDUT_BVC_RESET_ACK,
317 nsvc->nsei, 0, ns_bvci);
Harald Welte1174c082010-05-12 00:07:29 +0200318 }
319 from_peer = peer_by_bvci(bvci);
320 if (!from_peer) {
Harald Welte1c77c6e2010-05-03 21:37:11 +0200321 /* if a PTP-BVC is reset, and we don't know that
322 * PTP-BVCI yet, we should allocate a new peer */
323 LOGP(DGPRS, LOGL_INFO, "Allocationg new peer for "
324 "BVCI=%u via NSVCI=%u/NSEI=%u\n", bvci,
325 nsvc->nsvci, nsvc->nsei);
326 from_peer = peer_alloc(bvci);
327 from_peer->nsvc = nsvc;
Harald Welte44c48302010-05-03 19:22:32 +0200328 }
Harald Welte1174c082010-05-12 00:07:29 +0200329 if (TLVP_PRESENT(&tp, BSSGP_IE_CELL_ID)) {
330 struct gprs_ra_id raid;
331 /* We have a Cell Identifier present in this
332 * PDU, this means we can extend our local
333 * state information about this particular cell
334 * */
335 memcpy(from_peer->ra,
336 TLVP_VAL(&tp, BSSGP_IE_CELL_ID),
337 sizeof(from_peer->ra));
338 gsm48_parse_ra(&raid, from_peer->ra);
339 LOGP(DGPRS, LOGL_INFO, "NSEI=%u/BVCI=%u "
Harald Welte72953b82010-05-12 00:20:41 +0200340 "Cell ID %u-%u-%u-%u\n", nsvc->nsei,
Harald Welte1174c082010-05-12 00:07:29 +0200341 bvci, raid.mcc, raid.mnc, raid.lac,
342 raid.rac);
343 }
Harald Welte44c48302010-05-03 19:22:32 +0200344 }
345 break;
Harald Welte9f75c352010-04-30 20:26:32 +0200346 }
347
Harald Weltee9ea2692010-05-11 20:20:13 +0200348 /* Normally, we can simply pass on all signalling messages from BSS to
349 * SGSN */
Harald Welte69619e32010-05-03 19:05:10 +0200350 return gbprox_relay2sgsn(msg, ns_bvci);
Harald Welte9f75c352010-04-30 20:26:32 +0200351err_no_peer:
Harald Welte0a4050c2010-05-11 10:01:17 +0200352 LOGP(DGPRS, LOGL_ERROR, "NSEI=%u(BSS) cannot find peer based on RAC\n",
353 nsvc->nsei);
354 return bssgp_tx_status(BSSGP_CAUSE_UNKNOWN_BVCI, NULL, msg);
Harald Welte9f75c352010-04-30 20:26:32 +0200355err_mand_ie:
Harald Welte0a4050c2010-05-11 10:01:17 +0200356 LOGP(DGPRS, LOGL_ERROR, "NSEI=%u(BSS) missing mandatory RA IE\n",
357 nsvc->nsei);
358 return bssgp_tx_status(BSSGP_CAUSE_MISSING_MAND_IE, NULL, msg);
Harald Welte9f75c352010-04-30 20:26:32 +0200359}
360
361/* Receive paging request from SGSN, we need to relay to proper BSS */
362static int gbprox_rx_paging(struct msgb *msg, struct tlv_parsed *tp,
363 struct gprs_nsvc *nsvc, uint16_t ns_bvci)
364{
Harald Welte4cf12e92010-05-13 14:14:56 +0200365 struct gbprox_peer *peer = NULL;
Harald Welte9f75c352010-04-30 20:26:32 +0200366
Harald Welte4cf12e92010-05-13 14:14:56 +0200367 LOGP(DGPRS, LOGL_INFO, "NSEI=%u(SGSN) BSSGP PAGING ",
368 nsvc->nsei);
Harald Welte9f75c352010-04-30 20:26:32 +0200369 if (TLVP_PRESENT(tp, BSSGP_IE_BVCI)) {
Holger Hans Peter Freytherffd68562012-09-04 20:42:20 +0200370 uint16_t bvci = ntohs(tlvp_val16_unal(tp, BSSGP_IE_BVCI));
Harald Welte4cf12e92010-05-13 14:14:56 +0200371 LOGPC(DGPRS, LOGL_INFO, "routing by BVCI to peer BVCI=%u\n",
372 bvci);
Harald Welte9f75c352010-04-30 20:26:32 +0200373 } else if (TLVP_PRESENT(tp, BSSGP_IE_ROUTEING_AREA)) {
374 peer = peer_by_rac(TLVP_VAL(tp, BSSGP_IE_ROUTEING_AREA));
Harald Welte4cf12e92010-05-13 14:14:56 +0200375 LOGPC(DGPRS, LOGL_INFO, "routing by RAC to peer BVCI=%u\n",
Holger Hans Peter Freyther62eaf542010-06-08 16:30:24 +0800376 peer ? peer->bvci : -1);
Harald Welte9f75c352010-04-30 20:26:32 +0200377 } else if (TLVP_PRESENT(tp, BSSGP_IE_LOCATION_AREA)) {
378 peer = peer_by_lac(TLVP_VAL(tp, BSSGP_IE_LOCATION_AREA));
Harald Welte4cf12e92010-05-13 14:14:56 +0200379 LOGPC(DGPRS, LOGL_INFO, "routing by LAC to peer BVCI=%u\n",
Holger Hans Peter Freyther62eaf542010-06-08 16:30:24 +0800380 peer ? peer->bvci : -1);
Harald Welte9f75c352010-04-30 20:26:32 +0200381 } else
Harald Welte4cf12e92010-05-13 14:14:56 +0200382 LOGPC(DGPRS, LOGL_INFO, "\n");
383
384 if (!peer) {
385 LOGP(DGPRS, LOGL_ERROR, "NSEI=%u(SGSN) BSSGP PAGING: "
386 "unable to route, missing IE\n", nsvc->nsei);
Harald Welte9f75c352010-04-30 20:26:32 +0200387 return -EINVAL;
Harald Welte4cf12e92010-05-13 14:14:56 +0200388 }
389 return gbprox_relay2peer(msg, peer, ns_bvci);
Harald Welte9f75c352010-04-30 20:26:32 +0200390}
391
Harald Welte0a4050c2010-05-11 10:01:17 +0200392/* Receive an incoming BVC-RESET message from the SGSN */
393static int rx_reset_from_sgsn(struct msgb *msg, struct tlv_parsed *tp,
394 struct gprs_nsvc *nsvc, uint16_t ns_bvci)
395{
396 struct gbprox_peer *peer;
397 uint16_t ptp_bvci;
398
399 if (!TLVP_PRESENT(tp, BSSGP_IE_BVCI)) {
400 return bssgp_tx_status(BSSGP_CAUSE_MISSING_MAND_IE,
401 NULL, msg);
402 }
Holger Hans Peter Freytherffd68562012-09-04 20:42:20 +0200403 ptp_bvci = ntohs(tlvp_val16_unal(tp, BSSGP_IE_BVCI));
Harald Welte0a4050c2010-05-11 10:01:17 +0200404
405 if (ptp_bvci >= 2) {
406 /* A reset for a PTP BVC was received, forward it to its
407 * respective peer */
408 peer = peer_by_bvci(ptp_bvci);
409 if (!peer) {
Harald Welte4cf12e92010-05-13 14:14:56 +0200410 LOGP(DGPRS, LOGL_ERROR, "NSEI=%u BVCI=%u: Cannot find BSS\n",
411 nsvc->nsei, ptp_bvci);
Harald Welte0a4050c2010-05-11 10:01:17 +0200412 return bssgp_tx_status(BSSGP_CAUSE_UNKNOWN_BVCI,
413 NULL, msg);
414 }
415 return gbprox_relay2peer(msg, peer, ns_bvci);
416 }
417
418 /* A reset for the Signalling entity has been received
419 * from the SGSN. As the signalling BVCI is shared
420 * among all the BSS's that we multiplex, it needs to
421 * be relayed */
422 llist_for_each_entry(peer, &gbprox_bts_peers, list)
423 gbprox_relay2peer(msg, peer, ns_bvci);
424
425 return 0;
426}
427
Harald Welte9f75c352010-04-30 20:26:32 +0200428/* Receive an incoming signalling message from the SGSN-side NS-VC */
429static int gbprox_rx_sig_from_sgsn(struct msgb *msg, struct gprs_nsvc *nsvc,
430 uint16_t ns_bvci)
431{
Harald Welteca3620a2010-05-03 16:30:59 +0200432 struct bssgp_normal_hdr *bgph = (struct bssgp_normal_hdr *) msgb_bssgph(msg);
Harald Welte9f75c352010-04-30 20:26:32 +0200433 struct tlv_parsed tp;
434 uint8_t pdu_type = bgph->pdu_type;
Harald Welteca3620a2010-05-03 16:30:59 +0200435 int data_len = msgb_bssgp_len(msg) - sizeof(*bgph);
Harald Welte9f75c352010-04-30 20:26:32 +0200436 struct gbprox_peer *peer;
437 uint16_t bvci;
438 int rc = 0;
439
Harald Weltec471d3d2011-02-06 17:13:12 +0100440 if (ns_bvci != 0 && ns_bvci != 1) {
Harald Welte4cf12e92010-05-13 14:14:56 +0200441 LOGP(DGPRS, LOGL_NOTICE, "NSEI=%u(SGSN) BVCI=%u is not "
Harald Welte44c48302010-05-03 19:22:32 +0200442 "signalling\n", nsvc->nsei, ns_bvci);
Harald Welte0a4050c2010-05-11 10:01:17 +0200443 /* FIXME: Send proper error message */
Harald Welte9f75c352010-04-30 20:26:32 +0200444 return -EINVAL;
445 }
446
447 /* we actually should never see those two for BVCI == 0, but double-check
448 * just to make sure */
449 if (pdu_type == BSSGP_PDUT_UL_UNITDATA ||
450 pdu_type == BSSGP_PDUT_DL_UNITDATA) {
Harald Welte44c48302010-05-03 19:22:32 +0200451 LOGP(DGPRS, LOGL_NOTICE, "NSEI=%u(SGSN) UNITDATA not allowed in "
452 "signalling\n", nsvc->nsei);
Harald Welte0a4050c2010-05-11 10:01:17 +0200453 return bssgp_tx_status(BSSGP_CAUSE_PROTO_ERR_UNSPEC, NULL, msg);
Harald Welte9f75c352010-04-30 20:26:32 +0200454 }
455
456 rc = bssgp_tlv_parse(&tp, bgph->data, data_len);
457
458 switch (pdu_type) {
Harald Welte0a4050c2010-05-11 10:01:17 +0200459 case BSSGP_PDUT_BVC_RESET:
460 rc = rx_reset_from_sgsn(msg, &tp, nsvc, ns_bvci);
461 break;
Harald Welte9f75c352010-04-30 20:26:32 +0200462 case BSSGP_PDUT_FLUSH_LL:
Harald Welte9f75c352010-04-30 20:26:32 +0200463 case BSSGP_PDUT_BVC_RESET_ACK:
464 /* simple case: BVCI IE is mandatory */
465 if (!TLVP_PRESENT(&tp, BSSGP_IE_BVCI))
466 goto err_mand_ie;
Holger Hans Peter Freytherffd68562012-09-04 20:42:20 +0200467 bvci = ntohs(tlvp_val16_unal(&tp, BSSGP_IE_BVCI));
Harald Welte69619e32010-05-03 19:05:10 +0200468 rc = gbprox_relay2bvci(msg, bvci, ns_bvci);
Harald Welte9f75c352010-04-30 20:26:32 +0200469 break;
470 case BSSGP_PDUT_PAGING_PS:
471 case BSSGP_PDUT_PAGING_CS:
472 /* process the paging request (LAC/RAC lookup) */
473 rc = gbprox_rx_paging(msg, &tp, nsvc, ns_bvci);
474 break;
475 case BSSGP_PDUT_STATUS:
Harald Welte0a4050c2010-05-11 10:01:17 +0200476 /* Some exception has occurred */
Harald Welte44c48302010-05-03 19:22:32 +0200477 LOGP(DGPRS, LOGL_NOTICE,
Harald Welte4cf12e92010-05-13 14:14:56 +0200478 "NSEI=%u(SGSN) BSSGP STATUS ", nsvc->nsei);
Harald Welte0a4050c2010-05-11 10:01:17 +0200479 if (!TLVP_PRESENT(&tp, BSSGP_IE_CAUSE)) {
480 LOGPC(DGPRS, LOGL_NOTICE, "\n");
481 goto err_mand_ie;
482 }
483 LOGPC(DGPRS, LOGL_NOTICE,
484 "cause=0x%02x(%s) ", *TLVP_VAL(&tp, BSSGP_IE_CAUSE),
485 bssgp_cause_str(*TLVP_VAL(&tp, BSSGP_IE_CAUSE)));
486 if (TLVP_PRESENT(&tp, BSSGP_IE_BVCI)) {
Holger Hans Peter Freytherffd68562012-09-04 20:42:20 +0200487 uint16_t bvci = tlvp_val16_unal(&tp, BSSGP_IE_BVCI);
Harald Welte0a4050c2010-05-11 10:01:17 +0200488 LOGPC(DGPRS, LOGL_NOTICE,
Holger Hans Peter Freytherffd68562012-09-04 20:42:20 +0200489 "BVCI=%u\n", ntohs(bvci));
Harald Welte0a4050c2010-05-11 10:01:17 +0200490 } else
491 LOGPC(DGPRS, LOGL_NOTICE, "\n");
Harald Welte9f75c352010-04-30 20:26:32 +0200492 break;
493 /* those only exist in the SGSN -> BSS direction */
494 case BSSGP_PDUT_SUSPEND_ACK:
495 case BSSGP_PDUT_SUSPEND_NACK:
496 case BSSGP_PDUT_RESUME_ACK:
497 case BSSGP_PDUT_RESUME_NACK:
498 /* RAC IE is mandatory */
499 if (!TLVP_PRESENT(&tp, BSSGP_IE_ROUTEING_AREA))
500 goto err_mand_ie;
501 peer = peer_by_rac(TLVP_VAL(&tp, BSSGP_IE_ROUTEING_AREA));
502 if (!peer)
503 goto err_no_peer;
Harald Welte69619e32010-05-03 19:05:10 +0200504 rc = gbprox_relay2peer(msg, peer, ns_bvci);
Harald Welte9f75c352010-04-30 20:26:32 +0200505 break;
Harald Welte36f98d92011-02-06 13:09:29 +0100506 case BSSGP_PDUT_BVC_BLOCK_ACK:
507 case BSSGP_PDUT_BVC_UNBLOCK_ACK:
508 if (!TLVP_PRESENT(&tp, BSSGP_IE_BVCI))
509 goto err_mand_ie;
Holger Hans Peter Freytherffd68562012-09-04 20:42:20 +0200510 bvci = ntohs(tlvp_val16_unal(&tp, BSSGP_IE_BVCI));
Harald Welte36f98d92011-02-06 13:09:29 +0100511 if (bvci == 0) {
512 LOGP(DGPRS, LOGL_NOTICE, "NSEI=%u(SGSN) BSSGP "
513 "%sBLOCK_ACK for signalling BVCI ?!?\n", nsvc->nsei,
514 pdu_type == BSSGP_PDUT_BVC_UNBLOCK_ACK ? "UN":"");
515 /* should we send STATUS ? */
516 } else {
517 /* Mark BVC as (un)blocked */
518 block_unblock_peer(bvci, pdu_type);
519 }
520 rc = gbprox_relay2bvci(msg, bvci, ns_bvci);
521 break;
Harald Welte9f75c352010-04-30 20:26:32 +0200522 case BSSGP_PDUT_SGSN_INVOKE_TRACE:
Harald Welte44c48302010-05-03 19:22:32 +0200523 LOGP(DGPRS, LOGL_ERROR,
Harald Welte4cf12e92010-05-13 14:14:56 +0200524 "NSEI=%u(SGSN) BSSGP INVOKE TRACE not supported\n",nsvc->nsei);
Harald Welte0a4050c2010-05-11 10:01:17 +0200525 rc = bssgp_tx_status(BSSGP_CAUSE_PDU_INCOMP_FEAT, NULL, msg);
Harald Welte9f75c352010-04-30 20:26:32 +0200526 break;
527 default:
Harald Welte72953b82010-05-12 00:20:41 +0200528 LOGP(DGPRS, LOGL_NOTICE, "BSSGP PDU type 0x%02x unknown\n",
529 pdu_type);
Harald Welte0a4050c2010-05-11 10:01:17 +0200530 rc = bssgp_tx_status(BSSGP_CAUSE_PROTO_ERR_UNSPEC, NULL, msg);
Harald Welte9f75c352010-04-30 20:26:32 +0200531 break;
532 }
533
534 return rc;
535err_mand_ie:
Harald Welte1c77c6e2010-05-03 21:37:11 +0200536 LOGP(DGPRS, LOGL_ERROR, "NSEI=%u(SGSN) missing mandatory IE\n",
537 nsvc->nsei);
Harald Welte0a4050c2010-05-11 10:01:17 +0200538 return bssgp_tx_status(BSSGP_CAUSE_MISSING_MAND_IE, NULL, msg);
Harald Welte9f75c352010-04-30 20:26:32 +0200539err_no_peer:
Harald Welte0a4050c2010-05-11 10:01:17 +0200540 LOGP(DGPRS, LOGL_ERROR, "NSEI=%u(SGSN) cannot find peer based on RAC\n",
541 nsvc->nsei);
542 return bssgp_tx_status(BSSGP_CAUSE_UNKNOWN_BVCI, NULL, msg);
Harald Welte9f75c352010-04-30 20:26:32 +0200543}
544
545/* Main input function for Gb proxy */
546int gbprox_rcvmsg(struct msgb *msg, struct gprs_nsvc *nsvc, uint16_t ns_bvci)
547{
Harald Welte672f5c42010-05-03 18:54:58 +0200548 int rc;
Harald Welte36f98d92011-02-06 13:09:29 +0100549 struct gbprox_peer *peer;
Harald Welte9f75c352010-04-30 20:26:32 +0200550
551 /* Only BVCI=0 messages need special treatment */
552 if (ns_bvci == 0 || ns_bvci == 1) {
553 if (nsvc->remote_end_is_sgsn)
Harald Welte672f5c42010-05-03 18:54:58 +0200554 rc = gbprox_rx_sig_from_sgsn(msg, nsvc, ns_bvci);
Harald Welte9f75c352010-04-30 20:26:32 +0200555 else
Harald Welte672f5c42010-05-03 18:54:58 +0200556 rc = gbprox_rx_sig_from_bss(msg, nsvc, ns_bvci);
557 } else {
558 /* All other BVCI are PTP and thus can be simply forwarded */
Harald Welte1c77c6e2010-05-03 21:37:11 +0200559 if (!nsvc->remote_end_is_sgsn) {
Harald Welte36f98d92011-02-06 13:09:29 +0100560 return gbprox_relay2sgsn(msg, ns_bvci);
Harald Welte70f38d22010-05-01 12:10:57 +0200561 }
Harald Welte36f98d92011-02-06 13:09:29 +0100562 /* else: SGSN -> BSS direction */
563 peer = peer_by_bvci(ns_bvci);
564 if (!peer) {
565 LOGP(DGPRS, LOGL_INFO, "Allocationg new peer for "
566 "BVCI=%u via NSVC=%u/NSEI=%u\n", ns_bvci,
567 nsvc->nsvci, nsvc->nsei);
568 peer = peer_alloc(ns_bvci);
569 peer->nsvc = nsvc;
570 }
571 if (peer->blocked) {
572 LOGP(DGPRS, LOGL_NOTICE, "Dropping PDU for "
573 "blocked BVCI=%u via NSVC=%u/NSEI=%u\n",
574 ns_bvci, nsvc->nsvci, nsvc->nsei);
575 return bssgp_tx_status(BSSGP_CAUSE_BVCI_BLOCKED, NULL, msg);
576 }
577 rc = gbprox_relay2peer(msg, peer, ns_bvci);
Harald Welte9f75c352010-04-30 20:26:32 +0200578 }
579
Harald Welte672f5c42010-05-03 18:54:58 +0200580 return rc;
Harald Welte9f75c352010-04-30 20:26:32 +0200581}
Harald Welte85801d02010-05-11 05:49:43 +0200582
Harald Welte1ccbf442010-05-14 11:53:08 +0000583int gbprox_reset_persistent_nsvcs(struct gprs_ns_inst *nsi)
584{
585 struct gprs_nsvc *nsvc;
586
587 llist_for_each_entry(nsvc, &nsi->gprs_nsvcs, list) {
588 if (!nsvc->persistent)
589 continue;
590 gprs_nsvc_reset(nsvc, NS_CAUSE_OM_INTERVENTION);
591 }
592 return 0;
593}
594
Harald Weltec1c1dd22010-05-11 06:34:24 +0200595/* Signal handler for signals from NS layer */
596int gbprox_signal(unsigned int subsys, unsigned int signal,
597 void *handler_data, void *signal_data)
598{
599 struct ns_signal_data *nssd = signal_data;
600 struct gprs_nsvc *nsvc = nssd->nsvc;
601 struct gbprox_peer *peer;
602
Harald Weltea6a20b42012-06-16 16:40:42 +0800603 if (subsys != SS_L_NS)
Harald Weltec1c1dd22010-05-11 06:34:24 +0200604 return 0;
605
Harald Weltef69c0592010-05-11 18:29:44 +0200606 if (signal == S_NS_RESET && nsvc->nsei == gbcfg.nsip_sgsn_nsei) {
607 /* We have received a NS-RESET from the NSEI and NSVC
608 * of the SGSN. This might happen with SGSN that start
609 * their own NS-RESET procedure without waiting for our
610 * NS-RESET */
611 nsvc->remote_end_is_sgsn = 1;
612 }
613
Harald Welteb778d2c2010-05-12 13:28:25 +0000614 if (signal == S_NS_ALIVE_EXP && nsvc->remote_end_is_sgsn) {
615 LOGP(DGPRS, LOGL_NOTICE, "Tns alive expired too often, "
616 "re-starting RESET procedure\n");
Harald Weltee6599ee2012-06-17 12:25:53 +0800617 gprs_ns_nsip_connect(nsvc->nsi, &nsvc->ip.bts_addr,
618 nsvc->nsei, nsvc->nsvci);
Harald Welteb778d2c2010-05-12 13:28:25 +0000619 }
620
Harald Welte5e106d72011-02-06 16:33:29 +0100621 if (!nsvc->remote_end_is_sgsn) {
622 /* from BSS to SGSN */
623 peer = peer_by_nsvc(nsvc);
624 if (!peer) {
625 LOGP(DGPRS, LOGL_NOTICE, "signal %u for unknown peer "
626 "NSEI=%u/NSVCI=%u\n", signal, nsvc->nsei,
627 nsvc->nsvci);
628 return 0;
629 }
Harald Weltec1c1dd22010-05-11 06:34:24 +0200630 switch (signal) {
631 case S_NS_RESET:
Harald Weltec1c1dd22010-05-11 06:34:24 +0200632 case S_NS_BLOCK:
Harald Welte5e106d72011-02-06 16:33:29 +0100633 if (!peer->blocked)
634 break;
635 LOGP(DGPRS, LOGL_NOTICE, "Converting NS_RESET from "
636 "NSEI=%u/NSVCI=%u into BSSGP_BVC_BLOCK to SGSN\n",
637 nsvc->nsei, nsvc->nsvci);
638 bssgp_tx_simple_bvci(BSSGP_PDUT_BVC_BLOCK, nsvc->nsei,
639 peer->bvci, 0);
Harald Weltec1c1dd22010-05-11 06:34:24 +0200640 break;
Harald Welte5e106d72011-02-06 16:33:29 +0100641 }
642 } else {
643 /* iterate over all BTS peers and send the respective PDU */
644 llist_for_each_entry(peer, &gbprox_bts_peers, list) {
645 switch (signal) {
646 case S_NS_RESET:
647 gprs_ns_tx_reset(peer->nsvc, nssd->cause);
648 break;
649 case S_NS_BLOCK:
650 gprs_ns_tx_block(peer->nsvc, nssd->cause);
651 break;
652 case S_NS_UNBLOCK:
653 gprs_ns_tx_unblock(peer->nsvc);
654 break;
655 }
Harald Weltec1c1dd22010-05-11 06:34:24 +0200656 }
657 }
658 return 0;
659}
660
Harald Welte85801d02010-05-11 05:49:43 +0200661
Harald Welte4b037e42010-05-19 19:45:32 +0200662#include <osmocom/vty/command.h>
Harald Welte85801d02010-05-11 05:49:43 +0200663
664gDEFUN(show_gbproxy, show_gbproxy_cmd, "show gbproxy",
665 SHOW_STR "Display information about the Gb proxy")
666{
667 struct gbprox_peer *peer;
668
669 llist_for_each_entry(peer, &gbprox_bts_peers, list) {
670 struct gprs_nsvc *nsvc = peer->nsvc;
671 struct gprs_ra_id raid;
Harald Welte7fc98222010-05-11 10:15:42 +0200672 gsm48_parse_ra(&raid, peer->ra);
Harald Welte85801d02010-05-11 05:49:43 +0200673
Harald Welte268bed02010-05-19 17:42:20 +0200674 vty_out(vty, "NSEI %5u, NS-VC %5u, PTP-BVCI %5u, "
Harald Welte7570c212010-05-19 17:06:16 +0200675 "RAC %u-%u-%u-%u",
Harald Welte85801d02010-05-11 05:49:43 +0200676 nsvc->nsei, nsvc->nsvci, peer->bvci,
Harald Welte7570c212010-05-19 17:06:16 +0200677 raid.mcc, raid.mnc, raid.lac, raid.rac);
678 if (nsvc->ll == GPRS_NS_LL_UDP || nsvc->ll == GPRS_NS_LL_FR_GRE)
Harald Weltef3956cb2011-02-06 17:44:14 +0100679 vty_out(vty, " %s:%u",
Harald Welte85801d02010-05-11 05:49:43 +0200680 inet_ntoa(nsvc->ip.bts_addr.sin_addr),
Harald Weltef3956cb2011-02-06 17:44:14 +0100681 ntohs(nsvc->ip.bts_addr.sin_port));
682 if (peer->blocked)
683 vty_out(vty, " [BVC-BLOCKED]");
684
685 vty_out(vty, "%s", VTY_NEWLINE);
Harald Welte85801d02010-05-11 05:49:43 +0200686 }
687 return CMD_SUCCESS;
688}