blob: 5d8658af5df3c549827bf06c2cbac935d5733c7f [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 Pedrol59223962021-10-18 12:24:38 +0200122 gprs_rlcmac_ul_tbf *ul_tbf = tbf_alloc_ul_pacch(bts, tbf->ms(), tbf->trx->trx_no);
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");
Pau Espin Pedrol6ad11a62021-07-27 12:27:08 +0200127 osmo_fsm_inst_dispatch(tbf->ul_ass_fsm.fi, TBF_UL_ASS_EV_SCHED_ASS, NULL);
Max6dc90b82018-02-19 17:17:28 +0100128 } else {
129 LOGP(DRLCMAC, LOGL_DEBUG, "MS requests UL TBF in ack message, so we packet access reject:\n");
Pau Espin Pedrol6ad11a62021-07-27 12:27:08 +0200130 osmo_fsm_inst_dispatch(tbf->ul_ass_fsm.fi, TBF_UL_ASS_EV_SCHED_ASS_REJ, NULL);
Max6dc90b82018-02-19 17:17:28 +0100131 }
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);
142}
143
Max6dc90b82018-02-19 17:17:28 +0100144void gprs_rlcmac_pdch::enable()
145{
Pau Espin Pedrol4f67a9b2021-06-30 16:03:06 +0200146 OSMO_ASSERT(m_is_enabled == 0);
Max6dc90b82018-02-19 17:17:28 +0100147 INIT_LLIST_HEAD(&paging_list);
Pau Espin Pedrol4f67a9b2021-06-30 16:03:06 +0200148
149 OSMO_ASSERT(!this->ulc);
150 this->ulc = pdch_ulc_alloc(this, trx->bts);
151
Max6dc90b82018-02-19 17:17:28 +0100152 m_is_enabled = 1;
Oliver Smith35d51ca2021-09-02 12:23:58 +0200153 bts_stat_item_inc(trx->bts, STAT_PDCH_AVAILABLE);
Max6dc90b82018-02-19 17:17:28 +0100154}
155
156void gprs_rlcmac_pdch::disable()
157{
Pau Espin Pedrol4f67a9b2021-06-30 16:03:06 +0200158 OSMO_ASSERT(m_is_enabled == 1);
159 this->free_resources();
160
Max6dc90b82018-02-19 17:17:28 +0100161 m_is_enabled = 0;
Oliver Smith35d51ca2021-09-02 12:23:58 +0200162 bts_stat_item_dec(trx->bts, STAT_PDCH_AVAILABLE);
Max6dc90b82018-02-19 17:17:28 +0100163}
164
165void gprs_rlcmac_pdch::free_resources()
166{
167 struct gprs_rlcmac_paging *pag;
168
Max6dc90b82018-02-19 17:17:28 +0100169 /* kick all TBF on slot */
Pau Espin Pedrol906aafc2021-01-18 17:53:29 +0100170 pdch_free_all_tbf(this);
Max6dc90b82018-02-19 17:17:28 +0100171
172 /* flush all pending paging messages */
173 while ((pag = dequeue_paging()))
174 talloc_free(pag);
175
Pau Espin Pedrol15c58ac2021-03-08 14:57:58 +0100176 talloc_free(this->ulc);
Pau Espin Pedrol4f67a9b2021-06-30 16:03:06 +0200177 this->ulc = NULL;
Max6dc90b82018-02-19 17:17:28 +0100178}
179
180struct gprs_rlcmac_paging *gprs_rlcmac_pdch::dequeue_paging()
181{
182 struct gprs_rlcmac_paging *pag;
183
184 if (llist_empty(&paging_list))
185 return NULL;
Pau Espin Pedrolc48d27b2021-05-13 15:58:55 +0200186 pag = llist_first_entry(&paging_list, struct gprs_rlcmac_paging, list);
Max6dc90b82018-02-19 17:17:28 +0100187 llist_del(&pag->list);
188
189 return pag;
190}
191
192struct msgb *gprs_rlcmac_pdch::packet_paging_request()
193{
194 struct gprs_rlcmac_paging *pag;
Pau Espin Pedrol5e300ce2020-02-03 17:18:03 +0100195 RlcMacDownlink_t *mac_control_block;
196 bitvec *pag_vec;
Max6dc90b82018-02-19 17:17:28 +0100197 struct msgb *msg;
198 unsigned wp = 0, len;
Pau Espin Pedrol5e300ce2020-02-03 17:18:03 +0100199 int rc;
Max6dc90b82018-02-19 17:17:28 +0100200
201 /* no paging, no message */
202 pag = dequeue_paging();
203 if (!pag)
204 return NULL;
205
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100206 LOGPDCH(this, DRLCMAC, LOGL_DEBUG, "Scheduling paging\n");
Max6dc90b82018-02-19 17:17:28 +0100207
208 /* alloc message */
209 msg = msgb_alloc(23, "pag ctrl block");
210 if (!msg) {
211 talloc_free(pag);
212 return NULL;
213 }
Pau Espin Pedrol5e300ce2020-02-03 17:18:03 +0100214 pag_vec = bitvec_alloc(23, tall_pcu_ctx);
Max6dc90b82018-02-19 17:17:28 +0100215 if (!pag_vec) {
216 msgb_free(msg);
217 talloc_free(pag);
218 return NULL;
219 }
220 wp = Encoding::write_packet_paging_request(pag_vec);
221
222 /* loop until message is full */
223 while (pag) {
Neels Hofmeyr00520512020-08-21 15:44:58 +0200224 if (log_check_level(DRLCMAC, LOGL_DEBUG)) {
225 struct osmo_mobile_identity omi = {};
226 char str[64];
227 osmo_mobile_identity_decode(&omi, pag->identity_lv + 1, pag->identity_lv[0], true);
228 osmo_mobile_identity_to_str_buf(str, sizeof(str), &omi);
229 LOGP(DRLCMAC, LOGL_DEBUG, "Paging MI - %s\n", str);
230 }
Vadim Yanitskiyd71c5662020-03-26 15:45:21 +0700231
Max6dc90b82018-02-19 17:17:28 +0100232 /* try to add paging */
Vadim Yanitskiyce160142020-03-26 16:18:17 +0700233 if ((pag->identity_lv[1] & GSM_MI_TYPE_MASK) == GSM_MI_TYPE_TMSI) {
Max6dc90b82018-02-19 17:17:28 +0100234 /* TMSI */
Max6dc90b82018-02-19 17:17:28 +0100235 len = 1 + 1 + 1 + 32 + 2 + 1;
236 if (pag->identity_lv[0] != 5) {
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100237 LOGPDCH(this, DRLCMAC, LOGL_ERROR,
238 "TMSI paging with MI != 5 octets!\n");
Max6dc90b82018-02-19 17:17:28 +0100239 goto continue_next;
240 }
241 } else {
242 /* MI */
Max6dc90b82018-02-19 17:17:28 +0100243 len = 1 + 1 + 1 + 4 + (pag->identity_lv[0]<<3) + 2 + 1;
244 if (pag->identity_lv[0] > 8) {
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100245 LOGPDCH(this, DRLCMAC, LOGL_ERROR,
246 "Paging with MI > 8 octets!\n");
Max6dc90b82018-02-19 17:17:28 +0100247 goto continue_next;
248 }
249 }
250 if (wp + len > 184) {
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100251 LOGPDCH(this, DRLCMAC, LOGL_DEBUG,
252 "- Does not fit, so schedule next time\n");
Max6dc90b82018-02-19 17:17:28 +0100253 /* put back paging record, because does not fit */
Pau Espin Pedrol7d3ee9e2020-11-23 16:04:02 +0100254 llist_add(&pag->list, &paging_list);
Max6dc90b82018-02-19 17:17:28 +0100255 break;
256 }
257 Encoding::write_repeated_page_info(pag_vec, wp, pag->identity_lv[0],
258 pag->identity_lv + 1, pag->chan_needed);
259
260continue_next:
261 talloc_free(pag);
262 pag = dequeue_paging();
263 }
264
265 bitvec_pack(pag_vec, msgb_put(msg, 23));
Pau Espin Pedrol5e300ce2020-02-03 17:18:03 +0100266 mac_control_block = (RlcMacDownlink_t *)talloc_zero(tall_pcu_ctx, RlcMacDownlink_t);
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100267 LOGPDCH(this, DRLCMAC, LOGL_DEBUG, "+++++++++++++++++++++++++ TX : Packet Paging Request +++++++++++++++++++++++++\n");
Pau Espin Pedrol5e300ce2020-02-03 17:18:03 +0100268 rc = decode_gsm_rlcmac_downlink(pag_vec, mac_control_block);
269 if (rc < 0) {
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100270 LOGPDCH(this, DRLCMAC, LOGL_ERROR, "Decoding of Downlink Packet Paging Request failed (%d): %s\n",
Pau Espin Pedrol9c4f9ff2020-11-23 16:36:42 +0100271 rc, osmo_hexdump(msgb_data(msg), msgb_length(msg)));
Pau Espin Pedrol5e300ce2020-02-03 17:18:03 +0100272 goto free_ret;
273 }
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100274 LOGPDCH(this, DRLCMAC, LOGL_DEBUG, "------------------------- TX : Packet Paging Request -------------------------\n");
Max6dc90b82018-02-19 17:17:28 +0100275 bitvec_free(pag_vec);
276 talloc_free(mac_control_block);
Max6dc90b82018-02-19 17:17:28 +0100277 return msg;
Pau Espin Pedrol5e300ce2020-02-03 17:18:03 +0100278
279free_ret:
280 bitvec_free(pag_vec);
281 talloc_free(mac_control_block);
282 msgb_free(msg);
283 return NULL;
Max6dc90b82018-02-19 17:17:28 +0100284}
285
Neels Hofmeyr59fc0bd2020-08-21 16:21:23 +0200286bool gprs_rlcmac_pdch::add_paging(uint8_t chan_needed, const struct osmo_mobile_identity *mi)
Max6dc90b82018-02-19 17:17:28 +0100287{
Neels Hofmeyr59fc0bd2020-08-21 16:21:23 +0200288 int rc;
Max6dc90b82018-02-19 17:17:28 +0100289 struct gprs_rlcmac_paging *pag = talloc_zero(tall_pcu_ctx, struct gprs_rlcmac_paging);
290 if (!pag)
291 return false;
292
293 pag->chan_needed = chan_needed;
Neels Hofmeyr59fc0bd2020-08-21 16:21:23 +0200294 rc = osmo_mobile_identity_encode_buf(pag->identity_lv + 1, sizeof(pag->identity_lv) - 1, mi, true);
295 if (rc <= 0) {
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100296 LOGPDCH(this, DRLCMAC, LOGL_ERROR, "Cannot encode Mobile Identity (rc=%d)\n", rc);
Neels Hofmeyr59fc0bd2020-08-21 16:21:23 +0200297 talloc_free(pag);
298 return false;
299 }
300 pag->identity_lv[0] = rc;
Max6dc90b82018-02-19 17:17:28 +0100301
302 llist_add(&pag->list, &paging_list);
303
304 return true;
305}
306
307void gprs_rlcmac_pdch::rcv_control_ack(Packet_Control_Acknowledgement_t *packet, uint32_t fn)
308{
309 struct gprs_rlcmac_tbf *tbf, *new_tbf;
310 uint32_t tlli = packet->TLLI;
Pau Espin Pedrolab178902021-06-22 22:15:20 +0200311 GprsMs *ms;
Max6dc90b82018-02-19 17:17:28 +0100312 gprs_rlcmac_ul_tbf *ul_tbf;
Pau Espin Pedrol86580e12021-03-29 18:15:30 +0200313 enum pdch_ulc_tbf_poll_reason reason;
Pau Espin Pedrol99360a32021-03-09 17:18:12 +0100314 struct pdch_ulc_node *poll;
Max6dc90b82018-02-19 17:17:28 +0100315
Pau Espin Pedrol99360a32021-03-09 17:18:12 +0100316 poll = pdch_ulc_get_node(ulc, fn);
Pau Espin Pedrole9db5c72021-09-28 16:38:05 +0200317 if (!poll || poll->type != PDCH_ULC_NODE_TBF_POLL) {
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100318 LOGPDCH(this, DRLCMAC, LOGL_NOTICE, "PACKET CONTROL ACK with "
Max6dc90b82018-02-19 17:17:28 +0100319 "unknown FN=%u TLLI=0x%08x (TRX %d TS %d)\n",
320 fn, tlli, trx_no(), ts_no);
Pau Espin Pedrolab178902021-06-22 22:15:20 +0200321 ms = bts_ms_by_tlli(bts(), tlli, GSM_RESERVED_TMSI);
Max6dc90b82018-02-19 17:17:28 +0100322 if (ms)
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100323 LOGPDCH(this, DRLCMAC, LOGL_NOTICE, "PACKET CONTROL ACK with "
324 "unknown TBF corresponds to MS with IMSI %s, TA %d, "
325 "uTBF (TFI=%d, state=%s), dTBF (TFI=%d, state=%s)\n",
326 ms_imsi(ms), ms_ta(ms),
327 ms_ul_tbf(ms) ? ms_ul_tbf(ms)->tfi() : 0,
328 ms_ul_tbf(ms) ? ms_ul_tbf(ms)->state_name() : "None",
329 ms_dl_tbf(ms) ? ms_dl_tbf(ms)->tfi() : 0,
330 ms_dl_tbf(ms) ? ms_dl_tbf(ms)->state_name() : "None");
Max6dc90b82018-02-19 17:17:28 +0100331 return;
332 }
Pau Espin Pedrole9db5c72021-09-28 16:38:05 +0200333 OSMO_ASSERT(poll->tbf_poll.poll_tbf);
Pau Espin Pedrol99360a32021-03-09 17:18:12 +0100334 tbf = poll->tbf_poll.poll_tbf;
Pau Espin Pedrol86580e12021-03-29 18:15:30 +0200335 reason = poll->tbf_poll.reason;
Max6dc90b82018-02-19 17:17:28 +0100336
337 /* Reset N3101 counter: */
Max847ed9f2018-02-20 18:16:11 +0100338 tbf->n_reset(N3101);
Max6dc90b82018-02-19 17:17:28 +0100339
340 tbf->update_ms(tlli, GPRS_RLCMAC_UL_TBF);
Pau Espin Pedrolab178902021-06-22 22:15:20 +0200341 /* Gather MS from TBF, since it may be NULL or may have been merged during update_ms */
342 ms = tbf->ms();
Max6dc90b82018-02-19 17:17:28 +0100343
Pau Espin Pedrolc6e911c2021-06-07 18:13:23 +0200344 LOGPTBF(tbf, LOGL_DEBUG, "FN=%" PRIu32 " Rx Packet Control Ack (reason=%s)\n",
345 fn, get_value_string(pdch_ulc_tbf_poll_reason_names, reason));
Max6dc90b82018-02-19 17:17:28 +0100346
Pau Espin Pedrolc8d21662021-09-28 13:27:51 +0200347 switch (reason) {
348 case PDCH_ULC_POLL_UL_ACK:
349 ul_tbf = as_ul_tbf(tbf);
350 OSMO_ASSERT(ul_tbf);
351 if (!tbf_ul_ack_exp_ctrl_ack(ul_tbf, fn, ts_no)) {
352 LOGPTBF(tbf, LOGL_NOTICE, "FN=%d, TS=%d (curr FN %d): POLL_UL_ACK not expected!\n",
353 fn, ts_no, bts_current_frame_number(tbf->bts));
354 return;
355 }
Pau Espin Pedrol0dbf6f22021-10-11 18:08:25 +0200356 pdch_ulc_release_fn(ulc, fn);
Pau Espin Pedrolea8dbdd2021-07-29 18:39:16 +0200357 osmo_fsm_inst_dispatch(ul_tbf->ul_ack_fsm.fi, TBF_UL_ACK_EV_RX_CTRL_ACK, NULL);
Pau Espin Pedrol7a2b65e2021-10-11 19:18:13 +0200358 /* We only set polling on final UL ACK/NACK */
Max6dc90b82018-02-19 17:17:28 +0100359 LOGPTBF(tbf, LOGL_DEBUG, "[UPLINK] END\n");
Pau Espin Pedrol7a2b65e2021-10-11 19:18:13 +0200360 osmo_fsm_inst_dispatch(ul_tbf->state_fsm.fi, TBF_EV_FINAL_UL_ACK_CONFIRMED, NULL);
Max6dc90b82018-02-19 17:17:28 +0100361 return;
Max6dc90b82018-02-19 17:17:28 +0100362
Pau Espin Pedrolc8d21662021-09-28 13:27:51 +0200363 case PDCH_ULC_POLL_UL_ASS:
364 if (!tbf->ul_ass_state_is(TBF_UL_ASS_WAIT_ACK)) {
365 LOGPTBF(tbf, LOGL_NOTICE, "FN=%d, TS=%d (curr FN %d): POLL_UL_ASS not expected! state is %s\n",
366 fn, ts_no, bts_current_frame_number(tbf->bts),
367 osmo_fsm_inst_state_name(tbf_ul_ass_fi(tbf)));
Max6dc90b82018-02-19 17:17:28 +0100368 return;
369 }
Max6dc90b82018-02-19 17:17:28 +0100370 LOGPTBF(tbf, LOGL_DEBUG, "[DOWNLINK] UPLINK ASSIGNED\n");
Pau Espin Pedrol0dbf6f22021-10-11 18:08:25 +0200371 pdch_ulc_release_fn(ulc, fn);
Max6dc90b82018-02-19 17:17:28 +0100372 /* reset N3105 */
Max847ed9f2018-02-20 18:16:11 +0100373 tbf->n_reset(N3105);
Pau Espin Pedrol6ad11a62021-07-27 12:27:08 +0200374 osmo_fsm_inst_dispatch(tbf->ul_ass_fsm.fi, TBF_UL_ASS_EV_RX_ASS_CTRL_ACK, NULL);
Max6dc90b82018-02-19 17:17:28 +0100375
Pau Espin Pedrolab178902021-06-22 22:15:20 +0200376 new_tbf = ms_ul_tbf(ms);
Max6dc90b82018-02-19 17:17:28 +0100377 if (!new_tbf) {
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100378 LOGPDCH(this, DRLCMAC, LOGL_ERROR, "Got ACK, but UL "
Max6dc90b82018-02-19 17:17:28 +0100379 "TBF is gone TLLI=0x%08x\n", tlli);
380 return;
381 }
Pau Espin Pedroldc2aaac2021-05-14 12:50:46 +0200382 if (tbf->state_is(TBF_ST_WAIT_RELEASE) &&
Max6dc90b82018-02-19 17:17:28 +0100383 tbf->direction == new_tbf->direction)
384 tbf_free(tbf);
385
Pau Espin Pedrol720e19e2021-07-22 19:56:37 +0200386 osmo_fsm_inst_dispatch(new_tbf->state_fsm.fi, TBF_EV_ASSIGN_ACK_PACCH, NULL);
Max6dc90b82018-02-19 17:17:28 +0100387 /* there might be LLC packets waiting in the queue, but the DL
388 * TBF might have been released while the UL TBF has been
389 * established */
Pau Espin Pedrolda971ee2020-12-16 15:59:45 +0100390 if (ms_need_dl_tbf(new_tbf->ms()))
Max6dc90b82018-02-19 17:17:28 +0100391 new_tbf->establish_dl_tbf_on_pacch();
Max6dc90b82018-02-19 17:17:28 +0100392 return;
Pau Espin Pedrolc8d21662021-09-28 13:27:51 +0200393
394 case PDCH_ULC_POLL_DL_ASS:
395 if (!tbf->dl_ass_state_is(TBF_DL_ASS_WAIT_ACK)) {
396 LOGPTBF(tbf, LOGL_NOTICE, "FN=%d, TS=%d (curr FN %d): POLL_DL_ASS not expected! state is %s\n",
397 fn, ts_no, bts_current_frame_number(tbf->bts),
398 osmo_fsm_inst_state_name(tbf_dl_ass_fi(tbf)));
399 return;
400 }
401 LOGPTBF(tbf, LOGL_DEBUG, "[UPLINK] DOWNLINK ASSIGNED\n");
Pau Espin Pedrol0dbf6f22021-10-11 18:08:25 +0200402 pdch_ulc_release_fn(ulc, fn);
Pau Espin Pedrolc8d21662021-09-28 13:27:51 +0200403 /* reset N3105 */
404 tbf->n_reset(N3105);
405 osmo_fsm_inst_dispatch(tbf->dl_ass_fsm.fi, TBF_DL_ASS_EV_RX_ASS_CTRL_ACK, NULL);
406
407 new_tbf = ms_dl_tbf(ms);
408 if (!new_tbf) {
409 LOGPDCH(this, DRLCMAC, LOGL_ERROR, "Got ACK, but DL "
410 "TBF is gone TLLI=0x%08x\n", tlli);
411 return;
412 }
413 if (tbf->state_is(TBF_ST_WAIT_RELEASE) &&
414 tbf->direction == new_tbf->direction)
415 tbf_free(tbf);
416
417 osmo_fsm_inst_dispatch(new_tbf->state_fsm.fi, TBF_EV_ASSIGN_ACK_PACCH, NULL);
Pau Espin Pedrolc8d21662021-09-28 13:27:51 +0200418 return;
419
420 case PDCH_ULC_POLL_CELL_CHG_CONTINUE:
421 if (!ms->nacc || !nacc_fsm_exp_ctrl_ack(ms->nacc, fn, ts_no)) {
422 LOGPTBF(tbf, LOGL_NOTICE, "FN=%d, TS=%d (curr FN %d): POLL_CELL_CHG_CONTINUE not expected!\n",
423 fn, ts_no, bts_current_frame_number(tbf->bts));
424 return;
425 }
Pau Espin Pedrol0dbf6f22021-10-11 18:08:25 +0200426 pdch_ulc_release_fn(ulc, fn);
Pau Espin Pedrol952cb3d2021-02-01 14:52:48 +0100427 osmo_fsm_inst_dispatch(ms->nacc->fi, NACC_EV_RX_CELL_CHG_CONTINUE_ACK, NULL);
428 /* Don't assume MS is no longer reachable (hence don't free) after this: TS 44.060
429 * "When the mobile station receives the PACKET CELL CHANGE ORDER
430 * or the PACKET CELL CHANGE CONTINUE message the mobile station
431 * shall transmit a PACKET CONTROL ACKNOWLEDGMENT message in the
432 * specified uplink radio block if a valid RRBP field is
433 * received as part of the message; the mobile station _MAY_ then
434 * switch to a new cell."
435 */
436 return;
Pau Espin Pedrolc8d21662021-09-28 13:27:51 +0200437
438 case PDCH_ULC_POLL_DL_ACK:
439 /* Handled in rcv_control_dl_ack_nack() upon receival of DL ACK/NACK as a response to our POLL. */
440 return;
441 default:
442 LOGPDCH(this, DRLCMAC, LOGL_ERROR, "FN=%" PRIu32 " "
443 "Error: received PACKET CONTROL ACK at no request (reason=%s)\n", fn,
444 get_value_string(pdch_ulc_tbf_poll_reason_names, reason));
Pau Espin Pedrol952cb3d2021-02-01 14:52:48 +0100445 }
Max6dc90b82018-02-19 17:17:28 +0100446}
447
Pau Espin Pedrole13cdc52019-09-25 13:46:14 +0200448void 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 +0100449{
450 int8_t tfi = 0; /* must be signed */
Pau Espin Pedrol99360a32021-03-09 17:18:12 +0100451 struct pdch_ulc_node *poll;
Max6dc90b82018-02-19 17:17:28 +0100452 struct gprs_rlcmac_dl_tbf *tbf;
453 int rc;
Max6dc90b82018-02-19 17:17:28 +0100454 int num_blocks;
455 uint8_t bits_data[RLC_GPRS_WS/8];
456 bitvec bits;
457 int bsn_begin, bsn_end;
458 char show_bits[RLC_GPRS_WS + 1];
459
460 tfi = ack_nack->DOWNLINK_TFI;
Pau Espin Pedrol99360a32021-03-09 17:18:12 +0100461 poll = pdch_ulc_get_node(ulc, fn);
Pau Espin Pedrol8318d9c2021-10-11 18:17:35 +0200462 if (!poll || poll->type != PDCH_ULC_NODE_TBF_POLL ||
463 poll->tbf_poll.reason != PDCH_ULC_POLL_DL_ACK) {
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100464 LOGPDCH(this, DRLCMAC, LOGL_NOTICE, "PACKET DOWNLINK ACK with "
Max6dc90b82018-02-19 17:17:28 +0100465 "unknown FN=%u TFI=%d (TRX %d TS %d)\n",
466 fn, tfi, trx_no(), ts_no);
467 return;
468 }
Pau Espin Pedrole9db5c72021-09-28 16:38:05 +0200469 OSMO_ASSERT(poll->tbf_poll.poll_tbf);
Pau Espin Pedrol99360a32021-03-09 17:18:12 +0100470 tbf = as_dl_tbf(poll->tbf_poll.poll_tbf);
Pau Espin Pedrolb5fece92021-08-23 16:58:04 +0200471 if (tbf->tfi() != tfi) {
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100472 LOGPTBFDL(tbf, LOGL_NOTICE,
473 "PACKET DOWNLINK ACK with wrong TFI=%d, ignoring!\n", tfi);
Max6dc90b82018-02-19 17:17:28 +0100474 return;
475 }
476
477 /* Reset N3101 counter: */
Max847ed9f2018-02-20 18:16:11 +0100478 tbf->n_reset(N3101);
Max6dc90b82018-02-19 17:17:28 +0100479
Pau Espin Pedrol99360a32021-03-09 17:18:12 +0100480 pdch_ulc_release_fn(ulc, fn);
Max6dc90b82018-02-19 17:17:28 +0100481
482 LOGPTBF(tbf, LOGL_DEBUG, "RX: [PCU <- BTS] Packet Downlink Ack/Nack\n");
483
484 bits.data = bits_data;
485 bits.data_len = sizeof(bits_data);
486 bits.cur_bit = 0;
487
488 num_blocks = Decoding::decode_gprs_acknack_bits(
489 &ack_nack->Ack_Nack_Description, &bits,
Pau Espin Pedrolb3f23972020-10-23 21:00:23 +0200490 &bsn_begin, &bsn_end, static_cast<gprs_rlc_dl_window *>(tbf->window()));
Max6dc90b82018-02-19 17:17:28 +0100491
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100492 LOGPDCH(this, DRLCMAC, LOGL_DEBUG,
Max6dc90b82018-02-19 17:17:28 +0100493 "Got GPRS DL ACK bitmap: SSN: %d, BSN %d to %d - 1 (%d blocks), "
494 "\"%s\"\n",
495 ack_nack->Ack_Nack_Description.STARTING_SEQUENCE_NUMBER,
496 bsn_begin, bsn_end, num_blocks,
497 (Decoding::extract_rbb(&bits, show_bits), show_bits));
498
499 rc = tbf->rcvd_dl_ack(
500 ack_nack->Ack_Nack_Description.FINAL_ACK_INDICATION,
501 bsn_begin, &bits);
502 if (rc == 1) {
503 tbf_free(tbf);
504 return;
505 }
506 /* check for channel request */
507 if (ack_nack->Exist_Channel_Request_Description)
Pau Espin Pedrol0ece97d2021-01-18 12:53:54 +0100508 sched_ul_ass_or_rej(bts(), tbf);
Max6dc90b82018-02-19 17:17:28 +0100509
510 /* get measurements */
511 if (tbf->ms()) {
Pau Espin Pedrole13cdc52019-09-25 13:46:14 +0200512 get_meas(meas, &ack_nack->Channel_Quality_Report);
Pau Espin Pedrolda971ee2020-12-16 15:59:45 +0100513 ms_update_l1_meas(tbf->ms(), meas);
Max6dc90b82018-02-19 17:17:28 +0100514 }
515}
516
Pau Espin Pedrole13cdc52019-09-25 13:46:14 +0200517void 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 +0100518{
519 int8_t tfi = 0; /* must be signed */
520 struct gprs_rlcmac_dl_tbf *tbf;
Pau Espin Pedrol99360a32021-03-09 17:18:12 +0100521 struct pdch_ulc_node *poll;
Pau Espin Pedrolb3f23972020-10-23 21:00:23 +0200522 gprs_rlc_dl_window *window;
Max6dc90b82018-02-19 17:17:28 +0100523 int rc;
524 int num_blocks;
525 uint8_t bits_data[RLC_EGPRS_MAX_WS/8];
526 char show_bits[RLC_EGPRS_MAX_WS + 1];
527 bitvec bits;
528 int bsn_begin, bsn_end;
529
530 tfi = ack_nack->DOWNLINK_TFI;
Pau Espin Pedrol99360a32021-03-09 17:18:12 +0100531 poll = pdch_ulc_get_node(ulc, fn);
Pau Espin Pedrol8318d9c2021-10-11 18:17:35 +0200532 if (!poll || poll->type != PDCH_ULC_NODE_TBF_POLL ||
533 poll->tbf_poll.reason != PDCH_ULC_POLL_DL_ACK) {
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100534 LOGPDCH(this, DRLCMAC, LOGL_NOTICE, "EGPRS PACKET DOWNLINK ACK with "
Max6dc90b82018-02-19 17:17:28 +0100535 "unknown FN=%u TFI=%d (TRX %d TS %d)\n",
536 fn, tfi, trx_no(), ts_no);
537 return;
538 }
Pau Espin Pedrole9db5c72021-09-28 16:38:05 +0200539 OSMO_ASSERT(poll->tbf_poll.poll_tbf);
Pau Espin Pedrol99360a32021-03-09 17:18:12 +0100540 tbf = as_dl_tbf(poll->tbf_poll.poll_tbf);
Pau Espin Pedrolb5fece92021-08-23 16:58:04 +0200541 if (tbf->tfi() != tfi) {
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100542 LOGPDCH(this, DRLCMAC, LOGL_NOTICE, "EGPRS PACKET DOWNLINK ACK with "
Max6dc90b82018-02-19 17:17:28 +0100543 "wrong TFI=%d, ignoring!\n", tfi);
544 return;
545 }
546
547 /* Reset N3101 counter: */
Max847ed9f2018-02-20 18:16:11 +0100548 tbf->n_reset(N3101);
Pau Espin Pedrol99360a32021-03-09 17:18:12 +0100549 pdch_ulc_release_fn(ulc, fn);
Max6dc90b82018-02-19 17:17:28 +0100550
551 LOGPTBF(tbf, LOGL_DEBUG,
552 "RX: [PCU <- BTS] EGPRS Packet Downlink Ack/Nack\n");
553
Pau Espin Pedrolb3f23972020-10-23 21:00:23 +0200554 window = static_cast<gprs_rlc_dl_window *>(tbf->window());
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100555 LOGPDCH(this, DRLCMAC, LOGL_DEBUG, "EGPRS ACK/NACK: "
Max6dc90b82018-02-19 17:17:28 +0100556 "ut: %d, final: %d, bow: %d, eow: %d, ssn: %d, have_crbb: %d, "
557 "urbb_len:%d, %p, %p, %d, %d, win: %d-%d, urbb: %s\n",
558 (int)ack_nack->EGPRS_AckNack.UnionType,
559 (int)ack_nack->EGPRS_AckNack.Desc.FINAL_ACK_INDICATION,
560 (int)ack_nack->EGPRS_AckNack.Desc.BEGINNING_OF_WINDOW,
561 (int)ack_nack->EGPRS_AckNack.Desc.END_OF_WINDOW,
562 (int)ack_nack->EGPRS_AckNack.Desc.STARTING_SEQUENCE_NUMBER,
563 (int)ack_nack->EGPRS_AckNack.Desc.Exist_CRBB,
564 (int)ack_nack->EGPRS_AckNack.Desc.URBB_LENGTH,
565 (void *)&ack_nack->EGPRS_AckNack.UnionType,
566 (void *)&ack_nack->EGPRS_AckNack.Desc,
567 (int)offsetof(EGPRS_AckNack_t, Desc),
568 (int)offsetof(EGPRS_AckNack_w_len_t, Desc),
Pau Espin Pedrolb3f23972020-10-23 21:00:23 +0200569 window->v_a(),
570 window->v_s(),
Max6dc90b82018-02-19 17:17:28 +0100571 osmo_hexdump((const uint8_t *)&ack_nack->EGPRS_AckNack.Desc.URBB,
572 sizeof(ack_nack->EGPRS_AckNack.Desc.URBB)));
573
574 bits.data = bits_data;
575 bits.data_len = sizeof(bits_data);
576 bits.cur_bit = 0;
577
578 num_blocks = Decoding::decode_egprs_acknack_bits(
579 &ack_nack->EGPRS_AckNack.Desc, &bits,
Pau Espin Pedrolb3f23972020-10-23 21:00:23 +0200580 &bsn_begin, &bsn_end, window);
Max6dc90b82018-02-19 17:17:28 +0100581
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100582 LOGPDCH(this, DRLCMAC, LOGL_DEBUG,
Max6dc90b82018-02-19 17:17:28 +0100583 "Got EGPRS DL ACK bitmap: SSN: %d, BSN %d to %d - 1 (%d blocks), "
584 "\"%s\"\n",
585 ack_nack->EGPRS_AckNack.Desc.STARTING_SEQUENCE_NUMBER,
586 bsn_begin, bsn_end, num_blocks,
587 (Decoding::extract_rbb(&bits, show_bits), show_bits)
588 );
589
590 rc = tbf->rcvd_dl_ack(
591 ack_nack->EGPRS_AckNack.Desc.FINAL_ACK_INDICATION,
592 bsn_begin, &bits);
593 if (rc == 1) {
594 tbf_free(tbf);
595 return;
596 }
597
598 /* check for channel request */
599 if (ack_nack->Exist_ChannelRequestDescription)
Pau Espin Pedrol0ece97d2021-01-18 12:53:54 +0100600 sched_ul_ass_or_rej(bts(), tbf);
Max6dc90b82018-02-19 17:17:28 +0100601
602 /* get measurements */
603 if (tbf->ms()) {
604 /* TODO: Implement Measurements parsing for EGPRS */
605 /*
Pau Espin Pedrole13cdc52019-09-25 13:46:14 +0200606 get_meas(meas, &ack_nack->Channel_Quality_Report);
607 tbf->ms()->update_l1_meas(meas);
Max6dc90b82018-02-19 17:17:28 +0100608 */
609 }
610}
611
Pau Espin Pedrole13cdc52019-09-25 13:46:14 +0200612void 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 +0100613{
614 struct gprs_rlcmac_sba *sba;
Pau Espin Pedrol7a2b65e2021-10-11 19:18:13 +0200615 int rc;
Max6dc90b82018-02-19 17:17:28 +0100616
617 if (request->ID.UnionType) {
Pau Espin Pedrol43479972021-04-22 19:18:13 +0200618 struct gprs_rlcmac_ul_tbf *ul_tbf = NULL;
619 struct pdch_ulc_node *item;
Max6dc90b82018-02-19 17:17:28 +0100620 uint32_t tlli = request->ID.u.TLLI;
Max6dc90b82018-02-19 17:17:28 +0100621
Pau Espin Pedrol2182e622021-01-14 16:48:38 +0100622 GprsMs *ms = bts_ms_by_tlli(bts(), tlli, GSM_RESERVED_TMSI);
Pau Espin Pedrolce600112020-05-12 19:20:10 +0200623 if (!ms) {
Pau Espin Pedrol2182e622021-01-14 16:48:38 +0100624 ms = bts_alloc_ms(bts(), 0, 0); /* ms class updated later */
Pau Espin Pedrolda971ee2020-12-16 15:59:45 +0100625 ms_set_tlli(ms, tlli);
Pau Espin Pedrolce600112020-05-12 19:20:10 +0200626 }
Pau Espin Pedrol17402a52020-05-08 17:44:33 +0200627
Max6dc90b82018-02-19 17:17:28 +0100628 /* Keep the ms, even if it gets idle temporarily */
Pau Espin Pedrolda971ee2020-12-16 15:59:45 +0100629 ms_ref(ms);
Max6dc90b82018-02-19 17:17:28 +0100630
Pau Espin Pedrol43479972021-04-22 19:18:13 +0200631 if (!(item = pdch_ulc_get_node(ulc, fn))) {
632 LOGPDCH(this, DRLCMAC, LOGL_NOTICE, "FN=%u PKT RESOURCE REQ: "
633 "UL block not reserved\n", fn);
634 goto return_unref;
635 }
636
637 switch (item->type) {
Pau Espin Pedrol201dbe02021-10-11 19:04:24 +0200638 case PDCH_ULC_NODE_TBF_USF:
639 /* Is it actually valid for an MS to send a PKT Res Req during USF? */
640 ul_tbf = item->tbf_usf.ul_tbf;
641 LOGPDCH(this, DRLCMAC, LOGL_NOTICE, "FN=%u PKT RESOURCE REQ: "
642 "Unexpectedly received, waiting USF of %s\n",
643 fn, tbf_name(item->tbf_usf.ul_tbf));
644 /* Ignore it, let common path expire related ULC entry */
645 goto return_unref;
Pau Espin Pedrol43479972021-04-22 19:18:13 +0200646 case PDCH_ULC_NODE_SBA:
647 sba = item->sba.sba;
648 LOGPDCH(this, DRLCMAC, LOGL_DEBUG, "FN=%u PKT RESOURCE REQ: "
649 "MS requests UL TBF throguh SBA\n", fn);
Pau Espin Pedrolda971ee2020-12-16 15:59:45 +0100650 ms_set_ta(ms, sba->ta);
Pau Espin Pedrol15c58ac2021-03-08 14:57:58 +0100651 sba_free(sba);
Pau Espin Pedrol43479972021-04-22 19:18:13 +0200652 break;
653 case PDCH_ULC_NODE_TBF_POLL:
654 if (item->tbf_poll.poll_tbf->direction != GPRS_RLCMAC_UL_TBF) {
655 LOGPDCH(this, DRLCMAC, LOGL_NOTICE, "FN=%u PKT RESOURCE REQ: "
656 "Unexpectedly received for DL TBF %s\n", fn,
657 tbf_name(item->tbf_poll.poll_tbf));
658 /* let common path expire the poll */
659 goto return_unref;
660 }
661 ul_tbf = (struct gprs_rlcmac_ul_tbf *)item->tbf_poll.poll_tbf;
662 if (item->tbf_poll.reason != PDCH_ULC_POLL_UL_ACK) {
663 LOGPDCH(this, DRLCMAC, LOGL_NOTICE, "FN=%u PKT RESOURCE REQ: "
664 "Unexpectedly received, waiting for poll reason %d\n",
665 fn, item->tbf_poll.reason);
666 /* let common path expire the poll */
667 goto return_unref;
668 }
669 if (ul_tbf != ms_ul_tbf(ms)) {
670 LOGPDCH(this, DRLCMAC, LOGL_NOTICE, "FN=%u PKT RESOURCE REQ: "
671 "Unexpected TLLI 0x%08x received vs exp 0x%08x\n",
672 fn, tlli, ul_tbf->tlli());
673 /* let common path expire the poll */
674 goto return_unref;
675 }
676 /* 3GPP TS 44.060 $ 9.3.3.3 */
677 LOGPTBFUL(ul_tbf, LOGL_DEBUG, "FN=%u PKT RESOURCE REQ: "
678 "MS requests reuse of finished UL TBF in RRBP "
679 "block of final UL ACK/NACK\n", fn);
680 ul_tbf->n_reset(N3103);
681 pdch_ulc_release_node(ulc, item);
Pau Espin Pedrol7a2b65e2021-10-11 19:18:13 +0200682 rc = osmo_fsm_inst_dispatch(ul_tbf->state_fsm.fi, TBF_EV_FINAL_UL_ACK_CONFIRMED, NULL);
683 if (rc) {
684 /* FSM failed handling, get rid of previous finished UL TBF before providing a new one */
685 LOGPTBFUL(ul_tbf, LOGL_NOTICE,
686 "Got PACKET RESOURCE REQ while TBF not finished, killing pending UL TBF\n");
687 tbf_free(ul_tbf);
688 } /* else: ul_tbf has been freed by state_fsm */
689 ul_tbf = NULL;
Pau Espin Pedrol43479972021-04-22 19:18:13 +0200690 break;
Pau Espin Pedrol43479972021-04-22 19:18:13 +0200691 default:
692 OSMO_ASSERT(0);
Max6dc90b82018-02-19 17:17:28 +0100693 }
Pau Espin Pedrol43479972021-04-22 19:18:13 +0200694
Pau Espin Pedrol7a2b65e2021-10-11 19:18:13 +0200695 /* Here ul_tbf is NULL:
696 * - SBA case: no previous TBF) and in
697 * - POLL case: PktResReq is a final ACk confirmation and ul_tbf was freed
698 */
Pau Espin Pedrol9e7361a2020-07-08 17:35:12 +0200699
Pau Espin Pedrole50ce6e2020-03-23 18:49:16 +0100700 if (request->Exist_MS_Radio_Access_capability2) {
Pau Espin Pedrol17402a52020-05-08 17:44:33 +0200701 uint8_t ms_class, egprs_ms_class;
Pau Espin Pedrol8a35e642021-01-18 17:14:14 +0100702 ms_class = get_ms_class_by_capability(&request->MS_Radio_Access_capability2);
703 egprs_ms_class = get_egprs_ms_class_by_capability(&request->MS_Radio_Access_capability2);
Pau Espin Pedrolbcb226d2020-07-08 17:18:22 +0200704 if (ms_class)
Pau Espin Pedrolda971ee2020-12-16 15:59:45 +0100705 ms_set_ms_class(ms, ms_class);
Pau Espin Pedrolbcb226d2020-07-08 17:18:22 +0200706 if (egprs_ms_class)
Pau Espin Pedrolda971ee2020-12-16 15:59:45 +0100707 ms_set_egprs_ms_class(ms, egprs_ms_class);
Max6dc90b82018-02-19 17:17:28 +0100708 }
Pau Espin Pedrol17402a52020-05-08 17:44:33 +0200709
Pau Espin Pedrol59223962021-10-18 12:24:38 +0200710 ul_tbf = tbf_alloc_ul_pacch(bts(), ms, trx_no());
Max6dc90b82018-02-19 17:17:28 +0100711 if (!ul_tbf) {
Pau Espin Pedrol54742f22021-04-26 16:48:34 +0200712 handle_tbf_reject(bts(), ms, trx_no(), ts_no);
Pau Espin Pedrolda971ee2020-12-16 15:59:45 +0100713 goto return_unref;
Max6dc90b82018-02-19 17:17:28 +0100714 }
715
Pau Espin Pedrolffe998c2021-10-12 19:32:28 +0200716 /* Set control TS to the TS where this PktResReq was received,
717 * which in practice happens to be the control_ts from the
718 * previous UL-TBF or SBA. When CTRL ACK is received as RRBP of the Pkt
719 * UL Ass scheduled below, then TBF_EV_ASSIGN_ACK_PACCH will be
720 * sent to tbf_fsm which will call tbf_assign_control_ts(),
721 * effectively setting back control_ts to
722 * tbf->initial_common_ts. */
Pau Espin Pedrol506eb232019-12-24 13:02:48 +0100723 LOGPTBF(ul_tbf, LOGL_DEBUG, "change control TS %d -> %d until assignment is complete.\n",
Max6dc90b82018-02-19 17:17:28 +0100724 ul_tbf->control_ts, ts_no);
725
726 ul_tbf->control_ts = ts_no;
727 /* schedule uplink assignment */
Pau Espin Pedrol6ad11a62021-07-27 12:27:08 +0200728 osmo_fsm_inst_dispatch(ul_tbf->ul_ass_fsm.fi, TBF_UL_ASS_EV_SCHED_ASS, NULL);
Max6dc90b82018-02-19 17:17:28 +0100729
Max6dc90b82018-02-19 17:17:28 +0100730 /* get measurements */
Pau Espin Pedrol43479972021-04-22 19:18:13 +0200731 get_meas(meas, request);
732 ms_update_l1_meas(ul_tbf->ms(), meas);
Pau Espin Pedrolda971ee2020-12-16 15:59:45 +0100733return_unref:
734 ms_unref(ms);
Max6dc90b82018-02-19 17:17:28 +0100735 return;
736 }
737
738 if (request->ID.u.Global_TFI.UnionType) {
739 struct gprs_rlcmac_dl_tbf *dl_tbf;
740 int8_t tfi = request->ID.u.Global_TFI.u.DOWNLINK_TFI;
Pau Espin Pedrol2182e622021-01-14 16:48:38 +0100741 dl_tbf = bts_dl_tbf_by_tfi(bts(), tfi, trx_no(), ts_no);
Max6dc90b82018-02-19 17:17:28 +0100742 if (!dl_tbf) {
Thorsten Alteholz8bb79042018-10-06 10:42:58 +0200743 LOGP(DRLCMAC, LOGL_NOTICE, "PACKET RESOURCE REQ unknown downlink TFI=%d\n", tfi);
Max6dc90b82018-02-19 17:17:28 +0100744 return;
745 }
746 LOGPTBFDL(dl_tbf, LOGL_ERROR,
747 "RX: [PCU <- BTS] FIXME: Packet resource request\n");
748
749 /* Reset N3101 counter: */
Max847ed9f2018-02-20 18:16:11 +0100750 dl_tbf->n_reset(N3101);
Max6dc90b82018-02-19 17:17:28 +0100751 } else {
752 struct gprs_rlcmac_ul_tbf *ul_tbf;
753 int8_t tfi = request->ID.u.Global_TFI.u.UPLINK_TFI;
Pau Espin Pedrol2182e622021-01-14 16:48:38 +0100754 ul_tbf = bts_ul_tbf_by_tfi(bts(), tfi, trx_no(), ts_no);
Max6dc90b82018-02-19 17:17:28 +0100755 if (!ul_tbf) {
Thorsten Alteholz8bb79042018-10-06 10:42:58 +0200756 LOGP(DRLCMAC, LOGL_NOTICE, "PACKET RESOURCE REQ unknown uplink TFI=%d\n", tfi);
Max6dc90b82018-02-19 17:17:28 +0100757 return;
758 }
759 LOGPTBFUL(ul_tbf, LOGL_ERROR,
760 "RX: [PCU <- BTS] FIXME: Packet resource request\n");
761
762 /* Reset N3101 counter: */
Max847ed9f2018-02-20 18:16:11 +0100763 ul_tbf->n_reset(N3101);
Max6dc90b82018-02-19 17:17:28 +0100764 }
765}
766
767void gprs_rlcmac_pdch::rcv_measurement_report(Packet_Measurement_Report_t *report, uint32_t fn)
768{
Pau Espin Pedrolb69928c2020-08-18 20:29:40 +0200769 struct gprs_rlcmac_sba *sba;
Pau Espin Pedrol99360a32021-03-09 17:18:12 +0100770 struct pdch_ulc_node *poll;
Pau Espin Pedrolb69928c2020-08-18 20:29:40 +0200771 GprsMs *ms;
Max6dc90b82018-02-19 17:17:28 +0100772
Pau Espin Pedrol2182e622021-01-14 16:48:38 +0100773 ms = bts_ms_by_tlli(bts(), report->TLLI, GSM_RESERVED_TMSI);
Pau Espin Pedrolb69928c2020-08-18 20:29:40 +0200774 if (!ms) {
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100775 LOGPDCH(this, DRLCMAC, LOGL_NOTICE, "MS send measurement "
776 "but TLLI 0x%08x is unknown\n", report->TLLI);
Pau Espin Pedrol2182e622021-01-14 16:48:38 +0100777 ms = bts_alloc_ms(bts(), 0, 0);
Pau Espin Pedrolda971ee2020-12-16 15:59:45 +0100778 ms_set_tlli(ms, report->TLLI);
Pau Espin Pedrolb69928c2020-08-18 20:29:40 +0200779 }
Pau Espin Pedrol99360a32021-03-09 17:18:12 +0100780 if ((poll = pdch_ulc_get_node(ulc, fn))) {
781 switch (poll->type) {
782 case PDCH_ULC_NODE_TBF_USF:
Pau Espin Pedrolc1f38c72021-03-24 14:06:15 +0100783 pdch_ulc_release_fn(ulc, fn);
Pau Espin Pedrol99360a32021-03-09 17:18:12 +0100784 break;
785 case PDCH_ULC_NODE_TBF_POLL:
786 LOGPDCH(this, DRLCMAC, LOGL_INFO, "FN=%" PRIu32 " Rx Meas Report "
787 "on RRBP POLL, this probably means a DL/CTRL ACK/NACk will "
788 "need to be polled again later\n", fn);
Pau Espin Pedrol99360a32021-03-09 17:18:12 +0100789 pdch_ulc_release_fn(ulc, fn);
790 break;
791 case PDCH_ULC_NODE_SBA:
792 sba = poll->sba.sba;
793 ms_set_ta(ms, sba->ta);
794 sba_free(sba);
795 break;
796 }
Max6dc90b82018-02-19 17:17:28 +0100797 }
Pau Espin Pedrolb69928c2020-08-18 20:29:40 +0200798 gprs_rlcmac_meas_rep(ms, report);
Max6dc90b82018-02-19 17:17:28 +0100799}
800
Pau Espin Pedrolc0a250d2021-01-21 18:46:13 +0100801void gprs_rlcmac_pdch::rcv_cell_change_notification(Packet_Cell_Change_Notification_t *notif,
802 uint32_t fn, struct pcu_l1_meas *meas)
803{
804 GprsMs *ms;
805
806 bts_do_rate_ctr_inc(bts(), CTR_PKT_CELL_CHG_NOTIFICATION);
807
808 if (notif->Global_TFI.UnionType == 0) {
809 struct gprs_rlcmac_ul_tbf *ul_tbf = ul_tbf_by_tfi(notif->Global_TFI.u.UPLINK_TFI);
810 if (!ul_tbf) {
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100811 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 +0100812 return;
813 }
814 ms = ul_tbf->ms();
815 } else if (notif->Global_TFI.UnionType == 1) {
816 struct gprs_rlcmac_dl_tbf *dl_tbf = dl_tbf_by_tfi(notif->Global_TFI.u.DOWNLINK_TFI);
817 if (!dl_tbf) {
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100818 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 +0100819 return;
820 }
821 ms = dl_tbf->ms();
822 } else { OSMO_ASSERT(0); }
823
Pau Espin Pedrol9a6f0b12021-03-24 14:05:04 +0100824 pdch_ulc_release_fn(ulc, fn);
825
Pau Espin Pedrolc0a250d2021-01-21 18:46:13 +0100826 ms_update_l1_meas(ms, meas);
827 ms_nacc_start(ms, notif);
828}
829
Max6dc90b82018-02-19 17:17:28 +0100830/* Received Uplink RLC control block. */
Pau Espin Pedrol812d4662019-09-25 13:35:11 +0200831int gprs_rlcmac_pdch::rcv_control_block(const uint8_t *data, uint8_t data_len,
Pau Espin Pedrol2ae83372020-05-18 11:35:35 +0200832 uint32_t fn, struct pcu_l1_meas *meas, enum CodingScheme cs)
Max6dc90b82018-02-19 17:17:28 +0100833{
Pau Espin Pedrol812d4662019-09-25 13:35:11 +0200834 bitvec *rlc_block;
835 RlcMacUplink_t *ul_control_block;
Pau Espin Pedrol2ae83372020-05-18 11:35:35 +0200836 unsigned len = mcs_max_bytes_ul(cs);
Pau Espin Pedrol5e300ce2020-02-03 17:18:03 +0100837 int rc;
Pau Espin Pedrol812d4662019-09-25 13:35:11 +0200838
839 if (!(rlc_block = bitvec_alloc(len, tall_pcu_ctx)))
840 return -ENOMEM;
841 bitvec_unpack(rlc_block, data);
842 ul_control_block = (RlcMacUplink_t *)talloc_zero(tall_pcu_ctx, RlcMacUplink_t);
843
Pau Espin Pedrol68bfdff2021-03-09 20:19:51 +0100844 LOGPDCH(this, DRLCMAC, LOGL_DEBUG, "FN=%u +++++++++++++++++++++++++ RX : Uplink Control Block +++++++++++++++++++++++++\n", fn);
Keith6fd8ffb2020-03-05 19:48:24 -0600845
Keith2b6acd82020-03-26 16:33:59 -0500846 rc = decode_gsm_rlcmac_uplink(rlc_block, ul_control_block);
Keith6fd8ffb2020-03-05 19:48:24 -0600847 if (ul_control_block->u.MESSAGE_TYPE == MT_PACKET_UPLINK_DUMMY_CONTROL_BLOCK)
Pau Espin Pedrol2182e622021-01-14 16:48:38 +0100848 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 -0600849 else
Pau Espin Pedrol2182e622021-01-14 16:48:38 +0100850 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 -0600851
Pau Espin Pedrol16705a42020-10-27 10:24:57 +0100852 if (rc < 0) {
Pau Espin Pedrol68bfdff2021-03-09 20:19:51 +0100853 LOGPDCH(this, DRLCMACUL, LOGL_ERROR, "FN=%u Dropping Uplink Control Block "
854 "with invalid content, decode failed: %d)\n", fn, rc);
Pau Espin Pedrol5e300ce2020-02-03 17:18:03 +0100855 goto free_ret;
856 }
Pau Espin Pedrol68bfdff2021-03-09 20:19:51 +0100857 LOGPDCH(this, DRLCMAC, LOGL_DEBUG, "FN=%u ------------------------- RX : Uplink Control Block -------------------------\n", fn);
Max6dc90b82018-02-19 17:17:28 +0100858
Pau Espin Pedrol2182e622021-01-14 16:48:38 +0100859 bts_do_rate_ctr_inc(bts(), CTR_RLC_RECV_CONTROL);
Max6dc90b82018-02-19 17:17:28 +0100860 switch (ul_control_block->u.MESSAGE_TYPE) {
861 case MT_PACKET_CONTROL_ACK:
862 rcv_control_ack(&ul_control_block->u.Packet_Control_Acknowledgement, fn);
863 break;
864 case MT_PACKET_DOWNLINK_ACK_NACK:
Pau Espin Pedrole13cdc52019-09-25 13:46:14 +0200865 rcv_control_dl_ack_nack(&ul_control_block->u.Packet_Downlink_Ack_Nack, fn, meas);
Max6dc90b82018-02-19 17:17:28 +0100866 break;
867 case MT_EGPRS_PACKET_DOWNLINK_ACK_NACK:
Pau Espin Pedrole13cdc52019-09-25 13:46:14 +0200868 rcv_control_egprs_dl_ack_nack(&ul_control_block->u.Egprs_Packet_Downlink_Ack_Nack, fn, meas);
Max6dc90b82018-02-19 17:17:28 +0100869 break;
870 case MT_PACKET_RESOURCE_REQUEST:
Pau Espin Pedrole13cdc52019-09-25 13:46:14 +0200871 rcv_resource_request(&ul_control_block->u.Packet_Resource_Request, fn, meas);
Max6dc90b82018-02-19 17:17:28 +0100872 break;
873 case MT_PACKET_MEASUREMENT_REPORT:
874 rcv_measurement_report(&ul_control_block->u.Packet_Measurement_Report, fn);
875 break;
876 case MT_PACKET_UPLINK_DUMMY_CONTROL_BLOCK:
877 /* ignoring it. change the SI to not force sending these? */
878 break;
Pau Espin Pedrolc0a250d2021-01-21 18:46:13 +0100879 case MT_PACKET_CELL_CHANGE_NOTIFICATION:
880 rcv_cell_change_notification(&ul_control_block->u.Packet_Cell_Change_Notification, fn, meas);
881 break;
Max6dc90b82018-02-19 17:17:28 +0100882 default:
Pau Espin Pedrol2182e622021-01-14 16:48:38 +0100883 bts_do_rate_ctr_inc(bts(), CTR_DECODE_ERRORS);
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100884 LOGPDCH(this, DRLCMAC, LOGL_NOTICE,
Pau Espin Pedrol68bfdff2021-03-09 20:19:51 +0100885 "FN=%u RX: [PCU <- BTS] unknown control block(%d) received\n",
886 fn, ul_control_block->u.MESSAGE_TYPE);
Max6dc90b82018-02-19 17:17:28 +0100887 }
Pau Espin Pedrol99360a32021-03-09 17:18:12 +0100888
Pau Espin Pedrol5e300ce2020-02-03 17:18:03 +0100889free_ret:
Max6dc90b82018-02-19 17:17:28 +0100890 talloc_free(ul_control_block);
Pau Espin Pedrol812d4662019-09-25 13:35:11 +0200891 bitvec_free(rlc_block);
Pau Espin Pedrol5e300ce2020-02-03 17:18:03 +0100892 return rc;
Max6dc90b82018-02-19 17:17:28 +0100893}
894
895/* received RLC/MAC block from L1 */
896int gprs_rlcmac_pdch::rcv_block(uint8_t *data, uint8_t len, uint32_t fn,
897 struct pcu_l1_meas *meas)
898{
Pau Espin Pedrol30617112021-03-05 18:59:05 +0100899 /* First of all, update TDMA clock: */
900 bts_set_current_frame_number(trx->bts, fn);
901
Pau Espin Pedrol3cba94d2021-03-05 18:54:01 +0100902 /* No successfully decoded UL block was received during this FN: */
Pau Espin Pedrol99360a32021-03-09 17:18:12 +0100903 if (len == 0)
Pau Espin Pedrol3cba94d2021-03-05 18:54:01 +0100904 return 0;
Pau Espin Pedrol3cba94d2021-03-05 18:54:01 +0100905
Pau Espin Pedrol2ae83372020-05-18 11:35:35 +0200906 enum CodingScheme cs = mcs_get_by_size_ul(len);
Max6dc90b82018-02-19 17:17:28 +0100907 if (!cs) {
Pau Espin Pedrol2182e622021-01-14 16:48:38 +0100908 bts_do_rate_ctr_inc(bts(), CTR_DECODE_ERRORS);
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100909 LOGPDCH(this, DRLCMACUL, LOGL_ERROR, "Dropping data block with invalid "
910 "length %d: %s\n", len, osmo_hexdump(data, len));
Max6dc90b82018-02-19 17:17:28 +0100911 return -EINVAL;
912 }
913
Pau Espin Pedrol2182e622021-01-14 16:48:38 +0100914 bts_do_rate_ctr_add(bts(), CTR_RLC_UL_BYTES, len);
Max6dc90b82018-02-19 17:17:28 +0100915
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100916 LOGPDCH(this, DRLCMACUL, LOGL_DEBUG, "Got RLC block, coding scheme: %s, "
Pau Espin Pedrol2ae83372020-05-18 11:35:35 +0200917 "length: %d (%d))\n", mcs_name(cs), len, mcs_used_size_ul(cs));
Max6dc90b82018-02-19 17:17:28 +0100918
Max8a8e0fb2019-03-25 16:32:50 +0100919 if (mcs_is_gprs(cs))
Max6dc90b82018-02-19 17:17:28 +0100920 return rcv_block_gprs(data, len, fn, meas, cs);
921
Max8a8e0fb2019-03-25 16:32:50 +0100922 if (mcs_is_edge(cs))
Max6dc90b82018-02-19 17:17:28 +0100923 return rcv_data_block(data, len, fn, meas, cs);
924
Pau Espin Pedrol2182e622021-01-14 16:48:38 +0100925 bts_do_rate_ctr_inc(bts(), CTR_DECODE_ERRORS);
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100926 LOGPDCH(this, DRLCMACUL, LOGL_ERROR, "Unsupported coding scheme %s\n",
Max136ebcc2019-03-05 14:59:03 +0100927 mcs_name(cs));
Max6dc90b82018-02-19 17:17:28 +0100928 return -EINVAL;
929}
930
931/*! \brief process egprs and gprs data blocks */
932int gprs_rlcmac_pdch::rcv_data_block(uint8_t *data, uint8_t data_len, uint32_t fn,
Pau Espin Pedrol2ae83372020-05-18 11:35:35 +0200933 struct pcu_l1_meas *meas, enum CodingScheme cs)
Max6dc90b82018-02-19 17:17:28 +0100934{
935 int rc;
936 struct gprs_rlc_data_info rlc_dec;
937 struct gprs_rlcmac_ul_tbf *tbf;
Pau Espin Pedrolc1f38c72021-03-24 14:06:15 +0100938 struct pdch_ulc_node *node;
Pau Espin Pedrol2ae83372020-05-18 11:35:35 +0200939 unsigned len = mcs_size_ul(cs);
Max6dc90b82018-02-19 17:17:28 +0100940
941 /* These are always data blocks, since EGPRS still uses CS-1 for
942 * control blocks (see 44.060, section 10.3, 1st par.)
943 */
Max8a8e0fb2019-03-25 16:32:50 +0100944 if (mcs_is_edge(cs)) {
Pau Espin Pedrol2182e622021-01-14 16:48:38 +0100945 bts_send_gsmtap_meas(bts(), PCU_GSMTAP_C_UL_DATA_EGPRS, true,
Pau Espin Pedrol0b0391f2020-05-19 17:23:23 +0200946 trx_no(), ts_no, GSMTAP_CHANNEL_PDTCH, fn,
947 data, data_len, meas);
Max6dc90b82018-02-19 17:17:28 +0100948 } else {
Pau Espin Pedrol2182e622021-01-14 16:48:38 +0100949 bts_send_gsmtap_meas(bts(), PCU_GSMTAP_C_UL_DATA_GPRS, true,
Pau Espin Pedrol0b0391f2020-05-19 17:23:23 +0200950 trx_no(), ts_no, GSMTAP_CHANNEL_PDTCH, fn,
951 data, data_len, meas);
Max6dc90b82018-02-19 17:17:28 +0100952 }
953
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100954 LOGPDCH(this, DRLCMACUL, LOGL_DEBUG, " UL data: %s\n", osmo_hexdump(data, len));
Max6dc90b82018-02-19 17:17:28 +0100955
956 rc = Decoding::rlc_parse_ul_data_header(&rlc_dec, data, cs);
957 if (rc < 0) {
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100958 LOGPDCH(this, DRLCMACUL, LOGL_ERROR,
Max6dc90b82018-02-19 17:17:28 +0100959 "Got %s RLC block but header parsing has failed\n",
Max136ebcc2019-03-05 14:59:03 +0100960 mcs_name(cs));
Pau Espin Pedrol2182e622021-01-14 16:48:38 +0100961 bts_do_rate_ctr_inc(bts(), CTR_DECODE_ERRORS);
Max6dc90b82018-02-19 17:17:28 +0100962 return rc;
963 }
964
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100965 LOGPDCH(this, DRLCMACUL, LOGL_INFO,
Max6dc90b82018-02-19 17:17:28 +0100966 "Got %s RLC block: "
967 "R=%d, SI=%d, TFI=%d, CPS=%d, RSB=%d, "
968 "rc=%d\n",
Max136ebcc2019-03-05 14:59:03 +0100969 mcs_name(cs),
Max6dc90b82018-02-19 17:17:28 +0100970 rlc_dec.r, rlc_dec.si, rlc_dec.tfi, rlc_dec.cps, rlc_dec.rsb,
971 rc);
972
973 /* find TBF inst from given TFI */
974 tbf = ul_tbf_by_tfi(rlc_dec.tfi);
975 if (!tbf) {
Pau Espin Pedrol95e22662021-02-25 17:49:30 +0100976 LOGPDCH(this, DRLCMACUL, LOGL_NOTICE, "UL DATA unknown TFI=%d\n",
Max6dc90b82018-02-19 17:17:28 +0100977 rlc_dec.tfi);
978 return 0;
979 }
980
Pau Espin Pedrolc1f38c72021-03-24 14:06:15 +0100981 node = pdch_ulc_get_node(ulc, fn);
982 if (node) {
983 switch (node->type) {
984 case PDCH_ULC_NODE_TBF_USF:
Pau Espin Pedrolffa29182021-10-12 20:05:37 +0200985 if (tbf == node->tbf_usf.ul_tbf)
986 pdch_ulc_release_node(ulc, node);
987 else
Pau Espin Pedrolc1f38c72021-03-24 14:06:15 +0100988 LOGPDCH(this, DRLCMACUL, LOGL_NOTICE, "FN=%" PRIu32 " "
989 "Rx UL DATA from unexpected %s vs expected %s\n",
990 fn, tbf_name(tbf), tbf_name(node->tbf_usf.ul_tbf));
991 break;
992 case PDCH_ULC_NODE_TBF_POLL:
993 LOGPDCH(this, DRLCMACUL, LOGL_NOTICE, "FN=%" PRIu32 " "
Pau Espin Pedrol196f36b2021-10-18 12:37:51 +0200994 "Rx UL DATA from unexpected %s vs expected POLL %s reason=%s\n",
995 fn, tbf_name(tbf), tbf_name(node->tbf_poll.poll_tbf),
996 get_value_string(pdch_ulc_tbf_poll_reason_names, node->tbf_poll.reason));
Pau Espin Pedrolc1f38c72021-03-24 14:06:15 +0100997 break;
998 case PDCH_ULC_NODE_SBA:
999 LOGPDCH(this, DRLCMACUL, LOGL_NOTICE, "FN=%" PRIu32 " "
1000 "Rx UL DATA from unexpected %s vs expected SBA\n",
1001 fn, tbf_name(tbf));
1002 break;
1003 }
Pau Espin Pedrolc1f38c72021-03-24 14:06:15 +01001004 } else {
1005 LOGPDCH(this, DRLCMACUL, LOGL_NOTICE, "FN=%" PRIu32 " "
1006 "Rx UL DATA from unexpected %s\n", fn, tbf_name(tbf));
1007 }
1008
Max6dc90b82018-02-19 17:17:28 +01001009 /* Reset N3101 counter: */
Max847ed9f2018-02-20 18:16:11 +01001010 tbf->n_reset(N3101);
Max6dc90b82018-02-19 17:17:28 +01001011
1012 return tbf->rcv_data_block_acknowledged(&rlc_dec, data, meas);
1013}
1014
1015int gprs_rlcmac_pdch::rcv_block_gprs(uint8_t *data, uint8_t data_len, uint32_t fn,
Pau Espin Pedrol2ae83372020-05-18 11:35:35 +02001016 struct pcu_l1_meas *meas, enum CodingScheme cs)
Max6dc90b82018-02-19 17:17:28 +01001017{
1018 unsigned payload = data[0] >> 6;
Max6dc90b82018-02-19 17:17:28 +01001019 int rc = 0;
Max6dc90b82018-02-19 17:17:28 +01001020
1021 switch (payload) {
1022 case GPRS_RLCMAC_DATA_BLOCK:
1023 rc = rcv_data_block(data, data_len, fn, meas, cs);
1024 break;
1025 case GPRS_RLCMAC_CONTROL_BLOCK:
Pau Espin Pedrole13cdc52019-09-25 13:46:14 +02001026 rc = rcv_control_block(data, data_len, fn, meas, cs);
Max6dc90b82018-02-19 17:17:28 +01001027 break;
1028 case GPRS_RLCMAC_CONTROL_BLOCK_OPT:
Pau Espin Pedrol95e22662021-02-25 17:49:30 +01001029 LOGPDCH(this, DRLCMAC, LOGL_NOTICE, "GPRS_RLCMAC_CONTROL_BLOCK_OPT block payload is not supported.\n");
Max6dc90b82018-02-19 17:17:28 +01001030 break;
1031 default:
Pau Espin Pedrol95e22662021-02-25 17:49:30 +01001032 LOGPDCH(this, DRLCMAC, LOGL_NOTICE, "Unknown RLCMAC block payload(%u).\n", payload);
Max6dc90b82018-02-19 17:17:28 +01001033 rc = -EINVAL;
1034 }
1035
1036 return rc;
1037}
1038
1039gprs_rlcmac_tbf *gprs_rlcmac_pdch::tbf_from_list_by_tfi(
1040 LListHead<gprs_rlcmac_tbf> *tbf_list, uint8_t tfi,
1041 enum gprs_rlcmac_tbf_direction dir)
1042{
1043 gprs_rlcmac_tbf *tbf;
1044 LListHead<gprs_rlcmac_tbf> *pos;
1045
1046 llist_for_each(pos, tbf_list) {
1047 tbf = pos->entry();
1048 if (tbf->tfi() != tfi)
1049 continue;
1050 if (!tbf->pdch[ts_no])
1051 continue;
1052 return tbf;
1053 }
1054 return NULL;
1055}
1056
1057gprs_rlcmac_ul_tbf *gprs_rlcmac_pdch::ul_tbf_by_tfi(uint8_t tfi)
1058{
1059 return as_ul_tbf(tbf_by_tfi(tfi, GPRS_RLCMAC_UL_TBF));
1060}
1061
1062gprs_rlcmac_dl_tbf *gprs_rlcmac_pdch::dl_tbf_by_tfi(uint8_t tfi)
1063{
1064 return as_dl_tbf(tbf_by_tfi(tfi, GPRS_RLCMAC_DL_TBF));
1065}
1066
1067/* lookup TBF Entity (by TFI) */
1068gprs_rlcmac_tbf *gprs_rlcmac_pdch::tbf_by_tfi(uint8_t tfi,
1069 enum gprs_rlcmac_tbf_direction dir)
1070{
1071 struct gprs_rlcmac_tbf *tbf;
1072
1073 if (tfi >= 32)
1074 return NULL;
1075
1076 tbf = m_tbfs[dir][tfi];
1077
Pau Espin Pedrol710e0e92021-04-22 21:03:33 +02001078 return tbf;
Max6dc90b82018-02-19 17:17:28 +01001079}
1080
Oliver Smith402451b2021-09-08 09:33:24 +02001081void gprs_rlcmac_pdch::num_tbfs_update(gprs_rlcmac_tbf *tbf, bool is_attach)
1082{
1083 int threshold = is_attach ? 0 : 1;
1084 int inc = is_attach ? 1 : -1;
1085 uint8_t ul_dl_gprs = m_num_tbfs_gprs[GPRS_RLCMAC_UL_TBF] +
1086 m_num_tbfs_gprs[GPRS_RLCMAC_DL_TBF];
1087 uint8_t ul_dl_egprs = m_num_tbfs_egprs[GPRS_RLCMAC_UL_TBF] +
1088 m_num_tbfs_egprs[GPRS_RLCMAC_DL_TBF];
1089
1090 /* Count PDCHs with at least one TBF as "occupied", as in
1091 * 3GPP TS 52.402 § B.2.1.42-44. So if transitioning from 0 (threshold)
1092 * TBFs in this PDCH to 1, increase the counter by 1 (inc). */
1093 if (ul_dl_gprs + ul_dl_egprs == threshold)
1094 bts_stat_item_add(trx->bts, STAT_PDCH_OCCUPIED, inc);
1095
1096 /* Update occupied GPRS/EGPRS stats (§ B.2.1.54-55) too */
1097 if (tbf->is_egprs_enabled() && ul_dl_egprs == threshold)
1098 bts_stat_item_add(trx->bts, STAT_PDCH_OCCUPIED_EGPRS, inc);
1099 else if (!tbf->is_egprs_enabled() && ul_dl_gprs == threshold)
1100 bts_stat_item_add(trx->bts, STAT_PDCH_OCCUPIED_GPRS, inc);
1101
1102 if (tbf->is_egprs_enabled())
1103 m_num_tbfs_egprs[tbf->direction] += inc;
1104 else
1105 m_num_tbfs_gprs[tbf->direction] += inc;
1106}
1107
Max6dc90b82018-02-19 17:17:28 +01001108void gprs_rlcmac_pdch::attach_tbf(gprs_rlcmac_tbf *tbf)
1109{
1110 gprs_rlcmac_ul_tbf *ul_tbf;
1111
1112 if (m_tbfs[tbf->direction][tbf->tfi()])
Pau Espin Pedrol95e22662021-02-25 17:49:30 +01001113 LOGPDCH(this, DRLCMAC, LOGL_ERROR,
Max6dc90b82018-02-19 17:17:28 +01001114 "%s has not been detached, overwriting it\n",
Max6dc90b82018-02-19 17:17:28 +01001115 m_tbfs[tbf->direction][tbf->tfi()]->name());
1116
Oliver Smith402451b2021-09-08 09:33:24 +02001117 num_tbfs_update(tbf, true);
Pau Espin Pedrolb5fece92021-08-23 16:58:04 +02001118 if (tbf->direction == GPRS_RLCMAC_UL_TBF) {
1119 ul_tbf = as_ul_tbf(tbf);
Max6dc90b82018-02-19 17:17:28 +01001120 m_assigned_usf |= 1 << ul_tbf->m_usf[ts_no];
1121 }
1122 m_assigned_tfi[tbf->direction] |= 1UL << tbf->tfi();
1123 m_tbfs[tbf->direction][tbf->tfi()] = tbf;
1124
Pau Espin Pedrol95e22662021-02-25 17:49:30 +01001125 LOGPDCH(this, DRLCMAC, LOGL_INFO, "Attaching %s, %d TBFs, "
Max6dc90b82018-02-19 17:17:28 +01001126 "USFs = %02x, TFIs = %08x.\n",
Oliver Smith402451b2021-09-08 09:33:24 +02001127 tbf->name(), num_tbfs(tbf->direction),
Max6dc90b82018-02-19 17:17:28 +01001128 m_assigned_usf, m_assigned_tfi[tbf->direction]);
1129}
1130
1131void gprs_rlcmac_pdch::detach_tbf(gprs_rlcmac_tbf *tbf)
1132{
1133 gprs_rlcmac_ul_tbf *ul_tbf;
1134
Oliver Smith402451b2021-09-08 09:33:24 +02001135 if (tbf->is_egprs_enabled()) {
1136 OSMO_ASSERT(m_num_tbfs_egprs[tbf->direction] > 0);
1137 } else {
1138 OSMO_ASSERT(m_num_tbfs_gprs[tbf->direction] > 0);
1139 }
Max6dc90b82018-02-19 17:17:28 +01001140
Oliver Smith402451b2021-09-08 09:33:24 +02001141 num_tbfs_update(tbf, false);
Pau Espin Pedrolb5fece92021-08-23 16:58:04 +02001142 if (tbf->direction == GPRS_RLCMAC_UL_TBF) {
1143 ul_tbf = as_ul_tbf(tbf);
Max6dc90b82018-02-19 17:17:28 +01001144 m_assigned_usf &= ~(1 << ul_tbf->m_usf[ts_no]);
1145 }
1146 m_assigned_tfi[tbf->direction] &= ~(1UL << tbf->tfi());
1147 m_tbfs[tbf->direction][tbf->tfi()] = NULL;
1148
Pau Espin Pedrol99360a32021-03-09 17:18:12 +01001149 pdch_ulc_release_tbf(ulc, tbf);
1150
Pau Espin Pedrol95e22662021-02-25 17:49:30 +01001151 LOGPDCH(this, DRLCMAC, LOGL_INFO, "Detaching %s, %d TBFs, "
Max6dc90b82018-02-19 17:17:28 +01001152 "USFs = %02x, TFIs = %08x.\n",
Oliver Smith402451b2021-09-08 09:33:24 +02001153 tbf->name(), num_tbfs(tbf->direction),
Max6dc90b82018-02-19 17:17:28 +01001154 m_assigned_usf, m_assigned_tfi[tbf->direction]);
1155}
1156
Pau Espin Pedrol22862882020-11-16 17:35:10 +01001157bool gprs_rlcmac_pdch::has_gprs_only_tbf_attached() const
1158{
Oliver Smithfce67bc2021-09-08 11:36:03 +02001159 return (m_num_tbfs_gprs[GPRS_RLCMAC_UL_TBF] +
1160 m_num_tbfs_gprs[GPRS_RLCMAC_DL_TBF]) > 0;
Pau Espin Pedrol22862882020-11-16 17:35:10 +01001161}
1162
Max6dc90b82018-02-19 17:17:28 +01001163void gprs_rlcmac_pdch::reserve(enum gprs_rlcmac_tbf_direction dir)
1164{
1165 m_num_reserved[dir] += 1;
1166}
1167
1168void gprs_rlcmac_pdch::unreserve(enum gprs_rlcmac_tbf_direction dir)
1169{
1170 OSMO_ASSERT(m_num_reserved[dir] > 0);
1171 m_num_reserved[dir] -= 1;
1172}
1173
Pau Espin Pedrol2182e622021-01-14 16:48:38 +01001174inline struct gprs_rlcmac_bts *gprs_rlcmac_pdch::bts() const
Max6dc90b82018-02-19 17:17:28 +01001175{
1176 return trx->bts;
1177}
1178
1179uint8_t gprs_rlcmac_pdch::trx_no() const
1180{
1181 return trx->trx_no;
1182}
1183
Vadim Yanitskiybd0dac32019-10-05 21:57:14 +07001184uint8_t gprs_rlcmac_pdch::reserve_tai(uint8_t ta)
1185{
1186 uint8_t tai;
1187
1188 for (tai = 0; tai < PTCCH_TAI_NUM; tai++) {
1189 if (ptcch_msg[tai] == PTCCH_TAI_FREE) {
1190 ptcch_msg[tai] = ta;
1191 return tai;
1192 }
1193 }
1194
1195 /* Special case: no free TAI available */
1196 return PTCCH_TAI_FREE;
1197}
1198
1199void gprs_rlcmac_pdch::release_tai(uint8_t tai)
1200{
1201 OSMO_ASSERT(tai < PTCCH_TAI_NUM);
1202 ptcch_msg[tai] = PTCCH_TAI_FREE;
1203}
1204
1205void gprs_rlcmac_pdch::update_ta(uint8_t tai, uint8_t ta)
1206{
1207 OSMO_ASSERT(tai < PTCCH_TAI_NUM);
1208 ptcch_msg[tai] = ta;
1209}
Pau Espin Pedrol906aafc2021-01-18 17:53:29 +01001210
1211void pdch_free_all_tbf(struct gprs_rlcmac_pdch *pdch)
1212{
Pau Espin Pedrol1d663d92021-09-03 12:39:26 +02001213 struct llist_item *pos;
1214 struct llist_item *pos2;
1215
Pau Espin Pedrol906aafc2021-01-18 17:53:29 +01001216 for (uint8_t tfi = 0; tfi < 32; tfi++) {
1217 struct gprs_rlcmac_tbf *tbf;
1218
1219 tbf = pdch->ul_tbf_by_tfi(tfi);
1220 if (tbf)
1221 tbf_free(tbf);
1222 tbf = pdch->dl_tbf_by_tfi(tfi);
1223 if (tbf)
1224 tbf_free(tbf);
1225 }
Pau Espin Pedrol1d663d92021-09-03 12:39:26 +02001226
1227 /* Some temporary dummy TBFs to tx ImmAssRej may be left linked to the
1228 * PDCH, since they have no TFI assigned (see handle_tbf_reject()).
1229 * Get rid of them too: */
1230 llist_for_each_entry_safe(pos, pos2, &pdch->trx->ul_tbfs, list) {
1231 struct gprs_rlcmac_ul_tbf *ul_tbf = as_ul_tbf((struct gprs_rlcmac_tbf *)pos->entry);
1232 if (ul_tbf->control_ts == pdch->ts_no)
1233 tbf_free(ul_tbf);
1234 }
Pau Espin Pedrol906aafc2021-01-18 17:53:29 +01001235}
Pau Espin Pedrole91c4c72021-01-18 17:54:30 +01001236
Pau Espin Pedrol4f67a9b2021-06-30 16:03:06 +02001237void pdch_disable(struct gprs_rlcmac_pdch *pdch)
1238{
Pau Espin Pedrole91c4c72021-01-18 17:54:30 +01001239 pdch->disable();
1240}
Pau Espin Pedrol4f67a9b2021-06-30 16:03:06 +02001241
1242bool pdch_is_enabled(const struct gprs_rlcmac_pdch *pdch)
1243{
1244 return pdch->is_enabled();
1245}