blob: 5cdac5f587d97f208e7eb391fdcbc1148638ba58 [file] [log] [blame]
Daniel Willmannca102af2014-08-08 12:14:12 +02001/* Copied from tbf.cpp
2 *
3 * Copyright (C) 2012 Ivan Klyuchnikov
4 * Copyright (C) 2012 Andreas Eversberg <jolly@eversberg.eu>
5 * Copyright (C) 2013 by Holger Hans Peter Freyther
6 *
7 * This program is free software; you can redistribute it and/or
8 * modify it under the terms of the GNU General Public License
9 * as published by the Free Software Foundation; either version 2
10 * of the License, or (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 General Public License
18 * along with this program; if not, write to the Free Software
19 * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
20 */
21
22#include <bts.h>
23#include <tbf.h>
24#include <rlc.h>
25#include <gprs_rlcmac.h>
26#include <gprs_debug.h>
27#include <gprs_bssgp_pcu.h>
28#include <decoding.h>
29
Jacob Erlbeck3bed5d12015-03-19 11:22:38 +010030#include "pcu_utils.h"
31
Daniel Willmannca102af2014-08-08 12:14:12 +020032extern "C" {
33#include <osmocom/core/msgb.h>
34#include <osmocom/core/talloc.h>
35}
36
37#include <errno.h>
38#include <string.h>
39
40/* After sending these frames, we poll for ack/nack. */
41#define POLL_ACK_AFTER_FRAMES 20
42
43
44static const struct gprs_rlcmac_cs gprs_rlcmac_cs[] = {
45/* frame length data block max payload */
46 { 0, 0, 0 },
47 { 23, 23, 20 }, /* CS-1 */
48 { 34, 33, 30 }, /* CS-2 */
49 { 40, 39, 36 }, /* CS-3 */
50 { 54, 53, 50 }, /* CS-4 */
51};
52
53extern "C" {
54int bssgp_tx_llc_discarded(struct bssgp_bvc_ctx *bctx, uint32_t tlli,
55 uint8_t num_frames, uint32_t num_octets);
56}
57
58static inline void tbf_update_ms_class(struct gprs_rlcmac_tbf *tbf,
59 const uint8_t ms_class)
60{
61 if (!tbf->ms_class && ms_class)
62 tbf->ms_class = ms_class;
63}
64
Jacob Erlbeckd0261b72015-04-02 13:58:09 +020065static void llc_timer_cb(void *_tbf)
66{
67 struct gprs_rlcmac_dl_tbf *tbf = (struct gprs_rlcmac_dl_tbf *)_tbf;
68
69 if (tbf->state_is_not(GPRS_RLCMAC_FLOW))
70 return;
71
72 LOGP(DRLCMAC, LOGL_DEBUG,
73 "%s LLC receive timeout, requesting DL ACK\n", tbf_name(tbf));
74
75 tbf->request_dl_ack();
76}
77
78void gprs_rlcmac_dl_tbf::cleanup()
79{
80 osmo_timer_del(&m_llc_timer);
81}
82
83void gprs_rlcmac_dl_tbf::start_llc_timer()
84{
85 if (bts_data()->llc_idle_ack_csec > 0) {
86 struct timeval tv;
87
88 /* TODO: this ought to be within a constructor */
89 m_llc_timer.data = this;
90 m_llc_timer.cb = &llc_timer_cb;
91
92 csecs_to_timeval(bts_data()->llc_idle_ack_csec, &tv);
93 osmo_timer_schedule(&m_llc_timer, tv.tv_sec, tv.tv_usec);
94 }
95}
96
Daniel Willmannca102af2014-08-08 12:14:12 +020097int gprs_rlcmac_dl_tbf::append_data(const uint8_t ms_class,
98 const uint16_t pdu_delay_csec,
99 const uint8_t *data, const uint16_t len)
100{
101 LOGP(DRLCMAC, LOGL_INFO, "%s append\n", tbf_name(this));
102 if (state_is(GPRS_RLCMAC_WAIT_RELEASE)) {
103 LOGP(DRLCMAC, LOGL_DEBUG,
104 "%s in WAIT RELEASE state "
105 "(T3193), so reuse TBF\n", tbf_name(this));
106 tbf_update_ms_class(this, ms_class);
107 reuse_tbf(data, len);
Jacob Erlbeckc4952092015-03-24 11:04:19 +0100108 } else if (!have_data()) {
109 m_llc.put_frame(data, len);
110 bts->llc_frame_sched();
Jacob Erlbeck3bed5d12015-03-19 11:22:38 +0100111 /* it is no longer drained */
112 m_last_dl_drained_fn = -1;
Jacob Erlbeckc4952092015-03-24 11:04:19 +0100113 tbf_update_ms_class(this, ms_class);
Jacob Erlbeckd0261b72015-04-02 13:58:09 +0200114 start_llc_timer();
Daniel Willmannca102af2014-08-08 12:14:12 +0200115 } else {
Jacob Erlbeckd0261b72015-04-02 13:58:09 +0200116 /* TODO: put this path into an llc_enqueue method */
Daniel Willmannca102af2014-08-08 12:14:12 +0200117 /* the TBF exists, so we must write it in the queue
118 * we prepend lifetime in front of PDU */
119 struct timeval *tv;
120 struct msgb *llc_msg = msgb_alloc(len + sizeof(*tv) * 2,
121 "llc_pdu_queue");
122 if (!llc_msg)
123 return -ENOMEM;
124 tv = (struct timeval *)msgb_put(llc_msg, sizeof(*tv));
125 gprs_llc::calc_pdu_lifetime(bts, pdu_delay_csec, tv);
126 tv = (struct timeval *)msgb_put(llc_msg, sizeof(*tv));
127 gettimeofday(tv, NULL);
128 memcpy(msgb_put(llc_msg, len), data, len);
129 m_llc.enqueue(llc_msg);
130 tbf_update_ms_class(this, ms_class);
Jacob Erlbeckd0261b72015-04-02 13:58:09 +0200131 start_llc_timer();
Daniel Willmannca102af2014-08-08 12:14:12 +0200132 }
133
134 return 0;
135}
136
137static struct gprs_rlcmac_dl_tbf *tbf_lookup_dl(BTS *bts,
138 const uint32_t tlli, const char *imsi)
139{
Jacob Erlbecke43460b2015-05-13 13:33:12 +0200140 GprsMs *ms = bts->ms_store().get_ms(tlli, 0, imsi);
141 if (!ms)
142 return NULL;
143
144 return ms->dl_tbf();
Daniel Willmannca102af2014-08-08 12:14:12 +0200145}
146
147static int tbf_new_dl_assignment(struct gprs_rlcmac_bts *bts,
148 const char *imsi,
149 const uint32_t tlli, const uint8_t ms_class,
150 const uint8_t *data, const uint16_t len)
151{
152 uint8_t trx, ta, ss;
153 int8_t use_trx;
Jacob Erlbecke43460b2015-05-13 13:33:12 +0200154 struct gprs_rlcmac_ul_tbf *ul_tbf = NULL, *old_ul_tbf;
Jacob Erlbeck90de3a72015-04-09 19:18:59 +0200155 struct gprs_rlcmac_dl_tbf *dl_tbf = NULL;
Daniel Willmannca102af2014-08-08 12:14:12 +0200156 int8_t tfi; /* must be signed */
157 int rc;
Jacob Erlbecke43460b2015-05-13 13:33:12 +0200158 GprsMs *ms;
Daniel Willmannca102af2014-08-08 12:14:12 +0200159
160 /* check for uplink data, so we copy our informations */
161#warning "Do the same look up for IMSI, TLLI and OLD_TLLI"
162#warning "Refactor the below lines... into a new method"
Jacob Erlbecke43460b2015-05-13 13:33:12 +0200163 ms = bts->bts->ms_store().get_ms(tlli, 0, imsi);
164 if (ms)
165 ul_tbf = ms->ul_tbf();
166
Daniel Willmannca102af2014-08-08 12:14:12 +0200167 if (ul_tbf && ul_tbf->m_contention_resolution_done
168 && !ul_tbf->m_final_ack_sent) {
169 use_trx = ul_tbf->trx->trx_no;
170 ta = ul_tbf->ta;
171 ss = 0;
172 old_ul_tbf = ul_tbf;
173 } else {
174 use_trx = -1;
175 /* we already have an uplink TBF, so we use that TA */
176 if (ul_tbf)
177 ta = ul_tbf->ta;
178 else {
179 /* recall TA */
180 rc = bts->bts->timing_advance()->recall(tlli);
181 if (rc < 0) {
182 LOGP(DRLCMAC, LOGL_NOTICE, "TA unknown"
183 ", assuming 0\n");
184 ta = 0;
185 } else
186 ta = rc;
187 }
188 ss = 1; /* PCH assignment only allows one timeslot */
189 old_ul_tbf = NULL;
190 }
191
192 // Create new TBF (any TRX)
193#warning "Copy and paste with alloc_ul_tbf"
194 tfi = bts->bts->tfi_find_free(GPRS_RLCMAC_DL_TBF, &trx, use_trx);
Jacob Erlbeck90de3a72015-04-09 19:18:59 +0200195 if (tfi >= 0)
196 /* set number of downlink slots according to multislot class */
197 dl_tbf = tbf_alloc_dl_tbf(bts, ul_tbf, tfi, trx, ms_class, ss);
198
Daniel Willmannca102af2014-08-08 12:14:12 +0200199 if (!dl_tbf) {
200 LOGP(DRLCMAC, LOGL_NOTICE, "No PDCH resource\n");
Jacob Erlbeck90de3a72015-04-09 19:18:59 +0200201 bssgp_tx_llc_discarded(gprs_bssgp_pcu_current_bctx(), tlli,
202 1, len);
Jacob Erlbeck29d91e92015-04-29 14:46:52 +0200203 bts->bts->llc_dropped_frame();
Daniel Willmannca102af2014-08-08 12:14:12 +0200204 return -EBUSY;
205 }
206 dl_tbf->m_tlli = tlli;
207 dl_tbf->m_tlli_valid = 1;
208 dl_tbf->ta = ta;
Jacob Erlbeckfecece02015-05-08 12:13:08 +0200209 dl_tbf->update_ms(tlli);
Daniel Willmannca102af2014-08-08 12:14:12 +0200210
211 LOGP(DRLCMAC, LOGL_DEBUG, "%s [DOWNLINK] START\n", tbf_name(dl_tbf));
212
213 /* new TBF, so put first frame */
214 dl_tbf->m_llc.put_frame(data, len);
215 dl_tbf->bts->llc_frame_sched();
216
217 /* Store IMSI for later look-up and PCH retransmission */
218 dl_tbf->assign_imsi(imsi);
219
220 /* trigger downlink assignment and set state to ASSIGN.
221 * we don't use old_downlink, so the possible uplink is used
222 * to trigger downlink assignment. if there is no uplink,
223 * AGCH is used. */
224 dl_tbf->bts->trigger_dl_ass(dl_tbf, old_ul_tbf, imsi);
225 return 0;
226}
227
228/**
229 * TODO: split into unit test-able parts...
230 */
231int gprs_rlcmac_dl_tbf::handle(struct gprs_rlcmac_bts *bts,
232 const uint32_t tlli, const char *imsi,
233 const uint8_t ms_class, const uint16_t delay_csec,
234 const uint8_t *data, const uint16_t len)
235{
236 struct gprs_rlcmac_dl_tbf *dl_tbf;
237
238 /* check for existing TBF */
239 dl_tbf = tbf_lookup_dl(bts->bts, tlli, imsi);
240 if (dl_tbf) {
241 int rc = dl_tbf->append_data(ms_class, delay_csec, data, len);
242 if (rc >= 0)
243 dl_tbf->assign_imsi(imsi);
244 return rc;
245 }
246
247 return tbf_new_dl_assignment(bts, imsi, tlli, ms_class, data, len);
248}
249
250struct msgb *gprs_rlcmac_dl_tbf::llc_dequeue(bssgp_bvc_ctx *bctx)
251{
252 struct msgb *msg;
Jacob Erlbeck6e4ccec2015-05-06 14:24:36 +0200253 struct timeval *tv_recv, *tv_disc;
254 struct timeval tv_now, tv_now2;
Daniel Willmannca102af2014-08-08 12:14:12 +0200255 uint32_t octets = 0, frames = 0;
Jacob Erlbeck0c1c8772015-03-20 12:02:42 +0100256 struct timeval hyst_delta = {0, 0};
257 const unsigned keep_small_thresh = 60;
258
259 if (bts_data()->llc_discard_csec)
260 csecs_to_timeval(bts_data()->llc_discard_csec, &hyst_delta);
Daniel Willmannca102af2014-08-08 12:14:12 +0200261
262 gettimeofday(&tv_now, NULL);
Jacob Erlbeck0c1c8772015-03-20 12:02:42 +0100263 timeradd(&tv_now, &hyst_delta, &tv_now2);
Daniel Willmannca102af2014-08-08 12:14:12 +0200264
265 while ((msg = m_llc.dequeue())) {
Jacob Erlbeck6e4ccec2015-05-06 14:24:36 +0200266 tv_disc = (struct timeval *)msg->data;
267 msgb_pull(msg, sizeof(*tv_disc));
268 tv_recv = (struct timeval *)msg->data;
269 msgb_pull(msg, sizeof(*tv_recv));
270
271 gprs_bssgp_update_queue_delay(tv_recv, &tv_now);
Daniel Willmannca102af2014-08-08 12:14:12 +0200272
Jacob Erlbeck0c1c8772015-03-20 12:02:42 +0100273 /* Is the age below the low water mark? */
Jacob Erlbeck6e4ccec2015-05-06 14:24:36 +0200274 if (!gprs_llc::is_frame_expired(&tv_now2, tv_disc))
Jacob Erlbeck0c1c8772015-03-20 12:02:42 +0100275 break;
276
277 /* Is the age below the high water mark */
Jacob Erlbeck6e4ccec2015-05-06 14:24:36 +0200278 if (!gprs_llc::is_frame_expired(&tv_now, tv_disc)) {
Jacob Erlbeck0c1c8772015-03-20 12:02:42 +0100279 /* Has the previous message not been dropped? */
280 if (frames == 0)
281 break;
282
283 /* Hysteresis mode, try to discard LLC messages until
284 * the low water mark has been reached */
285
286 /* Check whether to abort the hysteresis mode */
287
288 /* Is the frame small, perhaps only a TCP ACK? */
289 if (msg->len <= keep_small_thresh)
290 break;
291
292 /* Is it a GMM message? */
293 if (!gprs_llc::is_user_data_frame(msg->data, msg->len))
294 break;
Daniel Willmannca102af2014-08-08 12:14:12 +0200295 }
Jacob Erlbeck0c1c8772015-03-20 12:02:42 +0100296
297 bts->llc_timedout_frame();
298 frames++;
299 octets += msg->len;
300 msgb_free(msg);
Jacob Erlbeck29d91e92015-04-29 14:46:52 +0200301 bts->llc_dropped_frame();
Jacob Erlbeck0c1c8772015-03-20 12:02:42 +0100302 continue;
Daniel Willmannca102af2014-08-08 12:14:12 +0200303 }
304
305 if (frames) {
Jacob Erlbeck0c1c8772015-03-20 12:02:42 +0100306 LOGP(DRLCMACDL, LOGL_NOTICE, "%s Discarding LLC PDU "
307 "because lifetime limit reached, "
308 "count=%u new_queue_size=%zu\n",
309 tbf_name(this), frames, m_llc.m_queue_size);
Daniel Willmannca102af2014-08-08 12:14:12 +0200310 if (frames > 0xff)
311 frames = 0xff;
312 if (octets > 0xffffff)
313 octets = 0xffffff;
314 bssgp_tx_llc_discarded(bctx, m_tlli, frames, octets);
315 }
316
317 return msg;
318}
319
320/*
321 * Create DL data block
322 * The messages are fragmented and forwarded as data blocks.
323 */
324struct msgb *gprs_rlcmac_dl_tbf::create_dl_acked_block(uint32_t fn, uint8_t ts)
325{
326 LOGP(DRLCMACDL, LOGL_DEBUG, "%s downlink (V(A)==%d .. "
327 "V(S)==%d)\n", tbf_name(this),
328 m_window.v_a(), m_window.v_s());
329
330do_resend:
331 /* check if there is a block with negative acknowledgement */
332 int resend_bsn = m_window.resend_needed();
333 if (resend_bsn >= 0) {
334 LOGP(DRLCMACDL, LOGL_DEBUG, "- Resending BSN %d\n", resend_bsn);
335 /* re-send block with negative aknowlegement */
336 m_window.m_v_b.mark_unacked(resend_bsn);
337 bts->rlc_resent();
Jacob Erlbeck7c444152015-03-12 12:08:54 +0100338 return create_dl_acked_block(fn, ts, resend_bsn);
Daniel Willmannca102af2014-08-08 12:14:12 +0200339 }
340
341 /* if the window has stalled, or transfer is complete,
342 * send an unacknowledged block */
Jacob Erlbeck95340242015-03-19 13:22:07 +0100343 if (state_is(GPRS_RLCMAC_FINISHED)) {
344 LOGP(DRLCMACDL, LOGL_DEBUG, "- Restarting at BSN %d, "
345 "because all blocks have been transmitted.\n",
346 m_window.v_a());
347 bts->rlc_restarted();
348 } else if (dl_window_stalled()) {
349 LOGP(DRLCMACDL, LOGL_NOTICE, "- Restarting at BSN %d, "
350 "because all window is stalled.\n",
351 m_window.v_a());
352 bts->rlc_stalled();
Jacob Erlbecke25b5b92015-03-19 14:21:33 +0100353 } else if (have_data()) {
354 /* New blocks may be send */
355 return create_new_bsn(fn, ts);
356 } else if (!m_window.window_empty()) {
357 LOGP(DRLCMACDL, LOGL_DEBUG, "- Restarting at BSN %d, "
358 "because all blocks have been transmitted (FLOW).\n",
359 m_window.v_a());
360 bts->rlc_restarted();
Jacob Erlbeck95340242015-03-19 13:22:07 +0100361 } else {
Jacob Erlbecke25b5b92015-03-19 14:21:33 +0100362 /* Nothing left to send, create dummy LLC commands */
Jacob Erlbeck95340242015-03-19 13:22:07 +0100363 return create_new_bsn(fn, ts);
Daniel Willmannca102af2014-08-08 12:14:12 +0200364 }
365
Jacob Erlbeck95340242015-03-19 13:22:07 +0100366 /* If V(S) == V(A) and finished state, we would have received
367 * acknowledgement of all transmitted block. In this case we
368 * would have transmitted the final block, and received ack
369 * from MS. But in this case we did not receive the final ack
370 * indication from MS. This should never happen if MS works
371 * correctly. */
372 if (m_window.window_empty()) {
373 LOGP(DRLCMACDL, LOGL_DEBUG, "- MS acked all blocks, "
374 "so we re-transmit final block!\n");
375 /* we just send final block again */
376 int16_t index = m_window.v_s_mod(-1);
377 bts->rlc_resent();
378 return create_dl_acked_block(fn, ts, index);
379 }
380
381 /* cycle through all unacked blocks */
382 int resend = m_window.mark_for_resend();
383
384 /* At this point there should be at least one unacked block
385 * to be resent. If not, this is an software error. */
386 if (resend == 0) {
387 LOGP(DRLCMACDL, LOGL_ERROR, "Software error: "
388 "There are no unacknowledged blocks, but V(A) "
389 " != V(S). PLEASE FIX!\n");
390 /* we just send final block again */
391 int16_t index = m_window.v_s_mod(-1);
392 return create_dl_acked_block(fn, ts, index);
393 }
394 goto do_resend;
Daniel Willmannca102af2014-08-08 12:14:12 +0200395}
396
397struct msgb *gprs_rlcmac_dl_tbf::create_new_bsn(const uint32_t fn, const uint8_t ts)
398{
399 struct rlc_dl_header *rh;
400 struct rlc_li_field *li;
401 struct msgb *msg;
402 uint8_t *delimiter, *data, *e_pointer;
403 uint16_t space, chunk;
404 gprs_rlc_data *rlc_data;
Daniel Willmannca102af2014-08-08 12:14:12 +0200405 const uint16_t bsn = m_window.v_s();
406
407 LOGP(DRLCMACDL, LOGL_DEBUG, "- Sending new block at BSN %d\n",
408 m_window.v_s());
409
410#warning "Selection of the CS doesn't belong here"
411 if (cs == 0) {
412 cs = bts_data()->initial_cs_dl;
413 if (cs < 1 || cs > 4)
414 cs = 1;
415 }
416 /* total length of block, including spare bits */
417 const uint8_t block_length = gprs_rlcmac_cs[cs].block_length;
418 /* length of usable data of block, w/o spare bits, inc. MAC */
419 const uint8_t block_data_len = gprs_rlcmac_cs[cs].block_data;
420
421 /* now we still have untransmitted LLC data, so we fill mac block */
422 rlc_data = m_rlc.block(bsn);
423 data = rlc_data->prepare(block_data_len);
424
425 rh = (struct rlc_dl_header *)data;
426 rh->pt = 0; /* Data Block */
427 rh->rrbp = rh->s_p = 0; /* Polling, set later, if required */
428 rh->usf = 7; /* will be set at scheduler */
429 rh->pr = 0; /* FIXME: power reduction */
430 rh->tfi = m_tfi; /* TFI */
431 rh->fbi = 0; /* Final Block Indicator, set late, if true */
432 rh->bsn = bsn; /* Block Sequence Number */
433 rh->e = 0; /* Extension bit, maybe set later */
434 e_pointer = data + 2; /* points to E of current chunk */
435 data += sizeof(*rh);
436 delimiter = data; /* where next length header would be stored */
437 space = block_data_len - sizeof(*rh);
438 while (1) {
Jacob Erlbeckcbb1e702015-03-25 12:21:55 +0100439 if (m_llc.frame_length() == 0) {
440 /* A header will need to by added, so we just need
441 * space-1 octets */
442 m_llc.put_dummy_frame(space - 1);
443
Jacob Erlbeck3bed5d12015-03-19 11:22:38 +0100444 /* The data just drained, store the current fn */
445 if (m_last_dl_drained_fn < 0)
446 m_last_dl_drained_fn = fn;
447
Jacob Erlbeckcbb1e702015-03-25 12:21:55 +0100448 /* It is not clear, when the next real data will
449 * arrive, so request a DL ack/nack now */
450 request_dl_ack();
451
452 LOGP(DRLCMACDL, LOGL_DEBUG,
453 "-- Empty chunk, "
Jacob Erlbeck3bed5d12015-03-19 11:22:38 +0100454 "added LLC dummy command of size %d, "
455 "drained_since=%d\n",
456 m_llc.frame_length(), frames_since_last_drain(fn));
Jacob Erlbeckcbb1e702015-03-25 12:21:55 +0100457 }
458
Daniel Willmannca102af2014-08-08 12:14:12 +0200459 chunk = m_llc.chunk_size();
Jacob Erlbeckcbb1e702015-03-25 12:21:55 +0100460
Daniel Willmannca102af2014-08-08 12:14:12 +0200461 /* if chunk will exceed block limit */
462 if (chunk > space) {
463 LOGP(DRLCMACDL, LOGL_DEBUG, "-- Chunk with length %d "
464 "larger than space (%d) left in block: copy "
465 "only remaining space, and we are done\n",
466 chunk, space);
467 /* block is filled, so there is no extension */
468 *e_pointer |= 0x01;
469 /* fill only space */
470 m_llc.consume(data, space);
471 /* return data block as message */
472 break;
473 }
474 /* if FINAL chunk would fit precisely in space left */
Jacob Erlbeck3bed5d12015-03-19 11:22:38 +0100475 if (chunk == space && llist_empty(&m_llc.queue) && !keep_open(fn))
476 {
Daniel Willmannca102af2014-08-08 12:14:12 +0200477 LOGP(DRLCMACDL, LOGL_DEBUG, "-- Chunk with length %d "
478 "would exactly fit into space (%d): because "
479 "this is a final block, we don't add length "
480 "header, and we are done\n", chunk, space);
481 LOGP(DRLCMACDL, LOGL_INFO, "Complete DL frame for "
482 "%s that fits precisely in last block: "
483 "len=%d\n", tbf_name(this), m_llc.frame_length());
484 gprs_rlcmac_dl_bw(this, m_llc.frame_length());
485 /* block is filled, so there is no extension */
486 *e_pointer |= 0x01;
487 /* fill space */
488 m_llc.consume(data, space);
489 m_llc.reset();
490 /* final block */
491 rh->fbi = 1; /* we indicate final block */
Jacob Erlbeck7c444152015-03-12 12:08:54 +0100492 request_dl_ack();
Daniel Willmannca102af2014-08-08 12:14:12 +0200493 set_state(GPRS_RLCMAC_FINISHED);
494 /* return data block as message */
495 break;
496 }
497 /* if chunk would fit exactly in space left */
498 if (chunk == space) {
499 LOGP(DRLCMACDL, LOGL_DEBUG, "-- Chunk with length %d "
500 "would exactly fit into space (%d): add length "
501 "header with LI=0, to make frame extend to "
502 "next block, and we are done\n", chunk, space);
503 /* make space for delimiter */
504 if (delimiter != data)
505 memmove(delimiter + 1, delimiter,
506 data - delimiter);
507 data++;
508 space--;
509 /* add LI with 0 length */
510 li = (struct rlc_li_field *)delimiter;
511 li->e = 1; /* not more extension */
512 li->m = 0; /* shall be set to 0, in case of li = 0 */
513 li->li = 0; /* chunk fills the complete space */
514 // no need to set e_pointer nor increase delimiter
515 /* fill only space, which is 1 octet less than chunk */
516 m_llc.consume(data, space);
517 /* return data block as message */
518 break;
519 }
Jacob Erlbeck3bed5d12015-03-19 11:22:38 +0100520
Daniel Willmannca102af2014-08-08 12:14:12 +0200521 LOGP(DRLCMACDL, LOGL_DEBUG, "-- Chunk with length %d is less "
522 "than remaining space (%d): add length header to "
523 "to delimit LLC frame\n", chunk, space);
524 /* the LLC frame chunk ends in this block */
525 /* make space for delimiter */
526 if (delimiter != data)
527 memmove(delimiter + 1, delimiter, data - delimiter);
528 data++;
529 space--;
530 /* add LI to delimit frame */
531 li = (struct rlc_li_field *)delimiter;
532 li->e = 0; /* Extension bit, maybe set later */
533 li->m = 0; /* will be set later, if there is more LLC data */
534 li->li = chunk; /* length of chunk */
535 e_pointer = delimiter; /* points to E of current delimiter */
536 delimiter++;
537 /* copy (rest of) LLC frame to space and reset later */
538 m_llc.consume(data, chunk);
539 data += chunk;
540 space -= chunk;
541 LOGP(DRLCMACDL, LOGL_INFO, "Complete DL frame for %s"
542 "len=%d\n", tbf_name(this), m_llc.frame_length());
543 gprs_rlcmac_dl_bw(this, m_llc.frame_length());
544 m_llc.reset();
545 /* dequeue next LLC frame, if any */
546 msg = llc_dequeue(gprs_bssgp_pcu_current_bctx());
547 if (msg) {
548 LOGP(DRLCMACDL, LOGL_INFO, "- Dequeue next LLC for "
549 "%s (len=%d)\n", tbf_name(this), msg->len);
550 m_llc.put_frame(msg->data, msg->len);
551 bts->llc_frame_sched();
552 msgb_free(msg);
Jacob Erlbeck3bed5d12015-03-19 11:22:38 +0100553 m_last_dl_drained_fn = -1;
Daniel Willmannca102af2014-08-08 12:14:12 +0200554 }
555 /* if we have more data and we have space left */
Jacob Erlbeck3bed5d12015-03-19 11:22:38 +0100556 if (space > 0 && (m_llc.frame_length() || keep_open(fn))) {
Daniel Willmannca102af2014-08-08 12:14:12 +0200557 li->m = 1; /* we indicate more frames to follow */
558 continue;
559 }
560 /* if we don't have more LLC frames */
Jacob Erlbeck3bed5d12015-03-19 11:22:38 +0100561 if (!m_llc.frame_length() && !keep_open(fn)) {
Daniel Willmannca102af2014-08-08 12:14:12 +0200562 LOGP(DRLCMACDL, LOGL_DEBUG, "-- Final block, so we "
563 "done.\n");
564 li->e = 1; /* we cannot extend */
Jacob Erlbeck3bed5d12015-03-19 11:22:38 +0100565
Daniel Willmannca102af2014-08-08 12:14:12 +0200566 rh->fbi = 1; /* we indicate final block */
Jacob Erlbeck7c444152015-03-12 12:08:54 +0100567 request_dl_ack();
Daniel Willmannca102af2014-08-08 12:14:12 +0200568 set_state(GPRS_RLCMAC_FINISHED);
569 break;
570 }
571 /* we have no space left */
572 LOGP(DRLCMACDL, LOGL_DEBUG, "-- No space left, so we are "
573 "done.\n");
574 li->e = 1; /* we cannot extend */
575 break;
576 }
577 LOGP(DRLCMACDL, LOGL_DEBUG, "data block: %s\n",
578 osmo_hexdump(rlc_data->block, block_length));
579#warning "move this up?"
580 rlc_data->len = block_length;
581 /* raise send state and set ack state array */
582 m_window.m_v_b.mark_unacked(bsn);
583 m_window.increment_send();
584
Jacob Erlbeck7c444152015-03-12 12:08:54 +0100585 return create_dl_acked_block(fn, ts, bsn);
586}
587
Daniel Willmannca102af2014-08-08 12:14:12 +0200588struct msgb *gprs_rlcmac_dl_tbf::create_dl_acked_block(
589 const uint32_t fn, const uint8_t ts,
Jacob Erlbeck7c444152015-03-12 12:08:54 +0100590 const int index)
Daniel Willmannca102af2014-08-08 12:14:12 +0200591{
592 uint8_t *data;
593 struct rlc_dl_header *rh;
594 struct msgb *dl_msg;
595 uint8_t len;
Daniel Willmannefd5dbb2014-08-25 16:20:23 +0200596 bool need_poll;
Daniel Willmannca102af2014-08-08 12:14:12 +0200597
598 /* get data and header from current block */
599 data = m_rlc.block(index)->block;
600 len = m_rlc.block(index)->len;
601 rh = (struct rlc_dl_header *)data;
602
Jacob Erlbeck005ee7f2015-03-20 14:53:54 +0100603 /* If the TBF has just started, relate frames_since_last_poll to the
604 * current fn */
605 if (m_last_dl_poll_fn < 0)
606 m_last_dl_poll_fn = fn;
607
Daniel Willmannefd5dbb2014-08-25 16:20:23 +0200608 need_poll = state_flags & (1 << GPRS_RLCMAC_FLAG_TO_DL_ACK);
Daniel Willmannca102af2014-08-08 12:14:12 +0200609 /* Clear Polling, if still set in history buffer */
610 rh->s_p = 0;
611
612 /* poll after POLL_ACK_AFTER_FRAMES frames, or when final block is tx.
613 */
Jacob Erlbeck7c444152015-03-12 12:08:54 +0100614 if (m_tx_counter >= POLL_ACK_AFTER_FRAMES || m_dl_ack_requested ||
Daniel Willmannefd5dbb2014-08-25 16:20:23 +0200615 need_poll) {
Jacob Erlbeck7c444152015-03-12 12:08:54 +0100616 if (m_dl_ack_requested) {
Daniel Willmannca102af2014-08-08 12:14:12 +0200617 LOGP(DRLCMACDL, LOGL_DEBUG, "- Scheduling Ack/Nack "
Jacob Erlbeck7c444152015-03-12 12:08:54 +0100618 "polling, because is was requested explicitly "
619 "(e.g. first final block sent).\n");
Daniel Willmannefd5dbb2014-08-25 16:20:23 +0200620 } else if (need_poll) {
621 LOGP(DRLCMACDL, LOGL_DEBUG, "- Scheduling Ack/Nack "
Daniel Willmann635d47c2014-09-17 17:58:29 +0200622 "polling, because polling timed out.\n");
Daniel Willmannca102af2014-08-08 12:14:12 +0200623 } else {
624 LOGP(DRLCMACDL, LOGL_DEBUG, "- Scheduling Ack/Nack "
625 "polling, because %d blocks sent.\n",
626 POLL_ACK_AFTER_FRAMES);
627 }
628 /* scheduling not possible, because: */
629 if (poll_state != GPRS_RLCMAC_POLL_NONE)
630 LOGP(DRLCMACDL, LOGL_DEBUG, "Polling is already "
631 "sheduled for %s, so we must wait for "
632 "requesting downlink ack\n", tbf_name(this));
633 else if (control_ts != ts)
634 LOGP(DRLCMACDL, LOGL_DEBUG, "Polling cannot be "
635 "sheduled in this TS %d, waiting for "
636 "TS %d\n", ts, control_ts);
Daniel Willmannca102af2014-08-08 12:14:12 +0200637 else if (bts->sba()->find(trx->trx_no, ts, (fn + 13) % 2715648))
638 LOGP(DRLCMACDL, LOGL_DEBUG, "Polling cannot be "
639 "sheduled, because single block alllocation "
640 "already exists\n");
641 else {
642 LOGP(DRLCMACDL, LOGL_DEBUG, "Polling sheduled in this "
643 "TS %d\n", ts);
644 m_tx_counter = 0;
645 /* start timer whenever we send the final block */
646 if (rh->fbi == 1)
647 tbf_timer_start(this, 3191, bts_data()->t3191, 0);
648
649 /* schedule polling */
650 poll_state = GPRS_RLCMAC_POLL_SCHED;
651 poll_fn = (fn + 13) % 2715648;
652
Daniel Willmannefd5dbb2014-08-25 16:20:23 +0200653 /* Clear poll timeout flag */
654 state_flags &= ~(1 << GPRS_RLCMAC_FLAG_TO_DL_ACK);
655
Jacob Erlbeck7c444152015-03-12 12:08:54 +0100656 /* Clear request flag */
657 m_dl_ack_requested = false;
658
Daniel Willmannca102af2014-08-08 12:14:12 +0200659 /* set polling in header */
660 rh->rrbp = 0; /* N+13 */
661 rh->s_p = 1; /* Polling */
Jacob Erlbeck005ee7f2015-03-20 14:53:54 +0100662
663 m_last_dl_poll_fn = poll_fn;
Daniel Willmannca102af2014-08-08 12:14:12 +0200664 }
665 }
666
667 /* return data block as message */
668 dl_msg = msgb_alloc(len, "rlcmac_dl_data");
669 if (!dl_msg)
670 return NULL;
671
672 /* Increment TX-counter */
673 m_tx_counter++;
674
675 memcpy(msgb_put(dl_msg, len), data, len);
676 bts->rlc_sent();
677
678 return dl_msg;
679}
680
681int gprs_rlcmac_dl_tbf::update_window(const uint8_t ssn, const uint8_t *rbb)
682{
683 int16_t dist; /* must be signed */
684 uint16_t lost = 0, received = 0;
685 char show_rbb[65];
686 char show_v_b[RLC_MAX_SNS + 1];
687 const uint16_t mod_sns = m_window.mod_sns();
688
689 Decoding::extract_rbb(rbb, show_rbb);
690 /* show received array in debug (bit 64..1) */
691 LOGP(DRLCMACDL, LOGL_DEBUG, "- ack: (BSN=%d)\"%s\""
692 "(BSN=%d) R=ACK I=NACK\n", (ssn - 64) & mod_sns,
693 show_rbb, (ssn - 1) & mod_sns);
694
695 /* apply received array to receive state (SSN-64..SSN-1) */
696 /* calculate distance of ssn from V(S) */
697 dist = (m_window.v_s() - ssn) & mod_sns;
698 /* check if distance is less than distance V(A)..V(S) */
699 if (dist >= m_window.distance()) {
700 /* this might happpen, if the downlink assignment
701 * was not received by ms and the ack refers
702 * to previous TBF
703 * FIXME: we should implement polling for
704 * control ack!*/
705 LOGP(DRLCMACDL, LOGL_NOTICE, "- ack range is out of "
706 "V(A)..V(S) range %s Free TBF!\n", tbf_name(this));
707 return 1; /* indicate to free TBF */
708 }
709
710 m_window.update(bts, show_rbb, ssn,
711 &lost, &received);
712
713 /* report lost and received packets */
714 gprs_rlcmac_received_lost(this, received, lost);
715
716 /* raise V(A), if possible */
717 m_window.raise(m_window.move_window());
718
719 /* show receive state array in debug (V(A)..V(S)-1) */
720 m_window.show_state(show_v_b);
721 LOGP(DRLCMACDL, LOGL_DEBUG, "- V(B): (V(A)=%d)\"%s\""
722 "(V(S)-1=%d) A=Acked N=Nacked U=Unacked "
723 "X=Resend-Unacked I=Invalid\n",
724 m_window.v_a(), show_v_b,
725 m_window.v_s_mod(-1));
726
727 if (state_is(GPRS_RLCMAC_FINISHED) && m_window.window_empty()) {
728 LOGP(DRLCMACDL, LOGL_NOTICE, "Received acknowledge of "
729 "all blocks, but without final ack "
730 "inidcation (don't worry)\n");
731 }
732 return 0;
733}
734
735
736int gprs_rlcmac_dl_tbf::maybe_start_new_window()
737{
738 struct msgb *msg;
739 uint16_t received;
740
741 LOGP(DRLCMACDL, LOGL_DEBUG, "- Final ACK received.\n");
742 /* range V(A)..V(S)-1 */
743 received = m_window.count_unacked();
744
745 /* report all outstanding packets as received */
746 gprs_rlcmac_received_lost(this, received, 0);
747
748 set_state(GPRS_RLCMAC_WAIT_RELEASE);
749
750 /* check for LLC PDU in the LLC Queue */
751 msg = llc_dequeue(gprs_bssgp_pcu_current_bctx());
752 if (!msg) {
753 /* no message, start T3193, change state to RELEASE */
754 LOGP(DRLCMACDL, LOGL_DEBUG, "- No new message, so we release.\n");
755 /* start T3193 */
756 tbf_timer_start(this, 3193,
757 bts_data()->t3193_msec / 1000,
758 (bts_data()->t3193_msec % 1000) * 1000);
759
760 return 0;
761 }
762
763 /* we have more data so we will re-use this tbf */
764 reuse_tbf(msg->data, msg->len);
765 msgb_free(msg);
766 return 0;
767}
768
769int gprs_rlcmac_dl_tbf::rcvd_dl_ack(uint8_t final_ack, uint8_t ssn, uint8_t *rbb)
770{
771 LOGP(DRLCMACDL, LOGL_DEBUG, "%s downlink acknowledge\n", tbf_name(this));
772
773 if (!final_ack)
774 return update_window(ssn, rbb);
775 return maybe_start_new_window();
776}
777
778void gprs_rlcmac_dl_tbf::reuse_tbf(const uint8_t *data, const uint16_t len)
779{
Daniel Willmanne4818152014-08-15 16:52:09 +0200780 uint8_t trx;
Jacob Erlbeck90de3a72015-04-09 19:18:59 +0200781 struct gprs_rlcmac_dl_tbf *new_tbf = NULL;
Daniel Willmanne4818152014-08-15 16:52:09 +0200782 int8_t tfi; /* must be signed */
Daniel Willmanne4818152014-08-15 16:52:09 +0200783 struct msgb *msg;
784
Daniel Willmannca102af2014-08-08 12:14:12 +0200785 bts->tbf_reused();
Daniel Willmanne4818152014-08-15 16:52:09 +0200786
787 tfi = bts->tfi_find_free(GPRS_RLCMAC_DL_TBF, &trx, this->trx->trx_no);
Jacob Erlbeck90de3a72015-04-09 19:18:59 +0200788 if (tfi >= 0)
789 new_tbf = tbf_alloc_dl_tbf(bts->bts_data(), NULL, tfi, trx,
790 ms_class, 0);
791
Daniel Willmanne4818152014-08-15 16:52:09 +0200792 if (!new_tbf) {
793 LOGP(DRLCMAC, LOGL_NOTICE, "No PDCH resource\n");
Jacob Erlbeck90de3a72015-04-09 19:18:59 +0200794 bssgp_tx_llc_discarded(gprs_bssgp_pcu_current_bctx(), m_tlli,
795 1, len);
Jacob Erlbeck29d91e92015-04-29 14:46:52 +0200796 bts->llc_dropped_frame();
Daniel Willmanne4818152014-08-15 16:52:09 +0200797 return;
798 }
799
800 new_tbf->m_tlli = m_tlli;
801 new_tbf->m_tlli_valid = m_tlli_valid;
802 new_tbf->ta = ta;
803 new_tbf->assign_imsi(m_imsi);
Jacob Erlbeckfecece02015-05-08 12:13:08 +0200804 new_tbf->update_ms(m_tlli);
Daniel Willmanne4818152014-08-15 16:52:09 +0200805
806 /* Copy over all data to the new TBF */
807 new_tbf->m_llc.put_frame(data, len);
Daniel Willmannca102af2014-08-08 12:14:12 +0200808 bts->llc_frame_sched();
809
Daniel Willmanne4818152014-08-15 16:52:09 +0200810 while ((msg = m_llc.dequeue()))
811 new_tbf->m_llc.enqueue(msg);
812
Daniel Willmannca102af2014-08-08 12:14:12 +0200813 /* reset rlc states */
814 m_tx_counter = 0;
815 m_wait_confirm = 0;
816 m_window.reset();
817
Jacob Erlbeck297edf72015-02-26 14:59:52 +0100818 /* mark TLLI as invalid */
819 m_tlli_valid = 0;
820
Daniel Willmannca102af2014-08-08 12:14:12 +0200821 /* keep to flags */
822 state_flags &= GPRS_RLCMAC_FLAG_TO_MASK;
823 state_flags &= ~(1 << GPRS_RLCMAC_FLAG_CCCH);
824
825 update();
826
827 LOGP(DRLCMAC, LOGL_DEBUG, "%s Trigger dowlink assignment on PACCH, "
828 "because another LLC PDU has arrived in between\n",
829 tbf_name(this));
Daniel Willmanne4818152014-08-15 16:52:09 +0200830 bts->trigger_dl_ass(new_tbf, this, NULL);
Daniel Willmannca102af2014-08-08 12:14:12 +0200831}
832
833bool gprs_rlcmac_dl_tbf::dl_window_stalled() const
834{
835 return m_window.window_stalled();
836}
837
Jacob Erlbeckeceb9102015-03-20 14:41:50 +0100838void gprs_rlcmac_dl_tbf::request_dl_ack()
839{
840 m_dl_ack_requested = true;
841}
842
843bool gprs_rlcmac_dl_tbf::need_control_ts() const
844{
845 if (poll_state != GPRS_RLCMAC_POLL_NONE)
846 return false;
847
848 return state_flags & (1 << GPRS_RLCMAC_FLAG_TO_DL_ACK) ||
849 m_tx_counter >= POLL_ACK_AFTER_FRAMES ||
850 m_dl_ack_requested;
851}
852
853bool gprs_rlcmac_dl_tbf::have_data() const
854{
855 return m_llc.chunk_size() > 0 || !llist_empty(&m_llc.queue);
856}
Jacob Erlbeck005ee7f2015-03-20 14:53:54 +0100857
858int gprs_rlcmac_dl_tbf::frames_since_last_poll(unsigned fn) const
859{
860 unsigned wrapped;
861 if (m_last_dl_poll_fn < 0)
862 return -1;
863
864 wrapped = (fn + 2715648 - m_last_dl_poll_fn) % 2715648;
865 if (wrapped < 2715648/2)
866 return wrapped;
867 else
868 return wrapped - 2715648;
869}
870
Jacob Erlbeck3bed5d12015-03-19 11:22:38 +0100871int gprs_rlcmac_dl_tbf::frames_since_last_drain(unsigned fn) const
872{
873 unsigned wrapped;
874 if (m_last_dl_drained_fn < 0)
875 return -1;
876
877 wrapped = (fn + 2715648 - m_last_dl_drained_fn) % 2715648;
878 if (wrapped < 2715648/2)
879 return wrapped;
880 else
881 return wrapped - 2715648;
882}
883
884bool gprs_rlcmac_dl_tbf::keep_open(unsigned fn) const
885{
886 int keep_time_frames;
887
888 if (bts_data()->dl_tbf_idle_msec <= 0)
889 return false;
890
891 keep_time_frames = msecs_to_frames(bts_data()->dl_tbf_idle_msec);
892 return frames_since_last_drain(fn) <= keep_time_frames;
893}