Pau Espin Pedrol | b2c6b38 | 2019-05-14 13:40:49 +0200 | [diff] [blame] | 1 | module OSMUX_Emulation { |
| 2 | |
| 3 | /* Functionalities that we want this module to implement: |
| 4 | * * act as a Osmux source that generates a Osmux Stream |
| 5 | * * act as a Osmux sink that consumes a Osmux Stream |
| 6 | * |
| 7 | * for all of the above, we want to be able to |
| 8 | * * specify the payload type |
| 9 | * * specify the interval / sample rate |
| 10 | * * create drop-outs in the stream |
| 11 | * * detect reordered or lost frames |
| 12 | * * validate if the size of the frames matches epectations |
| 13 | * * play back real audio (at least some tones?) |
| 14 | * * enable/disable generation/verification of RTCP |
| 15 | */ |
| 16 | |
| 17 | /* Ideas: |
| 18 | |
| 19 | * each component consists of transmitter and receiver |
| 20 | * transmitters and receivers can be operated as tuple? |
| 21 | * high-level operation |
| 22 | ** set-up config at transmitter + receiver |
| 23 | ** transmit sequence of payloads |
| 24 | ** verify receiption of those payloads |
| 25 | * can operate full-duplex/bi-directional as needed |
| 26 | |
| 27 | * transmitter |
| 28 | ** trigger transmission of n number of packets |
| 29 | ** transmit them at normal ptime interval |
| 30 | ** payload size configurable |
| 31 | ** payload contents PRBS or the like |
| 32 | |
| 33 | * receiver |
| 34 | ** count number of related packets at receiver |
| 35 | ** check received payload type |
| 36 | ** check received timestamp increments |
| 37 | ** check received seq_nr increments |
| 38 | ** (optionally) check for SSRC |
| 39 | ** (optionally) check for payload size |
| 40 | ** (optionally) check for payload contents |
| 41 | |
| 42 | * later |
| 43 | ** how to test transcoding? |
| 44 | ** how to test pure play-out endpoints (rx only)? |
| 45 | ** how to test "Rx from wrong IP/port" scenarios? |
| 46 | ** how to test RTCP? |
| 47 | ** maybe keep ports un-connected to show wrong src -lrt |
| 48 | |
| 49 | */ |
| 50 | |
| 51 | |
| 52 | |
| 53 | |
| 54 | import from General_Types all; |
| 55 | import from Osmocom_Types all; |
| 56 | import from IPL4asp_Types all; |
Pau Espin Pedrol | ef046b3 | 2022-08-12 17:42:21 +0200 | [diff] [blame] | 57 | import from Misc_Helpers all; |
Pau Espin Pedrol | 71ed463 | 2022-09-02 18:51:19 +0200 | [diff] [blame] | 58 | import from AMR_Types all; |
Pau Espin Pedrol | b2c6b38 | 2019-05-14 13:40:49 +0200 | [diff] [blame] | 59 | import from OSMUX_Types all; |
| 60 | import from OSMUX_CodecPort all; |
| 61 | import from OSMUX_CodecPort_CtrlFunct all; |
| 62 | |
| 63 | type component OSMUX_Emulation_CT { |
| 64 | /* down-facing ports for Osmux on top of IPL4asp */ |
| 65 | port OSMUX_CODEC_PT OSMUX; |
| 66 | var integer g_osmux_conn_id := -1; |
| 67 | |
| 68 | /* user-facing port for controlling the binding */ |
| 69 | port OsmuxEM_CTRL_PT CTRL; |
Pau Espin Pedrol | 5bd8e88 | 2022-08-31 13:32:40 +0200 | [diff] [blame] | 70 | /* user-facing port for sniffing Osmux frames */ |
| 71 | port OsmuxEM_DATA_PT DATA; |
Pau Espin Pedrol | b2c6b38 | 2019-05-14 13:40:49 +0200 | [diff] [blame] | 72 | |
| 73 | /* configurable by user, should be fixed */ |
| 74 | var OsmuxemConfig g_cfg := c_OsmuxemDefaultCfg; |
| 75 | |
| 76 | /* statistics */ |
| 77 | var OsmuxemStats g_stat := c_OsmuxemStatsReset; |
| 78 | |
| 79 | var HostName g_remote_host; |
| 80 | var PortNumber g_remote_port; |
| 81 | var HostName g_local_host; |
| 82 | var PortNumber g_local_port; |
| 83 | |
| 84 | /* state variables, change over time */ |
| 85 | var boolean g_rx_enabled := false; |
| 86 | var boolean g_tx_connected := false; /* Set to true after connect() */ |
| 87 | |
| 88 | var INT7b g_rx_payload_type := 0; |
| 89 | var LIN2_BO_LAST g_rx_last_seq; |
| 90 | var uint32_t g_rx_last_ts; |
| 91 | |
| 92 | var RxHandleTableRec RxHandleTable[16]; |
| 93 | var OsmuxTxHandle TxHandleList[16]; |
| 94 | } |
| 95 | |
| 96 | type record RxHandleTableRec { |
| 97 | OsmuxCID cid, |
| 98 | OsmuxRxHandle vc_conn |
| 99 | }; |
| 100 | |
| 101 | type record OsmuxRxHandle { |
| 102 | OsmuxCID cid, |
| 103 | boolean first_seq_seen, |
| 104 | INT1 last_seq_ack |
| 105 | }; |
| 106 | |
| 107 | const OsmuxRxHandle c_OsmuxemDefaultRxHandle := { |
| 108 | cid := 0, |
| 109 | first_seq_seen := false, |
| 110 | last_seq_ack := 0 |
| 111 | } |
| 112 | |
| 113 | type record OsmuxTxHandle { |
| 114 | INT2b ft, |
| 115 | BIT1 amr_f, |
| 116 | BIT1 amr_q, |
| 117 | INT1 seq, |
| 118 | OsmuxCID cid, |
| 119 | INT4b amr_ft, |
| 120 | INT4b amr_cmr |
| 121 | }; |
| 122 | |
| 123 | template OsmuxTxHandle t_TxHandleAMR590(OsmuxCID cid) := { |
| 124 | ft := 1,//enum2int(OsmuxFT:OSMUX_FT_AMR) |
| 125 | amr_f := '0'B, /* this frame is the last frame in this payload */ |
| 126 | amr_q := '1'B, /* frame not damaged */ |
| 127 | seq := 12, |
| 128 | cid := cid, |
| 129 | amr_ft := 2, /* AMR 5.90 */ |
| 130 | amr_cmr := 0 |
| 131 | }; |
| 132 | |
| 133 | type enumerated OsmuxemMode { |
| 134 | OSMUXEM_MODE_NONE, |
| 135 | OSMUXEM_MODE_TXONLY, |
| 136 | OSMUXEM_MODE_RXONLY, |
| 137 | OSMUXEM_MODE_BIDIR |
| 138 | }; |
| 139 | |
| 140 | type record OsmuxemStats { |
| 141 | /* number of packets transmitted */ |
| 142 | integer num_pkts_tx, |
| 143 | /* number of Osmux payload bytes transmitted */ |
| 144 | integer bytes_payload_tx, |
| 145 | |
| 146 | /* number of packets received */ |
| 147 | integer num_pkts_rx, |
| 148 | /* number of Osmux payload bytes received */ |
| 149 | integer bytes_payload_rx, |
| 150 | /* number of packets received out-of-sequence */ |
| 151 | integer num_pkts_rx_err_seq, |
| 152 | /* number of packets received during Rx disable */ |
| 153 | integer num_pkts_rx_err_disabled, |
| 154 | /* number of packets received with mismatching payload */ |
| 155 | integer num_pkts_rx_err_payload |
| 156 | } |
| 157 | |
| 158 | const OsmuxemStats c_OsmuxemStatsReset := { |
| 159 | num_pkts_tx := 0, |
| 160 | bytes_payload_tx := 0, |
| 161 | num_pkts_rx := 0, |
| 162 | bytes_payload_rx := 0, |
| 163 | num_pkts_rx_err_seq := 0, |
| 164 | num_pkts_rx_err_disabled := 0, |
| 165 | num_pkts_rx_err_payload := 0 |
| 166 | } |
| 167 | |
| 168 | type record OsmuxemConfig { |
| 169 | INT3b batch_size, |
| 170 | integer tx_duration_ms, |
| 171 | octetstring tx_fixed_payload optional, |
| 172 | octetstring rx_fixed_payload optional |
| 173 | }; |
| 174 | |
| 175 | const OsmuxemConfig c_OsmuxemDefaultCfg := { |
| 176 | batch_size := 4, |
| 177 | tx_duration_ms := 20 * 4, /* 4 is batch_size */ |
| 178 | tx_fixed_payload := '010203040102030401020304010203040102030401020304'O, |
| 179 | rx_fixed_payload := '010203040102030401020304010203040102030401020304'O |
| 180 | } |
| 181 | |
| 182 | signature OsmuxEM_bind(in HostName local_host, inout PortNumber local_port); |
| 183 | signature OsmuxEM_connect(in HostName remote_host, in PortNumber remote_port); |
| 184 | signature OsmuxEM_mode(in OsmuxemMode mode); |
| 185 | signature OsmuxEM_configure(in OsmuxemConfig cfg); |
| 186 | signature OsmuxEM_stats_get(out OsmuxemStats stats); |
| 187 | signature OsmuxEM_register_rxhandle(in OsmuxRxHandle hdl); |
| 188 | signature OsmuxEM_register_txhandle(in OsmuxTxHandle hdl); |
| 189 | |
| 190 | type port OsmuxEM_CTRL_PT procedure { |
| 191 | inout OsmuxEM_bind, OsmuxEM_connect, OsmuxEM_mode, OsmuxEM_configure, |
| 192 | OsmuxEM_stats_get, OsmuxEM_register_rxhandle, OsmuxEM_register_txhandle; |
| 193 | } with { extension "internal" }; |
| 194 | |
Pau Espin Pedrol | 5bd8e88 | 2022-08-31 13:32:40 +0200 | [diff] [blame] | 195 | type port OsmuxEM_DATA_PT message { |
| 196 | inout OSMUX_PDU; |
| 197 | } with { extension "internal" }; |
| 198 | |
Pau Espin Pedrol | b2c6b38 | 2019-05-14 13:40:49 +0200 | [diff] [blame] | 199 | function f_osmuxem_bind(OsmuxEM_CTRL_PT pt, in HostName local_host, inout PortNumber local_port) { |
| 200 | pt.call(OsmuxEM_bind:{local_host, local_port}) { |
| 201 | [] pt.getreply(OsmuxEM_bind:{local_host, ?}) -> param (local_port) {}; |
| 202 | } |
| 203 | } |
| 204 | function f_osmuxem_connect(OsmuxEM_CTRL_PT pt, in HostName remote_host, in PortNumber remote_port) { |
| 205 | pt.call(OsmuxEM_connect:{remote_host, remote_port}) { |
| 206 | [] pt.getreply(OsmuxEM_connect:{remote_host, remote_port}) {}; |
| 207 | } |
| 208 | } |
| 209 | function f_osmuxem_mode(OsmuxEM_CTRL_PT pt, in OsmuxemMode mode) { |
| 210 | pt.call(OsmuxEM_mode:{mode}) { |
| 211 | [] pt.getreply(OsmuxEM_mode:{mode}) {}; |
| 212 | } |
| 213 | } |
| 214 | function f_osmuxem_configure(OsmuxEM_CTRL_PT pt, in OsmuxemConfig cfg) { |
| 215 | pt.call(OsmuxEM_configure:{cfg}) { |
| 216 | [] pt.getreply(OsmuxEM_configure:{cfg}) {}; |
| 217 | } |
| 218 | } |
| 219 | function f_osmuxem_stats_get(OsmuxEM_CTRL_PT pt) return OsmuxemStats { |
| 220 | var OsmuxemStats stats; |
| 221 | pt.call(OsmuxEM_stats_get:{-}) { |
| 222 | [] pt.getreply(OsmuxEM_stats_get:{?}) -> param(stats) {}; |
| 223 | } |
| 224 | return stats; |
| 225 | } |
| 226 | |
| 227 | function f_osmuxem_register_rxhandle(OsmuxEM_CTRL_PT pt, OsmuxRxHandle hdl) { |
| 228 | pt.call(OsmuxEM_register_rxhandle:{hdl}) { |
| 229 | [] pt.getreply(OsmuxEM_register_rxhandle:{hdl}) {}; |
| 230 | } |
| 231 | } |
| 232 | |
| 233 | function f_osmuxem_register_txhandle(OsmuxEM_CTRL_PT pt, OsmuxTxHandle hdl) { |
| 234 | pt.call(OsmuxEM_register_txhandle:{hdl}) { |
| 235 | [] pt.getreply(OsmuxEM_register_txhandle:{hdl}) {}; |
| 236 | } |
| 237 | } |
| 238 | |
| 239 | |
| 240 | function f_osmuxem_stats_compare_value(integer a, integer b, integer tolerance := 0) return boolean { |
| 241 | var integer temp; |
| 242 | |
| 243 | temp := (a - b) |
| 244 | if (temp < 0) { |
| 245 | temp := -temp; |
| 246 | } |
| 247 | |
| 248 | if (temp > tolerance) { |
| 249 | return false; |
| 250 | } |
| 251 | |
| 252 | return true; |
| 253 | } |
| 254 | |
| 255 | /* Cross-compare two osmuxem-statistics. The transmission statistics on the a side |
| 256 | * must match the reception statistics on the other side and vice versa. The |
| 257 | * user may also supply a tolerance value (number of packets) when deviations |
| 258 | * are acceptable */ |
| 259 | function f_osmuxem_stats_compare(OsmuxemStats a, OsmuxemStats b, integer tolerance := 0) return boolean { |
| 260 | var integer plen; |
| 261 | |
| 262 | log("stats A: ", a); |
| 263 | log("stats B: ", b); |
| 264 | log("tolerance: ", tolerance, " packets"); |
| 265 | |
| 266 | if (f_osmuxem_stats_compare_value(a.num_pkts_tx, b.num_pkts_rx, tolerance) == false) { |
| 267 | return false; |
| 268 | } |
| 269 | |
| 270 | if (f_osmuxem_stats_compare_value(a.num_pkts_rx, b.num_pkts_tx, tolerance) == false) { |
| 271 | return false; |
| 272 | } |
| 273 | |
| 274 | if(a.num_pkts_tx > 0) { |
| 275 | plen := a.bytes_payload_tx / a.num_pkts_tx; |
| 276 | } else { |
| 277 | plen := 0; |
| 278 | } |
| 279 | |
| 280 | if (f_osmuxem_stats_compare_value(a.bytes_payload_tx, b.bytes_payload_rx, tolerance * plen) == false) { |
| 281 | return false; |
| 282 | } |
| 283 | |
| 284 | if (f_osmuxem_stats_compare_value(a.bytes_payload_rx, b.bytes_payload_tx, tolerance * plen) == false) { |
| 285 | return false; |
| 286 | } |
| 287 | |
| 288 | return true; |
| 289 | } |
| 290 | |
| 291 | /* Check the statistics for general signs of errors. This is a basic general |
| 292 | * check that will fit most situations and is intended to be executed by |
| 293 | * the testcases as as needed. */ |
| 294 | function f_osmuxem_stats_err_check(OsmuxemStats s) { |
| 295 | log("stats: ", s); |
| 296 | |
| 297 | /* Check if there was some activity at either on the RX or on the |
| 298 | * TX side, but complete silence would indicate some problem */ |
| 299 | if (s.num_pkts_tx < 1 and s.num_pkts_rx < 1) { |
Pau Espin Pedrol | ef046b3 | 2022-08-12 17:42:21 +0200 | [diff] [blame] | 300 | Misc_Helpers.f_shutdown(__BFILE__, __LINE__, fail, |
| 301 | "no Osmux packet activity detected (packets)"); |
Pau Espin Pedrol | b2c6b38 | 2019-05-14 13:40:49 +0200 | [diff] [blame] | 302 | } |
| 303 | if (s.bytes_payload_tx < 1 and s.bytes_payload_rx < 1) { |
Pau Espin Pedrol | ef046b3 | 2022-08-12 17:42:21 +0200 | [diff] [blame] | 304 | Misc_Helpers.f_shutdown(__BFILE__, __LINE__, fail, |
| 305 | "no Osmux packet activity detected (bytes)"); |
Pau Espin Pedrol | b2c6b38 | 2019-05-14 13:40:49 +0200 | [diff] [blame] | 306 | } |
| 307 | |
| 308 | /* Check error counters */ |
| 309 | if (s.num_pkts_rx_err_seq != 0) { |
Pau Espin Pedrol | ef046b3 | 2022-08-12 17:42:21 +0200 | [diff] [blame] | 310 | Misc_Helpers.f_shutdown(__BFILE__, __LINE__, fail, |
| 311 | "Osmux packet sequence number errors occurred"); |
Pau Espin Pedrol | b2c6b38 | 2019-05-14 13:40:49 +0200 | [diff] [blame] | 312 | } |
| 313 | if (s.num_pkts_rx_err_disabled != 0) { |
Pau Espin Pedrol | ef046b3 | 2022-08-12 17:42:21 +0200 | [diff] [blame] | 314 | Misc_Helpers.f_shutdown(__BFILE__, __LINE__, fail, |
| 315 | "Osmux packets received while RX was disabled"); |
Pau Espin Pedrol | b2c6b38 | 2019-05-14 13:40:49 +0200 | [diff] [blame] | 316 | } |
| 317 | if (s.num_pkts_rx_err_payload != 0) { |
Pau Espin Pedrol | ef046b3 | 2022-08-12 17:42:21 +0200 | [diff] [blame] | 318 | Misc_Helpers.f_shutdown(__BFILE__, __LINE__, fail, |
| 319 | "Osmux packets with mismatching payload received"); |
Pau Espin Pedrol | b2c6b38 | 2019-05-14 13:40:49 +0200 | [diff] [blame] | 320 | } |
| 321 | } |
| 322 | |
| 323 | template PDU_Osmux_AMR ts_OsmuxAMR(BIT1 marker, INT3b ctr, BIT1 amr_f, BIT1 amr_q, INT1 seq, |
| 324 | OsmuxCID cid, INT4b amr_ft, INT4b amr_cmr, |
| 325 | octetstring payload) := { |
| 326 | header := { |
| 327 | marker := marker, |
| 328 | ft := 1, |
| 329 | ctr := ctr, |
| 330 | amr_f := amr_f, |
| 331 | amr_q := amr_q, |
| 332 | seq := seq, |
| 333 | cid := cid, |
| 334 | amr_ft := amr_ft, |
| 335 | amr_cmr := amr_cmr |
| 336 | }, |
| 337 | data := payload |
| 338 | } |
| 339 | |
| 340 | private function f_rxhandle_get_by_cid(OsmuxCID cid) runs on OSMUX_Emulation_CT return OsmuxRxHandle { |
| 341 | var integer i; |
| 342 | for (i := 0; i < sizeof(RxHandleTable); i := i+1) { |
| 343 | if (isbound(RxHandleTable[i].cid) and RxHandleTable[i].cid == cid) { |
| 344 | return RxHandleTable[i].vc_conn; |
| 345 | } |
| 346 | } |
Pau Espin Pedrol | ef046b3 | 2022-08-12 17:42:21 +0200 | [diff] [blame] | 347 | Misc_Helpers.f_shutdown(__BFILE__, __LINE__, fail, |
| 348 | log2str("No Component for CID ", cid)); |
| 349 | return RxHandleTable[0].vc_conn; /* make compiler happy, not reached */ |
Pau Espin Pedrol | b2c6b38 | 2019-05-14 13:40:49 +0200 | [diff] [blame] | 350 | } |
| 351 | |
| 352 | private function f_rxhandle_cid_add(OsmuxRxHandle hdl) runs on OSMUX_Emulation_CT { |
| 353 | var integer i; |
| 354 | for (i := 0; i < sizeof(RxHandleTable); i := i+1) { |
| 355 | if (not isbound(RxHandleTable[i].cid)) { |
| 356 | RxHandleTable[i].cid := hdl.cid; |
| 357 | RxHandleTable[i].vc_conn := hdl; |
| 358 | return; |
| 359 | } |
| 360 | } |
Pau Espin Pedrol | ef046b3 | 2022-08-12 17:42:21 +0200 | [diff] [blame] | 361 | Misc_Helpers.f_shutdown(__BFILE__, __LINE__, fail, |
| 362 | log2str("No Space in RxHandleTable for ", hdl.cid)); |
Pau Espin Pedrol | b2c6b38 | 2019-05-14 13:40:49 +0200 | [diff] [blame] | 363 | } |
| 364 | |
| 365 | private function f_txhandle_cid_add(OsmuxTxHandle hdl) runs on OSMUX_Emulation_CT { |
| 366 | var integer i; |
| 367 | for (i := 0; i < sizeof(TxHandleList); i := i+1) { |
| 368 | if (not isbound(TxHandleList[i])) { |
| 369 | TxHandleList[i] := hdl; |
| 370 | return; |
| 371 | } |
| 372 | } |
Pau Espin Pedrol | ef046b3 | 2022-08-12 17:42:21 +0200 | [diff] [blame] | 373 | Misc_Helpers.f_shutdown(__BFILE__, __LINE__, fail, |
| 374 | log2str("No Space in TxHandleList for ", hdl.cid)); |
Pau Espin Pedrol | b2c6b38 | 2019-05-14 13:40:49 +0200 | [diff] [blame] | 375 | } |
| 376 | |
Pau Espin Pedrol | 30f0667 | 2022-10-25 12:30:58 +0200 | [diff] [blame] | 377 | /* Generate correctly-sized AMR payload based on amr_ft, using tx_fixed_payload as a fill pattern. */ |
Pau Espin Pedrol | b2c6b38 | 2019-05-14 13:40:49 +0200 | [diff] [blame] | 378 | function f_osmux_gen_expected_rx_rtp_payload(INT4b amr_ft, octetstring tx_fixed_payload) return octetstring { |
Pau Espin Pedrol | 30f0667 | 2022-10-25 12:30:58 +0200 | [diff] [blame] | 379 | var integer payload_len_bits; |
Pau Espin Pedrol | b2c6b38 | 2019-05-14 13:40:49 +0200 | [diff] [blame] | 380 | var integer payload_len; |
Pau Espin Pedrol | 30f0667 | 2022-10-25 12:30:58 +0200 | [diff] [blame] | 381 | var bitstring payload_truncated_bits; |
Pau Espin Pedrol | b2c6b38 | 2019-05-14 13:40:49 +0200 | [diff] [blame] | 382 | var octetstring payload_truncated; |
Pau Espin Pedrol | 30f0667 | 2022-10-25 12:30:58 +0200 | [diff] [blame] | 383 | |
| 384 | /* Generate the AMR payload as a bitstring, since some formats don't end up in octet boundary: */ |
| 385 | payload_len_bits := f_amrft_payload_bits_len(amr_ft); |
| 386 | payload_truncated_bits := substr(oct2bit(tx_fixed_payload), 0, payload_len_bits); |
| 387 | |
| 388 | /* Now convert it as an octet string filling final padding with zeroes: */ |
Pau Espin Pedrol | b2c6b38 | 2019-05-14 13:40:49 +0200 | [diff] [blame] | 389 | payload_len := f_amrft_payload_len(amr_ft); |
Pau Espin Pedrol | 30f0667 | 2022-10-25 12:30:58 +0200 | [diff] [blame] | 390 | payload_truncated := bit2oct(f_pad_bit(payload_truncated_bits, payload_len*8, '0'B)); |
Pau Espin Pedrol | b2c6b38 | 2019-05-14 13:40:49 +0200 | [diff] [blame] | 391 | return payload_truncated; |
| 392 | } |
| 393 | |
| 394 | private function f_osmux_gen_payload(INT3b ctr, INT4b amr_ft) runs on OSMUX_Emulation_CT return octetstring { |
| 395 | var octetstring payload_truncated := ''O; |
| 396 | var integer i; |
| 397 | |
| 398 | for (i := 0; i < ctr + 1; i := i+1) { |
| 399 | payload_truncated := payload_truncated & f_osmux_gen_expected_rx_rtp_payload(amr_ft, g_cfg.tx_fixed_payload); |
| 400 | } |
| 401 | return payload_truncated; |
| 402 | } |
| 403 | |
| 404 | private function f_tx_osmux(integer i, INT3b ctr, octetstring payload, BIT1 marker := '0'B) runs on OSMUX_Emulation_CT { |
| 405 | var OsmuxTxHandle hdl := TxHandleList[i]; |
| 406 | var PDU_Osmux_AMR osmux_amr := valueof(ts_OsmuxAMR(marker, ctr, hdl.amr_f, |
| 407 | hdl.amr_q, hdl.seq, hdl.cid, hdl.amr_ft, |
| 408 | hdl.amr_cmr, payload)); |
| 409 | OSMUX.send(t_Osmux_Send(g_osmux_conn_id, OSMUX_PDU:{osmux_amr:=osmux_amr})); |
| 410 | /* increment sequence + timestamp for next transmit */ |
| 411 | TxHandleList[i].seq := TxHandleList[i].seq + 1; |
| 412 | |
| 413 | /* update counters */ |
| 414 | g_stat.num_pkts_tx := g_stat.num_pkts_tx+1; |
| 415 | g_stat.bytes_payload_tx := g_stat.bytes_payload_tx + |
| 416 | lengthof(payload); |
| 417 | } |
| 418 | |
| 419 | private function f_tx_osmux_all_cid(BIT1 marker := '0'B) runs on OSMUX_Emulation_CT { |
| 420 | /* TODO: append all in one UDP packet and send together */ |
| 421 | var integer i; |
| 422 | var octetstring payload_truncated; |
| 423 | var INT3b ctr := g_cfg.batch_size - 1; |
| 424 | |
| 425 | for (i := 0; i < sizeof(TxHandleList); i := i+1) { |
| 426 | if (isbound(TxHandleList[i])) { |
| 427 | payload_truncated := f_osmux_gen_payload(ctr, TxHandleList[i].amr_ft); |
| 428 | f_tx_osmux(i, ctr, payload_truncated, marker); |
| 429 | |
| 430 | } |
| 431 | } |
| 432 | } |
| 433 | |
| 434 | function f_main() runs on OSMUX_Emulation_CT |
| 435 | { |
| 436 | var Result res; |
| 437 | var OsmuxRxHandle rx_hdl; |
| 438 | var OsmuxTxHandle tx_hdl; |
| 439 | var octetstring payload_truncated; |
Pau Espin Pedrol | 4d0886d | 2022-08-12 17:42:51 +0200 | [diff] [blame] | 440 | var PortEvent port_event; |
Pau Espin Pedrol | b2c6b38 | 2019-05-14 13:40:49 +0200 | [diff] [blame] | 441 | timer T_transmit := int2float(g_cfg.tx_duration_ms)/1000.0; |
| 442 | var Osmux_RecvFrom rx_osmux; |
| 443 | var PDU_Osmux_AMR rx_amr; |
| 444 | var PDU_Osmux_DUMMY osmux_dummy; |
| 445 | var OsmuxemConfig cfg; |
| 446 | var template Osmux_RecvFrom tr_osmux_amr := { |
| 447 | connId := ?, |
| 448 | remName := ?, |
| 449 | remPort := ?, |
| 450 | locName := ?, |
| 451 | locPort := ?, |
| 452 | msg := ? |
| 453 | }; |
| 454 | tr_osmux_amr.msg := { osmux_amr := ? }; |
| 455 | var template Osmux_RecvFrom tr_osmux_dummy := { |
| 456 | connId := ?, |
| 457 | remName := ?, |
| 458 | remPort := ?, |
| 459 | locName := ?, |
| 460 | locPort := ?, |
| 461 | msg := ? |
| 462 | }; |
| 463 | tr_osmux_dummy.msg := { osmux_dummy := ? }; |
| 464 | |
| 465 | while (true) { |
| 466 | alt { |
| 467 | /* control procedures (calls) from the user */ |
| 468 | [] CTRL.getcall(OsmuxEM_bind:{?,?}) -> param(g_local_host, g_local_port) { |
| 469 | |
| 470 | g_tx_connected := false; /* will set it back to true upon next connect() call */ |
Pau Espin Pedrol | 08005d7 | 2020-09-08 13:16:14 +0200 | [diff] [blame] | 471 | |
| 472 | if (g_osmux_conn_id != -1) { |
| 473 | res := OSMUX_CodecPort_CtrlFunct.f_IPL4_close(OSMUX, g_osmux_conn_id, {udp := {}}); |
| 474 | g_osmux_conn_id := -1; |
| 475 | } |
Pau Espin Pedrol | b2c6b38 | 2019-05-14 13:40:49 +0200 | [diff] [blame] | 476 | res := OSMUX_CodecPort_CtrlFunct.f_IPL4_listen(OSMUX, g_local_host, |
| 477 | g_local_port, {udp:={}}); |
| 478 | if (not ispresent(res.connId)) { |
Pau Espin Pedrol | ef046b3 | 2022-08-12 17:42:21 +0200 | [diff] [blame] | 479 | Misc_Helpers.f_shutdown(__BFILE__, __LINE__, fail, |
| 480 | "Could not listen on Osmux socket, check your configuration"); |
Pau Espin Pedrol | b2c6b38 | 2019-05-14 13:40:49 +0200 | [diff] [blame] | 481 | } |
| 482 | g_osmux_conn_id := res.connId; |
| 483 | tr_osmux_amr.connId := g_osmux_conn_id; |
| 484 | tr_osmux_dummy.connId := g_osmux_conn_id; |
| 485 | |
| 486 | CTRL.reply(OsmuxEM_bind:{g_local_host, g_local_port}); |
| 487 | } |
| 488 | [] CTRL.getcall(OsmuxEM_connect:{?,?}) -> param (g_remote_host, g_remote_port) { |
| 489 | res := OSMUX_CodecPort_CtrlFunct.f_IPL4_connect(OSMUX, g_remote_host, |
| 490 | g_remote_port, |
| 491 | g_local_host, g_local_port, |
| 492 | g_osmux_conn_id, {udp:={}}); |
| 493 | if (not ispresent(res.connId)) { |
Pau Espin Pedrol | ef046b3 | 2022-08-12 17:42:21 +0200 | [diff] [blame] | 494 | Misc_Helpers.f_shutdown(__BFILE__, __LINE__, fail, |
| 495 | "Could not connect to Osmux socket, check your configuration"); |
Pau Espin Pedrol | b2c6b38 | 2019-05-14 13:40:49 +0200 | [diff] [blame] | 496 | } |
| 497 | g_tx_connected := true; |
| 498 | CTRL.reply(OsmuxEM_connect:{g_remote_host, g_remote_port}); |
| 499 | } |
| 500 | [] CTRL.getcall(OsmuxEM_mode:{OSMUXEM_MODE_NONE}) { |
| 501 | T_transmit.stop; |
| 502 | g_rx_enabled := false; |
| 503 | CTRL.reply(OsmuxEM_mode:{OSMUXEM_MODE_NONE}); |
| 504 | } |
| 505 | [] CTRL.getcall(OsmuxEM_mode:{OSMUXEM_MODE_TXONLY}) { |
| 506 | /* start transmit timer */ |
| 507 | T_transmit.start; |
| 508 | g_rx_enabled := false; |
| 509 | CTRL.reply(OsmuxEM_mode:{OSMUXEM_MODE_TXONLY}); |
| 510 | } |
| 511 | [] CTRL.getcall(OsmuxEM_mode:{OSMUXEM_MODE_RXONLY}) { |
| 512 | |
| 513 | T_transmit.stop; |
| 514 | if (g_rx_enabled == false) { |
| 515 | /* flush queues */ |
| 516 | OSMUX.clear; |
| 517 | g_rx_enabled := true; |
| 518 | } |
| 519 | CTRL.reply(OsmuxEM_mode:{OSMUXEM_MODE_RXONLY}); |
| 520 | } |
| 521 | [] CTRL.getcall(OsmuxEM_mode:{OSMUXEM_MODE_BIDIR}) { |
| 522 | T_transmit.start; |
| 523 | if (g_rx_enabled == false) { |
| 524 | /* flush queues */ |
| 525 | OSMUX.clear; |
| 526 | g_rx_enabled := true; |
| 527 | } |
| 528 | CTRL.reply(OsmuxEM_mode:{OSMUXEM_MODE_BIDIR}); |
| 529 | } |
| 530 | [] CTRL.getcall(OsmuxEM_configure:{?}) -> param (cfg) { |
| 531 | g_cfg := cfg; |
| 532 | CTRL.reply(OsmuxEM_configure:{cfg}); |
| 533 | } |
| 534 | [] CTRL.getcall(OsmuxEM_register_txhandle:{?}) -> param (tx_hdl) { |
| 535 | f_txhandle_cid_add(tx_hdl); |
| 536 | CTRL.reply(OsmuxEM_register_txhandle:{tx_hdl}); |
| 537 | } |
| 538 | [] CTRL.getcall(OsmuxEM_register_rxhandle:{?}) -> param (rx_hdl) { |
| 539 | f_rxhandle_cid_add(rx_hdl); |
| 540 | CTRL.reply(OsmuxEM_register_rxhandle:{rx_hdl}); |
| 541 | } |
| 542 | [] CTRL.getcall(OsmuxEM_stats_get:{?}) { |
| 543 | CTRL.reply(OsmuxEM_stats_get:{g_stat}); |
| 544 | } |
| 545 | |
| 546 | /* simply ignore any Osmux AMR if receiver not enabled */ |
| 547 | [g_rx_enabled==false] OSMUX.receive(tr_osmux_amr) { |
| 548 | g_stat.num_pkts_rx_err_disabled := g_stat.num_pkts_rx_err_disabled+1; |
| 549 | } |
| 550 | /* simply ignore any Osmux Dummy if receiver not enabled */ |
| 551 | [g_rx_enabled==false] OSMUX.receive(tr_osmux_dummy) -> value rx_osmux { |
| 552 | log("Osmux Dummy received on CID ", rx_osmux.msg.osmux_dummy.header.cid, " (rx_disabled)"); |
| 553 | } |
| 554 | |
| 555 | /* process received Osmux AMR if receiver enabled */ |
| 556 | [g_rx_enabled] OSMUX.receive(tr_osmux_amr) -> value rx_osmux { |
| 557 | /* increment counters */ |
| 558 | g_stat.num_pkts_rx := g_stat.num_pkts_rx+1; |
| 559 | g_stat.bytes_payload_rx := g_stat.bytes_payload_rx + |
| 560 | lengthof(rx_osmux.msg.osmux_amr.data); |
| 561 | rx_hdl := f_rxhandle_get_by_cid(rx_osmux.msg.osmux_amr.header.cid); |
| 562 | |
| 563 | if (rx_hdl.first_seq_seen and rx_hdl.last_seq_ack != rx_osmux.msg.osmux_amr.header.seq - 1 ) { |
| 564 | g_stat.num_pkts_rx_err_seq := g_stat.num_pkts_rx_err_seq + 1; |
| 565 | } |
| 566 | rx_hdl.first_seq_seen := true; |
| 567 | rx_hdl.last_seq_ack := rx_osmux.msg.osmux_amr.header.seq; |
| 568 | |
| 569 | payload_truncated := f_osmux_gen_payload(rx_osmux.msg.osmux_amr.header.ctr, rx_osmux.msg.osmux_amr.header.amr_ft); |
| 570 | if (ispresent(g_cfg.rx_fixed_payload) and rx_osmux.msg.osmux_amr.data != payload_truncated) { |
| 571 | g_stat.num_pkts_rx_err_payload := g_stat.num_pkts_rx_err_payload + 1; |
| 572 | } |
Pau Espin Pedrol | 5bd8e88 | 2022-08-31 13:32:40 +0200 | [diff] [blame] | 573 | if (DATA.checkstate("Connected")) { |
| 574 | DATA.send(rx_osmux.msg); |
| 575 | } |
Pau Espin Pedrol | b2c6b38 | 2019-05-14 13:40:49 +0200 | [diff] [blame] | 576 | } |
| 577 | /* process received Osmux Dummy if receiver enabled */ |
| 578 | [g_rx_enabled] OSMUX.receive(tr_osmux_dummy) -> value rx_osmux { |
| 579 | log("Osmux Dummy received on CID", rx_osmux.msg.osmux_dummy.header.cid); |
| 580 | rx_hdl := f_rxhandle_get_by_cid(rx_osmux.msg.osmux_dummy.header.cid); |
| 581 | } |
| 582 | |
| 583 | /* transmit if timer has expired */ |
| 584 | [g_tx_connected] T_transmit.timeout { |
| 585 | /* send one Osmux frame, re-start timer */ |
| 586 | f_tx_osmux_all_cid(); |
| 587 | T_transmit.start; |
| 588 | } |
| 589 | |
Pau Espin Pedrol | 4d0886d | 2022-08-12 17:42:51 +0200 | [diff] [blame] | 590 | [] OSMUX.receive(PortEvent:?) -> value port_event { |
| 591 | Misc_Helpers.f_shutdown(__BFILE__, __LINE__, fail, |
| 592 | log2str("Received unexpected port event from Osmux:", port_event)); |
| 593 | } |
| 594 | |
Pau Espin Pedrol | b2c6b38 | 2019-05-14 13:40:49 +0200 | [diff] [blame] | 595 | /* fail on any unexpected messages */ |
| 596 | [] OSMUX.receive { |
Pau Espin Pedrol | ef046b3 | 2022-08-12 17:42:21 +0200 | [diff] [blame] | 597 | Misc_Helpers.f_shutdown(__BFILE__, __LINE__, fail, |
| 598 | "Received unexpected msg type from Osmux"); |
Pau Espin Pedrol | b2c6b38 | 2019-05-14 13:40:49 +0200 | [diff] [blame] | 599 | } |
| 600 | } |
| 601 | } |
| 602 | } |
| 603 | |
| 604 | |
| 605 | } |