blob: 3d9bb8963195f42c2c5fab01df5fcf54018121c7 [file] [log] [blame]
Harald Welte24a655f2010-04-30 19:54:29 +02001/* GPRS Networks Service (NS) messages on the Gb interfacebvci = msgb_bvci(msg);
Harald Welte9ba50052010-03-14 15:45:01 +08002 * 3GPP TS 08.16 version 8.0.1 Release 1999 / ETSI TS 101 299 V8.0.1 (2002-05) */
3
Harald Weltef030b212010-04-26 19:18:54 +02004/* (C) 2009-2010 by Harald Welte <laforge@gnumonks.org>
Harald Welte9ba50052010-03-14 15:45:01 +08005 *
6 * All Rights Reserved
7 *
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; either version 2 of the License, or
11 * (at your option) any later version.
12 *
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
17 *
18 * You should have received a copy of the GNU General Public License along
19 * with this program; if not, write to the Free Software Foundation, Inc.,
20 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
21 *
22 */
23
24/* Some introduction into NS: NS is used typically on top of frame relay,
25 * but in the ip.access world it is encapsulated in UDP packets. It serves
26 * as an intermediate shim betwen BSSGP and the underlying medium. It doesn't
27 * do much, apart from providing congestion notification and status indication.
28 *
29 * Terms:
30 * NS Network Service
31 * NSVC NS Virtual Connection
32 * NSEI NS Entity Identifier
33 * NSVL NS Virtual Link
34 * NSVLI NS Virtual Link Identifier
35 * BVC BSSGP Virtual Connection
36 * BVCI BSSGP Virtual Connection Identifier
37 * NSVCG NS Virtual Connection Goup
38 * Blocked NS-VC cannot be used for user traffic
39 * Alive Ability of a NS-VC to provide communication
40 *
41 * There can be multiple BSSGP virtual connections over one (group of) NSVC's. BSSGP will
42 * therefore identify the BSSGP virtual connection by a BVCI passed down to NS.
43 * NS then has to firgure out which NSVC's are responsible for this BVCI.
44 * Those mappings are administratively configured.
45 */
46
47#include <stdlib.h>
48#include <unistd.h>
49#include <errno.h>
Harald Welte8f9a3ee2010-05-02 11:26:34 +020050#include <stdint.h>
Harald Welte9ba50052010-03-14 15:45:01 +080051
52#include <arpa/inet.h>
53
54#include <openbsc/gsm_data.h>
55#include <osmocore/msgb.h>
56#include <osmocore/tlv.h>
57#include <osmocore/talloc.h>
Harald Weltef030b212010-04-26 19:18:54 +020058#include <osmocore/select.h>
Harald Welte9ba50052010-03-14 15:45:01 +080059#include <openbsc/debug.h>
60#include <openbsc/gprs_ns.h>
61#include <openbsc/gprs_bssgp.h>
62
63#define NS_ALLOC_SIZE 1024
64
65static const struct tlv_definition ns_att_tlvdef = {
66 .def = {
67 [NS_IE_CAUSE] = { TLV_TYPE_TvLV, 0 },
68 [NS_IE_VCI] = { TLV_TYPE_TvLV, 0 },
69 [NS_IE_PDU] = { TLV_TYPE_TvLV, 0 },
70 [NS_IE_BVCI] = { TLV_TYPE_TvLV, 0 },
71 [NS_IE_NSEI] = { TLV_TYPE_TvLV, 0 },
72 },
73};
74
Harald Weltef030b212010-04-26 19:18:54 +020075/* Lookup struct gprs_nsvc based on NSVCI */
76static struct gprs_nsvc *nsvc_by_nsvci(struct gprs_ns_inst *nsi,
Harald Welte8f9a3ee2010-05-02 11:26:34 +020077 uint16_t nsvci)
Harald Weltef030b212010-04-26 19:18:54 +020078{
79 struct gprs_nsvc *nsvc;
80 llist_for_each_entry(nsvc, &nsi->gprs_nsvcs, list) {
81 if (nsvc->nsvci == nsvci)
82 return nsvc;
83 }
84 return NULL;
85}
86
Harald Welte24a655f2010-04-30 19:54:29 +020087/* Lookup struct gprs_nsvc based on NSVCI */
88static struct gprs_nsvc *nsvc_by_nsei(struct gprs_ns_inst *nsi,
Harald Welte8f9a3ee2010-05-02 11:26:34 +020089 uint16_t nsei)
Harald Welte24a655f2010-04-30 19:54:29 +020090{
91 struct gprs_nsvc *nsvc;
92 llist_for_each_entry(nsvc, &nsi->gprs_nsvcs, list) {
93 if (nsvc->nsei == nsei)
94 return nsvc;
95 }
96 return NULL;
97}
98
99
Harald Weltef030b212010-04-26 19:18:54 +0200100/* Lookup struct gprs_nsvc based on remote peer socket addr */
101static struct gprs_nsvc *nsvc_by_rem_addr(struct gprs_ns_inst *nsi,
102 struct sockaddr_in *sin)
103{
104 struct gprs_nsvc *nsvc;
105 llist_for_each_entry(nsvc, &nsi->gprs_nsvcs, list) {
106 if (!memcmp(&nsvc->ip.bts_addr, sin, sizeof(*sin)))
107 return nsvc;
108 }
109 return NULL;
110}
111
Harald Welte69a4cf22010-05-03 20:55:10 +0200112static void gprs_ns_timer_cb(void *data);
113
Harald Welte8f9a3ee2010-05-02 11:26:34 +0200114static struct gprs_nsvc *nsvc_create(struct gprs_ns_inst *nsi, uint16_t nsvci)
Harald Weltef030b212010-04-26 19:18:54 +0200115{
116 struct gprs_nsvc *nsvc;
117
118 nsvc = talloc_zero(nsi, struct gprs_nsvc);
119 nsvc->nsvci = nsvci;
120 /* before RESET procedure: BLOCKED and DEAD */
121 nsvc->state = NSE_S_BLOCKED;
122 nsvc->nsi = nsi;
Harald Welte69a4cf22010-05-03 20:55:10 +0200123 nsvc->timer.cb = gprs_ns_timer_cb;
124 nsvc->timer.data = nsvc;
125
Harald Weltef030b212010-04-26 19:18:54 +0200126 llist_add(&nsvc->list, &nsi->gprs_nsvcs);
127
128 return nsvc;
129}
Harald Welte9ba50052010-03-14 15:45:01 +0800130
131/* Section 10.3.2, Table 13 */
Harald Welte2577d412010-05-02 09:37:45 +0200132static const struct value_string ns_cause_str[] = {
133 { NS_CAUSE_TRANSIT_FAIL, "Transit network failure" },
134 { NS_CAUSE_OM_INTERVENTION, "O&M intervention" },
135 { NS_CAUSE_EQUIP_FAIL, "Equipment failure" },
136 { NS_CAUSE_NSVC_BLOCKED, "NS-VC blocked" },
137 { NS_CAUSE_NSVC_UNKNOWN, "NS-VC unknown" },
138 { NS_CAUSE_BVCI_UNKNOWN, "BVCI unknown" },
139 { NS_CAUSE_SEM_INCORR_PDU, "Semantically incorrect PDU" },
140 { NS_CAUSE_PDU_INCOMP_PSTATE, "PDU not compatible with protocol state" },
Harald Welte69a4cf22010-05-03 20:55:10 +0200141 { NS_CAUSE_PROTO_ERR_UNSPEC, "Protocol error, unspecified" },
Harald Welte2577d412010-05-02 09:37:45 +0200142 { NS_CAUSE_INVAL_ESSENT_IE, "Invalid essential IE" },
143 { NS_CAUSE_MISSING_ESSENT_IE, "Missing essential IE" },
144 { 0, NULL }
Harald Welte9ba50052010-03-14 15:45:01 +0800145};
146
Harald Welte2577d412010-05-02 09:37:45 +0200147const char *gprs_ns_cause_str(enum ns_cause cause)
Harald Welte9ba50052010-03-14 15:45:01 +0800148{
Harald Welte2577d412010-05-02 09:37:45 +0200149 return get_value_string(ns_cause_str, cause);
Harald Welte9ba50052010-03-14 15:45:01 +0800150}
151
Harald Welte24a655f2010-04-30 19:54:29 +0200152static int nsip_sendmsg(struct gprs_nsvc *nsvc, struct msgb *msg);
Harald Weltef030b212010-04-26 19:18:54 +0200153
Harald Welte24a655f2010-04-30 19:54:29 +0200154static int gprs_ns_tx(struct gprs_nsvc *nsvc, struct msgb *msg)
Harald Welte9ba50052010-03-14 15:45:01 +0800155{
Harald Weltef030b212010-04-26 19:18:54 +0200156 int ret;
157
158 switch (nsvc->nsi->ll) {
159 case GPRS_NS_LL_UDP:
Harald Welte24a655f2010-04-30 19:54:29 +0200160 ret = nsip_sendmsg(nsvc, msg);
Harald Weltef030b212010-04-26 19:18:54 +0200161 break;
162 default:
163 LOGP(DGPRS, LOGL_ERROR, "unsupported NS linklayer %u\n", nsvc->nsi->ll);
164 msgb_free(msg);
165 ret = -EIO;
166 break;
167 }
168 return ret;
Harald Welte9ba50052010-03-14 15:45:01 +0800169}
170
Harald Welte8f9a3ee2010-05-02 11:26:34 +0200171static int gprs_ns_tx_simple(struct gprs_nsvc *nsvc, uint8_t pdu_type)
Harald Welte9ba50052010-03-14 15:45:01 +0800172{
173 struct msgb *msg = msgb_alloc(NS_ALLOC_SIZE, "GPRS/NS");
174 struct gprs_ns_hdr *nsh;
175
176 if (!msg)
177 return -ENOMEM;
178
179 nsh = (struct gprs_ns_hdr *) msgb_put(msg, sizeof(*nsh));
180
181 nsh->pdu_type = pdu_type;
182
Harald Welte24a655f2010-04-30 19:54:29 +0200183 return gprs_ns_tx(nsvc, msg);
Harald Welte9ba50052010-03-14 15:45:01 +0800184}
185
Harald Welte570fb832010-05-03 21:05:24 +0200186static int gprs_ns_tx_reset(struct gprs_nsvc *nsvc, uint8_t cause)
Harald Welte69a4cf22010-05-03 20:55:10 +0200187{
188 struct msgb *msg = msgb_alloc(NS_ALLOC_SIZE, "GPRS/NS");
189 struct gprs_ns_hdr *nsh;
Harald Welte69a4cf22010-05-03 20:55:10 +0200190 uint16_t nsvci = htons(nsvc->nsvci);
191 uint16_t nsei = htons(nsvc->nsei);
192
193 if (!msg)
194 return -ENOMEM;
195
196 nsh = (struct gprs_ns_hdr *) msgb_put(msg, sizeof(*nsh));
197 nsh->pdu_type = NS_PDUT_RESET;
198
199 msgb_tvlv_put(msg, NS_IE_CAUSE, 1, &cause);
200 msgb_tvlv_put(msg, NS_IE_VCI, 2, (uint8_t *) &nsvci);
201 msgb_tvlv_put(msg, NS_IE_NSEI, 2, (uint8_t *) &nsei);
202
203 return gprs_ns_tx(nsvc, msg);
204
205}
206
Harald Welte9ba50052010-03-14 15:45:01 +0800207#define NS_ALIVE_RETRIES 10 /* after 3 failed retransmit we declare BTS as dead */
208
Harald Welte69a4cf22010-05-03 20:55:10 +0200209static const uint8_t timer_mode_tout[_NSVC_TIMER_NR] = {
210 [NSVC_TIMER_TNS_RESET] = 60,
211 [NSVC_TIMER_TNS_ALIVE] = 3,
212 [NSVC_TIMER_TNS_TEST] = 30,
213};
214
215static void nsvc_start_timer(struct gprs_nsvc *nsvc, enum nsvc_timer_mode mode)
216{
217 nsvc->alive_retries = 0;
218
219 if (bsc_timer_pending(&nsvc->timer))
220 bsc_del_timer(&nsvc->timer);
221
222 nsvc->timer_mode = mode;
223 bsc_schedule_timer(&nsvc->timer, timer_mode_tout[mode], 0);
224}
225
Harald Welte80405452010-05-03 20:16:13 +0200226static void gprs_ns_timer_cb(void *data)
Harald Welte9ba50052010-03-14 15:45:01 +0800227{
228 struct gprs_nsvc *nsvc = data;
229
Harald Welte80405452010-05-03 20:16:13 +0200230 switch (nsvc->timer_mode) {
231 case NSVC_TIMER_TNS_ALIVE:
Harald Welte9ba50052010-03-14 15:45:01 +0800232 /* Tns-alive case: we expired without response ! */
233 nsvc->alive_retries++;
234 if (nsvc->alive_retries > NS_ALIVE_RETRIES) {
235 /* mark as dead and blocked */
236 nsvc->state = NSE_S_BLOCKED;
Harald Welte69a4cf22010-05-03 20:55:10 +0200237 DEBUGP(DGPRS, "NSEI=%u Tns-alive expired more then "
238 "%u times, blocking NS-VC\n", nsvc->nsei,
239 NS_ALIVE_RETRIES);
Harald Welte9ba50052010-03-14 15:45:01 +0800240 /* FIXME: inform higher layers */
241 return;
242 }
Harald Welte69a4cf22010-05-03 20:55:10 +0200243 nsvc_start_timer(nsvc, NSVC_TIMER_TNS_ALIVE);
Harald Welte80405452010-05-03 20:16:13 +0200244 break;
245 case NSVC_TIMER_TNS_TEST:
Harald Welte9ba50052010-03-14 15:45:01 +0800246 /* Tns-test case: send NS-ALIVE PDU */
Harald Weltec5478482010-03-18 00:01:43 +0800247 gprs_ns_tx_simple(nsvc, NS_PDUT_ALIVE);
Harald Welte9ba50052010-03-14 15:45:01 +0800248 /* start Tns-alive timer */
Harald Welte69a4cf22010-05-03 20:55:10 +0200249 nsvc_start_timer(nsvc, NSVC_TIMER_TNS_ALIVE);
250 break;
251 case NSVC_TIMER_TNS_RESET:
252 /* Chapter 7.3: Re-send the RESET */
Harald Welte570fb832010-05-03 21:05:24 +0200253 gprs_ns_tx_reset(nsvc, NS_CAUSE_OM_INTERVENTION);
Harald Welte69a4cf22010-05-03 20:55:10 +0200254 nsvc_start_timer(nsvc, NSVC_TIMER_TNS_RESET);
Harald Welte80405452010-05-03 20:16:13 +0200255 break;
Harald Welte9ba50052010-03-14 15:45:01 +0800256 }
Harald Welte9ba50052010-03-14 15:45:01 +0800257}
258
259/* Section 9.2.6 */
Harald Weltec5478482010-03-18 00:01:43 +0800260static int gprs_ns_tx_reset_ack(struct gprs_nsvc *nsvc)
Harald Welte9ba50052010-03-14 15:45:01 +0800261{
262 struct msgb *msg = msgb_alloc(NS_ALLOC_SIZE, "GPRS/NS");
263 struct gprs_ns_hdr *nsh;
Harald Welte8f9a3ee2010-05-02 11:26:34 +0200264 uint16_t nsvci, nsei;
Harald Welte9ba50052010-03-14 15:45:01 +0800265
266 if (!msg)
267 return -ENOMEM;
268
Harald Weltec5478482010-03-18 00:01:43 +0800269 nsvci = htons(nsvc->nsvci);
270 nsei = htons(nsvc->nsei);
Harald Welte9ba50052010-03-14 15:45:01 +0800271
272 nsh = (struct gprs_ns_hdr *) msgb_put(msg, sizeof(*nsh));
273
274 nsh->pdu_type = NS_PDUT_RESET_ACK;
275
Harald Weltebbc9fac2010-05-03 18:54:12 +0200276 DEBUGP(DGPRS, "NSEI=%u Tx NS RESET ACK (NSVCI=%u)\n",
277 nsvc->nsei, nsvc->nsvci);
Harald Weltec5478482010-03-18 00:01:43 +0800278
Harald Welte8f9a3ee2010-05-02 11:26:34 +0200279 msgb_tvlv_put(msg, NS_IE_VCI, 2, (uint8_t *)&nsvci);
280 msgb_tvlv_put(msg, NS_IE_NSEI, 2, (uint8_t *)&nsei);
Harald Welte9ba50052010-03-14 15:45:01 +0800281
Harald Welte24a655f2010-04-30 19:54:29 +0200282 return gprs_ns_tx(nsvc, msg);
Harald Welte9ba50052010-03-14 15:45:01 +0800283}
284
Harald Welte24a655f2010-04-30 19:54:29 +0200285/* Section 9.2.10: transmit side / NS-UNITDATA-REQUEST primitive */
286int gprs_ns_sendmsg(struct gprs_ns_inst *nsi, struct msgb *msg)
Harald Welte9ba50052010-03-14 15:45:01 +0800287{
Harald Welte24a655f2010-04-30 19:54:29 +0200288 struct gprs_nsvc *nsvc;
Harald Welte9ba50052010-03-14 15:45:01 +0800289 struct gprs_ns_hdr *nsh;
Harald Welte8f9a3ee2010-05-02 11:26:34 +0200290 uint16_t bvci = msgb_bvci(msg);
Harald Welte24a655f2010-04-30 19:54:29 +0200291
292 nsvc = nsvc_by_nsei(nsi, msgb_nsei(msg));
293 if (!nsvc) {
Harald Weltebbc9fac2010-05-03 18:54:12 +0200294 LOGP(DGPRS, LOGL_ERROR, "Unable to resolve NSEI %u "
295 "to NS-VC!\n", msgb_nsei(msg));
Harald Welte24a655f2010-04-30 19:54:29 +0200296 return -EINVAL;
297 }
Harald Welte9ba50052010-03-14 15:45:01 +0800298
Harald Welte69a4cf22010-05-03 20:55:10 +0200299 if (!(nsvc->state & NSE_S_ALIVE)) {
300 LOGP(DGPRS, LOGL_ERROR, "NSEI=%u is not alive, cannot send\n",
301 nsvc->nsei);
302 return -EBUSY;
303 }
304 if (nsvc->state & NSE_S_BLOCKED) {
305 LOGP(DGPRS, LOGL_ERROR, "NSEI=%u is blocked, cannot send\n",
306 nsvc->nsei);
307 return -EBUSY;
308 }
309
Harald Welte9ba50052010-03-14 15:45:01 +0800310 nsh = (struct gprs_ns_hdr *) msgb_push(msg, sizeof(*nsh) + 3);
311 if (!nsh) {
Harald Weltebbc9fac2010-05-03 18:54:12 +0200312 LOGP(DGPRS, LOGL_ERROR, "Not enough headroom for NS header\n");
Harald Welte9ba50052010-03-14 15:45:01 +0800313 return -EIO;
314 }
315
316 nsh->pdu_type = NS_PDUT_UNITDATA;
317 /* spare octet in data[0] */
318 nsh->data[1] = bvci >> 8;
319 nsh->data[2] = bvci & 0xff;
320
Harald Welte24a655f2010-04-30 19:54:29 +0200321 return gprs_ns_tx(nsvc, msg);
Harald Welte9ba50052010-03-14 15:45:01 +0800322}
323
324/* Section 9.2.10: receive side */
Harald Welte24a655f2010-04-30 19:54:29 +0200325static int gprs_ns_rx_unitdata(struct gprs_nsvc *nsvc, struct msgb *msg)
Harald Welte9ba50052010-03-14 15:45:01 +0800326{
327 struct gprs_ns_hdr *nsh = (struct gprs_ns_hdr *)msg->l2h;
Harald Welte8f9a3ee2010-05-02 11:26:34 +0200328 uint16_t bvci;
Harald Welte9ba50052010-03-14 15:45:01 +0800329
330 /* spare octet in data[0] */
331 bvci = nsh->data[1] << 8 | nsh->data[2];
Harald Welteec19c102010-05-02 09:50:42 +0200332 msgb_bssgph(msg) = &nsh->data[3];
Harald Welte30bc19a2010-05-02 11:19:37 +0200333 msgb_bvci(msg) = bvci;
Harald Welte9ba50052010-03-14 15:45:01 +0800334
335 /* call upper layer (BSSGP) */
Harald Weltef030b212010-04-26 19:18:54 +0200336 return nsvc->nsi->cb(GPRS_NS_EVT_UNIT_DATA, nsvc, msg, bvci);
Harald Welte9ba50052010-03-14 15:45:01 +0800337}
338
339/* Section 9.2.7 */
Harald Welte24a655f2010-04-30 19:54:29 +0200340static int gprs_ns_rx_status(struct gprs_nsvc *nsvc, struct msgb *msg)
Harald Welte9ba50052010-03-14 15:45:01 +0800341{
Harald Weltef030b212010-04-26 19:18:54 +0200342 struct gprs_ns_hdr *nsh = (struct gprs_ns_hdr *) msg->l2h;
Harald Welte9ba50052010-03-14 15:45:01 +0800343 struct tlv_parsed tp;
Harald Welte8f9a3ee2010-05-02 11:26:34 +0200344 uint8_t cause;
Harald Welte9ba50052010-03-14 15:45:01 +0800345 int rc;
346
Harald Weltebbc9fac2010-05-03 18:54:12 +0200347 DEBUGP(DGPRS, "NSEI=%u NS STATUS ", nsvc->nsei);
Harald Welte9ba50052010-03-14 15:45:01 +0800348
349 rc = tlv_parse(&tp, &ns_att_tlvdef, nsh->data, msgb_l2len(msg), 0, 0);
350
351 if (!TLVP_PRESENT(&tp, NS_IE_CAUSE)) {
352 DEBUGPC(DGPRS, "missing cause IE\n");
353 return -EINVAL;
354 }
355
356 cause = *TLVP_VAL(&tp, NS_IE_CAUSE);
357 DEBUGPC(DGPRS, "cause=%s\n", gprs_ns_cause_str(cause));
358
359 return 0;
360}
361
362/* Section 7.3 */
Harald Welte24a655f2010-04-30 19:54:29 +0200363static int gprs_ns_rx_reset(struct gprs_nsvc *nsvc, struct msgb *msg)
Harald Welte9ba50052010-03-14 15:45:01 +0800364{
365 struct gprs_ns_hdr *nsh = (struct gprs_ns_hdr *) msg->l2h;
Harald Welte9ba50052010-03-14 15:45:01 +0800366 struct tlv_parsed tp;
Harald Welte8f9a3ee2010-05-02 11:26:34 +0200367 uint8_t *cause;
368 uint16_t *nsvci, *nsei;
Harald Welte9ba50052010-03-14 15:45:01 +0800369 int rc;
370
Harald Welte9ba50052010-03-14 15:45:01 +0800371 rc = tlv_parse(&tp, &ns_att_tlvdef, nsh->data, msgb_l2len(msg), 0, 0);
372
373 if (!TLVP_PRESENT(&tp, NS_IE_CAUSE) ||
374 !TLVP_PRESENT(&tp, NS_IE_VCI) ||
375 !TLVP_PRESENT(&tp, NS_IE_NSEI)) {
376 /* FIXME: respond with NS_CAUSE_MISSING_ESSENT_IE */
Harald Weltebbc9fac2010-05-03 18:54:12 +0200377 LOGP(DGPRS, LOGL_ERROR, "NS RESET Missing mandatory IE\n");
Harald Welte9ba50052010-03-14 15:45:01 +0800378 return -EINVAL;
379 }
380
Harald Welte8f9a3ee2010-05-02 11:26:34 +0200381 cause = (uint8_t *) TLVP_VAL(&tp, NS_IE_CAUSE);
382 nsvci = (uint16_t *) TLVP_VAL(&tp, NS_IE_VCI);
383 nsei = (uint16_t *) TLVP_VAL(&tp, NS_IE_NSEI);
Harald Welte9ba50052010-03-14 15:45:01 +0800384
Harald Weltebbc9fac2010-05-03 18:54:12 +0200385 DEBUGP(DGPRS, "NSEI=%u NS RESET (NSVCI=%u, cause=%s)\n",
386 nsvc->nsvci, nsvc->nsei, gprs_ns_cause_str(*cause));
387
Harald Weltec5478482010-03-18 00:01:43 +0800388 nsvc->state = NSE_S_BLOCKED | NSE_S_ALIVE;
389 nsvc->nsei = ntohs(*nsei);
390 nsvc->nsvci = ntohs(*nsvci);
Harald Welte9ba50052010-03-14 15:45:01 +0800391
Harald Welte9ba50052010-03-14 15:45:01 +0800392 /* mark the NS-VC as blocked and alive */
Harald Welte9ba50052010-03-14 15:45:01 +0800393 /* start the test procedure */
Harald Welte69a4cf22010-05-03 20:55:10 +0200394 nsvc_start_timer(nsvc, NSVC_TIMER_TNS_ALIVE);
Harald Welte9ba50052010-03-14 15:45:01 +0800395
Harald Weltec5478482010-03-18 00:01:43 +0800396 return gprs_ns_tx_reset_ack(nsvc);
Harald Welte9ba50052010-03-14 15:45:01 +0800397}
398
399/* main entry point, here incoming NS frames enter */
Harald Weltef030b212010-04-26 19:18:54 +0200400int gprs_ns_rcvmsg(struct gprs_ns_inst *nsi, struct msgb *msg,
401 struct sockaddr_in *saddr)
Harald Welte9ba50052010-03-14 15:45:01 +0800402{
403 struct gprs_ns_hdr *nsh = (struct gprs_ns_hdr *) msg->l2h;
Harald Weltef030b212010-04-26 19:18:54 +0200404 struct gprs_nsvc *nsvc;
Harald Welte9ba50052010-03-14 15:45:01 +0800405 int rc = 0;
406
Harald Weltef030b212010-04-26 19:18:54 +0200407 /* look up the NSVC based on source address */
408 nsvc = nsvc_by_rem_addr(nsi, saddr);
409 if (!nsvc) {
410 /* Only the RESET procedure creates a new NSVC */
Harald Weltebbc9fac2010-05-03 18:54:12 +0200411 if (nsh->pdu_type != NS_PDUT_RESET) {
412 LOGP(DGPRS, LOGL_INFO, "Ignoring NS PDU type 0x%0x "
413 "from %s for non-existing NS-VC\n",
414 nsh->pdu_type, inet_ntoa(saddr->sin_addr));
Harald Welte570fb832010-05-03 21:05:24 +0200415 //gprs_ns_tx_reset(nsvc, NS_CAUSE_NSVC_UNKNOWN);
Harald Weltef030b212010-04-26 19:18:54 +0200416 return -EIO;
Harald Weltebbc9fac2010-05-03 18:54:12 +0200417 }
418 LOGP(DGPRS, LOGL_INFO, "Creating NS-VC for BSS at %s:%u\n",
419 inet_ntoa(saddr->sin_addr), ntohs(saddr->sin_port));
Harald Weltef030b212010-04-26 19:18:54 +0200420 nsvc = nsvc_create(nsi, 0xffff);
421 nsvc->ip.bts_addr = *saddr;
Harald Weltebbc9fac2010-05-03 18:54:12 +0200422 } else
423 msgb_nsei(msg) = nsvc->nsei;
Harald Weltec5478482010-03-18 00:01:43 +0800424
Harald Welte9ba50052010-03-14 15:45:01 +0800425 switch (nsh->pdu_type) {
426 case NS_PDUT_ALIVE:
427 /* remote end inquires whether we're still alive,
428 * we need to respond with ALIVE_ACK */
Harald Weltec5478482010-03-18 00:01:43 +0800429 rc = gprs_ns_tx_simple(nsvc, NS_PDUT_ALIVE_ACK);
Harald Welte9ba50052010-03-14 15:45:01 +0800430 break;
431 case NS_PDUT_ALIVE_ACK:
432 /* stop Tns-alive */
Harald Welte80405452010-05-03 20:16:13 +0200433 bsc_del_timer(&nsvc->timer);
Harald Welte9ba50052010-03-14 15:45:01 +0800434 /* start Tns-test */
Harald Welte69a4cf22010-05-03 20:55:10 +0200435 nsvc_start_timer(nsvc, NSVC_TIMER_TNS_TEST);
Harald Welte7fb7e612010-05-03 21:11:22 +0200436 if (nsvc->remote_end_is_sgsn) {
437 /* FIXME: this should be one level higher */
438 if (nsvc->state & NSE_S_BLOCKED)
439 rc = gprs_ns_tx_simple(nsvc, NS_PDUT_UNBLOCK);
440 }
Harald Welte9ba50052010-03-14 15:45:01 +0800441 break;
442 case NS_PDUT_UNITDATA:
443 /* actual user data */
Harald Welte24a655f2010-04-30 19:54:29 +0200444 rc = gprs_ns_rx_unitdata(nsvc, msg);
Harald Welte9ba50052010-03-14 15:45:01 +0800445 break;
446 case NS_PDUT_STATUS:
Harald Welte24a655f2010-04-30 19:54:29 +0200447 rc = gprs_ns_rx_status(nsvc, msg);
Harald Welte9ba50052010-03-14 15:45:01 +0800448 break;
449 case NS_PDUT_RESET:
Harald Welte24a655f2010-04-30 19:54:29 +0200450 rc = gprs_ns_rx_reset(nsvc, msg);
Harald Welte9ba50052010-03-14 15:45:01 +0800451 break;
452 case NS_PDUT_RESET_ACK:
Harald Weltebbc9fac2010-05-03 18:54:12 +0200453 DEBUGP(DGPRS, "NSEI=%u Rx NS RESET ACK\n", nsvc->nsei);
Harald Weltef030b212010-04-26 19:18:54 +0200454 /* mark remote NS-VC as blocked + active */
455 nsvc->remote_state = NSE_S_BLOCKED | NSE_S_ALIVE;
Harald Welte69a4cf22010-05-03 20:55:10 +0200456 if (nsvc->remote_end_is_sgsn) {
457 /* stop RESET timer */
458 bsc_del_timer(&nsvc->timer);
Harald Welte570fb832010-05-03 21:05:24 +0200459 /* send ALIVE PDU */
460 rc = gprs_ns_tx_simple(nsvc, NS_PDUT_ALIVE);
461 nsvc_start_timer(nsvc, NSVC_TIMER_TNS_ALIVE);
Harald Welte7fb7e612010-05-03 21:11:22 +0200462 /* mark local state as BLOCKED + ALIVE */
463 nsvc->state = NSE_S_BLOCKED | NSE_S_ALIVE;
Harald Welte69a4cf22010-05-03 20:55:10 +0200464 }
Harald Welte9ba50052010-03-14 15:45:01 +0800465 break;
466 case NS_PDUT_UNBLOCK:
467 /* Section 7.2: unblocking procedure */
Harald Weltebbc9fac2010-05-03 18:54:12 +0200468 DEBUGP(DGPRS, "NSEI=%u Rx NS UNBLOCK\n", nsvc->nsei);
Harald Welte9ba50052010-03-14 15:45:01 +0800469 nsvc->state &= ~NSE_S_BLOCKED;
Harald Weltec5478482010-03-18 00:01:43 +0800470 rc = gprs_ns_tx_simple(nsvc, NS_PDUT_UNBLOCK_ACK);
Harald Welte9ba50052010-03-14 15:45:01 +0800471 break;
472 case NS_PDUT_UNBLOCK_ACK:
Harald Weltebbc9fac2010-05-03 18:54:12 +0200473 DEBUGP(DGPRS, "NSEI=%u Rx NS UNBLOCK ACK\n", nsvc->nsei);
Harald Weltef030b212010-04-26 19:18:54 +0200474 /* mark remote NS-VC as unblocked + active */
475 nsvc->remote_state = NSE_S_ALIVE;
Harald Welte7fb7e612010-05-03 21:11:22 +0200476 if (nsvc->remote_end_is_sgsn)
477 nsvc->state = NSE_S_ALIVE;
Harald Welte9ba50052010-03-14 15:45:01 +0800478 break;
479 case NS_PDUT_BLOCK:
Harald Weltebbc9fac2010-05-03 18:54:12 +0200480 DEBUGP(DGPRS, "NSEI=%u Rx NS BLOCK\n", nsvc->nsei);
Harald Welte9ba50052010-03-14 15:45:01 +0800481 nsvc->state |= NSE_S_BLOCKED;
Harald Weltec5478482010-03-18 00:01:43 +0800482 rc = gprs_ns_tx_simple(nsvc, NS_PDUT_UNBLOCK_ACK);
Harald Welte9ba50052010-03-14 15:45:01 +0800483 break;
484 case NS_PDUT_BLOCK_ACK:
Harald Weltebbc9fac2010-05-03 18:54:12 +0200485 DEBUGP(DGPRS, "NSEI=%u Rx NS BLOCK ACK\n", nsvc->nsei);
Harald Weltef030b212010-04-26 19:18:54 +0200486 /* mark remote NS-VC as blocked + active */
487 nsvc->remote_state = NSE_S_BLOCKED | NSE_S_ALIVE;
Harald Welte9ba50052010-03-14 15:45:01 +0800488 break;
489 default:
Harald Weltebbc9fac2010-05-03 18:54:12 +0200490 DEBUGP(DGPRS, "NSEI=%u Rx Unknown NS PDU type 0x%02x\n",
491 nsvc->nsei, nsh->pdu_type);
Harald Welte9ba50052010-03-14 15:45:01 +0800492 rc = -EINVAL;
493 break;
494 }
495 return rc;
496}
497
Harald Weltef030b212010-04-26 19:18:54 +0200498struct gprs_ns_inst *gprs_ns_instantiate(gprs_ns_cb_t *cb)
499{
500 struct gprs_ns_inst *nsi = talloc_zero(tall_bsc_ctx, struct gprs_ns_inst);
501
502 nsi->cb = cb;
503 INIT_LLIST_HEAD(&nsi->gprs_nsvcs);
504
Harald Welte3771d092010-04-30 20:26:32 +0200505 return nsi;
Harald Weltef030b212010-04-26 19:18:54 +0200506}
507
508void gprs_ns_destroy(struct gprs_ns_inst *nsi)
509{
510 /* FIXME: clear all timers */
511
512 /* recursively free the NSI and all its NSVCs */
513 talloc_free(nsi);
514}
515
516
517/* NS-over-IP code, according to 3GPP TS 48.016 Chapter 6.2
518 * We don't support Size Procedure, Configuration Procedure, ChangeWeight Procedure */
519
520/* Read a single NS-over-IP message */
521static struct msgb *read_nsip_msg(struct bsc_fd *bfd, int *error,
522 struct sockaddr_in *saddr)
523{
524 struct msgb *msg = msgb_alloc(NS_ALLOC_SIZE, "Abis/IP/GPRS-NS");
525 int ret = 0;
526 socklen_t saddr_len = sizeof(*saddr);
527
528 if (!msg) {
529 *error = -ENOMEM;
530 return NULL;
531 }
532
533 ret = recvfrom(bfd->fd, msg->data, NS_ALLOC_SIZE, 0,
534 (struct sockaddr *)saddr, &saddr_len);
535 if (ret < 0) {
Harald Weltebbc9fac2010-05-03 18:54:12 +0200536 LOGP(DGPRS, LOGL_ERROR, "recv error %s during NSIP recv\n",
537 strerror(errno));
Harald Weltef030b212010-04-26 19:18:54 +0200538 msgb_free(msg);
539 *error = ret;
540 return NULL;
541 } else if (ret == 0) {
542 msgb_free(msg);
543 *error = ret;
544 return NULL;
545 }
546
547 msg->l2h = msg->data;
548 msgb_put(msg, ret);
549
550 return msg;
551}
552
553static int handle_nsip_read(struct bsc_fd *bfd)
554{
555 int error;
556 struct sockaddr_in saddr;
557 struct gprs_ns_inst *nsi = bfd->data;
558 struct msgb *msg = read_nsip_msg(bfd, &error, &saddr);
559
560 if (!msg)
561 return error;
562
563 return gprs_ns_rcvmsg(nsi, msg, &saddr);
564}
565
566static int handle_nsip_write(struct bsc_fd *bfd)
567{
568 /* FIXME: actually send the data here instead of nsip_sendmsg() */
569 return -EIO;
570}
571
Harald Welte24a655f2010-04-30 19:54:29 +0200572int nsip_sendmsg(struct gprs_nsvc *nsvc, struct msgb *msg)
Harald Weltef030b212010-04-26 19:18:54 +0200573{
574 int rc;
575 struct gprs_ns_inst *nsi = nsvc->nsi;
576 struct sockaddr_in *daddr = &nsvc->ip.bts_addr;
577
578 rc = sendto(nsi->nsip.fd.fd, msg->data, msg->len, 0,
579 (struct sockaddr *)daddr, sizeof(*daddr));
580
581 talloc_free(msg);
582
583 return rc;
584}
585
586/* UDP Port 23000 carries the LLC-in-BSSGP-in-NS protocol stack */
587static int nsip_fd_cb(struct bsc_fd *bfd, unsigned int what)
588{
589 int rc = 0;
590
591 if (what & BSC_FD_READ)
592 rc = handle_nsip_read(bfd);
593 if (what & BSC_FD_WRITE)
594 rc = handle_nsip_write(bfd);
595
596 return rc;
597}
598
599
600/* FIXME: this is currently in input/ipaccess.c */
Harald Welte8f9a3ee2010-05-02 11:26:34 +0200601extern int make_sock(struct bsc_fd *bfd, int proto, uint16_t port,
Harald Weltef030b212010-04-26 19:18:54 +0200602 int (*cb)(struct bsc_fd *fd, unsigned int what));
603
604/* Listen for incoming GPRS packets */
605int nsip_listen(struct gprs_ns_inst *nsi, uint16_t udp_port)
606{
607 int ret;
608
609 ret = make_sock(&nsi->nsip.fd, IPPROTO_UDP, udp_port, nsip_fd_cb);
610 if (ret < 0)
611 return ret;
612
613 nsi->ll = GPRS_NS_LL_UDP;
614 nsi->nsip.fd.data = nsi;
615
616 return ret;
617}
Harald Welte3771d092010-04-30 20:26:32 +0200618
619/* Establish a connection (from the BSS) to the SGSN */
620struct gprs_nsvc *nsip_connect(struct gprs_ns_inst *nsi,
Harald Welte1203de32010-05-01 11:28:43 +0200621 struct sockaddr_in *dest, uint16_t nsei,
622 uint16_t nsvci)
Harald Welte3771d092010-04-30 20:26:32 +0200623{
624 struct gprs_nsvc *nsvc;
625
626 nsvc = nsvc_by_rem_addr(nsi, dest);
627 if (!nsvc) {
628 nsvc = nsvc_create(nsi, nsvci);
629 nsvc->ip.bts_addr = *dest;
630 }
Harald Welte1203de32010-05-01 11:28:43 +0200631 nsvc->nsei = nsei;
632 nsvc->nsvci = nsvci;
Harald Welte3771d092010-04-30 20:26:32 +0200633 nsvc->remote_end_is_sgsn = 1;
634
635 /* Initiate a RESET procedure */
Harald Welte570fb832010-05-03 21:05:24 +0200636 if (gprs_ns_tx_reset(nsvc, NS_CAUSE_OM_INTERVENTION) < 0) {
Harald Welte69a4cf22010-05-03 20:55:10 +0200637 LOGP(DGPRS, LOGL_ERROR, "NSEI=%u, error resetting NS-VC\n",
638 nsei);
639 }
640 /* run a timer and re-transmit the reset request? */
641 nsvc_start_timer(nsvc, NSVC_TIMER_TNS_RESET);
Harald Welte3771d092010-04-30 20:26:32 +0200642
643 return nsvc;
644}