blob: 7240e1fcf49141916d05fdec892f37de310ecab0 [file] [log] [blame]
Holger Hans Peter Freyther17c31ce2013-08-24 18:31:27 +02001/* Copied from gprs_bssgp_pcu.cpp
2 *
3 * Copyright (C) 2012 Ivan Klyuchnikov
Holger Hans Peter Freyther86921282013-08-24 21:26:42 +02004 * Copyright (C) 2012 Andreas Eversberg <jolly@eversberg.eu>
Holger Hans Peter Freyther17c31ce2013-08-24 18:31:27 +02005 * 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
Holger Hans Peter Freyther67ed34e2013-10-17 17:01:54 +020022#include <bts.h>
Holger Hans Peter Freyther17c31ce2013-08-24 18:31:27 +020023#include <tbf.h>
Holger Hans Peter Freytherd11290b2013-10-26 17:32:04 +020024#include <rlc.h>
Holger Hans Peter Freyther2db7e7e2013-10-26 20:45:35 +020025#include <encoding.h>
Holger Hans Peter Freyther17c31ce2013-08-24 18:31:27 +020026#include <gprs_rlcmac.h>
27#include <gprs_debug.h>
Holger Hans Peter Freyther3dc56a32013-10-26 21:38:30 +020028#include <gprs_bssgp_pcu.h>
Holger Hans Peter Freyther77e05972013-11-06 19:16:43 +010029#include <decoding.h>
Holger Hans Peter Freyther17c31ce2013-08-24 18:31:27 +020030
31extern "C" {
32#include <osmocom/core/msgb.h>
Holger Hans Peter Freyther45561302013-10-16 17:55:57 +020033#include <osmocom/core/talloc.h>
Holger Hans Peter Freyther17c31ce2013-08-24 18:31:27 +020034}
35
36#include <errno.h>
37#include <string.h>
38
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +020039/* After sending these frames, we poll for ack/nack. */
40#define POLL_ACK_AFTER_FRAMES 20
Holger Hans Peter Freyther77e05972013-11-06 19:16:43 +010041/* After receiving these frames, we send ack/nack. */
42#define SEND_ACK_AFTER_FRAMES 20
43
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +020044
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +020045static const struct gprs_rlcmac_cs gprs_rlcmac_cs[] = {
46/* frame length data block max payload */
47 { 0, 0, 0 },
48 { 23, 23, 20 }, /* CS-1 */
49 { 34, 33, 30 }, /* CS-2 */
50 { 40, 39, 36 }, /* CS-3 */
51 { 54, 53, 50 }, /* CS-4 */
52};
53
Holger Hans Peter Freyther1702f102013-10-20 08:44:02 +020054extern "C" {
55int bssgp_tx_llc_discarded(struct bssgp_bvc_ctx *bctx, uint32_t tlli,
56 uint8_t num_frames, uint32_t num_octets);
57}
58
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +020059extern void *tall_pcu_ctx;
60
Holger Hans Peter Freytheraf8094d2013-10-26 17:56:15 +020061static void tbf_timer_cb(void *_tbf);
62
Holger Hans Peter Freytherd9262b32013-10-26 20:12:59 +020063inline gprs_rlcmac_bts *gprs_rlcmac_tbf::bts_data() const
64{
65 return bts->bts_data();
66}
67
Holger Hans Peter Freytherd1d114f2013-08-24 20:46:18 +020068static inline void tbf_update_ms_class(struct gprs_rlcmac_tbf *tbf,
69 const uint8_t ms_class)
70{
71 if (!tbf->ms_class && ms_class)
72 tbf->ms_class = ms_class;
73}
74
Holger Hans Peter Freyther5464c9b2013-10-27 20:57:35 +010075void gprs_rlcmac_tbf::assign_imsi(const char *imsi)
Holger Hans Peter Freytherd8689282013-08-24 20:51:06 +020076{
Holger Hans Peter Freyther5464c9b2013-10-27 20:57:35 +010077 strncpy(m_imsi, imsi, sizeof(m_imsi));
78 m_imsi[sizeof(m_imsi) - 1] = '\0';
Holger Hans Peter Freytherd8689282013-08-24 20:51:06 +020079}
80
Daniel Willmann23544022014-07-30 19:12:27 +020081static struct gprs_rlcmac_dl_tbf *tbf_lookup_dl(BTS *bts,
Holger Hans Peter Freyther34bd8bd2013-10-19 21:10:38 +020082 const uint32_t tlli, const char *imsi)
Holger Hans Peter Freyther31d0df92013-08-24 20:42:45 +020083{
84 /* TODO: look up by IMSI first, then tlli, then old_tlli */
Daniel Willmannb59d61b2014-07-02 17:58:14 +020085 return bts->dl_tbf_by_tlli(tlli);
Holger Hans Peter Freyther31d0df92013-08-24 20:42:45 +020086}
87
Daniel Willmann538ac5b2014-07-30 19:12:27 +020088int gprs_rlcmac_dl_tbf::append_data(const uint8_t ms_class,
Holger Hans Peter Freyther31d0df92013-08-24 20:42:45 +020089 const uint16_t pdu_delay_csec,
90 const uint8_t *data, const uint16_t len)
91{
Holger Hans Peter Freythera1da2512013-11-07 07:32:51 +010092 LOGP(DRLCMAC, LOGL_INFO, "%s append\n", tbf_name(this));
93 if (state_is(GPRS_RLCMAC_WAIT_RELEASE)) {
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +010094 LOGP(DRLCMAC, LOGL_DEBUG,
95 "%s in WAIT RELEASE state "
Holger Hans Peter Freythera1da2512013-11-07 07:32:51 +010096 "(T3193), so reuse TBF\n", tbf_name(this));
Holger Hans Peter Freythera1da2512013-11-07 07:32:51 +010097 tbf_update_ms_class(this, ms_class);
Holger Hans Peter Freyther55cf9942013-11-13 18:15:45 +010098 reuse_tbf(data, len);
Holger Hans Peter Freyther31d0df92013-08-24 20:42:45 +020099 } else {
100 /* the TBF exists, so we must write it in the queue
101 * we prepend lifetime in front of PDU */
102 struct timeval *tv;
Daniel Willmann9c623892013-12-04 18:11:47 +0100103 struct msgb *llc_msg = msgb_alloc(len + sizeof(*tv) * 2,
Holger Hans Peter Freyther31d0df92013-08-24 20:42:45 +0200104 "llc_pdu_queue");
105 if (!llc_msg)
106 return -ENOMEM;
107 tv = (struct timeval *)msgb_put(llc_msg, sizeof(*tv));
Holger Hans Peter Freytherfce431c2013-11-13 15:17:12 +0100108 gprs_llc::calc_pdu_lifetime(bts, pdu_delay_csec, tv);
Daniel Willmann9c623892013-12-04 18:11:47 +0100109 tv = (struct timeval *)msgb_put(llc_msg, sizeof(*tv));
110 gettimeofday(tv, NULL);
Holger Hans Peter Freyther31d0df92013-08-24 20:42:45 +0200111 memcpy(msgb_put(llc_msg, len), data, len);
Holger Hans Peter Freythera1da2512013-11-07 07:32:51 +0100112 m_llc.enqueue(llc_msg);
113 tbf_update_ms_class(this, ms_class);
Holger Hans Peter Freyther31d0df92013-08-24 20:42:45 +0200114 }
115
116 return 0;
117}
118
Holger Hans Peter Freyther443c8222013-08-24 20:59:46 +0200119static int tbf_new_dl_assignment(struct gprs_rlcmac_bts *bts,
120 const char *imsi,
121 const uint32_t tlli, const uint8_t ms_class,
122 const uint8_t *data, const uint16_t len)
123{
124 uint8_t trx, ta, ss;
125 int8_t use_trx;
Daniel Willmann532a4b52014-08-07 12:39:26 +0200126 struct gprs_rlcmac_ul_tbf *ul_tbf, *old_ul_tbf;
127 struct gprs_rlcmac_dl_tbf *dl_tbf;
Holger Hans Peter Freyther443c8222013-08-24 20:59:46 +0200128 int8_t tfi; /* must be signed */
129 int rc;
130
131 /* check for uplink data, so we copy our informations */
Holger Hans Peter Freytherbb20b2c2013-08-24 21:22:16 +0200132#warning "Do the same look up for IMSI, TLLI and OLD_TLLI"
133#warning "Refactor the below lines... into a new method"
Daniel Willmann532a4b52014-08-07 12:39:26 +0200134 ul_tbf = bts->bts->ul_tbf_by_tlli(tlli);
135 if (ul_tbf && ul_tbf->dir.ul.contention_resolution_done
136 && !ul_tbf->dir.ul.final_ack_sent) {
137 use_trx = ul_tbf->trx->trx_no;
138 ta = ul_tbf->ta;
Holger Hans Peter Freyther443c8222013-08-24 20:59:46 +0200139 ss = 0;
Daniel Willmann532a4b52014-08-07 12:39:26 +0200140 old_ul_tbf = ul_tbf;
Holger Hans Peter Freyther443c8222013-08-24 20:59:46 +0200141 } else {
142 use_trx = -1;
143 /* we already have an uplink TBF, so we use that TA */
Daniel Willmann532a4b52014-08-07 12:39:26 +0200144 if (ul_tbf)
145 ta = ul_tbf->ta;
Holger Hans Peter Freyther443c8222013-08-24 20:59:46 +0200146 else {
147 /* recall TA */
Holger Hans Peter Freyther111614a2013-10-19 20:04:57 +0200148 rc = bts->bts->timing_advance()->recall(tlli);
Holger Hans Peter Freyther443c8222013-08-24 20:59:46 +0200149 if (rc < 0) {
150 LOGP(DRLCMAC, LOGL_NOTICE, "TA unknown"
151 ", assuming 0\n");
152 ta = 0;
153 } else
154 ta = rc;
155 }
156 ss = 1; /* PCH assignment only allows one timeslot */
Daniel Willmann532a4b52014-08-07 12:39:26 +0200157 old_ul_tbf = NULL;
Holger Hans Peter Freyther443c8222013-08-24 20:59:46 +0200158 }
159
160 // Create new TBF (any TRX)
Holger Hans Peter Freytherbcafdf82013-08-24 21:13:31 +0200161#warning "Copy and paste with alloc_ul_tbf"
Holger Hans Peter Freyther70ddde62013-10-26 19:17:58 +0200162 tfi = bts->bts->tfi_find_free(GPRS_RLCMAC_DL_TBF, &trx, use_trx);
Holger Hans Peter Freyther443c8222013-08-24 20:59:46 +0200163 if (tfi < 0) {
164 LOGP(DRLCMAC, LOGL_NOTICE, "No PDCH resource\n");
165 /* FIXME: send reject */
166 return -EBUSY;
167 }
168 /* set number of downlink slots according to multislot class */
Daniel Willmann532a4b52014-08-07 12:39:26 +0200169 dl_tbf = tbf_alloc_dl_tbf(bts, ul_tbf, tfi, trx, ms_class, ss);
170 if (!dl_tbf) {
Holger Hans Peter Freyther90b87ea2013-10-27 10:38:31 +0100171 LOGP(DRLCMAC, LOGL_NOTICE, "No PDCH resource\n");
Holger Hans Peter Freyther443c8222013-08-24 20:59:46 +0200172 /* FIXME: send reject */
173 return -EBUSY;
174 }
Daniel Willmann532a4b52014-08-07 12:39:26 +0200175 dl_tbf->m_tlli = tlli;
176 dl_tbf->m_tlli_valid = 1;
177 dl_tbf->ta = ta;
Holger Hans Peter Freyther443c8222013-08-24 20:59:46 +0200178
Daniel Willmann532a4b52014-08-07 12:39:26 +0200179 LOGP(DRLCMAC, LOGL_DEBUG, "%s [DOWNLINK] START\n", tbf_name(dl_tbf));
Holger Hans Peter Freyther443c8222013-08-24 20:59:46 +0200180
181 /* new TBF, so put first frame */
Daniel Willmann532a4b52014-08-07 12:39:26 +0200182 dl_tbf->m_llc.put_frame(data, len);
183 dl_tbf->bts->llc_frame_sched();
Holger Hans Peter Freyther443c8222013-08-24 20:59:46 +0200184
Holger Hans Peter Freyther5464c9b2013-10-27 20:57:35 +0100185 /* Store IMSI for later look-up and PCH retransmission */
Daniel Willmann532a4b52014-08-07 12:39:26 +0200186 dl_tbf->assign_imsi(imsi);
Holger Hans Peter Freyther5464c9b2013-10-27 20:57:35 +0100187
Holger Hans Peter Freyther443c8222013-08-24 20:59:46 +0200188 /* trigger downlink assignment and set state to ASSIGN.
189 * we don't use old_downlink, so the possible uplink is used
190 * to trigger downlink assignment. if there is no uplink,
191 * AGCH is used. */
Daniel Willmann532a4b52014-08-07 12:39:26 +0200192 dl_tbf->bts->trigger_dl_ass(dl_tbf, old_ul_tbf, imsi);
Holger Hans Peter Freyther443c8222013-08-24 20:59:46 +0200193 return 0;
194}
195
Holger Hans Peter Freyther17c31ce2013-08-24 18:31:27 +0200196/**
197 * TODO: split into unit test-able parts...
198 */
Holger Hans Peter Freythera1da2512013-11-07 07:32:51 +0100199int gprs_rlcmac_tbf::handle(struct gprs_rlcmac_bts *bts,
Holger Hans Peter Freyther17c31ce2013-08-24 18:31:27 +0200200 const uint32_t tlli, const char *imsi,
Holger Hans Peter Freyther31d0df92013-08-24 20:42:45 +0200201 const uint8_t ms_class, const uint16_t delay_csec,
Holger Hans Peter Freyther17c31ce2013-08-24 18:31:27 +0200202 const uint8_t *data, const uint16_t len)
203{
Daniel Willmann23544022014-07-30 19:12:27 +0200204 struct gprs_rlcmac_dl_tbf *dl_tbf;
Holger Hans Peter Freyther17c31ce2013-08-24 18:31:27 +0200205
206 /* check for existing TBF */
Daniel Willmann23544022014-07-30 19:12:27 +0200207 dl_tbf = tbf_lookup_dl(bts->bts, tlli, imsi);
208 if (dl_tbf) {
209 int rc = dl_tbf->append_data(ms_class, delay_csec, data, len);
Holger Hans Peter Freyther443c8222013-08-24 20:59:46 +0200210 if (rc >= 0)
Daniel Willmann23544022014-07-30 19:12:27 +0200211 dl_tbf->assign_imsi(imsi);
Holger Hans Peter Freyther443c8222013-08-24 20:59:46 +0200212 return rc;
213 }
Holger Hans Peter Freyther17c31ce2013-08-24 18:31:27 +0200214
Holger Hans Peter Freyther443c8222013-08-24 20:59:46 +0200215 return tbf_new_dl_assignment(bts, imsi, tlli, ms_class, data, len);
Holger Hans Peter Freyther17c31ce2013-08-24 18:31:27 +0200216}
Holger Hans Peter Freyther86921282013-08-24 21:26:42 +0200217
Daniel Willmann0d12a2f2014-07-10 17:44:07 +0200218gprs_rlcmac_ul_tbf *tbf_alloc_ul(struct gprs_rlcmac_bts *bts,
Holger Hans Peter Freyther86921282013-08-24 21:26:42 +0200219 int8_t use_trx, uint8_t ms_class,
220 uint32_t tlli, uint8_t ta, struct gprs_rlcmac_tbf *dl_tbf)
221{
222 uint8_t trx;
Daniel Willmann0d12a2f2014-07-10 17:44:07 +0200223 struct gprs_rlcmac_ul_tbf *tbf;
Holger Hans Peter Freyther5697b4c2013-11-11 16:22:39 +0100224 int8_t tfi; /* must be signed */
Holger Hans Peter Freyther86921282013-08-24 21:26:42 +0200225
226#warning "Copy and paste with tbf_new_dl_assignment"
Holger Hans Peter Freytherba263682013-12-25 19:15:57 +0100227 /* create new TBF, use same TRX as DL TBF */
Holger Hans Peter Freyther70ddde62013-10-26 19:17:58 +0200228 tfi = bts->bts->tfi_find_free(GPRS_RLCMAC_UL_TBF, &trx, use_trx);
Holger Hans Peter Freyther86921282013-08-24 21:26:42 +0200229 if (tfi < 0) {
Holger Hans Peter Freyther90b87ea2013-10-27 10:38:31 +0100230 LOGP(DRLCMAC, LOGL_NOTICE, "No PDCH resource\n");
Holger Hans Peter Freyther86921282013-08-24 21:26:42 +0200231 /* FIXME: send reject */
232 return NULL;
233 }
234 /* use multislot class of downlink TBF */
Daniel Willmann48aa0b02014-07-16 18:54:10 +0200235 tbf = tbf_alloc_ul_tbf(bts, dl_tbf, tfi, trx, ms_class, 0);
Holger Hans Peter Freyther86921282013-08-24 21:26:42 +0200236 if (!tbf) {
Holger Hans Peter Freyther90b87ea2013-10-27 10:38:31 +0100237 LOGP(DRLCMAC, LOGL_NOTICE, "No PDCH resource\n");
Holger Hans Peter Freyther86921282013-08-24 21:26:42 +0200238 /* FIXME: send reject */
239 return NULL;
240 }
Holger Hans Peter Freyther474685e2013-10-27 17:01:14 +0100241 tbf->m_tlli = tlli;
242 tbf->m_tlli_valid = 1; /* no contention resolution */
Holger Hans Peter Freyther86921282013-08-24 21:26:42 +0200243 tbf->dir.ul.contention_resolution_done = 1;
244 tbf->ta = ta; /* use current TA */
245 tbf_new_state(tbf, GPRS_RLCMAC_ASSIGN);
246 tbf->state_flags |= (1 << GPRS_RLCMAC_FLAG_PACCH);
247 tbf_timer_start(tbf, 3169, bts->t3169, 0);
248
249 return tbf;
250}
Holger Hans Peter Freyther964ddb62013-10-16 17:53:23 +0200251
Holger Hans Peter Freyther45561302013-10-16 17:55:57 +0200252static void tbf_unlink_pdch(struct gprs_rlcmac_tbf *tbf)
253{
Holger Hans Peter Freyther45561302013-10-16 17:55:57 +0200254 int ts;
255
256 if (tbf->direction == GPRS_RLCMAC_UL_TBF) {
Holger Hans Peter Freyther34f6e5e2013-10-27 20:31:47 +0100257 tbf->trx->ul_tbf[tbf->tfi()] = NULL;
Daniel Willmann17a1d5e2014-05-30 20:21:30 +0200258 for (ts = 0; ts < 8; ts++)
Holger Hans Peter Freyther45561302013-10-16 17:55:57 +0200259 tbf->pdch[ts] = NULL;
Holger Hans Peter Freyther45561302013-10-16 17:55:57 +0200260 } else {
Holger Hans Peter Freyther34f6e5e2013-10-27 20:31:47 +0100261 tbf->trx->dl_tbf[tbf->tfi()] = NULL;
Daniel Willmann17a1d5e2014-05-30 20:21:30 +0200262 for (ts = 0; ts < 8; ts++)
Holger Hans Peter Freyther45561302013-10-16 17:55:57 +0200263 tbf->pdch[ts] = NULL;
Holger Hans Peter Freyther45561302013-10-16 17:55:57 +0200264 }
265}
266
267void tbf_free(struct gprs_rlcmac_tbf *tbf)
268{
Holger Hans Peter Freyther45561302013-10-16 17:55:57 +0200269 /* Give final measurement report */
270 gprs_rlcmac_rssi_rep(tbf);
271 gprs_rlcmac_lost_rep(tbf);
272
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +0100273 LOGP(DRLCMAC, LOGL_INFO, "%s free\n", tbf_name(tbf));
Holger Hans Peter Freyther45561302013-10-16 17:55:57 +0200274 if (tbf->ul_ass_state != GPRS_RLCMAC_UL_ASS_NONE)
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +0100275 LOGP(DRLCMAC, LOGL_ERROR, "%s Software error: Pending uplink "
Holger Hans Peter Freyther45561302013-10-16 17:55:57 +0200276 "assignment. This may not happen, because the "
277 "assignment message never gets transmitted. Please "
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +0100278 "be sure not to free in this state. PLEASE FIX!\n",
279 tbf_name(tbf));
Holger Hans Peter Freyther45561302013-10-16 17:55:57 +0200280 if (tbf->dl_ass_state != GPRS_RLCMAC_DL_ASS_NONE)
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +0100281 LOGP(DRLCMAC, LOGL_ERROR, "%s Software error: Pending downlink "
Holger Hans Peter Freyther45561302013-10-16 17:55:57 +0200282 "assignment. This may not happen, because the "
283 "assignment message never gets transmitted. Please "
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +0100284 "be sure not to free in this state. PLEASE FIX!\n",
285 tbf_name(tbf));
Holger Hans Peter Freyther86300bb2013-10-26 18:01:35 +0200286 tbf->stop_timer();
Holger Hans Peter Freyther782f6dd2013-10-26 18:31:51 +0200287 #warning "TODO: Could/Should generate bssgp_tx_llc_discarded"
Holger Hans Peter Freyther758dc122013-11-06 20:39:45 +0100288 tbf->m_llc.clear(tbf->bts);
Holger Hans Peter Freyther45561302013-10-16 17:55:57 +0200289 tbf_unlink_pdch(tbf);
Daniel Willmann1b3864f2014-07-30 13:25:19 +0200290 llist_del(&tbf->list.list);
Holger Hans Peter Freyther15877642013-10-27 09:50:15 +0100291
292 if (tbf->direction == GPRS_RLCMAC_UL_TBF)
293 tbf->bts->tbf_ul_freed();
294 else
295 tbf->bts->tbf_dl_freed();
296
Holger Hans Peter Freyther45561302013-10-16 17:55:57 +0200297 LOGP(DRLCMAC, LOGL_DEBUG, "********** TBF ends here **********\n");
298 talloc_free(tbf);
299}
300
Holger Hans Peter Freytheraa9c3262013-10-26 17:49:36 +0200301int gprs_rlcmac_tbf::update()
Holger Hans Peter Freyther45561302013-10-16 17:55:57 +0200302{
Holger Hans Peter Freyther45561302013-10-16 17:55:57 +0200303 struct gprs_rlcmac_tbf *ul_tbf = NULL;
Holger Hans Peter Freytheraa9c3262013-10-26 17:49:36 +0200304 struct gprs_rlcmac_bts *bts_data = bts->bts_data();
Holger Hans Peter Freyther45561302013-10-16 17:55:57 +0200305 int rc;
306
307 LOGP(DRLCMAC, LOGL_DEBUG, "********** TBF update **********\n");
308
Holger Hans Peter Freytheraa9c3262013-10-26 17:49:36 +0200309 if (direction != GPRS_RLCMAC_DL_TBF)
Holger Hans Peter Freyther45561302013-10-16 17:55:57 +0200310 return -EINVAL;
311
Daniel Willmannb59d61b2014-07-02 17:58:14 +0200312 ul_tbf = bts->ul_tbf_by_tlli(m_tlli);
Holger Hans Peter Freyther45561302013-10-16 17:55:57 +0200313
Holger Hans Peter Freytheraa9c3262013-10-26 17:49:36 +0200314 tbf_unlink_pdch(this);
315 rc = bts_data->alloc_algorithm(bts_data, ul_tbf, this, bts_data->alloc_algorithm_curst, 0);
Holger Hans Peter Freyther90b87ea2013-10-27 10:38:31 +0100316 /* if no resource */
Holger Hans Peter Freyther45561302013-10-16 17:55:57 +0200317 if (rc < 0) {
Holger Hans Peter Freyther90b87ea2013-10-27 10:38:31 +0100318 LOGP(DRLCMAC, LOGL_ERROR, "No resource after update???\n");
Holger Hans Peter Freyther45561302013-10-16 17:55:57 +0200319 return -rc;
320 }
321
322 return 0;
323}
324
325int tbf_assign_control_ts(struct gprs_rlcmac_tbf *tbf)
326{
327 if (tbf->control_ts == 0xff)
328 LOGP(DRLCMAC, LOGL_INFO, "- Setting Control TS %d\n",
329 tbf->first_common_ts);
330 else if (tbf->control_ts != tbf->first_common_ts)
331 LOGP(DRLCMAC, LOGL_INFO, "- Changing Control TS %d\n",
332 tbf->first_common_ts);
333 tbf->control_ts = tbf->first_common_ts;
334
335 return 0;
336}
337
338static const char *tbf_state_name[] = {
339 "NULL",
340 "ASSIGN",
341 "FLOW",
342 "FINISHED",
343 "WAIT RELEASE",
344 "RELEASING",
345};
346
347void tbf_new_state(struct gprs_rlcmac_tbf *tbf,
348 enum gprs_rlcmac_tbf_state state)
349{
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +0100350 LOGP(DRLCMAC, LOGL_DEBUG, "%s changes state from %s to %s\n",
351 tbf_name(tbf),
Holger Hans Peter Freyther45561302013-10-16 17:55:57 +0200352 tbf_state_name[tbf->state], tbf_state_name[state]);
Holger Hans Peter Freyther1c344e22013-10-16 18:33:18 +0200353 tbf->set_state(state);
Holger Hans Peter Freyther45561302013-10-16 17:55:57 +0200354}
355
356void tbf_timer_start(struct gprs_rlcmac_tbf *tbf, unsigned int T,
357 unsigned int seconds, unsigned int microseconds)
358{
359 if (!osmo_timer_pending(&tbf->timer))
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +0100360 LOGP(DRLCMAC, LOGL_DEBUG, "%s starting timer %u.\n",
361 tbf_name(tbf), T);
Holger Hans Peter Freyther45561302013-10-16 17:55:57 +0200362 else
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +0100363 LOGP(DRLCMAC, LOGL_DEBUG, "%s restarting timer %u "
Holger Hans Peter Freyther45561302013-10-16 17:55:57 +0200364 "while old timer %u pending \n",
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +0100365 tbf_name(tbf), T, tbf->T);
Holger Hans Peter Freyther45561302013-10-16 17:55:57 +0200366
367 tbf->T = T;
368 tbf->num_T_exp = 0;
369
370 /* Tunning timers can be safely re-scheduled. */
371 tbf->timer.data = tbf;
372 tbf->timer.cb = &tbf_timer_cb;
373
374 osmo_timer_schedule(&tbf->timer, seconds, microseconds);
375}
376
Holger Hans Peter Freyther86300bb2013-10-26 18:01:35 +0200377void gprs_rlcmac_tbf::stop_t3191()
Holger Hans Peter Freyther45561302013-10-16 17:55:57 +0200378{
Holger Hans Peter Freyther86300bb2013-10-26 18:01:35 +0200379 return stop_timer();
380}
381
382void gprs_rlcmac_tbf::stop_timer()
383{
384 if (osmo_timer_pending(&timer)) {
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +0100385 LOGP(DRLCMAC, LOGL_DEBUG, "%s stopping timer %u.\n",
386 tbf_name(this), T);
Holger Hans Peter Freyther86300bb2013-10-26 18:01:35 +0200387 osmo_timer_del(&timer);
Holger Hans Peter Freyther45561302013-10-16 17:55:57 +0200388 }
389}
390
Holger Hans Peter Freytherd9262b32013-10-26 20:12:59 +0200391void gprs_rlcmac_tbf::poll_timeout()
392{
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +0100393 LOGP(DRLCMAC, LOGL_NOTICE, "%s poll timeout\n",
394 tbf_name(this));
Holger Hans Peter Freytherd9262b32013-10-26 20:12:59 +0200395
396 poll_state = GPRS_RLCMAC_POLL_NONE;
397
398 if (ul_ack_state == GPRS_RLCMAC_UL_ACK_WAIT_ACK) {
399 if (!(state_flags & (1 << GPRS_RLCMAC_FLAG_TO_UL_ACK))) {
400 LOGP(DRLCMAC, LOGL_NOTICE, "- Timeout for polling "
401 "PACKET CONTROL ACK for PACKET UPLINK ACK\n");
402 rlcmac_diag();
403 state_flags |= (1 << GPRS_RLCMAC_FLAG_TO_UL_ACK);
404 }
405 ul_ack_state = GPRS_RLCMAC_UL_ACK_NONE;
Holger Hans Peter Freytherd9262b32013-10-26 20:12:59 +0200406 if (state_is(GPRS_RLCMAC_FINISHED)) {
407 dir.ul.n3103++;
408 if (dir.ul.n3103 == bts->bts_data()->n3103) {
409 LOGP(DRLCMAC, LOGL_NOTICE,
410 "- N3103 exceeded\n");
Holger Hans Peter Freytherd9262b32013-10-26 20:12:59 +0200411 tbf_new_state(this, GPRS_RLCMAC_RELEASING);
412 tbf_timer_start(this, 3169, bts->bts_data()->t3169, 0);
413 return;
414 }
415 /* reschedule UL ack */
416 ul_ack_state = GPRS_RLCMAC_UL_ACK_SEND_ACK;
417 }
418 } else if (ul_ass_state == GPRS_RLCMAC_UL_ASS_WAIT_ACK) {
419 if (!(state_flags & (1 << GPRS_RLCMAC_FLAG_TO_UL_ASS))) {
420 LOGP(DRLCMAC, LOGL_NOTICE, "- Timeout for polling "
421 "PACKET CONTROL ACK for PACKET UPLINK "
422 "ASSIGNMENT.\n");
423 rlcmac_diag();
424 state_flags |= (1 << GPRS_RLCMAC_FLAG_TO_UL_ASS);
425 }
426 ul_ass_state = GPRS_RLCMAC_UL_ASS_NONE;
Holger Hans Peter Freytherd9262b32013-10-26 20:12:59 +0200427 n3105++;
428 if (n3105 == bts_data()->n3105) {
429 LOGP(DRLCMAC, LOGL_NOTICE, "- N3105 exceeded\n");
Holger Hans Peter Freytherd9262b32013-10-26 20:12:59 +0200430 tbf_new_state(this, GPRS_RLCMAC_RELEASING);
431 tbf_timer_start(this, 3195, bts_data()->t3195, 0);
432 return;
433 }
434 /* reschedule UL assignment */
435 ul_ass_state = GPRS_RLCMAC_UL_ASS_SEND_ASS;
436 } else if (dl_ass_state == GPRS_RLCMAC_DL_ASS_WAIT_ACK) {
437 if (!(state_flags & (1 << GPRS_RLCMAC_FLAG_TO_DL_ASS))) {
438 LOGP(DRLCMAC, LOGL_NOTICE, "- Timeout for polling "
439 "PACKET CONTROL ACK for PACKET DOWNLINK "
440 "ASSIGNMENT.\n");
441 rlcmac_diag();
442 state_flags |= (1 << GPRS_RLCMAC_FLAG_TO_DL_ASS);
443 }
444 dl_ass_state = GPRS_RLCMAC_DL_ASS_NONE;
Holger Hans Peter Freytherd9262b32013-10-26 20:12:59 +0200445 n3105++;
446 if (n3105 == bts->bts_data()->n3105) {
447 LOGP(DRLCMAC, LOGL_NOTICE, "- N3105 exceeded\n");
Holger Hans Peter Freytherd9262b32013-10-26 20:12:59 +0200448 tbf_new_state(this, GPRS_RLCMAC_RELEASING);
449 tbf_timer_start(this, 3195, bts_data()->t3195, 0);
450 return;
451 }
452 /* reschedule DL assignment */
453 dl_ass_state = GPRS_RLCMAC_DL_ASS_SEND_ASS;
454 } else if (direction == GPRS_RLCMAC_DL_TBF) {
455 if (!(state_flags & (1 << GPRS_RLCMAC_FLAG_TO_DL_ACK))) {
456 LOGP(DRLCMAC, LOGL_NOTICE, "- Timeout for polling "
457 "PACKET DOWNLINK ACK.\n");
458 rlcmac_diag();
459 state_flags |= (1 << GPRS_RLCMAC_FLAG_TO_DL_ACK);
460 }
Holger Hans Peter Freytherd9262b32013-10-26 20:12:59 +0200461 n3105++;
462 if (n3105 == bts->bts_data()->n3105) {
463 LOGP(DRLCMAC, LOGL_NOTICE, "- N3105 exceeded\n");
Holger Hans Peter Freytherd9262b32013-10-26 20:12:59 +0200464 tbf_new_state(this, GPRS_RLCMAC_RELEASING);
465 tbf_timer_start(this, 3195, bts_data()->t3195, 0);
466 return;
467 }
468 /* resend IMM.ASS on CCCH on timeout */
469 if ((state_flags & (1 << GPRS_RLCMAC_FLAG_CCCH))
470 && !(state_flags & (1 << GPRS_RLCMAC_FLAG_DL_ACK))) {
471 LOGP(DRLCMAC, LOGL_DEBUG, "Re-send dowlink assignment "
Holger Hans Peter Freyther34f6e5e2013-10-27 20:31:47 +0100472 "for %s on PCH (IMSI=%s)\n",
473 tbf_name(this),
Holger Hans Peter Freyther5464c9b2013-10-27 20:57:35 +0100474 m_imsi);
Holger Hans Peter Freytherd9262b32013-10-26 20:12:59 +0200475 /* send immediate assignment */
Holger Hans Peter Freyther5464c9b2013-10-27 20:57:35 +0100476 bts->snd_dl_ass(this, 0, m_imsi);
Holger Hans Peter Freytherd9262b32013-10-26 20:12:59 +0200477 dir.dl.wait_confirm = 1;
478 }
479 } else
480 LOGP(DRLCMAC, LOGL_ERROR, "- Poll Timeout, but no event!\n");
481}
482
Daniel Willmann48aa0b02014-07-16 18:54:10 +0200483static int setup_tbf(struct gprs_rlcmac_tbf *tbf, struct gprs_rlcmac_bts *bts,
484 struct gprs_rlcmac_tbf *old_tbf, uint8_t tfi, uint8_t trx,
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +0200485 uint8_t ms_class, uint8_t single_slot)
486{
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +0200487 int rc;
488
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +0200489 if (trx >= 8 || tfi >= 32)
Daniel Willmann48aa0b02014-07-16 18:54:10 +0200490 return -1;
Daniel Willmann078bb712014-07-10 17:44:06 +0200491
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +0200492 if (!tbf)
Daniel Willmann48aa0b02014-07-16 18:54:10 +0200493 return -1;
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +0200494
Daniel Willmann1b3864f2014-07-30 13:25:19 +0200495 /* Back pointer for PODS llist compatibility */
496 tbf->list.back = tbf;
497
Holger Hans Peter Freythera0047992014-01-16 10:07:20 +0100498 tbf->m_created_ts = time(NULL);
Holger Hans Peter Freyther9f0c1d22013-10-19 21:24:34 +0200499 tbf->bts = bts->bts;
Holger Hans Peter Freyther34f6e5e2013-10-27 20:31:47 +0100500 tbf->m_tfi = tfi;
Holger Hans Peter Freyther743bafa2013-09-29 07:50:50 +0200501 tbf->trx = &bts->trx[trx];
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +0200502 tbf->ms_class = ms_class;
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +0200503 /* select algorithm */
504 rc = bts->alloc_algorithm(bts, old_tbf, tbf, bts->alloc_algorithm_curst,
505 single_slot);
Holger Hans Peter Freyther90b87ea2013-10-27 10:38:31 +0100506 /* if no resource */
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +0200507 if (rc < 0) {
Daniel Willmann48aa0b02014-07-16 18:54:10 +0200508 return -1;
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +0200509 }
510 /* assign control ts */
511 tbf->control_ts = 0xff;
512 rc = tbf_assign_control_ts(tbf);
Holger Hans Peter Freyther90b87ea2013-10-27 10:38:31 +0100513 /* if no resource */
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +0200514 if (rc < 0) {
Daniel Willmann48aa0b02014-07-16 18:54:10 +0200515 return -1;
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +0200516 }
517
518 /* set timestamp */
519 gettimeofday(&tbf->meas.dl_bw_tv, NULL);
520 gettimeofday(&tbf->meas.rssi_tv, NULL);
521 gettimeofday(&tbf->meas.dl_loss_tv, NULL);
522
Holger Hans Peter Freyther758dc122013-11-06 20:39:45 +0100523 tbf->m_llc.init();
Daniel Willmann48aa0b02014-07-16 18:54:10 +0200524 return 0;
525}
526
527
528struct gprs_rlcmac_ul_tbf *tbf_alloc_ul_tbf(struct gprs_rlcmac_bts *bts,
529 struct gprs_rlcmac_tbf *old_tbf, uint8_t tfi, uint8_t trx,
530 uint8_t ms_class, uint8_t single_slot)
531{
532 struct gprs_rlcmac_ul_tbf *tbf;
533 int rc;
534
535 LOGP(DRLCMAC, LOGL_DEBUG, "********** TBF starts here **********\n");
536 LOGP(DRLCMAC, LOGL_INFO, "Allocating %s TBF: TFI=%d TRX=%d "
537 "MS_CLASS=%d\n", "UL", tfi, trx, ms_class);
538
539 if (trx >= 8 || tfi >= 32)
540 return NULL;
541
542 tbf = talloc_zero(tall_pcu_ctx, struct gprs_rlcmac_ul_tbf);
543
544 if (!tbf)
545 return NULL;
546
547 tbf->direction = GPRS_RLCMAC_UL_TBF;
548 rc = setup_tbf(tbf, bts, old_tbf, tfi, trx, ms_class, single_slot);
549 /* if no resource */
550 if (rc < 0) {
551 talloc_free(tbf);
552 return NULL;
Holger Hans Peter Freyther15877642013-10-27 09:50:15 +0100553 }
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +0200554
Daniel Willmann1b3864f2014-07-30 13:25:19 +0200555 llist_add(&tbf->list.list, &bts->ul_tbfs);
Daniel Willmann48aa0b02014-07-16 18:54:10 +0200556 tbf->bts->tbf_ul_created();
557
558 return tbf;
559}
560
561struct gprs_rlcmac_dl_tbf *tbf_alloc_dl_tbf(struct gprs_rlcmac_bts *bts,
562 struct gprs_rlcmac_tbf *old_tbf, uint8_t tfi, uint8_t trx,
563 uint8_t ms_class, uint8_t single_slot)
564{
565 struct gprs_rlcmac_dl_tbf *tbf;
566 int rc;
567
568 LOGP(DRLCMAC, LOGL_DEBUG, "********** TBF starts here **********\n");
569 LOGP(DRLCMAC, LOGL_INFO, "Allocating %s TBF: TFI=%d TRX=%d "
570 "MS_CLASS=%d\n", "DL", tfi, trx, ms_class);
571
572 if (trx >= 8 || tfi >= 32)
573 return NULL;
574
575 tbf = talloc_zero(tall_pcu_ctx, struct gprs_rlcmac_dl_tbf);
576
577 if (!tbf)
578 return NULL;
579
580 tbf->direction = GPRS_RLCMAC_DL_TBF;
581 rc = setup_tbf(tbf, bts, old_tbf, tfi, trx, ms_class, single_slot);
582 /* if no resource */
583 if (rc < 0) {
584 talloc_free(tbf);
585 return NULL;
586 }
587
Daniel Willmann1b3864f2014-07-30 13:25:19 +0200588 llist_add(&tbf->list.list, &bts->dl_tbfs);
Daniel Willmann48aa0b02014-07-16 18:54:10 +0200589 tbf->bts->tbf_dl_created();
590
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +0200591 return tbf;
592}
593
Holger Hans Peter Freytheraf8094d2013-10-26 17:56:15 +0200594static void tbf_timer_cb(void *_tbf)
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +0200595{
596 struct gprs_rlcmac_tbf *tbf = (struct gprs_rlcmac_tbf *)_tbf;
Holger Hans Peter Freytheraf8094d2013-10-26 17:56:15 +0200597 tbf->handle_timeout();
598}
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +0200599
Holger Hans Peter Freytheraf8094d2013-10-26 17:56:15 +0200600void gprs_rlcmac_tbf::handle_timeout()
601{
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +0100602 LOGP(DRLCMAC, LOGL_DEBUG, "%s timer %u expired.\n",
603 tbf_name(this), T);
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +0200604
Holger Hans Peter Freytheraf8094d2013-10-26 17:56:15 +0200605 num_T_exp++;
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +0200606
Holger Hans Peter Freytheraf8094d2013-10-26 17:56:15 +0200607 switch (T) {
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +0200608 case 0: /* assignment */
Holger Hans Peter Freytheraf8094d2013-10-26 17:56:15 +0200609 if ((state_flags & (1 << GPRS_RLCMAC_FLAG_PACCH))) {
610 if (state_is(GPRS_RLCMAC_ASSIGN)) {
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +0100611 LOGP(DRLCMAC, LOGL_NOTICE, "%s releasing due to "
612 "PACCH assignment timeout.\n", tbf_name(this));
Holger Hans Peter Freytheraf8094d2013-10-26 17:56:15 +0200613 tbf_free(this);
Holger Hans Peter Freyther3d0cc2f2014-01-16 10:09:42 +0100614 return;
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +0200615 } else
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +0100616 LOGP(DRLCMAC, LOGL_ERROR, "Error: %s is not "
617 "in assign state\n", tbf_name(this));
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +0200618 }
Holger Hans Peter Freytheraf8094d2013-10-26 17:56:15 +0200619 if ((state_flags & (1 << GPRS_RLCMAC_FLAG_CCCH))) {
Daniel Willmann532a4b52014-08-07 12:39:26 +0200620 gprs_rlcmac_dl_tbf *dl_tbf = static_cast<gprs_rlcmac_dl_tbf *>(this);
621 dl_tbf->dir.dl.wait_confirm = 0;
622 if (dl_tbf->state_is(GPRS_RLCMAC_ASSIGN)) {
623 tbf_assign_control_ts(dl_tbf);
Daniel Willmanncf1fae72014-05-30 17:58:01 +0200624
Daniel Willmann532a4b52014-08-07 12:39:26 +0200625 if (!dl_tbf->upgrade_to_multislot) {
Daniel Willmanncf1fae72014-05-30 17:58:01 +0200626 /* change state to FLOW, so scheduler
627 * will start transmission */
Daniel Willmann532a4b52014-08-07 12:39:26 +0200628 tbf_new_state(dl_tbf, GPRS_RLCMAC_FLOW);
Daniel Willmanncf1fae72014-05-30 17:58:01 +0200629 break;
630 }
631
632 /* This tbf can be upgraded to use multiple DL
633 * timeslots and now that there is already one
634 * slot assigned send another DL assignment via
635 * PDCH. */
636
637 /* keep to flags */
Daniel Willmann532a4b52014-08-07 12:39:26 +0200638 dl_tbf->state_flags &= GPRS_RLCMAC_FLAG_TO_MASK;
639 dl_tbf->state_flags &= ~(1 << GPRS_RLCMAC_FLAG_CCCH);
Daniel Willmanncf1fae72014-05-30 17:58:01 +0200640
Daniel Willmann532a4b52014-08-07 12:39:26 +0200641 dl_tbf->update();
Daniel Willmanncf1fae72014-05-30 17:58:01 +0200642
Daniel Willmann532a4b52014-08-07 12:39:26 +0200643 dl_tbf->bts->trigger_dl_ass(dl_tbf, dl_tbf, NULL);
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +0200644 } else
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +0100645 LOGP(DRLCMAC, LOGL_NOTICE, "%s Continue flow after "
Daniel Willmann532a4b52014-08-07 12:39:26 +0200646 "IMM.ASS confirm\n", tbf_name(dl_tbf));
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +0200647 }
648 break;
649 case 3169:
650 case 3191:
651 case 3195:
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +0100652 LOGP(DRLCMAC, LOGL_NOTICE, "%s T%d timeout during "
653 "transsmission\n", tbf_name(this), T);
Holger Hans Peter Freytheraf8094d2013-10-26 17:56:15 +0200654 rlcmac_diag();
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +0200655 /* fall through */
656 case 3193:
Holger Hans Peter Freyther8d0e4892013-10-27 12:42:58 +0100657 LOGP(DRLCMAC, LOGL_DEBUG,
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +0100658 "%s will be freed due to timeout\n", tbf_name(this));
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +0200659 /* free TBF */
Holger Hans Peter Freytheraf8094d2013-10-26 17:56:15 +0200660 tbf_free(this);
Holger Hans Peter Freyther3d0cc2f2014-01-16 10:09:42 +0100661 return;
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +0200662 break;
663 default:
Holger Hans Peter Freyther8d0e4892013-10-27 12:42:58 +0100664 LOGP(DRLCMAC, LOGL_ERROR,
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +0100665 "%s timer expired in unknown mode: %u\n", tbf_name(this), T);
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +0200666 }
667}
668
669int gprs_rlcmac_tbf::rlcmac_diag()
670{
671 if ((state_flags & (1 << GPRS_RLCMAC_FLAG_CCCH)))
672 LOGP(DRLCMAC, LOGL_NOTICE, "- Assignment was on CCCH\n");
673 if ((state_flags & (1 << GPRS_RLCMAC_FLAG_PACCH)))
674 LOGP(DRLCMAC, LOGL_NOTICE, "- Assignment was on PACCH\n");
675 if ((state_flags & (1 << GPRS_RLCMAC_FLAG_UL_DATA)))
676 LOGP(DRLCMAC, LOGL_NOTICE, "- Uplink data was received\n");
677 else if (direction == GPRS_RLCMAC_UL_TBF)
678 LOGP(DRLCMAC, LOGL_NOTICE, "- No uplink data received yet\n");
679 if ((state_flags & (1 << GPRS_RLCMAC_FLAG_DL_ACK)))
680 LOGP(DRLCMAC, LOGL_NOTICE, "- Downlink ACK was received\n");
681 else if (direction == GPRS_RLCMAC_DL_TBF)
682 LOGP(DRLCMAC, LOGL_NOTICE, "- No downlink ACK received yet\n");
683
684 return 0;
685}
686
Holger Hans Peter Freyther1702f102013-10-20 08:44:02 +0200687struct msgb *gprs_rlcmac_tbf::llc_dequeue(bssgp_bvc_ctx *bctx)
688{
689 struct msgb *msg;
690 struct timeval *tv, tv_now;
691 uint32_t octets = 0, frames = 0;
692
693 gettimeofday(&tv_now, NULL);
694
Holger Hans Peter Freyther758dc122013-11-06 20:39:45 +0100695 while ((msg = m_llc.dequeue())) {
Holger Hans Peter Freyther1702f102013-10-20 08:44:02 +0200696 tv = (struct timeval *)msg->data;
697 msgb_pull(msg, sizeof(*tv));
Daniel Willmann9c623892013-12-04 18:11:47 +0100698 msgb_pull(msg, sizeof(*tv));
Holger Hans Peter Freyther51e093b2013-11-13 15:35:45 +0100699
Holger Hans Peter Freytherb1302b02013-11-13 17:15:26 +0100700 if (gprs_llc::is_frame_expired(&tv_now, tv)) {
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +0100701 LOGP(DRLCMACDL, LOGL_NOTICE, "%s Discarding LLC PDU "
Holger Hans Peter Freyther550bb882013-12-04 17:10:54 +0100702 "because lifetime limit reached. Queue size %zu\n",
703 tbf_name(this), m_llc.m_queue_size);
Holger Hans Peter Freytherb3d5ee22013-11-13 16:43:26 +0100704 bts->llc_timedout_frame();
Holger Hans Peter Freyther1702f102013-10-20 08:44:02 +0200705 frames++;
706 octets += msg->len;
707 msgb_free(msg);
708 continue;
709 }
710 break;
711 }
712
713 if (frames) {
714 if (frames > 0xff)
715 frames = 0xff;
716 if (octets > 0xffffff)
717 octets = 0xffffff;
Holger Hans Peter Freyther474685e2013-10-27 17:01:14 +0100718 bssgp_tx_llc_discarded(bctx, m_tlli, frames, octets);
Holger Hans Peter Freyther1702f102013-10-20 08:44:02 +0200719 }
720
721 return msg;
722}
723
Holger Hans Peter Freytherd11290b2013-10-26 17:32:04 +0200724/*
725 * Store received block data in LLC message(s) and forward to SGSN
726 * if complete.
727 */
Holger Hans Peter Freythere5dc2a02013-11-13 20:10:12 +0100728int gprs_rlcmac_tbf::assemble_forward_llc(const gprs_rlc_data *_data)
Holger Hans Peter Freytherd11290b2013-10-26 17:32:04 +0200729{
Holger Hans Peter Freythere5dc2a02013-11-13 20:10:12 +0100730 const uint8_t *data = _data->block;
731 uint8_t len = _data->len;
732 const struct rlc_ul_header *rh = (const struct rlc_ul_header *) data;
Holger Hans Peter Freytherd11290b2013-10-26 17:32:04 +0200733 uint8_t e, m;
734 struct rlc_li_field *li;
735 uint8_t frame_offset[16], offset = 0, chunk;
736 int i, frames = 0;
737
738 LOGP(DRLCMACUL, LOGL_DEBUG, "- Assembling frames: (len=%d)\n", len);
739
740 data += 3;
741 len -= 3;
742 e = rh->e; /* if extended */
743 m = 1; /* more frames, that means: the first frame */
744
745 /* Parse frame offsets from length indicator(s), if any. */
746 while (1) {
747 if (frames == (int)sizeof(frame_offset)) {
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +0100748 LOGP(DRLCMACUL, LOGL_ERROR, "%s too many frames in "
749 "block\n", tbf_name(this));
Holger Hans Peter Freytherd11290b2013-10-26 17:32:04 +0200750 return -EINVAL;
751 }
752 frame_offset[frames++] = offset;
753 LOGP(DRLCMACUL, LOGL_DEBUG, "-- Frame %d starts at offset "
754 "%d\n", frames, offset);
755 if (!len)
756 break;
757 /* M == 0 and E == 0 is not allowed in this version. */
758 if (!m && !e) {
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +0100759 LOGP(DRLCMACUL, LOGL_NOTICE, "%s UL DATA "
Holger Hans Peter Freytherd11290b2013-10-26 17:32:04 +0200760 "ignored, because M='0' and E='0'.\n",
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +0100761 tbf_name(this));
Holger Hans Peter Freytherd11290b2013-10-26 17:32:04 +0200762 return 0;
763 }
764 /* no more frames in this segment */
765 if (e) {
766 break;
767 }
768 /* There is a new frame and an LI that delimits it. */
769 if (m) {
770 li = (struct rlc_li_field *)data;
771 LOGP(DRLCMACUL, LOGL_DEBUG, "-- Delimiter len=%d\n",
772 li->li);
773 /* Special case: LI == 0
774 * If the last segment would fit precisely into the
775 * rest of the RLC MAC block, there would be no way
776 * to delimit that this segment ends and is not
777 * continued in the next block.
778 * The special LI (0) is used to force the segment to
779 * extend into the next block, so it is delimited there.
780 * This LI must be skipped. Also it is the last LI.
781 */
782 if (li->li == 0) {
783 data++;
784 len--;
785 m = 1; /* M is ignored, we know there is more */
786 break; /* handle E as '1', so we break! */
787 }
788 e = li->e;
789 m = li->m;
790 offset += li->li;
791 data++;
792 len--;
793 continue;
794 }
795 }
796 if (!m) {
797 LOGP(DRLCMACUL, LOGL_DEBUG, "- Last frame carries spare "
798 "data\n");
799 }
800
801 LOGP(DRLCMACUL, LOGL_DEBUG, "- Data length after length fields: %d\n",
802 len);
803 /* TLLI */
804 if (rh->ti) {
805 if (len < 4) {
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +0100806 LOGP(DRLCMACUL, LOGL_NOTICE, "%s UL DATA TLLI out of "
807 "frame border\n", tbf_name(this));
Holger Hans Peter Freytherd11290b2013-10-26 17:32:04 +0200808 return -EINVAL;
809 }
810 data += 4;
811 len -= 4;
812 LOGP(DRLCMACUL, LOGL_DEBUG, "- Length after skipping TLLI: "
813 "%d\n", len);
814 }
815
816 /* PFI */
817 if (rh->pi) {
818 LOGP(DRLCMACUL, LOGL_ERROR, "ERROR: PFI not supported, "
819 "please disable in SYSTEM INFORMATION\n");
820 if (len < 1) {
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +0100821 LOGP(DRLCMACUL, LOGL_NOTICE, "%s UL DATA PFI out of "
822 "frame border\n", tbf_name(this));
Holger Hans Peter Freytherd11290b2013-10-26 17:32:04 +0200823 return -EINVAL;
824 }
825 data++;
826 len--;
827 LOGP(DRLCMACUL, LOGL_DEBUG, "- Length after skipping PFI: "
828 "%d\n", len);
829 }
830
831 /* Now we have:
832 * - a list of frames offsets: frame_offset[]
833 * - number of frames: i
834 * - m == 0: Last frame carries spare data (end of TBF).
835 */
836
837 /* Check if last offset would exceed frame. */
838 if (offset > len) {
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +0100839 LOGP(DRLCMACUL, LOGL_NOTICE, "%s UL DATA ignored, "
Holger Hans Peter Freytherd11290b2013-10-26 17:32:04 +0200840 "because LI delimits data that exceeds block size.\n",
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +0100841 tbf_name(this));
Holger Hans Peter Freytherd11290b2013-10-26 17:32:04 +0200842 return -EINVAL;
843 }
844
845 /* create LLC frames */
846 for (i = 0; i < frames; i++) {
847 /* last frame ? */
848 if (i == frames - 1) {
849 /* no more data in last frame */
850 if (!m)
851 break;
852 /* data until end of frame */
853 chunk = len - frame_offset[i];
854 } else {
855 /* data until next frame */
856 chunk = frame_offset[i + 1] - frame_offset[i];
857 }
Holger Hans Peter Freythere2310262013-11-13 16:56:15 +0100858 if (!m_llc.fits_in_current_frame(chunk)) {
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +0100859 LOGP(DRLCMACUL, LOGL_NOTICE, "%s LLC frame exceeds "
Holger Hans Peter Freythere2310262013-11-13 16:56:15 +0100860 "maximum size %u.\n", tbf_name(this),
861 m_llc.remaining_space());
862 chunk = m_llc.remaining_space();
Holger Hans Peter Freytherd11290b2013-10-26 17:32:04 +0200863 }
Holger Hans Peter Freythere2310262013-11-13 16:56:15 +0100864 m_llc.append_frame(data + frame_offset[i], chunk);
865 m_llc.consume(chunk);
Holger Hans Peter Freytherd11290b2013-10-26 17:32:04 +0200866 /* not last frame. */
867 if (i != frames - 1) {
868 /* send frame to SGSN */
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +0100869 LOGP(DRLCMACUL, LOGL_INFO, "%s complete UL frame len=%d\n",
Holger Hans Peter Freythere2310262013-11-13 16:56:15 +0100870 tbf_name(this) , m_llc.frame_length());
Holger Hans Peter Freyther99485142013-11-06 20:08:42 +0100871 snd_ul_ud();
Holger Hans Peter Freythere2310262013-11-13 16:56:15 +0100872 m_llc.reset();
Holger Hans Peter Freytherd11290b2013-10-26 17:32:04 +0200873 /* also check if CV==0, because the frame may fill up the
874 * block precisely, then it is also complete. normally the
875 * frame would be extended into the next block with a 0-length
876 * delimiter added to this block. */
877 } else if (rh->cv == 0) {
878 /* send frame to SGSN */
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +0100879 LOGP(DRLCMACUL, LOGL_INFO, "%s complete UL frame "
880 "that fits precisely in last block: "
Holger Hans Peter Freythere2310262013-11-13 16:56:15 +0100881 "len=%d\n", tbf_name(this), m_llc.frame_length());
Holger Hans Peter Freyther99485142013-11-06 20:08:42 +0100882 snd_ul_ud();
Holger Hans Peter Freythere2310262013-11-13 16:56:15 +0100883 m_llc.reset();
Holger Hans Peter Freytherd11290b2013-10-26 17:32:04 +0200884 }
885 }
886
887 return 0;
888}
889
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +0200890/*
891 * Create DL data block
892 * The messages are fragmented and forwarded as data blocks.
893 */
Daniel Willmannb8f26012014-07-30 19:12:28 +0200894struct msgb *gprs_rlcmac_dl_tbf::create_dl_acked_block(uint32_t fn, uint8_t ts)
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +0200895{
Holger Hans Peter Freyther34f6e5e2013-10-27 20:31:47 +0100896 LOGP(DRLCMACDL, LOGL_DEBUG, "%s downlink (V(A)==%d .. "
Holger Hans Peter Freytherf1593b72013-11-24 20:36:36 +0100897 "V(S)==%d)\n", tbf_name(this),
898 dir.dl.window.v_a(), dir.dl.window.v_s());
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +0200899
900do_resend:
901 /* check if there is a block with negative acknowledgement */
Daniel Willmann146514e2013-12-28 18:24:42 +0100902 int resend_bsn = dir.dl.window.resend_needed();
Holger Hans Peter Freyther15777792013-11-24 00:18:47 +0100903 if (resend_bsn >= 0) {
904 LOGP(DRLCMACDL, LOGL_DEBUG, "- Resending BSN %d\n", resend_bsn);
Holger Hans Peter Freyther15777792013-11-24 00:18:47 +0100905 /* re-send block with negative aknowlegement */
Daniel Willmann146514e2013-12-28 18:24:42 +0100906 dir.dl.window.m_v_b.mark_unacked(resend_bsn);
Holger Hans Peter Freyther15777792013-11-24 00:18:47 +0100907 bts->rlc_resent();
Holger Hans Peter Freyther3cbf9e02013-11-26 21:43:58 +0100908 return create_dl_acked_block(fn, ts, resend_bsn, false);
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +0200909 }
910
911 /* if the window has stalled, or transfer is complete,
912 * send an unacknowledged block */
Holger Hans Peter Freytherc03e3822013-11-24 00:21:32 +0100913 if (state_is(GPRS_RLCMAC_FINISHED) || dl_window_stalled()) {
Holger Hans Peter Freytheref93bdb2013-11-24 00:01:50 +0100914 if (state_is(GPRS_RLCMAC_FINISHED)) {
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +0200915 LOGP(DRLCMACDL, LOGL_DEBUG, "- Restarting at BSN %d, "
916 "because all blocks have been transmitted.\n",
Holger Hans Peter Freytherf1593b72013-11-24 20:36:36 +0100917 dir.dl.window.v_a());
Holger Hans Peter Freytheref93bdb2013-11-24 00:01:50 +0100918 bts->rlc_restarted();
919 } else {
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +0200920 LOGP(DRLCMACDL, LOGL_NOTICE, "- Restarting at BSN %d, "
921 "because all window is stalled.\n",
Holger Hans Peter Freytherf1593b72013-11-24 20:36:36 +0100922 dir.dl.window.v_a());
Holger Hans Peter Freytherc70aae42013-11-19 17:09:37 +0100923 bts->rlc_stalled();
924 }
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +0200925 /* If V(S) == V(A) and finished state, we would have received
926 * acknowledgement of all transmitted block. In this case we
927 * would have transmitted the final block, and received ack
928 * from MS. But in this case we did not receive the final ack
929 * indication from MS. This should never happen if MS works
930 * correctly. */
Holger Hans Peter Freytherf1593b72013-11-24 20:36:36 +0100931 if (dir.dl.window.window_empty()) {
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +0200932 LOGP(DRLCMACDL, LOGL_DEBUG, "- MS acked all blocks, "
933 "so we re-transmit final block!\n");
934 /* we just send final block again */
Holger Hans Peter Freyther3cbf9e02013-11-26 21:43:58 +0100935 int16_t index = dir.dl.window.v_s_mod(-1);
Holger Hans Peter Freythere9429b52013-11-13 19:36:57 +0100936 bts->rlc_resent();
Holger Hans Peter Freythera6ba67c2013-11-24 00:44:21 +0100937 return create_dl_acked_block(fn, ts, index, false);
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +0200938 }
939
940 /* cycle through all unacked blocks */
Daniel Willmann146514e2013-12-28 18:24:42 +0100941 int resend = dir.dl.window.mark_for_resend();
Holger Hans Peter Freyther8b16ae32013-11-24 00:38:54 +0100942
943 /* At this point there should be at least one unacked block
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +0200944 * to be resent. If not, this is an software error. */
945 if (resend == 0) {
946 LOGP(DRLCMACDL, LOGL_ERROR, "Software error: "
947 "There are no unacknowledged blocks, but V(A) "
948 " != V(S). PLEASE FIX!\n");
949 /* we just send final block again */
Holger Hans Peter Freyther3cbf9e02013-11-26 21:43:58 +0100950 int16_t index = dir.dl.window.v_s_mod(-1);
Holger Hans Peter Freythera6ba67c2013-11-24 00:44:21 +0100951 return create_dl_acked_block(fn, ts, index, false);
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +0200952 }
953 goto do_resend;
954 }
955
Holger Hans Peter Freythera6ba67c2013-11-24 00:44:21 +0100956 return create_new_bsn(fn, ts);
957}
958
Daniel Willmannb8f26012014-07-30 19:12:28 +0200959struct msgb *gprs_rlcmac_dl_tbf::create_new_bsn(const uint32_t fn, const uint8_t ts)
Holger Hans Peter Freythera6ba67c2013-11-24 00:44:21 +0100960{
961 struct rlc_dl_header *rh;
962 struct rlc_li_field *li;
963 struct msgb *msg;
Holger Hans Peter Freythera6ba67c2013-11-24 00:44:21 +0100964 uint8_t *delimiter, *data, *e_pointer;
965 uint16_t space, chunk;
Holger Hans Peter Freyther3cbf9e02013-11-26 21:43:58 +0100966 gprs_rlc_data *rlc_data;
Holger Hans Peter Freythera6ba67c2013-11-24 00:44:21 +0100967 bool first_fin_ack = false;
Holger Hans Peter Freyther3cbf9e02013-11-26 21:43:58 +0100968 const uint16_t bsn = dir.dl.window.v_s();
Holger Hans Peter Freythera6ba67c2013-11-24 00:44:21 +0100969
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +0200970 LOGP(DRLCMACDL, LOGL_DEBUG, "- Sending new block at BSN %d\n",
Holger Hans Peter Freytherf1593b72013-11-24 20:36:36 +0100971 dir.dl.window.v_s());
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +0200972
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +0200973#warning "Selection of the CS doesn't belong here"
974 if (cs == 0) {
975 cs = bts_data()->initial_cs_dl;
976 if (cs < 1 || cs > 4)
977 cs = 1;
978 }
Holger Hans Peter Freyther58db60c2013-11-13 20:45:40 +0100979 /* total length of block, including spare bits */
980 const uint8_t block_length = gprs_rlcmac_cs[cs].block_length;
981 /* length of usable data of block, w/o spare bits, inc. MAC */
982 const uint8_t block_data_len = gprs_rlcmac_cs[cs].block_data;
983
984 /* now we still have untransmitted LLC data, so we fill mac block */
Holger Hans Peter Freyther3cbf9e02013-11-26 21:43:58 +0100985 rlc_data = m_rlc.block(bsn);
986 data = rlc_data->prepare(block_data_len);
Holger Hans Peter Freyther58db60c2013-11-13 20:45:40 +0100987
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +0200988 rh = (struct rlc_dl_header *)data;
989 rh->pt = 0; /* Data Block */
990 rh->rrbp = rh->s_p = 0; /* Polling, set later, if required */
991 rh->usf = 7; /* will be set at scheduler */
992 rh->pr = 0; /* FIXME: power reduction */
Holger Hans Peter Freyther34f6e5e2013-10-27 20:31:47 +0100993 rh->tfi = m_tfi; /* TFI */
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +0200994 rh->fbi = 0; /* Final Block Indicator, set late, if true */
Holger Hans Peter Freyther3cbf9e02013-11-26 21:43:58 +0100995 rh->bsn = bsn; /* Block Sequence Number */
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +0200996 rh->e = 0; /* Extension bit, maybe set later */
997 e_pointer = data + 2; /* points to E of current chunk */
Holger Hans Peter Freyther58db60c2013-11-13 20:45:40 +0100998 data += sizeof(*rh);
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +0200999 delimiter = data; /* where next length header would be stored */
Holger Hans Peter Freyther58db60c2013-11-13 20:45:40 +01001000 space = block_data_len - sizeof(*rh);
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001001 while (1) {
Holger Hans Peter Freytheracb54272013-11-07 08:15:58 +01001002 chunk = m_llc.chunk_size();
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001003 /* if chunk will exceed block limit */
1004 if (chunk > space) {
1005 LOGP(DRLCMACDL, LOGL_DEBUG, "-- Chunk with length %d "
1006 "larger than space (%d) left in block: copy "
1007 "only remaining space, and we are done\n",
1008 chunk, space);
1009 /* block is filled, so there is no extension */
1010 *e_pointer |= 0x01;
1011 /* fill only space */
Holger Hans Peter Freytheracb54272013-11-07 08:15:58 +01001012 m_llc.consume(data, space);
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001013 /* return data block as message */
1014 break;
1015 }
1016 /* if FINAL chunk would fit precisely in space left */
Holger Hans Peter Freyther28e53782013-11-06 20:23:56 +01001017 if (chunk == space && llist_empty(&m_llc.queue)) {
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001018 LOGP(DRLCMACDL, LOGL_DEBUG, "-- Chunk with length %d "
1019 "would exactly fit into space (%d): because "
1020 "this is a final block, we don't add length "
1021 "header, and we are done\n", chunk, space);
1022 LOGP(DRLCMACDL, LOGL_INFO, "Complete DL frame for "
Holger Hans Peter Freyther34f6e5e2013-10-27 20:31:47 +01001023 "%s that fits precisely in last block: "
Holger Hans Peter Freythere2310262013-11-13 16:56:15 +01001024 "len=%d\n", tbf_name(this), m_llc.frame_length());
1025 gprs_rlcmac_dl_bw(this, m_llc.frame_length());
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001026 /* block is filled, so there is no extension */
1027 *e_pointer |= 0x01;
1028 /* fill space */
Holger Hans Peter Freytheracb54272013-11-07 08:15:58 +01001029 m_llc.consume(data, space);
Holger Hans Peter Freyther758dc122013-11-06 20:39:45 +01001030 m_llc.reset();
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001031 /* final block */
1032 rh->fbi = 1; /* we indicate final block */
1033 tbf_new_state(this, GPRS_RLCMAC_FINISHED);
1034 /* return data block as message */
1035 break;
1036 }
1037 /* if chunk would fit exactly in space left */
1038 if (chunk == space) {
1039 LOGP(DRLCMACDL, LOGL_DEBUG, "-- Chunk with length %d "
1040 "would exactly fit into space (%d): add length "
1041 "header with LI=0, to make frame extend to "
1042 "next block, and we are done\n", chunk, space);
1043 /* make space for delimiter */
1044 if (delimiter != data)
Daniel Willmannc3d53252013-11-13 20:27:21 +01001045 memmove(delimiter + 1, delimiter,
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001046 data - delimiter);
1047 data++;
1048 space--;
1049 /* add LI with 0 length */
1050 li = (struct rlc_li_field *)delimiter;
1051 li->e = 1; /* not more extension */
1052 li->m = 0; /* shall be set to 0, in case of li = 0 */
1053 li->li = 0; /* chunk fills the complete space */
1054 // no need to set e_pointer nor increase delimiter
1055 /* fill only space, which is 1 octet less than chunk */
Holger Hans Peter Freytheracb54272013-11-07 08:15:58 +01001056 m_llc.consume(data, space);
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001057 /* return data block as message */
1058 break;
1059 }
1060 LOGP(DRLCMACDL, LOGL_DEBUG, "-- Chunk with length %d is less "
1061 "than remaining space (%d): add length header to "
1062 "to delimit LLC frame\n", chunk, space);
1063 /* the LLC frame chunk ends in this block */
1064 /* make space for delimiter */
1065 if (delimiter != data)
Daniel Willmannc3d53252013-11-13 20:27:21 +01001066 memmove(delimiter + 1, delimiter, data - delimiter);
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001067 data++;
1068 space--;
1069 /* add LI to delimit frame */
1070 li = (struct rlc_li_field *)delimiter;
1071 li->e = 0; /* Extension bit, maybe set later */
1072 li->m = 0; /* will be set later, if there is more LLC data */
1073 li->li = chunk; /* length of chunk */
1074 e_pointer = delimiter; /* points to E of current delimiter */
1075 delimiter++;
Holger Hans Peter Freytheracb54272013-11-07 08:15:58 +01001076 /* copy (rest of) LLC frame to space and reset later */
1077 m_llc.consume(data, chunk);
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001078 data += chunk;
1079 space -= chunk;
Holger Hans Peter Freyther34f6e5e2013-10-27 20:31:47 +01001080 LOGP(DRLCMACDL, LOGL_INFO, "Complete DL frame for %s"
Holger Hans Peter Freythere2310262013-11-13 16:56:15 +01001081 "len=%d\n", tbf_name(this), m_llc.frame_length());
1082 gprs_rlcmac_dl_bw(this, m_llc.frame_length());
Holger Hans Peter Freyther758dc122013-11-06 20:39:45 +01001083 m_llc.reset();
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001084 /* dequeue next LLC frame, if any */
1085 msg = llc_dequeue(gprs_bssgp_pcu_current_bctx());
1086 if (msg) {
1087 LOGP(DRLCMACDL, LOGL_INFO, "- Dequeue next LLC for "
Holger Hans Peter Freyther34f6e5e2013-10-27 20:31:47 +01001088 "%s (len=%d)\n", tbf_name(this), msg->len);
Holger Hans Peter Freyther857281f2013-11-13 14:56:55 +01001089 m_llc.put_frame(msg->data, msg->len);
Holger Hans Peter Freytherb3d5ee22013-11-13 16:43:26 +01001090 bts->llc_frame_sched();
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001091 msgb_free(msg);
1092 }
1093 /* if we have more data and we have space left */
Holger Hans Peter Freythere2310262013-11-13 16:56:15 +01001094 if (space > 0 && m_llc.frame_length()) {
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001095 li->m = 1; /* we indicate more frames to follow */
1096 continue;
1097 }
1098 /* if we don't have more LLC frames */
Holger Hans Peter Freythere2310262013-11-13 16:56:15 +01001099 if (!m_llc.frame_length()) {
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001100 LOGP(DRLCMACDL, LOGL_DEBUG, "-- Final block, so we "
1101 "done.\n");
1102 li->e = 1; /* we cannot extend */
1103 rh->fbi = 1; /* we indicate final block */
Holger Hans Peter Freytherb7840462013-11-07 07:50:26 +01001104 first_fin_ack = true;
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001105 /* + 1 indicates: first final ack */
1106 tbf_new_state(this, GPRS_RLCMAC_FINISHED);
1107 break;
1108 }
1109 /* we have no space left */
1110 LOGP(DRLCMACDL, LOGL_DEBUG, "-- No space left, so we are "
1111 "done.\n");
1112 li->e = 1; /* we cannot extend */
1113 break;
1114 }
1115 LOGP(DRLCMACDL, LOGL_DEBUG, "data block: %s\n",
Holger Hans Peter Freyther3cbf9e02013-11-26 21:43:58 +01001116 osmo_hexdump(rlc_data->block, block_length));
Holger Hans Peter Freyther58db60c2013-11-13 20:45:40 +01001117#warning "move this up?"
Holger Hans Peter Freyther3cbf9e02013-11-26 21:43:58 +01001118 rlc_data->len = block_length;
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001119 /* raise send state and set ack state array */
Daniel Willmann146514e2013-12-28 18:24:42 +01001120 dir.dl.window.m_v_b.mark_unacked(bsn);
Holger Hans Peter Freytherf1593b72013-11-24 20:36:36 +01001121 dir.dl.window.increment_send();
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001122
Holger Hans Peter Freyther3cbf9e02013-11-26 21:43:58 +01001123 return create_dl_acked_block(fn, ts, bsn, first_fin_ack);
Holger Hans Peter Freytherb7840462013-11-07 07:50:26 +01001124}
1125
Daniel Willmannb8f26012014-07-30 19:12:28 +02001126struct msgb *gprs_rlcmac_dl_tbf::create_dl_acked_block(
Holger Hans Peter Freytherb7840462013-11-07 07:50:26 +01001127 const uint32_t fn, const uint8_t ts,
1128 const int index, const bool first_fin_ack)
1129{
1130 uint8_t *data;
1131 struct rlc_dl_header *rh;
1132 struct msgb *dl_msg;
1133 uint8_t len;
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001134
1135 /* get data and header from current block */
Holger Hans Peter Freyther3cbf9e02013-11-26 21:43:58 +01001136 data = m_rlc.block(index)->block;
1137 len = m_rlc.block(index)->len;
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001138 rh = (struct rlc_dl_header *)data;
1139
1140 /* Clear Polling, if still set in history buffer */
1141 rh->s_p = 0;
1142
1143 /* poll after POLL_ACK_AFTER_FRAMES frames, or when final block is tx.
1144 */
1145 if (dir.dl.tx_counter >= POLL_ACK_AFTER_FRAMES || first_fin_ack) {
1146 if (first_fin_ack) {
1147 LOGP(DRLCMACDL, LOGL_DEBUG, "- Scheduling Ack/Nack "
1148 "polling, because first final block sent.\n");
1149 } else {
1150 LOGP(DRLCMACDL, LOGL_DEBUG, "- Scheduling Ack/Nack "
1151 "polling, because %d blocks sent.\n",
1152 POLL_ACK_AFTER_FRAMES);
1153 }
1154 /* scheduling not possible, because: */
1155 if (poll_state != GPRS_RLCMAC_POLL_NONE)
Holger Hans Peter Freythere5109ba2014-01-16 10:11:22 +01001156 LOGP(DRLCMACDL, LOGL_DEBUG, "Polling is already "
Holger Hans Peter Freyther34f6e5e2013-10-27 20:31:47 +01001157 "sheduled for %s, so we must wait for "
1158 "requesting downlink ack\n", tbf_name(this));
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001159 else if (control_ts != ts)
Holger Hans Peter Freythere5109ba2014-01-16 10:11:22 +01001160 LOGP(DRLCMACDL, LOGL_DEBUG, "Polling cannot be "
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001161 "sheduled in this TS %d, waiting for "
1162 "TS %d\n", ts, control_ts);
Holger Hans Peter Freyther58db60c2013-11-13 20:45:40 +01001163#warning "What happens to the first_fin_ack in case something is already scheduled?"
Holger Hans Peter Freytherec80f822013-10-27 13:44:37 +01001164 else if (bts->sba()->find(trx->trx_no, ts, (fn + 13) % 2715648))
Holger Hans Peter Freythere5109ba2014-01-16 10:11:22 +01001165 LOGP(DRLCMACDL, LOGL_DEBUG, "Polling cannot be "
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001166 "sheduled, because single block alllocation "
1167 "already exists\n");
1168 else {
Holger Hans Peter Freythere5109ba2014-01-16 10:11:22 +01001169 LOGP(DRLCMACDL, LOGL_DEBUG, "Polling sheduled in this "
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001170 "TS %d\n", ts);
1171 dir.dl.tx_counter = 0;
1172 /* start timer whenever we send the final block */
1173 if (rh->fbi == 1)
1174 tbf_timer_start(this, 3191, bts_data()->t3191, 0);
1175
1176 /* schedule polling */
1177 poll_state = GPRS_RLCMAC_POLL_SCHED;
1178 poll_fn = (fn + 13) % 2715648;
1179
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001180 /* set polling in header */
1181 rh->rrbp = 0; /* N+13 */
1182 rh->s_p = 1; /* Polling */
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001183 }
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001184 }
1185
1186 /* return data block as message */
1187 dl_msg = msgb_alloc(len, "rlcmac_dl_data");
1188 if (!dl_msg)
1189 return NULL;
Holger Hans Peter Freyther64b49bc2013-11-23 23:16:07 +01001190
1191 /* Increment TX-counter */
1192 dir.dl.tx_counter++;
1193
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001194 memcpy(msgb_put(dl_msg, len), data, len);
Holger Hans Peter Freythere9429b52013-11-13 19:36:57 +01001195 bts->rlc_sent();
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001196
1197 return dl_msg;
1198}
1199
Holger Hans Peter Freyther2db7e7e2013-10-26 20:45:35 +02001200struct msgb *gprs_rlcmac_tbf::create_dl_ass(uint32_t fn)
1201{
1202 struct msgb *msg;
1203 struct gprs_rlcmac_tbf *new_tbf;
Holger Hans Peter Freyther9977e152013-11-24 22:52:10 +01001204 int poll_ass_dl = 1;
Holger Hans Peter Freyther2db7e7e2013-10-26 20:45:35 +02001205
Holger Hans Peter Freyther9977e152013-11-24 22:52:10 +01001206 if (direction == GPRS_RLCMAC_DL_TBF && control_ts != first_common_ts) {
Holger Hans Peter Freyther2db7e7e2013-10-26 20:45:35 +02001207 LOGP(DRLCMAC, LOGL_NOTICE, "Cannot poll for downlink "
1208 "assigment, because MS cannot reply. (control TS=%d, "
1209 "first common TS=%d)\n", control_ts,
1210 first_common_ts);
1211 poll_ass_dl = 0;
1212 }
1213 if (poll_ass_dl) {
1214 if (poll_state != GPRS_RLCMAC_POLL_NONE) {
1215 LOGP(DRLCMAC, LOGL_DEBUG, "Polling is already sheduled "
Holger Hans Peter Freyther34f6e5e2013-10-27 20:31:47 +01001216 "for %s, so we must wait for downlink "
1217 "assignment...\n", tbf_name(this));
Holger Hans Peter Freyther2db7e7e2013-10-26 20:45:35 +02001218 return NULL;
1219 }
Holger Hans Peter Freytherec80f822013-10-27 13:44:37 +01001220 if (bts->sba()->find(trx->trx_no, control_ts, (fn + 13) % 2715648)) {
Holger Hans Peter Freyther2db7e7e2013-10-26 20:45:35 +02001221 LOGP(DRLCMACUL, LOGL_DEBUG, "Polling is already "
1222 "scheduled for single block allocation...\n");
1223 return NULL;
1224 }
1225 }
1226
1227 /* on uplink TBF we get the downlink TBF to be assigned. */
1228 if (direction == GPRS_RLCMAC_UL_TBF) {
1229 /* be sure to check first, if contention resolution is done,
1230 * otherwise we cannot send the assignment yet */
1231 if (!dir.ul.contention_resolution_done) {
1232 LOGP(DRLCMAC, LOGL_DEBUG, "Cannot assign DL TBF now, "
1233 "because contention resolution is not "
1234 "finished.\n");
1235 return NULL;
1236 }
1237 #warning "THIS should probably go over the IMSI too"
Daniel Willmannb59d61b2014-07-02 17:58:14 +02001238 new_tbf = bts->dl_tbf_by_tlli(m_tlli);
Holger Hans Peter Freyther2db7e7e2013-10-26 20:45:35 +02001239 } else
1240 new_tbf = this;
1241 if (!new_tbf) {
1242 LOGP(DRLCMACDL, LOGL_ERROR, "We have a schedule for downlink "
Holger Hans Peter Freyther34f6e5e2013-10-27 20:31:47 +01001243 "assignment at uplink %s, but there is no downlink "
1244 "TBF\n", tbf_name(this));
Holger Hans Peter Freyther2db7e7e2013-10-26 20:45:35 +02001245 dl_ass_state = GPRS_RLCMAC_DL_ASS_NONE;
1246 return NULL;
1247 }
1248
1249 msg = msgb_alloc(23, "rlcmac_dl_ass");
1250 if (!msg)
1251 return NULL;
1252 bitvec *ass_vec = bitvec_alloc(23);
1253 if (!ass_vec) {
1254 msgb_free(msg);
1255 return NULL;
1256 }
1257 bitvec_unhex(ass_vec,
1258 "2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b");
Holger Hans Peter Freyther474685e2013-10-27 17:01:14 +01001259 LOGP(DRLCMAC, LOGL_INFO, "%s start Packet Downlink Assignment (PACCH)\n", tbf_name(new_tbf));
Holger Hans Peter Freyther2db7e7e2013-10-26 20:45:35 +02001260 RlcMacDownlink_t * mac_control_block = (RlcMacDownlink_t *)talloc_zero(tall_pcu_ctx, RlcMacDownlink_t);
Holger Hans Peter Freyther34f6e5e2013-10-27 20:31:47 +01001261 Encoding::write_packet_downlink_assignment(mac_control_block, m_tfi,
Holger Hans Peter Freyther2db7e7e2013-10-26 20:45:35 +02001262 (direction == GPRS_RLCMAC_DL_TBF), new_tbf,
1263 poll_ass_dl, bts_data()->alpha, bts_data()->gamma, -1, 0);
1264 LOGP(DRLCMAC, LOGL_DEBUG, "+++++++++++++++++++++++++ TX : Packet Downlink Assignment +++++++++++++++++++++++++\n");
1265 encode_gsm_rlcmac_downlink(ass_vec, mac_control_block);
1266 LOGPC(DCSN1, LOGL_NOTICE, "\n");
1267 LOGP(DRLCMAC, LOGL_DEBUG, "------------------------- TX : Packet Downlink Assignment -------------------------\n");
1268 bitvec_pack(ass_vec, msgb_put(msg, 23));
1269 bitvec_free(ass_vec);
1270 talloc_free(mac_control_block);
1271
1272 if (poll_ass_dl) {
1273 poll_state = GPRS_RLCMAC_POLL_SCHED;
1274 poll_fn = (fn + 13) % 2715648;
1275 dl_ass_state = GPRS_RLCMAC_DL_ASS_WAIT_ACK;
1276 } else {
1277 dl_ass_state = GPRS_RLCMAC_DL_ASS_NONE;
1278 tbf_new_state(new_tbf, GPRS_RLCMAC_FLOW);
1279 tbf_assign_control_ts(new_tbf);
1280 /* stop pending assignment timer */
1281 new_tbf->stop_timer();
1282
1283 }
Holger Hans Peter Freyther2db7e7e2013-10-26 20:45:35 +02001284
1285 return msg;
1286}
1287
Holger Hans Peter Freytherae03f222013-10-26 21:20:51 +02001288struct msgb *gprs_rlcmac_tbf::create_ul_ass(uint32_t fn)
1289{
1290 struct msgb *msg;
1291 struct gprs_rlcmac_tbf *new_tbf;
1292
Holger Hans Peter Freytherae03f222013-10-26 21:20:51 +02001293 if (poll_state != GPRS_RLCMAC_POLL_NONE) {
1294 LOGP(DRLCMACUL, LOGL_DEBUG, "Polling is already "
Holger Hans Peter Freyther34f6e5e2013-10-27 20:31:47 +01001295 "sheduled for %s, so we must wait for uplink "
1296 "assignment...\n", tbf_name(this));
Holger Hans Peter Freytherae03f222013-10-26 21:20:51 +02001297 return NULL;
1298 }
Holger Hans Peter Freytherec80f822013-10-27 13:44:37 +01001299 if (bts->sba()->find(trx->trx_no, control_ts, (fn + 13) % 2715648)) {
Holger Hans Peter Freytherae03f222013-10-26 21:20:51 +02001300 LOGP(DRLCMACUL, LOGL_DEBUG, "Polling is already scheduled for "
1301 "single block allocation...\n");
1302 return NULL;
1303 }
Holger Hans Peter Freytherae03f222013-10-26 21:20:51 +02001304
1305 /* on down TBF we get the uplink TBF to be assigned. */
1306#warning "Probably want to find by IMSI too"
1307 if (direction == GPRS_RLCMAC_DL_TBF)
Daniel Willmannb59d61b2014-07-02 17:58:14 +02001308 new_tbf = bts->ul_tbf_by_tlli(m_tlli);
Holger Hans Peter Freytherae03f222013-10-26 21:20:51 +02001309 else
1310 new_tbf = this;
1311
1312 if (!new_tbf) {
1313 LOGP(DRLCMACUL, LOGL_ERROR, "We have a schedule for uplink "
Holger Hans Peter Freyther34f6e5e2013-10-27 20:31:47 +01001314 "assignment at downlink %s, but there is no uplink "
1315 "TBF\n", tbf_name(this));
Holger Hans Peter Freytherae03f222013-10-26 21:20:51 +02001316 ul_ass_state = GPRS_RLCMAC_UL_ASS_NONE;
1317 return NULL;
1318 }
1319
1320 msg = msgb_alloc(23, "rlcmac_ul_ass");
1321 if (!msg)
1322 return NULL;
Holger Hans Peter Freyther474685e2013-10-27 17:01:14 +01001323 LOGP(DRLCMAC, LOGL_INFO, "%ss start Packet Uplink Assignment (PACCH)\n", tbf_name(new_tbf));
Holger Hans Peter Freytherae03f222013-10-26 21:20:51 +02001324 bitvec *ass_vec = bitvec_alloc(23);
1325 if (!ass_vec) {
1326 msgb_free(msg);
1327 return NULL;
1328 }
1329 bitvec_unhex(ass_vec,
1330 "2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b");
Holger Hans Peter Freyther34f6e5e2013-10-27 20:31:47 +01001331 Encoding::write_packet_uplink_assignment(bts_data(), ass_vec, m_tfi,
Holger Hans Peter Freyther474685e2013-10-27 17:01:14 +01001332 (direction == GPRS_RLCMAC_DL_TBF), m_tlli,
Holger Hans Peter Freyther9977e152013-11-24 22:52:10 +01001333 m_tlli_valid, new_tbf, 1, bts_data()->alpha,
Holger Hans Peter Freytherae03f222013-10-26 21:20:51 +02001334 bts_data()->gamma, -1);
1335 bitvec_pack(ass_vec, msgb_put(msg, 23));
1336 RlcMacDownlink_t * mac_control_block = (RlcMacDownlink_t *)talloc_zero(tall_pcu_ctx, RlcMacDownlink_t);
1337 LOGP(DRLCMAC, LOGL_DEBUG, "+++++++++++++++++++++++++ TX : Packet Uplink Assignment +++++++++++++++++++++++++\n");
1338 decode_gsm_rlcmac_downlink(ass_vec, mac_control_block);
1339 LOGPC(DCSN1, LOGL_NOTICE, "\n");
1340 LOGP(DRLCMAC, LOGL_DEBUG, "------------------------- TX : Packet Uplink Assignment -------------------------\n");
1341 bitvec_free(ass_vec);
1342 talloc_free(mac_control_block);
1343
Holger Hans Peter Freytherae03f222013-10-26 21:20:51 +02001344 poll_state = GPRS_RLCMAC_POLL_SCHED;
1345 poll_fn = (fn + 13) % 2715648;
1346 ul_ass_state = GPRS_RLCMAC_UL_ASS_WAIT_ACK;
Holger Hans Peter Freytherae03f222013-10-26 21:20:51 +02001347
1348 return msg;
1349}
1350
Holger Hans Peter Freyther46bcb8d2013-10-26 21:04:28 +02001351struct msgb *gprs_rlcmac_tbf::create_ul_ack(uint32_t fn)
1352{
1353 int final = (state_is(GPRS_RLCMAC_FINISHED));
1354 struct msgb *msg;
1355
1356 if (final) {
1357 if (poll_state != GPRS_RLCMAC_POLL_NONE) {
1358 LOGP(DRLCMACUL, LOGL_DEBUG, "Polling is already "
Holger Hans Peter Freyther34f6e5e2013-10-27 20:31:47 +01001359 "sheduled for %s, so we must wait for "
1360 "final uplink ack...\n", tbf_name(this));
Holger Hans Peter Freyther46bcb8d2013-10-26 21:04:28 +02001361 return NULL;
1362 }
Holger Hans Peter Freytherec80f822013-10-27 13:44:37 +01001363 if (bts->sba()->find(trx->trx_no, control_ts, (fn + 13) % 2715648)) {
Holger Hans Peter Freyther46bcb8d2013-10-26 21:04:28 +02001364 LOGP(DRLCMACUL, LOGL_DEBUG, "Polling is already "
1365 "scheduled for single block allocation...\n");
1366 return NULL;
1367 }
1368 }
1369
1370 msg = msgb_alloc(23, "rlcmac_ul_ack");
1371 if (!msg)
1372 return NULL;
1373 bitvec *ack_vec = bitvec_alloc(23);
1374 if (!ack_vec) {
1375 msgb_free(msg);
1376 return NULL;
1377 }
1378 bitvec_unhex(ack_vec,
1379 "2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b");
1380 RlcMacDownlink_t * mac_control_block = (RlcMacDownlink_t *)talloc_zero(tall_pcu_ctx, RlcMacDownlink_t);
1381 Encoding::write_packet_uplink_ack(bts_data(), mac_control_block, this, final);
1382 encode_gsm_rlcmac_downlink(ack_vec, mac_control_block);
1383 bitvec_pack(ack_vec, msgb_put(msg, 23));
1384 bitvec_free(ack_vec);
1385 talloc_free(mac_control_block);
1386
1387 /* now we must set this flag, so we are allowed to assign downlink
Holger Hans Peter Freyther22b31192013-10-26 21:07:45 +02001388 * TBF on PACCH. it is only allowed when TLLI is acknowledged. */
Holger Hans Peter Freyther46bcb8d2013-10-26 21:04:28 +02001389 dir.ul.contention_resolution_done = 1;
1390
1391 if (final) {
1392 poll_state = GPRS_RLCMAC_POLL_SCHED;
1393 poll_fn = (fn + 13) % 2715648;
1394 /* waiting for final acknowledge */
1395 ul_ack_state = GPRS_RLCMAC_UL_ACK_WAIT_ACK;
1396 dir.ul.final_ack_sent = 1;
1397 } else
1398 ul_ack_state = GPRS_RLCMAC_UL_ACK_NONE;
Holger Hans Peter Freyther46bcb8d2013-10-26 21:04:28 +02001399
1400 return msg;
1401}
1402
Holger Hans Peter Freyther86dc3552013-11-24 17:28:49 +01001403int gprs_rlcmac_tbf::update_window(const uint8_t ssn, const uint8_t *rbb)
Holger Hans Peter Freyther3dc56a32013-10-26 21:38:30 +02001404{
Holger Hans Peter Freyther3dc56a32013-10-26 21:38:30 +02001405 int16_t dist; /* must be signed */
Holger Hans Peter Freyther86dc3552013-11-24 17:28:49 +01001406 uint16_t lost = 0, received = 0;
Holger Hans Peter Freyther86dc3552013-11-24 17:28:49 +01001407 char show_rbb[65];
1408 char show_v_b[RLC_MAX_SNS + 1];
Holger Hans Peter Freytherf1593b72013-11-24 20:36:36 +01001409 const uint16_t mod_sns = dir.dl.window.mod_sns();
Holger Hans Peter Freyther86dc3552013-11-24 17:28:49 +01001410
1411 Decoding::extract_rbb(rbb, show_rbb);
1412 /* show received array in debug (bit 64..1) */
1413 LOGP(DRLCMACDL, LOGL_DEBUG, "- ack: (BSN=%d)\"%s\""
Daniel Willmann6f7cb2c2013-12-11 14:25:20 +01001414 "(BSN=%d) R=ACK I=NACK\n", (ssn - 64) & mod_sns,
Holger Hans Peter Freyther86dc3552013-11-24 17:28:49 +01001415 show_rbb, (ssn - 1) & mod_sns);
1416
1417 /* apply received array to receive state (SSN-64..SSN-1) */
1418 /* calculate distance of ssn from V(S) */
Holger Hans Peter Freytherf1593b72013-11-24 20:36:36 +01001419 dist = (dir.dl.window.v_s() - ssn) & mod_sns;
Holger Hans Peter Freyther86dc3552013-11-24 17:28:49 +01001420 /* check if distance is less than distance V(A)..V(S) */
Holger Hans Peter Freytherf1593b72013-11-24 20:36:36 +01001421 if (dist >= dir.dl.window.distance()) {
Holger Hans Peter Freyther86dc3552013-11-24 17:28:49 +01001422 /* this might happpen, if the downlink assignment
1423 * was not received by ms and the ack refers
1424 * to previous TBF
1425 * FIXME: we should implement polling for
1426 * control ack!*/
1427 LOGP(DRLCMACDL, LOGL_NOTICE, "- ack range is out of "
1428 "V(A)..V(S) range %s Free TBF!\n", tbf_name(this));
1429 return 1; /* indicate to free TBF */
1430 }
1431
Daniel Willmann146514e2013-12-28 18:24:42 +01001432 dir.dl.window.update(bts, show_rbb, ssn,
Holger Hans Peter Freytherf1593b72013-11-24 20:36:36 +01001433 &lost, &received);
Holger Hans Peter Freyther86dc3552013-11-24 17:28:49 +01001434
1435 /* report lost and received packets */
1436 gprs_rlcmac_received_lost(this, received, lost);
1437
1438 /* raise V(A), if possible */
Daniel Willmann146514e2013-12-28 18:24:42 +01001439 dir.dl.window.raise(dir.dl.window.move_window());
Holger Hans Peter Freyther86dc3552013-11-24 17:28:49 +01001440
1441 /* show receive state array in debug (V(A)..V(S)-1) */
Daniel Willmann3ce011f2014-01-15 12:45:56 +01001442 dir.dl.window.show_state(show_v_b);
Holger Hans Peter Freyther86dc3552013-11-24 17:28:49 +01001443 LOGP(DRLCMACDL, LOGL_DEBUG, "- V(B): (V(A)=%d)\"%s\""
1444 "(V(S)-1=%d) A=Acked N=Nacked U=Unacked "
Holger Hans Peter Freytherf1593b72013-11-24 20:36:36 +01001445 "X=Resend-Unacked I=Invalid\n",
1446 dir.dl.window.v_a(), show_v_b,
1447 dir.dl.window.v_s_mod(-1));
Holger Hans Peter Freyther86dc3552013-11-24 17:28:49 +01001448
Holger Hans Peter Freytherf1593b72013-11-24 20:36:36 +01001449 if (state_is(GPRS_RLCMAC_FINISHED) && dir.dl.window.window_empty()) {
Holger Hans Peter Freyther86dc3552013-11-24 17:28:49 +01001450 LOGP(DRLCMACDL, LOGL_NOTICE, "Received acknowledge of "
1451 "all blocks, but without final ack "
1452 "inidcation (don't worry)\n");
1453 }
1454 return 0;
1455}
1456
1457
1458int gprs_rlcmac_tbf::maybe_start_new_window()
1459{
Holger Hans Peter Freyther3dc56a32013-10-26 21:38:30 +02001460 struct msgb *msg;
Holger Hans Peter Freyther9c5539d2013-11-24 17:34:17 +01001461 uint16_t received;
Holger Hans Peter Freyther3dc56a32013-10-26 21:38:30 +02001462
Holger Hans Peter Freyther3dc56a32013-10-26 21:38:30 +02001463 LOGP(DRLCMACDL, LOGL_DEBUG, "- Final ACK received.\n");
Holger Hans Peter Freyther3dc56a32013-10-26 21:38:30 +02001464 /* range V(A)..V(S)-1 */
Daniel Willmann146514e2013-12-28 18:24:42 +01001465 received = dir.dl.window.count_unacked();
Holger Hans Peter Freyther3dc56a32013-10-26 21:38:30 +02001466
1467 /* report all outstanding packets as received */
Holger Hans Peter Freyther9c5539d2013-11-24 17:34:17 +01001468 gprs_rlcmac_received_lost(this, received, 0);
Holger Hans Peter Freyther3dc56a32013-10-26 21:38:30 +02001469
Daniel Willmann73191a42014-05-30 17:58:00 +02001470 tbf_new_state(this, GPRS_RLCMAC_WAIT_RELEASE);
1471
Holger Hans Peter Freyther3dc56a32013-10-26 21:38:30 +02001472 /* check for LLC PDU in the LLC Queue */
1473 msg = llc_dequeue(gprs_bssgp_pcu_current_bctx());
1474 if (!msg) {
1475 /* no message, start T3193, change state to RELEASE */
Holger Hans Peter Freyther86dc3552013-11-24 17:28:49 +01001476 LOGP(DRLCMACDL, LOGL_DEBUG, "- No new message, so we release.\n");
Holger Hans Peter Freyther3dc56a32013-10-26 21:38:30 +02001477 /* start T3193 */
Holger Hans Peter Freyther3dc56a32013-10-26 21:38:30 +02001478 tbf_timer_start(this, 3193,
1479 bts_data()->t3193_msec / 1000,
1480 (bts_data()->t3193_msec % 1000) * 1000);
Holger Hans Peter Freyther3dc56a32013-10-26 21:38:30 +02001481
1482 return 0;
1483 }
Holger Hans Peter Freyther3dc56a32013-10-26 21:38:30 +02001484
Holger Hans Peter Freyther55cf9942013-11-13 18:15:45 +01001485 /* we have more data so we will re-use this tbf */
1486 reuse_tbf(msg->data, msg->len);
1487 msgb_free(msg);
Holger Hans Peter Freyther3dc56a32013-10-26 21:38:30 +02001488 return 0;
1489}
1490
Daniel Willmann6c813fc2014-07-30 19:12:27 +02001491int gprs_rlcmac_dl_tbf::rcvd_dl_ack(uint8_t final_ack, uint8_t ssn, uint8_t *rbb)
Holger Hans Peter Freyther86dc3552013-11-24 17:28:49 +01001492{
1493 LOGP(DRLCMACDL, LOGL_DEBUG, "%s downlink acknowledge\n", tbf_name(this));
1494
1495 if (!final_ack)
1496 return update_window(ssn, rbb);
1497 return maybe_start_new_window();
1498}
1499
Holger Hans Peter Freyther964ddb62013-10-16 17:53:23 +02001500void gprs_rlcmac_tbf::free_all(struct gprs_rlcmac_trx *trx)
1501{
1502 for (uint8_t tfi = 0; tfi < 32; tfi++) {
1503 struct gprs_rlcmac_tbf *tbf;
1504
1505 tbf = trx->ul_tbf[tfi];
1506 if (tbf)
1507 tbf_free(tbf);
1508 tbf = trx->dl_tbf[tfi];
1509 if (tbf)
1510 tbf_free(tbf);
1511 }
1512}
Holger Hans Peter Freyther4f6a4e5d2013-10-16 17:58:46 +02001513
1514void gprs_rlcmac_tbf::free_all(struct gprs_rlcmac_pdch *pdch)
1515{
1516 for (uint8_t tfi = 0; tfi < 32; tfi++) {
1517 struct gprs_rlcmac_tbf *tbf;
1518
Daniel Willmann17a1d5e2014-05-30 20:21:30 +02001519 tbf = pdch->ul_tbf_by_tfi(tfi);
Holger Hans Peter Freyther4f6a4e5d2013-10-16 17:58:46 +02001520 if (tbf)
1521 tbf_free(tbf);
Daniel Willmann17a1d5e2014-05-30 20:21:30 +02001522 tbf = pdch->dl_tbf_by_tfi(tfi);
Holger Hans Peter Freyther4f6a4e5d2013-10-16 17:58:46 +02001523 if (tbf)
1524 tbf_free(tbf);
1525 }
1526}
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +01001527
Holger Hans Peter Freyther474685e2013-10-27 17:01:14 +01001528void gprs_rlcmac_tbf::tlli_mark_valid()
1529{
1530 m_tlli_valid = true;
1531}
1532
1533void gprs_rlcmac_tbf::update_tlli(uint32_t tlli)
1534{
1535 if (tlli == m_tlli)
1536 return;
1537
Holger Hans Peter Freytherb8098662013-10-30 14:50:17 +01001538 bool changedUl = false;
1539
1540 /*
1541 * During a Routing Area Update (due the assignment of a new
1542 * P-TMSI) the tlli can change. We notice this when receiving
1543 * a PACKET CONTROL ACK.
1544 * When we get a TLLI change on the DL we will look if there
1545 * is a UL TBF and change the tlli there as well.
1546 *
1547 * TODO: There could be multiple DL and UL TBFs and we should
1548 * have a proper way to link all the related TBFs so we can do
1549 * a group update.
1550 */
1551 if (m_tlli_valid && direction == GPRS_RLCMAC_DL_TBF) {
1552 gprs_rlcmac_tbf *ul_tbf;
Daniel Willmannb59d61b2014-07-02 17:58:14 +02001553 ul_tbf = bts->ul_tbf_by_tlli(m_tlli);
Holger Hans Peter Freytherb8098662013-10-30 14:50:17 +01001554
1555 if (ul_tbf) {
1556 ul_tbf->m_tlli = tlli;
1557 changedUl = true;
1558 }
1559 }
1560
Holger Hans Peter Freytherbc1626e2013-10-30 19:50:49 +01001561 /* update the timing advance for the new tlli */
1562 bts->timing_advance()->update(m_tlli, tlli, ta);
1563
Holger Hans Peter Freytherb8098662013-10-30 14:50:17 +01001564 LOGP(DRLCMAC, LOGL_NOTICE,
1565 "%s changing tlli from TLLI=0x%08x TLLI=0x%08x ul_changed=%d\n",
1566 tbf_name(this), m_tlli, tlli, changedUl);
Holger Hans Peter Freyther474685e2013-10-27 17:01:14 +01001567 m_tlli = tlli;
1568}
1569
Holger Hans Peter Freyther4c06d912013-11-25 23:05:26 +01001570int gprs_rlcmac_tbf::extract_tlli(const uint8_t *data, const size_t len)
1571{
1572 struct gprs_rlcmac_tbf *dl_tbf, *ul_tbf;
1573 struct rlc_ul_header *rh = (struct rlc_ul_header *)data;
1574 uint32_t new_tlli;
1575 int rc;
1576
1577 /* no TLLI yet */
1578 if (!rh->ti) {
1579 LOGP(DRLCMACUL, LOGL_NOTICE, "UL DATA TFI=%d without "
1580 "TLLI, but no TLLI received yet\n", rh->tfi);
1581 return 0;
1582 }
1583 rc = Decoding::tlli_from_ul_data(data, len, &new_tlli);
1584 if (rc) {
1585 bts->decode_error();
1586 LOGP(DRLCMACUL, LOGL_NOTICE, "Failed to decode TLLI "
1587 "of UL DATA TFI=%d.\n", rh->tfi);
1588 return 0;
1589 }
1590 update_tlli(new_tlli);
1591 LOGP(DRLCMACUL, LOGL_INFO, "Decoded premier TLLI=0x%08x of "
1592 "UL DATA TFI=%d.\n", tlli(), rh->tfi);
Daniel Willmannb59d61b2014-07-02 17:58:14 +02001593 if ((dl_tbf = bts->dl_tbf_by_tlli(tlli()))) {
Holger Hans Peter Freyther4c06d912013-11-25 23:05:26 +01001594 LOGP(DRLCMACUL, LOGL_NOTICE, "Got RACH from "
1595 "TLLI=0x%08x while %s still exists. "
1596 "Killing pending DL TBF\n", tlli(),
1597 tbf_name(dl_tbf));
1598 tbf_free(dl_tbf);
Holger Hans Peter Freyther3d0cc2f2014-01-16 10:09:42 +01001599 dl_tbf = NULL;
Holger Hans Peter Freyther4c06d912013-11-25 23:05:26 +01001600 }
Daniel Willmannb59d61b2014-07-02 17:58:14 +02001601 /* ul_tbf_by_tlli will not find your TLLI, because it is not
Holger Hans Peter Freyther4c06d912013-11-25 23:05:26 +01001602 * yet marked valid */
Daniel Willmannb59d61b2014-07-02 17:58:14 +02001603 if ((ul_tbf = bts->ul_tbf_by_tlli(tlli()))) {
Holger Hans Peter Freyther4c06d912013-11-25 23:05:26 +01001604 LOGP(DRLCMACUL, LOGL_NOTICE, "Got RACH from "
1605 "TLLI=0x%08x while %s still exists. "
1606 "Killing pending UL TBF\n", tlli(),
1607 tbf_name(ul_tbf));
1608 tbf_free(ul_tbf);
Holger Hans Peter Freyther3d0cc2f2014-01-16 10:09:42 +01001609 ul_tbf = NULL;
Holger Hans Peter Freyther4c06d912013-11-25 23:05:26 +01001610 }
1611 /* mark TLLI valid now */
1612 tlli_mark_valid();
1613 /* store current timing advance */
1614 bts->timing_advance()->remember(tlli(), ta);
1615 return 1;
1616}
1617
Holger Hans Peter Freyther77e05972013-11-06 19:16:43 +01001618int gprs_rlcmac_tbf::rcv_data_block_acknowledged(const uint8_t *data, size_t len, int8_t rssi)
1619{
Holger Hans Peter Freyther77e05972013-11-06 19:16:43 +01001620 struct rlc_ul_header *rh = (struct rlc_ul_header *)data;
1621 int rc;
1622
Holger Hans Peter Freytherf1593b72013-11-24 20:36:36 +01001623 const uint16_t mod_sns = dir.ul.window.mod_sns();
Holger Hans Peter Freytherf1593b72013-11-24 20:36:36 +01001624 const uint16_t ws = dir.ul.window.ws();
1625
Holger Hans Peter Freyther77e05972013-11-06 19:16:43 +01001626 this->state_flags |= (1 << GPRS_RLCMAC_FLAG_UL_DATA);
1627
1628 LOGP(DRLCMACUL, LOGL_DEBUG, "UL DATA TFI=%d received (V(Q)=%d .. "
Holger Hans Peter Freytherf1593b72013-11-24 20:36:36 +01001629 "V(R)=%d)\n", rh->tfi, this->dir.ul.window.v_q(),
1630 this->dir.ul.window.v_r());
Holger Hans Peter Freyther77e05972013-11-06 19:16:43 +01001631
1632 /* process RSSI */
1633 gprs_rlcmac_rssi(this, rssi);
1634
1635 /* get TLLI */
1636 if (!this->is_tlli_valid()) {
Holger Hans Peter Freyther4c06d912013-11-25 23:05:26 +01001637 if (!extract_tlli(data, len))
Holger Hans Peter Freyther77e05972013-11-06 19:16:43 +01001638 return 0;
Holger Hans Peter Freyther77e05972013-11-06 19:16:43 +01001639 /* already have TLLI, but we stille get another one */
1640 } else if (rh->ti) {
1641 uint32_t tlli;
1642 rc = Decoding::tlli_from_ul_data(data, len, &tlli);
1643 if (rc) {
1644 LOGP(DRLCMACUL, LOGL_NOTICE, "Failed to decode TLLI "
1645 "of UL DATA TFI=%d.\n", rh->tfi);
1646 return 0;
1647 }
1648 if (tlli != this->tlli()) {
1649 LOGP(DRLCMACUL, LOGL_NOTICE, "TLLI mismatch on UL "
1650 "DATA TFI=%d. (Ignoring due to contention "
1651 "resolution)\n", rh->tfi);
1652 return 0;
1653 }
1654 }
1655
Holger Hans Peter Freyther77e05972013-11-06 19:16:43 +01001656 /* restart T3169 */
1657 tbf_timer_start(this, 3169, bts_data()->t3169, 0);
1658
1659 /* Increment RX-counter */
1660 this->dir.ul.rx_counter++;
1661
Holger Hans Peter Freyther6ab5b242013-11-24 22:43:03 +01001662 if (!dir.ul.window.is_in_window(rh->bsn)) {
Holger Hans Peter Freyther77e05972013-11-06 19:16:43 +01001663 LOGP(DRLCMACUL, LOGL_DEBUG, "- BSN %d out of window "
Holger Hans Peter Freytherf1593b72013-11-24 20:36:36 +01001664 "%d..%d (it's normal)\n", rh->bsn,
1665 dir.ul.window.v_q(),
1666 (dir.ul.window.v_q() + ws - 1) & mod_sns);
Holger Hans Peter Freyther3c957762013-11-26 21:03:56 +01001667 maybe_schedule_uplink_acknack(rh);
Holger Hans Peter Freyther77e05972013-11-06 19:16:43 +01001668 return 0;
1669 }
Holger Hans Peter Freyther6ab5b242013-11-24 22:43:03 +01001670
Holger Hans Peter Freyther77e05972013-11-06 19:16:43 +01001671 /* Write block to buffer and set receive state array. */
Holger Hans Peter Freyther3cbf9e02013-11-26 21:43:58 +01001672 m_rlc.block(rh->bsn)->put_data(data, len);
Holger Hans Peter Freyther77e05972013-11-06 19:16:43 +01001673 LOGP(DRLCMACUL, LOGL_DEBUG, "- BSN %d storing in window (%d..%d)\n",
Holger Hans Peter Freytherf1593b72013-11-24 20:36:36 +01001674 rh->bsn, dir.ul.window.v_q(),
1675 (dir.ul.window.v_q() + ws - 1) & mod_sns);
Holger Hans Peter Freyther9977e152013-11-24 22:52:10 +01001676
Holger Hans Peter Freyther77e05972013-11-06 19:16:43 +01001677 /* Raise V(Q) if possible, and retrieve LLC frames from blocks.
1678 * This is looped until there is a gap (non received block) or
1679 * the window is empty.*/
Holger Hans Peter Freyther7f3e6622013-11-25 23:51:19 +01001680 const uint16_t v_q_beg = dir.ul.window.v_q();
Daniel Willmann55844792013-12-28 14:41:00 +01001681
1682 const uint16_t count = dir.ul.window.receive_bsn(rh->bsn);
Holger Hans Peter Freyther7f3e6622013-11-25 23:51:19 +01001683
1684 /* Retrieve LLC frames from blocks that are ready */
1685 for (uint16_t i = 0; i < count; ++i) {
Holger Hans Peter Freyther3cbf9e02013-11-26 21:43:58 +01001686 uint16_t index = (v_q_beg + i) & mod_sns;
1687 assemble_forward_llc(m_rlc.block(index));
Holger Hans Peter Freyther77e05972013-11-06 19:16:43 +01001688 }
1689
1690 /* Check CV of last frame in buffer */
1691 if (this->state_is(GPRS_RLCMAC_FLOW) /* still in flow state */
Holger Hans Peter Freytherf1593b72013-11-24 20:36:36 +01001692 && this->dir.ul.window.v_q() == this->dir.ul.window.v_r()) { /* if complete */
Holger Hans Peter Freyther77e05972013-11-06 19:16:43 +01001693 struct rlc_ul_header *last_rh = (struct rlc_ul_header *)
Holger Hans Peter Freyther3cbf9e02013-11-26 21:43:58 +01001694 m_rlc.block((dir.ul.window.v_r() - 1) & mod_sns)->block;
Holger Hans Peter Freyther77e05972013-11-06 19:16:43 +01001695 LOGP(DRLCMACUL, LOGL_DEBUG, "- No gaps in received block, "
1696 "last block: BSN=%d CV=%d\n", last_rh->bsn,
1697 last_rh->cv);
1698 if (last_rh->cv == 0) {
1699 LOGP(DRLCMACUL, LOGL_DEBUG, "- Finished with UL "
1700 "TBF\n");
1701 tbf_new_state(this, GPRS_RLCMAC_FINISHED);
1702 /* Reset N3103 counter. */
1703 this->dir.ul.n3103 = 0;
1704 }
1705 }
1706
1707 /* If TLLI is included or if we received half of the window, we send
1708 * an ack/nack */
Holger Hans Peter Freyther3c957762013-11-26 21:03:56 +01001709 maybe_schedule_uplink_acknack(rh);
1710
1711 return 0;
1712}
1713
1714void gprs_rlcmac_tbf::maybe_schedule_uplink_acknack(const rlc_ul_header *rh)
1715{
1716 if (rh->si || rh->ti || state_is(GPRS_RLCMAC_FINISHED)
1717 || (dir.ul.rx_counter % SEND_ACK_AFTER_FRAMES) == 0) {
Holger Hans Peter Freyther77e05972013-11-06 19:16:43 +01001718 if (rh->si) {
1719 LOGP(DRLCMACUL, LOGL_NOTICE, "- Scheduling Ack/Nack, "
1720 "because MS is stalled.\n");
1721 }
1722 if (rh->ti) {
1723 LOGP(DRLCMACUL, LOGL_DEBUG, "- Scheduling Ack/Nack, "
1724 "because TLLI is included.\n");
1725 }
Holger Hans Peter Freyther3c957762013-11-26 21:03:56 +01001726 if (state_is(GPRS_RLCMAC_FINISHED)) {
Holger Hans Peter Freyther77e05972013-11-06 19:16:43 +01001727 LOGP(DRLCMACUL, LOGL_DEBUG, "- Scheduling Ack/Nack, "
1728 "because last block has CV==0.\n");
1729 }
Holger Hans Peter Freyther3c957762013-11-26 21:03:56 +01001730 if ((dir.ul.rx_counter % SEND_ACK_AFTER_FRAMES) == 0) {
Holger Hans Peter Freyther77e05972013-11-06 19:16:43 +01001731 LOGP(DRLCMACUL, LOGL_DEBUG, "- Scheduling Ack/Nack, "
1732 "because %d frames received.\n",
1733 SEND_ACK_AFTER_FRAMES);
1734 }
Holger Hans Peter Freyther3c957762013-11-26 21:03:56 +01001735 if (ul_ack_state == GPRS_RLCMAC_UL_ACK_NONE) {
Holger Hans Peter Freyther77e05972013-11-06 19:16:43 +01001736 /* trigger sending at next RTS */
Holger Hans Peter Freyther3c957762013-11-26 21:03:56 +01001737 ul_ack_state = GPRS_RLCMAC_UL_ACK_SEND_ACK;
Holger Hans Peter Freyther77e05972013-11-06 19:16:43 +01001738 } else {
1739 /* already triggered */
1740 LOGP(DRLCMACUL, LOGL_DEBUG, "- Sending Ack/Nack is "
1741 "already triggered, don't schedule!\n");
1742 }
1743 }
Holger Hans Peter Freyther77e05972013-11-06 19:16:43 +01001744}
1745
Holger Hans Peter Freyther99485142013-11-06 20:08:42 +01001746/* Send Uplink unit-data to SGSN. */
1747int gprs_rlcmac_tbf::snd_ul_ud()
1748{
1749 uint8_t qos_profile[3];
1750 struct msgb *llc_pdu;
Holger Hans Peter Freythere2310262013-11-13 16:56:15 +01001751 unsigned msg_len = NS_HDR_LEN + BSSGP_HDR_LEN + m_llc.frame_length();
Holger Hans Peter Freyther99485142013-11-06 20:08:42 +01001752 struct bssgp_bvc_ctx *bctx = gprs_bssgp_pcu_current_bctx();
1753
Holger Hans Peter Freythere2310262013-11-13 16:56:15 +01001754 LOGP(DBSSGP, LOGL_INFO, "LLC [PCU -> SGSN] %s len=%d\n", tbf_name(this), m_llc.frame_length());
Holger Hans Peter Freyther99485142013-11-06 20:08:42 +01001755 if (!bctx) {
1756 LOGP(DBSSGP, LOGL_ERROR, "No bctx\n");
Holger Hans Peter Freyther758dc122013-11-06 20:39:45 +01001757 m_llc.reset_frame_space();
Holger Hans Peter Freyther99485142013-11-06 20:08:42 +01001758 return -EIO;
1759 }
1760
1761 llc_pdu = msgb_alloc_headroom(msg_len, msg_len,"llc_pdu");
Holger Hans Peter Freythere2310262013-11-13 16:56:15 +01001762 uint8_t *buf = msgb_push(llc_pdu, TL16V_GROSS_LEN(sizeof(uint8_t)*m_llc.frame_length()));
1763 tl16v_put(buf, BSSGP_IE_LLC_PDU, sizeof(uint8_t)*m_llc.frame_length(), m_llc.frame);
Holger Hans Peter Freyther99485142013-11-06 20:08:42 +01001764 qos_profile[0] = QOS_PROFILE >> 16;
1765 qos_profile[1] = QOS_PROFILE >> 8;
1766 qos_profile[2] = QOS_PROFILE;
1767 bssgp_tx_ul_ud(bctx, tlli(), qos_profile, llc_pdu);
1768
Holger Hans Peter Freyther758dc122013-11-06 20:39:45 +01001769 m_llc.reset_frame_space();
Holger Hans Peter Freyther99485142013-11-06 20:08:42 +01001770 return 0;
1771}
1772
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +01001773const char *tbf_name(gprs_rlcmac_tbf *tbf)
1774{
1775 static char buf[40];
1776 snprintf(buf, sizeof(buf), "TBF(TFI=%d TLLI=0x%08x DIR=%s)",
Holger Hans Peter Freyther34f6e5e2013-10-27 20:31:47 +01001777 tbf->m_tfi, tbf->m_tlli,
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +01001778 tbf->direction == GPRS_RLCMAC_UL_TBF ? "UL" : "DL");
1779 buf[sizeof(buf) - 1] = '\0';
1780 return buf;
1781}
Holger Hans Peter Freyther758dc122013-11-06 20:39:45 +01001782
Holger Hans Peter Freyther55cf9942013-11-13 18:15:45 +01001783
1784void gprs_rlcmac_tbf::reuse_tbf(const uint8_t *data, const uint16_t len)
1785{
1786 bts->tbf_reused();
1787 m_llc.put_frame(data, len);
1788 bts->llc_frame_sched();
1789
1790 /* reset rlc states */
1791 memset(&dir.dl, 0, sizeof(dir.dl));
Daniel Willmann146514e2013-12-28 18:24:42 +01001792 dir.dl.window.m_v_b.reset();
Holger Hans Peter Freyther55cf9942013-11-13 18:15:45 +01001793
1794 /* keep to flags */
1795 state_flags &= GPRS_RLCMAC_FLAG_TO_MASK;
1796 state_flags &= ~(1 << GPRS_RLCMAC_FLAG_CCCH);
1797
1798 update();
1799
1800 LOGP(DRLCMAC, LOGL_DEBUG, "%s Trigger dowlink assignment on PACCH, "
1801 "because another LLC PDU has arrived in between\n",
1802 tbf_name(this));
1803 bts->trigger_dl_ass(this, this, NULL);
1804}
Holger Hans Peter Freytherc03e3822013-11-24 00:21:32 +01001805
1806bool gprs_rlcmac_tbf::dl_window_stalled() const
1807{
Holger Hans Peter Freytherf1593b72013-11-24 20:36:36 +01001808 return dir.dl.window.window_stalled();
Holger Hans Peter Freytherc03e3822013-11-24 00:21:32 +01001809}
Holger Hans Peter Freyther7a5f3c22013-11-26 13:08:12 +01001810
1811void gprs_rlcmac_tbf::rotate_in_list()
1812{
Daniel Willmann1b3864f2014-07-30 13:25:19 +02001813 llist_del(&list.list);
Holger Hans Peter Freyther7a5f3c22013-11-26 13:08:12 +01001814 if (direction == GPRS_RLCMAC_UL_TBF)
Daniel Willmann1b3864f2014-07-30 13:25:19 +02001815 llist_add(&list.list, &bts->bts_data()->ul_tbfs);
Holger Hans Peter Freyther7a5f3c22013-11-26 13:08:12 +01001816 else
Daniel Willmann1b3864f2014-07-30 13:25:19 +02001817 llist_add(&list.list, &bts->bts_data()->dl_tbfs);
Holger Hans Peter Freyther7a5f3c22013-11-26 13:08:12 +01001818}
Holger Hans Peter Freyther8f399de2013-12-25 20:22:35 +01001819
1820uint8_t gprs_rlcmac_tbf::tsc() const
1821{
1822 return trx->pdch[first_ts].tsc;
1823}
Daniel Willmannafa72f52014-01-15 17:06:19 +01001824
1825void tbf_print_vty_info(struct vty *vty, llist_head *ltbf)
1826{
Daniel Willmann1b3864f2014-07-30 13:25:19 +02001827 gprs_rlcmac_tbf *tbf = llist_pods_entry(ltbf, gprs_rlcmac_tbf);
Daniel Willmannafa72f52014-01-15 17:06:19 +01001828
Daniel Willmann772415f2014-01-15 17:06:51 +01001829 vty_out(vty, "TBF: TFI=%d TLLI=0x%08x (%s) DIR=%s IMSI=%s%s", tbf->tfi(),
Daniel Willmannafa72f52014-01-15 17:06:19 +01001830 tbf->tlli(), tbf->is_tlli_valid() ? "valid" : "invalid",
1831 tbf->direction == GPRS_RLCMAC_UL_TBF ? "UL" : "DL",
1832 tbf->imsi(), VTY_NEWLINE);
Daniel Willmann80367aa2014-01-15 17:40:28 +01001833 vty_out(vty, " created=%lu state=%08x 1st_TS=%d 1st_cTS=%d ctrl_TS=%d "
Daniel Willmannafa72f52014-01-15 17:06:19 +01001834 "MS_CLASS=%d%s",
Holger Hans Peter Freythera0047992014-01-16 10:07:20 +01001835 tbf->created_ts(), tbf->state_flags, tbf->first_ts,
Daniel Willmann80367aa2014-01-15 17:40:28 +01001836 tbf->first_common_ts, tbf->control_ts, tbf->ms_class,
1837 VTY_NEWLINE);
Daniel Willmannafa72f52014-01-15 17:06:19 +01001838 vty_out(vty, " TS_alloc=");
1839 for (int i = 0; i < 8; i++) {
1840 if (tbf->pdch[i])
1841 vty_out(vty, "%d ", i);
1842 }
Daniel Willmann772415f2014-01-15 17:06:51 +01001843 vty_out(vty, " CS=%d%s%s", tbf->cs, VTY_NEWLINE, VTY_NEWLINE);
Daniel Willmannafa72f52014-01-15 17:06:19 +01001844}