blob: b5bb123d5131a4759a1525af40b26c90953fef0d [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);
Daniel Willmann7e994e32014-08-07 15:49:21 +0200135 if (ul_tbf && ul_tbf->m_contention_resolution_done
136 && !ul_tbf->m_final_ack_sent) {
Daniel Willmann532a4b52014-08-07 12:39:26 +0200137 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 */
Daniel Willmann30168882014-08-07 12:48:29 +0200199int gprs_rlcmac_dl_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 */
Daniel Willmann7e994e32014-08-07 15:49:21 +0200243 tbf->m_contention_resolution_done = 1;
Holger Hans Peter Freyther86921282013-08-24 21:26:42 +0200244 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)) {
Daniel Willmann6a16e0c2014-08-07 13:03:35 +0200407 gprs_rlcmac_ul_tbf *ul_tbf = static_cast<gprs_rlcmac_ul_tbf *>(this);
Daniel Willmann7e994e32014-08-07 15:49:21 +0200408 ul_tbf->m_n3103++;
409 if (ul_tbf->m_n3103 == ul_tbf->bts->bts_data()->n3103) {
Holger Hans Peter Freytherd9262b32013-10-26 20:12:59 +0200410 LOGP(DRLCMAC, LOGL_NOTICE,
411 "- N3103 exceeded\n");
Daniel Willmann6a16e0c2014-08-07 13:03:35 +0200412 tbf_new_state(ul_tbf, GPRS_RLCMAC_RELEASING);
413 tbf_timer_start(ul_tbf, 3169, ul_tbf->bts->bts_data()->t3169, 0);
Holger Hans Peter Freytherd9262b32013-10-26 20:12:59 +0200414 return;
415 }
416 /* reschedule UL ack */
Daniel Willmann6a16e0c2014-08-07 13:03:35 +0200417 ul_tbf->ul_ack_state = GPRS_RLCMAC_UL_ACK_SEND_ACK;
Holger Hans Peter Freytherd9262b32013-10-26 20:12:59 +0200418 }
419 } else if (ul_ass_state == GPRS_RLCMAC_UL_ASS_WAIT_ACK) {
420 if (!(state_flags & (1 << GPRS_RLCMAC_FLAG_TO_UL_ASS))) {
421 LOGP(DRLCMAC, LOGL_NOTICE, "- Timeout for polling "
422 "PACKET CONTROL ACK for PACKET UPLINK "
423 "ASSIGNMENT.\n");
424 rlcmac_diag();
425 state_flags |= (1 << GPRS_RLCMAC_FLAG_TO_UL_ASS);
426 }
427 ul_ass_state = GPRS_RLCMAC_UL_ASS_NONE;
Holger Hans Peter Freytherd9262b32013-10-26 20:12:59 +0200428 n3105++;
429 if (n3105 == bts_data()->n3105) {
430 LOGP(DRLCMAC, LOGL_NOTICE, "- N3105 exceeded\n");
Holger Hans Peter Freytherd9262b32013-10-26 20:12:59 +0200431 tbf_new_state(this, GPRS_RLCMAC_RELEASING);
432 tbf_timer_start(this, 3195, bts_data()->t3195, 0);
433 return;
434 }
435 /* reschedule UL assignment */
436 ul_ass_state = GPRS_RLCMAC_UL_ASS_SEND_ASS;
437 } else if (dl_ass_state == GPRS_RLCMAC_DL_ASS_WAIT_ACK) {
438 if (!(state_flags & (1 << GPRS_RLCMAC_FLAG_TO_DL_ASS))) {
439 LOGP(DRLCMAC, LOGL_NOTICE, "- Timeout for polling "
440 "PACKET CONTROL ACK for PACKET DOWNLINK "
441 "ASSIGNMENT.\n");
442 rlcmac_diag();
443 state_flags |= (1 << GPRS_RLCMAC_FLAG_TO_DL_ASS);
444 }
445 dl_ass_state = GPRS_RLCMAC_DL_ASS_NONE;
Holger Hans Peter Freytherd9262b32013-10-26 20:12:59 +0200446 n3105++;
447 if (n3105 == bts->bts_data()->n3105) {
448 LOGP(DRLCMAC, LOGL_NOTICE, "- N3105 exceeded\n");
Holger Hans Peter Freytherd9262b32013-10-26 20:12:59 +0200449 tbf_new_state(this, GPRS_RLCMAC_RELEASING);
450 tbf_timer_start(this, 3195, bts_data()->t3195, 0);
451 return;
452 }
453 /* reschedule DL assignment */
454 dl_ass_state = GPRS_RLCMAC_DL_ASS_SEND_ASS;
455 } else if (direction == GPRS_RLCMAC_DL_TBF) {
Daniel Willmann6a16e0c2014-08-07 13:03:35 +0200456 gprs_rlcmac_dl_tbf *dl_tbf = static_cast<gprs_rlcmac_dl_tbf *>(this);
457
458 if (!(dl_tbf->state_flags & (1 << GPRS_RLCMAC_FLAG_TO_DL_ACK))) {
Holger Hans Peter Freytherd9262b32013-10-26 20:12:59 +0200459 LOGP(DRLCMAC, LOGL_NOTICE, "- Timeout for polling "
460 "PACKET DOWNLINK ACK.\n");
Daniel Willmann6a16e0c2014-08-07 13:03:35 +0200461 dl_tbf->rlcmac_diag();
462 dl_tbf->state_flags |= (1 << GPRS_RLCMAC_FLAG_TO_DL_ACK);
Holger Hans Peter Freytherd9262b32013-10-26 20:12:59 +0200463 }
Daniel Willmann6a16e0c2014-08-07 13:03:35 +0200464 dl_tbf->n3105++;
465 if (dl_tbf->n3105 == dl_tbf->bts->bts_data()->n3105) {
Holger Hans Peter Freytherd9262b32013-10-26 20:12:59 +0200466 LOGP(DRLCMAC, LOGL_NOTICE, "- N3105 exceeded\n");
Daniel Willmann6a16e0c2014-08-07 13:03:35 +0200467 tbf_new_state(dl_tbf, GPRS_RLCMAC_RELEASING);
468 tbf_timer_start(dl_tbf, 3195, dl_tbf->bts_data()->t3195, 0);
Holger Hans Peter Freytherd9262b32013-10-26 20:12:59 +0200469 return;
470 }
471 /* resend IMM.ASS on CCCH on timeout */
Daniel Willmann6a16e0c2014-08-07 13:03:35 +0200472 if ((dl_tbf->state_flags & (1 << GPRS_RLCMAC_FLAG_CCCH))
473 && !(dl_tbf->state_flags & (1 << GPRS_RLCMAC_FLAG_DL_ACK))) {
Holger Hans Peter Freytherd9262b32013-10-26 20:12:59 +0200474 LOGP(DRLCMAC, LOGL_DEBUG, "Re-send dowlink assignment "
Holger Hans Peter Freyther34f6e5e2013-10-27 20:31:47 +0100475 "for %s on PCH (IMSI=%s)\n",
Daniel Willmann6a16e0c2014-08-07 13:03:35 +0200476 tbf_name(dl_tbf),
Holger Hans Peter Freyther5464c9b2013-10-27 20:57:35 +0100477 m_imsi);
Holger Hans Peter Freytherd9262b32013-10-26 20:12:59 +0200478 /* send immediate assignment */
Daniel Willmann6a16e0c2014-08-07 13:03:35 +0200479 dl_tbf->bts->snd_dl_ass(dl_tbf, 0, m_imsi);
Daniel Willmann7e994e32014-08-07 15:49:21 +0200480 dl_tbf->m_wait_confirm = 1;
Holger Hans Peter Freytherd9262b32013-10-26 20:12:59 +0200481 }
482 } else
483 LOGP(DRLCMAC, LOGL_ERROR, "- Poll Timeout, but no event!\n");
484}
485
Daniel Willmann48aa0b02014-07-16 18:54:10 +0200486static int setup_tbf(struct gprs_rlcmac_tbf *tbf, struct gprs_rlcmac_bts *bts,
487 struct gprs_rlcmac_tbf *old_tbf, uint8_t tfi, uint8_t trx,
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +0200488 uint8_t ms_class, uint8_t single_slot)
489{
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +0200490 int rc;
491
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +0200492 if (trx >= 8 || tfi >= 32)
Daniel Willmann48aa0b02014-07-16 18:54:10 +0200493 return -1;
Daniel Willmann078bb712014-07-10 17:44:06 +0200494
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +0200495 if (!tbf)
Daniel Willmann48aa0b02014-07-16 18:54:10 +0200496 return -1;
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +0200497
Daniel Willmann1b3864f2014-07-30 13:25:19 +0200498 /* Back pointer for PODS llist compatibility */
499 tbf->list.back = tbf;
500
Holger Hans Peter Freythera0047992014-01-16 10:07:20 +0100501 tbf->m_created_ts = time(NULL);
Holger Hans Peter Freyther9f0c1d22013-10-19 21:24:34 +0200502 tbf->bts = bts->bts;
Holger Hans Peter Freyther34f6e5e2013-10-27 20:31:47 +0100503 tbf->m_tfi = tfi;
Holger Hans Peter Freyther743bafa2013-09-29 07:50:50 +0200504 tbf->trx = &bts->trx[trx];
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +0200505 tbf->ms_class = ms_class;
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +0200506 /* select algorithm */
507 rc = bts->alloc_algorithm(bts, old_tbf, tbf, bts->alloc_algorithm_curst,
508 single_slot);
Holger Hans Peter Freyther90b87ea2013-10-27 10:38:31 +0100509 /* if no resource */
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +0200510 if (rc < 0) {
Daniel Willmann48aa0b02014-07-16 18:54:10 +0200511 return -1;
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +0200512 }
513 /* assign control ts */
514 tbf->control_ts = 0xff;
515 rc = tbf_assign_control_ts(tbf);
Holger Hans Peter Freyther90b87ea2013-10-27 10:38:31 +0100516 /* if no resource */
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +0200517 if (rc < 0) {
Daniel Willmann48aa0b02014-07-16 18:54:10 +0200518 return -1;
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +0200519 }
520
521 /* set timestamp */
522 gettimeofday(&tbf->meas.dl_bw_tv, NULL);
523 gettimeofday(&tbf->meas.rssi_tv, NULL);
524 gettimeofday(&tbf->meas.dl_loss_tv, NULL);
525
Holger Hans Peter Freyther758dc122013-11-06 20:39:45 +0100526 tbf->m_llc.init();
Daniel Willmann48aa0b02014-07-16 18:54:10 +0200527 return 0;
528}
529
530
531struct gprs_rlcmac_ul_tbf *tbf_alloc_ul_tbf(struct gprs_rlcmac_bts *bts,
532 struct gprs_rlcmac_tbf *old_tbf, uint8_t tfi, uint8_t trx,
533 uint8_t ms_class, uint8_t single_slot)
534{
535 struct gprs_rlcmac_ul_tbf *tbf;
536 int rc;
537
538 LOGP(DRLCMAC, LOGL_DEBUG, "********** TBF starts here **********\n");
539 LOGP(DRLCMAC, LOGL_INFO, "Allocating %s TBF: TFI=%d TRX=%d "
540 "MS_CLASS=%d\n", "UL", tfi, trx, ms_class);
541
542 if (trx >= 8 || tfi >= 32)
543 return NULL;
544
545 tbf = talloc_zero(tall_pcu_ctx, struct gprs_rlcmac_ul_tbf);
546
547 if (!tbf)
548 return NULL;
549
550 tbf->direction = GPRS_RLCMAC_UL_TBF;
551 rc = setup_tbf(tbf, bts, old_tbf, tfi, trx, ms_class, single_slot);
552 /* if no resource */
553 if (rc < 0) {
554 talloc_free(tbf);
555 return NULL;
Holger Hans Peter Freyther15877642013-10-27 09:50:15 +0100556 }
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +0200557
Daniel Willmann1b3864f2014-07-30 13:25:19 +0200558 llist_add(&tbf->list.list, &bts->ul_tbfs);
Daniel Willmann48aa0b02014-07-16 18:54:10 +0200559 tbf->bts->tbf_ul_created();
560
561 return tbf;
562}
563
564struct gprs_rlcmac_dl_tbf *tbf_alloc_dl_tbf(struct gprs_rlcmac_bts *bts,
565 struct gprs_rlcmac_tbf *old_tbf, uint8_t tfi, uint8_t trx,
566 uint8_t ms_class, uint8_t single_slot)
567{
568 struct gprs_rlcmac_dl_tbf *tbf;
569 int rc;
570
571 LOGP(DRLCMAC, LOGL_DEBUG, "********** TBF starts here **********\n");
572 LOGP(DRLCMAC, LOGL_INFO, "Allocating %s TBF: TFI=%d TRX=%d "
573 "MS_CLASS=%d\n", "DL", tfi, trx, ms_class);
574
575 if (trx >= 8 || tfi >= 32)
576 return NULL;
577
578 tbf = talloc_zero(tall_pcu_ctx, struct gprs_rlcmac_dl_tbf);
579
580 if (!tbf)
581 return NULL;
582
583 tbf->direction = GPRS_RLCMAC_DL_TBF;
584 rc = setup_tbf(tbf, bts, old_tbf, tfi, trx, ms_class, single_slot);
585 /* if no resource */
586 if (rc < 0) {
587 talloc_free(tbf);
588 return NULL;
589 }
590
Daniel Willmann1b3864f2014-07-30 13:25:19 +0200591 llist_add(&tbf->list.list, &bts->dl_tbfs);
Daniel Willmann48aa0b02014-07-16 18:54:10 +0200592 tbf->bts->tbf_dl_created();
593
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +0200594 return tbf;
595}
596
Holger Hans Peter Freytheraf8094d2013-10-26 17:56:15 +0200597static void tbf_timer_cb(void *_tbf)
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +0200598{
599 struct gprs_rlcmac_tbf *tbf = (struct gprs_rlcmac_tbf *)_tbf;
Holger Hans Peter Freytheraf8094d2013-10-26 17:56:15 +0200600 tbf->handle_timeout();
601}
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +0200602
Holger Hans Peter Freytheraf8094d2013-10-26 17:56:15 +0200603void gprs_rlcmac_tbf::handle_timeout()
604{
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +0100605 LOGP(DRLCMAC, LOGL_DEBUG, "%s timer %u expired.\n",
606 tbf_name(this), T);
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +0200607
Holger Hans Peter Freytheraf8094d2013-10-26 17:56:15 +0200608 num_T_exp++;
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +0200609
Holger Hans Peter Freytheraf8094d2013-10-26 17:56:15 +0200610 switch (T) {
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +0200611 case 0: /* assignment */
Holger Hans Peter Freytheraf8094d2013-10-26 17:56:15 +0200612 if ((state_flags & (1 << GPRS_RLCMAC_FLAG_PACCH))) {
613 if (state_is(GPRS_RLCMAC_ASSIGN)) {
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +0100614 LOGP(DRLCMAC, LOGL_NOTICE, "%s releasing due to "
615 "PACCH assignment timeout.\n", tbf_name(this));
Holger Hans Peter Freytheraf8094d2013-10-26 17:56:15 +0200616 tbf_free(this);
Holger Hans Peter Freyther3d0cc2f2014-01-16 10:09:42 +0100617 return;
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +0200618 } else
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +0100619 LOGP(DRLCMAC, LOGL_ERROR, "Error: %s is not "
620 "in assign state\n", tbf_name(this));
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +0200621 }
Holger Hans Peter Freytheraf8094d2013-10-26 17:56:15 +0200622 if ((state_flags & (1 << GPRS_RLCMAC_FLAG_CCCH))) {
Daniel Willmann532a4b52014-08-07 12:39:26 +0200623 gprs_rlcmac_dl_tbf *dl_tbf = static_cast<gprs_rlcmac_dl_tbf *>(this);
Daniel Willmann7e994e32014-08-07 15:49:21 +0200624 dl_tbf->m_wait_confirm = 0;
Daniel Willmann532a4b52014-08-07 12:39:26 +0200625 if (dl_tbf->state_is(GPRS_RLCMAC_ASSIGN)) {
626 tbf_assign_control_ts(dl_tbf);
Daniel Willmanncf1fae72014-05-30 17:58:01 +0200627
Daniel Willmann532a4b52014-08-07 12:39:26 +0200628 if (!dl_tbf->upgrade_to_multislot) {
Daniel Willmanncf1fae72014-05-30 17:58:01 +0200629 /* change state to FLOW, so scheduler
630 * will start transmission */
Daniel Willmann532a4b52014-08-07 12:39:26 +0200631 tbf_new_state(dl_tbf, GPRS_RLCMAC_FLOW);
Daniel Willmanncf1fae72014-05-30 17:58:01 +0200632 break;
633 }
634
635 /* This tbf can be upgraded to use multiple DL
636 * timeslots and now that there is already one
637 * slot assigned send another DL assignment via
638 * PDCH. */
639
640 /* keep to flags */
Daniel Willmann532a4b52014-08-07 12:39:26 +0200641 dl_tbf->state_flags &= GPRS_RLCMAC_FLAG_TO_MASK;
642 dl_tbf->state_flags &= ~(1 << GPRS_RLCMAC_FLAG_CCCH);
Daniel Willmanncf1fae72014-05-30 17:58:01 +0200643
Daniel Willmann532a4b52014-08-07 12:39:26 +0200644 dl_tbf->update();
Daniel Willmanncf1fae72014-05-30 17:58:01 +0200645
Daniel Willmann532a4b52014-08-07 12:39:26 +0200646 dl_tbf->bts->trigger_dl_ass(dl_tbf, dl_tbf, NULL);
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +0200647 } else
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +0100648 LOGP(DRLCMAC, LOGL_NOTICE, "%s Continue flow after "
Daniel Willmann532a4b52014-08-07 12:39:26 +0200649 "IMM.ASS confirm\n", tbf_name(dl_tbf));
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +0200650 }
651 break;
652 case 3169:
653 case 3191:
654 case 3195:
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +0100655 LOGP(DRLCMAC, LOGL_NOTICE, "%s T%d timeout during "
656 "transsmission\n", tbf_name(this), T);
Holger Hans Peter Freytheraf8094d2013-10-26 17:56:15 +0200657 rlcmac_diag();
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +0200658 /* fall through */
659 case 3193:
Holger Hans Peter Freyther8d0e4892013-10-27 12:42:58 +0100660 LOGP(DRLCMAC, LOGL_DEBUG,
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +0100661 "%s will be freed due to timeout\n", tbf_name(this));
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +0200662 /* free TBF */
Holger Hans Peter Freytheraf8094d2013-10-26 17:56:15 +0200663 tbf_free(this);
Holger Hans Peter Freyther3d0cc2f2014-01-16 10:09:42 +0100664 return;
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +0200665 break;
666 default:
Holger Hans Peter Freyther8d0e4892013-10-27 12:42:58 +0100667 LOGP(DRLCMAC, LOGL_ERROR,
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +0100668 "%s timer expired in unknown mode: %u\n", tbf_name(this), T);
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +0200669 }
670}
671
672int gprs_rlcmac_tbf::rlcmac_diag()
673{
674 if ((state_flags & (1 << GPRS_RLCMAC_FLAG_CCCH)))
675 LOGP(DRLCMAC, LOGL_NOTICE, "- Assignment was on CCCH\n");
676 if ((state_flags & (1 << GPRS_RLCMAC_FLAG_PACCH)))
677 LOGP(DRLCMAC, LOGL_NOTICE, "- Assignment was on PACCH\n");
678 if ((state_flags & (1 << GPRS_RLCMAC_FLAG_UL_DATA)))
679 LOGP(DRLCMAC, LOGL_NOTICE, "- Uplink data was received\n");
680 else if (direction == GPRS_RLCMAC_UL_TBF)
681 LOGP(DRLCMAC, LOGL_NOTICE, "- No uplink data received yet\n");
682 if ((state_flags & (1 << GPRS_RLCMAC_FLAG_DL_ACK)))
683 LOGP(DRLCMAC, LOGL_NOTICE, "- Downlink ACK was received\n");
684 else if (direction == GPRS_RLCMAC_DL_TBF)
685 LOGP(DRLCMAC, LOGL_NOTICE, "- No downlink ACK received yet\n");
686
687 return 0;
688}
689
Holger Hans Peter Freyther1702f102013-10-20 08:44:02 +0200690struct msgb *gprs_rlcmac_tbf::llc_dequeue(bssgp_bvc_ctx *bctx)
691{
692 struct msgb *msg;
693 struct timeval *tv, tv_now;
694 uint32_t octets = 0, frames = 0;
695
696 gettimeofday(&tv_now, NULL);
697
Holger Hans Peter Freyther758dc122013-11-06 20:39:45 +0100698 while ((msg = m_llc.dequeue())) {
Holger Hans Peter Freyther1702f102013-10-20 08:44:02 +0200699 tv = (struct timeval *)msg->data;
700 msgb_pull(msg, sizeof(*tv));
Daniel Willmann9c623892013-12-04 18:11:47 +0100701 msgb_pull(msg, sizeof(*tv));
Holger Hans Peter Freyther51e093b2013-11-13 15:35:45 +0100702
Holger Hans Peter Freytherb1302b02013-11-13 17:15:26 +0100703 if (gprs_llc::is_frame_expired(&tv_now, tv)) {
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +0100704 LOGP(DRLCMACDL, LOGL_NOTICE, "%s Discarding LLC PDU "
Holger Hans Peter Freyther550bb882013-12-04 17:10:54 +0100705 "because lifetime limit reached. Queue size %zu\n",
706 tbf_name(this), m_llc.m_queue_size);
Holger Hans Peter Freytherb3d5ee22013-11-13 16:43:26 +0100707 bts->llc_timedout_frame();
Holger Hans Peter Freyther1702f102013-10-20 08:44:02 +0200708 frames++;
709 octets += msg->len;
710 msgb_free(msg);
711 continue;
712 }
713 break;
714 }
715
716 if (frames) {
717 if (frames > 0xff)
718 frames = 0xff;
719 if (octets > 0xffffff)
720 octets = 0xffffff;
Holger Hans Peter Freyther474685e2013-10-27 17:01:14 +0100721 bssgp_tx_llc_discarded(bctx, m_tlli, frames, octets);
Holger Hans Peter Freyther1702f102013-10-20 08:44:02 +0200722 }
723
724 return msg;
725}
726
Holger Hans Peter Freytherd11290b2013-10-26 17:32:04 +0200727/*
728 * Store received block data in LLC message(s) and forward to SGSN
729 * if complete.
730 */
Daniel Willmanne2732e22014-08-07 17:32:01 +0200731int gprs_rlcmac_ul_tbf::assemble_forward_llc(const gprs_rlc_data *_data)
Holger Hans Peter Freytherd11290b2013-10-26 17:32:04 +0200732{
Holger Hans Peter Freythere5dc2a02013-11-13 20:10:12 +0100733 const uint8_t *data = _data->block;
734 uint8_t len = _data->len;
735 const struct rlc_ul_header *rh = (const struct rlc_ul_header *) data;
Holger Hans Peter Freytherd11290b2013-10-26 17:32:04 +0200736 uint8_t e, m;
737 struct rlc_li_field *li;
738 uint8_t frame_offset[16], offset = 0, chunk;
739 int i, frames = 0;
740
741 LOGP(DRLCMACUL, LOGL_DEBUG, "- Assembling frames: (len=%d)\n", len);
742
743 data += 3;
744 len -= 3;
745 e = rh->e; /* if extended */
746 m = 1; /* more frames, that means: the first frame */
747
748 /* Parse frame offsets from length indicator(s), if any. */
749 while (1) {
750 if (frames == (int)sizeof(frame_offset)) {
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +0100751 LOGP(DRLCMACUL, LOGL_ERROR, "%s too many frames in "
752 "block\n", tbf_name(this));
Holger Hans Peter Freytherd11290b2013-10-26 17:32:04 +0200753 return -EINVAL;
754 }
755 frame_offset[frames++] = offset;
756 LOGP(DRLCMACUL, LOGL_DEBUG, "-- Frame %d starts at offset "
757 "%d\n", frames, offset);
758 if (!len)
759 break;
760 /* M == 0 and E == 0 is not allowed in this version. */
761 if (!m && !e) {
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +0100762 LOGP(DRLCMACUL, LOGL_NOTICE, "%s UL DATA "
Holger Hans Peter Freytherd11290b2013-10-26 17:32:04 +0200763 "ignored, because M='0' and E='0'.\n",
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +0100764 tbf_name(this));
Holger Hans Peter Freytherd11290b2013-10-26 17:32:04 +0200765 return 0;
766 }
767 /* no more frames in this segment */
768 if (e) {
769 break;
770 }
771 /* There is a new frame and an LI that delimits it. */
772 if (m) {
773 li = (struct rlc_li_field *)data;
774 LOGP(DRLCMACUL, LOGL_DEBUG, "-- Delimiter len=%d\n",
775 li->li);
776 /* Special case: LI == 0
777 * If the last segment would fit precisely into the
778 * rest of the RLC MAC block, there would be no way
779 * to delimit that this segment ends and is not
780 * continued in the next block.
781 * The special LI (0) is used to force the segment to
782 * extend into the next block, so it is delimited there.
783 * This LI must be skipped. Also it is the last LI.
784 */
785 if (li->li == 0) {
786 data++;
787 len--;
788 m = 1; /* M is ignored, we know there is more */
789 break; /* handle E as '1', so we break! */
790 }
791 e = li->e;
792 m = li->m;
793 offset += li->li;
794 data++;
795 len--;
796 continue;
797 }
798 }
799 if (!m) {
800 LOGP(DRLCMACUL, LOGL_DEBUG, "- Last frame carries spare "
801 "data\n");
802 }
803
804 LOGP(DRLCMACUL, LOGL_DEBUG, "- Data length after length fields: %d\n",
805 len);
806 /* TLLI */
807 if (rh->ti) {
808 if (len < 4) {
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +0100809 LOGP(DRLCMACUL, LOGL_NOTICE, "%s UL DATA TLLI out of "
810 "frame border\n", tbf_name(this));
Holger Hans Peter Freytherd11290b2013-10-26 17:32:04 +0200811 return -EINVAL;
812 }
813 data += 4;
814 len -= 4;
815 LOGP(DRLCMACUL, LOGL_DEBUG, "- Length after skipping TLLI: "
816 "%d\n", len);
817 }
818
819 /* PFI */
820 if (rh->pi) {
821 LOGP(DRLCMACUL, LOGL_ERROR, "ERROR: PFI not supported, "
822 "please disable in SYSTEM INFORMATION\n");
823 if (len < 1) {
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +0100824 LOGP(DRLCMACUL, LOGL_NOTICE, "%s UL DATA PFI out of "
825 "frame border\n", tbf_name(this));
Holger Hans Peter Freytherd11290b2013-10-26 17:32:04 +0200826 return -EINVAL;
827 }
828 data++;
829 len--;
830 LOGP(DRLCMACUL, LOGL_DEBUG, "- Length after skipping PFI: "
831 "%d\n", len);
832 }
833
834 /* Now we have:
835 * - a list of frames offsets: frame_offset[]
836 * - number of frames: i
837 * - m == 0: Last frame carries spare data (end of TBF).
838 */
839
840 /* Check if last offset would exceed frame. */
841 if (offset > len) {
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +0100842 LOGP(DRLCMACUL, LOGL_NOTICE, "%s UL DATA ignored, "
Holger Hans Peter Freytherd11290b2013-10-26 17:32:04 +0200843 "because LI delimits data that exceeds block size.\n",
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +0100844 tbf_name(this));
Holger Hans Peter Freytherd11290b2013-10-26 17:32:04 +0200845 return -EINVAL;
846 }
847
848 /* create LLC frames */
849 for (i = 0; i < frames; i++) {
850 /* last frame ? */
851 if (i == frames - 1) {
852 /* no more data in last frame */
853 if (!m)
854 break;
855 /* data until end of frame */
856 chunk = len - frame_offset[i];
857 } else {
858 /* data until next frame */
859 chunk = frame_offset[i + 1] - frame_offset[i];
860 }
Holger Hans Peter Freythere2310262013-11-13 16:56:15 +0100861 if (!m_llc.fits_in_current_frame(chunk)) {
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +0100862 LOGP(DRLCMACUL, LOGL_NOTICE, "%s LLC frame exceeds "
Holger Hans Peter Freythere2310262013-11-13 16:56:15 +0100863 "maximum size %u.\n", tbf_name(this),
864 m_llc.remaining_space());
865 chunk = m_llc.remaining_space();
Holger Hans Peter Freytherd11290b2013-10-26 17:32:04 +0200866 }
Holger Hans Peter Freythere2310262013-11-13 16:56:15 +0100867 m_llc.append_frame(data + frame_offset[i], chunk);
868 m_llc.consume(chunk);
Holger Hans Peter Freytherd11290b2013-10-26 17:32:04 +0200869 /* not last frame. */
870 if (i != frames - 1) {
871 /* send frame to SGSN */
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +0100872 LOGP(DRLCMACUL, LOGL_INFO, "%s complete UL frame len=%d\n",
Holger Hans Peter Freythere2310262013-11-13 16:56:15 +0100873 tbf_name(this) , m_llc.frame_length());
Holger Hans Peter Freyther99485142013-11-06 20:08:42 +0100874 snd_ul_ud();
Holger Hans Peter Freythere2310262013-11-13 16:56:15 +0100875 m_llc.reset();
Holger Hans Peter Freytherd11290b2013-10-26 17:32:04 +0200876 /* also check if CV==0, because the frame may fill up the
877 * block precisely, then it is also complete. normally the
878 * frame would be extended into the next block with a 0-length
879 * delimiter added to this block. */
880 } else if (rh->cv == 0) {
881 /* send frame to SGSN */
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +0100882 LOGP(DRLCMACUL, LOGL_INFO, "%s complete UL frame "
883 "that fits precisely in last block: "
Holger Hans Peter Freythere2310262013-11-13 16:56:15 +0100884 "len=%d\n", tbf_name(this), m_llc.frame_length());
Holger Hans Peter Freyther99485142013-11-06 20:08:42 +0100885 snd_ul_ud();
Holger Hans Peter Freythere2310262013-11-13 16:56:15 +0100886 m_llc.reset();
Holger Hans Peter Freytherd11290b2013-10-26 17:32:04 +0200887 }
888 }
889
890 return 0;
891}
892
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +0200893/*
894 * Create DL data block
895 * The messages are fragmented and forwarded as data blocks.
896 */
Daniel Willmannb8f26012014-07-30 19:12:28 +0200897struct msgb *gprs_rlcmac_dl_tbf::create_dl_acked_block(uint32_t fn, uint8_t ts)
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +0200898{
Holger Hans Peter Freyther34f6e5e2013-10-27 20:31:47 +0100899 LOGP(DRLCMACDL, LOGL_DEBUG, "%s downlink (V(A)==%d .. "
Holger Hans Peter Freytherf1593b72013-11-24 20:36:36 +0100900 "V(S)==%d)\n", tbf_name(this),
Daniel Willmann7e994e32014-08-07 15:49:21 +0200901 m_window.v_a(), m_window.v_s());
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +0200902
903do_resend:
904 /* check if there is a block with negative acknowledgement */
Daniel Willmann7e994e32014-08-07 15:49:21 +0200905 int resend_bsn = m_window.resend_needed();
Holger Hans Peter Freyther15777792013-11-24 00:18:47 +0100906 if (resend_bsn >= 0) {
907 LOGP(DRLCMACDL, LOGL_DEBUG, "- Resending BSN %d\n", resend_bsn);
Holger Hans Peter Freyther15777792013-11-24 00:18:47 +0100908 /* re-send block with negative aknowlegement */
Daniel Willmann7e994e32014-08-07 15:49:21 +0200909 m_window.m_v_b.mark_unacked(resend_bsn);
Holger Hans Peter Freyther15777792013-11-24 00:18:47 +0100910 bts->rlc_resent();
Holger Hans Peter Freyther3cbf9e02013-11-26 21:43:58 +0100911 return create_dl_acked_block(fn, ts, resend_bsn, false);
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +0200912 }
913
914 /* if the window has stalled, or transfer is complete,
915 * send an unacknowledged block */
Holger Hans Peter Freytherc03e3822013-11-24 00:21:32 +0100916 if (state_is(GPRS_RLCMAC_FINISHED) || dl_window_stalled()) {
Holger Hans Peter Freytheref93bdb2013-11-24 00:01:50 +0100917 if (state_is(GPRS_RLCMAC_FINISHED)) {
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +0200918 LOGP(DRLCMACDL, LOGL_DEBUG, "- Restarting at BSN %d, "
919 "because all blocks have been transmitted.\n",
Daniel Willmann7e994e32014-08-07 15:49:21 +0200920 m_window.v_a());
Holger Hans Peter Freytheref93bdb2013-11-24 00:01:50 +0100921 bts->rlc_restarted();
922 } else {
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +0200923 LOGP(DRLCMACDL, LOGL_NOTICE, "- Restarting at BSN %d, "
924 "because all window is stalled.\n",
Daniel Willmann7e994e32014-08-07 15:49:21 +0200925 m_window.v_a());
Holger Hans Peter Freytherc70aae42013-11-19 17:09:37 +0100926 bts->rlc_stalled();
927 }
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +0200928 /* If V(S) == V(A) and finished state, we would have received
929 * acknowledgement of all transmitted block. In this case we
930 * would have transmitted the final block, and received ack
931 * from MS. But in this case we did not receive the final ack
932 * indication from MS. This should never happen if MS works
933 * correctly. */
Daniel Willmann7e994e32014-08-07 15:49:21 +0200934 if (m_window.window_empty()) {
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +0200935 LOGP(DRLCMACDL, LOGL_DEBUG, "- MS acked all blocks, "
936 "so we re-transmit final block!\n");
937 /* we just send final block again */
Daniel Willmann7e994e32014-08-07 15:49:21 +0200938 int16_t index = m_window.v_s_mod(-1);
Holger Hans Peter Freythere9429b52013-11-13 19:36:57 +0100939 bts->rlc_resent();
Holger Hans Peter Freythera6ba67c2013-11-24 00:44:21 +0100940 return create_dl_acked_block(fn, ts, index, false);
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +0200941 }
942
943 /* cycle through all unacked blocks */
Daniel Willmann7e994e32014-08-07 15:49:21 +0200944 int resend = m_window.mark_for_resend();
Holger Hans Peter Freyther8b16ae32013-11-24 00:38:54 +0100945
946 /* At this point there should be at least one unacked block
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +0200947 * to be resent. If not, this is an software error. */
948 if (resend == 0) {
949 LOGP(DRLCMACDL, LOGL_ERROR, "Software error: "
950 "There are no unacknowledged blocks, but V(A) "
951 " != V(S). PLEASE FIX!\n");
952 /* we just send final block again */
Daniel Willmann7e994e32014-08-07 15:49:21 +0200953 int16_t index = m_window.v_s_mod(-1);
Holger Hans Peter Freythera6ba67c2013-11-24 00:44:21 +0100954 return create_dl_acked_block(fn, ts, index, false);
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +0200955 }
956 goto do_resend;
957 }
958
Holger Hans Peter Freythera6ba67c2013-11-24 00:44:21 +0100959 return create_new_bsn(fn, ts);
960}
961
Daniel Willmannb8f26012014-07-30 19:12:28 +0200962struct 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 +0100963{
964 struct rlc_dl_header *rh;
965 struct rlc_li_field *li;
966 struct msgb *msg;
Holger Hans Peter Freythera6ba67c2013-11-24 00:44:21 +0100967 uint8_t *delimiter, *data, *e_pointer;
968 uint16_t space, chunk;
Holger Hans Peter Freyther3cbf9e02013-11-26 21:43:58 +0100969 gprs_rlc_data *rlc_data;
Holger Hans Peter Freythera6ba67c2013-11-24 00:44:21 +0100970 bool first_fin_ack = false;
Daniel Willmann7e994e32014-08-07 15:49:21 +0200971 const uint16_t bsn = m_window.v_s();
Holger Hans Peter Freythera6ba67c2013-11-24 00:44:21 +0100972
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +0200973 LOGP(DRLCMACDL, LOGL_DEBUG, "- Sending new block at BSN %d\n",
Daniel Willmann7e994e32014-08-07 15:49:21 +0200974 m_window.v_s());
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +0200975
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +0200976#warning "Selection of the CS doesn't belong here"
977 if (cs == 0) {
978 cs = bts_data()->initial_cs_dl;
979 if (cs < 1 || cs > 4)
980 cs = 1;
981 }
Holger Hans Peter Freyther58db60c2013-11-13 20:45:40 +0100982 /* total length of block, including spare bits */
983 const uint8_t block_length = gprs_rlcmac_cs[cs].block_length;
984 /* length of usable data of block, w/o spare bits, inc. MAC */
985 const uint8_t block_data_len = gprs_rlcmac_cs[cs].block_data;
986
987 /* now we still have untransmitted LLC data, so we fill mac block */
Holger Hans Peter Freyther3cbf9e02013-11-26 21:43:58 +0100988 rlc_data = m_rlc.block(bsn);
989 data = rlc_data->prepare(block_data_len);
Holger Hans Peter Freyther58db60c2013-11-13 20:45:40 +0100990
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +0200991 rh = (struct rlc_dl_header *)data;
992 rh->pt = 0; /* Data Block */
993 rh->rrbp = rh->s_p = 0; /* Polling, set later, if required */
994 rh->usf = 7; /* will be set at scheduler */
995 rh->pr = 0; /* FIXME: power reduction */
Holger Hans Peter Freyther34f6e5e2013-10-27 20:31:47 +0100996 rh->tfi = m_tfi; /* TFI */
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +0200997 rh->fbi = 0; /* Final Block Indicator, set late, if true */
Holger Hans Peter Freyther3cbf9e02013-11-26 21:43:58 +0100998 rh->bsn = bsn; /* Block Sequence Number */
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +0200999 rh->e = 0; /* Extension bit, maybe set later */
1000 e_pointer = data + 2; /* points to E of current chunk */
Holger Hans Peter Freyther58db60c2013-11-13 20:45:40 +01001001 data += sizeof(*rh);
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001002 delimiter = data; /* where next length header would be stored */
Holger Hans Peter Freyther58db60c2013-11-13 20:45:40 +01001003 space = block_data_len - sizeof(*rh);
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001004 while (1) {
Holger Hans Peter Freytheracb54272013-11-07 08:15:58 +01001005 chunk = m_llc.chunk_size();
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001006 /* if chunk will exceed block limit */
1007 if (chunk > space) {
1008 LOGP(DRLCMACDL, LOGL_DEBUG, "-- Chunk with length %d "
1009 "larger than space (%d) left in block: copy "
1010 "only remaining space, and we are done\n",
1011 chunk, space);
1012 /* block is filled, so there is no extension */
1013 *e_pointer |= 0x01;
1014 /* fill only space */
Holger Hans Peter Freytheracb54272013-11-07 08:15:58 +01001015 m_llc.consume(data, space);
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001016 /* return data block as message */
1017 break;
1018 }
1019 /* if FINAL chunk would fit precisely in space left */
Holger Hans Peter Freyther28e53782013-11-06 20:23:56 +01001020 if (chunk == space && llist_empty(&m_llc.queue)) {
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001021 LOGP(DRLCMACDL, LOGL_DEBUG, "-- Chunk with length %d "
1022 "would exactly fit into space (%d): because "
1023 "this is a final block, we don't add length "
1024 "header, and we are done\n", chunk, space);
1025 LOGP(DRLCMACDL, LOGL_INFO, "Complete DL frame for "
Holger Hans Peter Freyther34f6e5e2013-10-27 20:31:47 +01001026 "%s that fits precisely in last block: "
Holger Hans Peter Freythere2310262013-11-13 16:56:15 +01001027 "len=%d\n", tbf_name(this), m_llc.frame_length());
1028 gprs_rlcmac_dl_bw(this, m_llc.frame_length());
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001029 /* block is filled, so there is no extension */
1030 *e_pointer |= 0x01;
1031 /* fill space */
Holger Hans Peter Freytheracb54272013-11-07 08:15:58 +01001032 m_llc.consume(data, space);
Holger Hans Peter Freyther758dc122013-11-06 20:39:45 +01001033 m_llc.reset();
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001034 /* final block */
1035 rh->fbi = 1; /* we indicate final block */
1036 tbf_new_state(this, GPRS_RLCMAC_FINISHED);
1037 /* return data block as message */
1038 break;
1039 }
1040 /* if chunk would fit exactly in space left */
1041 if (chunk == space) {
1042 LOGP(DRLCMACDL, LOGL_DEBUG, "-- Chunk with length %d "
1043 "would exactly fit into space (%d): add length "
1044 "header with LI=0, to make frame extend to "
1045 "next block, and we are done\n", chunk, space);
1046 /* make space for delimiter */
1047 if (delimiter != data)
Daniel Willmannc3d53252013-11-13 20:27:21 +01001048 memmove(delimiter + 1, delimiter,
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001049 data - delimiter);
1050 data++;
1051 space--;
1052 /* add LI with 0 length */
1053 li = (struct rlc_li_field *)delimiter;
1054 li->e = 1; /* not more extension */
1055 li->m = 0; /* shall be set to 0, in case of li = 0 */
1056 li->li = 0; /* chunk fills the complete space */
1057 // no need to set e_pointer nor increase delimiter
1058 /* fill only space, which is 1 octet less than chunk */
Holger Hans Peter Freytheracb54272013-11-07 08:15:58 +01001059 m_llc.consume(data, space);
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001060 /* return data block as message */
1061 break;
1062 }
1063 LOGP(DRLCMACDL, LOGL_DEBUG, "-- Chunk with length %d is less "
1064 "than remaining space (%d): add length header to "
1065 "to delimit LLC frame\n", chunk, space);
1066 /* the LLC frame chunk ends in this block */
1067 /* make space for delimiter */
1068 if (delimiter != data)
Daniel Willmannc3d53252013-11-13 20:27:21 +01001069 memmove(delimiter + 1, delimiter, data - delimiter);
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001070 data++;
1071 space--;
1072 /* add LI to delimit frame */
1073 li = (struct rlc_li_field *)delimiter;
1074 li->e = 0; /* Extension bit, maybe set later */
1075 li->m = 0; /* will be set later, if there is more LLC data */
1076 li->li = chunk; /* length of chunk */
1077 e_pointer = delimiter; /* points to E of current delimiter */
1078 delimiter++;
Holger Hans Peter Freytheracb54272013-11-07 08:15:58 +01001079 /* copy (rest of) LLC frame to space and reset later */
1080 m_llc.consume(data, chunk);
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001081 data += chunk;
1082 space -= chunk;
Holger Hans Peter Freyther34f6e5e2013-10-27 20:31:47 +01001083 LOGP(DRLCMACDL, LOGL_INFO, "Complete DL frame for %s"
Holger Hans Peter Freythere2310262013-11-13 16:56:15 +01001084 "len=%d\n", tbf_name(this), m_llc.frame_length());
1085 gprs_rlcmac_dl_bw(this, m_llc.frame_length());
Holger Hans Peter Freyther758dc122013-11-06 20:39:45 +01001086 m_llc.reset();
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001087 /* dequeue next LLC frame, if any */
1088 msg = llc_dequeue(gprs_bssgp_pcu_current_bctx());
1089 if (msg) {
1090 LOGP(DRLCMACDL, LOGL_INFO, "- Dequeue next LLC for "
Holger Hans Peter Freyther34f6e5e2013-10-27 20:31:47 +01001091 "%s (len=%d)\n", tbf_name(this), msg->len);
Holger Hans Peter Freyther857281f2013-11-13 14:56:55 +01001092 m_llc.put_frame(msg->data, msg->len);
Holger Hans Peter Freytherb3d5ee22013-11-13 16:43:26 +01001093 bts->llc_frame_sched();
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001094 msgb_free(msg);
1095 }
1096 /* if we have more data and we have space left */
Holger Hans Peter Freythere2310262013-11-13 16:56:15 +01001097 if (space > 0 && m_llc.frame_length()) {
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001098 li->m = 1; /* we indicate more frames to follow */
1099 continue;
1100 }
1101 /* if we don't have more LLC frames */
Holger Hans Peter Freythere2310262013-11-13 16:56:15 +01001102 if (!m_llc.frame_length()) {
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001103 LOGP(DRLCMACDL, LOGL_DEBUG, "-- Final block, so we "
1104 "done.\n");
1105 li->e = 1; /* we cannot extend */
1106 rh->fbi = 1; /* we indicate final block */
Holger Hans Peter Freytherb7840462013-11-07 07:50:26 +01001107 first_fin_ack = true;
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001108 /* + 1 indicates: first final ack */
1109 tbf_new_state(this, GPRS_RLCMAC_FINISHED);
1110 break;
1111 }
1112 /* we have no space left */
1113 LOGP(DRLCMACDL, LOGL_DEBUG, "-- No space left, so we are "
1114 "done.\n");
1115 li->e = 1; /* we cannot extend */
1116 break;
1117 }
1118 LOGP(DRLCMACDL, LOGL_DEBUG, "data block: %s\n",
Holger Hans Peter Freyther3cbf9e02013-11-26 21:43:58 +01001119 osmo_hexdump(rlc_data->block, block_length));
Holger Hans Peter Freyther58db60c2013-11-13 20:45:40 +01001120#warning "move this up?"
Holger Hans Peter Freyther3cbf9e02013-11-26 21:43:58 +01001121 rlc_data->len = block_length;
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001122 /* raise send state and set ack state array */
Daniel Willmann7e994e32014-08-07 15:49:21 +02001123 m_window.m_v_b.mark_unacked(bsn);
1124 m_window.increment_send();
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001125
Holger Hans Peter Freyther3cbf9e02013-11-26 21:43:58 +01001126 return create_dl_acked_block(fn, ts, bsn, first_fin_ack);
Holger Hans Peter Freytherb7840462013-11-07 07:50:26 +01001127}
1128
Daniel Willmannb8f26012014-07-30 19:12:28 +02001129struct msgb *gprs_rlcmac_dl_tbf::create_dl_acked_block(
Holger Hans Peter Freytherb7840462013-11-07 07:50:26 +01001130 const uint32_t fn, const uint8_t ts,
1131 const int index, const bool first_fin_ack)
1132{
1133 uint8_t *data;
1134 struct rlc_dl_header *rh;
1135 struct msgb *dl_msg;
1136 uint8_t len;
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001137
1138 /* get data and header from current block */
Holger Hans Peter Freyther3cbf9e02013-11-26 21:43:58 +01001139 data = m_rlc.block(index)->block;
1140 len = m_rlc.block(index)->len;
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001141 rh = (struct rlc_dl_header *)data;
1142
1143 /* Clear Polling, if still set in history buffer */
1144 rh->s_p = 0;
1145
1146 /* poll after POLL_ACK_AFTER_FRAMES frames, or when final block is tx.
1147 */
Daniel Willmann7e994e32014-08-07 15:49:21 +02001148 if (m_tx_counter >= POLL_ACK_AFTER_FRAMES || first_fin_ack) {
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001149 if (first_fin_ack) {
1150 LOGP(DRLCMACDL, LOGL_DEBUG, "- Scheduling Ack/Nack "
1151 "polling, because first final block sent.\n");
1152 } else {
1153 LOGP(DRLCMACDL, LOGL_DEBUG, "- Scheduling Ack/Nack "
1154 "polling, because %d blocks sent.\n",
1155 POLL_ACK_AFTER_FRAMES);
1156 }
1157 /* scheduling not possible, because: */
1158 if (poll_state != GPRS_RLCMAC_POLL_NONE)
Holger Hans Peter Freythere5109ba2014-01-16 10:11:22 +01001159 LOGP(DRLCMACDL, LOGL_DEBUG, "Polling is already "
Holger Hans Peter Freyther34f6e5e2013-10-27 20:31:47 +01001160 "sheduled for %s, so we must wait for "
1161 "requesting downlink ack\n", tbf_name(this));
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001162 else if (control_ts != ts)
Holger Hans Peter Freythere5109ba2014-01-16 10:11:22 +01001163 LOGP(DRLCMACDL, LOGL_DEBUG, "Polling cannot be "
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001164 "sheduled in this TS %d, waiting for "
1165 "TS %d\n", ts, control_ts);
Holger Hans Peter Freyther58db60c2013-11-13 20:45:40 +01001166#warning "What happens to the first_fin_ack in case something is already scheduled?"
Holger Hans Peter Freytherec80f822013-10-27 13:44:37 +01001167 else if (bts->sba()->find(trx->trx_no, ts, (fn + 13) % 2715648))
Holger Hans Peter Freythere5109ba2014-01-16 10:11:22 +01001168 LOGP(DRLCMACDL, LOGL_DEBUG, "Polling cannot be "
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001169 "sheduled, because single block alllocation "
1170 "already exists\n");
1171 else {
Holger Hans Peter Freythere5109ba2014-01-16 10:11:22 +01001172 LOGP(DRLCMACDL, LOGL_DEBUG, "Polling sheduled in this "
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001173 "TS %d\n", ts);
Daniel Willmann7e994e32014-08-07 15:49:21 +02001174 m_tx_counter = 0;
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001175 /* start timer whenever we send the final block */
1176 if (rh->fbi == 1)
1177 tbf_timer_start(this, 3191, bts_data()->t3191, 0);
1178
1179 /* schedule polling */
1180 poll_state = GPRS_RLCMAC_POLL_SCHED;
1181 poll_fn = (fn + 13) % 2715648;
1182
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001183 /* set polling in header */
1184 rh->rrbp = 0; /* N+13 */
1185 rh->s_p = 1; /* Polling */
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001186 }
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001187 }
1188
1189 /* return data block as message */
1190 dl_msg = msgb_alloc(len, "rlcmac_dl_data");
1191 if (!dl_msg)
1192 return NULL;
Holger Hans Peter Freyther64b49bc2013-11-23 23:16:07 +01001193
1194 /* Increment TX-counter */
Daniel Willmann7e994e32014-08-07 15:49:21 +02001195 m_tx_counter++;
Holger Hans Peter Freyther64b49bc2013-11-23 23:16:07 +01001196
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001197 memcpy(msgb_put(dl_msg, len), data, len);
Holger Hans Peter Freythere9429b52013-11-13 19:36:57 +01001198 bts->rlc_sent();
Holger Hans Peter Freyther61a0a042013-10-26 21:48:38 +02001199
1200 return dl_msg;
1201}
1202
Holger Hans Peter Freyther2db7e7e2013-10-26 20:45:35 +02001203struct msgb *gprs_rlcmac_tbf::create_dl_ass(uint32_t fn)
1204{
1205 struct msgb *msg;
Daniel Willmannb2886f12014-08-07 14:48:20 +02001206 struct gprs_rlcmac_dl_tbf *new_dl_tbf;
Holger Hans Peter Freyther9977e152013-11-24 22:52:10 +01001207 int poll_ass_dl = 1;
Holger Hans Peter Freyther2db7e7e2013-10-26 20:45:35 +02001208
Holger Hans Peter Freyther9977e152013-11-24 22:52:10 +01001209 if (direction == GPRS_RLCMAC_DL_TBF && control_ts != first_common_ts) {
Holger Hans Peter Freyther2db7e7e2013-10-26 20:45:35 +02001210 LOGP(DRLCMAC, LOGL_NOTICE, "Cannot poll for downlink "
1211 "assigment, because MS cannot reply. (control TS=%d, "
1212 "first common TS=%d)\n", control_ts,
1213 first_common_ts);
1214 poll_ass_dl = 0;
1215 }
1216 if (poll_ass_dl) {
1217 if (poll_state != GPRS_RLCMAC_POLL_NONE) {
1218 LOGP(DRLCMAC, LOGL_DEBUG, "Polling is already sheduled "
Holger Hans Peter Freyther34f6e5e2013-10-27 20:31:47 +01001219 "for %s, so we must wait for downlink "
1220 "assignment...\n", tbf_name(this));
Holger Hans Peter Freyther2db7e7e2013-10-26 20:45:35 +02001221 return NULL;
1222 }
Holger Hans Peter Freytherec80f822013-10-27 13:44:37 +01001223 if (bts->sba()->find(trx->trx_no, control_ts, (fn + 13) % 2715648)) {
Holger Hans Peter Freyther2db7e7e2013-10-26 20:45:35 +02001224 LOGP(DRLCMACUL, LOGL_DEBUG, "Polling is already "
1225 "scheduled for single block allocation...\n");
1226 return NULL;
1227 }
1228 }
1229
1230 /* on uplink TBF we get the downlink TBF to be assigned. */
1231 if (direction == GPRS_RLCMAC_UL_TBF) {
Daniel Willmannb2886f12014-08-07 14:48:20 +02001232 gprs_rlcmac_ul_tbf *ul_tbf = static_cast<gprs_rlcmac_ul_tbf *>(this);
1233
Holger Hans Peter Freyther2db7e7e2013-10-26 20:45:35 +02001234 /* be sure to check first, if contention resolution is done,
1235 * otherwise we cannot send the assignment yet */
Daniel Willmann7e994e32014-08-07 15:49:21 +02001236 if (!ul_tbf->m_contention_resolution_done) {
Holger Hans Peter Freyther2db7e7e2013-10-26 20:45:35 +02001237 LOGP(DRLCMAC, LOGL_DEBUG, "Cannot assign DL TBF now, "
1238 "because contention resolution is not "
1239 "finished.\n");
1240 return NULL;
1241 }
1242 #warning "THIS should probably go over the IMSI too"
Daniel Willmannb2886f12014-08-07 14:48:20 +02001243 new_dl_tbf = ul_tbf->bts->dl_tbf_by_tlli(m_tlli);
Holger Hans Peter Freyther2db7e7e2013-10-26 20:45:35 +02001244 } else
Daniel Willmannb2886f12014-08-07 14:48:20 +02001245 new_dl_tbf = static_cast<gprs_rlcmac_dl_tbf *>(this);
1246 if (!new_dl_tbf) {
Holger Hans Peter Freyther2db7e7e2013-10-26 20:45:35 +02001247 LOGP(DRLCMACDL, LOGL_ERROR, "We have a schedule for downlink "
Holger Hans Peter Freyther34f6e5e2013-10-27 20:31:47 +01001248 "assignment at uplink %s, but there is no downlink "
1249 "TBF\n", tbf_name(this));
Holger Hans Peter Freyther2db7e7e2013-10-26 20:45:35 +02001250 dl_ass_state = GPRS_RLCMAC_DL_ASS_NONE;
1251 return NULL;
1252 }
1253
1254 msg = msgb_alloc(23, "rlcmac_dl_ass");
1255 if (!msg)
1256 return NULL;
1257 bitvec *ass_vec = bitvec_alloc(23);
1258 if (!ass_vec) {
1259 msgb_free(msg);
1260 return NULL;
1261 }
1262 bitvec_unhex(ass_vec,
1263 "2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b");
Daniel Willmannb2886f12014-08-07 14:48:20 +02001264 LOGP(DRLCMAC, LOGL_INFO, "%s start Packet Downlink Assignment (PACCH)\n", tbf_name(new_dl_tbf));
Holger Hans Peter Freyther2db7e7e2013-10-26 20:45:35 +02001265 RlcMacDownlink_t * mac_control_block = (RlcMacDownlink_t *)talloc_zero(tall_pcu_ctx, RlcMacDownlink_t);
Holger Hans Peter Freyther34f6e5e2013-10-27 20:31:47 +01001266 Encoding::write_packet_downlink_assignment(mac_control_block, m_tfi,
Daniel Willmannb2886f12014-08-07 14:48:20 +02001267 (direction == GPRS_RLCMAC_DL_TBF), new_dl_tbf,
Holger Hans Peter Freyther2db7e7e2013-10-26 20:45:35 +02001268 poll_ass_dl, bts_data()->alpha, bts_data()->gamma, -1, 0);
1269 LOGP(DRLCMAC, LOGL_DEBUG, "+++++++++++++++++++++++++ TX : Packet Downlink Assignment +++++++++++++++++++++++++\n");
1270 encode_gsm_rlcmac_downlink(ass_vec, mac_control_block);
1271 LOGPC(DCSN1, LOGL_NOTICE, "\n");
1272 LOGP(DRLCMAC, LOGL_DEBUG, "------------------------- TX : Packet Downlink Assignment -------------------------\n");
1273 bitvec_pack(ass_vec, msgb_put(msg, 23));
1274 bitvec_free(ass_vec);
1275 talloc_free(mac_control_block);
1276
1277 if (poll_ass_dl) {
1278 poll_state = GPRS_RLCMAC_POLL_SCHED;
1279 poll_fn = (fn + 13) % 2715648;
1280 dl_ass_state = GPRS_RLCMAC_DL_ASS_WAIT_ACK;
1281 } else {
1282 dl_ass_state = GPRS_RLCMAC_DL_ASS_NONE;
Daniel Willmannb2886f12014-08-07 14:48:20 +02001283 tbf_new_state(new_dl_tbf, GPRS_RLCMAC_FLOW);
1284 tbf_assign_control_ts(new_dl_tbf);
Holger Hans Peter Freyther2db7e7e2013-10-26 20:45:35 +02001285 /* stop pending assignment timer */
Daniel Willmannb2886f12014-08-07 14:48:20 +02001286 new_dl_tbf->stop_timer();
Holger Hans Peter Freyther2db7e7e2013-10-26 20:45:35 +02001287
1288 }
Holger Hans Peter Freyther2db7e7e2013-10-26 20:45:35 +02001289
1290 return msg;
1291}
1292
Holger Hans Peter Freytherae03f222013-10-26 21:20:51 +02001293struct msgb *gprs_rlcmac_tbf::create_ul_ass(uint32_t fn)
1294{
1295 struct msgb *msg;
Daniel Willmann350f64d2014-08-07 14:54:11 +02001296 struct gprs_rlcmac_ul_tbf *new_tbf;
Holger Hans Peter Freytherae03f222013-10-26 21:20:51 +02001297
Holger Hans Peter Freytherae03f222013-10-26 21:20:51 +02001298 if (poll_state != GPRS_RLCMAC_POLL_NONE) {
1299 LOGP(DRLCMACUL, LOGL_DEBUG, "Polling is already "
Holger Hans Peter Freyther34f6e5e2013-10-27 20:31:47 +01001300 "sheduled for %s, so we must wait for uplink "
1301 "assignment...\n", tbf_name(this));
Holger Hans Peter Freytherae03f222013-10-26 21:20:51 +02001302 return NULL;
1303 }
Holger Hans Peter Freytherec80f822013-10-27 13:44:37 +01001304 if (bts->sba()->find(trx->trx_no, control_ts, (fn + 13) % 2715648)) {
Holger Hans Peter Freytherae03f222013-10-26 21:20:51 +02001305 LOGP(DRLCMACUL, LOGL_DEBUG, "Polling is already scheduled for "
1306 "single block allocation...\n");
1307 return NULL;
1308 }
Holger Hans Peter Freytherae03f222013-10-26 21:20:51 +02001309
1310 /* on down TBF we get the uplink TBF to be assigned. */
1311#warning "Probably want to find by IMSI too"
1312 if (direction == GPRS_RLCMAC_DL_TBF)
Daniel Willmannb59d61b2014-07-02 17:58:14 +02001313 new_tbf = bts->ul_tbf_by_tlli(m_tlli);
Holger Hans Peter Freytherae03f222013-10-26 21:20:51 +02001314 else
Daniel Willmann350f64d2014-08-07 14:54:11 +02001315 new_tbf = static_cast<gprs_rlcmac_ul_tbf *>(this);
Holger Hans Peter Freytherae03f222013-10-26 21:20:51 +02001316
1317 if (!new_tbf) {
1318 LOGP(DRLCMACUL, LOGL_ERROR, "We have a schedule for uplink "
Holger Hans Peter Freyther34f6e5e2013-10-27 20:31:47 +01001319 "assignment at downlink %s, but there is no uplink "
1320 "TBF\n", tbf_name(this));
Holger Hans Peter Freytherae03f222013-10-26 21:20:51 +02001321 ul_ass_state = GPRS_RLCMAC_UL_ASS_NONE;
1322 return NULL;
1323 }
1324
1325 msg = msgb_alloc(23, "rlcmac_ul_ass");
1326 if (!msg)
1327 return NULL;
Holger Hans Peter Freyther474685e2013-10-27 17:01:14 +01001328 LOGP(DRLCMAC, LOGL_INFO, "%ss start Packet Uplink Assignment (PACCH)\n", tbf_name(new_tbf));
Holger Hans Peter Freytherae03f222013-10-26 21:20:51 +02001329 bitvec *ass_vec = bitvec_alloc(23);
1330 if (!ass_vec) {
1331 msgb_free(msg);
1332 return NULL;
1333 }
1334 bitvec_unhex(ass_vec,
1335 "2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b");
Holger Hans Peter Freyther34f6e5e2013-10-27 20:31:47 +01001336 Encoding::write_packet_uplink_assignment(bts_data(), ass_vec, m_tfi,
Holger Hans Peter Freyther474685e2013-10-27 17:01:14 +01001337 (direction == GPRS_RLCMAC_DL_TBF), m_tlli,
Holger Hans Peter Freyther9977e152013-11-24 22:52:10 +01001338 m_tlli_valid, new_tbf, 1, bts_data()->alpha,
Holger Hans Peter Freytherae03f222013-10-26 21:20:51 +02001339 bts_data()->gamma, -1);
1340 bitvec_pack(ass_vec, msgb_put(msg, 23));
1341 RlcMacDownlink_t * mac_control_block = (RlcMacDownlink_t *)talloc_zero(tall_pcu_ctx, RlcMacDownlink_t);
1342 LOGP(DRLCMAC, LOGL_DEBUG, "+++++++++++++++++++++++++ TX : Packet Uplink Assignment +++++++++++++++++++++++++\n");
1343 decode_gsm_rlcmac_downlink(ass_vec, mac_control_block);
1344 LOGPC(DCSN1, LOGL_NOTICE, "\n");
1345 LOGP(DRLCMAC, LOGL_DEBUG, "------------------------- TX : Packet Uplink Assignment -------------------------\n");
1346 bitvec_free(ass_vec);
1347 talloc_free(mac_control_block);
1348
Holger Hans Peter Freytherae03f222013-10-26 21:20:51 +02001349 poll_state = GPRS_RLCMAC_POLL_SCHED;
1350 poll_fn = (fn + 13) % 2715648;
1351 ul_ass_state = GPRS_RLCMAC_UL_ASS_WAIT_ACK;
Holger Hans Peter Freytherae03f222013-10-26 21:20:51 +02001352
1353 return msg;
1354}
1355
Daniel Willmann350f64d2014-08-07 14:54:11 +02001356struct msgb *gprs_rlcmac_ul_tbf::create_ul_ack(uint32_t fn)
Holger Hans Peter Freyther46bcb8d2013-10-26 21:04:28 +02001357{
1358 int final = (state_is(GPRS_RLCMAC_FINISHED));
1359 struct msgb *msg;
1360
1361 if (final) {
1362 if (poll_state != GPRS_RLCMAC_POLL_NONE) {
1363 LOGP(DRLCMACUL, LOGL_DEBUG, "Polling is already "
Holger Hans Peter Freyther34f6e5e2013-10-27 20:31:47 +01001364 "sheduled for %s, so we must wait for "
1365 "final uplink ack...\n", tbf_name(this));
Holger Hans Peter Freyther46bcb8d2013-10-26 21:04:28 +02001366 return NULL;
1367 }
Holger Hans Peter Freytherec80f822013-10-27 13:44:37 +01001368 if (bts->sba()->find(trx->trx_no, control_ts, (fn + 13) % 2715648)) {
Holger Hans Peter Freyther46bcb8d2013-10-26 21:04:28 +02001369 LOGP(DRLCMACUL, LOGL_DEBUG, "Polling is already "
1370 "scheduled for single block allocation...\n");
1371 return NULL;
1372 }
1373 }
1374
1375 msg = msgb_alloc(23, "rlcmac_ul_ack");
1376 if (!msg)
1377 return NULL;
1378 bitvec *ack_vec = bitvec_alloc(23);
1379 if (!ack_vec) {
1380 msgb_free(msg);
1381 return NULL;
1382 }
1383 bitvec_unhex(ack_vec,
1384 "2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b");
1385 RlcMacDownlink_t * mac_control_block = (RlcMacDownlink_t *)talloc_zero(tall_pcu_ctx, RlcMacDownlink_t);
1386 Encoding::write_packet_uplink_ack(bts_data(), mac_control_block, this, final);
1387 encode_gsm_rlcmac_downlink(ack_vec, mac_control_block);
1388 bitvec_pack(ack_vec, msgb_put(msg, 23));
1389 bitvec_free(ack_vec);
1390 talloc_free(mac_control_block);
1391
1392 /* now we must set this flag, so we are allowed to assign downlink
Holger Hans Peter Freyther22b31192013-10-26 21:07:45 +02001393 * TBF on PACCH. it is only allowed when TLLI is acknowledged. */
Daniel Willmann7e994e32014-08-07 15:49:21 +02001394 m_contention_resolution_done = 1;
Holger Hans Peter Freyther46bcb8d2013-10-26 21:04:28 +02001395
1396 if (final) {
1397 poll_state = GPRS_RLCMAC_POLL_SCHED;
1398 poll_fn = (fn + 13) % 2715648;
1399 /* waiting for final acknowledge */
1400 ul_ack_state = GPRS_RLCMAC_UL_ACK_WAIT_ACK;
Daniel Willmann7e994e32014-08-07 15:49:21 +02001401 m_final_ack_sent = 1;
Holger Hans Peter Freyther46bcb8d2013-10-26 21:04:28 +02001402 } else
1403 ul_ack_state = GPRS_RLCMAC_UL_ACK_NONE;
Holger Hans Peter Freyther46bcb8d2013-10-26 21:04:28 +02001404
1405 return msg;
1406}
1407
Daniel Willmann30168882014-08-07 12:48:29 +02001408int gprs_rlcmac_dl_tbf::update_window(const uint8_t ssn, const uint8_t *rbb)
Holger Hans Peter Freyther3dc56a32013-10-26 21:38:30 +02001409{
Holger Hans Peter Freyther3dc56a32013-10-26 21:38:30 +02001410 int16_t dist; /* must be signed */
Holger Hans Peter Freyther86dc3552013-11-24 17:28:49 +01001411 uint16_t lost = 0, received = 0;
Holger Hans Peter Freyther86dc3552013-11-24 17:28:49 +01001412 char show_rbb[65];
1413 char show_v_b[RLC_MAX_SNS + 1];
Daniel Willmann7e994e32014-08-07 15:49:21 +02001414 const uint16_t mod_sns = m_window.mod_sns();
Holger Hans Peter Freyther86dc3552013-11-24 17:28:49 +01001415
1416 Decoding::extract_rbb(rbb, show_rbb);
1417 /* show received array in debug (bit 64..1) */
1418 LOGP(DRLCMACDL, LOGL_DEBUG, "- ack: (BSN=%d)\"%s\""
Daniel Willmann6f7cb2c2013-12-11 14:25:20 +01001419 "(BSN=%d) R=ACK I=NACK\n", (ssn - 64) & mod_sns,
Holger Hans Peter Freyther86dc3552013-11-24 17:28:49 +01001420 show_rbb, (ssn - 1) & mod_sns);
1421
1422 /* apply received array to receive state (SSN-64..SSN-1) */
1423 /* calculate distance of ssn from V(S) */
Daniel Willmann7e994e32014-08-07 15:49:21 +02001424 dist = (m_window.v_s() - ssn) & mod_sns;
Holger Hans Peter Freyther86dc3552013-11-24 17:28:49 +01001425 /* check if distance is less than distance V(A)..V(S) */
Daniel Willmann7e994e32014-08-07 15:49:21 +02001426 if (dist >= m_window.distance()) {
Holger Hans Peter Freyther86dc3552013-11-24 17:28:49 +01001427 /* this might happpen, if the downlink assignment
1428 * was not received by ms and the ack refers
1429 * to previous TBF
1430 * FIXME: we should implement polling for
1431 * control ack!*/
1432 LOGP(DRLCMACDL, LOGL_NOTICE, "- ack range is out of "
1433 "V(A)..V(S) range %s Free TBF!\n", tbf_name(this));
1434 return 1; /* indicate to free TBF */
1435 }
1436
Daniel Willmann7e994e32014-08-07 15:49:21 +02001437 m_window.update(bts, show_rbb, ssn,
Holger Hans Peter Freytherf1593b72013-11-24 20:36:36 +01001438 &lost, &received);
Holger Hans Peter Freyther86dc3552013-11-24 17:28:49 +01001439
1440 /* report lost and received packets */
1441 gprs_rlcmac_received_lost(this, received, lost);
1442
1443 /* raise V(A), if possible */
Daniel Willmann7e994e32014-08-07 15:49:21 +02001444 m_window.raise(m_window.move_window());
Holger Hans Peter Freyther86dc3552013-11-24 17:28:49 +01001445
1446 /* show receive state array in debug (V(A)..V(S)-1) */
Daniel Willmann7e994e32014-08-07 15:49:21 +02001447 m_window.show_state(show_v_b);
Holger Hans Peter Freyther86dc3552013-11-24 17:28:49 +01001448 LOGP(DRLCMACDL, LOGL_DEBUG, "- V(B): (V(A)=%d)\"%s\""
1449 "(V(S)-1=%d) A=Acked N=Nacked U=Unacked "
Holger Hans Peter Freytherf1593b72013-11-24 20:36:36 +01001450 "X=Resend-Unacked I=Invalid\n",
Daniel Willmann7e994e32014-08-07 15:49:21 +02001451 m_window.v_a(), show_v_b,
1452 m_window.v_s_mod(-1));
Holger Hans Peter Freyther86dc3552013-11-24 17:28:49 +01001453
Daniel Willmann7e994e32014-08-07 15:49:21 +02001454 if (state_is(GPRS_RLCMAC_FINISHED) && m_window.window_empty()) {
Holger Hans Peter Freyther86dc3552013-11-24 17:28:49 +01001455 LOGP(DRLCMACDL, LOGL_NOTICE, "Received acknowledge of "
1456 "all blocks, but without final ack "
1457 "inidcation (don't worry)\n");
1458 }
1459 return 0;
1460}
1461
1462
Daniel Willmann30168882014-08-07 12:48:29 +02001463int gprs_rlcmac_dl_tbf::maybe_start_new_window()
Holger Hans Peter Freyther86dc3552013-11-24 17:28:49 +01001464{
Holger Hans Peter Freyther3dc56a32013-10-26 21:38:30 +02001465 struct msgb *msg;
Holger Hans Peter Freyther9c5539d2013-11-24 17:34:17 +01001466 uint16_t received;
Holger Hans Peter Freyther3dc56a32013-10-26 21:38:30 +02001467
Holger Hans Peter Freyther3dc56a32013-10-26 21:38:30 +02001468 LOGP(DRLCMACDL, LOGL_DEBUG, "- Final ACK received.\n");
Holger Hans Peter Freyther3dc56a32013-10-26 21:38:30 +02001469 /* range V(A)..V(S)-1 */
Daniel Willmann7e994e32014-08-07 15:49:21 +02001470 received = m_window.count_unacked();
Holger Hans Peter Freyther3dc56a32013-10-26 21:38:30 +02001471
1472 /* report all outstanding packets as received */
Holger Hans Peter Freyther9c5539d2013-11-24 17:34:17 +01001473 gprs_rlcmac_received_lost(this, received, 0);
Holger Hans Peter Freyther3dc56a32013-10-26 21:38:30 +02001474
Daniel Willmann73191a42014-05-30 17:58:00 +02001475 tbf_new_state(this, GPRS_RLCMAC_WAIT_RELEASE);
1476
Holger Hans Peter Freyther3dc56a32013-10-26 21:38:30 +02001477 /* check for LLC PDU in the LLC Queue */
1478 msg = llc_dequeue(gprs_bssgp_pcu_current_bctx());
1479 if (!msg) {
1480 /* no message, start T3193, change state to RELEASE */
Holger Hans Peter Freyther86dc3552013-11-24 17:28:49 +01001481 LOGP(DRLCMACDL, LOGL_DEBUG, "- No new message, so we release.\n");
Holger Hans Peter Freyther3dc56a32013-10-26 21:38:30 +02001482 /* start T3193 */
Holger Hans Peter Freyther3dc56a32013-10-26 21:38:30 +02001483 tbf_timer_start(this, 3193,
1484 bts_data()->t3193_msec / 1000,
1485 (bts_data()->t3193_msec % 1000) * 1000);
Holger Hans Peter Freyther3dc56a32013-10-26 21:38:30 +02001486
1487 return 0;
1488 }
Holger Hans Peter Freyther3dc56a32013-10-26 21:38:30 +02001489
Holger Hans Peter Freyther55cf9942013-11-13 18:15:45 +01001490 /* we have more data so we will re-use this tbf */
1491 reuse_tbf(msg->data, msg->len);
1492 msgb_free(msg);
Holger Hans Peter Freyther3dc56a32013-10-26 21:38:30 +02001493 return 0;
1494}
1495
Daniel Willmann6c813fc2014-07-30 19:12:27 +02001496int 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 +01001497{
1498 LOGP(DRLCMACDL, LOGL_DEBUG, "%s downlink acknowledge\n", tbf_name(this));
1499
1500 if (!final_ack)
1501 return update_window(ssn, rbb);
1502 return maybe_start_new_window();
1503}
1504
Holger Hans Peter Freyther964ddb62013-10-16 17:53:23 +02001505void gprs_rlcmac_tbf::free_all(struct gprs_rlcmac_trx *trx)
1506{
1507 for (uint8_t tfi = 0; tfi < 32; tfi++) {
1508 struct gprs_rlcmac_tbf *tbf;
1509
1510 tbf = trx->ul_tbf[tfi];
1511 if (tbf)
1512 tbf_free(tbf);
1513 tbf = trx->dl_tbf[tfi];
1514 if (tbf)
1515 tbf_free(tbf);
1516 }
1517}
Holger Hans Peter Freyther4f6a4e5d2013-10-16 17:58:46 +02001518
1519void gprs_rlcmac_tbf::free_all(struct gprs_rlcmac_pdch *pdch)
1520{
1521 for (uint8_t tfi = 0; tfi < 32; tfi++) {
1522 struct gprs_rlcmac_tbf *tbf;
1523
Daniel Willmann17a1d5e2014-05-30 20:21:30 +02001524 tbf = pdch->ul_tbf_by_tfi(tfi);
Holger Hans Peter Freyther4f6a4e5d2013-10-16 17:58:46 +02001525 if (tbf)
1526 tbf_free(tbf);
Daniel Willmann17a1d5e2014-05-30 20:21:30 +02001527 tbf = pdch->dl_tbf_by_tfi(tfi);
Holger Hans Peter Freyther4f6a4e5d2013-10-16 17:58:46 +02001528 if (tbf)
1529 tbf_free(tbf);
1530 }
1531}
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +01001532
Holger Hans Peter Freyther474685e2013-10-27 17:01:14 +01001533void gprs_rlcmac_tbf::tlli_mark_valid()
1534{
1535 m_tlli_valid = true;
1536}
1537
1538void gprs_rlcmac_tbf::update_tlli(uint32_t tlli)
1539{
1540 if (tlli == m_tlli)
1541 return;
1542
Holger Hans Peter Freytherb8098662013-10-30 14:50:17 +01001543 bool changedUl = false;
1544
1545 /*
1546 * During a Routing Area Update (due the assignment of a new
1547 * P-TMSI) the tlli can change. We notice this when receiving
1548 * a PACKET CONTROL ACK.
1549 * When we get a TLLI change on the DL we will look if there
1550 * is a UL TBF and change the tlli there as well.
1551 *
1552 * TODO: There could be multiple DL and UL TBFs and we should
1553 * have a proper way to link all the related TBFs so we can do
1554 * a group update.
1555 */
1556 if (m_tlli_valid && direction == GPRS_RLCMAC_DL_TBF) {
1557 gprs_rlcmac_tbf *ul_tbf;
Daniel Willmannb59d61b2014-07-02 17:58:14 +02001558 ul_tbf = bts->ul_tbf_by_tlli(m_tlli);
Holger Hans Peter Freytherb8098662013-10-30 14:50:17 +01001559
1560 if (ul_tbf) {
1561 ul_tbf->m_tlli = tlli;
1562 changedUl = true;
1563 }
1564 }
1565
Holger Hans Peter Freytherbc1626e2013-10-30 19:50:49 +01001566 /* update the timing advance for the new tlli */
1567 bts->timing_advance()->update(m_tlli, tlli, ta);
1568
Holger Hans Peter Freytherb8098662013-10-30 14:50:17 +01001569 LOGP(DRLCMAC, LOGL_NOTICE,
1570 "%s changing tlli from TLLI=0x%08x TLLI=0x%08x ul_changed=%d\n",
1571 tbf_name(this), m_tlli, tlli, changedUl);
Holger Hans Peter Freyther474685e2013-10-27 17:01:14 +01001572 m_tlli = tlli;
1573}
1574
Holger Hans Peter Freyther4c06d912013-11-25 23:05:26 +01001575int gprs_rlcmac_tbf::extract_tlli(const uint8_t *data, const size_t len)
1576{
1577 struct gprs_rlcmac_tbf *dl_tbf, *ul_tbf;
1578 struct rlc_ul_header *rh = (struct rlc_ul_header *)data;
1579 uint32_t new_tlli;
1580 int rc;
1581
1582 /* no TLLI yet */
1583 if (!rh->ti) {
1584 LOGP(DRLCMACUL, LOGL_NOTICE, "UL DATA TFI=%d without "
1585 "TLLI, but no TLLI received yet\n", rh->tfi);
1586 return 0;
1587 }
1588 rc = Decoding::tlli_from_ul_data(data, len, &new_tlli);
1589 if (rc) {
1590 bts->decode_error();
1591 LOGP(DRLCMACUL, LOGL_NOTICE, "Failed to decode TLLI "
1592 "of UL DATA TFI=%d.\n", rh->tfi);
1593 return 0;
1594 }
1595 update_tlli(new_tlli);
1596 LOGP(DRLCMACUL, LOGL_INFO, "Decoded premier TLLI=0x%08x of "
1597 "UL DATA TFI=%d.\n", tlli(), rh->tfi);
Daniel Willmannb59d61b2014-07-02 17:58:14 +02001598 if ((dl_tbf = bts->dl_tbf_by_tlli(tlli()))) {
Holger Hans Peter Freyther4c06d912013-11-25 23:05:26 +01001599 LOGP(DRLCMACUL, LOGL_NOTICE, "Got RACH from "
1600 "TLLI=0x%08x while %s still exists. "
1601 "Killing pending DL TBF\n", tlli(),
1602 tbf_name(dl_tbf));
1603 tbf_free(dl_tbf);
Holger Hans Peter Freyther3d0cc2f2014-01-16 10:09:42 +01001604 dl_tbf = NULL;
Holger Hans Peter Freyther4c06d912013-11-25 23:05:26 +01001605 }
Daniel Willmannb59d61b2014-07-02 17:58:14 +02001606 /* ul_tbf_by_tlli will not find your TLLI, because it is not
Holger Hans Peter Freyther4c06d912013-11-25 23:05:26 +01001607 * yet marked valid */
Daniel Willmannb59d61b2014-07-02 17:58:14 +02001608 if ((ul_tbf = bts->ul_tbf_by_tlli(tlli()))) {
Holger Hans Peter Freyther4c06d912013-11-25 23:05:26 +01001609 LOGP(DRLCMACUL, LOGL_NOTICE, "Got RACH from "
1610 "TLLI=0x%08x while %s still exists. "
1611 "Killing pending UL TBF\n", tlli(),
1612 tbf_name(ul_tbf));
1613 tbf_free(ul_tbf);
Holger Hans Peter Freyther3d0cc2f2014-01-16 10:09:42 +01001614 ul_tbf = NULL;
Holger Hans Peter Freyther4c06d912013-11-25 23:05:26 +01001615 }
1616 /* mark TLLI valid now */
1617 tlli_mark_valid();
1618 /* store current timing advance */
1619 bts->timing_advance()->remember(tlli(), ta);
1620 return 1;
1621}
1622
Daniel Willmann350f64d2014-08-07 14:54:11 +02001623int gprs_rlcmac_ul_tbf::rcv_data_block_acknowledged(const uint8_t *data, size_t len, int8_t rssi)
Holger Hans Peter Freyther77e05972013-11-06 19:16:43 +01001624{
Holger Hans Peter Freyther77e05972013-11-06 19:16:43 +01001625 struct rlc_ul_header *rh = (struct rlc_ul_header *)data;
1626 int rc;
1627
Daniel Willmann7e994e32014-08-07 15:49:21 +02001628 const uint16_t mod_sns = m_window.mod_sns();
1629 const uint16_t ws = m_window.ws();
Holger Hans Peter Freytherf1593b72013-11-24 20:36:36 +01001630
Holger Hans Peter Freyther77e05972013-11-06 19:16:43 +01001631 this->state_flags |= (1 << GPRS_RLCMAC_FLAG_UL_DATA);
1632
1633 LOGP(DRLCMACUL, LOGL_DEBUG, "UL DATA TFI=%d received (V(Q)=%d .. "
Daniel Willmann7e994e32014-08-07 15:49:21 +02001634 "V(R)=%d)\n", rh->tfi, this->m_window.v_q(),
1635 this->m_window.v_r());
Holger Hans Peter Freyther77e05972013-11-06 19:16:43 +01001636
1637 /* process RSSI */
1638 gprs_rlcmac_rssi(this, rssi);
1639
1640 /* get TLLI */
1641 if (!this->is_tlli_valid()) {
Holger Hans Peter Freyther4c06d912013-11-25 23:05:26 +01001642 if (!extract_tlli(data, len))
Holger Hans Peter Freyther77e05972013-11-06 19:16:43 +01001643 return 0;
Holger Hans Peter Freyther77e05972013-11-06 19:16:43 +01001644 /* already have TLLI, but we stille get another one */
1645 } else if (rh->ti) {
1646 uint32_t tlli;
1647 rc = Decoding::tlli_from_ul_data(data, len, &tlli);
1648 if (rc) {
1649 LOGP(DRLCMACUL, LOGL_NOTICE, "Failed to decode TLLI "
1650 "of UL DATA TFI=%d.\n", rh->tfi);
1651 return 0;
1652 }
1653 if (tlli != this->tlli()) {
1654 LOGP(DRLCMACUL, LOGL_NOTICE, "TLLI mismatch on UL "
1655 "DATA TFI=%d. (Ignoring due to contention "
1656 "resolution)\n", rh->tfi);
1657 return 0;
1658 }
1659 }
1660
Holger Hans Peter Freyther77e05972013-11-06 19:16:43 +01001661 /* restart T3169 */
1662 tbf_timer_start(this, 3169, bts_data()->t3169, 0);
1663
1664 /* Increment RX-counter */
Daniel Willmann7e994e32014-08-07 15:49:21 +02001665 this->m_rx_counter++;
Holger Hans Peter Freyther77e05972013-11-06 19:16:43 +01001666
Daniel Willmann7e994e32014-08-07 15:49:21 +02001667 if (!m_window.is_in_window(rh->bsn)) {
Holger Hans Peter Freyther77e05972013-11-06 19:16:43 +01001668 LOGP(DRLCMACUL, LOGL_DEBUG, "- BSN %d out of window "
Holger Hans Peter Freytherf1593b72013-11-24 20:36:36 +01001669 "%d..%d (it's normal)\n", rh->bsn,
Daniel Willmann7e994e32014-08-07 15:49:21 +02001670 m_window.v_q(),
1671 (m_window.v_q() + ws - 1) & mod_sns);
Holger Hans Peter Freyther3c957762013-11-26 21:03:56 +01001672 maybe_schedule_uplink_acknack(rh);
Holger Hans Peter Freyther77e05972013-11-06 19:16:43 +01001673 return 0;
1674 }
Holger Hans Peter Freyther6ab5b242013-11-24 22:43:03 +01001675
Holger Hans Peter Freyther77e05972013-11-06 19:16:43 +01001676 /* Write block to buffer and set receive state array. */
Holger Hans Peter Freyther3cbf9e02013-11-26 21:43:58 +01001677 m_rlc.block(rh->bsn)->put_data(data, len);
Holger Hans Peter Freyther77e05972013-11-06 19:16:43 +01001678 LOGP(DRLCMACUL, LOGL_DEBUG, "- BSN %d storing in window (%d..%d)\n",
Daniel Willmann7e994e32014-08-07 15:49:21 +02001679 rh->bsn, m_window.v_q(),
1680 (m_window.v_q() + ws - 1) & mod_sns);
Holger Hans Peter Freyther9977e152013-11-24 22:52:10 +01001681
Holger Hans Peter Freyther77e05972013-11-06 19:16:43 +01001682 /* Raise V(Q) if possible, and retrieve LLC frames from blocks.
1683 * This is looped until there is a gap (non received block) or
1684 * the window is empty.*/
Daniel Willmann7e994e32014-08-07 15:49:21 +02001685 const uint16_t v_q_beg = m_window.v_q();
Daniel Willmann55844792013-12-28 14:41:00 +01001686
Daniel Willmann7e994e32014-08-07 15:49:21 +02001687 const uint16_t count = m_window.receive_bsn(rh->bsn);
Holger Hans Peter Freyther7f3e6622013-11-25 23:51:19 +01001688
1689 /* Retrieve LLC frames from blocks that are ready */
1690 for (uint16_t i = 0; i < count; ++i) {
Holger Hans Peter Freyther3cbf9e02013-11-26 21:43:58 +01001691 uint16_t index = (v_q_beg + i) & mod_sns;
1692 assemble_forward_llc(m_rlc.block(index));
Holger Hans Peter Freyther77e05972013-11-06 19:16:43 +01001693 }
1694
1695 /* Check CV of last frame in buffer */
1696 if (this->state_is(GPRS_RLCMAC_FLOW) /* still in flow state */
Daniel Willmann7e994e32014-08-07 15:49:21 +02001697 && this->m_window.v_q() == this->m_window.v_r()) { /* if complete */
Holger Hans Peter Freyther77e05972013-11-06 19:16:43 +01001698 struct rlc_ul_header *last_rh = (struct rlc_ul_header *)
Daniel Willmann7e994e32014-08-07 15:49:21 +02001699 m_rlc.block((m_window.v_r() - 1) & mod_sns)->block;
Holger Hans Peter Freyther77e05972013-11-06 19:16:43 +01001700 LOGP(DRLCMACUL, LOGL_DEBUG, "- No gaps in received block, "
1701 "last block: BSN=%d CV=%d\n", last_rh->bsn,
1702 last_rh->cv);
1703 if (last_rh->cv == 0) {
1704 LOGP(DRLCMACUL, LOGL_DEBUG, "- Finished with UL "
1705 "TBF\n");
1706 tbf_new_state(this, GPRS_RLCMAC_FINISHED);
1707 /* Reset N3103 counter. */
Daniel Willmann7e994e32014-08-07 15:49:21 +02001708 this->m_n3103 = 0;
Holger Hans Peter Freyther77e05972013-11-06 19:16:43 +01001709 }
1710 }
1711
1712 /* If TLLI is included or if we received half of the window, we send
1713 * an ack/nack */
Holger Hans Peter Freyther3c957762013-11-26 21:03:56 +01001714 maybe_schedule_uplink_acknack(rh);
1715
1716 return 0;
1717}
1718
Daniel Willmann350f64d2014-08-07 14:54:11 +02001719void gprs_rlcmac_ul_tbf::maybe_schedule_uplink_acknack(const rlc_ul_header *rh)
Holger Hans Peter Freyther3c957762013-11-26 21:03:56 +01001720{
1721 if (rh->si || rh->ti || state_is(GPRS_RLCMAC_FINISHED)
Daniel Willmann7e994e32014-08-07 15:49:21 +02001722 || (m_rx_counter % SEND_ACK_AFTER_FRAMES) == 0) {
Holger Hans Peter Freyther77e05972013-11-06 19:16:43 +01001723 if (rh->si) {
1724 LOGP(DRLCMACUL, LOGL_NOTICE, "- Scheduling Ack/Nack, "
1725 "because MS is stalled.\n");
1726 }
1727 if (rh->ti) {
1728 LOGP(DRLCMACUL, LOGL_DEBUG, "- Scheduling Ack/Nack, "
1729 "because TLLI is included.\n");
1730 }
Holger Hans Peter Freyther3c957762013-11-26 21:03:56 +01001731 if (state_is(GPRS_RLCMAC_FINISHED)) {
Holger Hans Peter Freyther77e05972013-11-06 19:16:43 +01001732 LOGP(DRLCMACUL, LOGL_DEBUG, "- Scheduling Ack/Nack, "
1733 "because last block has CV==0.\n");
1734 }
Daniel Willmann7e994e32014-08-07 15:49:21 +02001735 if ((m_rx_counter % SEND_ACK_AFTER_FRAMES) == 0) {
Holger Hans Peter Freyther77e05972013-11-06 19:16:43 +01001736 LOGP(DRLCMACUL, LOGL_DEBUG, "- Scheduling Ack/Nack, "
1737 "because %d frames received.\n",
1738 SEND_ACK_AFTER_FRAMES);
1739 }
Holger Hans Peter Freyther3c957762013-11-26 21:03:56 +01001740 if (ul_ack_state == GPRS_RLCMAC_UL_ACK_NONE) {
Holger Hans Peter Freyther77e05972013-11-06 19:16:43 +01001741 /* trigger sending at next RTS */
Holger Hans Peter Freyther3c957762013-11-26 21:03:56 +01001742 ul_ack_state = GPRS_RLCMAC_UL_ACK_SEND_ACK;
Holger Hans Peter Freyther77e05972013-11-06 19:16:43 +01001743 } else {
1744 /* already triggered */
1745 LOGP(DRLCMACUL, LOGL_DEBUG, "- Sending Ack/Nack is "
1746 "already triggered, don't schedule!\n");
1747 }
1748 }
Holger Hans Peter Freyther77e05972013-11-06 19:16:43 +01001749}
1750
Holger Hans Peter Freyther99485142013-11-06 20:08:42 +01001751/* Send Uplink unit-data to SGSN. */
Daniel Willmanne2732e22014-08-07 17:32:01 +02001752int gprs_rlcmac_ul_tbf::snd_ul_ud()
Holger Hans Peter Freyther99485142013-11-06 20:08:42 +01001753{
1754 uint8_t qos_profile[3];
1755 struct msgb *llc_pdu;
Holger Hans Peter Freythere2310262013-11-13 16:56:15 +01001756 unsigned msg_len = NS_HDR_LEN + BSSGP_HDR_LEN + m_llc.frame_length();
Holger Hans Peter Freyther99485142013-11-06 20:08:42 +01001757 struct bssgp_bvc_ctx *bctx = gprs_bssgp_pcu_current_bctx();
1758
Holger Hans Peter Freythere2310262013-11-13 16:56:15 +01001759 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 +01001760 if (!bctx) {
1761 LOGP(DBSSGP, LOGL_ERROR, "No bctx\n");
Holger Hans Peter Freyther758dc122013-11-06 20:39:45 +01001762 m_llc.reset_frame_space();
Holger Hans Peter Freyther99485142013-11-06 20:08:42 +01001763 return -EIO;
1764 }
1765
1766 llc_pdu = msgb_alloc_headroom(msg_len, msg_len,"llc_pdu");
Holger Hans Peter Freythere2310262013-11-13 16:56:15 +01001767 uint8_t *buf = msgb_push(llc_pdu, TL16V_GROSS_LEN(sizeof(uint8_t)*m_llc.frame_length()));
1768 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 +01001769 qos_profile[0] = QOS_PROFILE >> 16;
1770 qos_profile[1] = QOS_PROFILE >> 8;
1771 qos_profile[2] = QOS_PROFILE;
1772 bssgp_tx_ul_ud(bctx, tlli(), qos_profile, llc_pdu);
1773
Holger Hans Peter Freyther758dc122013-11-06 20:39:45 +01001774 m_llc.reset_frame_space();
Holger Hans Peter Freyther99485142013-11-06 20:08:42 +01001775 return 0;
1776}
1777
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +01001778const char *tbf_name(gprs_rlcmac_tbf *tbf)
1779{
1780 static char buf[40];
1781 snprintf(buf, sizeof(buf), "TBF(TFI=%d TLLI=0x%08x DIR=%s)",
Holger Hans Peter Freyther34f6e5e2013-10-27 20:31:47 +01001782 tbf->m_tfi, tbf->m_tlli,
Holger Hans Peter Freytherbd449f52013-10-27 16:39:36 +01001783 tbf->direction == GPRS_RLCMAC_UL_TBF ? "UL" : "DL");
1784 buf[sizeof(buf) - 1] = '\0';
1785 return buf;
1786}
Holger Hans Peter Freyther758dc122013-11-06 20:39:45 +01001787
Holger Hans Peter Freyther55cf9942013-11-13 18:15:45 +01001788
Daniel Willmann30168882014-08-07 12:48:29 +02001789void gprs_rlcmac_dl_tbf::reuse_tbf(const uint8_t *data, const uint16_t len)
Holger Hans Peter Freyther55cf9942013-11-13 18:15:45 +01001790{
1791 bts->tbf_reused();
1792 m_llc.put_frame(data, len);
1793 bts->llc_frame_sched();
1794
1795 /* reset rlc states */
Daniel Willmann7e994e32014-08-07 15:49:21 +02001796 m_tx_counter = 0;
1797 m_wait_confirm = 0;
1798 m_window.reset();
Holger Hans Peter Freyther55cf9942013-11-13 18:15:45 +01001799
1800 /* keep to flags */
1801 state_flags &= GPRS_RLCMAC_FLAG_TO_MASK;
1802 state_flags &= ~(1 << GPRS_RLCMAC_FLAG_CCCH);
1803
1804 update();
1805
1806 LOGP(DRLCMAC, LOGL_DEBUG, "%s Trigger dowlink assignment on PACCH, "
1807 "because another LLC PDU has arrived in between\n",
1808 tbf_name(this));
1809 bts->trigger_dl_ass(this, this, NULL);
1810}
Holger Hans Peter Freytherc03e3822013-11-24 00:21:32 +01001811
Daniel Willmann30168882014-08-07 12:48:29 +02001812bool gprs_rlcmac_dl_tbf::dl_window_stalled() const
Holger Hans Peter Freytherc03e3822013-11-24 00:21:32 +01001813{
Daniel Willmann7e994e32014-08-07 15:49:21 +02001814 return m_window.window_stalled();
Holger Hans Peter Freytherc03e3822013-11-24 00:21:32 +01001815}
Holger Hans Peter Freyther7a5f3c22013-11-26 13:08:12 +01001816
1817void gprs_rlcmac_tbf::rotate_in_list()
1818{
Daniel Willmann1b3864f2014-07-30 13:25:19 +02001819 llist_del(&list.list);
Holger Hans Peter Freyther7a5f3c22013-11-26 13:08:12 +01001820 if (direction == GPRS_RLCMAC_UL_TBF)
Daniel Willmann1b3864f2014-07-30 13:25:19 +02001821 llist_add(&list.list, &bts->bts_data()->ul_tbfs);
Holger Hans Peter Freyther7a5f3c22013-11-26 13:08:12 +01001822 else
Daniel Willmann1b3864f2014-07-30 13:25:19 +02001823 llist_add(&list.list, &bts->bts_data()->dl_tbfs);
Holger Hans Peter Freyther7a5f3c22013-11-26 13:08:12 +01001824}
Holger Hans Peter Freyther8f399de2013-12-25 20:22:35 +01001825
1826uint8_t gprs_rlcmac_tbf::tsc() const
1827{
1828 return trx->pdch[first_ts].tsc;
1829}
Daniel Willmannafa72f52014-01-15 17:06:19 +01001830
1831void tbf_print_vty_info(struct vty *vty, llist_head *ltbf)
1832{
Daniel Willmann1b3864f2014-07-30 13:25:19 +02001833 gprs_rlcmac_tbf *tbf = llist_pods_entry(ltbf, gprs_rlcmac_tbf);
Daniel Willmannafa72f52014-01-15 17:06:19 +01001834
Daniel Willmann772415f2014-01-15 17:06:51 +01001835 vty_out(vty, "TBF: TFI=%d TLLI=0x%08x (%s) DIR=%s IMSI=%s%s", tbf->tfi(),
Daniel Willmannafa72f52014-01-15 17:06:19 +01001836 tbf->tlli(), tbf->is_tlli_valid() ? "valid" : "invalid",
1837 tbf->direction == GPRS_RLCMAC_UL_TBF ? "UL" : "DL",
1838 tbf->imsi(), VTY_NEWLINE);
Daniel Willmann80367aa2014-01-15 17:40:28 +01001839 vty_out(vty, " created=%lu state=%08x 1st_TS=%d 1st_cTS=%d ctrl_TS=%d "
Daniel Willmannafa72f52014-01-15 17:06:19 +01001840 "MS_CLASS=%d%s",
Holger Hans Peter Freythera0047992014-01-16 10:07:20 +01001841 tbf->created_ts(), tbf->state_flags, tbf->first_ts,
Daniel Willmann80367aa2014-01-15 17:40:28 +01001842 tbf->first_common_ts, tbf->control_ts, tbf->ms_class,
1843 VTY_NEWLINE);
Daniel Willmannafa72f52014-01-15 17:06:19 +01001844 vty_out(vty, " TS_alloc=");
1845 for (int i = 0; i < 8; i++) {
1846 if (tbf->pdch[i])
1847 vty_out(vty, "%d ", i);
1848 }
Daniel Willmann772415f2014-01-15 17:06:51 +01001849 vty_out(vty, " CS=%d%s%s", tbf->cs, VTY_NEWLINE, VTY_NEWLINE);
Daniel Willmannafa72f52014-01-15 17:06:19 +01001850}