blob: cab81dfd6f116fff3a32b2a8806fea384c6754ca [file] [log] [blame]
Max6dc90b82018-02-19 17:17:28 +01001/*
2 * Copyright (C) 2013 by Holger Hans Peter Freyther
3 * Copyright (C) 2018 by sysmocom - s.f.m.c. GmbH <info@sysmocom.de>
4 *
5 * All Rights Reserved
6 *
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU Affero General Public License as published by
9 * the Free Software Foundation; either version 3 of the License, or
10 * (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
15 * GNU General Public License for more details.
16 *
17 * You should have received a copy of the GNU Affero General Public License
18 * along with this program. If not, see <http://www.gnu.org/licenses/>.
19 *
20 */
21
22#include <bts.h>
23#include <pdch.h>
24#include <decoding.h>
25#include <encoding.h>
26#include <gprs_rlcmac.h>
27#include <gprs_debug.h>
Pau Espin Pedrol2ae83372020-05-18 11:35:35 +020028#include <coding_scheme.h>
Max6dc90b82018-02-19 17:17:28 +010029#include <gprs_ms.h>
30#include <gprs_ms_storage.h>
31#include <pcu_l1_if.h>
32#include <rlc.h>
33#include <sba.h>
34#include <tbf.h>
Pau Espin Pedrol9d1cdb12019-09-25 17:47:02 +020035#include <tbf_ul.h>
Max6dc90b82018-02-19 17:17:28 +010036#include <cxx_linuxlist.h>
Max6dc90b82018-02-19 17:17:28 +010037
38extern "C" {
Pau Espin Pedrol980ef1e2020-03-26 15:06:11 +010039#include <osmocom/core/talloc.h>
40#include <osmocom/core/msgb.h>
Vadim Yanitskiyd71c5662020-03-26 15:45:21 +070041#include <osmocom/gsm/gsm48.h>
Pau Espin Pedrol980ef1e2020-03-26 15:06:11 +010042#include <osmocom/gsm/protocol/gsm_04_08.h>
43#include <osmocom/core/bitvec.h>
44#include <osmocom/core/gsmtap.h>
45#include <osmocom/core/logging.h>
46#include <osmocom/core/utils.h>
Pau Espin Pedrolb2653fe2020-03-26 15:14:01 +010047
Pau Espin Pedrol980ef1e2020-03-26 15:06:11 +010048#include "coding_scheme.h"
Pau Espin Pedrolb2653fe2020-03-26 15:14:01 +010049#include "gsm_rlcmac.h"
Pau Espin Pedrol952cb3d2021-02-01 14:52:48 +010050#include "nacc_fsm.h"
Max6dc90b82018-02-19 17:17:28 +010051}
52
53#include <errno.h>
Vadim Yanitskiybd0dac32019-10-05 21:57:14 +070054#include <stdlib.h>
Max6dc90b82018-02-19 17:17:28 +010055#include <arpa/inet.h>
56
57extern void *tall_pcu_ctx;
58
59static void get_rx_qual_meas(struct pcu_l1_meas *meas, uint8_t rx_qual_enc)
60{
61 static const int16_t rx_qual_map[] = {
62 0, /* 0,14 % */
63 0, /* 0,28 % */
64 1, /* 0,57 % */
65 1, /* 1,13 % */
66 2, /* 2,26 % */
67 5, /* 4,53 % */
68 9, /* 9,05 % */
69 18, /* 18,10 % */
70 };
71
Pau Espin Pedrolda971ee2020-12-16 15:59:45 +010072 pcu_l1_meas_set_ms_rx_qual(meas, rx_qual_map[
73 OSMO_MIN(rx_qual_enc, ARRAY_SIZE(rx_qual_map)-1)
74 ]);
Max6dc90b82018-02-19 17:17:28 +010075}
76
77static void get_meas(struct pcu_l1_meas *meas,
78 const Packet_Resource_Request_t *qr)
79{
80 unsigned i;
81
Pau Espin Pedrolda971ee2020-12-16 15:59:45 +010082 pcu_l1_meas_set_ms_c_value(meas, qr->C_VALUE);
Max6dc90b82018-02-19 17:17:28 +010083 if (qr->Exist_SIGN_VAR)
Pau Espin Pedrolda971ee2020-12-16 15:59:45 +010084 pcu_l1_meas_set_ms_sign_var(meas, (qr->SIGN_VAR + 2) / 4); /* SIGN_VAR * 0.25 dB */
Max6dc90b82018-02-19 17:17:28 +010085
Pau Espin Pedrol0daf9132020-02-23 16:11:28 +070086 for (i = 0; i < OSMO_MIN(ARRAY_SIZE(qr->I_LEVEL_TN), ARRAY_SIZE(meas->ts)); i++)
Max6dc90b82018-02-19 17:17:28 +010087 {
Pau Espin Pedrol0daf9132020-02-23 16:11:28 +070088 if (qr->I_LEVEL_TN[i].Exist) {
Max6dc90b82018-02-19 17:17:28 +010089 LOGP(DRLCMAC, LOGL_INFO,
90 "Packet resource request: i_level[%d] = %d\n",
Pau Espin Pedrol0daf9132020-02-23 16:11:28 +070091 i, qr->I_LEVEL_TN[i].I_LEVEL);
Pau Espin Pedrolda971ee2020-12-16 15:59:45 +010092 pcu_l1_meas_set_ms_i_level(meas, i, -2 * qr->I_LEVEL_TN[i].I_LEVEL);
Max6dc90b82018-02-19 17:17:28 +010093 }
94 }
95}
96
97static void get_meas(struct pcu_l1_meas *meas,
98 const Channel_Quality_Report_t *qr)
99{
100 unsigned i;
101
102 get_rx_qual_meas(meas, qr->RXQUAL);
Pau Espin Pedrolda971ee2020-12-16 15:59:45 +0100103 pcu_l1_meas_set_ms_c_value(meas, qr->C_VALUE);
104 pcu_l1_meas_set_ms_sign_var(meas, (qr->SIGN_VAR + 2) / 4); /* SIGN_VAR * 0.25 dB */
Max6dc90b82018-02-19 17:17:28 +0100105
106 for (i = 0; i < OSMO_MIN(ARRAY_SIZE(qr->Slot), ARRAY_SIZE(meas->ts)); i++)
107 {
108 if (qr->Slot[i].Exist) {
109 LOGP(DRLCMAC, LOGL_DEBUG,
110 "Channel quality report: i_level[%d] = %d\n",
111 i, qr->Slot[i].I_LEVEL_TN);
Pau Espin Pedrolda971ee2020-12-16 15:59:45 +0100112 pcu_l1_meas_set_ms_i_level(meas, i, -2 * qr->Slot[i].I_LEVEL_TN);
Max6dc90b82018-02-19 17:17:28 +0100113 }
114 }
115}
116
Pau Espin Pedrol0ece97d2021-01-18 12:53:54 +0100117static inline void sched_ul_ass_or_rej(struct gprs_rlcmac_bts *bts, struct gprs_rlcmac_dl_tbf *tbf)
Max6dc90b82018-02-19 17:17:28 +0100118{
Pau Espin Pedrol2182e622021-01-14 16:48:38 +0100119 bts_do_rate_ctr_inc(bts, CTR_CHANNEL_REQUEST_DESCRIPTION);
Max6dc90b82018-02-19 17:17:28 +0100120
121 /* This call will register the new TBF with the MS on success */
Pau Espin Pedrolc6571b52021-05-10 17:10:37 +0200122 gprs_rlcmac_ul_tbf *ul_tbf = tbf_alloc_ul_pacch(bts, tbf->ms(), tbf->trx->trx_no, tbf->tlli());
Max6dc90b82018-02-19 17:17:28 +0100123
124 /* schedule uplink assignment or reject */
125 if (ul_tbf) {
126 LOGP(DRLCMAC, LOGL_DEBUG, "MS requests UL TBF in ack message, so we provide one:\n");
127 TBF_SET_ASS_STATE_UL(tbf, GPRS_RLCMAC_UL_ASS_SEND_ASS);
128 } else {
129 LOGP(DRLCMAC, LOGL_DEBUG, "MS requests UL TBF in ack message, so we packet access reject:\n");
130 TBF_SET_ASS_STATE_UL(tbf, GPRS_RLCMAC_UL_ASS_SEND_ASS_REJ);
131 }
132}
133
Pau Espin Pedrol702ebee2021-03-08 14:15:54 +0100134void pdch_init(struct gprs_rlcmac_pdch *pdch, struct gprs_rlcmac_trx *trx, uint8_t ts_nr)
135{
136 pdch->ts_no = ts_nr;
137 pdch->trx = trx;
138
139 /* Initialize the PTCCH/D message (Packet Timing Advance Control Channel) */
140 memset(pdch->ptcch_msg, PTCCH_TAI_FREE, PTCCH_TAI_NUM);
141 memset(pdch->ptcch_msg + PTCCH_TAI_NUM, PTCCH_PADDING, 7);
Pau Espin Pedrol15c58ac2021-03-08 14:57:58 +0100142 pdch->ulc = pdch_ulc_alloc(pdch, trx->bts);
Pau Espin Pedrol702ebee2021-03-08 14:15:54 +0100143}
144
Max6dc90b82018-02-19 17:17:28 +0100145void gprs_rlcmac_pdch::enable()
146{
147 /* TODO: Check if there are still allocated resources.. */
148 INIT_LLIST_HEAD(&paging_list);
149 m_is_enabled = 1;
150}
151
152void gprs_rlcmac_pdch::disable()
153{
154 /* TODO.. kick free_resources once we know the TRX/TS we are on */
155 m_is_enabled = 0;
156}
157
158void gprs_rlcmac_pdch::free_resources()
159{
160 struct gprs_rlcmac_paging *pag;
161
162 /* we are not enabled. there should be no resources */
163 if (!is_enabled())
164 return;
165
166 /* kick all TBF on slot */
Pau Espin Pedrol906aafc2021-01-18 17:53:29 +0100167 pdch_free_all_tbf(this);
Max6dc90b82018-02-19 17:17:28 +0100168
169 /* flush all pending paging messages */
170 while ((pag = dequeue_paging()))
171 talloc_free(pag);
172
Pau Espin Pedrol15c58ac2021-03-08 14:57:58 +0100173 talloc_free(this->ulc);
Max6dc90b82018-02-19 17:17:28 +0100174}
175
176struct gprs_rlcmac_paging *gprs_rlcmac_pdch::dequeue_paging()
177{
178 struct gprs_rlcmac_paging *pag;
179
180 if (llist_empty(&paging_list))
181 return NULL;
Pau Espin Pedrolc48d27b2021-05-13 15:58:55 +0200182 pag = llist_first_entry(&paging_list, struct gprs_rlcmac_paging, list);
Max6dc90b82018-02-19 17:17:28 +0100183 llist_del(&pag->list);
184
185 return pag;
186}
187
188struct msgb *gprs_rlcmac_pdch::packet_paging_request()
189{
190 struct gprs_rlcmac_paging *pag;
Pau Espin Pedrol5e300ce2020-02-03 17:18:03 +0100191 RlcMacDownlink_t *mac_control_block;
192 bitvec *pag_vec;
Max6dc90b82018-02-19 17:17:28 +0100193 struct msgb *msg;
194 unsigned wp = 0, len;
Pau Espin Pedrol5e300ce2020-02-03 17:18:03 +0100195 int rc;
Max6dc90b82018-02-19 17:17:28 +0100196
197 /* no paging, no message */
198 pag = dequeue_paging();
199 if (!pag)
200 return NULL;
201
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100202 LOGPDCH(this, DRLCMAC, LOGL_DEBUG, "Scheduling paging\n");
Max6dc90b82018-02-19 17:17:28 +0100203
204 /* alloc message */
205 msg = msgb_alloc(23, "pag ctrl block");
206 if (!msg) {
207 talloc_free(pag);
208 return NULL;
209 }
Pau Espin Pedrol5e300ce2020-02-03 17:18:03 +0100210 pag_vec = bitvec_alloc(23, tall_pcu_ctx);
Max6dc90b82018-02-19 17:17:28 +0100211 if (!pag_vec) {
212 msgb_free(msg);
213 talloc_free(pag);
214 return NULL;
215 }
216 wp = Encoding::write_packet_paging_request(pag_vec);
217
218 /* loop until message is full */
219 while (pag) {
Neels Hofmeyr00520512020-08-21 15:44:58 +0200220 if (log_check_level(DRLCMAC, LOGL_DEBUG)) {
221 struct osmo_mobile_identity omi = {};
222 char str[64];
223 osmo_mobile_identity_decode(&omi, pag->identity_lv + 1, pag->identity_lv[0], true);
224 osmo_mobile_identity_to_str_buf(str, sizeof(str), &omi);
225 LOGP(DRLCMAC, LOGL_DEBUG, "Paging MI - %s\n", str);
226 }
Vadim Yanitskiyd71c5662020-03-26 15:45:21 +0700227
Max6dc90b82018-02-19 17:17:28 +0100228 /* try to add paging */
Vadim Yanitskiyce160142020-03-26 16:18:17 +0700229 if ((pag->identity_lv[1] & GSM_MI_TYPE_MASK) == GSM_MI_TYPE_TMSI) {
Max6dc90b82018-02-19 17:17:28 +0100230 /* TMSI */
Max6dc90b82018-02-19 17:17:28 +0100231 len = 1 + 1 + 1 + 32 + 2 + 1;
232 if (pag->identity_lv[0] != 5) {
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100233 LOGPDCH(this, DRLCMAC, LOGL_ERROR,
234 "TMSI paging with MI != 5 octets!\n");
Max6dc90b82018-02-19 17:17:28 +0100235 goto continue_next;
236 }
237 } else {
238 /* MI */
Max6dc90b82018-02-19 17:17:28 +0100239 len = 1 + 1 + 1 + 4 + (pag->identity_lv[0]<<3) + 2 + 1;
240 if (pag->identity_lv[0] > 8) {
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100241 LOGPDCH(this, DRLCMAC, LOGL_ERROR,
242 "Paging with MI > 8 octets!\n");
Max6dc90b82018-02-19 17:17:28 +0100243 goto continue_next;
244 }
245 }
246 if (wp + len > 184) {
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100247 LOGPDCH(this, DRLCMAC, LOGL_DEBUG,
248 "- Does not fit, so schedule next time\n");
Max6dc90b82018-02-19 17:17:28 +0100249 /* put back paging record, because does not fit */
Pau Espin Pedrol7d3ee9e2020-11-23 16:04:02 +0100250 llist_add(&pag->list, &paging_list);
Max6dc90b82018-02-19 17:17:28 +0100251 break;
252 }
253 Encoding::write_repeated_page_info(pag_vec, wp, pag->identity_lv[0],
254 pag->identity_lv + 1, pag->chan_needed);
255
256continue_next:
257 talloc_free(pag);
258 pag = dequeue_paging();
259 }
260
261 bitvec_pack(pag_vec, msgb_put(msg, 23));
Pau Espin Pedrol5e300ce2020-02-03 17:18:03 +0100262 mac_control_block = (RlcMacDownlink_t *)talloc_zero(tall_pcu_ctx, RlcMacDownlink_t);
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100263 LOGPDCH(this, DRLCMAC, LOGL_DEBUG, "+++++++++++++++++++++++++ TX : Packet Paging Request +++++++++++++++++++++++++\n");
Pau Espin Pedrol5e300ce2020-02-03 17:18:03 +0100264 rc = decode_gsm_rlcmac_downlink(pag_vec, mac_control_block);
265 if (rc < 0) {
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100266 LOGPDCH(this, DRLCMAC, LOGL_ERROR, "Decoding of Downlink Packet Paging Request failed (%d): %s\n",
Pau Espin Pedrol9c4f9ff2020-11-23 16:36:42 +0100267 rc, osmo_hexdump(msgb_data(msg), msgb_length(msg)));
Pau Espin Pedrol5e300ce2020-02-03 17:18:03 +0100268 goto free_ret;
269 }
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100270 LOGPDCH(this, DRLCMAC, LOGL_DEBUG, "------------------------- TX : Packet Paging Request -------------------------\n");
Max6dc90b82018-02-19 17:17:28 +0100271 bitvec_free(pag_vec);
272 talloc_free(mac_control_block);
Max6dc90b82018-02-19 17:17:28 +0100273 return msg;
Pau Espin Pedrol5e300ce2020-02-03 17:18:03 +0100274
275free_ret:
276 bitvec_free(pag_vec);
277 talloc_free(mac_control_block);
278 msgb_free(msg);
279 return NULL;
Max6dc90b82018-02-19 17:17:28 +0100280}
281
Neels Hofmeyr59fc0bd2020-08-21 16:21:23 +0200282bool gprs_rlcmac_pdch::add_paging(uint8_t chan_needed, const struct osmo_mobile_identity *mi)
Max6dc90b82018-02-19 17:17:28 +0100283{
Neels Hofmeyr59fc0bd2020-08-21 16:21:23 +0200284 int rc;
Max6dc90b82018-02-19 17:17:28 +0100285 struct gprs_rlcmac_paging *pag = talloc_zero(tall_pcu_ctx, struct gprs_rlcmac_paging);
286 if (!pag)
287 return false;
288
289 pag->chan_needed = chan_needed;
Neels Hofmeyr59fc0bd2020-08-21 16:21:23 +0200290 rc = osmo_mobile_identity_encode_buf(pag->identity_lv + 1, sizeof(pag->identity_lv) - 1, mi, true);
291 if (rc <= 0) {
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100292 LOGPDCH(this, DRLCMAC, LOGL_ERROR, "Cannot encode Mobile Identity (rc=%d)\n", rc);
Neels Hofmeyr59fc0bd2020-08-21 16:21:23 +0200293 talloc_free(pag);
294 return false;
295 }
296 pag->identity_lv[0] = rc;
Max6dc90b82018-02-19 17:17:28 +0100297
298 llist_add(&pag->list, &paging_list);
299
300 return true;
301}
302
303void gprs_rlcmac_pdch::rcv_control_ack(Packet_Control_Acknowledgement_t *packet, uint32_t fn)
304{
305 struct gprs_rlcmac_tbf *tbf, *new_tbf;
306 uint32_t tlli = packet->TLLI;
Pau Espin Pedrol2182e622021-01-14 16:48:38 +0100307 GprsMs *ms = bts_ms_by_tlli(bts(), tlli, GSM_RESERVED_TMSI);
Max6dc90b82018-02-19 17:17:28 +0100308 gprs_rlcmac_ul_tbf *ul_tbf;
Pau Espin Pedrol86580e12021-03-29 18:15:30 +0200309 enum pdch_ulc_tbf_poll_reason reason;
Pau Espin Pedrol99360a32021-03-09 17:18:12 +0100310 struct pdch_ulc_node *poll;
Max6dc90b82018-02-19 17:17:28 +0100311
Pau Espin Pedrol99360a32021-03-09 17:18:12 +0100312 poll = pdch_ulc_get_node(ulc, fn);
313 if (!poll || poll->type !=PDCH_ULC_NODE_TBF_POLL || !poll->tbf_poll.poll_tbf) {
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100314 LOGPDCH(this, DRLCMAC, LOGL_NOTICE, "PACKET CONTROL ACK with "
Max6dc90b82018-02-19 17:17:28 +0100315 "unknown FN=%u TLLI=0x%08x (TRX %d TS %d)\n",
316 fn, tlli, trx_no(), ts_no);
317 if (ms)
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100318 LOGPDCH(this, DRLCMAC, LOGL_NOTICE, "PACKET CONTROL ACK with "
319 "unknown TBF corresponds to MS with IMSI %s, TA %d, "
320 "uTBF (TFI=%d, state=%s), dTBF (TFI=%d, state=%s)\n",
321 ms_imsi(ms), ms_ta(ms),
322 ms_ul_tbf(ms) ? ms_ul_tbf(ms)->tfi() : 0,
323 ms_ul_tbf(ms) ? ms_ul_tbf(ms)->state_name() : "None",
324 ms_dl_tbf(ms) ? ms_dl_tbf(ms)->tfi() : 0,
325 ms_dl_tbf(ms) ? ms_dl_tbf(ms)->state_name() : "None");
Max6dc90b82018-02-19 17:17:28 +0100326 return;
327 }
Pau Espin Pedrol99360a32021-03-09 17:18:12 +0100328 tbf = poll->tbf_poll.poll_tbf;
Pau Espin Pedrol86580e12021-03-29 18:15:30 +0200329 reason = poll->tbf_poll.reason;
Max6dc90b82018-02-19 17:17:28 +0100330
331 /* Reset N3101 counter: */
Max847ed9f2018-02-20 18:16:11 +0100332 tbf->n_reset(N3101);
Max6dc90b82018-02-19 17:17:28 +0100333
334 tbf->update_ms(tlli, GPRS_RLCMAC_UL_TBF);
335
336 LOGPTBF(tbf, LOGL_DEBUG, "RX: [PCU <- BTS] Packet Control Ack\n");
Pau Espin Pedrol99360a32021-03-09 17:18:12 +0100337 pdch_ulc_release_fn(ulc, fn);
Max6dc90b82018-02-19 17:17:28 +0100338
339 /* check if this control ack belongs to packet uplink ack */
340 ul_tbf = as_ul_tbf(tbf);
Pau Espin Pedrol86580e12021-03-29 18:15:30 +0200341 if (ul_tbf && ul_tbf->handle_ctrl_ack(reason)) {
Max6dc90b82018-02-19 17:17:28 +0100342 LOGPTBF(tbf, LOGL_DEBUG, "[UPLINK] END\n");
343 if (ul_tbf->ctrl_ack_to_toggle())
344 LOGPTBF(tbf, LOGL_NOTICE, "Recovered uplink ack for UL\n");
345
346 tbf_free(tbf);
347 return;
348 }
349 if (tbf->dl_ass_state_is(GPRS_RLCMAC_DL_ASS_WAIT_ACK)) {
350 LOGPTBF(tbf, LOGL_DEBUG, "[UPLINK] DOWNLINK ASSIGNED\n");
351 /* reset N3105 */
Max847ed9f2018-02-20 18:16:11 +0100352 tbf->n_reset(N3105);
Max6dc90b82018-02-19 17:17:28 +0100353 TBF_SET_ASS_STATE_DL(tbf, GPRS_RLCMAC_DL_ASS_NONE);
354
Pau Espin Pedrolda971ee2020-12-16 15:59:45 +0100355 new_tbf = tbf->ms() ? ms_dl_tbf(tbf->ms()) : NULL;
Max6dc90b82018-02-19 17:17:28 +0100356 if (!new_tbf) {
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100357 LOGPDCH(this, DRLCMAC, LOGL_ERROR, "Got ACK, but DL "
Max6dc90b82018-02-19 17:17:28 +0100358 "TBF is gone TLLI=0x%08x\n", tlli);
359 return;
360 }
Pau Espin Pedroldc2aaac2021-05-14 12:50:46 +0200361 if (tbf->state_is(TBF_ST_WAIT_RELEASE) &&
Max6dc90b82018-02-19 17:17:28 +0100362 tbf->direction == new_tbf->direction)
363 tbf_free(tbf);
364
365 if (new_tbf->check_n_clear(GPRS_RLCMAC_FLAG_CCCH)) {
366 /* We now know that the PACCH really existed */
367 LOGPTBF(new_tbf, LOGL_INFO,
368 "The TBF has been confirmed on the PACCH, "
369 "changed type from CCCH to PACCH\n");
370 TBF_ASS_TYPE_SET(new_tbf, GPRS_RLCMAC_FLAG_PACCH);
371 }
Pau Espin Pedroldc2aaac2021-05-14 12:50:46 +0200372 TBF_SET_STATE(new_tbf, TBF_ST_FLOW);
Max6dc90b82018-02-19 17:17:28 +0100373 /* stop pending assignment timer */
374 new_tbf->t_stop(T0, "control acked (DL-TBF)");
375 if (new_tbf->check_n_clear(GPRS_RLCMAC_FLAG_TO_DL_ASS))
376 LOGPTBF(new_tbf, LOGL_NOTICE, "Recovered downlink assignment\n");
377
378 tbf_assign_control_ts(new_tbf);
379 return;
380 }
381 if (tbf->ul_ass_state_is(GPRS_RLCMAC_UL_ASS_WAIT_ACK)) {
382 LOGPTBF(tbf, LOGL_DEBUG, "[DOWNLINK] UPLINK ASSIGNED\n");
383 /* reset N3105 */
Max847ed9f2018-02-20 18:16:11 +0100384 tbf->n_reset(N3105);
Max6dc90b82018-02-19 17:17:28 +0100385 TBF_SET_ASS_STATE_UL(tbf, GPRS_RLCMAC_UL_ASS_NONE);
386
Pau Espin Pedrolda971ee2020-12-16 15:59:45 +0100387 new_tbf = tbf->ms() ? ms_ul_tbf(tbf->ms()) : NULL;
Max6dc90b82018-02-19 17:17:28 +0100388 if (!new_tbf) {
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100389 LOGPDCH(this, DRLCMAC, LOGL_ERROR, "Got ACK, but UL "
Max6dc90b82018-02-19 17:17:28 +0100390 "TBF is gone TLLI=0x%08x\n", tlli);
391 return;
392 }
Pau Espin Pedroldc2aaac2021-05-14 12:50:46 +0200393 if (tbf->state_is(TBF_ST_WAIT_RELEASE) &&
Max6dc90b82018-02-19 17:17:28 +0100394 tbf->direction == new_tbf->direction)
395 tbf_free(tbf);
396
Pau Espin Pedroldc2aaac2021-05-14 12:50:46 +0200397 TBF_SET_STATE(new_tbf, TBF_ST_FLOW);
Max6dc90b82018-02-19 17:17:28 +0100398 if (new_tbf->check_n_clear(GPRS_RLCMAC_FLAG_TO_UL_ASS))
399 LOGPTBF(new_tbf, LOGL_NOTICE, "Recovered uplink assignment for UL\n");
400
401 tbf_assign_control_ts(new_tbf);
402 /* there might be LLC packets waiting in the queue, but the DL
403 * TBF might have been released while the UL TBF has been
404 * established */
Pau Espin Pedrolda971ee2020-12-16 15:59:45 +0100405 if (ms_need_dl_tbf(new_tbf->ms()))
Max6dc90b82018-02-19 17:17:28 +0100406 new_tbf->establish_dl_tbf_on_pacch();
407
408 return;
409 }
Pau Espin Pedrol952cb3d2021-02-01 14:52:48 +0100410 if (ms->nacc && ms->nacc->fi->state == NACC_ST_WAIT_CELL_CHG_CONTINUE_ACK &&
411 ms->nacc->continue_poll_fn == fn && ms->nacc->continue_poll_ts == ts_no) {
412 osmo_fsm_inst_dispatch(ms->nacc->fi, NACC_EV_RX_CELL_CHG_CONTINUE_ACK, NULL);
413 /* Don't assume MS is no longer reachable (hence don't free) after this: TS 44.060
414 * "When the mobile station receives the PACKET CELL CHANGE ORDER
415 * or the PACKET CELL CHANGE CONTINUE message the mobile station
416 * shall transmit a PACKET CONTROL ACKNOWLEDGMENT message in the
417 * specified uplink radio block if a valid RRBP field is
418 * received as part of the message; the mobile station _MAY_ then
419 * switch to a new cell."
420 */
421 return;
422 }
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100423 LOGPDCH(this, DRLCMAC, LOGL_ERROR,
424 "Error: received PACET CONTROL ACK at no request\n");
Max6dc90b82018-02-19 17:17:28 +0100425}
426
Pau Espin Pedrole13cdc52019-09-25 13:46:14 +0200427void gprs_rlcmac_pdch::rcv_control_dl_ack_nack(Packet_Downlink_Ack_Nack_t *ack_nack, uint32_t fn, struct pcu_l1_meas *meas)
Max6dc90b82018-02-19 17:17:28 +0100428{
429 int8_t tfi = 0; /* must be signed */
Pau Espin Pedrol99360a32021-03-09 17:18:12 +0100430 struct pdch_ulc_node *poll;
Max6dc90b82018-02-19 17:17:28 +0100431 struct gprs_rlcmac_dl_tbf *tbf;
432 int rc;
Max6dc90b82018-02-19 17:17:28 +0100433 int num_blocks;
434 uint8_t bits_data[RLC_GPRS_WS/8];
435 bitvec bits;
436 int bsn_begin, bsn_end;
437 char show_bits[RLC_GPRS_WS + 1];
438
439 tfi = ack_nack->DOWNLINK_TFI;
Pau Espin Pedrol99360a32021-03-09 17:18:12 +0100440 poll = pdch_ulc_get_node(ulc, fn);
441 if (!poll || poll->type != PDCH_ULC_NODE_TBF_POLL) {
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100442 LOGPDCH(this, DRLCMAC, LOGL_NOTICE, "PACKET DOWNLINK ACK with "
Max6dc90b82018-02-19 17:17:28 +0100443 "unknown FN=%u TFI=%d (TRX %d TS %d)\n",
444 fn, tfi, trx_no(), ts_no);
445 return;
446 }
Pau Espin Pedrol99360a32021-03-09 17:18:12 +0100447 tbf = as_dl_tbf(poll->tbf_poll.poll_tbf);
Max6dc90b82018-02-19 17:17:28 +0100448 if (tbf->tfi() != tfi) {
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100449 LOGPTBFDL(tbf, LOGL_NOTICE,
450 "PACKET DOWNLINK ACK with wrong TFI=%d, ignoring!\n", tfi);
Max6dc90b82018-02-19 17:17:28 +0100451 return;
452 }
453
454 /* Reset N3101 counter: */
Max847ed9f2018-02-20 18:16:11 +0100455 tbf->n_reset(N3101);
Max6dc90b82018-02-19 17:17:28 +0100456
457 if (tbf->handle_ack_nack())
458 LOGPTBF(tbf, LOGL_NOTICE, "Recovered downlink ack\n");
Pau Espin Pedrol99360a32021-03-09 17:18:12 +0100459 pdch_ulc_release_fn(ulc, fn);
Max6dc90b82018-02-19 17:17:28 +0100460
461 LOGPTBF(tbf, LOGL_DEBUG, "RX: [PCU <- BTS] Packet Downlink Ack/Nack\n");
462
463 bits.data = bits_data;
464 bits.data_len = sizeof(bits_data);
465 bits.cur_bit = 0;
466
467 num_blocks = Decoding::decode_gprs_acknack_bits(
468 &ack_nack->Ack_Nack_Description, &bits,
Pau Espin Pedrolb3f23972020-10-23 21:00:23 +0200469 &bsn_begin, &bsn_end, static_cast<gprs_rlc_dl_window *>(tbf->window()));
Max6dc90b82018-02-19 17:17:28 +0100470
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100471 LOGPDCH(this, DRLCMAC, LOGL_DEBUG,
Max6dc90b82018-02-19 17:17:28 +0100472 "Got GPRS DL ACK bitmap: SSN: %d, BSN %d to %d - 1 (%d blocks), "
473 "\"%s\"\n",
474 ack_nack->Ack_Nack_Description.STARTING_SEQUENCE_NUMBER,
475 bsn_begin, bsn_end, num_blocks,
476 (Decoding::extract_rbb(&bits, show_bits), show_bits));
477
478 rc = tbf->rcvd_dl_ack(
479 ack_nack->Ack_Nack_Description.FINAL_ACK_INDICATION,
480 bsn_begin, &bits);
481 if (rc == 1) {
482 tbf_free(tbf);
483 return;
484 }
485 /* check for channel request */
486 if (ack_nack->Exist_Channel_Request_Description)
Pau Espin Pedrol0ece97d2021-01-18 12:53:54 +0100487 sched_ul_ass_or_rej(bts(), tbf);
Max6dc90b82018-02-19 17:17:28 +0100488
489 /* get measurements */
490 if (tbf->ms()) {
Pau Espin Pedrole13cdc52019-09-25 13:46:14 +0200491 get_meas(meas, &ack_nack->Channel_Quality_Report);
Pau Espin Pedrolda971ee2020-12-16 15:59:45 +0100492 ms_update_l1_meas(tbf->ms(), meas);
Max6dc90b82018-02-19 17:17:28 +0100493 }
494}
495
Pau Espin Pedrole13cdc52019-09-25 13:46:14 +0200496void gprs_rlcmac_pdch::rcv_control_egprs_dl_ack_nack(EGPRS_PD_AckNack_t *ack_nack, uint32_t fn, struct pcu_l1_meas *meas)
Max6dc90b82018-02-19 17:17:28 +0100497{
498 int8_t tfi = 0; /* must be signed */
499 struct gprs_rlcmac_dl_tbf *tbf;
Pau Espin Pedrol99360a32021-03-09 17:18:12 +0100500 struct pdch_ulc_node *poll;
Pau Espin Pedrolb3f23972020-10-23 21:00:23 +0200501 gprs_rlc_dl_window *window;
Max6dc90b82018-02-19 17:17:28 +0100502 int rc;
503 int num_blocks;
504 uint8_t bits_data[RLC_EGPRS_MAX_WS/8];
505 char show_bits[RLC_EGPRS_MAX_WS + 1];
506 bitvec bits;
507 int bsn_begin, bsn_end;
508
509 tfi = ack_nack->DOWNLINK_TFI;
Pau Espin Pedrol99360a32021-03-09 17:18:12 +0100510 poll = pdch_ulc_get_node(ulc, fn);
511 if (!poll || poll->type !=PDCH_ULC_NODE_TBF_POLL) {
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100512 LOGPDCH(this, DRLCMAC, LOGL_NOTICE, "EGPRS PACKET DOWNLINK ACK with "
Max6dc90b82018-02-19 17:17:28 +0100513 "unknown FN=%u TFI=%d (TRX %d TS %d)\n",
514 fn, tfi, trx_no(), ts_no);
515 return;
516 }
Pau Espin Pedrol99360a32021-03-09 17:18:12 +0100517 tbf = as_dl_tbf(poll->tbf_poll.poll_tbf);
Max6dc90b82018-02-19 17:17:28 +0100518 if (tbf->tfi() != tfi) {
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100519 LOGPDCH(this, DRLCMAC, LOGL_NOTICE, "EGPRS PACKET DOWNLINK ACK with "
Max6dc90b82018-02-19 17:17:28 +0100520 "wrong TFI=%d, ignoring!\n", tfi);
521 return;
522 }
523
524 /* Reset N3101 counter: */
Max847ed9f2018-02-20 18:16:11 +0100525 tbf->n_reset(N3101);
Max6dc90b82018-02-19 17:17:28 +0100526
527 if (tbf->handle_ack_nack())
528 LOGPTBF(tbf, LOGL_NOTICE, "Recovered EGPRS downlink ack\n");
Pau Espin Pedrol99360a32021-03-09 17:18:12 +0100529 pdch_ulc_release_fn(ulc, fn);
Max6dc90b82018-02-19 17:17:28 +0100530
531 LOGPTBF(tbf, LOGL_DEBUG,
532 "RX: [PCU <- BTS] EGPRS Packet Downlink Ack/Nack\n");
533
Pau Espin Pedrolb3f23972020-10-23 21:00:23 +0200534 window = static_cast<gprs_rlc_dl_window *>(tbf->window());
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100535 LOGPDCH(this, DRLCMAC, LOGL_DEBUG, "EGPRS ACK/NACK: "
Max6dc90b82018-02-19 17:17:28 +0100536 "ut: %d, final: %d, bow: %d, eow: %d, ssn: %d, have_crbb: %d, "
537 "urbb_len:%d, %p, %p, %d, %d, win: %d-%d, urbb: %s\n",
538 (int)ack_nack->EGPRS_AckNack.UnionType,
539 (int)ack_nack->EGPRS_AckNack.Desc.FINAL_ACK_INDICATION,
540 (int)ack_nack->EGPRS_AckNack.Desc.BEGINNING_OF_WINDOW,
541 (int)ack_nack->EGPRS_AckNack.Desc.END_OF_WINDOW,
542 (int)ack_nack->EGPRS_AckNack.Desc.STARTING_SEQUENCE_NUMBER,
543 (int)ack_nack->EGPRS_AckNack.Desc.Exist_CRBB,
544 (int)ack_nack->EGPRS_AckNack.Desc.URBB_LENGTH,
545 (void *)&ack_nack->EGPRS_AckNack.UnionType,
546 (void *)&ack_nack->EGPRS_AckNack.Desc,
547 (int)offsetof(EGPRS_AckNack_t, Desc),
548 (int)offsetof(EGPRS_AckNack_w_len_t, Desc),
Pau Espin Pedrolb3f23972020-10-23 21:00:23 +0200549 window->v_a(),
550 window->v_s(),
Max6dc90b82018-02-19 17:17:28 +0100551 osmo_hexdump((const uint8_t *)&ack_nack->EGPRS_AckNack.Desc.URBB,
552 sizeof(ack_nack->EGPRS_AckNack.Desc.URBB)));
553
554 bits.data = bits_data;
555 bits.data_len = sizeof(bits_data);
556 bits.cur_bit = 0;
557
558 num_blocks = Decoding::decode_egprs_acknack_bits(
559 &ack_nack->EGPRS_AckNack.Desc, &bits,
Pau Espin Pedrolb3f23972020-10-23 21:00:23 +0200560 &bsn_begin, &bsn_end, window);
Max6dc90b82018-02-19 17:17:28 +0100561
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100562 LOGPDCH(this, DRLCMAC, LOGL_DEBUG,
Max6dc90b82018-02-19 17:17:28 +0100563 "Got EGPRS DL ACK bitmap: SSN: %d, BSN %d to %d - 1 (%d blocks), "
564 "\"%s\"\n",
565 ack_nack->EGPRS_AckNack.Desc.STARTING_SEQUENCE_NUMBER,
566 bsn_begin, bsn_end, num_blocks,
567 (Decoding::extract_rbb(&bits, show_bits), show_bits)
568 );
569
570 rc = tbf->rcvd_dl_ack(
571 ack_nack->EGPRS_AckNack.Desc.FINAL_ACK_INDICATION,
572 bsn_begin, &bits);
573 if (rc == 1) {
574 tbf_free(tbf);
575 return;
576 }
577
578 /* check for channel request */
579 if (ack_nack->Exist_ChannelRequestDescription)
Pau Espin Pedrol0ece97d2021-01-18 12:53:54 +0100580 sched_ul_ass_or_rej(bts(), tbf);
Max6dc90b82018-02-19 17:17:28 +0100581
582 /* get measurements */
583 if (tbf->ms()) {
584 /* TODO: Implement Measurements parsing for EGPRS */
585 /*
Pau Espin Pedrole13cdc52019-09-25 13:46:14 +0200586 get_meas(meas, &ack_nack->Channel_Quality_Report);
587 tbf->ms()->update_l1_meas(meas);
Max6dc90b82018-02-19 17:17:28 +0100588 */
589 }
590}
591
Pau Espin Pedrole13cdc52019-09-25 13:46:14 +0200592void gprs_rlcmac_pdch::rcv_resource_request(Packet_Resource_Request_t *request, uint32_t fn, struct pcu_l1_meas *meas)
Max6dc90b82018-02-19 17:17:28 +0100593{
594 struct gprs_rlcmac_sba *sba;
595
596 if (request->ID.UnionType) {
Pau Espin Pedrol43479972021-04-22 19:18:13 +0200597 struct gprs_rlcmac_ul_tbf *ul_tbf = NULL;
598 struct pdch_ulc_node *item;
Max6dc90b82018-02-19 17:17:28 +0100599 uint32_t tlli = request->ID.u.TLLI;
Max6dc90b82018-02-19 17:17:28 +0100600
Pau Espin Pedrol2182e622021-01-14 16:48:38 +0100601 GprsMs *ms = bts_ms_by_tlli(bts(), tlli, GSM_RESERVED_TMSI);
Pau Espin Pedrolce600112020-05-12 19:20:10 +0200602 if (!ms) {
Pau Espin Pedrol2182e622021-01-14 16:48:38 +0100603 ms = bts_alloc_ms(bts(), 0, 0); /* ms class updated later */
Pau Espin Pedrolda971ee2020-12-16 15:59:45 +0100604 ms_set_tlli(ms, tlli);
Pau Espin Pedrolce600112020-05-12 19:20:10 +0200605 }
Pau Espin Pedrol17402a52020-05-08 17:44:33 +0200606
Max6dc90b82018-02-19 17:17:28 +0100607 /* Keep the ms, even if it gets idle temporarily */
Pau Espin Pedrolda971ee2020-12-16 15:59:45 +0100608 ms_ref(ms);
Max6dc90b82018-02-19 17:17:28 +0100609
Pau Espin Pedrol43479972021-04-22 19:18:13 +0200610 if (!(item = pdch_ulc_get_node(ulc, fn))) {
611 LOGPDCH(this, DRLCMAC, LOGL_NOTICE, "FN=%u PKT RESOURCE REQ: "
612 "UL block not reserved\n", fn);
613 goto return_unref;
614 }
615
616 switch (item->type) {
617 case PDCH_ULC_NODE_SBA:
618 sba = item->sba.sba;
619 LOGPDCH(this, DRLCMAC, LOGL_DEBUG, "FN=%u PKT RESOURCE REQ: "
620 "MS requests UL TBF throguh SBA\n", fn);
Pau Espin Pedrolda971ee2020-12-16 15:59:45 +0100621 ms_set_ta(ms, sba->ta);
Pau Espin Pedrol15c58ac2021-03-08 14:57:58 +0100622 sba_free(sba);
Pau Espin Pedrol43479972021-04-22 19:18:13 +0200623 break;
624 case PDCH_ULC_NODE_TBF_POLL:
625 if (item->tbf_poll.poll_tbf->direction != GPRS_RLCMAC_UL_TBF) {
626 LOGPDCH(this, DRLCMAC, LOGL_NOTICE, "FN=%u PKT RESOURCE REQ: "
627 "Unexpectedly received for DL TBF %s\n", fn,
628 tbf_name(item->tbf_poll.poll_tbf));
629 /* let common path expire the poll */
630 goto return_unref;
631 }
632 ul_tbf = (struct gprs_rlcmac_ul_tbf *)item->tbf_poll.poll_tbf;
633 if (item->tbf_poll.reason != PDCH_ULC_POLL_UL_ACK) {
634 LOGPDCH(this, DRLCMAC, LOGL_NOTICE, "FN=%u PKT RESOURCE REQ: "
635 "Unexpectedly received, waiting for poll reason %d\n",
636 fn, item->tbf_poll.reason);
637 /* let common path expire the poll */
638 goto return_unref;
639 }
640 if (ul_tbf != ms_ul_tbf(ms)) {
641 LOGPDCH(this, DRLCMAC, LOGL_NOTICE, "FN=%u PKT RESOURCE REQ: "
642 "Unexpected TLLI 0x%08x received vs exp 0x%08x\n",
643 fn, tlli, ul_tbf->tlli());
644 /* let common path expire the poll */
645 goto return_unref;
646 }
647 /* 3GPP TS 44.060 $ 9.3.3.3 */
648 LOGPTBFUL(ul_tbf, LOGL_DEBUG, "FN=%u PKT RESOURCE REQ: "
649 "MS requests reuse of finished UL TBF in RRBP "
650 "block of final UL ACK/NACK\n", fn);
651 ul_tbf->n_reset(N3103);
652 pdch_ulc_release_node(ulc, item);
653 break;
654 case PDCH_ULC_NODE_TBF_USF:
655 /* Is it actually valid for an MS to send a PKT Res Req during USF? */
656 ul_tbf = item->tbf_usf.ul_tbf;
657 LOGPDCH(this, DRLCMAC, LOGL_NOTICE, "FN=%u PKT RESOURCE REQ: "
658 "Unexpectedly received, waiting USF of %s\n",
659 fn, tbf_name(item->tbf_usf.ul_tbf));
660 pdch_ulc_release_node(ulc, item);
661 break;
662 default:
663 OSMO_ASSERT(0);
Max6dc90b82018-02-19 17:17:28 +0100664 }
Pau Espin Pedrol43479972021-04-22 19:18:13 +0200665
666 /* here ul_tbf may be NULL in SBA case (no previous TBF) */
Pau Espin Pedrol9e7361a2020-07-08 17:35:12 +0200667
Pau Espin Pedrole50ce6e2020-03-23 18:49:16 +0100668 if (request->Exist_MS_Radio_Access_capability2) {
Pau Espin Pedrol17402a52020-05-08 17:44:33 +0200669 uint8_t ms_class, egprs_ms_class;
Pau Espin Pedrol8a35e642021-01-18 17:14:14 +0100670 ms_class = get_ms_class_by_capability(&request->MS_Radio_Access_capability2);
671 egprs_ms_class = get_egprs_ms_class_by_capability(&request->MS_Radio_Access_capability2);
Pau Espin Pedrolbcb226d2020-07-08 17:18:22 +0200672 if (ms_class)
Pau Espin Pedrolda971ee2020-12-16 15:59:45 +0100673 ms_set_ms_class(ms, ms_class);
Pau Espin Pedrolbcb226d2020-07-08 17:18:22 +0200674 if (egprs_ms_class)
Pau Espin Pedrolda971ee2020-12-16 15:59:45 +0100675 ms_set_egprs_ms_class(ms, egprs_ms_class);
Max6dc90b82018-02-19 17:17:28 +0100676 }
Pau Espin Pedrol17402a52020-05-08 17:44:33 +0200677
Pau Espin Pedrol9e7361a2020-07-08 17:35:12 +0200678 /* Get rid of previous finished UL TBF before providing a new one */
Pau Espin Pedrol43479972021-04-22 19:18:13 +0200679 if (ul_tbf) {
Pau Espin Pedroldc2aaac2021-05-14 12:50:46 +0200680 if (!ul_tbf->state_is(TBF_ST_FINISHED))
Pau Espin Pedrol9e7361a2020-07-08 17:35:12 +0200681 LOGPTBFUL(ul_tbf, LOGL_NOTICE,
682 "Got PACKET RESOURCE REQ while TBF not finished, killing pending UL TBF\n");
683 tbf_free(ul_tbf);
684 }
685
Pau Espin Pedrolc6571b52021-05-10 17:10:37 +0200686 ul_tbf = tbf_alloc_ul_pacch(bts(), ms, trx_no(), tlli);
Max6dc90b82018-02-19 17:17:28 +0100687 if (!ul_tbf) {
Pau Espin Pedrol54742f22021-04-26 16:48:34 +0200688 handle_tbf_reject(bts(), ms, trx_no(), ts_no);
Pau Espin Pedrolda971ee2020-12-16 15:59:45 +0100689 goto return_unref;
Max6dc90b82018-02-19 17:17:28 +0100690 }
691
692 /* set control ts to current MS's TS, until assignment complete */
Pau Espin Pedrol506eb232019-12-24 13:02:48 +0100693 LOGPTBF(ul_tbf, LOGL_DEBUG, "change control TS %d -> %d until assignment is complete.\n",
Max6dc90b82018-02-19 17:17:28 +0100694 ul_tbf->control_ts, ts_no);
695
696 ul_tbf->control_ts = ts_no;
697 /* schedule uplink assignment */
698 TBF_SET_ASS_STATE_UL(ul_tbf, GPRS_RLCMAC_UL_ASS_SEND_ASS);
699
Max6dc90b82018-02-19 17:17:28 +0100700 /* get measurements */
Pau Espin Pedrol43479972021-04-22 19:18:13 +0200701 get_meas(meas, request);
702 ms_update_l1_meas(ul_tbf->ms(), meas);
Pau Espin Pedrolda971ee2020-12-16 15:59:45 +0100703return_unref:
704 ms_unref(ms);
Max6dc90b82018-02-19 17:17:28 +0100705 return;
706 }
707
708 if (request->ID.u.Global_TFI.UnionType) {
709 struct gprs_rlcmac_dl_tbf *dl_tbf;
710 int8_t tfi = request->ID.u.Global_TFI.u.DOWNLINK_TFI;
Pau Espin Pedrol2182e622021-01-14 16:48:38 +0100711 dl_tbf = bts_dl_tbf_by_tfi(bts(), tfi, trx_no(), ts_no);
Max6dc90b82018-02-19 17:17:28 +0100712 if (!dl_tbf) {
Thorsten Alteholz8bb79042018-10-06 10:42:58 +0200713 LOGP(DRLCMAC, LOGL_NOTICE, "PACKET RESOURCE REQ unknown downlink TFI=%d\n", tfi);
Max6dc90b82018-02-19 17:17:28 +0100714 return;
715 }
716 LOGPTBFDL(dl_tbf, LOGL_ERROR,
717 "RX: [PCU <- BTS] FIXME: Packet resource request\n");
718
719 /* Reset N3101 counter: */
Max847ed9f2018-02-20 18:16:11 +0100720 dl_tbf->n_reset(N3101);
Max6dc90b82018-02-19 17:17:28 +0100721 } else {
722 struct gprs_rlcmac_ul_tbf *ul_tbf;
723 int8_t tfi = request->ID.u.Global_TFI.u.UPLINK_TFI;
Pau Espin Pedrol2182e622021-01-14 16:48:38 +0100724 ul_tbf = bts_ul_tbf_by_tfi(bts(), tfi, trx_no(), ts_no);
Max6dc90b82018-02-19 17:17:28 +0100725 if (!ul_tbf) {
Thorsten Alteholz8bb79042018-10-06 10:42:58 +0200726 LOGP(DRLCMAC, LOGL_NOTICE, "PACKET RESOURCE REQ unknown uplink TFI=%d\n", tfi);
Max6dc90b82018-02-19 17:17:28 +0100727 return;
728 }
729 LOGPTBFUL(ul_tbf, LOGL_ERROR,
730 "RX: [PCU <- BTS] FIXME: Packet resource request\n");
731
732 /* Reset N3101 counter: */
Max847ed9f2018-02-20 18:16:11 +0100733 ul_tbf->n_reset(N3101);
Max6dc90b82018-02-19 17:17:28 +0100734 }
735}
736
737void gprs_rlcmac_pdch::rcv_measurement_report(Packet_Measurement_Report_t *report, uint32_t fn)
738{
Pau Espin Pedrolb69928c2020-08-18 20:29:40 +0200739 struct gprs_rlcmac_sba *sba;
Pau Espin Pedrol99360a32021-03-09 17:18:12 +0100740 struct pdch_ulc_node *poll;
Pau Espin Pedrolb69928c2020-08-18 20:29:40 +0200741 GprsMs *ms;
Max6dc90b82018-02-19 17:17:28 +0100742
Pau Espin Pedrol2182e622021-01-14 16:48:38 +0100743 ms = bts_ms_by_tlli(bts(), report->TLLI, GSM_RESERVED_TMSI);
Pau Espin Pedrolb69928c2020-08-18 20:29:40 +0200744 if (!ms) {
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100745 LOGPDCH(this, DRLCMAC, LOGL_NOTICE, "MS send measurement "
746 "but TLLI 0x%08x is unknown\n", report->TLLI);
Pau Espin Pedrol2182e622021-01-14 16:48:38 +0100747 ms = bts_alloc_ms(bts(), 0, 0);
Pau Espin Pedrolda971ee2020-12-16 15:59:45 +0100748 ms_set_tlli(ms, report->TLLI);
Pau Espin Pedrolb69928c2020-08-18 20:29:40 +0200749 }
Pau Espin Pedrol99360a32021-03-09 17:18:12 +0100750 if ((poll = pdch_ulc_get_node(ulc, fn))) {
751 switch (poll->type) {
752 case PDCH_ULC_NODE_TBF_USF:
Pau Espin Pedrolc1f38c72021-03-24 14:06:15 +0100753 pdch_ulc_release_fn(ulc, fn);
Pau Espin Pedrol99360a32021-03-09 17:18:12 +0100754 break;
755 case PDCH_ULC_NODE_TBF_POLL:
756 LOGPDCH(this, DRLCMAC, LOGL_INFO, "FN=%" PRIu32 " Rx Meas Report "
757 "on RRBP POLL, this probably means a DL/CTRL ACK/NACk will "
758 "need to be polled again later\n", fn);
Pau Espin Pedrol99360a32021-03-09 17:18:12 +0100759 pdch_ulc_release_fn(ulc, fn);
760 break;
761 case PDCH_ULC_NODE_SBA:
762 sba = poll->sba.sba;
763 ms_set_ta(ms, sba->ta);
764 sba_free(sba);
765 break;
766 }
Max6dc90b82018-02-19 17:17:28 +0100767 }
Pau Espin Pedrolb69928c2020-08-18 20:29:40 +0200768 gprs_rlcmac_meas_rep(ms, report);
Max6dc90b82018-02-19 17:17:28 +0100769}
770
Pau Espin Pedrolc0a250d2021-01-21 18:46:13 +0100771void gprs_rlcmac_pdch::rcv_cell_change_notification(Packet_Cell_Change_Notification_t *notif,
772 uint32_t fn, struct pcu_l1_meas *meas)
773{
774 GprsMs *ms;
775
776 bts_do_rate_ctr_inc(bts(), CTR_PKT_CELL_CHG_NOTIFICATION);
777
778 if (notif->Global_TFI.UnionType == 0) {
779 struct gprs_rlcmac_ul_tbf *ul_tbf = ul_tbf_by_tfi(notif->Global_TFI.u.UPLINK_TFI);
780 if (!ul_tbf) {
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100781 LOGPDCH(this, DRLCMAC, LOGL_NOTICE, "UL TBF TFI=0x%2x not found\n", notif->Global_TFI.u.UPLINK_TFI);
Pau Espin Pedrolc0a250d2021-01-21 18:46:13 +0100782 return;
783 }
784 ms = ul_tbf->ms();
785 } else if (notif->Global_TFI.UnionType == 1) {
786 struct gprs_rlcmac_dl_tbf *dl_tbf = dl_tbf_by_tfi(notif->Global_TFI.u.DOWNLINK_TFI);
787 if (!dl_tbf) {
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100788 LOGPDCH(this, DRLCMAC, LOGL_NOTICE, "DL TBF TFI=0x%2x not found\n", notif->Global_TFI.u.DOWNLINK_TFI);
Pau Espin Pedrolc0a250d2021-01-21 18:46:13 +0100789 return;
790 }
791 ms = dl_tbf->ms();
792 } else { OSMO_ASSERT(0); }
793
Pau Espin Pedrol9a6f0b12021-03-24 14:05:04 +0100794 pdch_ulc_release_fn(ulc, fn);
795
Pau Espin Pedrolc0a250d2021-01-21 18:46:13 +0100796 ms_update_l1_meas(ms, meas);
797 ms_nacc_start(ms, notif);
798}
799
Max6dc90b82018-02-19 17:17:28 +0100800/* Received Uplink RLC control block. */
Pau Espin Pedrol812d4662019-09-25 13:35:11 +0200801int gprs_rlcmac_pdch::rcv_control_block(const uint8_t *data, uint8_t data_len,
Pau Espin Pedrol2ae83372020-05-18 11:35:35 +0200802 uint32_t fn, struct pcu_l1_meas *meas, enum CodingScheme cs)
Max6dc90b82018-02-19 17:17:28 +0100803{
Pau Espin Pedrol812d4662019-09-25 13:35:11 +0200804 bitvec *rlc_block;
805 RlcMacUplink_t *ul_control_block;
Pau Espin Pedrol2ae83372020-05-18 11:35:35 +0200806 unsigned len = mcs_max_bytes_ul(cs);
Pau Espin Pedrol5e300ce2020-02-03 17:18:03 +0100807 int rc;
Pau Espin Pedrol812d4662019-09-25 13:35:11 +0200808
809 if (!(rlc_block = bitvec_alloc(len, tall_pcu_ctx)))
810 return -ENOMEM;
811 bitvec_unpack(rlc_block, data);
812 ul_control_block = (RlcMacUplink_t *)talloc_zero(tall_pcu_ctx, RlcMacUplink_t);
813
Pau Espin Pedrol68bfdff2021-03-09 20:19:51 +0100814 LOGPDCH(this, DRLCMAC, LOGL_DEBUG, "FN=%u +++++++++++++++++++++++++ RX : Uplink Control Block +++++++++++++++++++++++++\n", fn);
Keith6fd8ffb2020-03-05 19:48:24 -0600815
Keith2b6acd82020-03-26 16:33:59 -0500816 rc = decode_gsm_rlcmac_uplink(rlc_block, ul_control_block);
Keith6fd8ffb2020-03-05 19:48:24 -0600817 if (ul_control_block->u.MESSAGE_TYPE == MT_PACKET_UPLINK_DUMMY_CONTROL_BLOCK)
Pau Espin Pedrol2182e622021-01-14 16:48:38 +0100818 bts_send_gsmtap_meas(bts(), PCU_GSMTAP_C_UL_DUMMY, true, trx_no(), ts_no, GSMTAP_CHANNEL_PACCH, fn, data, data_len, meas);
Keith6fd8ffb2020-03-05 19:48:24 -0600819 else
Pau Espin Pedrol2182e622021-01-14 16:48:38 +0100820 bts_send_gsmtap_meas(bts(), PCU_GSMTAP_C_UL_CTRL, true, trx_no(), ts_no, GSMTAP_CHANNEL_PACCH, fn, data, data_len, meas);
Keith6fd8ffb2020-03-05 19:48:24 -0600821
Pau Espin Pedrol16705a42020-10-27 10:24:57 +0100822 if (rc < 0) {
Pau Espin Pedrol68bfdff2021-03-09 20:19:51 +0100823 LOGPDCH(this, DRLCMACUL, LOGL_ERROR, "FN=%u Dropping Uplink Control Block "
824 "with invalid content, decode failed: %d)\n", fn, rc);
Pau Espin Pedrol5e300ce2020-02-03 17:18:03 +0100825 goto free_ret;
826 }
Pau Espin Pedrol68bfdff2021-03-09 20:19:51 +0100827 LOGPDCH(this, DRLCMAC, LOGL_DEBUG, "FN=%u ------------------------- RX : Uplink Control Block -------------------------\n", fn);
Max6dc90b82018-02-19 17:17:28 +0100828
Pau Espin Pedrol2182e622021-01-14 16:48:38 +0100829 bts_do_rate_ctr_inc(bts(), CTR_RLC_RECV_CONTROL);
Max6dc90b82018-02-19 17:17:28 +0100830 switch (ul_control_block->u.MESSAGE_TYPE) {
831 case MT_PACKET_CONTROL_ACK:
832 rcv_control_ack(&ul_control_block->u.Packet_Control_Acknowledgement, fn);
833 break;
834 case MT_PACKET_DOWNLINK_ACK_NACK:
Pau Espin Pedrole13cdc52019-09-25 13:46:14 +0200835 rcv_control_dl_ack_nack(&ul_control_block->u.Packet_Downlink_Ack_Nack, fn, meas);
Max6dc90b82018-02-19 17:17:28 +0100836 break;
837 case MT_EGPRS_PACKET_DOWNLINK_ACK_NACK:
Pau Espin Pedrole13cdc52019-09-25 13:46:14 +0200838 rcv_control_egprs_dl_ack_nack(&ul_control_block->u.Egprs_Packet_Downlink_Ack_Nack, fn, meas);
Max6dc90b82018-02-19 17:17:28 +0100839 break;
840 case MT_PACKET_RESOURCE_REQUEST:
Pau Espin Pedrole13cdc52019-09-25 13:46:14 +0200841 rcv_resource_request(&ul_control_block->u.Packet_Resource_Request, fn, meas);
Max6dc90b82018-02-19 17:17:28 +0100842 break;
843 case MT_PACKET_MEASUREMENT_REPORT:
844 rcv_measurement_report(&ul_control_block->u.Packet_Measurement_Report, fn);
845 break;
846 case MT_PACKET_UPLINK_DUMMY_CONTROL_BLOCK:
847 /* ignoring it. change the SI to not force sending these? */
848 break;
Pau Espin Pedrolc0a250d2021-01-21 18:46:13 +0100849 case MT_PACKET_CELL_CHANGE_NOTIFICATION:
850 rcv_cell_change_notification(&ul_control_block->u.Packet_Cell_Change_Notification, fn, meas);
851 break;
Max6dc90b82018-02-19 17:17:28 +0100852 default:
Pau Espin Pedrol2182e622021-01-14 16:48:38 +0100853 bts_do_rate_ctr_inc(bts(), CTR_DECODE_ERRORS);
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100854 LOGPDCH(this, DRLCMAC, LOGL_NOTICE,
Pau Espin Pedrol68bfdff2021-03-09 20:19:51 +0100855 "FN=%u RX: [PCU <- BTS] unknown control block(%d) received\n",
856 fn, ul_control_block->u.MESSAGE_TYPE);
Max6dc90b82018-02-19 17:17:28 +0100857 }
Pau Espin Pedrol99360a32021-03-09 17:18:12 +0100858
Pau Espin Pedrol5e300ce2020-02-03 17:18:03 +0100859free_ret:
Max6dc90b82018-02-19 17:17:28 +0100860 talloc_free(ul_control_block);
Pau Espin Pedrol812d4662019-09-25 13:35:11 +0200861 bitvec_free(rlc_block);
Pau Espin Pedrol5e300ce2020-02-03 17:18:03 +0100862 return rc;
Max6dc90b82018-02-19 17:17:28 +0100863}
864
865/* received RLC/MAC block from L1 */
866int gprs_rlcmac_pdch::rcv_block(uint8_t *data, uint8_t len, uint32_t fn,
867 struct pcu_l1_meas *meas)
868{
Pau Espin Pedrol30617112021-03-05 18:59:05 +0100869 /* First of all, update TDMA clock: */
870 bts_set_current_frame_number(trx->bts, fn);
871
Pau Espin Pedrol3cba94d2021-03-05 18:54:01 +0100872 /* No successfully decoded UL block was received during this FN: */
Pau Espin Pedrol99360a32021-03-09 17:18:12 +0100873 if (len == 0)
Pau Espin Pedrol3cba94d2021-03-05 18:54:01 +0100874 return 0;
Pau Espin Pedrol3cba94d2021-03-05 18:54:01 +0100875
Pau Espin Pedrol2ae83372020-05-18 11:35:35 +0200876 enum CodingScheme cs = mcs_get_by_size_ul(len);
Max6dc90b82018-02-19 17:17:28 +0100877 if (!cs) {
Pau Espin Pedrol2182e622021-01-14 16:48:38 +0100878 bts_do_rate_ctr_inc(bts(), CTR_DECODE_ERRORS);
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100879 LOGPDCH(this, DRLCMACUL, LOGL_ERROR, "Dropping data block with invalid "
880 "length %d: %s\n", len, osmo_hexdump(data, len));
Max6dc90b82018-02-19 17:17:28 +0100881 return -EINVAL;
882 }
883
Pau Espin Pedrol2182e622021-01-14 16:48:38 +0100884 bts_do_rate_ctr_add(bts(), CTR_RLC_UL_BYTES, len);
Max6dc90b82018-02-19 17:17:28 +0100885
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100886 LOGPDCH(this, DRLCMACUL, LOGL_DEBUG, "Got RLC block, coding scheme: %s, "
Pau Espin Pedrol2ae83372020-05-18 11:35:35 +0200887 "length: %d (%d))\n", mcs_name(cs), len, mcs_used_size_ul(cs));
Max6dc90b82018-02-19 17:17:28 +0100888
Max8a8e0fb2019-03-25 16:32:50 +0100889 if (mcs_is_gprs(cs))
Max6dc90b82018-02-19 17:17:28 +0100890 return rcv_block_gprs(data, len, fn, meas, cs);
891
Max8a8e0fb2019-03-25 16:32:50 +0100892 if (mcs_is_edge(cs))
Max6dc90b82018-02-19 17:17:28 +0100893 return rcv_data_block(data, len, fn, meas, cs);
894
Pau Espin Pedrol2182e622021-01-14 16:48:38 +0100895 bts_do_rate_ctr_inc(bts(), CTR_DECODE_ERRORS);
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100896 LOGPDCH(this, DRLCMACUL, LOGL_ERROR, "Unsupported coding scheme %s\n",
Max136ebcc2019-03-05 14:59:03 +0100897 mcs_name(cs));
Max6dc90b82018-02-19 17:17:28 +0100898 return -EINVAL;
899}
900
901/*! \brief process egprs and gprs data blocks */
902int gprs_rlcmac_pdch::rcv_data_block(uint8_t *data, uint8_t data_len, uint32_t fn,
Pau Espin Pedrol2ae83372020-05-18 11:35:35 +0200903 struct pcu_l1_meas *meas, enum CodingScheme cs)
Max6dc90b82018-02-19 17:17:28 +0100904{
905 int rc;
906 struct gprs_rlc_data_info rlc_dec;
907 struct gprs_rlcmac_ul_tbf *tbf;
Pau Espin Pedrolc1f38c72021-03-24 14:06:15 +0100908 struct pdch_ulc_node *node;
Pau Espin Pedrol2ae83372020-05-18 11:35:35 +0200909 unsigned len = mcs_size_ul(cs);
Max6dc90b82018-02-19 17:17:28 +0100910
911 /* These are always data blocks, since EGPRS still uses CS-1 for
912 * control blocks (see 44.060, section 10.3, 1st par.)
913 */
Max8a8e0fb2019-03-25 16:32:50 +0100914 if (mcs_is_edge(cs)) {
Pau Espin Pedrol2182e622021-01-14 16:48:38 +0100915 bts_send_gsmtap_meas(bts(), PCU_GSMTAP_C_UL_DATA_EGPRS, true,
Pau Espin Pedrol0b0391f2020-05-19 17:23:23 +0200916 trx_no(), ts_no, GSMTAP_CHANNEL_PDTCH, fn,
917 data, data_len, meas);
Max6dc90b82018-02-19 17:17:28 +0100918 } else {
Pau Espin Pedrol2182e622021-01-14 16:48:38 +0100919 bts_send_gsmtap_meas(bts(), PCU_GSMTAP_C_UL_DATA_GPRS, true,
Pau Espin Pedrol0b0391f2020-05-19 17:23:23 +0200920 trx_no(), ts_no, GSMTAP_CHANNEL_PDTCH, fn,
921 data, data_len, meas);
Max6dc90b82018-02-19 17:17:28 +0100922 }
923
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100924 LOGPDCH(this, DRLCMACUL, LOGL_DEBUG, " UL data: %s\n", osmo_hexdump(data, len));
Max6dc90b82018-02-19 17:17:28 +0100925
926 rc = Decoding::rlc_parse_ul_data_header(&rlc_dec, data, cs);
927 if (rc < 0) {
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100928 LOGPDCH(this, DRLCMACUL, LOGL_ERROR,
Max6dc90b82018-02-19 17:17:28 +0100929 "Got %s RLC block but header parsing has failed\n",
Max136ebcc2019-03-05 14:59:03 +0100930 mcs_name(cs));
Pau Espin Pedrol2182e622021-01-14 16:48:38 +0100931 bts_do_rate_ctr_inc(bts(), CTR_DECODE_ERRORS);
Max6dc90b82018-02-19 17:17:28 +0100932 return rc;
933 }
934
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100935 LOGPDCH(this, DRLCMACUL, LOGL_INFO,
Max6dc90b82018-02-19 17:17:28 +0100936 "Got %s RLC block: "
937 "R=%d, SI=%d, TFI=%d, CPS=%d, RSB=%d, "
938 "rc=%d\n",
Max136ebcc2019-03-05 14:59:03 +0100939 mcs_name(cs),
Max6dc90b82018-02-19 17:17:28 +0100940 rlc_dec.r, rlc_dec.si, rlc_dec.tfi, rlc_dec.cps, rlc_dec.rsb,
941 rc);
942
943 /* find TBF inst from given TFI */
944 tbf = ul_tbf_by_tfi(rlc_dec.tfi);
945 if (!tbf) {
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100946 LOGPDCH(this, DRLCMACUL, LOGL_NOTICE, "UL DATA unknown TFI=%d\n",
Max6dc90b82018-02-19 17:17:28 +0100947 rlc_dec.tfi);
948 return 0;
949 }
950
Pau Espin Pedrolc1f38c72021-03-24 14:06:15 +0100951 node = pdch_ulc_get_node(ulc, fn);
952 if (node) {
953 switch (node->type) {
954 case PDCH_ULC_NODE_TBF_USF:
955 if (tbf != node->tbf_usf.ul_tbf)
956 LOGPDCH(this, DRLCMACUL, LOGL_NOTICE, "FN=%" PRIu32 " "
957 "Rx UL DATA from unexpected %s vs expected %s\n",
958 fn, tbf_name(tbf), tbf_name(node->tbf_usf.ul_tbf));
959 break;
960 case PDCH_ULC_NODE_TBF_POLL:
961 LOGPDCH(this, DRLCMACUL, LOGL_NOTICE, "FN=%" PRIu32 " "
962 "Rx UL DATA from unexpected %s vs expected POLL %s\n",
963 fn, tbf_name(tbf), tbf_name(node->tbf_poll.poll_tbf));
964 break;
965 case PDCH_ULC_NODE_SBA:
966 LOGPDCH(this, DRLCMACUL, LOGL_NOTICE, "FN=%" PRIu32 " "
967 "Rx UL DATA from unexpected %s vs expected SBA\n",
968 fn, tbf_name(tbf));
969 break;
970 }
971 pdch_ulc_release_node(ulc, node);
972 } else {
973 LOGPDCH(this, DRLCMACUL, LOGL_NOTICE, "FN=%" PRIu32 " "
974 "Rx UL DATA from unexpected %s\n", fn, tbf_name(tbf));
975 }
976
Max6dc90b82018-02-19 17:17:28 +0100977 /* Reset N3101 counter: */
Max847ed9f2018-02-20 18:16:11 +0100978 tbf->n_reset(N3101);
Max6dc90b82018-02-19 17:17:28 +0100979
980 return tbf->rcv_data_block_acknowledged(&rlc_dec, data, meas);
981}
982
983int gprs_rlcmac_pdch::rcv_block_gprs(uint8_t *data, uint8_t data_len, uint32_t fn,
Pau Espin Pedrol2ae83372020-05-18 11:35:35 +0200984 struct pcu_l1_meas *meas, enum CodingScheme cs)
Max6dc90b82018-02-19 17:17:28 +0100985{
986 unsigned payload = data[0] >> 6;
Max6dc90b82018-02-19 17:17:28 +0100987 int rc = 0;
Max6dc90b82018-02-19 17:17:28 +0100988
989 switch (payload) {
990 case GPRS_RLCMAC_DATA_BLOCK:
991 rc = rcv_data_block(data, data_len, fn, meas, cs);
992 break;
993 case GPRS_RLCMAC_CONTROL_BLOCK:
Pau Espin Pedrole13cdc52019-09-25 13:46:14 +0200994 rc = rcv_control_block(data, data_len, fn, meas, cs);
Max6dc90b82018-02-19 17:17:28 +0100995 break;
996 case GPRS_RLCMAC_CONTROL_BLOCK_OPT:
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100997 LOGPDCH(this, DRLCMAC, LOGL_NOTICE, "GPRS_RLCMAC_CONTROL_BLOCK_OPT block payload is not supported.\n");
Max6dc90b82018-02-19 17:17:28 +0100998 break;
999 default:
Pau Espin Pedrol95e22662021-02-25 17:49:30 +01001000 LOGPDCH(this, DRLCMAC, LOGL_NOTICE, "Unknown RLCMAC block payload(%u).\n", payload);
Max6dc90b82018-02-19 17:17:28 +01001001 rc = -EINVAL;
1002 }
1003
1004 return rc;
1005}
1006
1007gprs_rlcmac_tbf *gprs_rlcmac_pdch::tbf_from_list_by_tfi(
1008 LListHead<gprs_rlcmac_tbf> *tbf_list, uint8_t tfi,
1009 enum gprs_rlcmac_tbf_direction dir)
1010{
1011 gprs_rlcmac_tbf *tbf;
1012 LListHead<gprs_rlcmac_tbf> *pos;
1013
1014 llist_for_each(pos, tbf_list) {
1015 tbf = pos->entry();
1016 if (tbf->tfi() != tfi)
1017 continue;
1018 if (!tbf->pdch[ts_no])
1019 continue;
1020 return tbf;
1021 }
1022 return NULL;
1023}
1024
1025gprs_rlcmac_ul_tbf *gprs_rlcmac_pdch::ul_tbf_by_tfi(uint8_t tfi)
1026{
1027 return as_ul_tbf(tbf_by_tfi(tfi, GPRS_RLCMAC_UL_TBF));
1028}
1029
1030gprs_rlcmac_dl_tbf *gprs_rlcmac_pdch::dl_tbf_by_tfi(uint8_t tfi)
1031{
1032 return as_dl_tbf(tbf_by_tfi(tfi, GPRS_RLCMAC_DL_TBF));
1033}
1034
1035/* lookup TBF Entity (by TFI) */
1036gprs_rlcmac_tbf *gprs_rlcmac_pdch::tbf_by_tfi(uint8_t tfi,
1037 enum gprs_rlcmac_tbf_direction dir)
1038{
1039 struct gprs_rlcmac_tbf *tbf;
1040
1041 if (tfi >= 32)
1042 return NULL;
1043
1044 tbf = m_tbfs[dir][tfi];
1045
Pau Espin Pedrol710e0e92021-04-22 21:03:33 +02001046 return tbf;
Max6dc90b82018-02-19 17:17:28 +01001047}
1048
1049void gprs_rlcmac_pdch::attach_tbf(gprs_rlcmac_tbf *tbf)
1050{
1051 gprs_rlcmac_ul_tbf *ul_tbf;
1052
1053 if (m_tbfs[tbf->direction][tbf->tfi()])
Pau Espin Pedrol95e22662021-02-25 17:49:30 +01001054 LOGPDCH(this, DRLCMAC, LOGL_ERROR,
Max6dc90b82018-02-19 17:17:28 +01001055 "%s has not been detached, overwriting it\n",
Max6dc90b82018-02-19 17:17:28 +01001056 m_tbfs[tbf->direction][tbf->tfi()]->name());
1057
1058 m_num_tbfs[tbf->direction] += 1;
1059 if (tbf->direction == GPRS_RLCMAC_UL_TBF) {
1060 ul_tbf = as_ul_tbf(tbf);
1061 m_assigned_usf |= 1 << ul_tbf->m_usf[ts_no];
1062 }
1063 m_assigned_tfi[tbf->direction] |= 1UL << tbf->tfi();
1064 m_tbfs[tbf->direction][tbf->tfi()] = tbf;
1065
Pau Espin Pedrol95e22662021-02-25 17:49:30 +01001066 LOGPDCH(this, DRLCMAC, LOGL_INFO, "Attaching %s, %d TBFs, "
Max6dc90b82018-02-19 17:17:28 +01001067 "USFs = %02x, TFIs = %08x.\n",
Pau Espin Pedrol95e22662021-02-25 17:49:30 +01001068 tbf->name(), m_num_tbfs[tbf->direction],
Max6dc90b82018-02-19 17:17:28 +01001069 m_assigned_usf, m_assigned_tfi[tbf->direction]);
1070}
1071
1072void gprs_rlcmac_pdch::detach_tbf(gprs_rlcmac_tbf *tbf)
1073{
1074 gprs_rlcmac_ul_tbf *ul_tbf;
1075
1076 OSMO_ASSERT(m_num_tbfs[tbf->direction] > 0);
1077
1078 m_num_tbfs[tbf->direction] -= 1;
1079 if (tbf->direction == GPRS_RLCMAC_UL_TBF) {
1080 ul_tbf = as_ul_tbf(tbf);
1081 m_assigned_usf &= ~(1 << ul_tbf->m_usf[ts_no]);
1082 }
1083 m_assigned_tfi[tbf->direction] &= ~(1UL << tbf->tfi());
1084 m_tbfs[tbf->direction][tbf->tfi()] = NULL;
1085
Pau Espin Pedrol99360a32021-03-09 17:18:12 +01001086 pdch_ulc_release_tbf(ulc, tbf);
1087
Pau Espin Pedrol95e22662021-02-25 17:49:30 +01001088 LOGPDCH(this, DRLCMAC, LOGL_INFO, "Detaching %s, %d TBFs, "
Max6dc90b82018-02-19 17:17:28 +01001089 "USFs = %02x, TFIs = %08x.\n",
Pau Espin Pedrol95e22662021-02-25 17:49:30 +01001090 tbf->name(), m_num_tbfs[tbf->direction],
Max6dc90b82018-02-19 17:17:28 +01001091 m_assigned_usf, m_assigned_tfi[tbf->direction]);
1092}
1093
Pau Espin Pedrol22862882020-11-16 17:35:10 +01001094bool gprs_rlcmac_pdch::has_gprs_only_tbf_attached() const
1095{
1096 unsigned int i;
1097 unsigned int j;
1098 for (i = 0; i < sizeof(m_assigned_tfi[0]); i++) {
1099 for (j = 0; j < 2; j++) {
1100 if (m_assigned_tfi[j] & (1UL << i)) {
1101 gprs_rlcmac_tbf *tbf = m_tbfs[j][i];
1102 if (!tbf->is_egprs_enabled())
1103 return true;
1104 }
1105 }
1106 }
1107 return false;
1108}
1109
Max6dc90b82018-02-19 17:17:28 +01001110void gprs_rlcmac_pdch::reserve(enum gprs_rlcmac_tbf_direction dir)
1111{
1112 m_num_reserved[dir] += 1;
1113}
1114
1115void gprs_rlcmac_pdch::unreserve(enum gprs_rlcmac_tbf_direction dir)
1116{
1117 OSMO_ASSERT(m_num_reserved[dir] > 0);
1118 m_num_reserved[dir] -= 1;
1119}
1120
Pau Espin Pedrol2182e622021-01-14 16:48:38 +01001121inline struct gprs_rlcmac_bts *gprs_rlcmac_pdch::bts() const
Max6dc90b82018-02-19 17:17:28 +01001122{
1123 return trx->bts;
1124}
1125
1126uint8_t gprs_rlcmac_pdch::trx_no() const
1127{
1128 return trx->trx_no;
1129}
1130
Vadim Yanitskiybd0dac32019-10-05 21:57:14 +07001131uint8_t gprs_rlcmac_pdch::reserve_tai(uint8_t ta)
1132{
1133 uint8_t tai;
1134
1135 for (tai = 0; tai < PTCCH_TAI_NUM; tai++) {
1136 if (ptcch_msg[tai] == PTCCH_TAI_FREE) {
1137 ptcch_msg[tai] = ta;
1138 return tai;
1139 }
1140 }
1141
1142 /* Special case: no free TAI available */
1143 return PTCCH_TAI_FREE;
1144}
1145
1146void gprs_rlcmac_pdch::release_tai(uint8_t tai)
1147{
1148 OSMO_ASSERT(tai < PTCCH_TAI_NUM);
1149 ptcch_msg[tai] = PTCCH_TAI_FREE;
1150}
1151
1152void gprs_rlcmac_pdch::update_ta(uint8_t tai, uint8_t ta)
1153{
1154 OSMO_ASSERT(tai < PTCCH_TAI_NUM);
1155 ptcch_msg[tai] = ta;
1156}
Pau Espin Pedrol906aafc2021-01-18 17:53:29 +01001157
1158void pdch_free_all_tbf(struct gprs_rlcmac_pdch *pdch)
1159{
1160 for (uint8_t tfi = 0; tfi < 32; tfi++) {
1161 struct gprs_rlcmac_tbf *tbf;
1162
1163 tbf = pdch->ul_tbf_by_tfi(tfi);
1164 if (tbf)
1165 tbf_free(tbf);
1166 tbf = pdch->dl_tbf_by_tfi(tfi);
1167 if (tbf)
1168 tbf_free(tbf);
1169 }
1170}
Pau Espin Pedrole91c4c72021-01-18 17:54:30 +01001171
1172void pdch_disable(struct gprs_rlcmac_pdch *pdch) {
1173 pdch->disable();
1174}