1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
|
/*
* Copyright (C) 2013 by Holger Hans Peter Freyther
*
* This program is free software; you can redistribute it and/or
* modify it under the terms of the GNU General Public License
* as published by the Free Software Foundation; either version 2
* of the License, or (at your option) any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this program; if not, write to the Free Software
* Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
*/
#include "tbf.h"
#include "bts.h"
#include "gprs_debug.h"
extern "C" {
#include <osmocom/core/utils.h>
}
uint8_t *gprs_rlc_data::prepare(size_t block_data_len)
{
/* todo.. only set it once if it turns out to be a bottleneck */
memset(block, 0x0, ARRAY_SIZE(block));
memset(block, 0x2b, block_data_len);
return block;
}
void gprs_rlc_v_b::reset()
{
for (size_t i = 0; i < ARRAY_SIZE(m_v_b); ++i)
mark_invalid(i);
}
int gprs_rlc_v_b::resend_needed(const uint16_t v_a, const uint16_t v_s,
const uint16_t mod_sns,
const uint16_t mod_sns_half)
{
for (uint8_t bsn = v_a; bsn != v_s; bsn = (bsn + 1) & mod_sns) {
uint16_t index = bsn & mod_sns_half;
if (is_nacked(index) || is_resend(index))
return bsn;
}
return -1;
}
int gprs_rlc_v_b::mark_for_resend(const uint16_t v_a, const uint16_t v_s,
const uint16_t mod_sns,
const uint16_t mod_sns_half)
{
int resend = 0;
for (uint8_t bsn = v_a; bsn != v_s; bsn = (bsn + 1) & mod_sns) {
uint16_t index = (bsn & mod_sns_half);
if (is_unacked(index)) {
/* mark to be re-send */
mark_resend(index);
resend += 1;
}
}
return resend;
}
void gprs_rlc_v_b::update(BTS *bts, char *show_rbb, uint8_t ssn,
const uint16_t v_a,
const uint16_t mod_sns, const uint16_t mod_sns_half,
uint16_t *lost, uint16_t *received)
{
uint16_t bsn;
int i;
/* SSN - 1 is in range V(A)..V(S)-1 */
for (i = 63, bsn = (ssn - 1) & mod_sns;
i >= 0 && bsn != ((v_a - 1) & mod_sns);
i--, bsn = (bsn - 1) & mod_sns) {
if (show_rbb[i] == '1') {
LOGP(DRLCMACDL, LOGL_DEBUG, "- got ack for BSN=%d\n", bsn);
if (!is_acked(bsn & mod_sns_half))
*received += 1;
mark_acked(bsn & mod_sns_half);
} else {
LOGP(DRLCMACDL, LOGL_DEBUG, "- got NACK for BSN=%d\n", bsn);
mark_nacked(bsn & mod_sns_half);
bts->rlc_nacked();
*lost += 1;
}
}
}
int gprs_rlc_v_b::move_window(const uint16_t v_a, const uint16_t v_s,
const uint16_t mod_sns, const uint16_t mod_sns_half)
{
int i;
uint16_t bsn;
int moved = 0;
for (i = 0, bsn = v_a; bsn != v_s; i++, bsn = (bsn + 1) & mod_sns) {
uint16_t index = (bsn & mod_sns_half);
if (is_acked(index)) {
mark_invalid(index);
moved += 1;
} else
break;
}
return moved;
}
|