blob: 7c9bb7544775e533c9cfa5068a9e97fd6fb70c7b [file] [log] [blame]
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +04001/* gprs_bssgp_pcu.cpp
2 *
3 * Copyright (C) 2012 Ivan Klyuchnikov
Holger Hans Peter Freyther416ce692013-08-22 08:44:04 +02004 * Copyright (C) 2013 by Holger Hans Peter Freyther
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +04005 *
6 * This program is free software; you can redistribute it and/or
7 * modify it under the terms of the GNU General Public License
8 * as published by the Free Software Foundation; either version 2
9 * of the License, or (at your option) any later version.
10 *
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
15 *
16 * You should have received a copy of the GNU General Public License
17 * along with this program; if not, write to the Free Software
18 * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
19 */
20
21#include <gprs_rlcmac.h>
22#include <gprs_bssgp_pcu.h>
23#include <pcu_l1_if.h>
Holger Hans Peter Freyther67ed34e2013-10-17 17:01:54 +020024#include <bts.h>
Holger Hans Peter Freyther17c31ce2013-08-24 18:31:27 +020025#include <tbf.h>
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +040026
Jacob Erlbeck1e96af62015-03-17 08:11:25 +010027#define BSSGP_TIMER_T1 30 /* Guards the (un)blocking procedures */
28#define BSSGP_TIMER_T2 30 /* Guards the reset procedure */
29
Holger Hans Peter Freythere8d9a5f2013-07-28 19:11:20 +020030static struct gprs_bssgp_pcu the_pcu = { 0, };
Holger Hans Peter Freyther90f08ef2013-07-13 12:45:44 +020031
Andreas Eversberg71cce912013-01-16 13:49:00 +010032extern void *tall_pcu_ctx;
Andreas Eversbergbf5a0f62012-07-06 08:58:22 +020033extern uint16_t spoof_mcc, spoof_mnc;
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +040034
Andreas Eversbergcd8a83a2012-09-23 06:41:21 +020035static void bvc_timeout(void *_priv);
36
Andreas Eversberg00950742012-10-08 12:25:55 +020037static int parse_imsi(struct tlv_parsed *tp, char *imsi)
38{
39 uint8_t imsi_len;
40 uint8_t *bcd_imsi;
41 int i, j;
42
43 if (!TLVP_PRESENT(tp, BSSGP_IE_IMSI))
44 return -EINVAL;
45
46 imsi_len = TLVP_LEN(tp, BSSGP_IE_IMSI);
47 bcd_imsi = (uint8_t *) TLVP_VAL(tp, BSSGP_IE_IMSI);
48
49 if ((bcd_imsi[0] & 0x08))
50 imsi_len = imsi_len * 2 - 1;
51 else
52 imsi_len = (imsi_len - 1) * 2;
53 for (i = 0, j = 0; j < imsi_len && j < 15; j++)
54 {
55 if (!(j & 1)) {
56 imsi[j] = (bcd_imsi[i] >> 4) + '0';
57 i++;
58 } else
59 imsi[j] = (bcd_imsi[i] & 0xf) + '0';
60 }
61 imsi[j] = '\0';
62
63 return 0;
64}
65
Holger Hans Peter Freyther98fe9452013-07-13 15:23:58 +020066static int parse_ra_cap_ms_class(struct tlv_parsed *tp)
67{
68 bitvec *block;
69 unsigned rp = 0;
70 uint8_t ms_class = 0;
71 uint8_t cap_len;
72 uint8_t *cap;
73
74 if (!TLVP_PRESENT(tp, BSSGP_IE_MS_RADIO_ACCESS_CAP))
75 return ms_class;
76
77 cap_len = TLVP_LEN(tp, BSSGP_IE_MS_RADIO_ACCESS_CAP);
78 cap = (uint8_t *) TLVP_VAL(tp, BSSGP_IE_MS_RADIO_ACCESS_CAP);
79
80 block = bitvec_alloc(cap_len);
81 bitvec_unpack(block, cap);
82 bitvec_read_field(block, rp, 4); // Access Technology Type
83 bitvec_read_field(block, rp, 7); // Length of Access Capabilities
84 bitvec_read_field(block, rp, 3); // RF Power Capability
85 if (bitvec_read_field(block, rp, 1)) // A5 Bits Present
86 bitvec_read_field(block, rp, 7); // A5 Bits
87 bitvec_read_field(block, rp, 1); // ES IND
88 bitvec_read_field(block, rp, 1); // PS
89 bitvec_read_field(block, rp, 1); // VGCS
90 bitvec_read_field(block, rp, 1); // VBS
91 if (bitvec_read_field(block, rp, 1)) { // Multislot Cap Present
92 if (bitvec_read_field(block, rp, 1)) // HSCSD Present
93 bitvec_read_field(block, rp, 5); // Class
94 if (bitvec_read_field(block, rp, 1)) { // GPRS Present
95 ms_class = bitvec_read_field(block, rp, 5); // Class
96 bitvec_read_field(block, rp, 1); // Ext.
97 }
98 if (bitvec_read_field(block, rp, 1)) // SMS Present
99 bitvec_read_field(block, rp, 4); // SMS Value
Holger Hans Peter Freyther98fe9452013-07-13 15:23:58 +0200100 }
101
102 bitvec_free(block);
103 return ms_class;
104}
105
Holger Hans Peter Freyther90d5df42013-07-28 21:14:15 +0200106static int gprs_bssgp_pcu_rx_dl_ud(struct msgb *msg, struct tlv_parsed *tp)
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +0400107{
108 struct bssgp_ud_hdr *budh;
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +0400109
Andreas Eversberge6228b32012-07-03 13:36:03 +0200110 uint32_t tlli;
Andreas Eversberge6228b32012-07-03 13:36:03 +0200111 uint8_t *data;
112 uint16_t len;
Andreas Eversberg00950742012-10-08 12:25:55 +0200113 char imsi[16] = "000";
Andreas Eversberg7d7cf542012-06-25 09:26:15 +0200114
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +0400115 budh = (struct bssgp_ud_hdr *)msgb_bssgph(msg);
Andreas Eversberge6228b32012-07-03 13:36:03 +0200116 tlli = ntohl(budh->tlli);
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +0400117
Ivan Kluchnikov5e0df932012-06-12 15:33:52 +0400118 /* LLC_PDU is mandatory IE */
119 if (!TLVP_PRESENT(tp, BSSGP_IE_LLC_PDU))
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +0400120 {
Andreas Eversberg0e403092012-07-06 11:04:57 +0200121 LOGP(DBSSGP, LOGL_NOTICE, "BSSGP TLLI=0x%08x Rx UL-UD missing mandatory IE\n", tlli);
Ivan Kluchnikov5e0df932012-06-12 15:33:52 +0400122 return bssgp_tx_status(BSSGP_CAUSE_MISSING_MAND_IE, NULL, msg);
123 }
Ivan Kluchnikovb172b1b2012-06-07 01:51:49 +0400124
Andreas Eversberge6228b32012-07-03 13:36:03 +0200125 data = (uint8_t *) TLVP_VAL(tp, BSSGP_IE_LLC_PDU);
126 len = TLVP_LEN(tp, BSSGP_IE_LLC_PDU);
Holger Hans Peter Freyther28e53782013-11-06 20:23:56 +0100127 if (len > sizeof(gprs_llc::frame))
Ivan Kluchnikovc7e7f682012-06-29 22:53:15 +0400128 {
Andreas Eversberg0e403092012-07-06 11:04:57 +0200129 LOGP(DBSSGP, LOGL_NOTICE, "BSSGP TLLI=0x%08x Rx UL-UD IE_LLC_PDU too large\n", tlli);
Andreas Eversberge6228b32012-07-03 13:36:03 +0200130 return bssgp_tx_status(BSSGP_CAUSE_COND_IE_ERR, NULL, msg);
Ivan Kluchnikovc7e7f682012-06-29 22:53:15 +0400131 }
Ivan Kluchnikovc7e7f682012-06-29 22:53:15 +0400132
Andreas Eversberge13fa2d2012-07-09 17:10:44 +0200133 /* read IMSI. if no IMSI exists, use first paging block (any paging),
134 * because during attachment the IMSI might not be known, so the MS
135 * will listen to all paging blocks. */
Andreas Eversberg00950742012-10-08 12:25:55 +0200136 parse_imsi(tp, imsi);
Andreas Eversberg51ab1342012-07-13 14:52:50 +0200137
138 /* parse ms radio access capability */
Holger Hans Peter Freyther98fe9452013-07-13 15:23:58 +0200139 uint8_t ms_class = parse_ra_cap_ms_class(tp);
Andreas Eversberg51ab1342012-07-13 14:52:50 +0200140
Andreas Eversberg24131bf2012-07-21 11:09:58 +0200141 /* get lifetime */
142 uint16_t delay_csec = 0xffff;
143 if (TLVP_PRESENT(tp, BSSGP_IE_PDU_LIFETIME))
144 {
145 uint8_t lt_len = TLVP_LEN(tp, BSSGP_IE_PDU_LIFETIME);
146 uint16_t *lt = (uint16_t *) TLVP_VAL(tp, BSSGP_IE_PDU_LIFETIME);
147 if (lt_len == 2)
148 delay_csec = ntohs(*lt);
149 else
150 LOGP(DBSSGP, LOGL_NOTICE, "BSSGP invalid length of "
151 "PDU_LIFETIME IE\n");
152 } else
153 LOGP(DBSSGP, LOGL_NOTICE, "BSSGP missing mandatory "
154 "PDU_LIFETIME IE\n");
155
Andreas Eversberge13fa2d2012-07-09 17:10:44 +0200156 LOGP(DBSSGP, LOGL_INFO, "LLC [SGSN -> PCU] = TLLI: 0x%08x IMSI: %s len: %d\n", tlli, imsi, len);
Ivan Kluchnikov5e0df932012-06-12 15:33:52 +0400157
Daniel Willmann30168882014-08-07 12:48:29 +0200158 return gprs_rlcmac_dl_tbf::handle(the_pcu.bts, tlli, imsi, ms_class, delay_csec, data, len);
Ivan Kluchnikovc7e7f682012-06-29 22:53:15 +0400159}
Ivan Kluchnikova9e6dc52012-06-17 08:30:06 +0400160
Andreas Eversberg8c3680d2012-10-08 12:30:56 +0200161int gprs_bssgp_pcu_rx_paging_ps(struct msgb *msg, struct tlv_parsed *tp)
162{
163 char imsi[16];
164 uint8_t *ptmsi = (uint8_t *) TLVP_VAL(tp, BSSGP_IE_TMSI);
165 uint16_t ptmsi_len = TLVP_LEN(tp, BSSGP_IE_TMSI);
166
167 LOGP(DBSSGP, LOGL_NOTICE, " P-TMSI = ");
168 for (int i = 0; i < ptmsi_len; i++)
169 {
170 LOGPC(DBSSGP, LOGL_NOTICE, "%02x", ptmsi[i]);
171 }
172 LOGPC(DBSSGP, LOGL_NOTICE, "\n");
173
174 if (parse_imsi(tp, imsi))
175 {
176 LOGP(DBSSGP, LOGL_ERROR, "No IMSI\n");
177 return -EINVAL;
178 }
179
180 return gprs_rlcmac_paging_request(ptmsi, ptmsi_len, imsi);
181}
182
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +0400183/* Receive a BSSGP PDU from a BSS on a PTP BVCI */
Holger Hans Peter Freyther90d5df42013-07-28 21:14:15 +0200184static int gprs_bssgp_pcu_rx_ptp(struct msgb *msg, struct tlv_parsed *tp, struct bssgp_bvc_ctx *bctx)
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +0400185{
186 struct bssgp_normal_hdr *bgph = (struct bssgp_normal_hdr *) msgb_bssgph(msg);
187 uint8_t pdu_type = bgph->pdu_type;
188 unsigned rc = 0;
189
Andreas Eversbergba1cd9b2012-07-25 09:14:09 +0200190 if (!bctx)
191 return -EINVAL;
192
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +0400193 /* If traffic is received on a BVC that is marked as blocked, the
194 * received PDU shall not be accepted and a STATUS PDU (Cause value:
195 * BVC Blocked) shall be sent to the peer entity on the signalling BVC */
196 if (bctx->state & BVC_S_BLOCKED && pdu_type != BSSGP_PDUT_STATUS)
197 {
198 uint16_t bvci = msgb_bvci(msg);
199 LOGP(DBSSGP, LOGL_NOTICE, "rx BVC_S_BLOCKED\n");
200 return bssgp_tx_status(BSSGP_CAUSE_BVCI_BLOCKED, &bvci, msg);
201 }
202
203 switch (pdu_type) {
204 case BSSGP_PDUT_DL_UNITDATA:
Andreas Eversberg0e403092012-07-06 11:04:57 +0200205 LOGP(DBSSGP, LOGL_DEBUG, "RX: [SGSN->PCU] BSSGP_PDUT_DL_UNITDATA\n");
Holger Hans Peter Freyther416ce692013-08-22 08:44:04 +0200206 if (the_pcu.on_dl_unit_data)
207 the_pcu.on_dl_unit_data(&the_pcu, msg, tp);
Ivan Kluchnikov5e0df932012-06-12 15:33:52 +0400208 gprs_bssgp_pcu_rx_dl_ud(msg, tp);
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +0400209 break;
210 case BSSGP_PDUT_PAGING_PS:
Andreas Eversberg0e403092012-07-06 11:04:57 +0200211 LOGP(DBSSGP, LOGL_DEBUG, "rx BSSGP_PDUT_PAGING_PS\n");
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +0400212 break;
213 case BSSGP_PDUT_PAGING_CS:
Andreas Eversberg0e403092012-07-06 11:04:57 +0200214 LOGP(DBSSGP, LOGL_DEBUG, "rx BSSGP_PDUT_PAGING_CS\n");
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +0400215 break;
216 case BSSGP_PDUT_RA_CAPA_UPDATE_ACK:
Andreas Eversberg0e403092012-07-06 11:04:57 +0200217 LOGP(DBSSGP, LOGL_DEBUG, "rx BSSGP_PDUT_RA_CAPA_UPDATE_ACK\n");
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +0400218 break;
219 case BSSGP_PDUT_FLOW_CONTROL_BVC_ACK:
Andreas Eversberg0e403092012-07-06 11:04:57 +0200220 LOGP(DBSSGP, LOGL_DEBUG, "rx BSSGP_PDUT_FLOW_CONTROL_BVC_ACK\n");
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +0400221 break;
222 case BSSGP_PDUT_FLOW_CONTROL_MS_ACK:
Andreas Eversberg0e403092012-07-06 11:04:57 +0200223 LOGP(DBSSGP, LOGL_DEBUG, "rx BSSGP_PDUT_FLOW_CONTROL_MS_ACK\n");
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +0400224 break;
225 default:
Andreas Eversberg0e403092012-07-06 11:04:57 +0200226 LOGP(DBSSGP, LOGL_NOTICE, "BSSGP BVCI=%u PDU type 0x%02x unknown\n", bctx->bvci, pdu_type);
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +0400227 rc = bssgp_tx_status(BSSGP_CAUSE_PROTO_ERR_UNSPEC, NULL, msg);
228 break;
229 }
230 return rc;
231}
232
233/* Receive a BSSGP PDU from a SGSN on a SIGNALLING BVCI */
Holger Hans Peter Freyther90d5df42013-07-28 21:14:15 +0200234static int gprs_bssgp_pcu_rx_sign(struct msgb *msg, struct tlv_parsed *tp, struct bssgp_bvc_ctx *bctx)
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +0400235{
236 struct bssgp_normal_hdr *bgph = (struct bssgp_normal_hdr *) msgb_bssgph(msg);
237 int rc = 0;
238 switch (bgph->pdu_type) {
239 case BSSGP_PDUT_STATUS:
240 /* Some exception has occurred */
241 DEBUGP(DBSSGP, "BSSGP BVCI=%u Rx BVC STATUS\n", bctx->bvci);
242 /* FIXME: send NM_STATUS.ind to NM */
243 break;
Holger Hans Peter Freythera9744de2013-07-28 19:01:20 +0200244 case BSSGP_PDUT_SUSPEND_ACK:
245 LOGP(DBSSGP, LOGL_DEBUG, "rx BSSGP_PDUT_SUSPEND_ACK\n");
246 break;
247 case BSSGP_PDUT_SUSPEND_NACK:
248 LOGP(DBSSGP, LOGL_DEBUG, "rx BSSGP_PDUT_SUSPEND_NACK\n");
249 break;
250 case BSSGP_PDUT_BVC_RESET_ACK:
251 LOGP(DBSSGP, LOGL_DEBUG, "rx BSSGP_PDUT_BVC_RESET_ACK\n");
252 if (!the_pcu.bvc_sig_reset)
253 the_pcu.bvc_sig_reset = 1;
254 else
255 the_pcu.bvc_reset = 1;
256 bvc_timeout(NULL);
257 break;
258 case BSSGP_PDUT_PAGING_PS:
259 LOGP(DBSSGP, LOGL_NOTICE, "RX: [SGSN->PCU] BSSGP_PDUT_PAGING_PS\n");
260 gprs_bssgp_pcu_rx_paging_ps(msg, tp);
261 break;
262 case BSSGP_PDUT_PAGING_CS:
263 LOGP(DBSSGP, LOGL_DEBUG, "rx BSSGP_PDUT_PAGING_CS\n");
264 break;
265 case BSSGP_PDUT_RESUME_ACK:
266 LOGP(DBSSGP, LOGL_DEBUG, "rx BSSGP_PDUT_RESUME_ACK\n");
267 break;
268 case BSSGP_PDUT_RESUME_NACK:
269 LOGP(DBSSGP, LOGL_DEBUG, "rx BSSGP_PDUT_RESUME_NACK\n");
270 break;
271 case BSSGP_PDUT_FLUSH_LL:
272 LOGP(DBSSGP, LOGL_DEBUG, "rx BSSGP_PDUT_FLUSH_LL\n");
273 break;
274 case BSSGP_PDUT_BVC_BLOCK_ACK:
275 LOGP(DBSSGP, LOGL_DEBUG, "rx BSSGP_PDUT_SUSPEND_ACK\n");
276 break;
277 case BSSGP_PDUT_BVC_UNBLOCK_ACK:
278 LOGP(DBSSGP, LOGL_DEBUG, "rx BSSGP_PDUT_BVC_UNBLOCK_ACK\n");
279 the_pcu.bvc_unblocked = 1;
Holger Hans Peter Freytherc0f16442013-08-22 08:40:33 +0200280 if (the_pcu.on_unblock_ack)
281 the_pcu.on_unblock_ack(&the_pcu);
Holger Hans Peter Freythera9744de2013-07-28 19:01:20 +0200282 bvc_timeout(NULL);
283 break;
284 case BSSGP_PDUT_SGSN_INVOKE_TRACE:
285 LOGP(DBSSGP, LOGL_DEBUG, "rx BSSGP_PDUT_SGSN_INVOKE_TRACE\n");
286 break;
287 default:
288 LOGP(DBSSGP, LOGL_NOTICE, "BSSGP BVCI=%u Rx PDU type 0x%02x unknown\n", bctx->bvci, bgph->pdu_type);
289 rc = bssgp_tx_status(BSSGP_CAUSE_PROTO_ERR_UNSPEC, NULL, msg);
290 break;
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +0400291 }
292 return rc;
293}
294
Holger Hans Peter Freyther90d5df42013-07-28 21:14:15 +0200295static int gprs_bssgp_pcu_rcvmsg(struct msgb *msg)
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +0400296{
297 struct bssgp_normal_hdr *bgph = (struct bssgp_normal_hdr *) msgb_bssgph(msg);
298 struct bssgp_ud_hdr *budh = (struct bssgp_ud_hdr *) msgb_bssgph(msg);
299 struct tlv_parsed tp;
300 uint8_t pdu_type = bgph->pdu_type;
301 uint16_t ns_bvci = msgb_bvci(msg);
302 int data_len;
303 int rc = 0;
Andreas Eversberg3e372d52012-07-06 09:28:15 +0200304 struct bssgp_bvc_ctx *bctx;
305
Jacob Erlbeck39645b82015-03-16 12:27:11 +0100306 if (pdu_type == BSSGP_PDUT_STATUS)
307 /* Pass the message to the generic BSSGP parser, which handles
308 * STATUS message in either direction. */
309 return bssgp_rcvmsg(msg);
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +0400310
311 /* Identifiers from DOWN: NSEI, BVCI (both in msg->cb) */
312
313 /* UNITDATA BSSGP headers have TLLI in front */
314 if (pdu_type != BSSGP_PDUT_UL_UNITDATA && pdu_type != BSSGP_PDUT_DL_UNITDATA)
315 {
316 data_len = msgb_bssgp_len(msg) - sizeof(*bgph);
317 rc = bssgp_tlv_parse(&tp, bgph->data, data_len);
318 }
319 else
320 {
321 data_len = msgb_bssgp_len(msg) - sizeof(*budh);
322 rc = bssgp_tlv_parse(&tp, budh->data, data_len);
323 }
324
325 /* look-up or create the BTS context for this BVC */
326 bctx = btsctx_by_bvci_nsei(ns_bvci, msgb_nsei(msg));
327
Andreas Eversbergcd8a83a2012-09-23 06:41:21 +0200328 if (!bctx
329 && pdu_type != BSSGP_PDUT_BVC_RESET_ACK
Andreas Eversberg8c3680d2012-10-08 12:30:56 +0200330 && pdu_type != BSSGP_PDUT_BVC_UNBLOCK_ACK
331 && pdu_type != BSSGP_PDUT_PAGING_PS)
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +0400332 {
333 LOGP(DBSSGP, LOGL_NOTICE, "NSEI=%u/BVCI=%u Rejecting PDU "
334 "type %u for unknown BVCI\n", msgb_nsei(msg), ns_bvci,
335 pdu_type);
336 return bssgp_tx_status(BSSGP_CAUSE_UNKNOWN_BVCI, NULL, msg);
337 }
338
339 if (bctx)
340 {
341 log_set_context(BSC_CTX_BVC, bctx);
342 rate_ctr_inc(&bctx->ctrg->ctr[BSSGP_CTR_PKTS_IN]);
343 rate_ctr_add(&bctx->ctrg->ctr[BSSGP_CTR_BYTES_IN], msgb_bssgp_len(msg));
344 }
345
346 if (ns_bvci == BVCI_SIGNALLING)
347 {
Andreas Eversberg0e403092012-07-06 11:04:57 +0200348 LOGP(DBSSGP, LOGL_DEBUG, "rx BVCI_SIGNALLING gprs_bssgp_rx_sign\n");
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +0400349 rc = gprs_bssgp_pcu_rx_sign(msg, &tp, bctx);
350 }
351 else if (ns_bvci == BVCI_PTM)
352 {
Andreas Eversberg0e403092012-07-06 11:04:57 +0200353 LOGP(DBSSGP, LOGL_DEBUG, "rx BVCI_PTM bssgp_tx_status\n");
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +0400354 rc = bssgp_tx_status(BSSGP_CAUSE_PDU_INCOMP_FEAT, NULL, msg);
355 }
356 else
357 {
Andreas Eversberg0e403092012-07-06 11:04:57 +0200358 LOGP(DBSSGP, LOGL_DEBUG, "rx BVCI_PTP gprs_bssgp_rx_ptp\n");
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +0400359 rc = gprs_bssgp_pcu_rx_ptp(msg, &tp, bctx);
360 }
361 return rc;
362}
Harald Welte477e79e2012-06-18 12:21:03 +0800363
Jacob Erlbeck39645b82015-03-16 12:27:11 +0100364static void handle_nm_status(struct osmo_bssgp_prim *bp)
365{
366 enum gprs_bssgp_cause cause;
367
368 LOGP(DPCU, LOGL_DEBUG,
369 "Got NM-STATUS.ind, BVCI=%d, NSEI=%d\n",
370 bp->bvci, bp->nsei);
371
372 if (!TLVP_PRESENT(bp->tp, BSSGP_IE_CAUSE))
373 return;
374
375 cause = (enum gprs_bssgp_cause)*TLVP_VAL(bp->tp, BSSGP_IE_CAUSE);
376
377 if (cause != BSSGP_CAUSE_BVCI_BLOCKED &&
378 cause != BSSGP_CAUSE_UNKNOWN_BVCI)
379 return;
380
381 if (!TLVP_PRESENT(bp->tp, BSSGP_IE_BVCI))
382 return;
383
384 if (gprs_bssgp_pcu_current_bctx()->bvci != bp->bvci) {
385 LOGP(DPCU, LOGL_NOTICE,
386 "Received BSSGP STATUS message for an unknown BVCI (%d), "
387 "ignored\n",
388 bp->bvci);
389 return;
390 }
391
392 switch (cause) {
393 case BSSGP_CAUSE_BVCI_BLOCKED:
394 if (the_pcu.bvc_unblocked) {
395 the_pcu.bvc_unblocked = 0;
396 bvc_timeout(NULL);
397 }
398 break;
399
400 case BSSGP_CAUSE_UNKNOWN_BVCI:
401 if (the_pcu.bvc_reset) {
402 the_pcu.bvc_reset = 0;
403 bvc_timeout(NULL);
404 }
405 break;
406 default:
407 break;
408 }
409}
410
Harald Welte477e79e2012-06-18 12:21:03 +0800411int bssgp_prim_cb(struct osmo_prim_hdr *oph, void *ctx)
412{
Jacob Erlbeck39645b82015-03-16 12:27:11 +0100413 struct osmo_bssgp_prim *bp;
414 bp = container_of(oph, struct osmo_bssgp_prim, oph);
415
416 switch (oph->sap) {
417 case SAP_BSSGP_NM:
418 if (oph->primitive == PRIM_NM_STATUS)
419 handle_nm_status(bp);
420 break;
421 default:
422 break;
423 }
Harald Welte477e79e2012-06-18 12:21:03 +0800424 return 0;
425}
Andreas Eversbergbf5a0f62012-07-06 08:58:22 +0200426
427static int sgsn_ns_cb(enum gprs_ns_evt event, struct gprs_nsvc *nsvc, struct msgb *msg, uint16_t bvci)
428{
429 int rc = 0;
430 switch (event) {
431 case GPRS_NS_EVT_UNIT_DATA:
432 /* hand the message into the BSSGP implementation */
433 rc = gprs_bssgp_pcu_rcvmsg(msg);
434 break;
435 default:
Andreas Eversberg0e403092012-07-06 11:04:57 +0200436 LOGP(DPCU, LOGL_NOTICE, "RLCMAC: Unknown event %u from NS\n", event);
Andreas Eversbergbf5a0f62012-07-06 08:58:22 +0200437 rc = -EIO;
438 break;
439 }
440 return rc;
441}
442
Andreas Eversbergbf5a0f62012-07-06 08:58:22 +0200443
444static int nsvc_signal_cb(unsigned int subsys, unsigned int signal,
445 void *handler_data, void *signal_data)
446{
447 struct ns_signal_data *nssd;
448
449 if (subsys != SS_L_NS)
450 return -EINVAL;
451
452 nssd = (struct ns_signal_data *)signal_data;
Holger Hans Peter Freyther90f08ef2013-07-13 12:45:44 +0200453 if (nssd->nsvc != the_pcu.nsvc) {
Andreas Eversbergbf5a0f62012-07-06 08:58:22 +0200454 LOGP(DPCU, LOGL_ERROR, "Signal received of unknown NSVC\n");
455 return -EINVAL;
456 }
457
458 switch (signal) {
459 case S_NS_UNBLOCK:
Holger Hans Peter Freyther4b984b12013-07-13 12:57:06 +0200460 if (!the_pcu.nsvc_unblocked) {
461 the_pcu.nsvc_unblocked = 1;
Andreas Eversbergcd8a83a2012-09-23 06:41:21 +0200462 LOGP(DPCU, LOGL_NOTICE, "NS-VC %d is unblocked.\n",
Holger Hans Peter Freyther90f08ef2013-07-13 12:45:44 +0200463 the_pcu.nsvc->nsvci);
464 the_pcu.bvc_sig_reset = 0;
465 the_pcu.bvc_reset = 0;
466 the_pcu.bvc_unblocked = 0;
Andreas Eversbergcd8a83a2012-09-23 06:41:21 +0200467 bvc_timeout(NULL);
Andreas Eversbergbf5a0f62012-07-06 08:58:22 +0200468 }
469 break;
470 case S_NS_BLOCK:
Holger Hans Peter Freyther4b984b12013-07-13 12:57:06 +0200471 if (the_pcu.nsvc_unblocked) {
472 the_pcu.nsvc_unblocked = 0;
Holger Hans Peter Freythered70cb72013-07-13 12:53:46 +0200473 osmo_timer_del(&the_pcu.bvc_timer);
Holger Hans Peter Freyther90f08ef2013-07-13 12:45:44 +0200474 the_pcu.bvc_sig_reset = 0;
475 the_pcu.bvc_reset = 0;
476 the_pcu.bvc_unblocked = 0;
Andreas Eversbergbf5a0f62012-07-06 08:58:22 +0200477 LOGP(DPCU, LOGL_NOTICE, "NS-VC is blocked.\n");
478 }
479 break;
480 }
481
482 return 0;
483}
484
Andreas Eversbergcd8a83a2012-09-23 06:41:21 +0200485int gprs_bssgp_tx_fc_bvc(void)
486{
Jacob Erlbeck87d73412015-04-21 12:56:48 +0200487 struct gprs_rlcmac_bts *bts;
488
Holger Hans Peter Freyther90692f92013-07-13 12:51:16 +0200489 if (!the_pcu.bctx) {
Andreas Eversbergcd8a83a2012-09-23 06:41:21 +0200490 LOGP(DBSSGP, LOGL_ERROR, "No bctx\n");
491 return -EIO;
492 }
Jacob Erlbeck87d73412015-04-21 12:56:48 +0200493 bts = bts_main_data();
494
Andreas Eversbergcd8a83a2012-09-23 06:41:21 +0200495 /* FIXME: use real values */
Jacob Erlbeck87d73412015-04-21 12:56:48 +0200496 return bssgp_tx_fc_bvc(the_pcu.bctx, 1,
497 bts->fc_bvc_bucket_size ? bts->fc_bvc_bucket_size : 6553500,
498 bts->fc_bvc_leak_rate ? bts->fc_bvc_leak_rate : 819100,
499 bts->fc_ms_bucket_size ? bts->fc_ms_bucket_size : 50000,
500 bts->fc_ms_leak_rate ? bts->fc_ms_leak_rate : 50000,
Andreas Eversbergcd8a83a2012-09-23 06:41:21 +0200501 NULL, NULL);
Andreas Eversbergcd8a83a2012-09-23 06:41:21 +0200502}
503
504static void bvc_timeout(void *_priv)
505{
Holger Hans Peter Freyther90f08ef2013-07-13 12:45:44 +0200506 if (!the_pcu.bvc_sig_reset) {
Andreas Eversbergcd8a83a2012-09-23 06:41:21 +0200507 LOGP(DBSSGP, LOGL_INFO, "Sending reset on BVCI 0\n");
Holger Hans Peter Freyther90692f92013-07-13 12:51:16 +0200508 bssgp_tx_bvc_reset(the_pcu.bctx, 0, BSSGP_CAUSE_OML_INTERV);
Jacob Erlbeck1e96af62015-03-17 08:11:25 +0100509 osmo_timer_schedule(&the_pcu.bvc_timer, BSSGP_TIMER_T2, 0);
Andreas Eversbergcd8a83a2012-09-23 06:41:21 +0200510 return;
511 }
512
Holger Hans Peter Freyther90f08ef2013-07-13 12:45:44 +0200513 if (!the_pcu.bvc_reset) {
Andreas Eversbergcd8a83a2012-09-23 06:41:21 +0200514 LOGP(DBSSGP, LOGL_INFO, "Sending reset on BVCI %d\n",
Holger Hans Peter Freyther90692f92013-07-13 12:51:16 +0200515 the_pcu.bctx->bvci);
516 bssgp_tx_bvc_reset(the_pcu.bctx, the_pcu.bctx->bvci, BSSGP_CAUSE_OML_INTERV);
Jacob Erlbeck1e96af62015-03-17 08:11:25 +0100517 osmo_timer_schedule(&the_pcu.bvc_timer, BSSGP_TIMER_T2, 0);
Andreas Eversbergcd8a83a2012-09-23 06:41:21 +0200518 return;
519 }
520
Holger Hans Peter Freyther90f08ef2013-07-13 12:45:44 +0200521 if (!the_pcu.bvc_unblocked) {
Andreas Eversbergcd8a83a2012-09-23 06:41:21 +0200522 LOGP(DBSSGP, LOGL_INFO, "Sending unblock on BVCI %d\n",
Holger Hans Peter Freyther90692f92013-07-13 12:51:16 +0200523 the_pcu.bctx->bvci);
524 bssgp_tx_bvc_unblock(the_pcu.bctx);
Jacob Erlbeck1e96af62015-03-17 08:11:25 +0100525 osmo_timer_schedule(&the_pcu.bvc_timer, BSSGP_TIMER_T1, 0);
Andreas Eversbergcd8a83a2012-09-23 06:41:21 +0200526 return;
527 }
528
529 LOGP(DBSSGP, LOGL_DEBUG, "Sending flow control info on BVCI %d\n",
Holger Hans Peter Freyther90692f92013-07-13 12:51:16 +0200530 the_pcu.bctx->bvci);
Andreas Eversbergcd8a83a2012-09-23 06:41:21 +0200531 gprs_bssgp_tx_fc_bvc();
Holger Hans Peter Freytherb67a8a32013-07-28 18:55:14 +0200532 osmo_timer_schedule(&the_pcu.bvc_timer, the_pcu.bts->fc_interval, 0);
Andreas Eversbergcd8a83a2012-09-23 06:41:21 +0200533}
534
Andreas Eversbergbf5a0f62012-07-06 08:58:22 +0200535/* create BSSGP/NS layer instances */
Holger Hans Peter Freythere8d9a5f2013-07-28 19:11:20 +0200536struct gprs_bssgp_pcu *gprs_bssgp_create_and_connect(struct gprs_rlcmac_bts *bts,
Holger Hans Peter Freytherb67a8a32013-07-28 18:55:14 +0200537 uint16_t local_port, uint32_t sgsn_ip,
Harald Welte30a73d82013-03-10 08:54:30 +0000538 uint16_t sgsn_port, uint16_t nsei, uint16_t nsvci, uint16_t bvci,
539 uint16_t mcc, uint16_t mnc, uint16_t lac, uint16_t rac,
540 uint16_t cell_id)
Andreas Eversbergbf5a0f62012-07-06 08:58:22 +0200541{
542 struct sockaddr_in dest;
Andreas Eversberga3c12fb2012-09-28 22:46:33 +0200543 int rc;
Andreas Eversbergbf5a0f62012-07-06 08:58:22 +0200544
Andreas Eversberg514491d2012-09-23 06:42:07 +0200545 mcc = ((mcc & 0xf00) >> 8) * 100 + ((mcc & 0x0f0) >> 4) * 10 + (mcc & 0x00f);
546 mnc = ((mnc & 0xf00) >> 8) * 100 + ((mnc & 0x0f0) >> 4) * 10 + (mnc & 0x00f);
547 cell_id = ntohs(cell_id);
Andreas Eversbergbf5a0f62012-07-06 08:58:22 +0200548
Holger Hans Peter Freythere8d9a5f2013-07-28 19:11:20 +0200549 /* if already created... return the current address */
Holger Hans Peter Freyther90692f92013-07-13 12:51:16 +0200550 if (the_pcu.bctx)
Holger Hans Peter Freythere8d9a5f2013-07-28 19:11:20 +0200551 return &the_pcu;
Andreas Eversbergbf5a0f62012-07-06 08:58:22 +0200552
Holger Hans Peter Freytherb67a8a32013-07-28 18:55:14 +0200553 the_pcu.bts = bts;
554
Andreas Eversberg71cce912013-01-16 13:49:00 +0100555 bssgp_nsi = gprs_ns_instantiate(&sgsn_ns_cb, tall_pcu_ctx);
Andreas Eversbergbf5a0f62012-07-06 08:58:22 +0200556 if (!bssgp_nsi) {
Andreas Eversberg0e403092012-07-06 11:04:57 +0200557 LOGP(DBSSGP, LOGL_ERROR, "Failed to create NS instance\n");
Holger Hans Peter Freythere8d9a5f2013-07-28 19:11:20 +0200558 return NULL;
Andreas Eversbergbf5a0f62012-07-06 08:58:22 +0200559 }
Harald Weltede5253a2013-01-11 09:45:17 +0100560 gprs_ns_vty_init(bssgp_nsi);
Harald Welte30a73d82013-03-10 08:54:30 +0000561 bssgp_nsi->nsip.local_port = local_port;
Andreas Eversberga3c12fb2012-09-28 22:46:33 +0200562 rc = gprs_ns_nsip_listen(bssgp_nsi);
563 if (rc < 0) {
564 LOGP(DBSSGP, LOGL_ERROR, "Failed to create socket\n");
565 gprs_ns_destroy(bssgp_nsi);
566 bssgp_nsi = NULL;
Holger Hans Peter Freythere8d9a5f2013-07-28 19:11:20 +0200567 return NULL;
Andreas Eversberga3c12fb2012-09-28 22:46:33 +0200568 }
Andreas Eversbergbf5a0f62012-07-06 08:58:22 +0200569
570 dest.sin_family = AF_INET;
571 dest.sin_port = htons(sgsn_port);
572 dest.sin_addr.s_addr = htonl(sgsn_ip);
573
Holger Hans Peter Freyther90f08ef2013-07-13 12:45:44 +0200574 the_pcu.nsvc = gprs_ns_nsip_connect(bssgp_nsi, &dest, nsei, nsvci);
575 if (!the_pcu.nsvc) {
Andreas Eversberg0e403092012-07-06 11:04:57 +0200576 LOGP(DBSSGP, LOGL_ERROR, "Failed to create NSVCt\n");
Andreas Eversbergbf5a0f62012-07-06 08:58:22 +0200577 gprs_ns_destroy(bssgp_nsi);
578 bssgp_nsi = NULL;
Holger Hans Peter Freythere8d9a5f2013-07-28 19:11:20 +0200579 return NULL;
Andreas Eversbergbf5a0f62012-07-06 08:58:22 +0200580 }
581
Holger Hans Peter Freyther90692f92013-07-13 12:51:16 +0200582 the_pcu.bctx = btsctx_alloc(bvci, nsei);
583 if (!the_pcu.bctx) {
Andreas Eversberg0e403092012-07-06 11:04:57 +0200584 LOGP(DBSSGP, LOGL_ERROR, "Failed to create BSSGP context\n");
Holger Hans Peter Freyther90f08ef2013-07-13 12:45:44 +0200585 the_pcu.nsvc = NULL;
Andreas Eversbergbf5a0f62012-07-06 08:58:22 +0200586 gprs_ns_destroy(bssgp_nsi);
587 bssgp_nsi = NULL;
Holger Hans Peter Freythere8d9a5f2013-07-28 19:11:20 +0200588 return NULL;
Andreas Eversbergbf5a0f62012-07-06 08:58:22 +0200589 }
Holger Hans Peter Freyther90692f92013-07-13 12:51:16 +0200590 the_pcu.bctx->ra_id.mcc = spoof_mcc ? : mcc;
591 the_pcu.bctx->ra_id.mnc = spoof_mnc ? : mnc;
592 the_pcu.bctx->ra_id.lac = lac;
593 the_pcu.bctx->ra_id.rac = rac;
594 the_pcu.bctx->cell_id = cell_id;
Andreas Eversbergbf5a0f62012-07-06 08:58:22 +0200595
596 osmo_signal_register_handler(SS_L_NS, nsvc_signal_cb, NULL);
597
Holger Hans Peter Freythered70cb72013-07-13 12:53:46 +0200598 the_pcu.bvc_timer.cb = bvc_timeout;
Andreas Eversbergcd8a83a2012-09-23 06:41:21 +0200599
600
Holger Hans Peter Freythere8d9a5f2013-07-28 19:11:20 +0200601 return &the_pcu;
Andreas Eversbergbf5a0f62012-07-06 08:58:22 +0200602}
603
Daniel Willmann6d8884d2014-06-04 18:30:59 +0200604void gprs_bssgp_destroy(void)
Andreas Eversbergbf5a0f62012-07-06 08:58:22 +0200605{
606 if (!bssgp_nsi)
607 return;
608
Holger Hans Peter Freythered70cb72013-07-13 12:53:46 +0200609 osmo_timer_del(&the_pcu.bvc_timer);
Andreas Eversbergcd8a83a2012-09-23 06:41:21 +0200610
Andreas Eversbergbf5a0f62012-07-06 08:58:22 +0200611 osmo_signal_unregister_handler(SS_L_NS, nsvc_signal_cb, NULL);
612
Holger Hans Peter Freyther90f08ef2013-07-13 12:45:44 +0200613 the_pcu.nsvc = NULL;
Andreas Eversbergbf5a0f62012-07-06 08:58:22 +0200614
615 /* FIXME: move this to libgb: btsctx_free() */
Holger Hans Peter Freyther90692f92013-07-13 12:51:16 +0200616 llist_del(&the_pcu.bctx->list);
617 talloc_free(the_pcu.bctx);
618 the_pcu.bctx = NULL;
Andreas Eversbergbf5a0f62012-07-06 08:58:22 +0200619
620 /* FIXME: blocking... */
Holger Hans Peter Freyther40bd0c42013-07-13 12:58:20 +0200621 the_pcu.nsvc_unblocked = 0;
622 the_pcu.bvc_sig_reset = 0;
623 the_pcu.bvc_reset = 0;
624 the_pcu.bvc_unblocked = 0;
Andreas Eversbergbf5a0f62012-07-06 08:58:22 +0200625
626 gprs_ns_destroy(bssgp_nsi);
627 bssgp_nsi = NULL;
628}
629
Holger Hans Peter Freyther90692f92013-07-13 12:51:16 +0200630struct bssgp_bvc_ctx *gprs_bssgp_pcu_current_bctx(void)
631{
632 return the_pcu.bctx;
633}