blob: 934ceef68b516013fd58551afe815f3ad23c818a [file] [log] [blame]
Harald Welted1991e72010-04-30 20:26:32 +02001/* NS-over-IP proxy */
2
3/* (C) 2010 by Harald Welte <laforge@gnumonks.org>
Holger Hans Peter Freyther51808442010-10-06 20:37:09 +08004 * (C) 2010 by On-Waves
Harald Welted1991e72010-04-30 20:26:32 +02005 * All Rights Reserved
6 *
7 * This program is free software; you can redistribute it and/or modify
Harald Welte0e3e88e2011-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 Welted1991e72010-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 Welte0e3e88e2011-01-01 15:25:50 +010015 * GNU Affero General Public License for more details.
Harald Welted1991e72010-04-30 20:26:32 +020016 *
Harald Welte0e3e88e2011-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 Welted1991e72010-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>
30#include <sys/types.h>
Harald Weltef2fdefe2010-05-11 10:15:42 +020031#include <arpa/inet.h>
Harald Welted1991e72010-04-30 20:26:32 +020032
33#include <osmocore/talloc.h>
34#include <osmocore/select.h>
35
36#include <openbsc/signal.h>
37#include <openbsc/debug.h>
38#include <openbsc/gprs_ns.h>
39#include <openbsc/gprs_bssgp.h>
Harald Weltef01709d2010-05-03 18:54:58 +020040#include <openbsc/gb_proxy.h>
Harald Welted1991e72010-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;
50
51 /* Routeing Area that this peer is part of (raw 04.08 encoding) */
52 uint8_t ra[6];
53};
54
55/* Linked list of all Gb peers (except SGSN) */
56static LLIST_HEAD(gbprox_bts_peers);
57
Harald Welted1991e72010-04-30 20:26:32 +020058/* Find the gbprox_peer by its BVCI */
59static struct gbprox_peer *peer_by_bvci(uint16_t bvci)
60{
61 struct gbprox_peer *peer;
62 llist_for_each_entry(peer, &gbprox_bts_peers, list) {
63 if (peer->bvci == bvci)
64 return peer;
65 }
66 return NULL;
67}
68
69static struct gbprox_peer *peer_by_nsvc(struct gprs_nsvc *nsvc)
70{
71 struct gbprox_peer *peer;
72 llist_for_each_entry(peer, &gbprox_bts_peers, list) {
73 if (peer->nsvc == nsvc)
74 return peer;
75 }
76 return NULL;
77}
78
79/* look-up a peer by its Routeing Area Code (RAC) */
Harald Weltee49c8292010-05-01 12:10:57 +020080static struct gbprox_peer *peer_by_rac(const uint8_t *ra)
Harald Welted1991e72010-04-30 20:26:32 +020081{
82 struct gbprox_peer *peer;
83 llist_for_each_entry(peer, &gbprox_bts_peers, list) {
Harald Welte8ba9d2d2010-05-12 00:07:29 +020084 if (!memcmp(peer->ra, ra, 6))
Harald Welted1991e72010-04-30 20:26:32 +020085 return peer;
86 }
87 return NULL;
88}
89
90/* look-up a peer by its Location Area Code (LAC) */
Harald Weltee49c8292010-05-01 12:10:57 +020091static struct gbprox_peer *peer_by_lac(const uint8_t *la)
Harald Welted1991e72010-04-30 20:26:32 +020092{
93 struct gbprox_peer *peer;
94 llist_for_each_entry(peer, &gbprox_bts_peers, list) {
Harald Welte8ba9d2d2010-05-12 00:07:29 +020095 if (!memcmp(peer->ra, la, 5))
Harald Welted1991e72010-04-30 20:26:32 +020096 return peer;
97 }
98 return NULL;
99}
100
101static struct gbprox_peer *peer_alloc(uint16_t bvci)
102{
103 struct gbprox_peer *peer;
104
105 peer = talloc_zero(tall_bsc_ctx, struct gbprox_peer);
106 if (!peer)
107 return NULL;
108
109 peer->bvci = bvci;
110 llist_add(&peer->list, &gbprox_bts_peers);
111
112 return peer;
113}
114
115static void peer_free(struct gbprox_peer *peer)
116{
117 llist_del(&peer->list);
118 talloc_free(peer);
119}
120
Harald Welte3fb22d62010-05-12 18:10:25 +0000121/* FIXME: this needs to go to libosmocore/msgb.c */
122static struct msgb *msgb_copy(const struct msgb *msg, const char *name)
123{
Holger Hans Peter Freyther337f4d52010-06-08 18:14:37 +0800124 struct openbsc_msgb_cb *old_cb, *new_cb;
Harald Welte3fb22d62010-05-12 18:10:25 +0000125 struct msgb *new_msg;
126
Holger Hans Peter Freyther337f4d52010-06-08 18:14:37 +0800127 new_msg = msgb_alloc(msg->data_len, name);
Harald Welte3fb22d62010-05-12 18:10:25 +0000128 if (!new_msg)
129 return NULL;
130
Harald Welte3fb22d62010-05-12 18:10:25 +0000131 /* copy data */
Holger Hans Peter Freyther337f4d52010-06-08 18:14:37 +0800132 memcpy(new_msg->_data, msg->_data, new_msg->data_len);
133
134 /* copy header */
135 new_msg->len = msg->len;
136 new_msg->data += msg->data - msg->_data;
137 new_msg->head += msg->head - msg->_data;
138 new_msg->tail += msg->tail - msg->_data;
139
140 new_msg->l1h = new_msg->_data + (msg->l1h - msg->_data);
141 new_msg->l2h = new_msg->_data + (msg->l2h - msg->_data);
142 new_msg->l3h = new_msg->_data + (msg->l3h - msg->_data);
143 new_msg->l4h = new_msg->_data + (msg->l4h - msg->_data);
144
145 /* copy GB specific data */
146 old_cb = OBSC_MSGB_CB(msg);
147 new_cb = OBSC_MSGB_CB(new_msg);
148
149 new_cb->bssgph = new_msg->_data + (old_cb->bssgph - msg->_data);
150 new_cb->llch = new_msg->_data + (old_cb->llch - msg->_data);
151
152 new_cb->bssgp_cell_id = old_cb->bssgp_cell_id;
153 new_cb->nsei = old_cb->nsei;
154 new_cb->bvci = old_cb->bvci;
155 new_cb->tlli = old_cb->tlli;
Harald Welte3fb22d62010-05-12 18:10:25 +0000156
157 return new_msg;
158}
159
Harald Welte3ad32432010-05-03 19:05:10 +0200160/* strip off the NS header */
161static void strip_ns_hdr(struct msgb *msg)
162{
163 int strip_len = msgb_bssgph(msg) - msg->data;
164 msgb_pull(msg, strip_len);
165}
166
Harald Welted1991e72010-04-30 20:26:32 +0200167/* feed a message down the NS-VC associated with the specified peer */
Harald Welte3fb22d62010-05-12 18:10:25 +0000168static int gbprox_relay2sgsn(struct msgb *old_msg, uint16_t ns_bvci)
Harald Weltef01709d2010-05-03 18:54:58 +0200169{
Harald Welte3fb22d62010-05-12 18:10:25 +0000170 /* create a copy of the message so the old one can
171 * be free()d safely when we return from gbprox_rcvmsg() */
172 struct msgb *msg = msgb_copy(old_msg, "msgb_relay2sgsn");
173
Harald Welteb8da0612010-05-11 20:20:13 +0200174 DEBUGP(DGPRS, "NSEI=%u proxying BTS->SGSN (NS_BVCI=%u, NSEI=%u)\n",
Harald Weltee661b272010-05-03 19:28:05 +0200175 msgb_nsei(msg), ns_bvci, gbcfg.nsip_sgsn_nsei);
Harald Welte6aa24d12010-05-03 19:22:32 +0200176
Harald Weltef01709d2010-05-03 18:54:58 +0200177 msgb_bvci(msg) = ns_bvci;
178 msgb_nsei(msg) = gbcfg.nsip_sgsn_nsei;
179
Harald Welte3ad32432010-05-03 19:05:10 +0200180 strip_ns_hdr(msg);
181
Harald Welte874acec2010-05-11 10:01:17 +0200182 return gprs_ns_sendmsg(bssgp_nsi, msg);
Harald Weltef01709d2010-05-03 18:54:58 +0200183}
184
Harald Weltef01709d2010-05-03 18:54:58 +0200185/* feed a message down the NS-VC associated with the specified peer */
Harald Welte3fb22d62010-05-12 18:10:25 +0000186static int gbprox_relay2peer(struct msgb *old_msg, struct gbprox_peer *peer,
Harald Welted1991e72010-04-30 20:26:32 +0200187 uint16_t ns_bvci)
188{
Harald Welte3fb22d62010-05-12 18:10:25 +0000189 /* create a copy of the message so the old one can
190 * be free()d safely when we return from gbprox_rcvmsg() */
191 struct msgb *msg = msgb_copy(old_msg, "msgb_relay2peer");
192
Harald Welte0cc900d2010-05-13 10:34:56 +0200193 DEBUGP(DGPRS, "NSEI=%u proxying SGSN->BSS (NS_BVCI=%u, NSEI=%u)\n",
Harald Weltee661b272010-05-03 19:28:05 +0200194 msgb_nsei(msg), ns_bvci, peer->nsvc->nsei);
Harald Welte6aa24d12010-05-03 19:22:32 +0200195
Harald Welted1991e72010-04-30 20:26:32 +0200196 msgb_bvci(msg) = ns_bvci;
197 msgb_nsei(msg) = peer->nsvc->nsei;
198
Harald Welte0cc900d2010-05-13 10:34:56 +0200199 /* Strip the old NS header, it will be replaced with a new one */
Harald Welte3ad32432010-05-03 19:05:10 +0200200 strip_ns_hdr(msg);
201
Harald Welte874acec2010-05-11 10:01:17 +0200202 return gprs_ns_sendmsg(bssgp_nsi, msg);
Harald Welted1991e72010-04-30 20:26:32 +0200203}
204
205/* Send a message to a peer identified by ptp_bvci but using ns_bvci
206 * in the NS hdr */
Harald Welte3ad32432010-05-03 19:05:10 +0200207static int gbprox_relay2bvci(struct msgb *msg, uint16_t ptp_bvci,
Harald Welted1991e72010-04-30 20:26:32 +0200208 uint16_t ns_bvci)
209{
210 struct gbprox_peer *peer;
211
212 peer = peer_by_bvci(ptp_bvci);
Harald Welte0358aae2010-05-03 21:37:11 +0200213 if (!peer) {
Harald Welte93048cf2010-05-13 14:14:56 +0200214 LOGP(DGPRS, LOGL_ERROR, "BVCI=%u: Cannot find BSS\n",
Harald Welte0358aae2010-05-03 21:37:11 +0200215 ptp_bvci);
Harald Welted1991e72010-04-30 20:26:32 +0200216 return -ENOENT;
Harald Welte0358aae2010-05-03 21:37:11 +0200217 }
Harald Welted1991e72010-04-30 20:26:32 +0200218
Harald Welte3ad32432010-05-03 19:05:10 +0200219 return gbprox_relay2peer(msg, peer, ns_bvci);
Harald Welted1991e72010-04-30 20:26:32 +0200220}
221
222/* Receive an incoming signalling message from a BSS-side NS-VC */
223static int gbprox_rx_sig_from_bss(struct msgb *msg, struct gprs_nsvc *nsvc,
224 uint16_t ns_bvci)
225{
Harald Welte2ac2e912010-05-03 16:30:59 +0200226 struct bssgp_normal_hdr *bgph = (struct bssgp_normal_hdr *) msgb_bssgph(msg);
Harald Welted1991e72010-04-30 20:26:32 +0200227 struct tlv_parsed tp;
228 uint8_t pdu_type = bgph->pdu_type;
Harald Welte2ac2e912010-05-03 16:30:59 +0200229 int data_len = msgb_bssgp_len(msg) - sizeof(*bgph);
Harald Welted1991e72010-04-30 20:26:32 +0200230 struct gbprox_peer *from_peer;
Harald Weltee49c8292010-05-01 12:10:57 +0200231 struct gprs_ra_id raid;
Harald Welted1991e72010-04-30 20:26:32 +0200232
233 if (ns_bvci != 0) {
Harald Welte93048cf2010-05-13 14:14:56 +0200234 LOGP(DGPRS, LOGL_NOTICE, "NSEI=%u BVCI=%u is not signalling\n",
Harald Welte6aa24d12010-05-03 19:22:32 +0200235 nsvc->nsei, ns_bvci);
Harald Welted1991e72010-04-30 20:26:32 +0200236 return -EINVAL;
237 }
238
239 /* we actually should never see those two for BVCI == 0, but double-check
240 * just to make sure */
241 if (pdu_type == BSSGP_PDUT_UL_UNITDATA ||
242 pdu_type == BSSGP_PDUT_DL_UNITDATA) {
Harald Welte6aa24d12010-05-03 19:22:32 +0200243 LOGP(DGPRS, LOGL_NOTICE, "NSEI=%u UNITDATA not allowed in "
244 "signalling\n", nsvc->nsei);
Harald Welted1991e72010-04-30 20:26:32 +0200245 return -EINVAL;
246 }
247
248 bssgp_tlv_parse(&tp, bgph->data, data_len);
249
250 switch (pdu_type) {
251 case BSSGP_PDUT_SUSPEND:
252 case BSSGP_PDUT_RESUME:
Harald Weltee49c8292010-05-01 12:10:57 +0200253 /* We implement RAC snooping during SUSPEND/RESUME, since
254 * it establishes a relationsip between BVCI/peer and the
255 * routeing area code. The snooped information is then
256 * used for routing the {SUSPEND,RESUME}_[N]ACK back to
257 * the correct BSSGP */
Harald Welted1991e72010-04-30 20:26:32 +0200258 if (!TLVP_PRESENT(&tp, BSSGP_IE_ROUTEING_AREA))
259 goto err_mand_ie;
260 from_peer = peer_by_nsvc(nsvc);
261 if (!from_peer)
262 goto err_no_peer;
Harald Welte8ba9d2d2010-05-12 00:07:29 +0200263 memcpy(from_peer->ra, TLVP_VAL(&tp, BSSGP_IE_ROUTEING_AREA),
264 sizeof(from_peer->ra));
Harald Weltef2fdefe2010-05-11 10:15:42 +0200265 gsm48_parse_ra(&raid, from_peer->ra);
Harald Welte93048cf2010-05-13 14:14:56 +0200266 LOGP(DGPRS, LOGL_INFO, "NSEI=%u BSSGP SUSPEND/RESUME "
267 "RAC snooping: RAC %u-%u-%u-%u behind BVCI=%u, "
268 "NSVCI=%u\n",nsvc->nsei, raid.mcc, raid.mnc, raid.lac,
269 raid.rac , from_peer->bvci, nsvc->nsvci);
Harald Welted1991e72010-04-30 20:26:32 +0200270 /* FIXME: This only supports one BSS per RA */
271 break;
Harald Welte6aa24d12010-05-03 19:22:32 +0200272 case BSSGP_PDUT_BVC_RESET:
273 /* If we receive a BVC reset on the signalling endpoint, we
274 * don't want the SGSN to reset, as the signalling endpoint
275 * is common for all point-to-point BVCs (and thus all BTS) */
276 if (TLVP_PRESENT(&tp, BSSGP_IE_BVCI)) {
277 uint16_t bvci = ntohs(*(uint16_t *)TLVP_VAL(&tp, BSSGP_IE_BVCI));
Harald Weltebe6e25a2010-05-12 00:20:41 +0200278 LOGP(DGPRS, LOGL_INFO, "NSEI=%u Rx BVC RESET (BVCI=%u)\n",
Harald Welteb8da0612010-05-11 20:20:13 +0200279 nsvc->nsei, bvci);
Harald Welte6aa24d12010-05-03 19:22:32 +0200280 if (bvci == 0) {
281 /* FIXME: only do this if SGSN is alive! */
Harald Welteb8da0612010-05-11 20:20:13 +0200282 LOGP(DGPRS, LOGL_INFO, "NSEI=%u Tx fake "
Harald Welte6aa24d12010-05-03 19:22:32 +0200283 "BVC RESET ACK of BVCI=0\n", nsvc->nsei);
284 return bssgp_tx_simple_bvci(BSSGP_PDUT_BVC_RESET_ACK,
285 nsvc->nsei, 0, ns_bvci);
Harald Welte8ba9d2d2010-05-12 00:07:29 +0200286 }
287 from_peer = peer_by_bvci(bvci);
288 if (!from_peer) {
Harald Welte0358aae2010-05-03 21:37:11 +0200289 /* if a PTP-BVC is reset, and we don't know that
290 * PTP-BVCI yet, we should allocate a new peer */
291 LOGP(DGPRS, LOGL_INFO, "Allocationg new peer for "
292 "BVCI=%u via NSVCI=%u/NSEI=%u\n", bvci,
293 nsvc->nsvci, nsvc->nsei);
294 from_peer = peer_alloc(bvci);
295 from_peer->nsvc = nsvc;
Harald Welte6aa24d12010-05-03 19:22:32 +0200296 }
Harald Welte8ba9d2d2010-05-12 00:07:29 +0200297 if (TLVP_PRESENT(&tp, BSSGP_IE_CELL_ID)) {
298 struct gprs_ra_id raid;
299 /* We have a Cell Identifier present in this
300 * PDU, this means we can extend our local
301 * state information about this particular cell
302 * */
303 memcpy(from_peer->ra,
304 TLVP_VAL(&tp, BSSGP_IE_CELL_ID),
305 sizeof(from_peer->ra));
306 gsm48_parse_ra(&raid, from_peer->ra);
307 LOGP(DGPRS, LOGL_INFO, "NSEI=%u/BVCI=%u "
Harald Weltebe6e25a2010-05-12 00:20:41 +0200308 "Cell ID %u-%u-%u-%u\n", nsvc->nsei,
Harald Welte8ba9d2d2010-05-12 00:07:29 +0200309 bvci, raid.mcc, raid.mnc, raid.lac,
310 raid.rac);
311 }
Harald Welte6aa24d12010-05-03 19:22:32 +0200312 }
313 break;
Harald Welted1991e72010-04-30 20:26:32 +0200314 }
315
Harald Welteb8da0612010-05-11 20:20:13 +0200316 /* Normally, we can simply pass on all signalling messages from BSS to
317 * SGSN */
Harald Welte3ad32432010-05-03 19:05:10 +0200318 return gbprox_relay2sgsn(msg, ns_bvci);
Harald Welted1991e72010-04-30 20:26:32 +0200319err_no_peer:
Harald Welte874acec2010-05-11 10:01:17 +0200320 LOGP(DGPRS, LOGL_ERROR, "NSEI=%u(BSS) cannot find peer based on RAC\n",
321 nsvc->nsei);
322 return bssgp_tx_status(BSSGP_CAUSE_UNKNOWN_BVCI, NULL, msg);
Harald Welted1991e72010-04-30 20:26:32 +0200323err_mand_ie:
Harald Welte874acec2010-05-11 10:01:17 +0200324 LOGP(DGPRS, LOGL_ERROR, "NSEI=%u(BSS) missing mandatory RA IE\n",
325 nsvc->nsei);
326 return bssgp_tx_status(BSSGP_CAUSE_MISSING_MAND_IE, NULL, msg);
Harald Welted1991e72010-04-30 20:26:32 +0200327}
328
329/* Receive paging request from SGSN, we need to relay to proper BSS */
330static int gbprox_rx_paging(struct msgb *msg, struct tlv_parsed *tp,
331 struct gprs_nsvc *nsvc, uint16_t ns_bvci)
332{
Harald Welte93048cf2010-05-13 14:14:56 +0200333 struct gbprox_peer *peer = NULL;
Harald Welted1991e72010-04-30 20:26:32 +0200334
Harald Welte93048cf2010-05-13 14:14:56 +0200335 LOGP(DGPRS, LOGL_INFO, "NSEI=%u(SGSN) BSSGP PAGING ",
336 nsvc->nsei);
Harald Welted1991e72010-04-30 20:26:32 +0200337 if (TLVP_PRESENT(tp, BSSGP_IE_BVCI)) {
338 uint16_t bvci = ntohs(*(uint16_t *)TLVP_VAL(tp, BSSGP_IE_BVCI));
Harald Welte93048cf2010-05-13 14:14:56 +0200339 LOGPC(DGPRS, LOGL_INFO, "routing by BVCI to peer BVCI=%u\n",
340 bvci);
Harald Welted1991e72010-04-30 20:26:32 +0200341 } else if (TLVP_PRESENT(tp, BSSGP_IE_ROUTEING_AREA)) {
342 peer = peer_by_rac(TLVP_VAL(tp, BSSGP_IE_ROUTEING_AREA));
Harald Welte93048cf2010-05-13 14:14:56 +0200343 LOGPC(DGPRS, LOGL_INFO, "routing by RAC to peer BVCI=%u\n",
Holger Hans Peter Freyther98b82c12010-06-08 16:30:24 +0800344 peer ? peer->bvci : -1);
Harald Welted1991e72010-04-30 20:26:32 +0200345 } else if (TLVP_PRESENT(tp, BSSGP_IE_LOCATION_AREA)) {
346 peer = peer_by_lac(TLVP_VAL(tp, BSSGP_IE_LOCATION_AREA));
Harald Welte93048cf2010-05-13 14:14:56 +0200347 LOGPC(DGPRS, LOGL_INFO, "routing by LAC to peer BVCI=%u\n",
Holger Hans Peter Freyther98b82c12010-06-08 16:30:24 +0800348 peer ? peer->bvci : -1);
Harald Welted1991e72010-04-30 20:26:32 +0200349 } else
Harald Welte93048cf2010-05-13 14:14:56 +0200350 LOGPC(DGPRS, LOGL_INFO, "\n");
351
352 if (!peer) {
353 LOGP(DGPRS, LOGL_ERROR, "NSEI=%u(SGSN) BSSGP PAGING: "
354 "unable to route, missing IE\n", nsvc->nsei);
Harald Welted1991e72010-04-30 20:26:32 +0200355 return -EINVAL;
Harald Welte93048cf2010-05-13 14:14:56 +0200356 }
357 return gbprox_relay2peer(msg, peer, ns_bvci);
Harald Welted1991e72010-04-30 20:26:32 +0200358}
359
Harald Welte874acec2010-05-11 10:01:17 +0200360/* Receive an incoming BVC-RESET message from the SGSN */
361static int rx_reset_from_sgsn(struct msgb *msg, struct tlv_parsed *tp,
362 struct gprs_nsvc *nsvc, uint16_t ns_bvci)
363{
364 struct gbprox_peer *peer;
365 uint16_t ptp_bvci;
366
367 if (!TLVP_PRESENT(tp, BSSGP_IE_BVCI)) {
368 return bssgp_tx_status(BSSGP_CAUSE_MISSING_MAND_IE,
369 NULL, msg);
370 }
371 ptp_bvci = ntohs(*(uint16_t *)TLVP_VAL(tp, BSSGP_IE_BVCI));
372
373 if (ptp_bvci >= 2) {
374 /* A reset for a PTP BVC was received, forward it to its
375 * respective peer */
376 peer = peer_by_bvci(ptp_bvci);
377 if (!peer) {
Harald Welte93048cf2010-05-13 14:14:56 +0200378 LOGP(DGPRS, LOGL_ERROR, "NSEI=%u BVCI=%u: Cannot find BSS\n",
379 nsvc->nsei, ptp_bvci);
Harald Welte874acec2010-05-11 10:01:17 +0200380 return bssgp_tx_status(BSSGP_CAUSE_UNKNOWN_BVCI,
381 NULL, msg);
382 }
383 return gbprox_relay2peer(msg, peer, ns_bvci);
384 }
385
386 /* A reset for the Signalling entity has been received
387 * from the SGSN. As the signalling BVCI is shared
388 * among all the BSS's that we multiplex, it needs to
389 * be relayed */
390 llist_for_each_entry(peer, &gbprox_bts_peers, list)
391 gbprox_relay2peer(msg, peer, ns_bvci);
392
393 return 0;
394}
395
Harald Welted1991e72010-04-30 20:26:32 +0200396/* Receive an incoming signalling message from the SGSN-side NS-VC */
397static int gbprox_rx_sig_from_sgsn(struct msgb *msg, struct gprs_nsvc *nsvc,
398 uint16_t ns_bvci)
399{
Harald Welte2ac2e912010-05-03 16:30:59 +0200400 struct bssgp_normal_hdr *bgph = (struct bssgp_normal_hdr *) msgb_bssgph(msg);
Harald Welted1991e72010-04-30 20:26:32 +0200401 struct tlv_parsed tp;
402 uint8_t pdu_type = bgph->pdu_type;
Harald Welte2ac2e912010-05-03 16:30:59 +0200403 int data_len = msgb_bssgp_len(msg) - sizeof(*bgph);
Harald Welted1991e72010-04-30 20:26:32 +0200404 struct gbprox_peer *peer;
405 uint16_t bvci;
406 int rc = 0;
407
408 if (ns_bvci != 0) {
Harald Welte93048cf2010-05-13 14:14:56 +0200409 LOGP(DGPRS, LOGL_NOTICE, "NSEI=%u(SGSN) BVCI=%u is not "
Harald Welte6aa24d12010-05-03 19:22:32 +0200410 "signalling\n", nsvc->nsei, ns_bvci);
Harald Welte874acec2010-05-11 10:01:17 +0200411 /* FIXME: Send proper error message */
Harald Welted1991e72010-04-30 20:26:32 +0200412 return -EINVAL;
413 }
414
415 /* we actually should never see those two for BVCI == 0, but double-check
416 * just to make sure */
417 if (pdu_type == BSSGP_PDUT_UL_UNITDATA ||
418 pdu_type == BSSGP_PDUT_DL_UNITDATA) {
Harald Welte6aa24d12010-05-03 19:22:32 +0200419 LOGP(DGPRS, LOGL_NOTICE, "NSEI=%u(SGSN) UNITDATA not allowed in "
420 "signalling\n", nsvc->nsei);
Harald Welte874acec2010-05-11 10:01:17 +0200421 return bssgp_tx_status(BSSGP_CAUSE_PROTO_ERR_UNSPEC, NULL, msg);
Harald Welted1991e72010-04-30 20:26:32 +0200422 }
423
424 rc = bssgp_tlv_parse(&tp, bgph->data, data_len);
425
426 switch (pdu_type) {
Harald Welte874acec2010-05-11 10:01:17 +0200427 case BSSGP_PDUT_BVC_RESET:
428 rc = rx_reset_from_sgsn(msg, &tp, nsvc, ns_bvci);
429 break;
Harald Welted1991e72010-04-30 20:26:32 +0200430 case BSSGP_PDUT_FLUSH_LL:
431 case BSSGP_PDUT_BVC_BLOCK_ACK:
432 case BSSGP_PDUT_BVC_UNBLOCK_ACK:
Harald Welted1991e72010-04-30 20:26:32 +0200433 case BSSGP_PDUT_BVC_RESET_ACK:
434 /* simple case: BVCI IE is mandatory */
435 if (!TLVP_PRESENT(&tp, BSSGP_IE_BVCI))
436 goto err_mand_ie;
437 bvci = ntohs(*(uint16_t *)TLVP_VAL(&tp, BSSGP_IE_BVCI));
Harald Welte3ad32432010-05-03 19:05:10 +0200438 rc = gbprox_relay2bvci(msg, bvci, ns_bvci);
Harald Welted1991e72010-04-30 20:26:32 +0200439 break;
440 case BSSGP_PDUT_PAGING_PS:
441 case BSSGP_PDUT_PAGING_CS:
442 /* process the paging request (LAC/RAC lookup) */
443 rc = gbprox_rx_paging(msg, &tp, nsvc, ns_bvci);
444 break;
445 case BSSGP_PDUT_STATUS:
Harald Welte874acec2010-05-11 10:01:17 +0200446 /* Some exception has occurred */
Harald Welte6aa24d12010-05-03 19:22:32 +0200447 LOGP(DGPRS, LOGL_NOTICE,
Harald Welte93048cf2010-05-13 14:14:56 +0200448 "NSEI=%u(SGSN) BSSGP STATUS ", nsvc->nsei);
Harald Welte874acec2010-05-11 10:01:17 +0200449 if (!TLVP_PRESENT(&tp, BSSGP_IE_CAUSE)) {
450 LOGPC(DGPRS, LOGL_NOTICE, "\n");
451 goto err_mand_ie;
452 }
453 LOGPC(DGPRS, LOGL_NOTICE,
454 "cause=0x%02x(%s) ", *TLVP_VAL(&tp, BSSGP_IE_CAUSE),
455 bssgp_cause_str(*TLVP_VAL(&tp, BSSGP_IE_CAUSE)));
456 if (TLVP_PRESENT(&tp, BSSGP_IE_BVCI)) {
Harald Weltef2fdefe2010-05-11 10:15:42 +0200457 uint16_t *bvci = (uint16_t *)
458 TLVP_VAL(&tp, BSSGP_IE_BVCI);
Harald Welte874acec2010-05-11 10:01:17 +0200459 LOGPC(DGPRS, LOGL_NOTICE,
460 "BVCI=%u\n", ntohs(*bvci));
461 } else
462 LOGPC(DGPRS, LOGL_NOTICE, "\n");
Harald Welted1991e72010-04-30 20:26:32 +0200463 break;
464 /* those only exist in the SGSN -> BSS direction */
465 case BSSGP_PDUT_SUSPEND_ACK:
466 case BSSGP_PDUT_SUSPEND_NACK:
467 case BSSGP_PDUT_RESUME_ACK:
468 case BSSGP_PDUT_RESUME_NACK:
469 /* RAC IE is mandatory */
470 if (!TLVP_PRESENT(&tp, BSSGP_IE_ROUTEING_AREA))
471 goto err_mand_ie;
472 peer = peer_by_rac(TLVP_VAL(&tp, BSSGP_IE_ROUTEING_AREA));
473 if (!peer)
474 goto err_no_peer;
Harald Welte3ad32432010-05-03 19:05:10 +0200475 rc = gbprox_relay2peer(msg, peer, ns_bvci);
Harald Welted1991e72010-04-30 20:26:32 +0200476 break;
477 case BSSGP_PDUT_SGSN_INVOKE_TRACE:
Harald Welte6aa24d12010-05-03 19:22:32 +0200478 LOGP(DGPRS, LOGL_ERROR,
Harald Welte93048cf2010-05-13 14:14:56 +0200479 "NSEI=%u(SGSN) BSSGP INVOKE TRACE not supported\n",nsvc->nsei);
Harald Welte874acec2010-05-11 10:01:17 +0200480 rc = bssgp_tx_status(BSSGP_CAUSE_PDU_INCOMP_FEAT, NULL, msg);
Harald Welted1991e72010-04-30 20:26:32 +0200481 break;
482 default:
Harald Weltebe6e25a2010-05-12 00:20:41 +0200483 LOGP(DGPRS, LOGL_NOTICE, "BSSGP PDU type 0x%02x unknown\n",
484 pdu_type);
Harald Welte874acec2010-05-11 10:01:17 +0200485 rc = bssgp_tx_status(BSSGP_CAUSE_PROTO_ERR_UNSPEC, NULL, msg);
Harald Welted1991e72010-04-30 20:26:32 +0200486 break;
487 }
488
489 return rc;
490err_mand_ie:
Harald Welte0358aae2010-05-03 21:37:11 +0200491 LOGP(DGPRS, LOGL_ERROR, "NSEI=%u(SGSN) missing mandatory IE\n",
492 nsvc->nsei);
Harald Welte874acec2010-05-11 10:01:17 +0200493 return bssgp_tx_status(BSSGP_CAUSE_MISSING_MAND_IE, NULL, msg);
Harald Welted1991e72010-04-30 20:26:32 +0200494err_no_peer:
Harald Welte874acec2010-05-11 10:01:17 +0200495 LOGP(DGPRS, LOGL_ERROR, "NSEI=%u(SGSN) cannot find peer based on RAC\n",
496 nsvc->nsei);
497 return bssgp_tx_status(BSSGP_CAUSE_UNKNOWN_BVCI, NULL, msg);
Harald Welted1991e72010-04-30 20:26:32 +0200498}
499
500/* Main input function for Gb proxy */
501int gbprox_rcvmsg(struct msgb *msg, struct gprs_nsvc *nsvc, uint16_t ns_bvci)
502{
Harald Weltef01709d2010-05-03 18:54:58 +0200503 int rc;
Harald Welted1991e72010-04-30 20:26:32 +0200504
505 /* Only BVCI=0 messages need special treatment */
506 if (ns_bvci == 0 || ns_bvci == 1) {
507 if (nsvc->remote_end_is_sgsn)
Harald Weltef01709d2010-05-03 18:54:58 +0200508 rc = gbprox_rx_sig_from_sgsn(msg, nsvc, ns_bvci);
Harald Welted1991e72010-04-30 20:26:32 +0200509 else
Harald Weltef01709d2010-05-03 18:54:58 +0200510 rc = gbprox_rx_sig_from_bss(msg, nsvc, ns_bvci);
511 } else {
512 /* All other BVCI are PTP and thus can be simply forwarded */
Harald Welte0358aae2010-05-03 21:37:11 +0200513 if (!nsvc->remote_end_is_sgsn) {
Harald Welte3ad32432010-05-03 19:05:10 +0200514 rc = gbprox_relay2sgsn(msg, ns_bvci);
Harald Weltee49c8292010-05-01 12:10:57 +0200515 } else {
Harald Weltef01709d2010-05-03 18:54:58 +0200516 struct gbprox_peer *peer = peer_by_bvci(ns_bvci);
517 if (!peer) {
Harald Weltebe6e25a2010-05-12 00:20:41 +0200518 LOGP(DGPRS, LOGL_INFO, "Allocationg new peer for "
Harald Weltef01709d2010-05-03 18:54:58 +0200519 "BVCI=%u via NSVC=%u/NSEI=%u\n", ns_bvci,
520 nsvc->nsvci, nsvc->nsei);
521 peer = peer_alloc(ns_bvci);
522 peer->nsvc = nsvc;
523 }
Harald Welte3ad32432010-05-03 19:05:10 +0200524 rc = gbprox_relay2peer(msg, peer, ns_bvci);
Harald Weltee49c8292010-05-01 12:10:57 +0200525 }
Harald Welted1991e72010-04-30 20:26:32 +0200526 }
527
Harald Weltef01709d2010-05-03 18:54:58 +0200528 return rc;
Harald Welted1991e72010-04-30 20:26:32 +0200529}
Harald Welteb34e2c12010-05-11 05:49:43 +0200530
Harald Welte9ee404a2010-05-14 11:53:08 +0000531int gbprox_reset_persistent_nsvcs(struct gprs_ns_inst *nsi)
532{
533 struct gprs_nsvc *nsvc;
534
535 llist_for_each_entry(nsvc, &nsi->gprs_nsvcs, list) {
536 if (!nsvc->persistent)
537 continue;
538 gprs_nsvc_reset(nsvc, NS_CAUSE_OM_INTERVENTION);
539 }
540 return 0;
541}
542
Harald Welte5bb0d362010-05-11 06:34:24 +0200543/* Signal handler for signals from NS layer */
544int gbprox_signal(unsigned int subsys, unsigned int signal,
545 void *handler_data, void *signal_data)
546{
547 struct ns_signal_data *nssd = signal_data;
548 struct gprs_nsvc *nsvc = nssd->nsvc;
549 struct gbprox_peer *peer;
550
551 if (subsys != SS_NS)
552 return 0;
553
Harald Welte15cbb0e2010-05-11 18:29:44 +0200554 if (signal == S_NS_RESET && nsvc->nsei == gbcfg.nsip_sgsn_nsei) {
555 /* We have received a NS-RESET from the NSEI and NSVC
556 * of the SGSN. This might happen with SGSN that start
557 * their own NS-RESET procedure without waiting for our
558 * NS-RESET */
559 nsvc->remote_end_is_sgsn = 1;
560 }
561
Harald Weltefa41cb72010-05-12 13:28:25 +0000562 if (signal == S_NS_ALIVE_EXP && nsvc->remote_end_is_sgsn) {
563 LOGP(DGPRS, LOGL_NOTICE, "Tns alive expired too often, "
564 "re-starting RESET procedure\n");
565 nsip_connect(nsvc->nsi, &nsvc->ip.bts_addr, nsvc->nsei,
566 nsvc->nsvci);
567 }
568
Harald Welte5bb0d362010-05-11 06:34:24 +0200569 /* We currently only care about signals from the SGSN */
570 if (!nsvc->remote_end_is_sgsn)
571 return 0;
572
573 /* iterate over all BTS peers and send the respective PDU */
574 llist_for_each_entry(peer, &gbprox_bts_peers, list) {
575 switch (signal) {
576 case S_NS_RESET:
577 gprs_ns_tx_reset(peer->nsvc, nssd->cause);
578 break;
579 case S_NS_BLOCK:
580 gprs_ns_tx_block(peer->nsvc, nssd->cause);
581 break;
582 case S_NS_UNBLOCK:
583 gprs_ns_tx_unblock(peer->nsvc);
584 break;
585 }
586 }
587 return 0;
588}
589
Harald Welteb34e2c12010-05-11 05:49:43 +0200590
Harald Weltebd9591f2010-05-19 19:45:32 +0200591#include <osmocom/vty/command.h>
Harald Welteb34e2c12010-05-11 05:49:43 +0200592
593gDEFUN(show_gbproxy, show_gbproxy_cmd, "show gbproxy",
594 SHOW_STR "Display information about the Gb proxy")
595{
596 struct gbprox_peer *peer;
597
598 llist_for_each_entry(peer, &gbprox_bts_peers, list) {
599 struct gprs_nsvc *nsvc = peer->nsvc;
600 struct gprs_ra_id raid;
Harald Weltef2fdefe2010-05-11 10:15:42 +0200601 gsm48_parse_ra(&raid, peer->ra);
Harald Welteb34e2c12010-05-11 05:49:43 +0200602
Harald Welte4f0675b2010-05-19 17:42:20 +0200603 vty_out(vty, "NSEI %5u, NS-VC %5u, PTP-BVCI %5u, "
Harald Welte6265d372010-05-19 17:06:16 +0200604 "RAC %u-%u-%u-%u",
Harald Welteb34e2c12010-05-11 05:49:43 +0200605 nsvc->nsei, nsvc->nsvci, peer->bvci,
Harald Welte6265d372010-05-19 17:06:16 +0200606 raid.mcc, raid.mnc, raid.lac, raid.rac);
607 if (nsvc->ll == GPRS_NS_LL_UDP || nsvc->ll == GPRS_NS_LL_FR_GRE)
608 vty_out(vty, " %s:%u%s",
Harald Welteb34e2c12010-05-11 05:49:43 +0200609 inet_ntoa(nsvc->ip.bts_addr.sin_addr),
610 ntohs(nsvc->ip.bts_addr.sin_port), VTY_NEWLINE);
Harald Welte6265d372010-05-19 17:06:16 +0200611 else
612 vty_out(vty, "%s", VTY_NEWLINE);
Harald Welteb34e2c12010-05-11 05:49:43 +0200613 }
614 return CMD_SUCCESS;
615}