Holger Hans Peter Freyther | d11290b | 2013-10-26 17:32:04 +0200 | [diff] [blame] | 1 | /* rlc header descriptions |
| 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 | #pragma once |
| 21 | |
Jacob Erlbeck | 4abc686 | 2015-12-08 15:14:05 +0100 | [diff] [blame] | 22 | #include "gprs_coding_scheme.h" |
| 23 | |
Jacob Erlbeck | 4aa78a8 | 2015-12-14 11:13:30 +0100 | [diff] [blame] | 24 | #include <osmocom/core/endian.h> |
| 25 | |
Holger Hans Peter Freyther | d11290b | 2013-10-26 17:32:04 +0200 | [diff] [blame] | 26 | #include <stdint.h> |
| 27 | |
Jacob Erlbeck | 8f8197f | 2015-12-28 13:51:44 +0100 | [diff] [blame] | 28 | #define RLC_GPRS_SNS 128 /* GPRS, must be power of 2 */ |
| 29 | #define RLC_GPRS_WS 64 /* max window size */ |
| 30 | #define RLC_EGPRS_SNS 2048 /* EGPRS, must be power of 2 */ |
| 31 | #define RLC_EGPRS_MIN_WS 64 /* min window size */ |
| 32 | #define RLC_EGPRS_MAX_WS 1024 /* min window size */ |
| 33 | #define RLC_EGPRS_SNS 2048 /* EGPRS, must be power of 2 */ |
| 34 | #define RLC_MAX_SNS RLC_EGPRS_SNS |
Jacob Erlbeck | eb08f86 | 2016-02-05 17:07:12 +0100 | [diff] [blame] | 35 | #define RLC_MAX_WS RLC_EGPRS_MAX_WS |
Jacob Erlbeck | 8f8197f | 2015-12-28 13:51:44 +0100 | [diff] [blame] | 36 | #define RLC_MAX_LEN 74 /* MCS-9 data unit */ |
Holger Hans Peter Freyther | 6b5660c | 2013-11-23 16:10:48 +0100 | [diff] [blame] | 37 | |
Holger Hans Peter Freyther | 35cc1c0 | 2014-07-02 14:48:44 +0200 | [diff] [blame] | 38 | struct BTS; |
Holger Hans Peter Freyther | cbb00eb | 2013-11-25 23:26:06 +0100 | [diff] [blame] | 39 | struct gprs_rlc_v_n; |
Holger Hans Peter Freyther | 6b5660c | 2013-11-23 16:10:48 +0100 | [diff] [blame] | 40 | |
Daniel Willmann | d54d9f5 | 2013-12-28 21:16:13 +0100 | [diff] [blame] | 41 | /* The state of a BSN in the send/receive window */ |
| 42 | enum gprs_rlc_ul_bsn_state { |
| 43 | GPRS_RLC_UL_BSN_INVALID, |
| 44 | GPRS_RLC_UL_BSN_RECEIVED, |
| 45 | GPRS_RLC_UL_BSN_MISSING, |
| 46 | GPRS_RLC_UL_BSN_MAX, |
| 47 | }; |
| 48 | |
| 49 | enum gprs_rlc_dl_bsn_state { |
| 50 | GPRS_RLC_DL_BSN_INVALID, |
| 51 | GPRS_RLC_DL_BSN_NACKED, |
| 52 | GPRS_RLC_DL_BSN_ACKED, |
| 53 | GPRS_RLC_DL_BSN_UNACKED, |
| 54 | GPRS_RLC_DL_BSN_RESEND, |
| 55 | GPRS_RLC_DL_BSN_MAX, |
| 56 | }; |
| 57 | |
Holger Hans Peter Freyther | 3cbf9e0 | 2013-11-26 21:43:58 +0100 | [diff] [blame] | 58 | |
| 59 | static inline uint16_t mod_sns_half() |
| 60 | { |
| 61 | return (RLC_MAX_SNS / 2) - 1; |
| 62 | } |
| 63 | |
Jacob Erlbeck | f2ba4cb | 2016-01-07 18:59:28 +0100 | [diff] [blame] | 64 | struct gprs_rlc_data_block_info { |
Jacob Erlbeck | 4abc686 | 2015-12-08 15:14:05 +0100 | [diff] [blame] | 65 | unsigned int data_len; /* EGPRS: N2, GPRS: N2-2, N-2 */ |
| 66 | unsigned int bsn; |
| 67 | unsigned int ti; |
| 68 | unsigned int e; |
Jacob Erlbeck | cc34a5b | 2016-01-11 12:53:08 +0100 | [diff] [blame] | 69 | unsigned int cv; /* FBI == 1 <=> CV == 0 */ |
Jacob Erlbeck | 4abc686 | 2015-12-08 15:14:05 +0100 | [diff] [blame] | 70 | unsigned int pi; |
| 71 | unsigned int spb; |
| 72 | }; |
| 73 | |
Jacob Erlbeck | f2ba4cb | 2016-01-07 18:59:28 +0100 | [diff] [blame] | 74 | struct gprs_rlc_data_info { |
Jacob Erlbeck | 4abc686 | 2015-12-08 15:14:05 +0100 | [diff] [blame] | 75 | GprsCodingScheme cs; |
| 76 | unsigned int r; |
| 77 | unsigned int si; |
| 78 | unsigned int tfi; |
| 79 | unsigned int cps; |
| 80 | unsigned int rsb; |
Jacob Erlbeck | cc34a5b | 2016-01-11 12:53:08 +0100 | [diff] [blame] | 81 | unsigned int usf; |
| 82 | unsigned int es_p; |
| 83 | unsigned int rrbp; |
| 84 | unsigned int pr; |
Jacob Erlbeck | 4abc686 | 2015-12-08 15:14:05 +0100 | [diff] [blame] | 85 | unsigned int num_data_blocks; |
| 86 | unsigned int data_offs_bits[2]; |
Jacob Erlbeck | f2ba4cb | 2016-01-07 18:59:28 +0100 | [diff] [blame] | 87 | struct gprs_rlc_data_block_info block_info[2]; |
Jacob Erlbeck | 4abc686 | 2015-12-08 15:14:05 +0100 | [diff] [blame] | 88 | }; |
| 89 | |
Holger Hans Peter Freyther | 6b5660c | 2013-11-23 16:10:48 +0100 | [diff] [blame] | 90 | struct gprs_rlc_data { |
| 91 | uint8_t *prepare(size_t block_data_length); |
Holger Hans Peter Freyther | 423dd22 | 2013-11-25 23:24:29 +0100 | [diff] [blame] | 92 | void put_data(const uint8_t *data, size_t len); |
Holger Hans Peter Freyther | 6b5660c | 2013-11-23 16:10:48 +0100 | [diff] [blame] | 93 | |
| 94 | /* block history */ |
| 95 | uint8_t block[RLC_MAX_LEN]; |
| 96 | /* block len of history */ |
| 97 | uint8_t len; |
Jacob Erlbeck | 1751c62 | 2015-06-04 12:12:32 +0200 | [diff] [blame] | 98 | |
Jacob Erlbeck | f2ba4cb | 2016-01-07 18:59:28 +0100 | [diff] [blame] | 99 | struct gprs_rlc_data_block_info block_info; |
Jacob Erlbeck | ce1beb4 | 2015-12-14 12:04:01 +0100 | [diff] [blame] | 100 | GprsCodingScheme cs; |
Holger Hans Peter Freyther | 6b5660c | 2013-11-23 16:10:48 +0100 | [diff] [blame] | 101 | }; |
| 102 | |
Jacob Erlbeck | 6e9f9c2 | 2016-01-11 11:15:45 +0100 | [diff] [blame] | 103 | void gprs_rlc_data_info_init_dl(struct gprs_rlc_data_info *rlc, |
| 104 | GprsCodingScheme cs); |
| 105 | void gprs_rlc_data_info_init_ul(struct gprs_rlc_data_info *rlc, |
| 106 | GprsCodingScheme cs); |
| 107 | void gprs_rlc_data_block_info_init(struct gprs_rlc_data_block_info *rdbi, |
| 108 | GprsCodingScheme cs); |
Jacob Erlbeck | 9e85939 | 2016-02-02 11:48:37 +0100 | [diff] [blame^] | 109 | unsigned int gprs_rlc_mcs_cps(GprsCodingScheme cs, int punct, int punct2, |
| 110 | int with_padding); |
Jacob Erlbeck | 6e9f9c2 | 2016-01-11 11:15:45 +0100 | [diff] [blame] | 111 | |
Holger Hans Peter Freyther | 6b5660c | 2013-11-23 16:10:48 +0100 | [diff] [blame] | 112 | /* |
| 113 | * I hold the currently transferred blocks and will provide |
| 114 | * the routines to manipulate these arrays. |
| 115 | */ |
| 116 | struct gprs_rlc { |
Holger Hans Peter Freyther | 3cbf9e0 | 2013-11-26 21:43:58 +0100 | [diff] [blame] | 117 | gprs_rlc_data *block(int bsn); |
| 118 | gprs_rlc_data m_blocks[RLC_MAX_SNS/2]; |
Holger Hans Peter Freyther | 6b5660c | 2013-11-23 16:10:48 +0100 | [diff] [blame] | 119 | }; |
| 120 | |
Daniel Willmann | 146514e | 2013-12-28 18:24:42 +0100 | [diff] [blame] | 121 | /** |
| 122 | * TODO: for GPRS/EDGE maybe make sns a template parameter |
| 123 | * so we create specialized versions... |
| 124 | */ |
| 125 | struct gprs_rlc_v_b { |
| 126 | /* Check for an individual frame */ |
| 127 | bool is_unacked(int bsn) const; |
| 128 | bool is_nacked(int bsn) const; |
| 129 | bool is_acked(int bsn) const; |
| 130 | bool is_resend(int bsn) const; |
| 131 | bool is_invalid(int bsn) const; |
Daniel Willmann | d54d9f5 | 2013-12-28 21:16:13 +0100 | [diff] [blame] | 132 | gprs_rlc_dl_bsn_state get_state(int bsn) const; |
Daniel Willmann | 146514e | 2013-12-28 18:24:42 +0100 | [diff] [blame] | 133 | |
| 134 | /* Mark a RLC frame for something */ |
| 135 | void mark_unacked(int bsn); |
| 136 | void mark_nacked(int bsn); |
| 137 | void mark_acked(int bsn); |
| 138 | void mark_resend(int bsn); |
| 139 | void mark_invalid(int bsn); |
| 140 | |
| 141 | void reset(); |
| 142 | |
| 143 | |
| 144 | private: |
Daniel Willmann | d54d9f5 | 2013-12-28 21:16:13 +0100 | [diff] [blame] | 145 | bool is_state(int bsn, const gprs_rlc_dl_bsn_state state) const; |
| 146 | void mark(int bsn, const gprs_rlc_dl_bsn_state state); |
Daniel Willmann | 146514e | 2013-12-28 18:24:42 +0100 | [diff] [blame] | 147 | |
Daniel Willmann | d54d9f5 | 2013-12-28 21:16:13 +0100 | [diff] [blame] | 148 | gprs_rlc_dl_bsn_state m_v_b[RLC_MAX_SNS/2]; /* acknowledge state array */ |
Daniel Willmann | 146514e | 2013-12-28 18:24:42 +0100 | [diff] [blame] | 149 | }; |
| 150 | |
Holger Hans Peter Freyther | f1593b7 | 2013-11-24 20:36:36 +0100 | [diff] [blame] | 151 | |
| 152 | /** |
Jacob Erlbeck | ed2dbf6 | 2015-12-28 19:15:40 +0100 | [diff] [blame] | 153 | * TODO: The UL/DL code could/should share a base class. |
Holger Hans Peter Freyther | f1593b7 | 2013-11-24 20:36:36 +0100 | [diff] [blame] | 154 | */ |
Jacob Erlbeck | db88380 | 2016-01-19 14:07:33 +0100 | [diff] [blame] | 155 | class gprs_rlc_window { |
| 156 | public: |
| 157 | gprs_rlc_window(); |
| 158 | |
Holger Hans Peter Freyther | f1593b7 | 2013-11-24 20:36:36 +0100 | [diff] [blame] | 159 | const uint16_t mod_sns() const; |
Jacob Erlbeck | 93c55d0 | 2015-12-23 16:29:07 +0100 | [diff] [blame] | 160 | const uint16_t mod_sns(uint16_t bsn) const; |
Holger Hans Peter Freyther | f1593b7 | 2013-11-24 20:36:36 +0100 | [diff] [blame] | 161 | const uint16_t sns() const; |
| 162 | const uint16_t ws() const; |
| 163 | |
Jacob Erlbeck | db88380 | 2016-01-19 14:07:33 +0100 | [diff] [blame] | 164 | void set_sns(uint16_t sns); |
| 165 | void set_ws(uint16_t ws); |
| 166 | |
| 167 | protected: |
| 168 | uint16_t m_sns; |
| 169 | uint16_t m_ws; |
| 170 | }; |
| 171 | |
| 172 | struct gprs_rlc_dl_window: public gprs_rlc_window { |
| 173 | void reset(); |
| 174 | |
Holger Hans Peter Freyther | f1593b7 | 2013-11-24 20:36:36 +0100 | [diff] [blame] | 175 | bool window_stalled() const; |
| 176 | bool window_empty() const; |
| 177 | |
| 178 | void increment_send(); |
| 179 | void raise(int moves); |
| 180 | |
| 181 | const uint16_t v_s() const; |
| 182 | const uint16_t v_s_mod(int offset) const; |
Holger Hans Peter Freyther | f1593b7 | 2013-11-24 20:36:36 +0100 | [diff] [blame] | 183 | const uint16_t v_a() const; |
| 184 | const int16_t distance() const; |
| 185 | |
Daniel Willmann | 146514e | 2013-12-28 18:24:42 +0100 | [diff] [blame] | 186 | /* Methods to manage reception */ |
| 187 | int resend_needed(); |
| 188 | int mark_for_resend(); |
Jacob Erlbeck | e1ca87f | 2015-12-23 16:40:56 +0100 | [diff] [blame] | 189 | void update(BTS *bts, char *show_rbb, uint16_t ssn, |
Daniel Willmann | 146514e | 2013-12-28 18:24:42 +0100 | [diff] [blame] | 190 | uint16_t *lost, uint16_t *received); |
Jacob Erlbeck | eb08f86 | 2016-02-05 17:07:12 +0100 | [diff] [blame] | 191 | void update(BTS *bts, const struct bitvec *rbb, |
| 192 | uint16_t first_bsn, uint16_t *lost, |
| 193 | uint16_t *received); |
Daniel Willmann | 146514e | 2013-12-28 18:24:42 +0100 | [diff] [blame] | 194 | int move_window(); |
Daniel Willmann | 3ce011f | 2014-01-15 12:45:56 +0100 | [diff] [blame] | 195 | void show_state(char *show_rbb); |
Daniel Willmann | 146514e | 2013-12-28 18:24:42 +0100 | [diff] [blame] | 196 | int count_unacked(); |
| 197 | |
Holger Hans Peter Freyther | f1593b7 | 2013-11-24 20:36:36 +0100 | [diff] [blame] | 198 | uint16_t m_v_s; /* send state */ |
| 199 | uint16_t m_v_a; /* ack state */ |
Daniel Willmann | 146514e | 2013-12-28 18:24:42 +0100 | [diff] [blame] | 200 | |
| 201 | gprs_rlc_v_b m_v_b; |
Jacob Erlbeck | a3a567e | 2015-12-28 13:46:32 +0100 | [diff] [blame] | 202 | |
| 203 | gprs_rlc_dl_window(); |
Holger Hans Peter Freyther | f1593b7 | 2013-11-24 20:36:36 +0100 | [diff] [blame] | 204 | }; |
| 205 | |
Daniel Willmann | 7c3751b | 2013-12-28 13:59:24 +0100 | [diff] [blame] | 206 | struct gprs_rlc_v_n { |
| 207 | void reset(); |
| 208 | |
| 209 | void mark_received(int bsn); |
| 210 | void mark_missing(int bsn); |
| 211 | |
| 212 | bool is_received(int bsn) const; |
| 213 | |
Daniel Willmann | d54d9f5 | 2013-12-28 21:16:13 +0100 | [diff] [blame] | 214 | gprs_rlc_ul_bsn_state state(int bsn) const; |
Daniel Willmann | 7c3751b | 2013-12-28 13:59:24 +0100 | [diff] [blame] | 215 | private: |
Daniel Willmann | d54d9f5 | 2013-12-28 21:16:13 +0100 | [diff] [blame] | 216 | bool is_state(int bsn, const gprs_rlc_ul_bsn_state state) const; |
| 217 | void mark(int bsn, const gprs_rlc_ul_bsn_state state); |
| 218 | gprs_rlc_ul_bsn_state m_v_n[RLC_MAX_SNS/2]; /* receive state array */ |
Daniel Willmann | 7c3751b | 2013-12-28 13:59:24 +0100 | [diff] [blame] | 219 | }; |
| 220 | |
Jacob Erlbeck | db88380 | 2016-01-19 14:07:33 +0100 | [diff] [blame] | 221 | struct gprs_rlc_ul_window: public gprs_rlc_window { |
Holger Hans Peter Freyther | f1593b7 | 2013-11-24 20:36:36 +0100 | [diff] [blame] | 222 | const uint16_t v_r() const; |
| 223 | const uint16_t v_q() const; |
| 224 | |
Daniel Willmann | 8a31f9e | 2013-11-27 17:08:35 +0100 | [diff] [blame] | 225 | const uint16_t ssn() const; |
| 226 | |
Jacob Erlbeck | e1ca87f | 2015-12-23 16:40:56 +0100 | [diff] [blame] | 227 | bool is_in_window(uint16_t bsn) const; |
| 228 | bool is_received(uint16_t bsn) const; |
Holger Hans Peter Freyther | 6ab5b24 | 2013-11-24 22:43:03 +0100 | [diff] [blame] | 229 | |
Daniel Willmann | 7c3751b | 2013-12-28 13:59:24 +0100 | [diff] [blame] | 230 | void update_rbb(char *rbb); |
Daniel Willmann | f4a1ec6 | 2013-12-28 13:57:31 +0100 | [diff] [blame] | 231 | void raise_v_r_to(int moves); |
Daniel Willmann | 7c3751b | 2013-12-28 13:59:24 +0100 | [diff] [blame] | 232 | void raise_v_r(const uint16_t bsn); |
| 233 | uint16_t raise_v_q(); |
Holger Hans Peter Freyther | cbb00eb | 2013-11-25 23:26:06 +0100 | [diff] [blame] | 234 | |
Holger Hans Peter Freyther | 7f3e662 | 2013-11-25 23:51:19 +0100 | [diff] [blame] | 235 | void raise_v_q(int); |
Holger Hans Peter Freyther | f1593b7 | 2013-11-24 20:36:36 +0100 | [diff] [blame] | 236 | |
Jacob Erlbeck | d87e1d6 | 2015-12-14 11:43:04 +0100 | [diff] [blame] | 237 | void receive_bsn(const uint16_t bsn); |
Jacob Erlbeck | 784a0bd | 2015-12-14 11:54:29 +0100 | [diff] [blame] | 238 | bool invalidate_bsn(const uint16_t bsn); |
Daniel Willmann | 5584479 | 2013-12-28 14:41:00 +0100 | [diff] [blame] | 239 | |
Holger Hans Peter Freyther | f1593b7 | 2013-11-24 20:36:36 +0100 | [diff] [blame] | 240 | uint16_t m_v_r; /* receive state */ |
| 241 | uint16_t m_v_q; /* receive window state */ |
Daniel Willmann | 7c3751b | 2013-12-28 13:59:24 +0100 | [diff] [blame] | 242 | |
| 243 | gprs_rlc_v_n m_v_n; |
Jacob Erlbeck | a3a567e | 2015-12-28 13:46:32 +0100 | [diff] [blame] | 244 | |
| 245 | gprs_rlc_ul_window(); |
Holger Hans Peter Freyther | f1593b7 | 2013-11-24 20:36:36 +0100 | [diff] [blame] | 246 | }; |
| 247 | |
Holger Hans Peter Freyther | d11290b | 2013-10-26 17:32:04 +0200 | [diff] [blame] | 248 | extern "C" { |
| 249 | /* TS 04.60 10.2.2 */ |
Jacob Erlbeck | 4aa78a8 | 2015-12-14 11:13:30 +0100 | [diff] [blame] | 250 | #if OSMO_IS_LITTLE_ENDIAN |
Holger Hans Peter Freyther | d11290b | 2013-10-26 17:32:04 +0200 | [diff] [blame] | 251 | struct rlc_ul_header { |
| 252 | uint8_t r:1, |
| 253 | si:1, |
| 254 | cv:4, |
| 255 | pt:2; |
| 256 | uint8_t ti:1, |
| 257 | tfi:5, |
| 258 | pi:1, |
| 259 | spare:1; |
| 260 | uint8_t e:1, |
| 261 | bsn:7; |
| 262 | } __attribute__ ((packed)); |
| 263 | |
| 264 | struct rlc_dl_header { |
| 265 | uint8_t usf:3, |
| 266 | s_p:1, |
| 267 | rrbp:2, |
| 268 | pt:2; |
| 269 | uint8_t fbi:1, |
| 270 | tfi:5, |
| 271 | pr:2; |
| 272 | uint8_t e:1, |
| 273 | bsn:7; |
| 274 | } __attribute__ ((packed)); |
| 275 | |
| 276 | struct rlc_li_field { |
| 277 | uint8_t e:1, |
| 278 | m:1, |
| 279 | li:6; |
| 280 | } __attribute__ ((packed)); |
Jacob Erlbeck | 4abc686 | 2015-12-08 15:14:05 +0100 | [diff] [blame] | 281 | |
| 282 | struct rlc_li_field_egprs { |
| 283 | uint8_t e:1, |
| 284 | li:7; |
| 285 | } __attribute__ ((packed)); |
| 286 | |
| 287 | struct gprs_rlc_ul_header_egprs_3 { |
| 288 | uint8_t r:1, |
| 289 | si:1, |
| 290 | cv:4, |
| 291 | tfi_a:2; |
| 292 | uint8_t tfi_b:3, |
| 293 | bsn1_a:5; |
| 294 | uint8_t bsn1_b:6, |
| 295 | cps_a:2; |
| 296 | uint8_t cps_b:2, |
| 297 | spb:2, |
| 298 | rsb:1, |
| 299 | pi:1, |
| 300 | spare:1, |
| 301 | dummy:1; |
| 302 | } __attribute__ ((packed)); |
Jacob Erlbeck | f0e4039 | 2016-01-08 10:07:53 +0100 | [diff] [blame] | 303 | |
Jacob Erlbeck | 9e85939 | 2016-02-02 11:48:37 +0100 | [diff] [blame^] | 304 | struct gprs_rlc_dl_header_egprs_1 { |
| 305 | uint8_t usf:3, |
| 306 | es_p:2, |
| 307 | rrbp:2, |
| 308 | tfi_a:1; |
| 309 | uint8_t tfi_b:4, |
| 310 | pr:2, |
| 311 | bsn1_a:2; |
| 312 | uint8_t bsn1_b:8; |
| 313 | uint8_t bsn1_c:1, |
| 314 | bsn2_a:7; |
| 315 | uint8_t bsn2_b:3, |
| 316 | cps:5; |
| 317 | } __attribute__ ((packed)); |
| 318 | |
| 319 | struct gprs_rlc_dl_header_egprs_2 { |
| 320 | uint8_t usf:3, |
| 321 | es_p:2, |
| 322 | rrbp:2, |
| 323 | tfi_a:1; |
| 324 | uint8_t tfi_b:4, |
| 325 | pr:2, |
| 326 | bsn1_a:2; |
| 327 | uint8_t bsn1_b:8; |
| 328 | uint8_t bsn1_c:1, |
| 329 | cps:3, |
| 330 | dummy:4; |
| 331 | } __attribute__ ((packed)); |
| 332 | |
Jacob Erlbeck | f0e4039 | 2016-01-08 10:07:53 +0100 | [diff] [blame] | 333 | struct gprs_rlc_dl_header_egprs_3 { |
| 334 | uint8_t usf:3, |
| 335 | es_p:2, |
| 336 | rrbp:2, |
| 337 | tfi_a:1; |
| 338 | uint8_t tfi_b:4, |
| 339 | pr:2, |
| 340 | bsn1_a:2; |
| 341 | uint8_t bsn1_b:8; |
| 342 | uint8_t bsn1_c:1, |
| 343 | cps:4, |
| 344 | spb:2, |
| 345 | dummy:1; |
| 346 | } __attribute__ ((packed)); |
Jacob Erlbeck | 4aa78a8 | 2015-12-14 11:13:30 +0100 | [diff] [blame] | 347 | #else |
| 348 | # error "Only little endian headers are supported yet. TODO: add missing structs" |
| 349 | #endif |
Holger Hans Peter Freyther | d11290b | 2013-10-26 17:32:04 +0200 | [diff] [blame] | 350 | } |
Holger Hans Peter Freyther | 6b5660c | 2013-11-23 16:10:48 +0100 | [diff] [blame] | 351 | |
Daniel Willmann | d54d9f5 | 2013-12-28 21:16:13 +0100 | [diff] [blame] | 352 | inline bool gprs_rlc_v_b::is_state(int bsn, const gprs_rlc_dl_bsn_state type) const |
Holger Hans Peter Freyther | 6b5660c | 2013-11-23 16:10:48 +0100 | [diff] [blame] | 353 | { |
Holger Hans Peter Freyther | 3cbf9e0 | 2013-11-26 21:43:58 +0100 | [diff] [blame] | 354 | return m_v_b[bsn & mod_sns_half()] == type; |
Holger Hans Peter Freyther | 6b5660c | 2013-11-23 16:10:48 +0100 | [diff] [blame] | 355 | } |
| 356 | |
Daniel Willmann | d54d9f5 | 2013-12-28 21:16:13 +0100 | [diff] [blame] | 357 | inline void gprs_rlc_v_b::mark(int bsn, const gprs_rlc_dl_bsn_state type) |
Holger Hans Peter Freyther | 6b5660c | 2013-11-23 16:10:48 +0100 | [diff] [blame] | 358 | { |
Holger Hans Peter Freyther | 3cbf9e0 | 2013-11-26 21:43:58 +0100 | [diff] [blame] | 359 | m_v_b[bsn & mod_sns_half()] = type; |
Holger Hans Peter Freyther | 6b5660c | 2013-11-23 16:10:48 +0100 | [diff] [blame] | 360 | } |
| 361 | |
Holger Hans Peter Freyther | 3cbf9e0 | 2013-11-26 21:43:58 +0100 | [diff] [blame] | 362 | inline bool gprs_rlc_v_b::is_nacked(int bsn) const |
Holger Hans Peter Freyther | 6b5660c | 2013-11-23 16:10:48 +0100 | [diff] [blame] | 363 | { |
Daniel Willmann | d54d9f5 | 2013-12-28 21:16:13 +0100 | [diff] [blame] | 364 | return is_state(bsn, GPRS_RLC_DL_BSN_NACKED); |
Holger Hans Peter Freyther | 6b5660c | 2013-11-23 16:10:48 +0100 | [diff] [blame] | 365 | } |
| 366 | |
Holger Hans Peter Freyther | 3cbf9e0 | 2013-11-26 21:43:58 +0100 | [diff] [blame] | 367 | inline bool gprs_rlc_v_b::is_acked(int bsn) const |
Holger Hans Peter Freyther | 6b5660c | 2013-11-23 16:10:48 +0100 | [diff] [blame] | 368 | { |
Daniel Willmann | d54d9f5 | 2013-12-28 21:16:13 +0100 | [diff] [blame] | 369 | return is_state(bsn, GPRS_RLC_DL_BSN_ACKED); |
Holger Hans Peter Freyther | 6b5660c | 2013-11-23 16:10:48 +0100 | [diff] [blame] | 370 | } |
| 371 | |
Holger Hans Peter Freyther | 3cbf9e0 | 2013-11-26 21:43:58 +0100 | [diff] [blame] | 372 | inline bool gprs_rlc_v_b::is_unacked(int bsn) const |
Holger Hans Peter Freyther | 6b5660c | 2013-11-23 16:10:48 +0100 | [diff] [blame] | 373 | { |
Daniel Willmann | d54d9f5 | 2013-12-28 21:16:13 +0100 | [diff] [blame] | 374 | return is_state(bsn, GPRS_RLC_DL_BSN_UNACKED); |
Holger Hans Peter Freyther | 6b5660c | 2013-11-23 16:10:48 +0100 | [diff] [blame] | 375 | } |
| 376 | |
Holger Hans Peter Freyther | 3cbf9e0 | 2013-11-26 21:43:58 +0100 | [diff] [blame] | 377 | inline bool gprs_rlc_v_b::is_resend(int bsn) const |
Holger Hans Peter Freyther | 6b5660c | 2013-11-23 16:10:48 +0100 | [diff] [blame] | 378 | { |
Daniel Willmann | d54d9f5 | 2013-12-28 21:16:13 +0100 | [diff] [blame] | 379 | return is_state(bsn, GPRS_RLC_DL_BSN_RESEND); |
Holger Hans Peter Freyther | 6b5660c | 2013-11-23 16:10:48 +0100 | [diff] [blame] | 380 | } |
| 381 | |
Holger Hans Peter Freyther | 3cbf9e0 | 2013-11-26 21:43:58 +0100 | [diff] [blame] | 382 | inline bool gprs_rlc_v_b::is_invalid(int bsn) const |
Holger Hans Peter Freyther | 9525567 | 2013-11-23 16:18:18 +0100 | [diff] [blame] | 383 | { |
Daniel Willmann | d54d9f5 | 2013-12-28 21:16:13 +0100 | [diff] [blame] | 384 | return is_state(bsn, GPRS_RLC_DL_BSN_INVALID); |
Holger Hans Peter Freyther | 9525567 | 2013-11-23 16:18:18 +0100 | [diff] [blame] | 385 | } |
| 386 | |
Daniel Willmann | d54d9f5 | 2013-12-28 21:16:13 +0100 | [diff] [blame] | 387 | inline gprs_rlc_dl_bsn_state gprs_rlc_v_b::get_state(int bsn) const |
Daniel Willmann | 146514e | 2013-12-28 18:24:42 +0100 | [diff] [blame] | 388 | { |
| 389 | return m_v_b[bsn & mod_sns_half()]; |
| 390 | } |
| 391 | |
Holger Hans Peter Freyther | 3cbf9e0 | 2013-11-26 21:43:58 +0100 | [diff] [blame] | 392 | inline void gprs_rlc_v_b::mark_resend(int bsn) |
Holger Hans Peter Freyther | 6b5660c | 2013-11-23 16:10:48 +0100 | [diff] [blame] | 393 | { |
Daniel Willmann | d54d9f5 | 2013-12-28 21:16:13 +0100 | [diff] [blame] | 394 | return mark(bsn, GPRS_RLC_DL_BSN_RESEND); |
Holger Hans Peter Freyther | 6b5660c | 2013-11-23 16:10:48 +0100 | [diff] [blame] | 395 | } |
| 396 | |
Holger Hans Peter Freyther | 3cbf9e0 | 2013-11-26 21:43:58 +0100 | [diff] [blame] | 397 | inline void gprs_rlc_v_b::mark_unacked(int bsn) |
Holger Hans Peter Freyther | 6b5660c | 2013-11-23 16:10:48 +0100 | [diff] [blame] | 398 | { |
Daniel Willmann | d54d9f5 | 2013-12-28 21:16:13 +0100 | [diff] [blame] | 399 | return mark(bsn, GPRS_RLC_DL_BSN_UNACKED); |
Holger Hans Peter Freyther | 6b5660c | 2013-11-23 16:10:48 +0100 | [diff] [blame] | 400 | } |
| 401 | |
Holger Hans Peter Freyther | 3cbf9e0 | 2013-11-26 21:43:58 +0100 | [diff] [blame] | 402 | inline void gprs_rlc_v_b::mark_acked(int bsn) |
Holger Hans Peter Freyther | 6b5660c | 2013-11-23 16:10:48 +0100 | [diff] [blame] | 403 | { |
Daniel Willmann | d54d9f5 | 2013-12-28 21:16:13 +0100 | [diff] [blame] | 404 | return mark(bsn, GPRS_RLC_DL_BSN_ACKED); |
Holger Hans Peter Freyther | 6b5660c | 2013-11-23 16:10:48 +0100 | [diff] [blame] | 405 | } |
| 406 | |
Holger Hans Peter Freyther | 3cbf9e0 | 2013-11-26 21:43:58 +0100 | [diff] [blame] | 407 | inline void gprs_rlc_v_b::mark_nacked(int bsn) |
Holger Hans Peter Freyther | 6b5660c | 2013-11-23 16:10:48 +0100 | [diff] [blame] | 408 | { |
Daniel Willmann | d54d9f5 | 2013-12-28 21:16:13 +0100 | [diff] [blame] | 409 | return mark(bsn, GPRS_RLC_DL_BSN_NACKED); |
Holger Hans Peter Freyther | 6b5660c | 2013-11-23 16:10:48 +0100 | [diff] [blame] | 410 | } |
| 411 | |
Holger Hans Peter Freyther | 3cbf9e0 | 2013-11-26 21:43:58 +0100 | [diff] [blame] | 412 | inline void gprs_rlc_v_b::mark_invalid(int bsn) |
Holger Hans Peter Freyther | 6b5660c | 2013-11-23 16:10:48 +0100 | [diff] [blame] | 413 | { |
Daniel Willmann | d54d9f5 | 2013-12-28 21:16:13 +0100 | [diff] [blame] | 414 | return mark(bsn, GPRS_RLC_DL_BSN_INVALID); |
Holger Hans Peter Freyther | 6b5660c | 2013-11-23 16:10:48 +0100 | [diff] [blame] | 415 | } |
Holger Hans Peter Freyther | f1593b7 | 2013-11-24 20:36:36 +0100 | [diff] [blame] | 416 | |
Jacob Erlbeck | db88380 | 2016-01-19 14:07:33 +0100 | [diff] [blame] | 417 | inline gprs_rlc_window::gprs_rlc_window() |
| 418 | : m_sns(RLC_GPRS_SNS) |
Jacob Erlbeck | 8f8197f | 2015-12-28 13:51:44 +0100 | [diff] [blame] | 419 | , m_ws(RLC_GPRS_WS) |
Jacob Erlbeck | a3a567e | 2015-12-28 13:46:32 +0100 | [diff] [blame] | 420 | { |
| 421 | } |
| 422 | |
Jacob Erlbeck | db88380 | 2016-01-19 14:07:33 +0100 | [diff] [blame] | 423 | inline const uint16_t gprs_rlc_window::sns() const |
Holger Hans Peter Freyther | f1593b7 | 2013-11-24 20:36:36 +0100 | [diff] [blame] | 424 | { |
Jacob Erlbeck | 8f8197f | 2015-12-28 13:51:44 +0100 | [diff] [blame] | 425 | return m_sns; |
Holger Hans Peter Freyther | f1593b7 | 2013-11-24 20:36:36 +0100 | [diff] [blame] | 426 | } |
| 427 | |
Jacob Erlbeck | db88380 | 2016-01-19 14:07:33 +0100 | [diff] [blame] | 428 | inline const uint16_t gprs_rlc_window::ws() const |
Holger Hans Peter Freyther | f1593b7 | 2013-11-24 20:36:36 +0100 | [diff] [blame] | 429 | { |
Jacob Erlbeck | 8f8197f | 2015-12-28 13:51:44 +0100 | [diff] [blame] | 430 | return m_ws; |
Holger Hans Peter Freyther | f1593b7 | 2013-11-24 20:36:36 +0100 | [diff] [blame] | 431 | } |
| 432 | |
Jacob Erlbeck | db88380 | 2016-01-19 14:07:33 +0100 | [diff] [blame] | 433 | inline const uint16_t gprs_rlc_window::mod_sns() const |
Holger Hans Peter Freyther | f1593b7 | 2013-11-24 20:36:36 +0100 | [diff] [blame] | 434 | { |
| 435 | return sns() - 1; |
| 436 | } |
| 437 | |
Jacob Erlbeck | db88380 | 2016-01-19 14:07:33 +0100 | [diff] [blame] | 438 | inline const uint16_t gprs_rlc_window::mod_sns(uint16_t bsn) const |
Jacob Erlbeck | 93c55d0 | 2015-12-23 16:29:07 +0100 | [diff] [blame] | 439 | { |
| 440 | return bsn & mod_sns(); |
| 441 | } |
| 442 | |
Jacob Erlbeck | db88380 | 2016-01-19 14:07:33 +0100 | [diff] [blame] | 443 | inline gprs_rlc_dl_window::gprs_rlc_dl_window() |
| 444 | : m_v_s(0) |
| 445 | , m_v_a(0) |
| 446 | { |
| 447 | } |
| 448 | |
Holger Hans Peter Freyther | f1593b7 | 2013-11-24 20:36:36 +0100 | [diff] [blame] | 449 | inline const uint16_t gprs_rlc_dl_window::v_s() const |
| 450 | { |
| 451 | return m_v_s; |
| 452 | } |
| 453 | |
Holger Hans Peter Freyther | f1593b7 | 2013-11-24 20:36:36 +0100 | [diff] [blame] | 454 | inline const uint16_t gprs_rlc_dl_window::v_s_mod(int offset) const |
| 455 | { |
Jacob Erlbeck | 93c55d0 | 2015-12-23 16:29:07 +0100 | [diff] [blame] | 456 | return mod_sns(m_v_s + offset); |
Holger Hans Peter Freyther | f1593b7 | 2013-11-24 20:36:36 +0100 | [diff] [blame] | 457 | } |
| 458 | |
| 459 | inline const uint16_t gprs_rlc_dl_window::v_a() const |
| 460 | { |
| 461 | return m_v_a; |
| 462 | } |
| 463 | |
| 464 | inline bool gprs_rlc_dl_window::window_stalled() const |
| 465 | { |
Jacob Erlbeck | 93c55d0 | 2015-12-23 16:29:07 +0100 | [diff] [blame] | 466 | return (mod_sns(m_v_s - m_v_a)) == ws(); |
Holger Hans Peter Freyther | f1593b7 | 2013-11-24 20:36:36 +0100 | [diff] [blame] | 467 | } |
| 468 | |
| 469 | inline bool gprs_rlc_dl_window::window_empty() const |
| 470 | { |
| 471 | return m_v_s == m_v_a; |
| 472 | } |
| 473 | |
| 474 | inline void gprs_rlc_dl_window::increment_send() |
| 475 | { |
| 476 | m_v_s = (m_v_s + 1) & mod_sns(); |
| 477 | } |
| 478 | |
| 479 | inline void gprs_rlc_dl_window::raise(int moves) |
| 480 | { |
| 481 | m_v_a = (m_v_a + moves) & mod_sns(); |
| 482 | } |
| 483 | |
| 484 | inline const int16_t gprs_rlc_dl_window::distance() const |
| 485 | { |
| 486 | return (m_v_s - m_v_a) & mod_sns(); |
| 487 | } |
| 488 | |
Jacob Erlbeck | a3a567e | 2015-12-28 13:46:32 +0100 | [diff] [blame] | 489 | inline gprs_rlc_ul_window::gprs_rlc_ul_window() |
| 490 | : m_v_r(0) |
| 491 | , m_v_q(0) |
| 492 | { |
| 493 | } |
| 494 | |
Jacob Erlbeck | e1ca87f | 2015-12-23 16:40:56 +0100 | [diff] [blame] | 495 | inline bool gprs_rlc_ul_window::is_in_window(uint16_t bsn) const |
Holger Hans Peter Freyther | 6ab5b24 | 2013-11-24 22:43:03 +0100 | [diff] [blame] | 496 | { |
| 497 | uint16_t offset_v_q; |
| 498 | |
| 499 | /* current block relative to lowest unreceived block */ |
| 500 | offset_v_q = (bsn - m_v_q) & mod_sns(); |
| 501 | /* If out of window (may happen if blocks below V(Q) are received |
| 502 | * again. */ |
| 503 | return offset_v_q < ws(); |
| 504 | } |
| 505 | |
Jacob Erlbeck | e1ca87f | 2015-12-23 16:40:56 +0100 | [diff] [blame] | 506 | inline bool gprs_rlc_ul_window::is_received(uint16_t bsn) const |
Jacob Erlbeck | 784a0bd | 2015-12-14 11:54:29 +0100 | [diff] [blame] | 507 | { |
| 508 | uint16_t offset_v_r; |
| 509 | |
| 510 | /* Offset to the end of the received window */ |
| 511 | offset_v_r = (m_v_r - 1 - bsn) & mod_sns(); |
| 512 | return is_in_window(bsn) && m_v_n.is_received(bsn) && offset_v_r < ws(); |
| 513 | } |
| 514 | |
Holger Hans Peter Freyther | f1593b7 | 2013-11-24 20:36:36 +0100 | [diff] [blame] | 515 | inline const uint16_t gprs_rlc_ul_window::v_r() const |
| 516 | { |
| 517 | return m_v_r; |
| 518 | } |
| 519 | |
| 520 | inline const uint16_t gprs_rlc_ul_window::v_q() const |
| 521 | { |
| 522 | return m_v_q; |
| 523 | } |
| 524 | |
Daniel Willmann | 8a31f9e | 2013-11-27 17:08:35 +0100 | [diff] [blame] | 525 | inline const uint16_t gprs_rlc_ul_window::ssn() const |
| 526 | { |
| 527 | return m_v_r; |
| 528 | } |
| 529 | |
Daniel Willmann | f4a1ec6 | 2013-12-28 13:57:31 +0100 | [diff] [blame] | 530 | inline void gprs_rlc_ul_window::raise_v_r_to(int moves) |
Holger Hans Peter Freyther | f1593b7 | 2013-11-24 20:36:36 +0100 | [diff] [blame] | 531 | { |
Jacob Erlbeck | 93c55d0 | 2015-12-23 16:29:07 +0100 | [diff] [blame] | 532 | m_v_r = mod_sns(m_v_r + moves); |
Holger Hans Peter Freyther | f1593b7 | 2013-11-24 20:36:36 +0100 | [diff] [blame] | 533 | } |
| 534 | |
Holger Hans Peter Freyther | 7f3e662 | 2013-11-25 23:51:19 +0100 | [diff] [blame] | 535 | inline void gprs_rlc_ul_window::raise_v_q(int incr) |
Holger Hans Peter Freyther | f1593b7 | 2013-11-24 20:36:36 +0100 | [diff] [blame] | 536 | { |
Jacob Erlbeck | 93c55d0 | 2015-12-23 16:29:07 +0100 | [diff] [blame] | 537 | m_v_q = mod_sns(m_v_q + incr); |
Holger Hans Peter Freyther | f1593b7 | 2013-11-24 20:36:36 +0100 | [diff] [blame] | 538 | } |
Holger Hans Peter Freyther | 270f7fc | 2013-11-24 20:55:02 +0100 | [diff] [blame] | 539 | |
Holger Hans Peter Freyther | 3cbf9e0 | 2013-11-26 21:43:58 +0100 | [diff] [blame] | 540 | inline void gprs_rlc_v_n::mark_received(int bsn) |
Holger Hans Peter Freyther | 270f7fc | 2013-11-24 20:55:02 +0100 | [diff] [blame] | 541 | { |
Daniel Willmann | d54d9f5 | 2013-12-28 21:16:13 +0100 | [diff] [blame] | 542 | return mark(bsn, GPRS_RLC_UL_BSN_RECEIVED); |
Holger Hans Peter Freyther | 270f7fc | 2013-11-24 20:55:02 +0100 | [diff] [blame] | 543 | } |
| 544 | |
Holger Hans Peter Freyther | 3cbf9e0 | 2013-11-26 21:43:58 +0100 | [diff] [blame] | 545 | inline void gprs_rlc_v_n::mark_missing(int bsn) |
Holger Hans Peter Freyther | 270f7fc | 2013-11-24 20:55:02 +0100 | [diff] [blame] | 546 | { |
Daniel Willmann | d54d9f5 | 2013-12-28 21:16:13 +0100 | [diff] [blame] | 547 | return mark(bsn, GPRS_RLC_UL_BSN_MISSING); |
Holger Hans Peter Freyther | 270f7fc | 2013-11-24 20:55:02 +0100 | [diff] [blame] | 548 | } |
| 549 | |
Holger Hans Peter Freyther | 3cbf9e0 | 2013-11-26 21:43:58 +0100 | [diff] [blame] | 550 | inline bool gprs_rlc_v_n::is_received(int bsn) const |
Holger Hans Peter Freyther | 270f7fc | 2013-11-24 20:55:02 +0100 | [diff] [blame] | 551 | { |
Daniel Willmann | d54d9f5 | 2013-12-28 21:16:13 +0100 | [diff] [blame] | 552 | return is_state(bsn, GPRS_RLC_UL_BSN_RECEIVED); |
Holger Hans Peter Freyther | 270f7fc | 2013-11-24 20:55:02 +0100 | [diff] [blame] | 553 | } |
| 554 | |
Daniel Willmann | d54d9f5 | 2013-12-28 21:16:13 +0100 | [diff] [blame] | 555 | inline bool gprs_rlc_v_n::is_state(int bsn, gprs_rlc_ul_bsn_state type) const |
Holger Hans Peter Freyther | 270f7fc | 2013-11-24 20:55:02 +0100 | [diff] [blame] | 556 | { |
Holger Hans Peter Freyther | 3cbf9e0 | 2013-11-26 21:43:58 +0100 | [diff] [blame] | 557 | return m_v_n[bsn & mod_sns_half()] == type; |
| 558 | } |
| 559 | |
Daniel Willmann | d54d9f5 | 2013-12-28 21:16:13 +0100 | [diff] [blame] | 560 | inline void gprs_rlc_v_n::mark(int bsn, gprs_rlc_ul_bsn_state type) |
Holger Hans Peter Freyther | 3cbf9e0 | 2013-11-26 21:43:58 +0100 | [diff] [blame] | 561 | { |
| 562 | m_v_n[bsn & mod_sns_half()] = type; |
| 563 | } |
| 564 | |
Daniel Willmann | d54d9f5 | 2013-12-28 21:16:13 +0100 | [diff] [blame] | 565 | inline gprs_rlc_ul_bsn_state gprs_rlc_v_n::state(int bsn) const |
Holger Hans Peter Freyther | 3cbf9e0 | 2013-11-26 21:43:58 +0100 | [diff] [blame] | 566 | { |
Daniel Willmann | d54d9f5 | 2013-12-28 21:16:13 +0100 | [diff] [blame] | 567 | return m_v_n[bsn & mod_sns_half()]; |
Holger Hans Peter Freyther | 270f7fc | 2013-11-24 20:55:02 +0100 | [diff] [blame] | 568 | } |
Holger Hans Peter Freyther | 3cbf9e0 | 2013-11-26 21:43:58 +0100 | [diff] [blame] | 569 | |
| 570 | inline gprs_rlc_data *gprs_rlc::block(int bsn) |
| 571 | { |
| 572 | return &m_blocks[bsn & mod_sns_half()]; |
| 573 | } |