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