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