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