Harald Welte | d4ba7ff | 2017-07-17 21:00:48 +0200 | [diff] [blame] | 1 | /* Test Port that stacks on top of L1CTL test port and performs LAPDm encoding/decoding, so the user can send |
| 2 | * and receive LAPDm frames in decoded TTCN-3 data types. This is particularly useful for sending/receiving |
| 3 | * all kinds of hand-crafted LAPDm frames for testing of the remote LAPDm layer */ |
| 4 | module LAPDm_RAW_PT { |
| 5 | import from GSM_Types all; |
Harald Welte | ffcad68 | 2017-07-30 22:51:04 +0200 | [diff] [blame] | 6 | import from GSM_RR_Types all; |
Harald Welte | d4ba7ff | 2017-07-17 21:00:48 +0200 | [diff] [blame] | 7 | import from Osmocom_Types all; |
| 8 | import from L1CTL_Types all; |
| 9 | import from L1CTL_PortType all; |
| 10 | import from LAPDm_Types all; |
Harald Welte | 4b6c772 | 2017-08-01 00:07:12 +0200 | [diff] [blame] | 11 | import from RLCMAC_Types all; |
Harald Welte | d4ba7ff | 2017-07-17 21:00:48 +0200 | [diff] [blame] | 12 | |
| 13 | /* request to tune to a given ARFCN and start BCCH decoding */ |
| 14 | type record BCCH_tune_req { |
| 15 | Arfcn arfcn, |
| 16 | boolean combined_ccch |
| 17 | } |
| 18 | |
| 19 | /* ask for a dedicated channel to be established */ |
| 20 | type record DCCH_establish_req { |
| 21 | uint8_t ra |
| 22 | } |
| 23 | |
| 24 | type record DCCH_establish_res { |
| 25 | ChannelDescription chan_desc optional, |
| 26 | charstring err optional |
| 27 | } |
| 28 | |
Harald Welte | b669ee0 | 2018-03-09 12:50:02 +0100 | [diff] [blame] | 29 | type record length(8) of uint8_t TfiList; |
| 30 | type record TbfPars { |
| 31 | GsmArfcn arfcn optional, |
| 32 | /* Temporary Flow Identifier for each TN */ |
| 33 | TfiList tfi |
| 34 | } |
| 35 | type record length(8) of TbfPars TbfParsPerTs; |
| 36 | |
| 37 | template TbfPars t_TbfParsInit := { |
| 38 | arfcn := omit, |
| 39 | tfi := { 255, 255, 255, 255, 255, 255, 255, 255 } |
| 40 | } |
| 41 | |
| 42 | type record TBF_UL_establish_res { |
| 43 | TbfPars pars optional, |
Harald Welte | 4b6c772 | 2017-08-01 00:07:12 +0200 | [diff] [blame] | 44 | charstring err optional |
| 45 | } |
| 46 | |
Harald Welte | d4ba7ff | 2017-07-17 21:00:48 +0200 | [diff] [blame] | 47 | type record DCCH_release_req { |
| 48 | } |
| 49 | |
| 50 | /* PH-DATA.ind / PH-DATA.req */ |
| 51 | type record LAPDm_ph_data { |
| 52 | boolean sacch, |
| 53 | GsmSapi sapi, |
| 54 | LapdmFrame lapdm |
| 55 | } |
| 56 | |
Harald Welte | b669ee0 | 2018-03-09 12:50:02 +0100 | [diff] [blame] | 57 | type integer TbfNr (0..7); /* maximum of 8 concurrent TBF per direction */ |
| 58 | type record TBF_UL_establish_req { |
| 59 | TbfNr tbf_nr, |
Harald Welte | 4b6c772 | 2017-08-01 00:07:12 +0200 | [diff] [blame] | 60 | uint8_t ra |
| 61 | } |
| 62 | |
Harald Welte | b669ee0 | 2018-03-09 12:50:02 +0100 | [diff] [blame] | 63 | type record TBF_DL_establish_req { |
| 64 | TbfNr tbf_nr, |
| 65 | TbfPars pars |
| 66 | } |
| 67 | |
Harald Welte | 4b6c772 | 2017-08-01 00:07:12 +0200 | [diff] [blame] | 68 | /* PH-DATA.ind / PH-DATA.req */ |
| 69 | type record RLCMAC_ph_data_ind { |
| 70 | GprsCodingScheme cs, |
Harald Welte | 7024baa | 2018-03-02 23:37:51 +0100 | [diff] [blame] | 71 | uint8_t ts_nr, |
| 72 | GsmFrameNumber fn, |
Harald Welte | 4b6c772 | 2017-08-01 00:07:12 +0200 | [diff] [blame] | 73 | RlcmacDlBlock block |
| 74 | } |
Harald Welte | 7024baa | 2018-03-02 23:37:51 +0100 | [diff] [blame] | 75 | type record RLCMAC_ph_data_req_dyn { |
Harald Welte | 4b6c772 | 2017-08-01 00:07:12 +0200 | [diff] [blame] | 76 | uint8_t tbf_id, |
| 77 | GprsCodingScheme cs, |
| 78 | RlcmacUlBlock block |
| 79 | } |
Harald Welte | 7024baa | 2018-03-02 23:37:51 +0100 | [diff] [blame] | 80 | type record RLCMAC_ph_data_req_abs { |
| 81 | uint8_t tbf_id, |
| 82 | GprsCodingScheme cs, |
| 83 | uint8_t ts_nr, |
| 84 | GsmFrameNumber fn, |
| 85 | Arfcn arfcn, |
| 86 | RlcmacUlBlock block |
| 87 | } |
| 88 | type union RLCMAC_ph_data_req { |
| 89 | RLCMAC_ph_data_req_dyn dyn, |
| 90 | RLCMAC_ph_data_req_abs abs |
| 91 | } |
Harald Welte | 4b6c772 | 2017-08-01 00:07:12 +0200 | [diff] [blame] | 92 | |
Harald Welte | d4ba7ff | 2017-07-17 21:00:48 +0200 | [diff] [blame] | 93 | /* port from our (internal) point of view */ |
| 94 | type port LAPDm_SP_PT message { |
| 95 | in BCCH_tune_req, |
| 96 | DCCH_establish_req, |
| 97 | DCCH_release_req, |
Harald Welte | b669ee0 | 2018-03-09 12:50:02 +0100 | [diff] [blame] | 98 | TBF_UL_establish_req, |
| 99 | TBF_DL_establish_req, |
Harald Welte | 4b6c772 | 2017-08-01 00:07:12 +0200 | [diff] [blame] | 100 | RLCMAC_ph_data_req, |
Harald Welte | d4ba7ff | 2017-07-17 21:00:48 +0200 | [diff] [blame] | 101 | LAPDm_ph_data; |
| 102 | out DCCH_establish_res, |
Harald Welte | b669ee0 | 2018-03-09 12:50:02 +0100 | [diff] [blame] | 103 | TBF_UL_establish_res, |
Harald Welte | 4b6c772 | 2017-08-01 00:07:12 +0200 | [diff] [blame] | 104 | RLCMAC_ph_data_ind, |
Harald Welte | d4ba7ff | 2017-07-17 21:00:48 +0200 | [diff] [blame] | 105 | LAPDm_ph_data; |
| 106 | } with {extension "internal"}; |
| 107 | |
| 108 | /* port from user (external) point of view */ |
| 109 | type port LAPDm_PT message { |
| 110 | in DCCH_establish_res, |
Harald Welte | b669ee0 | 2018-03-09 12:50:02 +0100 | [diff] [blame] | 111 | TBF_UL_establish_res, |
Harald Welte | 4b6c772 | 2017-08-01 00:07:12 +0200 | [diff] [blame] | 112 | RLCMAC_ph_data_ind, |
Harald Welte | d4ba7ff | 2017-07-17 21:00:48 +0200 | [diff] [blame] | 113 | LAPDm_ph_data; |
| 114 | out BCCH_tune_req, |
| 115 | DCCH_establish_req, |
| 116 | DCCH_release_req, |
Harald Welte | b669ee0 | 2018-03-09 12:50:02 +0100 | [diff] [blame] | 117 | TBF_UL_establish_req, |
| 118 | TBF_DL_establish_req, |
Harald Welte | 4b6c772 | 2017-08-01 00:07:12 +0200 | [diff] [blame] | 119 | RLCMAC_ph_data_req, |
Harald Welte | d4ba7ff | 2017-07-17 21:00:48 +0200 | [diff] [blame] | 120 | LAPDm_ph_data; |
| 121 | } with {extension "internal"}; |
| 122 | |
| 123 | function LAPDmStart() runs on lapdm_CT { |
| 124 | f_init(); |
| 125 | ScanEvents(); |
| 126 | } |
| 127 | |
| 128 | /* TS 44.004 Figure 5.1 */ |
| 129 | type enumerated ph_state_enum { |
| 130 | PH_STATE_NULL, |
| 131 | PH_STATE_BCH, |
| 132 | PH_STATE_SEARCHING_BCH, |
| 133 | PH_STATE_TUNING_DCH, |
Harald Welte | 4b6c772 | 2017-08-01 00:07:12 +0200 | [diff] [blame] | 134 | PH_STATE_DCH, |
| 135 | PH_STATE_TBF |
Harald Welte | d4ba7ff | 2017-07-17 21:00:48 +0200 | [diff] [blame] | 136 | } |
| 137 | |
| 138 | type component lapdm_CT { |
Harald Welte | d4ba7ff | 2017-07-17 21:00:48 +0200 | [diff] [blame] | 139 | |
| 140 | /* L1CTL port towards the bottom */ |
| 141 | port L1CTL_PT L1CTL; |
| 142 | /* Port towards L2 */ |
| 143 | port LAPDm_SP_PT LAPDM_SP; |
| 144 | |
| 145 | /* physical layer state */ |
| 146 | var ph_state_enum ph_state := PH_STATE_NULL; |
| 147 | |
| 148 | /* channel description of the currently active DCH */ |
| 149 | var ChannelDescription chan_desc; |
Harald Welte | b669ee0 | 2018-03-09 12:50:02 +0100 | [diff] [blame] | 150 | |
| 151 | var TbfParsPerTs g_tbf_ul; |
| 152 | var TbfParsPerTs g_tbf_dl; |
Harald Welte | d4ba7ff | 2017-07-17 21:00:48 +0200 | [diff] [blame] | 153 | }; |
| 154 | |
| 155 | /* wrapper function to log state transitions */ |
| 156 | private function set_ph_state(ph_state_enum new_state) runs on lapdm_CT { |
| 157 | log("PH-STATE ", ph_state, " -> ", new_state); |
| 158 | ph_state := new_state; |
| 159 | } |
| 160 | |
| 161 | private function f_init() runs on lapdm_CT { |
Harald Welte | b26cfff | 2017-08-25 09:56:47 +0200 | [diff] [blame] | 162 | f_connect_reset(L1CTL); |
Harald Welte | d4ba7ff | 2017-07-17 21:00:48 +0200 | [diff] [blame] | 163 | set_ph_state(PH_STATE_NULL); |
| 164 | } |
| 165 | |
| 166 | /* release the dedicated radio channel */ |
| 167 | private function f_release_dcch() runs on lapdm_CT { |
Harald Welte | f8df4cb | 2018-03-10 15:15:08 +0100 | [diff] [blame] | 168 | L1CTL.send(ts_L1CTL_DM_REL_REQ(chan_desc.chan_nr)); |
Harald Welte | 4b6c772 | 2017-08-01 00:07:12 +0200 | [diff] [blame] | 169 | set_ph_state(PH_STATE_BCH); |
Harald Welte | d4ba7ff | 2017-07-17 21:00:48 +0200 | [diff] [blame] | 170 | } |
| 171 | |
| 172 | /* tune to given ARFCN and start BCCH/CCCH decoding */ |
| 173 | private function f_tune_bcch(Arfcn arfcn, boolean combined) runs on lapdm_CT { |
| 174 | var L1ctlCcchMode mode := CCCH_MODE_NON_COMBINED; |
| 175 | if (combined) { |
| 176 | mode := CCCH_MODE_COMBINED; |
| 177 | } |
| 178 | |
| 179 | if (ph_state == PH_STATE_DCH) { |
| 180 | /* release any previous DCH */ |
| 181 | f_release_dcch(); |
Harald Welte | 4b6c772 | 2017-08-01 00:07:12 +0200 | [diff] [blame] | 182 | } else if (ph_state == PH_STATE_TBF) { |
| 183 | f_release_tbf(); |
Harald Welte | d4ba7ff | 2017-07-17 21:00:48 +0200 | [diff] [blame] | 184 | } |
| 185 | |
| 186 | set_ph_state(PH_STATE_SEARCHING_BCH); |
| 187 | |
| 188 | /* send FB/SB req to sync to cell */ |
| 189 | f_L1CTL_FBSB(L1CTL, arfcn, mode); |
| 190 | set_ph_state(PH_STATE_BCH); |
| 191 | } |
| 192 | |
| 193 | /* master function establishing a dedicated radio channel */ |
| 194 | private function f_establish_dcch(uint8_t ra) runs on lapdm_CT { |
| 195 | var ImmediateAssignment imm_ass; |
| 196 | var GsmFrameNumber rach_fn; |
| 197 | |
| 198 | /* send RACH request and obtain FN at which it was sent */ |
| 199 | rach_fn := f_L1CTL_RACH(L1CTL, ra); |
| 200 | //if (not rach_fn) { return; } |
| 201 | |
| 202 | /* wait for receiving matching IMM ASS */ |
| 203 | imm_ass := f_L1CTL_WAIT_IMM_ASS(L1CTL, ra, rach_fn) |
| 204 | //if (not imm_ass) { return; } |
| 205 | set_ph_state(PH_STATE_TUNING_DCH); |
| 206 | |
| 207 | /* store/save channel description */ |
| 208 | chan_desc := imm_ass.chan_desc; |
| 209 | |
| 210 | /* send DM_EST_REQ */ |
| 211 | f_L1CTL_DM_EST_REQ_IA(L1CTL, imm_ass); |
| 212 | set_ph_state(PH_STATE_DCH); |
| 213 | } |
| 214 | |
Harald Welte | 4b6c772 | 2017-08-01 00:07:12 +0200 | [diff] [blame] | 215 | /* initialize a tfi_usf array with "not used" value 255 for all TN */ |
| 216 | function f_TfiUsfArrInit() return TfiUsfArr { |
| 217 | var TfiUsfArr tua := { 255, 255, 255, 255, 255, 255, 255, 255 }; |
| 218 | return tua; |
| 219 | } |
| 220 | |
| 221 | /* set TFI/USF value for one given timeslot number (index) */ |
| 222 | function f_TfiUsfArrSet(inout TfiUsfArr a, in uint8_t idx, in uint8_t tfi_usf) { |
| 223 | a[idx] := tfi_usf; |
| 224 | } |
| 225 | |
| 226 | /* Match an IMM.ASS for an Uplink TBF with a dynamic allocation */ |
| 227 | template ImmediateAssignment t_IMM_ASS_TBF_UL_DYN(uint8_t ra, GsmFrameNumber fn) modifies t_IMM_ASS := { |
| 228 | ded_or_tbf := { spare := ?, tma := ?, downlink := false, tbf := true}, |
| 229 | chan_desc := omit, |
| 230 | pkt_chan_desc := ?, |
| 231 | rest_octets := { |
| 232 | presence := '11'B, |
| 233 | ll := omit, |
| 234 | lh := omit, |
| 235 | hl := omit, |
| 236 | hh := { |
| 237 | presence := '00'B, |
| 238 | ul := { |
| 239 | presence := '1'B, |
| 240 | dynamic := { |
| 241 | tfi_assignment := ?, |
| 242 | polling := ?, |
| 243 | spare := '0'B, |
| 244 | usf := ?, |
| 245 | usf_granularity := ?, |
| 246 | p0_present := ?, |
| 247 | p0 := *, |
| 248 | pr_mode := *, |
| 249 | ch_coding_cmd := ?, |
| 250 | tlli_block_chan_coding:= ?, |
| 251 | alpha_present := ?, |
| 252 | alpha := *, |
| 253 | gamma := ?, |
| 254 | ta_index_present := ?, |
| 255 | ta_index := *, |
| 256 | tbf_starting_time_present := ?, |
| 257 | tbf_starting_time := * |
| 258 | }, |
| 259 | single := omit |
| 260 | }, |
| 261 | dl := omit |
| 262 | } |
| 263 | } |
| 264 | }; |
| 265 | |
Harald Welte | 7024baa | 2018-03-02 23:37:51 +0100 | [diff] [blame] | 266 | template (value) RLCMAC_ph_data_req ts_PH_DATA_ABS(uint8_t tbf_id, GprsCodingScheme cs, |
| 267 | uint8_t ts, uint32_t fn, Arfcn arfcn, |
| 268 | RlcmacUlBlock block) := { |
| 269 | abs := { |
| 270 | tbf_id := tbf_id, |
| 271 | cs := CS1, /* FIXME */ |
| 272 | ts_nr := ts, |
| 273 | fn := fn, |
| 274 | arfcn := arfcn, |
| 275 | block := block |
| 276 | } |
| 277 | } |
| 278 | |
Harald Welte | 4b6c772 | 2017-08-01 00:07:12 +0200 | [diff] [blame] | 279 | private function f_establish_tbf(uint8_t ra) runs on lapdm_CT { |
| 280 | var ImmediateAssignment imm_ass; |
| 281 | var GsmFrameNumber rach_fn; |
| 282 | var TfiUsfArr tua := f_TfiUsfArrInit(); |
| 283 | |
| 284 | /* send RACH request and obtain FN at which it was sent */ |
| 285 | rach_fn := f_L1CTL_RACH(L1CTL, ra); |
| 286 | |
| 287 | /* wait for receiving matching IMM ASS */ |
| 288 | imm_ass := f_L1CTL_WAIT_IMM_ASS(L1CTL, ra, rach_fn); |
| 289 | |
| 290 | if (match(imm_ass, t_IMM_ASS_TBF_UL_DYN(ra, rach_fn))) { |
| 291 | set_ph_state(PH_STATE_TBF); |
| 292 | |
| 293 | /* store/save channel description */ |
| 294 | //chan_desc := imm_ass.chan_desc; |
| 295 | |
| 296 | /* Important: ARFCN, TN, TSC, USF, USF_GRANULARITY, CH_CODING_CMD */ |
| 297 | f_TfiUsfArrSet(tua, imm_ass.pkt_chan_desc.tn, imm_ass.rest_octets.hh.ul.dynamic.usf); |
| 298 | f_L1CTL_TBF_CFG(L1CTL, true, tua); |
| 299 | } else { |
| 300 | /* FIXME: single block uplink allocation */ |
| 301 | log("Failed to match ", t_IMM_ASS_TBF_UL_DYN(ra, rach_fn)); |
| 302 | log("Non-dynamic UL TBF assignment not supported yet"); |
| 303 | } |
| 304 | } |
| 305 | |
| 306 | private function f_release_tbf() runs on lapdm_CT { |
| 307 | var TfiUsfArr tua := f_TfiUsfArrInit(); |
| 308 | /* send "all timeslots unused" for both UL and DL */ |
| 309 | f_L1CTL_TBF_CFG(L1CTL, true, tua); |
| 310 | f_L1CTL_TBF_CFG(L1CTL, false, tua); |
| 311 | /* L1 will then fall back to BCCH/CCCH */ |
| 312 | set_ph_state(PH_STATE_BCH); |
| 313 | } |
| 314 | |
Harald Welte | b669ee0 | 2018-03-09 12:50:02 +0100 | [diff] [blame] | 315 | /* Establish TBF / packet transfer mode */ |
| 316 | private altstep as_tbf_ul_est() runs on lapdm_CT { |
| 317 | var TBF_UL_establish_req tbf_ul_req; |
| 318 | [] LAPDM_SP.receive(TBF_UL_establish_req:?) -> value tbf_ul_req { |
| 319 | var TbfNr tbf_nr := tbf_ul_req.tbf_nr; |
| 320 | var TBF_UL_establish_res res; |
| 321 | if (isvalue(g_tbf_ul[tbf_nr].arfcn)) { |
| 322 | setverdict(fail, "Cannot establish UL TBF ID ", tbf_nr, ": BUSY"); |
Daniel Willmann | e4ff537 | 2018-07-05 17:35:03 +0200 | [diff] [blame] | 323 | mtc.stop; |
Harald Welte | b669ee0 | 2018-03-09 12:50:02 +0100 | [diff] [blame] | 324 | } |
| 325 | f_establish_tbf(tbf_ul_req.ra); |
| 326 | if (ph_state == PH_STATE_TBF) { |
| 327 | g_tbf_ul[tbf_nr] := valueof(t_TbfParsInit); /* FIXME: Actual TFI[s] */ |
| 328 | log("Established UL TBF ", tbf_nr); |
| 329 | res := { pars := g_tbf_ul[tbf_nr], err := omit }; |
| 330 | } else { |
| 331 | res := { pars := omit, err := "Unable to establish UL TBF" }; |
| 332 | } |
| 333 | LAPDM_SP.send(res); |
| 334 | } |
| 335 | } |
| 336 | |
| 337 | private altstep as_tbf_dl_est() runs on lapdm_CT { |
| 338 | var TBF_DL_establish_req tbf_dl_req; |
| 339 | [] LAPDM_SP.receive(TBF_DL_establish_req:?) -> value tbf_dl_req { |
| 340 | var TbfNr tbf_nr := tbf_dl_req.tbf_nr; |
| 341 | if (isvalue(g_tbf_dl[tbf_nr].arfcn)) { |
| 342 | setverdict(fail, "Cannot establish DL TBF ID ", tbf_nr, ": BUSY"); |
Daniel Willmann | e4ff537 | 2018-07-05 17:35:03 +0200 | [diff] [blame] | 343 | mtc.stop; |
Harald Welte | b669ee0 | 2018-03-09 12:50:02 +0100 | [diff] [blame] | 344 | } |
| 345 | g_tbf_dl[tbf_nr] := tbf_dl_req.pars; |
| 346 | f_L1CTL_TBF_CFG(L1CTL, false, tbf_dl_req.pars.tfi); |
| 347 | set_ph_state(PH_STATE_TBF); |
| 348 | log("Established DL TBF ", tbf_nr, ": ", tbf_dl_req.pars); |
| 349 | } |
| 350 | } |
| 351 | |
| 352 | private function f_init_tbf() runs on lapdm_CT { |
| 353 | var integer i; |
| 354 | for (i := 0; i < 8; i := i+1) { |
| 355 | g_tbf_ul[i] := valueof(t_TbfParsInit); |
| 356 | g_tbf_dl[i] := valueof(t_TbfParsInit); |
| 357 | } |
| 358 | } |
| 359 | |
Harald Welte | d4ba7ff | 2017-07-17 21:00:48 +0200 | [diff] [blame] | 360 | function ScanEvents() runs on lapdm_CT { |
| 361 | var L1ctlDlMessage dl; |
| 362 | var BCCH_tune_req bt; |
| 363 | var LAPDm_ph_data lpd; |
Harald Welte | 4b6c772 | 2017-08-01 00:07:12 +0200 | [diff] [blame] | 364 | var RLCMAC_ph_data_ind rpdi; |
| 365 | var RLCMAC_ph_data_req rpdr; |
Harald Welte | d4ba7ff | 2017-07-17 21:00:48 +0200 | [diff] [blame] | 366 | var DCCH_establish_req est_req; |
| 367 | var DCCH_establish_res est_res; |
Harald Welte | b669ee0 | 2018-03-09 12:50:02 +0100 | [diff] [blame] | 368 | |
| 369 | f_init_tbf(); |
Harald Welte | d4ba7ff | 2017-07-17 21:00:48 +0200 | [diff] [blame] | 370 | |
| 371 | while (true) { |
| 372 | if (ph_state == PH_STATE_NULL) { |
| 373 | alt { |
| 374 | [] LAPDM_SP.receive(BCCH_tune_req:?) -> value bt { |
| 375 | f_tune_bcch(bt.arfcn, bt.combined_ccch); |
| 376 | } |
| 377 | |
| 378 | [] LAPDM_SP.receive {} |
| 379 | [] L1CTL.receive {} |
| 380 | |
| 381 | } |
| 382 | } else if (ph_state == PH_STATE_BCH or ph_state == PH_STATE_SEARCHING_BCH) { |
| 383 | alt { |
| 384 | [] LAPDM_SP.receive(BCCH_tune_req:?) -> value bt { |
| 385 | f_tune_bcch(bt.arfcn, bt.combined_ccch); |
| 386 | } |
| 387 | |
| 388 | /* forward CCCH SAPI from L1CTL to User */ |
Harald Welte | f8df4cb | 2018-03-10 15:15:08 +0100 | [diff] [blame] | 389 | [] L1CTL.receive(tr_L1CTL_DATA_IND(t_RslChanNr_BCCH(0))) -> value dl { |
Harald Welte | d4ba7ff | 2017-07-17 21:00:48 +0200 | [diff] [blame] | 390 | lpd.sacch := false; |
| 391 | lpd.sapi := 0; |
| 392 | lpd.lapdm.bbis := dec_LapdmFrameBbis(dl.payload.data_ind.payload); |
| 393 | LAPDM_SP.send(lpd); |
| 394 | } |
| 395 | |
| 396 | /* forward BCCH SAPI from L1CTL to User */ |
Harald Welte | f8df4cb | 2018-03-10 15:15:08 +0100 | [diff] [blame] | 397 | [] L1CTL.receive(tr_L1CTL_DATA_IND(t_RslChanNr_PCH_AGCH(0))) -> value dl { |
Harald Welte | d4ba7ff | 2017-07-17 21:00:48 +0200 | [diff] [blame] | 398 | lpd.sacch := false; |
| 399 | lpd.sapi := 0; |
| 400 | lpd.lapdm.bbis := dec_LapdmFrameBbis(dl.payload.data_ind.payload); |
| 401 | LAPDM_SP.send(lpd); |
| 402 | } |
| 403 | |
| 404 | /* Establish dedicated channel */ |
| 405 | [] LAPDM_SP.receive(DCCH_establish_req:?) -> value est_req { |
| 406 | var DCCH_establish_res res; |
| 407 | f_establish_dcch(est_req.ra); |
| 408 | if (ph_state == PH_STATE_DCH) { |
| 409 | res := { chan_desc, omit }; |
| 410 | } else { |
| 411 | res := { omit, "Unable to esetablish DCCH" }; |
| 412 | } |
| 413 | LAPDM_SP.send(res); |
| 414 | } |
| 415 | |
Harald Welte | b669ee0 | 2018-03-09 12:50:02 +0100 | [diff] [blame] | 416 | [] as_tbf_ul_est(); |
| 417 | [] as_tbf_dl_est(); |
Harald Welte | 4b6c772 | 2017-08-01 00:07:12 +0200 | [diff] [blame] | 418 | |
Harald Welte | d4ba7ff | 2017-07-17 21:00:48 +0200 | [diff] [blame] | 419 | [] LAPDM_SP.receive {} |
| 420 | [] L1CTL.receive {} |
| 421 | |
| 422 | } |
| 423 | |
| 424 | } else if (ph_state == PH_STATE_TUNING_DCH or ph_state == PH_STATE_DCH) { |
| 425 | alt { |
| 426 | |
| 427 | /* decode any received DATA frames for the dedicated channel and pass them up */ |
Harald Welte | f8df4cb | 2018-03-10 15:15:08 +0100 | [diff] [blame] | 428 | [] L1CTL.receive(tr_L1CTL_DATA_IND(chan_desc.chan_nr)) -> value dl { |
Harald Welte | d4ba7ff | 2017-07-17 21:00:48 +0200 | [diff] [blame] | 429 | if (dl.dl_info.link_id.c == SACCH) { |
| 430 | lpd.sacch := true; |
| 431 | /* FIXME: how to deal with UI frames in B4 format (lo length!) */ |
| 432 | } else { |
| 433 | lpd.sacch := false; |
| 434 | } |
| 435 | lpd.sapi := dl.dl_info.link_id.sapi; |
Harald Welte | d879bd9 | 2018-03-12 15:01:23 +0100 | [diff] [blame] | 436 | lpd.lapdm.ab := dec_LapdmFrameAB(dl.payload.data_ind.payload); |
Harald Welte | d4ba7ff | 2017-07-17 21:00:48 +0200 | [diff] [blame] | 437 | LAPDM_SP.send(lpd); |
| 438 | } |
| 439 | |
| 440 | /* encode any LAPDm record from user and pass it on to L1CTL */ |
| 441 | [] LAPDM_SP.receive(LAPDm_ph_data:?) -> value lpd { |
| 442 | var octetstring buf; |
| 443 | var RslLinkId link_id; |
| 444 | if (lpd.sacch) { |
| 445 | link_id := valueof(ts_RslLinkID_SACCH(lpd.sapi)); |
| 446 | } else { |
| 447 | link_id := valueof(ts_RslLinkID_DCCH(lpd.sapi)); |
| 448 | } |
| 449 | buf := enc_LapdmFrame(lpd.lapdm); |
Harald Welte | f8df4cb | 2018-03-10 15:15:08 +0100 | [diff] [blame] | 450 | L1CTL.send(ts_L1CTL_DATA_REQ(chan_desc.chan_nr, link_id, buf)); |
Harald Welte | d4ba7ff | 2017-07-17 21:00:48 +0200 | [diff] [blame] | 451 | } |
| 452 | |
| 453 | /* Release dedicated channel */ |
| 454 | [] LAPDM_SP.receive(DCCH_release_req:?) { |
| 455 | /* go back to BCCH */ |
| 456 | f_release_dcch(); |
| 457 | } |
| 458 | |
| 459 | [] LAPDM_SP.receive {} |
| 460 | [] L1CTL.receive {} |
| 461 | |
| 462 | |
| 463 | } |
Harald Welte | 4b6c772 | 2017-08-01 00:07:12 +0200 | [diff] [blame] | 464 | } else if (ph_state == PH_STATE_TBF) { |
| 465 | alt { |
| 466 | |
| 467 | /* decode + forward any blocks from L1 to L23*/ |
Harald Welte | f8df4cb | 2018-03-10 15:15:08 +0100 | [diff] [blame] | 468 | [] L1CTL.receive(tr_L1CTL_DATA_IND(t_RslChanNr_PDCH(?))) -> value dl { |
Harald Welte | 4b6c772 | 2017-08-01 00:07:12 +0200 | [diff] [blame] | 469 | rpdi.block := dec_RlcmacDlBlock(dl.payload.data_ind.payload); |
Harald Welte | b669ee0 | 2018-03-09 12:50:02 +0100 | [diff] [blame] | 470 | /* FIXME: Filter based on g_tbf_dl */ |
Harald Welte | 7024baa | 2018-03-02 23:37:51 +0100 | [diff] [blame] | 471 | rpdi.fn := dl.dl_info.frame_nr; |
| 472 | rpdi.ts_nr := dl.dl_info.chan_nr.tn; |
Harald Welte | 4b6c772 | 2017-08-01 00:07:12 +0200 | [diff] [blame] | 473 | rpdi.cs := CS1; /* FIXME */ |
| 474 | log("RPDI: ", rpdi); |
| 475 | LAPDM_SP.send(rpdi); |
| 476 | } |
| 477 | |
| 478 | [] L1CTL.receive { } |
| 479 | |
| 480 | /* encode + forward any blocks from L23 to L1 */ |
| 481 | [] LAPDM_SP.receive(RLCMAC_ph_data_req:?) -> value rpdr { |
| 482 | var octetstring buf; |
Harald Welte | 7024baa | 2018-03-02 23:37:51 +0100 | [diff] [blame] | 483 | if (ischosen(rpdr.dyn)) { |
| 484 | buf := enc_RlcmacUlBlock(rpdr.dyn.block); |
Harald Welte | f8df4cb | 2018-03-10 15:15:08 +0100 | [diff] [blame] | 485 | L1CTL.send(ts_L1CTL_DATA_TBF_REQ(buf, L1CTL_CS1, rpdr.dyn.tbf_id)); |
Harald Welte | 7024baa | 2018-03-02 23:37:51 +0100 | [diff] [blame] | 486 | } else { |
| 487 | buf := enc_RlcmacUlBlock(rpdr.abs.block); |
Harald Welte | f8df4cb | 2018-03-10 15:15:08 +0100 | [diff] [blame] | 488 | L1CTL.send(ts_L1CTL_DATA_ABS_REQ(buf, rpdr.abs.arfcn, |
Harald Welte | 7024baa | 2018-03-02 23:37:51 +0100 | [diff] [blame] | 489 | rpdr.abs.ts_nr, rpdr.abs.fn, |
| 490 | L1CTL_CS1, rpdr.abs.tbf_id)); |
| 491 | } |
Harald Welte | 4b6c772 | 2017-08-01 00:07:12 +0200 | [diff] [blame] | 492 | } |
| 493 | |
Harald Welte | b669ee0 | 2018-03-09 12:50:02 +0100 | [diff] [blame] | 494 | [] as_tbf_ul_est(); |
| 495 | [] as_tbf_dl_est(); |
| 496 | |
Harald Welte | 4b6c772 | 2017-08-01 00:07:12 +0200 | [diff] [blame] | 497 | /* FIXME: release TBF mode */ |
| 498 | [] LAPDM_SP.receive(DCCH_release_req:?) { |
| 499 | /* go back to BCCH */ |
| 500 | f_release_tbf(); |
Harald Welte | b669ee0 | 2018-03-09 12:50:02 +0100 | [diff] [blame] | 501 | f_init_tbf(); |
Harald Welte | 4b6c772 | 2017-08-01 00:07:12 +0200 | [diff] [blame] | 502 | } |
| 503 | |
| 504 | } |
Harald Welte | d4ba7ff | 2017-07-17 21:00:48 +0200 | [diff] [blame] | 505 | } |
Harald Welte | 4b6c772 | 2017-08-01 00:07:12 +0200 | [diff] [blame] | 506 | |
Harald Welte | d4ba7ff | 2017-07-17 21:00:48 +0200 | [diff] [blame] | 507 | } /* while (1) */ |
| 508 | } |
| 509 | } |