blob: aa6e37bfb2e751afe84b07c9725b14af67ff5828 [file] [log] [blame]
Harald Welte9ba50052010-03-14 15:45:01 +08001/* GPRS BSSGP protocol implementation as per 3GPP TS 08.18 */
2
Harald Weltebfe62e52017-05-15 12:48:30 +02003/* (C) 2009-2017 by Harald Welte <laforge@gnumonks.org>
Harald Welte9ba50052010-03-14 15:45:01 +08004 *
5 * All Rights Reserved
6 *
7 * This program is free software; you can redistribute it and/or modify
Harald Welte7fa89c22014-10-26 20:33:09 +01008 * it under the terms of the GNU General Public License as published by
9 * the Free Software Foundation; either version 2 of the License, or
Harald Welte9ba50052010-03-14 15:45:01 +080010 * (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 Welte7fa89c22014-10-26 20:33:09 +010015 * GNU General Public License for more details.
Harald Welte9ba50052010-03-14 15:45:01 +080016 *
Harald Welte7fa89c22014-10-26 20:33:09 +010017 * You should have received a copy of the GNU General Public License
Harald Weltee4cbb3f2011-01-01 15:25:50 +010018 * along with this program. If not, see <http://www.gnu.org/licenses/>.
Harald Welte9ba50052010-03-14 15:45:01 +080019 *
Harald Welte4e5721d2010-05-17 23:41:43 +020020 * TODO:
21 * o properly count incoming BVC-RESET packets in counter group
22 * o set log context as early as possible for outgoing packets
Harald Welte9ba50052010-03-14 15:45:01 +080023 */
24
25#include <errno.h>
Harald Welte8f9a3ee2010-05-02 11:26:34 +020026#include <stdint.h>
Harald Welte9ba50052010-03-14 15:45:01 +080027
Pablo Neira Ayusoff663232011-03-22 16:47:59 +010028#include <osmocom/core/msgb.h>
Harald Weltebfe62e52017-05-15 12:48:30 +020029#include <osmocom/core/byteswap.h>
30#include <osmocom/core/bit16gen.h>
Pablo Neira Ayusoff663232011-03-22 16:47:59 +010031#include <osmocom/gsm/tlv.h>
32#include <osmocom/core/talloc.h>
33#include <osmocom/core/rate_ctr.h>
Jacob Erlbeckbc9d9ac2015-11-02 14:49:35 +010034#include <osmocom/core/stats.h>
Harald Welte6752fa42010-05-02 09:23:16 +020035
Harald Welte73952e32012-06-16 14:59:56 +080036#include <osmocom/gprs/gprs_bssgp.h>
37#include <osmocom/gprs/gprs_ns.h>
38
Harald Weltecca49632012-06-16 17:45:59 +080039#include "common_vty.h"
40
Harald Welte6752fa42010-05-02 09:23:16 +020041void *bssgp_tall_ctx = NULL;
42
Harald Welte25de8112010-05-13 21:26:28 +020043static const struct rate_ctr_desc bssgp_ctr_description[] = {
Harald Welte16c8dbb2010-05-17 23:30:01 +020044 { "packets.in", "Packets at BSSGP Level ( In)" },
45 { "packets.out","Packets at BSSGP Level (Out)" },
46 { "bytes.in", "Bytes at BSSGP Level ( In)" },
47 { "bytes.out", "Bytes at BSSGP Level (Out)" },
Harald Welte25de8112010-05-13 21:26:28 +020048 { "blocked", "BVC Blocking count" },
49 { "discarded", "BVC LLC Discarded count" },
Jacob Erlbeck36153dc2015-03-17 10:21:17 +010050 { "status", "BVC Status count" },
Harald Welte25de8112010-05-13 21:26:28 +020051};
52
53static const struct rate_ctr_group_desc bssgp_ctrg_desc = {
54 .group_name_prefix = "bssgp.bss_ctx",
55 .group_description = "BSSGP Peer Statistics",
56 .num_ctr = ARRAY_SIZE(bssgp_ctr_description),
57 .ctr_desc = bssgp_ctr_description,
Jacob Erlbeckbc9d9ac2015-11-02 14:49:35 +010058 .class_id = OSMO_STATS_CLASS_PEER,
Harald Welte25de8112010-05-13 21:26:28 +020059};
60
Harald Weltea78b9c22010-05-17 23:02:42 +020061LLIST_HEAD(bssgp_bvc_ctxts);
Harald Welte6752fa42010-05-02 09:23:16 +020062
Harald Welted11c0592012-09-06 21:57:11 +020063static int _bssgp_tx_dl_ud(struct bssgp_flow_control *fc, struct msgb *msg,
64 uint32_t llc_pdu_len, void *priv);
65
Harald Welte6752fa42010-05-02 09:23:16 +020066/* Find a BTS Context based on parsed RA ID and Cell ID */
Harald Welte8a521132010-05-17 22:59:29 +020067struct bssgp_bvc_ctx *btsctx_by_raid_cid(const struct gprs_ra_id *raid, uint16_t cid)
Harald Welte6752fa42010-05-02 09:23:16 +020068{
Harald Welte8a521132010-05-17 22:59:29 +020069 struct bssgp_bvc_ctx *bctx;
Harald Welte6752fa42010-05-02 09:23:16 +020070
Harald Weltea78b9c22010-05-17 23:02:42 +020071 llist_for_each_entry(bctx, &bssgp_bvc_ctxts, list) {
Harald Welte6752fa42010-05-02 09:23:16 +020072 if (!memcmp(&bctx->ra_id, raid, sizeof(bctx->ra_id)) &&
73 bctx->cell_id == cid)
74 return bctx;
75 }
76 return NULL;
77}
78
79/* Find a BTS context based on BVCI+NSEI tuple */
Harald Welte8a521132010-05-17 22:59:29 +020080struct bssgp_bvc_ctx *btsctx_by_bvci_nsei(uint16_t bvci, uint16_t nsei)
Harald Welte6752fa42010-05-02 09:23:16 +020081{
Harald Welte8a521132010-05-17 22:59:29 +020082 struct bssgp_bvc_ctx *bctx;
Harald Welte6752fa42010-05-02 09:23:16 +020083
Harald Weltea78b9c22010-05-17 23:02:42 +020084 llist_for_each_entry(bctx, &bssgp_bvc_ctxts, list) {
Harald Welte6752fa42010-05-02 09:23:16 +020085 if (bctx->nsei == nsei && bctx->bvci == bvci)
86 return bctx;
87 }
88 return NULL;
89}
90
Harald Welte8a521132010-05-17 22:59:29 +020091struct bssgp_bvc_ctx *btsctx_alloc(uint16_t bvci, uint16_t nsei)
Harald Welte6752fa42010-05-02 09:23:16 +020092{
Harald Welte8a521132010-05-17 22:59:29 +020093 struct bssgp_bvc_ctx *ctx;
Harald Welte6752fa42010-05-02 09:23:16 +020094
Harald Welte8a521132010-05-17 22:59:29 +020095 ctx = talloc_zero(bssgp_tall_ctx, struct bssgp_bvc_ctx);
Harald Welte6752fa42010-05-02 09:23:16 +020096 if (!ctx)
97 return NULL;
98 ctx->bvci = bvci;
99 ctx->nsei = nsei;
Harald Welte25de8112010-05-13 21:26:28 +0200100 /* FIXME: BVCI is not unique, only BVCI+NSEI ?!? */
101 ctx->ctrg = rate_ctr_group_alloc(ctx, &bssgp_ctrg_desc, bvci);
Harald Welted8b47692012-09-07 11:29:32 +0200102 ctx->fc = talloc_zero(ctx, struct bssgp_flow_control);
103 /* cofigure for 2Mbit, 30 packets in queue */
104 bssgp_fc_init(ctx->fc, 100000, 2*1024*1024/8, 30, &_bssgp_tx_dl_ud);
Harald Welte25de8112010-05-13 21:26:28 +0200105
Harald Weltea78b9c22010-05-17 23:02:42 +0200106 llist_add(&ctx->list, &bssgp_bvc_ctxts);
Harald Welte6752fa42010-05-02 09:23:16 +0200107
108 return ctx;
109}
110
Harald Welte9ba50052010-03-14 15:45:01 +0800111/* Chapter 10.4.5: Flow Control BVC ACK */
Harald Welte8f9a3ee2010-05-02 11:26:34 +0200112static int bssgp_tx_fc_bvc_ack(uint16_t nsei, uint8_t tag, uint16_t ns_bvci)
Harald Welte9ba50052010-03-14 15:45:01 +0800113{
114 struct msgb *msg = bssgp_msgb_alloc();
115 struct bssgp_normal_hdr *bgph =
116 (struct bssgp_normal_hdr *) msgb_put(msg, sizeof(*bgph));
117
Harald Welte24a655f2010-04-30 19:54:29 +0200118 msgb_nsei(msg) = nsei;
119 msgb_bvci(msg) = ns_bvci;
120
Harald Welte9ba50052010-03-14 15:45:01 +0800121 bgph->pdu_type = BSSGP_PDUT_FLOW_CONTROL_BVC_ACK;
122 msgb_tvlv_put(msg, BSSGP_IE_TAG, 1, &tag);
123
Harald Welte24a655f2010-04-30 19:54:29 +0200124 return gprs_ns_sendmsg(bssgp_nsi, msg);
Harald Welte9ba50052010-03-14 15:45:01 +0800125}
126
Harald Weltea8aa4df2010-05-30 22:00:53 +0200127/* 10.3.7 SUSPEND-ACK PDU */
128int bssgp_tx_suspend_ack(uint16_t nsei, uint32_t tlli,
129 const struct gprs_ra_id *ra_id, uint8_t suspend_ref)
130{
131 struct msgb *msg = bssgp_msgb_alloc();
132 struct bssgp_normal_hdr *bgph =
133 (struct bssgp_normal_hdr *) msgb_put(msg, sizeof(*bgph));
134 uint32_t _tlli;
135 uint8_t ra[6];
136
137 msgb_nsei(msg) = nsei;
138 msgb_bvci(msg) = 0; /* Signalling */
139 bgph->pdu_type = BSSGP_PDUT_SUSPEND_ACK;
140
Harald Weltebfe62e52017-05-15 12:48:30 +0200141 _tlli = osmo_htonl(tlli);
Harald Weltea8aa4df2010-05-30 22:00:53 +0200142 msgb_tvlv_put(msg, BSSGP_IE_TLLI, 4, (uint8_t *) &_tlli);
143 gsm48_construct_ra(ra, ra_id);
144 msgb_tvlv_put(msg, BSSGP_IE_ROUTEING_AREA, 6, ra);
145 msgb_tvlv_put(msg, BSSGP_IE_SUSPEND_REF_NR, 1, &suspend_ref);
146
147 return gprs_ns_sendmsg(bssgp_nsi, msg);
148}
149
150/* 10.3.8 SUSPEND-NACK PDU */
151int bssgp_tx_suspend_nack(uint16_t nsei, uint32_t tlli,
Dieter Spaard2b13fc2010-12-12 12:45:08 +0100152 const struct gprs_ra_id *ra_id,
Harald Weltea8aa4df2010-05-30 22:00:53 +0200153 uint8_t *cause)
154{
155 struct msgb *msg = bssgp_msgb_alloc();
156 struct bssgp_normal_hdr *bgph =
157 (struct bssgp_normal_hdr *) msgb_put(msg, sizeof(*bgph));
158 uint32_t _tlli;
Dieter Spaard2b13fc2010-12-12 12:45:08 +0100159 uint8_t ra[6];
Harald Weltea8aa4df2010-05-30 22:00:53 +0200160
161 msgb_nsei(msg) = nsei;
162 msgb_bvci(msg) = 0; /* Signalling */
163 bgph->pdu_type = BSSGP_PDUT_SUSPEND_NACK;
164
Harald Weltebfe62e52017-05-15 12:48:30 +0200165 _tlli = osmo_htonl(tlli);
Harald Weltea8aa4df2010-05-30 22:00:53 +0200166 msgb_tvlv_put(msg, BSSGP_IE_TLLI, 4, (uint8_t *) &_tlli);
Dieter Spaard2b13fc2010-12-12 12:45:08 +0100167 gsm48_construct_ra(ra, ra_id);
168 msgb_tvlv_put(msg, BSSGP_IE_ROUTEING_AREA, 6, ra);
Harald Weltea8aa4df2010-05-30 22:00:53 +0200169 if (cause)
170 msgb_tvlv_put(msg, BSSGP_IE_CAUSE, 1, cause);
171
172 return gprs_ns_sendmsg(bssgp_nsi, msg);
173}
174
175/* 10.3.10 RESUME-ACK PDU */
176int bssgp_tx_resume_ack(uint16_t nsei, uint32_t tlli,
177 const struct gprs_ra_id *ra_id)
178{
179 struct msgb *msg = bssgp_msgb_alloc();
180 struct bssgp_normal_hdr *bgph =
181 (struct bssgp_normal_hdr *) msgb_put(msg, sizeof(*bgph));
182 uint32_t _tlli;
183 uint8_t ra[6];
184
185 msgb_nsei(msg) = nsei;
186 msgb_bvci(msg) = 0; /* Signalling */
187 bgph->pdu_type = BSSGP_PDUT_RESUME_ACK;
188
Harald Weltebfe62e52017-05-15 12:48:30 +0200189 _tlli = osmo_htonl(tlli);
Harald Weltea8aa4df2010-05-30 22:00:53 +0200190 msgb_tvlv_put(msg, BSSGP_IE_TLLI, 4, (uint8_t *) &_tlli);
191 gsm48_construct_ra(ra, ra_id);
192 msgb_tvlv_put(msg, BSSGP_IE_ROUTEING_AREA, 6, ra);
193
194 return gprs_ns_sendmsg(bssgp_nsi, msg);
195}
196
197/* 10.3.11 RESUME-NACK PDU */
198int bssgp_tx_resume_nack(uint16_t nsei, uint32_t tlli,
199 const struct gprs_ra_id *ra_id, uint8_t *cause)
200{
201 struct msgb *msg = bssgp_msgb_alloc();
202 struct bssgp_normal_hdr *bgph =
203 (struct bssgp_normal_hdr *) msgb_put(msg, sizeof(*bgph));
204 uint32_t _tlli;
205 uint8_t ra[6];
206
207 msgb_nsei(msg) = nsei;
208 msgb_bvci(msg) = 0; /* Signalling */
209 bgph->pdu_type = BSSGP_PDUT_SUSPEND_NACK;
210
Harald Weltebfe62e52017-05-15 12:48:30 +0200211 _tlli = osmo_htonl(tlli);
Harald Weltea8aa4df2010-05-30 22:00:53 +0200212 msgb_tvlv_put(msg, BSSGP_IE_TLLI, 4, (uint8_t *) &_tlli);
213 gsm48_construct_ra(ra, ra_id);
214 msgb_tvlv_put(msg, BSSGP_IE_ROUTEING_AREA, 6, ra);
215 if (cause)
216 msgb_tvlv_put(msg, BSSGP_IE_CAUSE, 1, cause);
217
218 return gprs_ns_sendmsg(bssgp_nsi, msg);
219}
220
Harald Weltea2ca4ed2010-05-02 11:54:55 +0200221uint16_t bssgp_parse_cell_id(struct gprs_ra_id *raid, const uint8_t *buf)
Harald Welte6752fa42010-05-02 09:23:16 +0200222{
223 /* 6 octets RAC */
224 gsm48_parse_ra(raid, buf);
225 /* 2 octets CID */
Harald Weltebfe62e52017-05-15 12:48:30 +0200226 return osmo_load16be(buf+6);
Harald Welte6752fa42010-05-02 09:23:16 +0200227}
228
Harald Welte28610072011-11-24 21:32:07 +0100229int bssgp_create_cell_id(uint8_t *buf, const struct gprs_ra_id *raid,
230 uint16_t cid)
231{
Harald Welte28610072011-11-24 21:32:07 +0100232 /* 6 octets RAC */
233 gsm48_construct_ra(buf, raid);
234 /* 2 octets CID */
Harald Weltebfe62e52017-05-15 12:48:30 +0200235 osmo_store16be(cid, buf+6);
Harald Welte28610072011-11-24 21:32:07 +0100236
237 return 8;
238}
239
Harald Welte3fddf3c2010-05-01 16:48:27 +0200240/* Chapter 8.4 BVC-Reset Procedure */
241static int bssgp_rx_bvc_reset(struct msgb *msg, struct tlv_parsed *tp,
242 uint16_t ns_bvci)
243{
Harald Welte15a36432012-06-17 12:16:31 +0800244 struct osmo_bssgp_prim nmp;
Harald Welte8a521132010-05-17 22:59:29 +0200245 struct bssgp_bvc_ctx *bctx;
Harald Welte6752fa42010-05-02 09:23:16 +0200246 uint16_t nsei = msgb_nsei(msg);
247 uint16_t bvci;
Harald Welte3fddf3c2010-05-01 16:48:27 +0200248
Harald Weltebfe62e52017-05-15 12:48:30 +0200249 bvci = tlvp_val16be(tp, BSSGP_IE_BVCI);
Harald Weltee9686b62010-05-31 18:07:17 +0200250 DEBUGP(DBSSGP, "BSSGP BVCI=%u Rx RESET cause=%s\n", bvci,
Harald Welte3fddf3c2010-05-01 16:48:27 +0200251 bssgp_cause_str(*TLVP_VAL(tp, BSSGP_IE_CAUSE)));
252
Harald Welte6752fa42010-05-02 09:23:16 +0200253 /* look-up or create the BTS context for this BVC */
254 bctx = btsctx_by_bvci_nsei(bvci, nsei);
255 if (!bctx)
256 bctx = btsctx_alloc(bvci, nsei);
257
Harald Welte25de8112010-05-13 21:26:28 +0200258 /* As opposed to NS-VCs, BVCs are NOT blocked after RESET */
259 bctx->state &= ~BVC_S_BLOCKED;
260
Harald Welte3fddf3c2010-05-01 16:48:27 +0200261 /* When we receive a BVC-RESET PDU (at least of a PTP BVCI), the BSS
262 * informs us about its RAC + Cell ID, so we can create a mapping */
Harald Welte6752fa42010-05-02 09:23:16 +0200263 if (bvci != 0 && bvci != 1) {
264 if (!TLVP_PRESENT(tp, BSSGP_IE_CELL_ID)) {
Harald Welte086fe322011-08-19 16:45:19 +0200265 LOGP(DBSSGP, LOGL_ERROR, "BSSGP BVCI=%u Rx RESET "
Harald Welte6752fa42010-05-02 09:23:16 +0200266 "missing mandatory IE\n", bvci);
267 return -EINVAL;
268 }
269 /* actually extract RAC / CID */
Harald Weltea2ca4ed2010-05-02 11:54:55 +0200270 bctx->cell_id = bssgp_parse_cell_id(&bctx->ra_id,
271 TLVP_VAL(tp, BSSGP_IE_CELL_ID));
Harald Welteb8a6a832010-05-11 05:54:22 +0200272 LOGP(DBSSGP, LOGL_NOTICE, "Cell %u-%u-%u-%u CI %u on BVCI %u\n",
Harald Welte6752fa42010-05-02 09:23:16 +0200273 bctx->ra_id.mcc, bctx->ra_id.mnc, bctx->ra_id.lac,
274 bctx->ra_id.rac, bctx->cell_id, bvci);
275 }
Harald Welte3fddf3c2010-05-01 16:48:27 +0200276
Harald Welte15a36432012-06-17 12:16:31 +0800277 /* Send NM_BVC_RESET.ind to NM */
278 memset(&nmp, 0, sizeof(nmp));
279 nmp.nsei = nsei;
280 nmp.bvci = bvci;
281 nmp.tp = tp;
282 nmp.ra_id = &bctx->ra_id;
283 osmo_prim_init(&nmp.oph, SAP_BSSGP_NM, PRIM_NM_BVC_RESET,
284 PRIM_OP_INDICATION, msg);
285 bssgp_prim_cb(&nmp.oph, NULL);
286
Harald Welte6752fa42010-05-02 09:23:16 +0200287 /* Acknowledge the RESET to the BTS */
Harald Welte5b3bffb2012-09-07 12:03:40 +0200288 bssgp_tx_simple_bvci(BSSGP_PDUT_BVC_RESET_ACK,
289 nsei, bvci, ns_bvci);
Harald Welte3fddf3c2010-05-01 16:48:27 +0200290 return 0;
291}
292
Harald Welte25de8112010-05-13 21:26:28 +0200293static int bssgp_rx_bvc_block(struct msgb *msg, struct tlv_parsed *tp)
294{
Harald Welte15a36432012-06-17 12:16:31 +0800295 struct osmo_bssgp_prim nmp;
Harald Welte25de8112010-05-13 21:26:28 +0200296 uint16_t bvci;
Harald Welte8a521132010-05-17 22:59:29 +0200297 struct bssgp_bvc_ctx *ptp_ctx;
Harald Welte25de8112010-05-13 21:26:28 +0200298
Harald Weltebfe62e52017-05-15 12:48:30 +0200299 bvci = tlvp_val16be(tp, BSSGP_IE_BVCI);
Harald Welte61c07842010-05-18 11:57:08 +0200300 if (bvci == BVCI_SIGNALLING) {
Harald Welte58e65c92010-05-13 21:45:23 +0200301 /* 8.3.2: Signalling BVC shall never be blocked */
302 LOGP(DBSSGP, LOGL_ERROR, "NSEI=%u/BVCI=%u "
303 "received block for signalling BVC!?!\n",
304 msgb_nsei(msg), msgb_bvci(msg));
305 return 0;
306 }
Harald Welte25de8112010-05-13 21:26:28 +0200307
Harald Welte086fe322011-08-19 16:45:19 +0200308 LOGP(DBSSGP, LOGL_INFO, "BSSGP Rx BVCI=%u BVC-BLOCK\n", bvci);
Harald Welte25de8112010-05-13 21:26:28 +0200309
310 ptp_ctx = btsctx_by_bvci_nsei(bvci, msgb_nsei(msg));
311 if (!ptp_ctx)
312 return bssgp_tx_status(BSSGP_CAUSE_UNKNOWN_BVCI, &bvci, msg);
313
314 ptp_ctx->state |= BVC_S_BLOCKED;
315 rate_ctr_inc(&ptp_ctx->ctrg->ctr[BSSGP_CTR_BLOCKED]);
316
Harald Welte15a36432012-06-17 12:16:31 +0800317 /* Send NM_BVC_BLOCK.ind to NM */
318 memset(&nmp, 0, sizeof(nmp));
319 nmp.nsei = msgb_nsei(msg);
320 nmp.bvci = bvci;
321 nmp.tp = tp;
322 osmo_prim_init(&nmp.oph, SAP_BSSGP_NM, PRIM_NM_BVC_BLOCK,
323 PRIM_OP_INDICATION, msg);
324 bssgp_prim_cb(&nmp.oph, NULL);
Harald Welte25de8112010-05-13 21:26:28 +0200325
326 /* We always acknowledge the BLOCKing */
327 return bssgp_tx_simple_bvci(BSSGP_PDUT_BVC_BLOCK_ACK, msgb_nsei(msg),
328 bvci, msgb_bvci(msg));
329};
330
331static int bssgp_rx_bvc_unblock(struct msgb *msg, struct tlv_parsed *tp)
332{
Harald Welte15a36432012-06-17 12:16:31 +0800333 struct osmo_bssgp_prim nmp;
Harald Welte25de8112010-05-13 21:26:28 +0200334 uint16_t bvci;
Harald Welte8a521132010-05-17 22:59:29 +0200335 struct bssgp_bvc_ctx *ptp_ctx;
Harald Welte25de8112010-05-13 21:26:28 +0200336
Harald Weltebfe62e52017-05-15 12:48:30 +0200337 bvci = tlvp_val16be(tp, BSSGP_IE_BVCI);
Harald Welte61c07842010-05-18 11:57:08 +0200338 if (bvci == BVCI_SIGNALLING) {
Harald Welte58e65c92010-05-13 21:45:23 +0200339 /* 8.3.2: Signalling BVC shall never be blocked */
340 LOGP(DBSSGP, LOGL_ERROR, "NSEI=%u/BVCI=%u "
341 "received unblock for signalling BVC!?!\n",
342 msgb_nsei(msg), msgb_bvci(msg));
343 return 0;
344 }
Harald Welte25de8112010-05-13 21:26:28 +0200345
Harald Weltee9686b62010-05-31 18:07:17 +0200346 DEBUGP(DBSSGP, "BSSGP BVCI=%u Rx BVC-UNBLOCK\n", bvci);
Harald Welte25de8112010-05-13 21:26:28 +0200347
348 ptp_ctx = btsctx_by_bvci_nsei(bvci, msgb_nsei(msg));
349 if (!ptp_ctx)
350 return bssgp_tx_status(BSSGP_CAUSE_UNKNOWN_BVCI, &bvci, msg);
351
352 ptp_ctx->state &= ~BVC_S_BLOCKED;
353
Harald Welte15a36432012-06-17 12:16:31 +0800354 /* Send NM_BVC_UNBLOCK.ind to NM */
355 memset(&nmp, 0, sizeof(nmp));
356 nmp.nsei = msgb_nsei(msg);
357 nmp.bvci = bvci;
358 nmp.tp = tp;
359 osmo_prim_init(&nmp.oph, SAP_BSSGP_NM, PRIM_NM_BVC_UNBLOCK,
360 PRIM_OP_INDICATION, msg);
361 bssgp_prim_cb(&nmp.oph, NULL);
Harald Welte25de8112010-05-13 21:26:28 +0200362
363 /* We always acknowledge the unBLOCKing */
364 return bssgp_tx_simple_bvci(BSSGP_PDUT_BVC_UNBLOCK_ACK, msgb_nsei(msg),
365 bvci, msgb_bvci(msg));
366};
367
Harald Welte9ba50052010-03-14 15:45:01 +0800368/* Uplink unit-data */
Harald Welte25de8112010-05-13 21:26:28 +0200369static int bssgp_rx_ul_ud(struct msgb *msg, struct tlv_parsed *tp,
Harald Welte8a521132010-05-17 22:59:29 +0200370 struct bssgp_bvc_ctx *ctx)
Harald Welte9ba50052010-03-14 15:45:01 +0800371{
Harald Welte15a36432012-06-17 12:16:31 +0800372 struct osmo_bssgp_prim gbp;
Harald Welteec19c102010-05-02 09:50:42 +0200373 struct bssgp_ud_hdr *budh = (struct bssgp_ud_hdr *) msgb_bssgph(msg);
Harald Welte9ba50052010-03-14 15:45:01 +0800374
Harald Welte6752fa42010-05-02 09:23:16 +0200375 /* extract TLLI and parse TLV IEs */
Harald Weltebfe62e52017-05-15 12:48:30 +0200376 msgb_tlli(msg) = osmo_ntohl(budh->tlli);
Harald Welte9ba50052010-03-14 15:45:01 +0800377
Harald Welte086fe322011-08-19 16:45:19 +0200378 DEBUGP(DBSSGP, "BSSGP TLLI=0x%08x Rx UPLINK-UNITDATA\n", msgb_tlli(msg));
Harald Weltee9686b62010-05-31 18:07:17 +0200379
Harald Welte9ba50052010-03-14 15:45:01 +0800380 /* Cell ID and LLC_PDU are the only mandatory IE */
Harald Welte25de8112010-05-13 21:26:28 +0200381 if (!TLVP_PRESENT(tp, BSSGP_IE_CELL_ID) ||
Harald Weltee9686b62010-05-31 18:07:17 +0200382 !TLVP_PRESENT(tp, BSSGP_IE_LLC_PDU)) {
383 LOGP(DBSSGP, LOGL_ERROR, "BSSGP TLLI=0x%08x Rx UL-UD "
384 "missing mandatory IE\n", msgb_tlli(msg));
Harald Welte25de8112010-05-13 21:26:28 +0200385 return bssgp_tx_status(BSSGP_CAUSE_MISSING_MAND_IE, NULL, msg);
Harald Weltee9686b62010-05-31 18:07:17 +0200386 }
Harald Welte30bc19a2010-05-02 11:19:37 +0200387
Harald Weltea2ca4ed2010-05-02 11:54:55 +0200388 /* store pointer to LLC header and CELL ID in msgb->cb */
Holger Hans Peter Freytherb6eded82010-05-23 21:11:19 +0800389 msgb_llch(msg) = (uint8_t *) TLVP_VAL(tp, BSSGP_IE_LLC_PDU);
390 msgb_bcid(msg) = (uint8_t *) TLVP_VAL(tp, BSSGP_IE_CELL_ID);
Harald Welte9ba50052010-03-14 15:45:01 +0800391
Harald Welte15a36432012-06-17 12:16:31 +0800392 /* Send BSSGP_UL_UD.ind to NM */
393 memset(&gbp, 0, sizeof(gbp));
394 gbp.nsei = ctx->nsei;
395 gbp.bvci = ctx->bvci;
396 gbp.tlli = msgb_tlli(msg);
397 gbp.tp = tp;
398 osmo_prim_init(&gbp.oph, SAP_BSSGP_LL, PRIM_BSSGP_UL_UD,
399 PRIM_OP_INDICATION, msg);
400 return bssgp_prim_cb(&gbp.oph, NULL);
Harald Welte9ba50052010-03-14 15:45:01 +0800401}
402
Jacob Erlbeckb43baf22014-09-10 12:43:28 +0200403static int bssgp_rx_suspend(struct msgb *msg, struct tlv_parsed *tp)
Harald Welte9ba50052010-03-14 15:45:01 +0800404{
Harald Welte15a36432012-06-17 12:16:31 +0800405 struct osmo_bssgp_prim gbp;
Harald Weltea8aa4df2010-05-30 22:00:53 +0200406 struct gprs_ra_id raid;
407 uint32_t tlli;
Jacob Erlbeckb43baf22014-09-10 12:43:28 +0200408 uint16_t ns_bvci = msgb_bvci(msg);
Harald Welte313cccf2010-06-09 11:22:47 +0200409 int rc;
Harald Welte9ba50052010-03-14 15:45:01 +0800410
Harald Welte25de8112010-05-13 21:26:28 +0200411 if (!TLVP_PRESENT(tp, BSSGP_IE_TLLI) ||
Harald Weltee9686b62010-05-31 18:07:17 +0200412 !TLVP_PRESENT(tp, BSSGP_IE_ROUTEING_AREA)) {
413 LOGP(DBSSGP, LOGL_ERROR, "BSSGP BVCI=%u Rx SUSPEND "
Jacob Erlbeckb43baf22014-09-10 12:43:28 +0200414 "missing mandatory IE\n", ns_bvci);
Harald Welte25de8112010-05-13 21:26:28 +0200415 return bssgp_tx_status(BSSGP_CAUSE_MISSING_MAND_IE, NULL, msg);
Harald Weltee9686b62010-05-31 18:07:17 +0200416 }
Harald Welte9ba50052010-03-14 15:45:01 +0800417
Harald Weltebfe62e52017-05-15 12:48:30 +0200418 tlli = tlvp_val32be(tp, BSSGP_IE_TLLI);
Harald Weltee9686b62010-05-31 18:07:17 +0200419
Harald Welte17925322010-05-31 20:18:35 +0200420 DEBUGP(DBSSGP, "BSSGP BVCI=%u TLLI=0x%08x Rx SUSPEND\n",
Jacob Erlbeckb43baf22014-09-10 12:43:28 +0200421 ns_bvci, tlli);
Harald Weltee9686b62010-05-31 18:07:17 +0200422
Harald Weltea8aa4df2010-05-30 22:00:53 +0200423 gsm48_parse_ra(&raid, TLVP_VAL(tp, BSSGP_IE_ROUTEING_AREA));
424
Harald Welte313cccf2010-06-09 11:22:47 +0200425 /* Inform GMM about the SUSPEND request */
Harald Welte15a36432012-06-17 12:16:31 +0800426 memset(&gbp, 0, sizeof(gbp));
427 gbp.nsei = msgb_nsei(msg);
Jacob Erlbeckb43baf22014-09-10 12:43:28 +0200428 gbp.bvci = ns_bvci;
Harald Welte15a36432012-06-17 12:16:31 +0800429 gbp.tlli = tlli;
430 gbp.ra_id = &raid;
431 osmo_prim_init(&gbp.oph, SAP_BSSGP_GMM, PRIM_BSSGP_GMM_SUSPEND,
432 PRIM_OP_REQUEST, msg);
433
434 rc = bssgp_prim_cb(&gbp.oph, NULL);
Harald Welte313cccf2010-06-09 11:22:47 +0200435 if (rc < 0)
Dieter Spaard2b13fc2010-12-12 12:45:08 +0100436 return bssgp_tx_suspend_nack(msgb_nsei(msg), tlli, &raid, NULL);
Harald Welte313cccf2010-06-09 11:22:47 +0200437
Harald Weltea8aa4df2010-05-30 22:00:53 +0200438 bssgp_tx_suspend_ack(msgb_nsei(msg), tlli, &raid, 0);
439
Holger Hans Peter Freytherd30cefa2010-05-23 21:12:15 +0800440 return 0;
Harald Welte9ba50052010-03-14 15:45:01 +0800441}
442
Jacob Erlbeckb43baf22014-09-10 12:43:28 +0200443static int bssgp_rx_resume(struct msgb *msg, struct tlv_parsed *tp)
Harald Welte9ba50052010-03-14 15:45:01 +0800444{
Harald Welte15a36432012-06-17 12:16:31 +0800445 struct osmo_bssgp_prim gbp;
Harald Weltea8aa4df2010-05-30 22:00:53 +0200446 struct gprs_ra_id raid;
447 uint32_t tlli;
Harald Welte313cccf2010-06-09 11:22:47 +0200448 uint8_t suspend_ref;
Jacob Erlbeckb43baf22014-09-10 12:43:28 +0200449 uint16_t ns_bvci = msgb_bvci(msg);
Harald Welte313cccf2010-06-09 11:22:47 +0200450 int rc;
Harald Welte9ba50052010-03-14 15:45:01 +0800451
Harald Welte25de8112010-05-13 21:26:28 +0200452 if (!TLVP_PRESENT(tp, BSSGP_IE_TLLI) ||
453 !TLVP_PRESENT(tp, BSSGP_IE_ROUTEING_AREA) ||
Harald Weltee9686b62010-05-31 18:07:17 +0200454 !TLVP_PRESENT(tp, BSSGP_IE_SUSPEND_REF_NR)) {
455 LOGP(DBSSGP, LOGL_ERROR, "BSSGP BVCI=%u Rx RESUME "
Jacob Erlbeckb43baf22014-09-10 12:43:28 +0200456 "missing mandatory IE\n", ns_bvci);
Harald Welte25de8112010-05-13 21:26:28 +0200457 return bssgp_tx_status(BSSGP_CAUSE_MISSING_MAND_IE, NULL, msg);
Harald Weltee9686b62010-05-31 18:07:17 +0200458 }
Harald Welte9ba50052010-03-14 15:45:01 +0800459
Harald Weltebfe62e52017-05-15 12:48:30 +0200460 tlli = tlvp_val32be(tp, BSSGP_IE_TLLI);
Harald Welte313cccf2010-06-09 11:22:47 +0200461 suspend_ref = *TLVP_VAL(tp, BSSGP_IE_SUSPEND_REF_NR);
Harald Weltee9686b62010-05-31 18:07:17 +0200462
Jacob Erlbeckb43baf22014-09-10 12:43:28 +0200463 DEBUGP(DBSSGP, "BSSGP BVCI=%u TLLI=0x%08x Rx RESUME\n", ns_bvci, tlli);
Harald Weltee9686b62010-05-31 18:07:17 +0200464
Harald Weltea8aa4df2010-05-30 22:00:53 +0200465 gsm48_parse_ra(&raid, TLVP_VAL(tp, BSSGP_IE_ROUTEING_AREA));
466
Harald Welte313cccf2010-06-09 11:22:47 +0200467 /* Inform GMM about the RESUME request */
Harald Welte15a36432012-06-17 12:16:31 +0800468 memset(&gbp, 0, sizeof(gbp));
469 gbp.nsei = msgb_nsei(msg);
Jacob Erlbeckb43baf22014-09-10 12:43:28 +0200470 gbp.bvci = ns_bvci;
Harald Welte15a36432012-06-17 12:16:31 +0800471 gbp.tlli = tlli;
472 gbp.ra_id = &raid;
473 gbp.u.resume.suspend_ref = suspend_ref;
474 osmo_prim_init(&gbp.oph, SAP_BSSGP_GMM, PRIM_BSSGP_GMM_RESUME,
475 PRIM_OP_REQUEST, msg);
476
477 rc = bssgp_prim_cb(&gbp.oph, NULL);
Harald Welte313cccf2010-06-09 11:22:47 +0200478 if (rc < 0)
479 return bssgp_tx_resume_nack(msgb_nsei(msg), tlli, &raid,
480 NULL);
481
Harald Weltea8aa4df2010-05-30 22:00:53 +0200482 bssgp_tx_resume_ack(msgb_nsei(msg), tlli, &raid);
Holger Hans Peter Freytherd30cefa2010-05-23 21:12:15 +0800483 return 0;
Harald Welte9ba50052010-03-14 15:45:01 +0800484}
485
Harald Weltee9686b62010-05-31 18:07:17 +0200486
487static int bssgp_rx_llc_disc(struct msgb *msg, struct tlv_parsed *tp,
488 struct bssgp_bvc_ctx *ctx)
489{
Harald Welte15a36432012-06-17 12:16:31 +0800490 struct osmo_bssgp_prim nmp;
Harald Welteb7363142010-07-23 21:59:29 +0200491 uint32_t tlli = 0;
Harald Weltee9686b62010-05-31 18:07:17 +0200492
493 if (!TLVP_PRESENT(tp, BSSGP_IE_TLLI) ||
494 !TLVP_PRESENT(tp, BSSGP_IE_LLC_FRAMES_DISCARDED) ||
495 !TLVP_PRESENT(tp, BSSGP_IE_BVCI) ||
496 !TLVP_PRESENT(tp, BSSGP_IE_NUM_OCT_AFF)) {
497 LOGP(DBSSGP, LOGL_ERROR, "BSSGP BVCI=%u Rx LLC DISCARDED "
498 "missing mandatory IE\n", ctx->bvci);
499 }
500
Harald Welteb7363142010-07-23 21:59:29 +0200501 if (TLVP_PRESENT(tp, BSSGP_IE_TLLI))
Harald Weltebfe62e52017-05-15 12:48:30 +0200502 tlli = tlvp_val32be(tp, BSSGP_IE_TLLI);
Harald Weltee9686b62010-05-31 18:07:17 +0200503
Harald Welte086fe322011-08-19 16:45:19 +0200504 DEBUGP(DBSSGP, "BSSGP BVCI=%u TLLI=%08x Rx LLC DISCARDED\n",
Harald Weltee9686b62010-05-31 18:07:17 +0200505 ctx->bvci, tlli);
506
507 rate_ctr_inc(&ctx->ctrg->ctr[BSSGP_CTR_DISCARDED]);
508
Harald Welte15a36432012-06-17 12:16:31 +0800509 /* send NM_LLC_DISCARDED to NM */
510 memset(&nmp, 0, sizeof(nmp));
511 nmp.nsei = msgb_nsei(msg);
512 nmp.bvci = ctx->bvci;
513 nmp.tlli = tlli;
514 nmp.tp = tp;
515 osmo_prim_init(&nmp.oph, SAP_BSSGP_NM, PRIM_NM_LLC_DISCARDED,
516 PRIM_OP_INDICATION, msg);
517
518 return bssgp_prim_cb(&nmp.oph, NULL);
Harald Weltee9686b62010-05-31 18:07:17 +0200519}
520
Jacob Erlbeck36153dc2015-03-17 10:21:17 +0100521int bssgp_rx_status(struct msgb *msg, struct tlv_parsed *tp,
522 uint16_t bvci, struct bssgp_bvc_ctx *bctx)
523{
524 struct osmo_bssgp_prim nmp;
525 enum gprs_bssgp_cause cause;
526
527 if (!TLVP_PRESENT(tp, BSSGP_IE_CAUSE)) {
528 LOGP(DBSSGP, LOGL_ERROR, "BSSGP BVCI=%u Rx STATUS "
529 "missing mandatory IE\n", bvci);
530 cause = BSSGP_CAUSE_PROTO_ERR_UNSPEC;
531 } else {
532 cause = *TLVP_VAL(tp, BSSGP_IE_CAUSE);
533 }
534
535 LOGP(DBSSGP, LOGL_NOTICE, "BSSGP BVCI=%u Rx BVC STATUS, cause=%s\n",
536 bvci, bssgp_cause_str(cause));
537
538 if (cause == BSSGP_CAUSE_BVCI_BLOCKED || cause == BSSGP_CAUSE_UNKNOWN_BVCI) {
539 if (!TLVP_PRESENT(tp, BSSGP_IE_BVCI))
540 LOGP(DBSSGP, LOGL_ERROR,
541 "BSSGP BVCI=%u Rx STATUS cause=%s "
542 "missing conditional BVCI IE\n",
543 bvci, bssgp_cause_str(cause));
544 }
545
546 if (bctx)
547 rate_ctr_inc(&bctx->ctrg->ctr[BSSGP_CTR_STATUS]);
548
549 /* send NM_STATUS to NM */
550 memset(&nmp, 0, sizeof(nmp));
551 nmp.nsei = msgb_nsei(msg);
552 nmp.bvci = bvci;
553 nmp.tp = tp;
554 osmo_prim_init(&nmp.oph, SAP_BSSGP_NM, PRIM_NM_STATUS,
555 PRIM_OP_INDICATION, msg);
556
557 return bssgp_prim_cb(&nmp.oph, NULL);
558}
559
560
Harald Welted11c0592012-09-06 21:57:11 +0200561/* One element (msgb) in a BSSGP Flow Control queue */
562struct bssgp_fc_queue_element {
563 /* linked list of queue elements */
564 struct llist_head list;
565 /* The message that we have enqueued */
566 struct msgb *msg;
567 /* Length of the LLC PDU part of the contained message */
568 uint32_t llc_pdu_len;
569 /* private pointer passed to the flow control out_cb function */
570 void *priv;
571};
572
573static int fc_queue_timer_cfg(struct bssgp_flow_control *fc);
574static int bssgp_fc_needs_queueing(struct bssgp_flow_control *fc, uint32_t pdu_len);
575
576static void fc_timer_cb(void *data)
577{
578 struct bssgp_flow_control *fc = data;
579 struct bssgp_fc_queue_element *fcqe;
580 struct timeval time_now;
581
582 /* if the queue is empty, we return without sending something
583 * and without re-starting the timer */
584 if (llist_empty(&fc->queue))
585 return;
586
587 /* get the first entry from the queue */
588 fcqe = llist_entry(fc->queue.next, struct bssgp_fc_queue_element,
589 list);
590
591 if (bssgp_fc_needs_queueing(fc, fcqe->llc_pdu_len)) {
592 LOGP(DBSSGP, LOGL_NOTICE, "BSSGP-FC: fc_timer_cb() but still "
593 "not able to send PDU of %u bytes\n", fcqe->llc_pdu_len);
594 /* make sure we re-start the timer */
595 fc_queue_timer_cfg(fc);
596 return;
597 }
598
599 /* remove from the queue */
600 llist_del(&fcqe->list);
601
602 fc->queue_depth--;
603
604 /* record the time we transmitted this PDU */
Neels Hofmeyr8e2f7e82016-09-22 03:58:13 +0200605 osmo_gettimeofday(&time_now, NULL);
Harald Welted11c0592012-09-06 21:57:11 +0200606 fc->time_last_pdu = time_now;
607
608 /* call the output callback for this FC instance */
609 fc->out_cb(fcqe->priv, fcqe->msg, fcqe->llc_pdu_len, NULL);
610
611 /* we expect that out_cb will in the end free the msgb once
612 * it is no longer needed */
613
614 /* but we have to free the queue element ourselves */
615 talloc_free(fcqe);
616
617 /* re-configure the timer for the next PDU */
618 fc_queue_timer_cfg(fc);
619}
620
621/* configure/schedule the flow control timer to expire once the bucket
622 * will have leaked a sufficient number of bytes to transmit the next
623 * PDU in the queue */
624static int fc_queue_timer_cfg(struct bssgp_flow_control *fc)
625{
626 struct bssgp_fc_queue_element *fcqe;
627 uint32_t msecs;
628
629 if (llist_empty(&fc->queue))
630 return 0;
631
Jacob Erlbeck97319352015-04-30 19:28:03 +0200632 fcqe = llist_entry(fc->queue.next, struct bssgp_fc_queue_element,
Harald Welted11c0592012-09-06 21:57:11 +0200633 list);
634
Harald Welte27b2bb72013-06-22 09:44:00 +0200635 if (fc->bucket_leak_rate != 0) {
636 /* Calculate the point in time at which we will have leaked
637 * a sufficient number of bytes from the bucket to transmit
638 * the first PDU in the queue */
639 msecs = (fcqe->llc_pdu_len * 1000) / fc->bucket_leak_rate;
640 /* FIXME: add that time to fc->time_last_pdu and subtract it from
641 * current time */
Pablo Neira Ayuso44f423f2017-05-08 18:00:28 +0200642 osmo_timer_setup(&fc->timer, fc_timer_cb, fc);
Harald Welte27b2bb72013-06-22 09:44:00 +0200643 osmo_timer_schedule(&fc->timer, msecs / 1000, (msecs % 1000) * 1000);
644 } else {
645 /* If the PCU is telling us to not send any more data at all,
646 * there's no point starting a timer. */
647 }
Harald Welted11c0592012-09-06 21:57:11 +0200648
649 return 0;
650}
651
652/* Enqueue a PDU in the flow control queue for delayed transmission */
653static int fc_enqueue(struct bssgp_flow_control *fc, struct msgb *msg,
654 uint32_t llc_pdu_len, void *priv)
655{
656 struct bssgp_fc_queue_element *fcqe;
657
658 if (fc->queue_depth >= fc->max_queue_depth)
659 return -ENOSPC;
660
661 fcqe = talloc_zero(fc, struct bssgp_fc_queue_element);
662 if (!fcqe)
663 return -ENOMEM;
664 fcqe->msg = msg;
665 fcqe->llc_pdu_len = llc_pdu_len;
666 fcqe->priv = priv;
667
668 llist_add_tail(&fcqe->list, &fc->queue);
669
670 fc->queue_depth++;
671
672 /* re-configure the timer for dequeueing the pdu */
673 fc_queue_timer_cfg(fc);
674
675 return 0;
676}
677
678/* According to Section 8.2 */
679static int bssgp_fc_needs_queueing(struct bssgp_flow_control *fc, uint32_t pdu_len)
680{
681 struct timeval time_now, time_diff;
682 int64_t bucket_predicted;
683 uint32_t csecs_elapsed, leaked;
684
685 /* B' = B + L(p) - (Tc - Tp)*R */
686
687 /* compute number of centi-seconds that have elapsed since transmitting
688 * the last PDU (Tc - Tp) */
Neels Hofmeyr8e2f7e82016-09-22 03:58:13 +0200689 osmo_gettimeofday(&time_now, NULL);
Harald Welted11c0592012-09-06 21:57:11 +0200690 timersub(&time_now, &fc->time_last_pdu, &time_diff);
691 csecs_elapsed = time_diff.tv_sec*100 + time_diff.tv_usec/10000;
692
693 /* compute number of bytes that have leaked in the elapsed number
694 * of centi-seconds */
695 leaked = csecs_elapsed * (fc->bucket_leak_rate / 100);
696 /* add the current PDU length to the last bucket level */
697 bucket_predicted = fc->bucket_counter + pdu_len;
698 /* ... and subtract the number of leaked bytes */
699 bucket_predicted -= leaked;
700
701 if (bucket_predicted < pdu_len) {
702 /* this is just to make sure the bucket doesn't underflow */
703 bucket_predicted = pdu_len;
704 goto pass;
705 }
706
707 if (bucket_predicted <= fc->bucket_size_max) {
708 /* the bucket is not full yet, we can pass the packet */
709 fc->bucket_counter = bucket_predicted;
710 goto pass;
711 }
712
713 /* bucket is full, PDU needs to be delayed */
714 return 1;
715
716pass:
717 /* if we reach here, the PDU can pass */
718 return 0;
719}
720
721/* output callback for BVC flow control */
722static int _bssgp_tx_dl_ud(struct bssgp_flow_control *fc, struct msgb *msg,
723 uint32_t llc_pdu_len, void *priv)
724{
725 return gprs_ns_sendmsg(bssgp_nsi, msg);
726}
727
728/* input function of the flow control implementation, called first
729 * for the MM flow control, and then as the MM flow control output
730 * callback in order to perform BVC flow control */
731int bssgp_fc_in(struct bssgp_flow_control *fc, struct msgb *msg,
732 uint32_t llc_pdu_len, void *priv)
733{
734 struct timeval time_now;
735
Harald Weltebb826222012-09-07 10:22:01 +0200736 if (llc_pdu_len > fc->bucket_size_max) {
737 LOGP(DBSSGP, LOGL_NOTICE, "Single PDU (size=%u) is larger "
738 "than maximum bucket size (%u)!\n", llc_pdu_len,
739 fc->bucket_size_max);
Holger Hans Peter Freyther10dd73c2014-10-10 17:24:34 +0200740 msgb_free(msg);
Harald Weltebb826222012-09-07 10:22:01 +0200741 return -EIO;
742 }
743
Harald Welted11c0592012-09-06 21:57:11 +0200744 if (bssgp_fc_needs_queueing(fc, llc_pdu_len)) {
745 return fc_enqueue(fc, msg, llc_pdu_len, priv);
746 } else {
747 /* record the time we transmitted this PDU */
Neels Hofmeyr8e2f7e82016-09-22 03:58:13 +0200748 osmo_gettimeofday(&time_now, NULL);
Harald Welted11c0592012-09-06 21:57:11 +0200749 fc->time_last_pdu = time_now;
750 return fc->out_cb(priv, msg, llc_pdu_len, NULL);
751 }
752}
753
Harald Weltebb826222012-09-07 10:22:01 +0200754
755/* Initialize the Flow Control structure */
756void bssgp_fc_init(struct bssgp_flow_control *fc,
757 uint32_t bucket_size_max, uint32_t bucket_leak_rate,
758 uint32_t max_queue_depth,
759 int (*out_cb)(struct bssgp_flow_control *fc, struct msgb *msg,
760 uint32_t llc_pdu_len, void *priv))
761{
762 fc->out_cb = out_cb;
763 fc->bucket_size_max = bucket_size_max;
764 fc->bucket_leak_rate = bucket_leak_rate;
765 fc->max_queue_depth = max_queue_depth;
766 INIT_LLIST_HEAD(&fc->queue);
Neels Hofmeyr8e2f7e82016-09-22 03:58:13 +0200767 osmo_gettimeofday(&fc->time_last_pdu, NULL);
Harald Weltebb826222012-09-07 10:22:01 +0200768}
769
Harald Welted11c0592012-09-06 21:57:11 +0200770/* Initialize the Flow Control parameters for a new MS according to
771 * default values for the BVC specified by BVCI and NSEI */
772int bssgp_fc_ms_init(struct bssgp_flow_control *fc_ms, uint16_t bvci,
Harald Weltebb826222012-09-07 10:22:01 +0200773 uint16_t nsei, uint32_t max_queue_depth)
Harald Welted11c0592012-09-06 21:57:11 +0200774{
775 struct bssgp_bvc_ctx *ctx;
776
777 ctx = btsctx_by_bvci_nsei(bvci, nsei);
778 if (!ctx)
779 return -ENODEV;
Harald Weltebb826222012-09-07 10:22:01 +0200780
781 /* output call-back of per-MS FC is per-CTX FC */
782 bssgp_fc_init(fc_ms, ctx->bmax_default_ms, ctx->r_default_ms,
783 max_queue_depth, bssgp_fc_in);
Harald Welted11c0592012-09-06 21:57:11 +0200784
785 return 0;
786}
787
Harald Welte25de8112010-05-13 21:26:28 +0200788static int bssgp_rx_fc_bvc(struct msgb *msg, struct tlv_parsed *tp,
Harald Welte8a521132010-05-17 22:59:29 +0200789 struct bssgp_bvc_ctx *bctx)
Harald Welte9ba50052010-03-14 15:45:01 +0800790{
Harald Welte27b2bb72013-06-22 09:44:00 +0200791 uint32_t old_leak_rate = bctx->fc->bucket_leak_rate;
792 uint32_t old_r_def_ms = bctx->r_default_ms;
Harald Welte9ba50052010-03-14 15:45:01 +0800793
Harald Weltee9686b62010-05-31 18:07:17 +0200794 DEBUGP(DBSSGP, "BSSGP BVCI=%u Rx Flow Control BVC\n",
795 bctx->bvci);
Harald Welte9ba50052010-03-14 15:45:01 +0800796
797 if (!TLVP_PRESENT(tp, BSSGP_IE_TAG) ||
798 !TLVP_PRESENT(tp, BSSGP_IE_BVC_BUCKET_SIZE) ||
799 !TLVP_PRESENT(tp, BSSGP_IE_BUCKET_LEAK_RATE) ||
800 !TLVP_PRESENT(tp, BSSGP_IE_BMAX_DEFAULT_MS) ||
Harald Weltee9686b62010-05-31 18:07:17 +0200801 !TLVP_PRESENT(tp, BSSGP_IE_R_DEFAULT_MS)) {
802 LOGP(DBSSGP, LOGL_ERROR, "BSSGP BVCI=%u Rx FC BVC "
803 "missing mandatory IE\n", bctx->bvci);
Harald Welte9ba50052010-03-14 15:45:01 +0800804 return bssgp_tx_status(BSSGP_CAUSE_MISSING_MAND_IE, NULL, msg);
Harald Weltee9686b62010-05-31 18:07:17 +0200805 }
Harald Welte9ba50052010-03-14 15:45:01 +0800806
Harald Weltebb826222012-09-07 10:22:01 +0200807 /* 11.3.5 Bucket Size in 100 octets unit */
Harald Weltebfe62e52017-05-15 12:48:30 +0200808 bctx->fc->bucket_size_max = 100 * tlvp_val16be(tp, BSSGP_IE_BVC_BUCKET_SIZE);
Harald Weltebb826222012-09-07 10:22:01 +0200809 /* 11.3.4 Bucket Leak Rate in 100 bits/sec unit */
Harald Weltebfe62e52017-05-15 12:48:30 +0200810 bctx->fc->bucket_leak_rate = 100 * tlvp_val16be(tp, BSSGP_IE_BUCKET_LEAK_RATE) / 8;
Harald Weltebb826222012-09-07 10:22:01 +0200811 /* 11.3.2 in octets */
Harald Weltebfe62e52017-05-15 12:48:30 +0200812 bctx->bmax_default_ms = tlvp_val16be(tp, BSSGP_IE_BMAX_DEFAULT_MS);
Harald Weltebb826222012-09-07 10:22:01 +0200813 /* 11.3.32 Bucket Leak rate in 100bits/sec unit */
Harald Weltebfe62e52017-05-15 12:48:30 +0200814 bctx->r_default_ms = 100 * tlvp_val16be(tp, BSSGP_IE_R_DEFAULT_MS) / 8;
Harald Welte30bc19a2010-05-02 11:19:37 +0200815
Harald Welte27b2bb72013-06-22 09:44:00 +0200816 if (old_leak_rate != 0 && bctx->fc->bucket_leak_rate == 0)
817 LOGP(DBSSGP, LOGL_NOTICE, "BSS instructs us to bucket leak "
818 "rate of 0, stopping all DL GPRS!\n");
819 else if (old_leak_rate == 0 && bctx->fc->bucket_leak_rate != 0)
820 LOGP(DBSSGP, LOGL_NOTICE, "BSS instructs us to bucket leak "
821 "rate of != 0, restarting all DL GPRS!\n");
822
823 if (old_r_def_ms != 0 && bctx->r_default_ms == 0)
824 LOGP(DBSSGP, LOGL_NOTICE, "BSS instructs us to MS default "
825 "bucket leak rate of 0, stopping DL GPRS!\n");
826 else if (old_r_def_ms == 0 && bctx->r_default_ms != 0)
827 LOGP(DBSSGP, LOGL_NOTICE, "BSS instructs us to MS default "
828 "bucket leak rate != 0, restarting DL GPRS!\n");
829
830 /* reconfigure the timer for flow control based on new values */
831 fc_queue_timer_cfg(bctx->fc);
832
Harald Welte9ba50052010-03-14 15:45:01 +0800833 /* Send FLOW_CONTROL_BVC_ACK */
Harald Welte24a655f2010-04-30 19:54:29 +0200834 return bssgp_tx_fc_bvc_ack(msgb_nsei(msg), *TLVP_VAL(tp, BSSGP_IE_TAG),
Harald Welte30bc19a2010-05-02 11:19:37 +0200835 msgb_bvci(msg));
Harald Welte9ba50052010-03-14 15:45:01 +0800836}
Harald Welte3fddf3c2010-05-01 16:48:27 +0200837
Harald Welte25de8112010-05-13 21:26:28 +0200838/* Receive a BSSGP PDU from a BSS on a PTP BVCI */
Harald Weltede4599c2012-06-17 13:04:02 +0800839static int bssgp_rx_ptp(struct msgb *msg, struct tlv_parsed *tp,
840 struct bssgp_bvc_ctx *bctx)
Harald Welte9ba50052010-03-14 15:45:01 +0800841{
Harald Welteec19c102010-05-02 09:50:42 +0200842 struct bssgp_normal_hdr *bgph =
843 (struct bssgp_normal_hdr *) msgb_bssgph(msg);
Harald Welte30bc19a2010-05-02 11:19:37 +0200844 uint8_t pdu_type = bgph->pdu_type;
Harald Welte9ba50052010-03-14 15:45:01 +0800845 int rc = 0;
846
Jacob Erlbeck36153dc2015-03-17 10:21:17 +0100847 OSMO_ASSERT(pdu_type != BSSGP_PDUT_STATUS);
848
Harald Welte58e65c92010-05-13 21:45:23 +0200849 /* If traffic is received on a BVC that is marked as blocked, the
850 * received PDU shall not be accepted and a STATUS PDU (Cause value:
851 * BVC Blocked) shall be sent to the peer entity on the signalling BVC */
Jacob Erlbeck36153dc2015-03-17 10:21:17 +0100852 if (bctx->state & BVC_S_BLOCKED) {
Harald Welte58e65c92010-05-13 21:45:23 +0200853 uint16_t bvci = msgb_bvci(msg);
854 return bssgp_tx_status(BSSGP_CAUSE_BVCI_BLOCKED, &bvci, msg);
855 }
856
Harald Welte9ba50052010-03-14 15:45:01 +0800857 switch (pdu_type) {
858 case BSSGP_PDUT_UL_UNITDATA:
859 /* some LLC data from the MS */
Harald Welte25de8112010-05-13 21:26:28 +0200860 rc = bssgp_rx_ul_ud(msg, tp, bctx);
Harald Welte9ba50052010-03-14 15:45:01 +0800861 break;
862 case BSSGP_PDUT_RA_CAPABILITY:
863 /* BSS requests RA capability or IMSI */
Harald Weltee9686b62010-05-31 18:07:17 +0200864 DEBUGP(DBSSGP, "BSSGP BVCI=%u Rx RA CAPABILITY UPDATE\n",
865 bctx->bvci);
Harald Welte6b7cf252010-05-13 19:41:31 +0200866 /* FIXME: send GMM_RA_CAPABILITY_UPDATE.ind to GMM */
Harald Welte9ba50052010-03-14 15:45:01 +0800867 /* FIXME: send RA_CAPA_UPDATE_ACK */
868 break;
869 case BSSGP_PDUT_RADIO_STATUS:
Harald Weltee9686b62010-05-31 18:07:17 +0200870 DEBUGP(DBSSGP, "BSSGP BVCI=%u Rx RADIO STATUS\n", bctx->bvci);
Harald Welte9ba50052010-03-14 15:45:01 +0800871 /* BSS informs us of some exception */
Harald Welte6b7cf252010-05-13 19:41:31 +0200872 /* FIXME: send GMM_RADIO_STATUS.ind to GMM */
Harald Welte9ba50052010-03-14 15:45:01 +0800873 break;
Harald Welte9ba50052010-03-14 15:45:01 +0800874 case BSSGP_PDUT_FLOW_CONTROL_BVC:
875 /* BSS informs us of available bandwidth in Gb interface */
Harald Welte25de8112010-05-13 21:26:28 +0200876 rc = bssgp_rx_fc_bvc(msg, tp, bctx);
Harald Welte9ba50052010-03-14 15:45:01 +0800877 break;
878 case BSSGP_PDUT_FLOW_CONTROL_MS:
879 /* BSS informs us of available bandwidth to one MS */
Harald Weltee9686b62010-05-31 18:07:17 +0200880 DEBUGP(DBSSGP, "BSSGP BVCI=%u Rx Flow Control MS\n",
881 bctx->bvci);
Harald Welte30bc19a2010-05-02 11:19:37 +0200882 /* FIXME: actually implement flow control */
883 /* FIXME: Send FLOW_CONTROL_MS_ACK */
Harald Welte9ba50052010-03-14 15:45:01 +0800884 break;
Harald Welte9ba50052010-03-14 15:45:01 +0800885 case BSSGP_PDUT_STATUS:
Jacob Erlbeck36153dc2015-03-17 10:21:17 +0100886 /* This is already handled in bssgp_rcvmsg() */
Jacob Erlbeck49ed9be2015-03-17 10:21:16 +0100887 break;
Harald Welte9ba50052010-03-14 15:45:01 +0800888 case BSSGP_PDUT_DOWNLOAD_BSS_PFC:
889 case BSSGP_PDUT_CREATE_BSS_PFC_ACK:
890 case BSSGP_PDUT_CREATE_BSS_PFC_NACK:
891 case BSSGP_PDUT_MODIFY_BSS_PFC:
892 case BSSGP_PDUT_DELETE_BSS_PFC_ACK:
Max2c34ab42016-03-17 15:42:26 +0100893 DEBUGP(DBSSGP, "BSSGP BVCI=%u Rx PDU type %s not [yet] "
894 "implemented\n", bctx->bvci, bssgp_pdu_str(pdu_type));
Harald Welte25de8112010-05-13 21:26:28 +0200895 rc = bssgp_tx_status(BSSGP_CAUSE_PDU_INCOMP_FEAT, NULL, msg);
Harald Welte9ba50052010-03-14 15:45:01 +0800896 break;
897 /* those only exist in the SGSN -> BSS direction */
898 case BSSGP_PDUT_DL_UNITDATA:
899 case BSSGP_PDUT_PAGING_PS:
900 case BSSGP_PDUT_PAGING_CS:
901 case BSSGP_PDUT_RA_CAPA_UPDATE_ACK:
Harald Welte25de8112010-05-13 21:26:28 +0200902 case BSSGP_PDUT_FLOW_CONTROL_BVC_ACK:
903 case BSSGP_PDUT_FLOW_CONTROL_MS_ACK:
Max2c34ab42016-03-17 15:42:26 +0100904 DEBUGP(DBSSGP, "BSSGP BVCI=%u PDU type %s only exists in DL\n",
905 bctx->bvci, bssgp_pdu_str(pdu_type));
Harald Welte25de8112010-05-13 21:26:28 +0200906 bssgp_tx_status(BSSGP_CAUSE_PROTO_ERR_UNSPEC, NULL, msg);
907 rc = -EINVAL;
908 break;
909 default:
Max2c34ab42016-03-17 15:42:26 +0100910 DEBUGP(DBSSGP, "BSSGP BVCI=%u PDU type %s unknown\n",
911 bctx->bvci, bssgp_pdu_str(pdu_type));
Harald Welte25de8112010-05-13 21:26:28 +0200912 rc = bssgp_tx_status(BSSGP_CAUSE_PROTO_ERR_UNSPEC, NULL, msg);
913 break;
914 }
915
Holger Hans Peter Freytherd30cefa2010-05-23 21:12:15 +0800916 return rc;
Harald Welte25de8112010-05-13 21:26:28 +0200917}
918
919/* Receive a BSSGP PDU from a BSS on a SIGNALLING BVCI */
Harald Weltede4599c2012-06-17 13:04:02 +0800920static int bssgp_rx_sign(struct msgb *msg, struct tlv_parsed *tp,
921 struct bssgp_bvc_ctx *bctx)
Harald Welte25de8112010-05-13 21:26:28 +0200922{
923 struct bssgp_normal_hdr *bgph =
924 (struct bssgp_normal_hdr *) msgb_bssgph(msg);
925 uint8_t pdu_type = bgph->pdu_type;
926 int rc = 0;
927 uint16_t ns_bvci = msgb_bvci(msg);
Jacob Erlbeckb43baf22014-09-10 12:43:28 +0200928 uint16_t bvci = bctx ? bctx->bvci : ns_bvci;
Harald Welte25de8112010-05-13 21:26:28 +0200929
930 switch (bgph->pdu_type) {
931 case BSSGP_PDUT_SUSPEND:
932 /* MS wants to suspend */
Jacob Erlbeckb43baf22014-09-10 12:43:28 +0200933 rc = bssgp_rx_suspend(msg, tp);
Harald Welte25de8112010-05-13 21:26:28 +0200934 break;
935 case BSSGP_PDUT_RESUME:
936 /* MS wants to resume */
Jacob Erlbeckb43baf22014-09-10 12:43:28 +0200937 rc = bssgp_rx_resume(msg, tp);
Harald Welte25de8112010-05-13 21:26:28 +0200938 break;
939 case BSSGP_PDUT_FLUSH_LL_ACK:
940 /* BSS informs us it has performed LL FLUSH */
Jacob Erlbeckb43baf22014-09-10 12:43:28 +0200941 DEBUGP(DBSSGP, "BSSGP Rx BVCI=%u FLUSH LL ACK\n", bvci);
Harald Welte25de8112010-05-13 21:26:28 +0200942 /* FIXME: send NM_FLUSH_LL.res to NM */
943 break;
944 case BSSGP_PDUT_LLC_DISCARD:
945 /* BSS informs that some LLC PDU's have been discarded */
Jacob Erlbeckb43baf22014-09-10 12:43:28 +0200946 if (!bctx) {
947 LOGP(DBSSGP, LOGL_ERROR,
948 "BSSGP Rx LLC-DISCARD missing mandatory BVCI\n");
949 goto err_mand_ie;
950 }
Harald Weltee9686b62010-05-31 18:07:17 +0200951 rc = bssgp_rx_llc_disc(msg, tp, bctx);
Harald Welte25de8112010-05-13 21:26:28 +0200952 break;
953 case BSSGP_PDUT_BVC_BLOCK:
954 /* BSS tells us that BVC shall be blocked */
Harald Welte25de8112010-05-13 21:26:28 +0200955 if (!TLVP_PRESENT(tp, BSSGP_IE_BVCI) ||
Harald Weltee9686b62010-05-31 18:07:17 +0200956 !TLVP_PRESENT(tp, BSSGP_IE_CAUSE)) {
957 LOGP(DBSSGP, LOGL_ERROR, "BSSGP Rx BVC-BLOCK "
958 "missing mandatory IE\n");
Harald Welte25de8112010-05-13 21:26:28 +0200959 goto err_mand_ie;
Harald Weltee9686b62010-05-31 18:07:17 +0200960 }
Harald Welte2677ea52010-05-31 17:16:36 +0200961 rc = bssgp_rx_bvc_block(msg, tp);
Harald Welte25de8112010-05-13 21:26:28 +0200962 break;
963 case BSSGP_PDUT_BVC_UNBLOCK:
964 /* BSS tells us that BVC shall be unblocked */
Harald Weltee9686b62010-05-31 18:07:17 +0200965 if (!TLVP_PRESENT(tp, BSSGP_IE_BVCI)) {
966 LOGP(DBSSGP, LOGL_ERROR, "BSSGP Rx BVC-UNBLOCK "
967 "missing mandatory IE\n");
Harald Welte25de8112010-05-13 21:26:28 +0200968 goto err_mand_ie;
Harald Weltee9686b62010-05-31 18:07:17 +0200969 }
Harald Welte25de8112010-05-13 21:26:28 +0200970 rc = bssgp_rx_bvc_unblock(msg, tp);
971 break;
972 case BSSGP_PDUT_BVC_RESET:
973 /* BSS tells us that BVC init is required */
Harald Welte25de8112010-05-13 21:26:28 +0200974 if (!TLVP_PRESENT(tp, BSSGP_IE_BVCI) ||
Harald Weltee9686b62010-05-31 18:07:17 +0200975 !TLVP_PRESENT(tp, BSSGP_IE_CAUSE)) {
976 LOGP(DBSSGP, LOGL_ERROR, "BSSGP Rx BVC-RESET "
977 "missing mandatory IE\n");
Harald Welte25de8112010-05-13 21:26:28 +0200978 goto err_mand_ie;
Harald Weltee9686b62010-05-31 18:07:17 +0200979 }
Harald Welte25de8112010-05-13 21:26:28 +0200980 rc = bssgp_rx_bvc_reset(msg, tp, ns_bvci);
981 break;
982 case BSSGP_PDUT_STATUS:
Jacob Erlbeck36153dc2015-03-17 10:21:17 +0100983 /* This is already handled in bssgp_rcvmsg() */
Harald Welte25de8112010-05-13 21:26:28 +0200984 break;
985 /* those only exist in the SGSN -> BSS direction */
986 case BSSGP_PDUT_PAGING_PS:
987 case BSSGP_PDUT_PAGING_CS:
Harald Welte9ba50052010-03-14 15:45:01 +0800988 case BSSGP_PDUT_SUSPEND_ACK:
989 case BSSGP_PDUT_SUSPEND_NACK:
990 case BSSGP_PDUT_RESUME_ACK:
991 case BSSGP_PDUT_RESUME_NACK:
Harald Welte6b7cf252010-05-13 19:41:31 +0200992 case BSSGP_PDUT_FLUSH_LL:
Harald Welte9ba50052010-03-14 15:45:01 +0800993 case BSSGP_PDUT_BVC_BLOCK_ACK:
994 case BSSGP_PDUT_BVC_UNBLOCK_ACK:
995 case BSSGP_PDUT_SGSN_INVOKE_TRACE:
Max2c34ab42016-03-17 15:42:26 +0100996 DEBUGP(DBSSGP, "BSSGP BVCI=%u Rx PDU type %s only exists in DL\n",
997 bvci, bssgp_pdu_str(pdu_type));
Harald Welte25de8112010-05-13 21:26:28 +0200998 bssgp_tx_status(BSSGP_CAUSE_PROTO_ERR_UNSPEC, NULL, msg);
Harald Welte9ba50052010-03-14 15:45:01 +0800999 rc = -EINVAL;
1000 break;
1001 default:
Max2c34ab42016-03-17 15:42:26 +01001002 DEBUGP(DBSSGP, "BSSGP BVCI=%u Rx PDU type %s unknown\n",
1003 bvci, bssgp_pdu_str(pdu_type));
Harald Welte25de8112010-05-13 21:26:28 +02001004 rc = bssgp_tx_status(BSSGP_CAUSE_PROTO_ERR_UNSPEC, NULL, msg);
Harald Welte9ba50052010-03-14 15:45:01 +08001005 break;
1006 }
1007
1008 return rc;
1009err_mand_ie:
1010 return bssgp_tx_status(BSSGP_CAUSE_MISSING_MAND_IE, NULL, msg);
1011}
1012
Harald Welte25de8112010-05-13 21:26:28 +02001013/* We expect msgb_bssgph() to point to the BSSGP header */
Harald Weltede4599c2012-06-17 13:04:02 +08001014int bssgp_rcvmsg(struct msgb *msg)
Harald Welte25de8112010-05-13 21:26:28 +02001015{
1016 struct bssgp_normal_hdr *bgph =
1017 (struct bssgp_normal_hdr *) msgb_bssgph(msg);
1018 struct bssgp_ud_hdr *budh = (struct bssgp_ud_hdr *) msgb_bssgph(msg);
1019 struct tlv_parsed tp;
Harald Welte8a521132010-05-17 22:59:29 +02001020 struct bssgp_bvc_ctx *bctx;
Harald Welte25de8112010-05-13 21:26:28 +02001021 uint8_t pdu_type = bgph->pdu_type;
1022 uint16_t ns_bvci = msgb_bvci(msg);
Jacob Erlbeckb83b8382014-09-23 13:28:22 +02001023 uint16_t bvci = ns_bvci;
Harald Welte25de8112010-05-13 21:26:28 +02001024 int data_len;
1025 int rc = 0;
1026
1027 /* Identifiers from DOWN: NSEI, BVCI (both in msg->cb) */
1028
1029 /* UNITDATA BSSGP headers have TLLI in front */
1030 if (pdu_type != BSSGP_PDUT_UL_UNITDATA &&
1031 pdu_type != BSSGP_PDUT_DL_UNITDATA) {
1032 data_len = msgb_bssgp_len(msg) - sizeof(*bgph);
1033 rc = bssgp_tlv_parse(&tp, bgph->data, data_len);
1034 } else {
1035 data_len = msgb_bssgp_len(msg) - sizeof(*budh);
1036 rc = bssgp_tlv_parse(&tp, budh->data, data_len);
1037 }
1038
Jacob Erlbeckb83b8382014-09-23 13:28:22 +02001039 if (bvci == BVCI_SIGNALLING && TLVP_PRESENT(&tp, BSSGP_IE_BVCI))
Harald Weltebfe62e52017-05-15 12:48:30 +02001040 bvci = tlvp_val16be(&tp, BSSGP_IE_BVCI);
Jacob Erlbeckb83b8382014-09-23 13:28:22 +02001041
Harald Welte25de8112010-05-13 21:26:28 +02001042 /* look-up or create the BTS context for this BVC */
Jacob Erlbeckb83b8382014-09-23 13:28:22 +02001043 bctx = btsctx_by_bvci_nsei(bvci, msgb_nsei(msg));
Harald Welte25de8112010-05-13 21:26:28 +02001044
Harald Welte16c8dbb2010-05-17 23:30:01 +02001045 if (bctx) {
Neels Hofmeyr8b86cd72017-02-23 18:03:28 +01001046 log_set_context(LOG_CTX_GB_BVC, bctx);
Harald Welte16c8dbb2010-05-17 23:30:01 +02001047 rate_ctr_inc(&bctx->ctrg->ctr[BSSGP_CTR_PKTS_IN]);
1048 rate_ctr_add(&bctx->ctrg->ctr[BSSGP_CTR_BYTES_IN],
1049 msgb_bssgp_len(msg));
1050 }
1051
Jacob Erlbeck36153dc2015-03-17 10:21:17 +01001052 /* Always handle STATUS PDUs, even if they contain an invalid BVCI or
1053 * are otherwise unexpected */
1054 if (pdu_type == BSSGP_PDUT_STATUS)
1055 /* Some exception has occurred */
1056 return bssgp_rx_status(msg, &tp, bvci, bctx);
1057
1058 /* Only a RESET PDU can create a new BVC context, otherwise it must be
1059 * registered if a BVCI is given. */
1060 if (!bctx && bvci != BVCI_SIGNALLING &&
1061 pdu_type != BSSGP_PDUT_BVC_RESET) {
1062 LOGP(DBSSGP, LOGL_NOTICE, "NSEI=%u/BVCI=%u Rejecting PDU "
Max2c34ab42016-03-17 15:42:26 +01001063 "type %s for unknown BVCI\n", msgb_nsei(msg), bvci,
1064 bssgp_pdu_str(pdu_type));
Jacob Erlbeck36153dc2015-03-17 10:21:17 +01001065 return bssgp_tx_status(BSSGP_CAUSE_UNKNOWN_BVCI, &bvci, msg);
1066 }
1067
Harald Welte61c07842010-05-18 11:57:08 +02001068 if (ns_bvci == BVCI_SIGNALLING)
Harald Weltede4599c2012-06-17 13:04:02 +08001069 rc = bssgp_rx_sign(msg, &tp, bctx);
Harald Welte61c07842010-05-18 11:57:08 +02001070 else if (ns_bvci == BVCI_PTM)
Harald Welte25de8112010-05-13 21:26:28 +02001071 rc = bssgp_tx_status(BSSGP_CAUSE_PDU_INCOMP_FEAT, NULL, msg);
Jacob Erlbeckb535e392015-04-07 17:52:44 +02001072 else if (bctx)
Harald Weltede4599c2012-06-17 13:04:02 +08001073 rc = bssgp_rx_ptp(msg, &tp, bctx);
Jacob Erlbeckb535e392015-04-07 17:52:44 +02001074 else
1075 LOGP(DBSSGP, LOGL_NOTICE,
Max2c34ab42016-03-17 15:42:26 +01001076 "NSEI=%u/BVCI=%u Cannot handle PDU type %s for "
Jacob Erlbeckb535e392015-04-07 17:52:44 +02001077 "unknown BVCI, NS BVCI %u\n",
Max2c34ab42016-03-17 15:42:26 +01001078 msgb_nsei(msg), bvci, bssgp_pdu_str(pdu_type), ns_bvci);
Harald Welte25de8112010-05-13 21:26:28 +02001079
1080 return rc;
1081}
1082
Harald Weltede4599c2012-06-17 13:04:02 +08001083int bssgp_tx_dl_ud(struct msgb *msg, uint16_t pdu_lifetime,
1084 struct bssgp_dl_ud_par *dup)
Harald Welte9ba50052010-03-14 15:45:01 +08001085{
Harald Welte8a521132010-05-17 22:59:29 +02001086 struct bssgp_bvc_ctx *bctx;
Harald Welte9ba50052010-03-14 15:45:01 +08001087 struct bssgp_ud_hdr *budh;
Harald Welte8f9a3ee2010-05-02 11:26:34 +02001088 uint8_t llc_pdu_tlv_hdr_len = 2;
Harald Welte8ef54d12012-06-17 09:31:16 +08001089 uint8_t *llc_pdu_tlv;
Harald Welte8f9a3ee2010-05-02 11:26:34 +02001090 uint16_t msg_len = msg->len;
Harald Welte30bc19a2010-05-02 11:19:37 +02001091 uint16_t bvci = msgb_bvci(msg);
1092 uint16_t nsei = msgb_nsei(msg);
Harald Weltebfe62e52017-05-15 12:48:30 +02001093 uint16_t _pdu_lifetime = osmo_htons(pdu_lifetime); /* centi-seconds */
Harald Welte2f946832010-05-31 22:12:30 +02001094 uint16_t drx_params;
Harald Welte9ba50052010-03-14 15:45:01 +08001095
Jacob Erlbeckc6415912015-04-07 17:52:43 +02001096 OSMO_ASSERT(dup != NULL);
1097
Harald Welte30bc19a2010-05-02 11:19:37 +02001098 /* Identifiers from UP: TLLI, BVCI, NSEI (all in msgb->cb) */
Harald Welte61c07842010-05-18 11:57:08 +02001099 if (bvci <= BVCI_PTM ) {
Harald Welteb8a6a832010-05-11 05:54:22 +02001100 LOGP(DBSSGP, LOGL_ERROR, "Cannot send DL-UD to BVCI %u\n",
Harald Welte30bc19a2010-05-02 11:19:37 +02001101 bvci);
Holger Hans Peter Freyther10dd73c2014-10-10 17:24:34 +02001102 msgb_free(msg);
Harald Welte30bc19a2010-05-02 11:19:37 +02001103 return -EINVAL;
1104 }
1105
1106 bctx = btsctx_by_bvci_nsei(bvci, nsei);
Harald Welte25de8112010-05-13 21:26:28 +02001107 if (!bctx) {
Harald Welted11c0592012-09-06 21:57:11 +02001108 LOGP(DBSSGP, LOGL_ERROR, "Cannot send DL-UD to unknown BVCI %u\n",
1109 bvci);
Holger Hans Peter Freyther10dd73c2014-10-10 17:24:34 +02001110 msgb_free(msg);
Harald Welted11c0592012-09-06 21:57:11 +02001111 return -ENODEV;
Harald Welte25de8112010-05-13 21:26:28 +02001112 }
Harald Welte9ba50052010-03-14 15:45:01 +08001113
1114 if (msg->len > TVLV_MAX_ONEBYTE)
1115 llc_pdu_tlv_hdr_len += 1;
1116
1117 /* prepend the tag and length of the LLC-PDU TLV */
1118 llc_pdu_tlv = msgb_push(msg, llc_pdu_tlv_hdr_len);
1119 llc_pdu_tlv[0] = BSSGP_IE_LLC_PDU;
1120 if (llc_pdu_tlv_hdr_len > 2) {
1121 llc_pdu_tlv[1] = msg_len >> 8;
1122 llc_pdu_tlv[2] = msg_len & 0xff;
1123 } else {
Sylvain Munautb00d1ad2010-06-09 21:13:13 +02001124 llc_pdu_tlv[1] = msg_len & 0x7f;
Harald Welte9ba50052010-03-14 15:45:01 +08001125 llc_pdu_tlv[1] |= 0x80;
1126 }
1127
Harald Welte2f946832010-05-31 22:12:30 +02001128 /* FIXME: optional elements: Alignment, UTRAN CCO, LSA, PFI */
1129
Jacob Erlbeckc6415912015-04-07 17:52:43 +02001130 /* Old TLLI to help BSS map from old->new */
1131 if (dup->tlli) {
Harald Weltebfe62e52017-05-15 12:48:30 +02001132 uint32_t tlli = osmo_htonl(*dup->tlli);
Jacob Erlbeckc6415912015-04-07 17:52:43 +02001133 msgb_tvlv_push(msg, BSSGP_IE_TLLI, 4, (uint8_t *) &tlli);
Harald Welte2f946832010-05-31 22:12:30 +02001134 }
Harald Welte9ba50052010-03-14 15:45:01 +08001135
Jacob Erlbeckc6415912015-04-07 17:52:43 +02001136 /* IMSI */
1137 if (dup->imsi && strlen(dup->imsi)) {
1138 uint8_t mi[10];
1139 int imsi_len = gsm48_generate_mid_from_imsi(mi, dup->imsi);
1140 if (imsi_len > 2)
1141 msgb_tvlv_push(msg, BSSGP_IE_IMSI,
1142 imsi_len-2, mi+2);
1143 }
1144
1145 /* DRX parameters */
Harald Weltebfe62e52017-05-15 12:48:30 +02001146 drx_params = osmo_htons(dup->drx_parms);
Jacob Erlbeckc6415912015-04-07 17:52:43 +02001147 msgb_tvlv_push(msg, BSSGP_IE_DRX_PARAMS, 2,
1148 (uint8_t *) &drx_params);
1149
1150 /* FIXME: Priority */
1151
1152 /* MS Radio Access Capability */
1153 if (dup->ms_ra_cap.len)
1154 msgb_tvlv_push(msg, BSSGP_IE_MS_RADIO_ACCESS_CAP,
1155 dup->ms_ra_cap.len, dup->ms_ra_cap.v);
1156
Harald Welte9ba50052010-03-14 15:45:01 +08001157 /* prepend the pdu lifetime */
Harald Welte8ef54d12012-06-17 09:31:16 +08001158 msgb_tvlv_push(msg, BSSGP_IE_PDU_LIFETIME, 2, (uint8_t *)&_pdu_lifetime);
Harald Welte9ba50052010-03-14 15:45:01 +08001159
1160 /* prepend the QoS profile, TLLI and pdu type */
1161 budh = (struct bssgp_ud_hdr *) msgb_push(msg, sizeof(*budh));
Harald Welte8ef54d12012-06-17 09:31:16 +08001162 memcpy(budh->qos_profile, dup->qos_profile, sizeof(budh->qos_profile));
Harald Weltebfe62e52017-05-15 12:48:30 +02001163 budh->tlli = osmo_htonl(msgb_tlli(msg));
Harald Welte9ba50052010-03-14 15:45:01 +08001164 budh->pdu_type = BSSGP_PDUT_DL_UNITDATA;
1165
Harald Welte16c8dbb2010-05-17 23:30:01 +02001166 rate_ctr_inc(&bctx->ctrg->ctr[BSSGP_CTR_PKTS_OUT]);
1167 rate_ctr_add(&bctx->ctrg->ctr[BSSGP_CTR_BYTES_OUT], msg->len);
1168
Harald Welte30bc19a2010-05-02 11:19:37 +02001169 /* Identifiers down: BVCI, NSEI (in msgb->cb) */
Harald Welte24a655f2010-04-30 19:54:29 +02001170
Harald Welted11c0592012-09-06 21:57:11 +02001171 /* check if we have to go through per-ms flow control or can go
1172 * directly to the per-BSS flow control */
1173 if (dup->fc)
Harald Welted8b47692012-09-07 11:29:32 +02001174 return bssgp_fc_in(dup->fc, msg, msg_len, bctx->fc);
Harald Welted11c0592012-09-06 21:57:11 +02001175 else
Harald Welted8b47692012-09-07 11:29:32 +02001176 return bssgp_fc_in(bctx->fc, msg, msg_len, NULL);
Harald Welte9ba50052010-03-14 15:45:01 +08001177}
Harald Welte68b4f032010-06-09 16:22:28 +02001178
1179/* Send a single GMM-PAGING.req to a given NSEI/NS-BVCI */
Harald Weltede4599c2012-06-17 13:04:02 +08001180int bssgp_tx_paging(uint16_t nsei, uint16_t ns_bvci,
1181 struct bssgp_paging_info *pinfo)
Harald Welte68b4f032010-06-09 16:22:28 +02001182{
1183 struct msgb *msg = bssgp_msgb_alloc();
1184 struct bssgp_normal_hdr *bgph =
1185 (struct bssgp_normal_hdr *) msgb_put(msg, sizeof(*bgph));
Harald Weltebfe62e52017-05-15 12:48:30 +02001186 uint16_t drx_params = osmo_htons(pinfo->drx_params);
Harald Welte68b4f032010-06-09 16:22:28 +02001187 uint8_t mi[10];
1188 int imsi_len = gsm48_generate_mid_from_imsi(mi, pinfo->imsi);
1189 uint8_t ra[6];
1190
1191 if (imsi_len < 2)
1192 return -EINVAL;
1193
1194 msgb_nsei(msg) = nsei;
1195 msgb_bvci(msg) = ns_bvci;
1196
1197 if (pinfo->mode == BSSGP_PAGING_PS)
1198 bgph->pdu_type = BSSGP_PDUT_PAGING_PS;
1199 else
1200 bgph->pdu_type = BSSGP_PDUT_PAGING_CS;
1201 /* IMSI */
1202 msgb_tvlv_put(msg, BSSGP_IE_IMSI, imsi_len-2, mi+2);
1203 /* DRX Parameters */
1204 msgb_tvlv_put(msg, BSSGP_IE_DRX_PARAMS, 2,
1205 (uint8_t *) &drx_params);
1206 /* Scope */
1207 switch (pinfo->scope) {
1208 case BSSGP_PAGING_BSS_AREA:
1209 {
1210 uint8_t null = 0;
1211 msgb_tvlv_put(msg, BSSGP_IE_BSS_AREA_ID, 1, &null);
1212 }
1213 break;
1214 case BSSGP_PAGING_LOCATION_AREA:
1215 gsm48_construct_ra(ra, &pinfo->raid);
1216 msgb_tvlv_put(msg, BSSGP_IE_LOCATION_AREA, 4, ra);
1217 break;
1218 case BSSGP_PAGING_ROUTEING_AREA:
1219 gsm48_construct_ra(ra, &pinfo->raid);
1220 msgb_tvlv_put(msg, BSSGP_IE_ROUTEING_AREA, 6, ra);
1221 break;
1222 case BSSGP_PAGING_BVCI:
1223 {
Harald Weltebfe62e52017-05-15 12:48:30 +02001224 uint16_t bvci = osmo_htons(pinfo->bvci);
Harald Welte68b4f032010-06-09 16:22:28 +02001225 msgb_tvlv_put(msg, BSSGP_IE_BVCI, 2, (uint8_t *)&bvci);
1226 }
1227 break;
1228 }
1229 /* QoS profile mandatory for PS */
1230 if (pinfo->mode == BSSGP_PAGING_PS)
1231 msgb_tvlv_put(msg, BSSGP_IE_QOS_PROFILE, 3, pinfo->qos);
1232
1233 /* Optional (P-)TMSI */
1234 if (pinfo->ptmsi) {
Harald Weltebfe62e52017-05-15 12:48:30 +02001235 uint32_t ptmsi = osmo_htonl(*pinfo->ptmsi);
Harald Welte68b4f032010-06-09 16:22:28 +02001236 msgb_tvlv_put(msg, BSSGP_IE_TMSI, 4, (uint8_t *) &ptmsi);
1237 }
1238
1239 return gprs_ns_sendmsg(bssgp_nsi, msg);
1240}
Harald Weltecca49632012-06-16 17:45:59 +08001241
Harald Weltede4599c2012-06-17 13:04:02 +08001242void bssgp_set_log_ss(int ss)
Harald Weltecca49632012-06-16 17:45:59 +08001243{
1244 DBSSGP = ss;
1245}