blob: a9720ca22e9ed31be2cbc95e4b1361f5ca634f26 [file] [log] [blame]
Andreas Eversberg66690dd2012-06-27 15:44:31 +02001/* Data block transfer
2 *
3 * Copyright (C) 2012 Ivan Klyuchnikov
4 * Copyright (C) 2012 Andreas Eversberg <jolly@eversberg.eu>
5 *
6 * This program is free software; you can redistribute it and/or
7 * modify it under the terms of the GNU General Public License
8 * as published by the Free Software Foundation; either version 2
9 * of the License, or (at your option) any later version.
10 *
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
15 *
16 * You should have received a copy of the GNU General Public License
17 * along with this program; if not, write to the Free Software
18 * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
19 */
20
21#include <gprs_bssgp_pcu.h>
22#include <gprs_rlcmac.h>
Andreas Eversberge6228b32012-07-03 13:36:03 +020023#include <pcu_l1_if.h>
Holger Hans Peter Freyther67ed34e2013-10-17 17:01:54 +020024#include <bts.h>
Holger Hans Peter Freyther63f29d62013-10-19 19:04:03 +020025#include <encoding.h>
Holger Hans Peter Freyther86921282013-08-24 21:26:42 +020026#include <tbf.h>
Holger Hans Peter Freytherd11290b2013-10-26 17:32:04 +020027#include <rlc.h>
Andreas Eversberg66690dd2012-06-27 15:44:31 +020028
Holger Hans Peter Freyther7ce21eb2013-10-20 08:28:25 +020029static struct gprs_rlcmac_cs gprs_rlcmac_cs[] = {
30/* frame length data block max payload */
31 { 0, 0, 0 },
32 { 23, 23, 20 }, /* CS-1 */
33 { 34, 33, 30 }, /* CS-2 */
34 { 40, 39, 36 }, /* CS-3 */
35 { 54, 53, 50 }, /* CS-4 */
36};
37
38
Andreas Eversberg6681bb82012-07-25 08:48:44 +020039extern void *tall_pcu_ctx;
Andreas Eversberg66690dd2012-06-27 15:44:31 +020040
Andreas Eversbergf54a89e2012-07-16 11:56:11 +020041/* After sending these frames, we poll for ack/nack. */
Andreas Eversberg5f14bd92012-10-03 14:20:26 +020042#define POLL_ACK_AFTER_FRAMES 20
Andreas Eversberg66690dd2012-06-27 15:44:31 +020043
Andreas Eversberg802bb6e2012-08-06 11:15:05 +020044/* If acknowledgement to uplink/downlink assignmentshould be polled */
45#define POLLING_ASSIGNMENT_DL 1
46#define POLLING_ASSIGNMENT_UL 1
Andreas Eversberge6228b32012-07-03 13:36:03 +020047
Andreas Eversberg66690dd2012-06-27 15:44:31 +020048
Holger Hans Peter Freytherb65e08a2013-10-20 17:10:25 +020049static void gprs_rlcmac_downlink_assignment(
Holger Hans Peter Freyther344ff482013-10-17 12:01:04 +020050 gprs_rlcmac_tbf *tbf, uint8_t poll,
Holger Hans Peter Freyther52c911b2013-08-24 18:30:54 +020051 const char *imsi);
Andreas Eversberga9be1542012-09-27 09:23:24 +020052
Andreas Eversberg14db19e2012-08-06 15:03:03 +020053static int gprs_rlcmac_diag(struct gprs_rlcmac_tbf *tbf)
54{
Holger Hans Peter Freyther7380bab2013-10-16 18:09:19 +020055 return tbf->rlcmac_diag();
Andreas Eversberg14db19e2012-08-06 15:03:03 +020056}
57
Holger Hans Peter Freyther344ff482013-10-17 12:01:04 +020058int gprs_rlcmac_poll_timeout(struct gprs_rlcmac_bts *bts, struct gprs_rlcmac_tbf *tbf)
Andreas Eversberge6228b32012-07-03 13:36:03 +020059{
Andreas Eversbergb0c7ea72012-07-13 14:46:03 +020060 LOGP(DRLCMAC, LOGL_NOTICE, "Poll timeout for %s TBF=%d\n",
61 (tbf->direction == GPRS_RLCMAC_UL_TBF) ? "UL" : "DL", tbf->tfi);
Andreas Eversberge6228b32012-07-03 13:36:03 +020062
63 tbf->poll_state = GPRS_RLCMAC_POLL_NONE;
64
65 if (tbf->ul_ack_state == GPRS_RLCMAC_UL_ACK_WAIT_ACK) {
Andreas Eversberg14db19e2012-08-06 15:03:03 +020066 if (!(tbf->state_flags & (1 << GPRS_RLCMAC_FLAG_TO_UL_ACK))) {
67 LOGP(DRLCMAC, LOGL_NOTICE, "- Timeout for polling "
68 "PACKET CONTROL ACK for PACKET UPLINK ACK\n");
69 gprs_rlcmac_diag(tbf);
70 tbf->state_flags |= (1 << GPRS_RLCMAC_FLAG_TO_UL_ACK);
71 }
Andreas Eversberge6228b32012-07-03 13:36:03 +020072 tbf->ul_ack_state = GPRS_RLCMAC_UL_ACK_NONE;
Holger Hans Peter Freyther34bd8bd2013-10-19 21:10:38 +020073 debug_diagram(bts->bts, tbf->diag, "timeout UL-ACK");
Holger Hans Peter Freyther1c344e22013-10-16 18:33:18 +020074 if (tbf->state_is(GPRS_RLCMAC_FINISHED)) {
Andreas Eversberge6228b32012-07-03 13:36:03 +020075 tbf->dir.ul.n3103++;
Andreas Eversbergdfa563c2012-07-06 08:13:59 +020076 if (tbf->dir.ul.n3103 == bts->n3103) {
Andreas Eversberg4b470ff2012-07-16 12:02:40 +020077 LOGP(DRLCMAC, LOGL_NOTICE,
78 "- N3103 exceeded\n");
Holger Hans Peter Freyther34bd8bd2013-10-19 21:10:38 +020079 debug_diagram(bts->bts, tbf->diag, "N3103 exceeded");
Andreas Eversberge6228b32012-07-03 13:36:03 +020080 tbf_new_state(tbf, GPRS_RLCMAC_RELEASING);
Andreas Eversbergdfa563c2012-07-06 08:13:59 +020081 tbf_timer_start(tbf, 3169, bts->t3169, 0);
Andreas Eversberge6228b32012-07-03 13:36:03 +020082 return 0;
83 }
84 /* reschedule UL ack */
85 tbf->ul_ack_state = GPRS_RLCMAC_UL_ACK_SEND_ACK;
86 }
87 } else
88 if (tbf->ul_ass_state == GPRS_RLCMAC_UL_ASS_WAIT_ACK) {
Andreas Eversberg14db19e2012-08-06 15:03:03 +020089 if (!(tbf->state_flags & (1 << GPRS_RLCMAC_FLAG_TO_UL_ASS))) {
90 LOGP(DRLCMAC, LOGL_NOTICE, "- Timeout for polling "
91 "PACKET CONTROL ACK for PACKET UPLINK "
92 "ASSIGNMENT.\n");
93 gprs_rlcmac_diag(tbf);
94 tbf->state_flags |= (1 << GPRS_RLCMAC_FLAG_TO_UL_ASS);
95 }
Andreas Eversberge6228b32012-07-03 13:36:03 +020096 tbf->ul_ass_state = GPRS_RLCMAC_UL_ASS_NONE;
Holger Hans Peter Freytherb65e08a2013-10-20 17:10:25 +020097 debug_diagram(tbf->bts, tbf->diag, "timeout UL-ASS");
Andreas Eversberg802bb6e2012-08-06 11:15:05 +020098 tbf->n3105++;
99 if (tbf->n3105 == bts->n3105) {
100 LOGP(DRLCMAC, LOGL_NOTICE, "- N3105 exceeded\n");
Holger Hans Peter Freyther34bd8bd2013-10-19 21:10:38 +0200101 debug_diagram(bts->bts, tbf->diag, "N3105 exceeded");
Andreas Eversberge6228b32012-07-03 13:36:03 +0200102 tbf_new_state(tbf, GPRS_RLCMAC_RELEASING);
Andreas Eversbergdfa563c2012-07-06 08:13:59 +0200103 tbf_timer_start(tbf, 3195, bts->t3195, 0);
Andreas Eversberge6228b32012-07-03 13:36:03 +0200104 return 0;
105 }
Andreas Eversberg802bb6e2012-08-06 11:15:05 +0200106 /* reschedule UL assignment */
107 tbf->ul_ass_state = GPRS_RLCMAC_UL_ASS_SEND_ASS;
Andreas Eversberge6228b32012-07-03 13:36:03 +0200108 } else
109 if (tbf->dl_ass_state == GPRS_RLCMAC_DL_ASS_WAIT_ACK) {
Andreas Eversberg14db19e2012-08-06 15:03:03 +0200110 if (!(tbf->state_flags & (1 << GPRS_RLCMAC_FLAG_TO_DL_ASS))) {
111 LOGP(DRLCMAC, LOGL_NOTICE, "- Timeout for polling "
112 "PACKET CONTROL ACK for PACKET DOWNLINK "
113 "ASSIGNMENT.\n");
114 gprs_rlcmac_diag(tbf);
115 tbf->state_flags |= (1 << GPRS_RLCMAC_FLAG_TO_DL_ASS);
116 }
Andreas Eversberge6228b32012-07-03 13:36:03 +0200117 tbf->dl_ass_state = GPRS_RLCMAC_DL_ASS_NONE;
Holger Hans Peter Freyther34bd8bd2013-10-19 21:10:38 +0200118 debug_diagram(bts->bts, tbf->diag, "timeout DL-ASS");
Andreas Eversberg802bb6e2012-08-06 11:15:05 +0200119 tbf->n3105++;
120 if (tbf->n3105 == bts->n3105) {
121 LOGP(DRLCMAC, LOGL_NOTICE, "- N3105 exceeded\n");
Holger Hans Peter Freyther34bd8bd2013-10-19 21:10:38 +0200122 debug_diagram(bts->bts, tbf->diag, "N3105 exceeded");
Andreas Eversberg802bb6e2012-08-06 11:15:05 +0200123 tbf_new_state(tbf, GPRS_RLCMAC_RELEASING);
124 tbf_timer_start(tbf, 3195, bts->t3195, 0);
125 return 0;
Andreas Eversberge6228b32012-07-03 13:36:03 +0200126 }
Andreas Eversberg802bb6e2012-08-06 11:15:05 +0200127 /* reschedule DL assignment */
128 tbf->dl_ass_state = GPRS_RLCMAC_DL_ASS_SEND_ASS;
Andreas Eversberge6228b32012-07-03 13:36:03 +0200129 } else
Andreas Eversberg802bb6e2012-08-06 11:15:05 +0200130 if (tbf->direction == GPRS_RLCMAC_DL_TBF) {
Andreas Eversberg14db19e2012-08-06 15:03:03 +0200131 if (!(tbf->state_flags & (1 << GPRS_RLCMAC_FLAG_TO_DL_ACK))) {
132 LOGP(DRLCMAC, LOGL_NOTICE, "- Timeout for polling "
133 "PACKET DOWNLINK ACK.\n");
134 gprs_rlcmac_diag(tbf);
135 tbf->state_flags |= (1 << GPRS_RLCMAC_FLAG_TO_DL_ACK);
136 }
Holger Hans Peter Freyther34bd8bd2013-10-19 21:10:38 +0200137 debug_diagram(bts->bts, tbf->diag, "timeout DL-ACK");
Andreas Eversberg802bb6e2012-08-06 11:15:05 +0200138 tbf->n3105++;
139 if (tbf->n3105 == bts->n3105) {
Andreas Eversberg4b470ff2012-07-16 12:02:40 +0200140 LOGP(DRLCMAC, LOGL_NOTICE, "- N3105 exceeded\n");
Holger Hans Peter Freyther34bd8bd2013-10-19 21:10:38 +0200141 debug_diagram(bts->bts, tbf->diag, "N3105 exceeded");
Andreas Eversberge6228b32012-07-03 13:36:03 +0200142 tbf_new_state(tbf, GPRS_RLCMAC_RELEASING);
143 tbf_timer_start(tbf, 3195, bts->t3195, 0);
144 return 0;
145 }
Andreas Eversberga9be1542012-09-27 09:23:24 +0200146 /* resend IMM.ASS on CCCH on timeout */
147 if ((tbf->state_flags & (1 << GPRS_RLCMAC_FLAG_CCCH))
148 && !(tbf->state_flags & (1 << GPRS_RLCMAC_FLAG_DL_ACK))) {
149 LOGP(DRLCMAC, LOGL_DEBUG, "Re-send dowlink assignment "
150 "for TBF=%d on PCH (IMSI=%s)\n", tbf->tfi,
151 tbf->dir.dl.imsi);
152 /* send immediate assignment */
Holger Hans Peter Freytherb65e08a2013-10-20 17:10:25 +0200153 gprs_rlcmac_downlink_assignment(tbf, 0, tbf->dir.dl.imsi);
Andreas Eversberga9be1542012-09-27 09:23:24 +0200154 tbf->dir.dl.wait_confirm = 1;
155 }
Andreas Eversberg4b470ff2012-07-16 12:02:40 +0200156 } else
157 LOGP(DRLCMAC, LOGL_ERROR, "- Poll Timeout, but no event!\n");
Andreas Eversberge6228b32012-07-03 13:36:03 +0200158
159 return 0;
160}
161
Andreas Eversberge13fa2d2012-07-09 17:10:44 +0200162#ifdef DEBUG_DL_ASS_IDLE
163 char debug_imsi[16];
164#endif
Andreas Eversberge6228b32012-07-03 13:36:03 +0200165
Andreas Eversberge6228b32012-07-03 13:36:03 +0200166/*
167 * UL data block flow
168 */
169
Holger Hans Peter Freytherb65e08a2013-10-20 17:10:25 +0200170struct msgb *gprs_rlcmac_send_uplink_ack(
Holger Hans Peter Freytherae947fc2013-10-17 13:29:03 +0200171 struct gprs_rlcmac_tbf *tbf,
Andreas Eversberg66690dd2012-06-27 15:44:31 +0200172 uint32_t fn)
173{
Holger Hans Peter Freyther1c344e22013-10-16 18:33:18 +0200174 int final = (tbf->state_is(GPRS_RLCMAC_FINISHED));
Holger Hans Peter Freytherb65e08a2013-10-20 17:10:25 +0200175 gprs_rlcmac_bts *bts = tbf->bts->bts_data();
Andreas Eversberg66690dd2012-06-27 15:44:31 +0200176 struct msgb *msg;
177
Andreas Eversberg07e97cf2012-08-07 16:00:56 +0200178 if (final) {
179 if (tbf->poll_state != GPRS_RLCMAC_POLL_NONE) {
180 LOGP(DRLCMACUL, LOGL_DEBUG, "Polling is already "
181 "sheduled for TBF=%d, so we must wait for "
182 "final uplink ack...\n", tbf->tfi);
Andreas Eversberge6228b32012-07-03 13:36:03 +0200183 return NULL;
Andreas Eversberg07e97cf2012-08-07 16:00:56 +0200184 }
Holger Hans Peter Freytherb65e08a2013-10-20 17:10:25 +0200185 if (tbf->bts->sba()->find(tbf->trx_no, tbf->control_ts, (fn + 13) % 2715648)) {
Andreas Eversberg07e97cf2012-08-07 16:00:56 +0200186 LOGP(DRLCMACUL, LOGL_DEBUG, "Polling is already "
187 "scheduled for single block allocation...\n");
188 return NULL;
189 }
Andreas Eversberge6228b32012-07-03 13:36:03 +0200190 }
191
Andreas Eversberg66690dd2012-06-27 15:44:31 +0200192 msg = msgb_alloc(23, "rlcmac_ul_ack");
193 if (!msg)
194 return NULL;
195 bitvec *ack_vec = bitvec_alloc(23);
196 if (!ack_vec) {
197 msgb_free(msg);
198 return NULL;
199 }
200 bitvec_unhex(ack_vec,
201 "2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b");
Andreas Eversberg6681bb82012-07-25 08:48:44 +0200202 RlcMacDownlink_t * mac_control_block = (RlcMacDownlink_t *)talloc_zero(tall_pcu_ctx, RlcMacDownlink_t);
Holger Hans Peter Freyther63f29d62013-10-19 19:04:03 +0200203 Encoding::write_packet_uplink_ack(bts, mac_control_block, tbf, final);
Ivan Kluchnikovef7f28c2012-07-12 14:49:15 +0400204 encode_gsm_rlcmac_downlink(ack_vec, mac_control_block);
Andreas Eversberg66690dd2012-06-27 15:44:31 +0200205 bitvec_pack(ack_vec, msgb_put(msg, 23));
206 bitvec_free(ack_vec);
Andreas Eversberg6681bb82012-07-25 08:48:44 +0200207 talloc_free(mac_control_block);
Andreas Eversberg66690dd2012-06-27 15:44:31 +0200208
Andreas Eversbergee31b782012-07-15 16:27:01 +0200209 /* now we must set this flag, so we are allowed to assign downlink
210 * TBF on PACCH. it is only allowed when TLLI is aknowledged. */
Andreas Eversberg08e93cd2012-07-26 08:13:06 +0200211 tbf->dir.ul.contention_resolution_done = 1;
Andreas Eversberg66690dd2012-06-27 15:44:31 +0200212
213 if (final) {
Andreas Eversberg66690dd2012-06-27 15:44:31 +0200214 tbf->poll_state = GPRS_RLCMAC_POLL_SCHED;
215 tbf->poll_fn = (fn + 13) % 2715648;
Andreas Eversberge6228b32012-07-03 13:36:03 +0200216 /* waiting for final acknowledge */
217 tbf->ul_ack_state = GPRS_RLCMAC_UL_ACK_WAIT_ACK;
Andreas Eversberg08e93cd2012-07-26 08:13:06 +0200218 tbf->dir.ul.final_ack_sent = 1;
Andreas Eversberg66690dd2012-06-27 15:44:31 +0200219 } else
Andreas Eversberge6228b32012-07-03 13:36:03 +0200220 tbf->ul_ack_state = GPRS_RLCMAC_UL_ACK_NONE;
Holger Hans Peter Freyther34bd8bd2013-10-19 21:10:38 +0200221 debug_diagram(bts->bts, tbf->diag, "send UL-ACK");
Andreas Eversberg66690dd2012-06-27 15:44:31 +0200222
223 return msg;
224}
225
Andreas Eversberge6228b32012-07-03 13:36:03 +0200226struct msgb *gprs_rlcmac_send_packet_uplink_assignment(
227 struct gprs_rlcmac_tbf *tbf, uint32_t fn)
228{
229 struct msgb *msg;
230 struct gprs_rlcmac_tbf *new_tbf;
Holger Hans Peter Freytherb65e08a2013-10-20 17:10:25 +0200231 gprs_rlcmac_bts *bts = tbf->bts->bts_data();
Andreas Eversberge6228b32012-07-03 13:36:03 +0200232
Andreas Eversberg802bb6e2012-08-06 11:15:05 +0200233#if POLLING_ASSIGNMENT_UL == 1
Andreas Eversberge6228b32012-07-03 13:36:03 +0200234 if (tbf->poll_state != GPRS_RLCMAC_POLL_NONE) {
235 LOGP(DRLCMACUL, LOGL_DEBUG, "Polling is already "
236 "sheduled for TBF=%d, so we must wait for uplink "
237 "assignment...\n", tbf->tfi);
238 return NULL;
239 }
Holger Hans Peter Freytherb65e08a2013-10-20 17:10:25 +0200240 if (tbf->bts->sba()->find(tbf->trx_no, tbf->control_ts, (fn + 13) % 2715648)) {
Andreas Eversberg07e97cf2012-08-07 16:00:56 +0200241 LOGP(DRLCMACUL, LOGL_DEBUG, "Polling is already scheduled for "
242 "single block allocation...\n");
243 return NULL;
244 }
Andreas Eversbergb0c7ea72012-07-13 14:46:03 +0200245#endif
Andreas Eversberge6228b32012-07-03 13:36:03 +0200246
247 /* on down TBF we get the uplink TBF to be assigned. */
248 if (tbf->direction == GPRS_RLCMAC_DL_TBF)
Holger Hans Peter Freytherb65e08a2013-10-20 17:10:25 +0200249 new_tbf = tbf->bts->tbf_by_tlli(tbf->tlli, GPRS_RLCMAC_UL_TBF);
Andreas Eversberge6228b32012-07-03 13:36:03 +0200250 else
251 new_tbf = tbf;
252
253 if (!new_tbf) {
254 LOGP(DRLCMACUL, LOGL_ERROR, "We have a schedule for uplink "
255 "assignment at downlink TBF=%d, but there is no uplink "
256 "TBF\n", tbf->tfi);
257 tbf->ul_ass_state = GPRS_RLCMAC_UL_ASS_NONE;
258 return NULL;
259 }
260
261 msg = msgb_alloc(23, "rlcmac_ul_ass");
262 if (!msg)
263 return NULL;
Andreas Eversberg0e403092012-07-06 11:04:57 +0200264 LOGP(DRLCMAC, LOGL_INFO, "TBF: START TFI: %u TLLI: 0x%08x Packet Uplink Assignment (PACCH)\n", new_tbf->tfi, new_tbf->tlli);
Andreas Eversberge6228b32012-07-03 13:36:03 +0200265 bitvec *ass_vec = bitvec_alloc(23);
266 if (!ass_vec) {
267 msgb_free(msg);
268 return NULL;
269 }
270 bitvec_unhex(ass_vec,
271 "2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b");
Holger Hans Peter Freyther63f29d62013-10-19 19:04:03 +0200272 Encoding::write_packet_uplink_assignment(bts, ass_vec, tbf->tfi,
Andreas Eversberg07e97cf2012-08-07 16:00:56 +0200273 (tbf->direction == GPRS_RLCMAC_DL_TBF), tbf->tlli,
Andreas Eversbergaafcbbb2012-09-27 09:20:45 +0200274 tbf->tlli_valid, new_tbf, POLLING_ASSIGNMENT_UL, bts->alpha,
Andreas Eversbergafdd9e12012-10-07 17:08:55 +0200275 bts->gamma, -1);
Andreas Eversberge6228b32012-07-03 13:36:03 +0200276 bitvec_pack(ass_vec, msgb_put(msg, 23));
Andreas Eversberg6681bb82012-07-25 08:48:44 +0200277 RlcMacDownlink_t * mac_control_block = (RlcMacDownlink_t *)talloc_zero(tall_pcu_ctx, RlcMacDownlink_t);
Andreas Eversberg0e403092012-07-06 11:04:57 +0200278 LOGP(DRLCMAC, LOGL_DEBUG, "+++++++++++++++++++++++++ TX : Packet Uplink Assignment +++++++++++++++++++++++++\n");
Andreas Eversberge6228b32012-07-03 13:36:03 +0200279 decode_gsm_rlcmac_downlink(ass_vec, mac_control_block);
Andreas Eversberg0e403092012-07-06 11:04:57 +0200280 LOGPC(DCSN1, LOGL_NOTICE, "\n");
281 LOGP(DRLCMAC, LOGL_DEBUG, "------------------------- TX : Packet Uplink Assignment -------------------------\n");
Andreas Eversberge6228b32012-07-03 13:36:03 +0200282 bitvec_free(ass_vec);
Andreas Eversberg6681bb82012-07-25 08:48:44 +0200283 talloc_free(mac_control_block);
Andreas Eversberge6228b32012-07-03 13:36:03 +0200284
Andreas Eversberg802bb6e2012-08-06 11:15:05 +0200285#if POLLING_ASSIGNMENT_UL == 1
Andreas Eversberge6228b32012-07-03 13:36:03 +0200286 tbf->poll_state = GPRS_RLCMAC_POLL_SCHED;
287 tbf->poll_fn = (fn + 13) % 2715648;
288 tbf->ul_ass_state = GPRS_RLCMAC_UL_ASS_WAIT_ACK;
289#else
290 tbf->ul_ass_state = GPRS_RLCMAC_UL_ASS_NONE;
Andreas Eversberg642c7d32012-07-23 17:58:55 +0200291 tbf_new_state(new_tbf, GPRS_RLCMAC_FLOW);
292 tbf_assign_control_ts(new_tbf);
Andreas Eversberge6228b32012-07-03 13:36:03 +0200293#endif
Holger Hans Peter Freyther34bd8bd2013-10-19 21:10:38 +0200294 debug_diagram(bts->bts, tbf->diag, "send UL-ASS");
Andreas Eversberge6228b32012-07-03 13:36:03 +0200295
296 return msg;
297}
298
Holger Hans Peter Freytherb0250eb2013-10-17 13:46:19 +0200299int gprs_rlcmac_rcv_rach(struct gprs_rlcmac_bts *bts,
300 uint8_t ra, uint32_t Fn, int16_t qta)
Andreas Eversberge6228b32012-07-03 13:36:03 +0200301{
302 struct gprs_rlcmac_tbf *tbf;
Andreas Eversberg02d7cd22013-01-15 08:59:34 +0100303 uint8_t trx, ts = 0;
Andreas Eversbergb0c7ea72012-07-13 14:46:03 +0200304 int8_t tfi; /* must be signed */
Andreas Eversberg07e97cf2012-08-07 16:00:56 +0200305 uint8_t sb = 0;
306 uint32_t sb_fn = 0;
307 int rc;
308 uint8_t plen;
Andreas Eversberge6228b32012-07-03 13:36:03 +0200309
310 LOGP(DRLCMAC, LOGL_DEBUG, "MS requests UL TBF on RACH, so we provide "
311 "one:\n");
Andreas Eversberg07e97cf2012-08-07 16:00:56 +0200312 if ((ra & 0xf8) == 0x70) {
313 LOGP(DRLCMAC, LOGL_DEBUG, "MS requests single block "
314 "allocation\n");
315 sb = 1;
316 } else if (bts->force_two_phase) {
317 LOGP(DRLCMAC, LOGL_DEBUG, "MS requests single phase access, "
318 "but we force two phase access\n");
319 sb = 1;
Andreas Eversberge6228b32012-07-03 13:36:03 +0200320 }
Andreas Eversberge6228b32012-07-03 13:36:03 +0200321 if (qta < 0)
322 qta = 0;
323 if (qta > 252)
324 qta = 252;
Andreas Eversberg07e97cf2012-08-07 16:00:56 +0200325 if (sb) {
Holger Hans Peter Freythercedf8902013-10-19 20:47:12 +0200326 rc = bts->bts->sba()->alloc(&trx, &ts, &sb_fn, qta >> 2);
Andreas Eversberg07e97cf2012-08-07 16:00:56 +0200327 if (rc < 0)
328 return rc;
329 LOGP(DRLCMAC, LOGL_DEBUG, "RX: [PCU <- BTS] RACH qbit-ta=%d "
330 "ra=0x%02x, Fn=%d (%d,%d,%d)\n", qta, ra, Fn,
331 (Fn / (26 * 51)) % 32, Fn % 51, Fn % 26);
332 LOGP(DRLCMAC, LOGL_INFO, "TX: Immediate Assignment Uplink "
333 "(AGCH)\n");
334 } else {
335 // Create new TBF
Holger Hans Peter Freytherbcafdf82013-08-24 21:13:31 +0200336 #warning "Copy and pate with other routines.."
Holger Hans Peter Freyther70ddde62013-10-26 19:17:58 +0200337 tfi = bts->bts->tfi_find_free(GPRS_RLCMAC_UL_TBF, &trx, -1);
Andreas Eversberg07e97cf2012-08-07 16:00:56 +0200338 if (tfi < 0) {
339 LOGP(DRLCMAC, LOGL_NOTICE, "No PDCH ressource\n");
340 /* FIXME: send reject */
341 return -EBUSY;
342 }
343 /* set class to 0, since we don't know the multislot class yet */
Holger Hans Peter Freytherb67a8a32013-07-28 18:55:14 +0200344 tbf = tbf_alloc(bts, NULL, GPRS_RLCMAC_UL_TBF, tfi, trx, 0, 1);
Andreas Eversberg07e97cf2012-08-07 16:00:56 +0200345 if (!tbf) {
346 LOGP(DRLCMAC, LOGL_NOTICE, "No PDCH ressource\n");
347 /* FIXME: send reject */
348 return -EBUSY;
349 }
350 tbf->ta = qta >> 2;
351 tbf_new_state(tbf, GPRS_RLCMAC_FLOW);
352 tbf->state_flags |= (1 << GPRS_RLCMAC_FLAG_CCCH);
353 tbf_timer_start(tbf, 3169, bts->t3169, 0);
354 LOGP(DRLCMAC, LOGL_DEBUG, "TBF: [UPLINK] START TFI: %u\n",
355 tbf->tfi);
356 LOGP(DRLCMAC, LOGL_DEBUG, "RX: [PCU <- BTS] TFI: %u RACH "
357 "qbit-ta=%d ra=0x%02x, Fn=%d (%d,%d,%d)\n", tbf->tfi,
358 qta, ra, Fn, (Fn / (26 * 51)) % 32, Fn % 51, Fn % 26);
359 LOGP(DRLCMAC, LOGL_INFO, "TX: START TFI: %u Immediate "
360 "Assignment Uplink (AGCH)\n", tbf->tfi);
361 }
Andreas Eversberg7b045012012-07-05 07:38:49 +0200362 bitvec *immediate_assignment = bitvec_alloc(22) /* without plen */;
Andreas Eversberg07e97cf2012-08-07 16:00:56 +0200363 bitvec_unhex(immediate_assignment,
364 "2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b");
365 if (sb)
Holger Hans Peter Freyther63f29d62013-10-19 19:04:03 +0200366 plen = Encoding::write_immediate_assignment(bts, immediate_assignment, 0, ra,
Andreas Eversberg07e97cf2012-08-07 16:00:56 +0200367 Fn, qta >> 2, bts->trx[trx].arfcn, ts,
Andreas Eversbergaafcbbb2012-09-27 09:20:45 +0200368 bts->trx[trx].pdch[ts].tsc, 0, 0, 0, 0, sb_fn, 1,
Andreas Eversbergafdd9e12012-10-07 17:08:55 +0200369 bts->alpha, bts->gamma, -1);
Andreas Eversberg07e97cf2012-08-07 16:00:56 +0200370 else
Holger Hans Peter Freyther63f29d62013-10-19 19:04:03 +0200371 plen = Encoding::write_immediate_assignment(bts, immediate_assignment, 0, ra,
Andreas Eversberg07e97cf2012-08-07 16:00:56 +0200372 Fn, tbf->ta, tbf->arfcn, tbf->first_ts, tbf->tsc,
Andreas Eversbergaafcbbb2012-09-27 09:20:45 +0200373 tbf->tfi, tbf->dir.ul.usf[tbf->first_ts], 0, 0, 0, 0,
Andreas Eversbergafdd9e12012-10-07 17:08:55 +0200374 bts->alpha, bts->gamma, -1);
Andreas Eversberg7b045012012-07-05 07:38:49 +0200375 pcu_l1if_tx_agch(immediate_assignment, plen);
Andreas Eversberge6228b32012-07-03 13:36:03 +0200376 bitvec_free(immediate_assignment);
377
378 return 0;
379}
380
381
Andreas Eversberge6228b32012-07-03 13:36:03 +0200382/* send DL data block
383 *
384 * The messages are fragmented and forwarded as data blocks.
385 */
386struct msgb *gprs_rlcmac_send_data_block_acknowledged(
Andreas Eversberg592e04a2012-07-15 06:25:37 +0200387 struct gprs_rlcmac_tbf *tbf, uint32_t fn, uint8_t ts)
Andreas Eversberge6228b32012-07-03 13:36:03 +0200388{
Andreas Eversberge6228b32012-07-03 13:36:03 +0200389 struct rlc_dl_header *rh;
390 struct rlc_li_field *li;
391 uint8_t block_length; /* total length of block, including spare bits */
392 uint8_t block_data; /* usable data of block, w/o spare bits, inc. MAC */
393 struct msgb *msg, *dl_msg;
394 uint8_t bsn;
395 uint16_t mod_sns = tbf->sns - 1;
396 uint16_t mod_sns_half = (tbf->sns >> 1) - 1;
397 uint16_t index;
398 uint8_t *delimiter, *data, *e_pointer;
399 uint8_t len;
400 uint16_t space, chunk;
Andreas Eversberg0c9b50c2012-10-07 15:50:51 +0200401 int first_fin_ack = 0;
Holger Hans Peter Freytherb65e08a2013-10-20 17:10:25 +0200402 gprs_rlcmac_bts *bts = tbf->bts->bts_data();
Andreas Eversberge6228b32012-07-03 13:36:03 +0200403
Andreas Eversberg0e403092012-07-06 11:04:57 +0200404 LOGP(DRLCMACDL, LOGL_DEBUG, "DL DATA TBF=%d downlink (V(A)==%d .. "
Andreas Eversberge6228b32012-07-03 13:36:03 +0200405 "V(S)==%d)\n", tbf->tfi, tbf->dir.dl.v_a, tbf->dir.dl.v_s);
406
407do_resend:
408 /* check if there is a block with negative acknowledgement */
409 for (bsn = tbf->dir.dl.v_a; bsn != tbf->dir.dl.v_s;
410 bsn = (bsn + 1) & mod_sns) {
411 index = (bsn & mod_sns_half);
412 if (tbf->dir.dl.v_b[index] == 'N'
413 || tbf->dir.dl.v_b[index] == 'X') {
414 LOGP(DRLCMACDL, LOGL_DEBUG, "- Resending BSN %d\n",
415 bsn);
416 /* re-send block with negative aknowlegement */
417 tbf->dir.dl.v_b[index] = 'U'; /* unacked */
418 goto tx_block;
419 }
420 }
421
422 /* if the window has stalled, or transfer is complete,
423 * send an unacknowledged block */
Holger Hans Peter Freyther1c344e22013-10-16 18:33:18 +0200424 if (tbf->state_is(GPRS_RLCMAC_FINISHED)
Andreas Eversberge6228b32012-07-03 13:36:03 +0200425 || ((tbf->dir.dl.v_s - tbf->dir.dl.v_a) & mod_sns) == tbf->ws) {
426 int resend = 0;
427
Holger Hans Peter Freyther1c344e22013-10-16 18:33:18 +0200428 if (tbf->state_is(GPRS_RLCMAC_FINISHED))
Andreas Eversberge6228b32012-07-03 13:36:03 +0200429 LOGP(DRLCMACDL, LOGL_DEBUG, "- Restarting at BSN %d, "
430 "because all blocks have been transmitted.\n",
431 tbf->dir.dl.v_a);
432 else
Andreas Eversberg4b470ff2012-07-16 12:02:40 +0200433 LOGP(DRLCMACDL, LOGL_NOTICE, "- Restarting at BSN %d, "
Andreas Eversberge6228b32012-07-03 13:36:03 +0200434 "because all window is stalled.\n",
435 tbf->dir.dl.v_a);
436 /* If V(S) == V(A) and finished state, we would have received
437 * acknowledgement of all transmitted block. In this case we
438 * would have transmitted the final block, and received ack
439 * from MS. But in this case we did not receive the final ack
440 * indication from MS. This should never happen if MS works
441 * correctly. */
442 if (tbf->dir.dl.v_s == tbf->dir.dl.v_a) {
Andreas Eversberg0c9b50c2012-10-07 15:50:51 +0200443 LOGP(DRLCMACDL, LOGL_DEBUG, "- MS acked all blocks, "
444 "so we re-transmit final block!\n");
Andreas Eversberge6228b32012-07-03 13:36:03 +0200445 /* we just send final block again */
446 index = ((tbf->dir.dl.v_s - 1) & mod_sns_half);
447 goto tx_block;
448 }
449
450 /* cycle through all unacked blocks */
451 for (bsn = tbf->dir.dl.v_a; bsn != tbf->dir.dl.v_s;
452 bsn = (bsn + 1) & mod_sns) {
453 index = (bsn & mod_sns_half);
454 if (tbf->dir.dl.v_b[index] == 'U') {
455 /* mark to be re-send */
456 tbf->dir.dl.v_b[index] = 'X';
457 resend++;
458 }
459 }
460 /* At this point there should be at leasst one unacked block
461 * to be resent. If not, this is an software error. */
462 if (resend == 0) {
463 LOGP(DRLCMACDL, LOGL_ERROR, "Software error: "
464 "There are no unacknowledged blocks, but V(A) "
465 " != V(S). PLEASE FIX!\n");
466 /* we just send final block again */
467 index = ((tbf->dir.dl.v_s - 1) & mod_sns_half);
468 goto tx_block;
469 }
470 goto do_resend;
471 }
472
473 LOGP(DRLCMACDL, LOGL_DEBUG, "- Sending new block at BSN %d\n",
474 tbf->dir.dl.v_s);
475
476 /* now we still have untransmitted LLC data, so we fill mac block */
477 index = tbf->dir.dl.v_s & mod_sns_half;
478 data = tbf->rlc_block[index];
Holger Hans Peter Freytherb65e08a2013-10-20 17:10:25 +0200479#warning "Selection of the CS doesn't belong here"
Andreas Eversberg3b1332c2012-10-03 14:20:53 +0200480 if (tbf->cs == 0) {
Andreas Eversberg499ff412012-10-03 14:21:36 +0200481 tbf->cs = bts->initial_cs_dl;
Andreas Eversberg3b1332c2012-10-03 14:20:53 +0200482 if (tbf->cs < 1 || tbf->cs > 4)
483 tbf->cs = 1;
Andreas Eversberge6228b32012-07-03 13:36:03 +0200484 }
Andreas Eversberg3b1332c2012-10-03 14:20:53 +0200485 block_length = gprs_rlcmac_cs[tbf->cs].block_length;
486 block_data = gprs_rlcmac_cs[tbf->cs].block_data;
Andreas Eversberge6228b32012-07-03 13:36:03 +0200487 memset(data, 0x2b, block_data); /* spare bits will be left 0 */
488 rh = (struct rlc_dl_header *)data;
489 rh->pt = 0; /* Data Block */
490 rh->rrbp = rh->s_p = 0; /* Polling, set later, if required */
491 rh->usf = 7; /* will be set at scheduler */
492 rh->pr = 0; /* FIXME: power reduction */
493 rh->tfi = tbf->tfi; /* TFI */
494 rh->fbi = 0; /* Final Block Indicator, set late, if true */
495 rh->bsn = tbf->dir.dl.v_s; /* Block Sequence Number */
496 rh->e = 0; /* Extension bit, maybe set later */
497 e_pointer = data + 2; /* points to E of current chunk */
498 data += 3;
499 delimiter = data; /* where next length header would be stored */
500 space = block_data - 3;
501 while (1) {
502 chunk = tbf->llc_length - tbf->llc_index;
503 /* if chunk will exceed block limit */
504 if (chunk > space) {
505 LOGP(DRLCMACDL, LOGL_DEBUG, "-- Chunk with length %d "
506 "larger than space (%d) left in block: copy "
507 "only remaining space, and we are done\n",
508 chunk, space);
509 /* block is filled, so there is no extension */
510 *e_pointer |= 0x01;
511 /* fill only space */
512 memcpy(data, tbf->llc_frame + tbf->llc_index, space);
513 /* incement index */
514 tbf->llc_index += space;
515 /* return data block as message */
516 break;
517 }
518 /* if FINAL chunk would fit precisely in space left */
519 if (chunk == space && llist_empty(&tbf->llc_queue)) {
520 LOGP(DRLCMACDL, LOGL_DEBUG, "-- Chunk with length %d "
521 "would exactly fit into space (%d): because "
522 "this is a final block, we don't add length "
523 "header, and we are done\n", chunk, space);
Andreas Eversberg0e403092012-07-06 11:04:57 +0200524 LOGP(DRLCMACDL, LOGL_INFO, "Complete DL frame for "
525 "TBF=%d that fits precisely in last block: "
Andreas Eversbergb0c7ea72012-07-13 14:46:03 +0200526 "len=%d\n", tbf->tfi, tbf->llc_length);
Andreas Eversberg050ace22013-03-16 16:22:02 +0100527 gprs_rlcmac_dl_bw(tbf, tbf->llc_length);
Andreas Eversberge6228b32012-07-03 13:36:03 +0200528 /* block is filled, so there is no extension */
529 *e_pointer |= 0x01;
530 /* fill space */
531 memcpy(data, tbf->llc_frame + tbf->llc_index, space);
532 /* reset LLC frame */
533 tbf->llc_index = tbf->llc_length = 0;
534 /* final block */
535 rh->fbi = 1; /* we indicate final block */
536 tbf_new_state(tbf, GPRS_RLCMAC_FINISHED);
537 /* return data block as message */
538 break;
539 }
540 /* if chunk would fit exactly in space left */
541 if (chunk == space) {
542 LOGP(DRLCMACDL, LOGL_DEBUG, "-- Chunk with length %d "
543 "would exactly fit into space (%d): add length "
544 "header with LI=0, to make frame extend to "
545 "next block, and we are done\n", chunk, space);
546 /* make space for delimiter */
547 if (delimiter != data)
548 memcpy(delimiter + 1, delimiter,
549 data - delimiter);
550 data++;
551 space--;
552 /* add LI with 0 length */
553 li = (struct rlc_li_field *)delimiter;
554 li->e = 1; /* not more extension */
555 li->m = 0; /* shall be set to 0, in case of li = 0 */
556 li->li = 0; /* chunk fills the complete space */
557 // no need to set e_pointer nor increase delimiter
558 /* fill only space, which is 1 octet less than chunk */
559 memcpy(data, tbf->llc_frame + tbf->llc_index, space);
560 /* incement index */
561 tbf->llc_index += space;
562 /* return data block as message */
563 break;
564 }
565 LOGP(DRLCMACDL, LOGL_DEBUG, "-- Chunk with length %d is less "
566 "than remaining space (%d): add length header to "
567 "to delimit LLC frame\n", chunk, space);
568 /* the LLC frame chunk ends in this block */
569 /* make space for delimiter */
570 if (delimiter != data)
571 memcpy(delimiter + 1, delimiter, data - delimiter);
572 data++;
573 space--;
574 /* add LI to delimit frame */
575 li = (struct rlc_li_field *)delimiter;
576 li->e = 0; /* Extension bit, maybe set later */
577 li->m = 0; /* will be set later, if there is more LLC data */
578 li->li = chunk; /* length of chunk */
579 e_pointer = delimiter; /* points to E of current delimiter */
580 delimiter++;
581 /* copy (rest of) LLC frame to space */
582 memcpy(data, tbf->llc_frame + tbf->llc_index, chunk);
583 data += chunk;
584 space -= chunk;
Andreas Eversbergb0c7ea72012-07-13 14:46:03 +0200585 LOGP(DRLCMACDL, LOGL_INFO, "Complete DL frame for TBF=%d: "
586 "len=%d\n", tbf->tfi, tbf->llc_length);
Andreas Eversberg050ace22013-03-16 16:22:02 +0100587 gprs_rlcmac_dl_bw(tbf, tbf->llc_length);
Andreas Eversberge6228b32012-07-03 13:36:03 +0200588 /* reset LLC frame */
589 tbf->llc_index = tbf->llc_length = 0;
590 /* dequeue next LLC frame, if any */
Holger Hans Peter Freyther1702f102013-10-20 08:44:02 +0200591 msg = tbf->llc_dequeue(gprs_bssgp_pcu_current_bctx());
Andreas Eversberge6228b32012-07-03 13:36:03 +0200592 if (msg) {
Andreas Eversberg0e403092012-07-06 11:04:57 +0200593 LOGP(DRLCMACDL, LOGL_INFO, "- Dequeue next LLC for "
594 "TBF=%d (len=%d)\n", tbf->tfi, msg->len);
Holger Hans Peter Freyther1702f102013-10-20 08:44:02 +0200595 tbf->update_llc_frame(msg);
Andreas Eversberge6228b32012-07-03 13:36:03 +0200596 msgb_free(msg);
597 }
598 /* if we have more data and we have space left */
599 if (space > 0 && tbf->llc_length) {
600 li->m = 1; /* we indicate more frames to follow */
601 continue;
602 }
603 /* if we don't have more LLC frames */
604 if (!tbf->llc_length) {
Andreas Eversberg0e403092012-07-06 11:04:57 +0200605 LOGP(DRLCMACDL, LOGL_DEBUG, "-- Final block, so we "
Andreas Eversberge6228b32012-07-03 13:36:03 +0200606 "done.\n");
607 li->e = 1; /* we cannot extend */
608 rh->fbi = 1; /* we indicate final block */
Andreas Eversberg5f14bd92012-10-03 14:20:26 +0200609 first_fin_ack = 1;
Andreas Eversbergf54a89e2012-07-16 11:56:11 +0200610 /* + 1 indicates: first final ack */
Andreas Eversberge6228b32012-07-03 13:36:03 +0200611 tbf_new_state(tbf, GPRS_RLCMAC_FINISHED);
612 break;
613 }
614 /* we have no space left */
Andreas Eversberg0e403092012-07-06 11:04:57 +0200615 LOGP(DRLCMACDL, LOGL_DEBUG, "-- No space left, so we are "
Andreas Eversberge6228b32012-07-03 13:36:03 +0200616 "done.\n");
617 li->e = 1; /* we cannot extend */
618 break;
619 }
620 LOGP(DRLCMACDL, LOGL_DEBUG, "data block: %s\n",
621 osmo_hexdump(tbf->rlc_block[index], block_length));
622 tbf->rlc_block_len[index] = block_length;
623 /* raise send state and set ack state array */
624 tbf->dir.dl.v_b[index] = 'U'; /* unacked */
625 tbf->dir.dl.v_s = (tbf->dir.dl.v_s + 1) & mod_sns; /* inc send state */
626
627tx_block:
628 /* from this point on, new block is sent or old block is resent */
629
630 /* get data and header from current block */
631 data = tbf->rlc_block[index];
632 len = tbf->rlc_block_len[index];
633 rh = (struct rlc_dl_header *)data;
634
Andreas Eversberge6228b32012-07-03 13:36:03 +0200635 /* Clear Polling, if still set in history buffer */
636 rh->s_p = 0;
637
Andreas Eversbergf54a89e2012-07-16 11:56:11 +0200638 /* poll after POLL_ACK_AFTER_FRAMES frames, or when final block is tx.
639 */
Andreas Eversberg5f14bd92012-10-03 14:20:26 +0200640 if (tbf->dir.dl.tx_counter >= POLL_ACK_AFTER_FRAMES || first_fin_ack) {
641 if (first_fin_ack) {
Andreas Eversberge6228b32012-07-03 13:36:03 +0200642 LOGP(DRLCMACDL, LOGL_DEBUG, "- Scheduling Ack/Nack "
Andreas Eversberg5f14bd92012-10-03 14:20:26 +0200643 "polling, because first final block sent.\n");
Andreas Eversberg5e043da2012-07-15 06:51:30 +0200644 } else {
Andreas Eversberge6228b32012-07-03 13:36:03 +0200645 LOGP(DRLCMACDL, LOGL_DEBUG, "- Scheduling Ack/Nack "
646 "polling, because %d blocks sent.\n",
Andreas Eversbergf54a89e2012-07-16 11:56:11 +0200647 POLL_ACK_AFTER_FRAMES);
Andreas Eversberge6228b32012-07-03 13:36:03 +0200648 }
Andreas Eversberg5e043da2012-07-15 06:51:30 +0200649 /* scheduling not possible, because: */
Andreas Eversberge6228b32012-07-03 13:36:03 +0200650 if (tbf->poll_state != GPRS_RLCMAC_POLL_NONE)
Andreas Eversberg5e043da2012-07-15 06:51:30 +0200651 LOGP(DRLCMAC, LOGL_DEBUG, "Polling is already "
Andreas Eversberge6228b32012-07-03 13:36:03 +0200652 "sheduled for TBF=%d, so we must wait for "
653 "requesting downlink ack\n", tbf->tfi);
Andreas Eversberg5e043da2012-07-15 06:51:30 +0200654 else if (tbf->control_ts != ts)
655 LOGP(DRLCMAC, LOGL_DEBUG, "Polling cannot be "
656 "sheduled in this TS %d, waiting for "
657 "TS %d\n", ts, tbf->control_ts);
Holger Hans Peter Freytherb65e08a2013-10-20 17:10:25 +0200658 else if (tbf->bts->sba()->find(tbf->trx_no, ts, (fn + 13) % 2715648))
Andreas Eversberg07e97cf2012-08-07 16:00:56 +0200659 LOGP(DRLCMAC, LOGL_DEBUG, "Polling cannot be "
660 "sheduled, because single block alllocation "
661 "already exists\n");
Andreas Eversberge6228b32012-07-03 13:36:03 +0200662 else {
Andreas Eversbergee31b782012-07-15 16:27:01 +0200663 LOGP(DRLCMAC, LOGL_DEBUG, "Polling sheduled in this "
664 "TS %d\n", ts);
Andreas Eversberg5f14bd92012-10-03 14:20:26 +0200665 tbf->dir.dl.tx_counter = 0;
Andreas Eversberge6228b32012-07-03 13:36:03 +0200666 /* start timer whenever we send the final block */
667 if (rh->fbi == 1)
Andreas Eversbergdfa563c2012-07-06 08:13:59 +0200668 tbf_timer_start(tbf, 3191, bts->t3191, 0);
Andreas Eversberge6228b32012-07-03 13:36:03 +0200669
670 /* schedule polling */
671 tbf->poll_state = GPRS_RLCMAC_POLL_SCHED;
672 tbf->poll_fn = (fn + 13) % 2715648;
673
Andreas Eversbergb83e2a72012-10-07 15:26:00 +0200674#ifdef DEBUG_DIAGRAM
Holger Hans Peter Freyther34bd8bd2013-10-19 21:10:38 +0200675 debug_diagram(bts->bts, tbf->diag, "poll DL-ACK");
Andreas Eversbergb83e2a72012-10-07 15:26:00 +0200676 if (first_fin_ack)
Holger Hans Peter Freyther34bd8bd2013-10-19 21:10:38 +0200677 debug_diagram(bts->bts, tbf->diag, "(is first FINAL)");
Andreas Eversbergb83e2a72012-10-07 15:26:00 +0200678 if (rh->fbi)
Holger Hans Peter Freyther34bd8bd2013-10-19 21:10:38 +0200679 debug_diagram(bts->bts, tbf->diag, "(FBI is set)");
Andreas Eversbergb83e2a72012-10-07 15:26:00 +0200680#endif
681
Andreas Eversberge6228b32012-07-03 13:36:03 +0200682 /* set polling in header */
683 rh->rrbp = 0; /* N+13 */
684 rh->s_p = 1; /* Polling */
Andreas Eversberg5e043da2012-07-15 06:51:30 +0200685
686 /* Increment TX-counter */
687 tbf->dir.dl.tx_counter++;
Andreas Eversberge6228b32012-07-03 13:36:03 +0200688 }
Andreas Eversberg5e043da2012-07-15 06:51:30 +0200689 } else {
690 /* Increment TX-counter */
691 tbf->dir.dl.tx_counter++;
Andreas Eversberge6228b32012-07-03 13:36:03 +0200692 }
693
694 /* return data block as message */
695 dl_msg = msgb_alloc(len, "rlcmac_dl_data");
696 if (!dl_msg)
697 return NULL;
698 memcpy(msgb_put(dl_msg, len), data, len);
699
700 return dl_msg;
701}
702
Holger Hans Peter Freytherb65e08a2013-10-20 17:10:25 +0200703int gprs_rlcmac_downlink_ack(
Holger Hans Peter Freyther344ff482013-10-17 12:01:04 +0200704 struct gprs_rlcmac_tbf *tbf, uint8_t final,
Andreas Eversberge6228b32012-07-03 13:36:03 +0200705 uint8_t ssn, uint8_t *rbb)
706{
707 char show_rbb[65], show_v_b[RLC_MAX_SNS + 1];
708 uint16_t mod_sns = tbf->sns - 1;
709 uint16_t mod_sns_half = (tbf->sns >> 1) - 1;
710 int i; /* must be signed */
711 int16_t dist; /* must be signed */
712 uint8_t bit;
713 uint16_t bsn;
714 struct msgb *msg;
Andreas Eversberg050ace22013-03-16 16:22:02 +0100715 uint16_t lost = 0, received = 0;
Andreas Eversberge6228b32012-07-03 13:36:03 +0200716
Andreas Eversberg0e403092012-07-06 11:04:57 +0200717 LOGP(DRLCMACDL, LOGL_DEBUG, "TBF=%d downlink acknowledge\n",
Andreas Eversberge6228b32012-07-03 13:36:03 +0200718 tbf->tfi);
719
720 if (!final) {
721 /* show received array in debug (bit 64..1) */
722 for (i = 63; i >= 0; i--) {
723 bit = (rbb[i >> 3] >> (7 - (i&7))) & 1;
724 show_rbb[i] = (bit) ? '1' : 'o';
725 }
726 show_rbb[64] = '\0';
727 LOGP(DRLCMACDL, LOGL_DEBUG, "- ack: (BSN=%d)\"%s\""
Andreas Eversberg4b470ff2012-07-16 12:02:40 +0200728 "(BSN=%d) 1=ACK o=NACK\n", (ssn - 64) & mod_sns,
729 show_rbb, (ssn - 1) & mod_sns);
Andreas Eversberge6228b32012-07-03 13:36:03 +0200730
731 /* apply received array to receive state (SSN-64..SSN-1) */
732 /* calculate distance of ssn from V(S) */
733 dist = (tbf->dir.dl.v_s - ssn) & mod_sns;
734 /* check if distance is less than distance V(A)..V(S) */
Andreas Eversberg050ace22013-03-16 16:22:02 +0100735 if (dist >= ((tbf->dir.dl.v_s - tbf->dir.dl.v_a) & mod_sns)) {
Andreas Eversberg0f13c402012-07-16 11:59:23 +0200736 /* this might happpen, if the downlink assignment
737 * was not received by ms and the ack refers
738 * to previous TBF
739 * FIXME: we should implement polling for
740 * control ack!*/
741 LOGP(DRLCMACDL, LOGL_NOTICE, "- ack range is out of "
742 "V(A)..V(S) range (DL TBF=%d) Free TFB!\n",
743 tbf->tfi);
744 return 1; /* indicate to free TBF */
Andreas Eversberge6228b32012-07-03 13:36:03 +0200745 }
Andreas Eversberg050ace22013-03-16 16:22:02 +0100746 /* SSN - 1 is in range V(A)..V(S)-1 */
747 for (i = 63, bsn = (ssn - 1) & mod_sns;
748 i >= 0 && bsn != ((tbf->dir.dl.v_a - 1) & mod_sns);
749 i--, bsn = (bsn - 1) & mod_sns) {
750 bit = (rbb[i >> 3] >> (7 - (i&7))) & 1;
751 if (bit) {
752 LOGP(DRLCMACDL, LOGL_DEBUG, "- got "
753 "ack for BSN=%d\n", bsn);
754 if (tbf->dir.dl.v_b[bsn & mod_sns_half]
755 != 'A')
756 received++;
757 tbf->dir.dl.v_b[bsn & mod_sns_half] = 'A';
758 } else {
759 LOGP(DRLCMACDL, LOGL_DEBUG, "- got "
760 "NACK for BSN=%d\n", bsn);
761 tbf->dir.dl.v_b[bsn & mod_sns_half] = 'N';
762 lost++;
763 }
764 }
765 /* report lost and received packets */
766 gprs_rlcmac_received_lost(tbf, received, lost);
Andreas Eversberge6228b32012-07-03 13:36:03 +0200767
768 /* raise V(A), if possible */
769 for (i = 0, bsn = tbf->dir.dl.v_a; bsn != tbf->dir.dl.v_s;
770 i++, bsn = (bsn + 1) & mod_sns) {
771 if (tbf->dir.dl.v_b[bsn & mod_sns_half] == 'A') {
772 tbf->dir.dl.v_b[bsn & mod_sns_half] = 'I';
773 /* mark invalid */
774 tbf->dir.dl.v_a = (tbf->dir.dl.v_a + 1)
775 & mod_sns;
776 } else
777 break;
778 }
779
780 /* show receive state array in debug (V(A)..V(S)-1) */
781 for (i = 0, bsn = tbf->dir.dl.v_a; bsn != tbf->dir.dl.v_s;
782 i++, bsn = (bsn + 1) & mod_sns) {
783 show_v_b[i] = tbf->dir.dl.v_b[bsn & mod_sns_half];
784 if (show_v_b[i] == 0)
785 show_v_b[i] = ' ';
786 }
787 show_v_b[i] = '\0';
788 LOGP(DRLCMACDL, LOGL_DEBUG, "- V(B): (V(A)=%d)\"%s\""
789 "(V(S)-1=%d) A=Acked N=Nacked U=Unacked "
790 "X=Resend-Unacked\n", tbf->dir.dl.v_a, show_v_b,
791 (tbf->dir.dl.v_s - 1) & mod_sns);
792
Holger Hans Peter Freyther1c344e22013-10-16 18:33:18 +0200793 if (tbf->state_is(GPRS_RLCMAC_FINISHED)
Andreas Eversberg6664a902012-07-15 06:52:19 +0200794 && tbf->dir.dl.v_s == tbf->dir.dl.v_a) {
Andreas Eversberg0c9b50c2012-10-07 15:50:51 +0200795 LOGP(DRLCMACDL, LOGL_NOTICE, "Received acknowledge of "
796 "all blocks, but without final ack "
797 "inidcation (don't worry)\n");
798 }
799 return 0;
Andreas Eversbergb83e2a72012-10-07 15:26:00 +0200800 }
Andreas Eversberge6228b32012-07-03 13:36:03 +0200801
Andreas Eversberg0c9b50c2012-10-07 15:50:51 +0200802 LOGP(DRLCMACDL, LOGL_DEBUG, "- Final ACK received.\n");
Holger Hans Peter Freytherb65e08a2013-10-20 17:10:25 +0200803 debug_diagram(tbf->bts, tbf->diag, "got Final ACK");
Andreas Eversberg050ace22013-03-16 16:22:02 +0100804 /* range V(A)..V(S)-1 */
805 for (bsn = tbf->dir.dl.v_a; bsn != tbf->dir.dl.v_s;
806 bsn = (bsn + 1) & mod_sns) {
807 if (tbf->dir.dl.v_b[bsn & mod_sns_half] != 'A')
808 received++;
809 }
810
811 /* report all outstanding packets as received */
812 gprs_rlcmac_received_lost(tbf, received, lost);
Andreas Eversberg0c9b50c2012-10-07 15:50:51 +0200813
Andreas Eversberge6228b32012-07-03 13:36:03 +0200814 /* check for LLC PDU in the LLC Queue */
Holger Hans Peter Freyther1702f102013-10-20 08:44:02 +0200815 msg = tbf->llc_dequeue(gprs_bssgp_pcu_current_bctx());
Andreas Eversberge6228b32012-07-03 13:36:03 +0200816 if (!msg) {
Andreas Eversberge6228b32012-07-03 13:36:03 +0200817 /* no message, start T3193, change state to RELEASE */
818 LOGP(DRLCMACDL, LOGL_DEBUG, "- No new message, so we "
819 "release.\n");
Andreas Eversbergb3c6f6c2012-07-06 07:40:08 +0200820 /* start T3193 */
Holger Hans Peter Freyther34bd8bd2013-10-19 21:10:38 +0200821 debug_diagram(bts->bts, tbf->diag, "start T3193");
Holger Hans Peter Freytherb65e08a2013-10-20 17:10:25 +0200822 tbf_timer_start(tbf, 3193,
823 tbf->bts->bts_data()->t3193_msec / 1000,
824 (tbf->bts->bts_data()->t3193_msec % 1000) * 1000);
Andreas Eversberge6228b32012-07-03 13:36:03 +0200825 tbf_new_state(tbf, GPRS_RLCMAC_WAIT_RELEASE);
826
827 return 0;
828 }
Holger Hans Peter Freyther1702f102013-10-20 08:44:02 +0200829 #warning "Copy and paste on the sender path"
830 tbf->update_llc_frame(msg);
Andreas Eversberge6228b32012-07-03 13:36:03 +0200831 msgb_free(msg);
832
833 /* we have a message, so we trigger downlink assignment, and there
834 * set the state to ASSIGN. also we set old_downlink, because we
835 * re-use this tbf. */
836 LOGP(DRLCMAC, LOGL_DEBUG, "Trigger dowlink assignment on PACCH, "
837 "because another LLC PDU has arrived in between\n");
838 memset(&tbf->dir.dl, 0, sizeof(tbf->dir.dl)); /* reset RLC states */
Andreas Eversberga9be1542012-09-27 09:23:24 +0200839 tbf->state_flags &= GPRS_RLCMAC_FLAG_TO_MASK; /* keep TO flags */
840 tbf->state_flags &= ~(1 << GPRS_RLCMAC_FLAG_CCCH);
Holger Hans Peter Freytheraa9c3262013-10-26 17:49:36 +0200841 tbf->update();
Holger Hans Peter Freytherb65e08a2013-10-20 17:10:25 +0200842 gprs_rlcmac_trigger_downlink_assignment(tbf, tbf, NULL);
Andreas Eversberge6228b32012-07-03 13:36:03 +0200843
844 return 0;
845}
846
847
848struct msgb *gprs_rlcmac_send_packet_downlink_assignment(
849 struct gprs_rlcmac_tbf *tbf, uint32_t fn)
850{
851 struct msgb *msg;
852 struct gprs_rlcmac_tbf *new_tbf;
Holger Hans Peter Freytherb65e08a2013-10-20 17:10:25 +0200853 gprs_rlcmac_bts *bts = tbf->bts->bts_data();
Andreas Eversberg802bb6e2012-08-06 11:15:05 +0200854 int poll_ass_dl = POLLING_ASSIGNMENT_DL;
Andreas Eversberge6228b32012-07-03 13:36:03 +0200855
Andreas Eversberg802bb6e2012-08-06 11:15:05 +0200856 if (poll_ass_dl && tbf->direction == GPRS_RLCMAC_DL_TBF
857 && tbf->control_ts != tbf->first_common_ts) {
858 LOGP(DRLCMAC, LOGL_NOTICE, "Cannot poll for downlink "
Andreas Eversbergf01929b2012-10-08 12:40:49 +0200859 "assigment, because MS cannot reply. (control TS=%d, "
860 "first common TS=%d)\n", tbf->control_ts,
861 tbf->first_common_ts);
Andreas Eversberg802bb6e2012-08-06 11:15:05 +0200862 poll_ass_dl = 0;
Andreas Eversberge6228b32012-07-03 13:36:03 +0200863 }
Andreas Eversberg802bb6e2012-08-06 11:15:05 +0200864 if (poll_ass_dl) {
865 if (tbf->poll_state != GPRS_RLCMAC_POLL_NONE) {
866 LOGP(DRLCMAC, LOGL_DEBUG, "Polling is already sheduled "
867 "for TBF=%d, so we must wait for downlink "
868 "assignment...\n", tbf->tfi);
869 return NULL;
870 }
Holger Hans Peter Freytherb65e08a2013-10-20 17:10:25 +0200871 if (tbf->bts->sba()->find(tbf->trx_no, tbf->control_ts, (fn + 13) % 2715648)) {
Andreas Eversberg07e97cf2012-08-07 16:00:56 +0200872 LOGP(DRLCMACUL, LOGL_DEBUG, "Polling is already "
873 "scheduled for single block allocation...\n");
Andreas Eversberge6228b32012-07-03 13:36:03 +0200874 return NULL;
Andreas Eversberg07e97cf2012-08-07 16:00:56 +0200875 }
Andreas Eversberge6228b32012-07-03 13:36:03 +0200876 }
877
878 /* on uplink TBF we get the downlink TBF to be assigned. */
Andreas Eversbergee31b782012-07-15 16:27:01 +0200879 if (tbf->direction == GPRS_RLCMAC_UL_TBF) {
880 /* be sure to check first, if contention resolution is done,
881 * otherwise we cannot send the assignment yet */
Andreas Eversberg08e93cd2012-07-26 08:13:06 +0200882 if (!tbf->dir.ul.contention_resolution_done) {
Andreas Eversberg7f5352c2012-07-23 18:20:36 +0200883 LOGP(DRLCMAC, LOGL_DEBUG, "Cannot assign DL TBF now, "
Andreas Eversbergee31b782012-07-15 16:27:01 +0200884 "because contention resolution is not "
885 "finished.\n");
886 return NULL;
887 }
Holger Hans Peter Freytherb65e08a2013-10-20 17:10:25 +0200888 new_tbf = tbf->bts->tbf_by_tlli(tbf->tlli, GPRS_RLCMAC_DL_TBF);
Andreas Eversbergee31b782012-07-15 16:27:01 +0200889 } else
Andreas Eversberge6228b32012-07-03 13:36:03 +0200890 new_tbf = tbf;
891 if (!new_tbf) {
892 LOGP(DRLCMACDL, LOGL_ERROR, "We have a schedule for downlink "
893 "assignment at uplink TBF=%d, but there is no downlink "
894 "TBF\n", tbf->tfi);
895 tbf->dl_ass_state = GPRS_RLCMAC_DL_ASS_NONE;
896 return NULL;
897 }
898
899 msg = msgb_alloc(23, "rlcmac_dl_ass");
900 if (!msg)
901 return NULL;
902 bitvec *ass_vec = bitvec_alloc(23);
903 if (!ass_vec) {
904 msgb_free(msg);
905 return NULL;
906 }
907 bitvec_unhex(ass_vec,
908 "2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b");
Andreas Eversberg0e403092012-07-06 11:04:57 +0200909 LOGP(DRLCMAC, LOGL_INFO, "TBF: START TFI: %u TLLI: 0x%08x Packet Downlink Assignment (PACCH)\n", new_tbf->tfi, new_tbf->tlli);
Andreas Eversberg6681bb82012-07-25 08:48:44 +0200910 RlcMacDownlink_t * mac_control_block = (RlcMacDownlink_t *)talloc_zero(tall_pcu_ctx, RlcMacDownlink_t);
Holger Hans Peter Freyther63f29d62013-10-19 19:04:03 +0200911 Encoding::write_packet_downlink_assignment(mac_control_block, tbf->tfi,
Andreas Eversbergb0c7ea72012-07-13 14:46:03 +0200912 (tbf->direction == GPRS_RLCMAC_DL_TBF), new_tbf,
Andreas Eversbergafdd9e12012-10-07 17:08:55 +0200913 poll_ass_dl, bts->alpha, bts->gamma, -1, 0);
Andreas Eversberg0e403092012-07-06 11:04:57 +0200914 LOGP(DRLCMAC, LOGL_DEBUG, "+++++++++++++++++++++++++ TX : Packet Downlink Assignment +++++++++++++++++++++++++\n");
Ivan Kluchnikovef7f28c2012-07-12 14:49:15 +0400915 encode_gsm_rlcmac_downlink(ass_vec, mac_control_block);
Andreas Eversberg0e403092012-07-06 11:04:57 +0200916 LOGPC(DCSN1, LOGL_NOTICE, "\n");
917 LOGP(DRLCMAC, LOGL_DEBUG, "------------------------- TX : Packet Downlink Assignment -------------------------\n");
Ivan Kluchnikovef7f28c2012-07-12 14:49:15 +0400918 bitvec_pack(ass_vec, msgb_put(msg, 23));
Andreas Eversberge6228b32012-07-03 13:36:03 +0200919 bitvec_free(ass_vec);
Andreas Eversberg6681bb82012-07-25 08:48:44 +0200920 talloc_free(mac_control_block);
Andreas Eversberge6228b32012-07-03 13:36:03 +0200921
Andreas Eversberg802bb6e2012-08-06 11:15:05 +0200922 if (poll_ass_dl) {
923 tbf->poll_state = GPRS_RLCMAC_POLL_SCHED;
924 tbf->poll_fn = (fn + 13) % 2715648;
925 tbf->dl_ass_state = GPRS_RLCMAC_DL_ASS_WAIT_ACK;
926 } else {
927 tbf->dl_ass_state = GPRS_RLCMAC_DL_ASS_NONE;
928 tbf_new_state(new_tbf, GPRS_RLCMAC_FLOW);
929 tbf_assign_control_ts(new_tbf);
Andreas Eversbergcbcd1242012-08-07 15:48:21 +0200930 /* stop pending assignment timer */
Holger Hans Peter Freyther86300bb2013-10-26 18:01:35 +0200931 new_tbf->stop_timer();
Andreas Eversbergcbcd1242012-08-07 15:48:21 +0200932
Andreas Eversberg802bb6e2012-08-06 11:15:05 +0200933 }
Holger Hans Peter Freyther34bd8bd2013-10-19 21:10:38 +0200934 debug_diagram(bts->bts, tbf->diag, "send DL-ASS");
Andreas Eversberge6228b32012-07-03 13:36:03 +0200935
936 return msg;
937}
938
Holger Hans Peter Freytherb65e08a2013-10-20 17:10:25 +0200939static void gprs_rlcmac_downlink_assignment(
Holger Hans Peter Freyther344ff482013-10-17 12:01:04 +0200940 gprs_rlcmac_tbf *tbf, uint8_t poll,
Holger Hans Peter Freyther52c911b2013-08-24 18:30:54 +0200941 const char *imsi)
Andreas Eversberge6228b32012-07-03 13:36:03 +0200942{
Holger Hans Peter Freytherb65e08a2013-10-20 17:10:25 +0200943 gprs_rlcmac_bts *bts = tbf->bts->bts_data();
Andreas Eversbergaafcbbb2012-09-27 09:20:45 +0200944 int plen;
945
Holger Hans Peter Freyther34bd8bd2013-10-19 21:10:38 +0200946 debug_diagram(bts->bts, tbf->diag, "IMM.ASS (PCH)");
Andreas Eversberge13fa2d2012-07-09 17:10:44 +0200947 LOGP(DRLCMAC, LOGL_INFO, "TX: START TFI: %u TLLI: 0x%08x Immediate Assignment Downlink (PCH)\n", tbf->tfi, tbf->tlli);
Andreas Eversberg7b045012012-07-05 07:38:49 +0200948 bitvec *immediate_assignment = bitvec_alloc(22); /* without plen */
949 bitvec_unhex(immediate_assignment, "2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b");
Andreas Eversberge6228b32012-07-03 13:36:03 +0200950 /* use request reference that has maximum distance to current time,
951 * so the assignment will not conflict with possible RACH requests. */
Holger Hans Peter Freyther63f29d62013-10-19 19:04:03 +0200952 plen = Encoding::write_immediate_assignment(bts, immediate_assignment, 1, 125,
Andreas Eversbergaafcbbb2012-09-27 09:20:45 +0200953 (tbf->pdch[tbf->first_ts]->last_rts_fn + 21216) % 2715648, tbf->ta,
954 tbf->arfcn, tbf->first_ts, tbf->tsc, tbf->tfi, 0, tbf->tlli, poll,
Andreas Eversbergafdd9e12012-10-07 17:08:55 +0200955 tbf->poll_fn, 0, bts->alpha, bts->gamma, -1);
Andreas Eversberge13fa2d2012-07-09 17:10:44 +0200956 pcu_l1if_tx_pch(immediate_assignment, plen, imsi);
Andreas Eversberge6228b32012-07-03 13:36:03 +0200957 bitvec_free(immediate_assignment);
958}
959
960/* depending on the current TBF, we assign on PACCH or AGCH */
Holger Hans Peter Freytherb65e08a2013-10-20 17:10:25 +0200961void gprs_rlcmac_trigger_downlink_assignment(
Holger Hans Peter Freyther344ff482013-10-17 12:01:04 +0200962 struct gprs_rlcmac_tbf *tbf,
Holger Hans Peter Freyther52c911b2013-08-24 18:30:54 +0200963 struct gprs_rlcmac_tbf *old_tbf, const char *imsi)
Andreas Eversberge6228b32012-07-03 13:36:03 +0200964{
Andreas Eversberge6228b32012-07-03 13:36:03 +0200965#ifdef DEBUG_DL_ASS_IDLE
Andreas Eversberge13fa2d2012-07-09 17:10:44 +0200966 strncpy(debug_imsi, imsi);
Andreas Eversberge6228b32012-07-03 13:36:03 +0200967 LOGP(DRLCMAC, LOGL_ERROR, "**** DEBUGGING DOWNLINK ASSIGNMENT ****\n");
968#endif
969
970 /* stop pending timer */
Holger Hans Peter Freyther86300bb2013-10-26 18:01:35 +0200971 tbf->stop_timer();
Andreas Eversberge6228b32012-07-03 13:36:03 +0200972
973 /* check for downlink tbf: */
Andreas Eversberge6228b32012-07-03 13:36:03 +0200974 if (old_tbf) {
975#ifdef DEBUG_DL_ASS_IDLE
976 LOGP(DRLCMAC, LOGL_ERROR, "We must wait for current TBF to be "
977 "released.\n");
978 /* wait one second until assignment */
979 tbf_timer_start(tbf, 1234, 1,0);
980#else
Andreas Eversberg0e403092012-07-06 11:04:57 +0200981 LOGP(DRLCMAC, LOGL_DEBUG, "Send dowlink assignment on "
Andreas Eversbergb0c7ea72012-07-13 14:46:03 +0200982 "PACCH, because %s TBF=%d exists for TLLI=0x%08x\n",
Andreas Eversberg7f5352c2012-07-23 18:20:36 +0200983 (old_tbf->direction == GPRS_RLCMAC_UL_TBF)
984 ? "UL" : "DL", old_tbf->tfi, old_tbf->tlli);
Andreas Eversberge6228b32012-07-03 13:36:03 +0200985 old_tbf->dl_ass_state = GPRS_RLCMAC_DL_ASS_SEND_ASS;
986 /* use TA from old TBF */
987 tbf->ta = old_tbf->ta;
988 /* change state */
989 tbf_new_state(tbf, GPRS_RLCMAC_ASSIGN);
Andreas Eversberg14db19e2012-08-06 15:03:03 +0200990 tbf->state_flags |= (1 << GPRS_RLCMAC_FLAG_PACCH);
Andreas Eversberge6228b32012-07-03 13:36:03 +0200991 /* start timer */
992 tbf_timer_start(tbf, 0, Tassign_pacch);
993#endif
994 } else {
Andreas Eversberge13fa2d2012-07-09 17:10:44 +0200995 LOGP(DRLCMAC, LOGL_DEBUG, "Send dowlink assignment for TBF=%d on PCH, no TBF exist (IMSI=%s)\n", tbf->tfi, imsi);
996 if (!imsi || strlen(imsi) < 3) {
997 LOGP(DRLCMAC, LOGL_ERROR, "No valid IMSI!\n");
998 return;
999 }
Andreas Eversberge6228b32012-07-03 13:36:03 +02001000 /* change state */
1001 tbf_new_state(tbf, GPRS_RLCMAC_ASSIGN);
Andreas Eversberg14db19e2012-08-06 15:03:03 +02001002 tbf->state_flags |= (1 << GPRS_RLCMAC_FLAG_CCCH);
Andreas Eversberga9be1542012-09-27 09:23:24 +02001003 strncpy(tbf->dir.dl.imsi, imsi, sizeof(tbf->dir.dl.imsi));
Andreas Eversberg7438df72012-07-23 18:04:49 +02001004 /* send immediate assignment */
Holger Hans Peter Freytherb65e08a2013-10-20 17:10:25 +02001005 gprs_rlcmac_downlink_assignment(tbf, 0, imsi);
Andreas Eversberga9be1542012-09-27 09:23:24 +02001006 tbf->dir.dl.wait_confirm = 1;
1007 }
1008}
1009
Holger Hans Peter Freyther34bd8bd2013-10-19 21:10:38 +02001010int gprs_rlcmac_imm_ass_cnf(BTS *bts, uint8_t *data, uint32_t fn)
Andreas Eversberga9be1542012-09-27 09:23:24 +02001011{
1012 struct gprs_rlcmac_tbf *tbf;
1013 uint8_t plen;
1014 uint32_t tlli;
1015
1016 /* move to IA Rest Octets */
1017 plen = data[0] >> 2;
1018 data += 1 + plen;
1019
1020 if ((*data & 0xf0) != 0xd0) {
1021 LOGP(DRLCMAC, LOGL_ERROR, "Got IMM.ASS confirm, but rest "
1022 "octets do not start with bit sequence 'HH01' "
1023 "(Packet Downlink Assignment)\n");
1024 return -EINVAL;
1025 }
1026
1027 /* get TLLI from downlink assignment */
1028 tlli = (*data++) << 28;
1029 tlli |= (*data++) << 20;
1030 tlli |= (*data++) << 12;
1031 tlli |= (*data++) << 4;
1032 tlli |= (*data++) >> 4;
1033
Holger Hans Peter Freyther34bd8bd2013-10-19 21:10:38 +02001034 tbf = bts->tbf_by_tlli(tlli, GPRS_RLCMAC_DL_TBF);
Andreas Eversberga9be1542012-09-27 09:23:24 +02001035 if (!tbf) {
1036 LOGP(DRLCMAC, LOGL_ERROR, "Got IMM.ASS confirm, but TLLI=%08x "
1037 "does not exit\n", tlli);
1038 return -EINVAL;
1039 }
1040
1041 LOGP(DRLCMAC, LOGL_DEBUG, "Got IMM.ASS confirm for TLLI=%08x\n", tlli);
1042
1043 if (tbf->dir.dl.wait_confirm) {
Andreas Eversberge6228b32012-07-03 13:36:03 +02001044 tbf_timer_start(tbf, 0, Tassign_agch);
1045 }
Andreas Eversberga9be1542012-09-27 09:23:24 +02001046
1047 return 0;
1048}
Andreas Eversberge6228b32012-07-03 13:36:03 +02001049