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; |
| 57 | import from OSMUX_Types all; |
| 58 | import from OSMUX_CodecPort all; |
| 59 | import from OSMUX_CodecPort_CtrlFunct all; |
| 60 | |
| 61 | type component OSMUX_Emulation_CT { |
| 62 | /* down-facing ports for Osmux on top of IPL4asp */ |
| 63 | port OSMUX_CODEC_PT OSMUX; |
| 64 | var integer g_osmux_conn_id := -1; |
| 65 | |
| 66 | /* user-facing port for controlling the binding */ |
| 67 | port OsmuxEM_CTRL_PT CTRL; |
| 68 | |
| 69 | /* configurable by user, should be fixed */ |
| 70 | var OsmuxemConfig g_cfg := c_OsmuxemDefaultCfg; |
| 71 | |
| 72 | /* statistics */ |
| 73 | var OsmuxemStats g_stat := c_OsmuxemStatsReset; |
| 74 | |
| 75 | var HostName g_remote_host; |
| 76 | var PortNumber g_remote_port; |
| 77 | var HostName g_local_host; |
| 78 | var PortNumber g_local_port; |
| 79 | |
| 80 | /* state variables, change over time */ |
| 81 | var boolean g_rx_enabled := false; |
| 82 | var boolean g_tx_connected := false; /* Set to true after connect() */ |
| 83 | |
| 84 | var INT7b g_rx_payload_type := 0; |
| 85 | var LIN2_BO_LAST g_rx_last_seq; |
| 86 | var uint32_t g_rx_last_ts; |
| 87 | |
| 88 | var RxHandleTableRec RxHandleTable[16]; |
| 89 | var OsmuxTxHandle TxHandleList[16]; |
| 90 | } |
| 91 | |
| 92 | type record RxHandleTableRec { |
| 93 | OsmuxCID cid, |
| 94 | OsmuxRxHandle vc_conn |
| 95 | }; |
| 96 | |
| 97 | type record OsmuxRxHandle { |
| 98 | OsmuxCID cid, |
| 99 | boolean first_seq_seen, |
| 100 | INT1 last_seq_ack |
| 101 | }; |
| 102 | |
| 103 | const OsmuxRxHandle c_OsmuxemDefaultRxHandle := { |
| 104 | cid := 0, |
| 105 | first_seq_seen := false, |
| 106 | last_seq_ack := 0 |
| 107 | } |
| 108 | |
| 109 | type record OsmuxTxHandle { |
| 110 | INT2b ft, |
| 111 | BIT1 amr_f, |
| 112 | BIT1 amr_q, |
| 113 | INT1 seq, |
| 114 | OsmuxCID cid, |
| 115 | INT4b amr_ft, |
| 116 | INT4b amr_cmr |
| 117 | }; |
| 118 | |
| 119 | template OsmuxTxHandle t_TxHandleAMR590(OsmuxCID cid) := { |
| 120 | ft := 1,//enum2int(OsmuxFT:OSMUX_FT_AMR) |
| 121 | amr_f := '0'B, /* this frame is the last frame in this payload */ |
| 122 | amr_q := '1'B, /* frame not damaged */ |
| 123 | seq := 12, |
| 124 | cid := cid, |
| 125 | amr_ft := 2, /* AMR 5.90 */ |
| 126 | amr_cmr := 0 |
| 127 | }; |
| 128 | |
| 129 | type enumerated OsmuxemMode { |
| 130 | OSMUXEM_MODE_NONE, |
| 131 | OSMUXEM_MODE_TXONLY, |
| 132 | OSMUXEM_MODE_RXONLY, |
| 133 | OSMUXEM_MODE_BIDIR |
| 134 | }; |
| 135 | |
| 136 | type record OsmuxemStats { |
| 137 | /* number of packets transmitted */ |
| 138 | integer num_pkts_tx, |
| 139 | /* number of Osmux payload bytes transmitted */ |
| 140 | integer bytes_payload_tx, |
| 141 | |
| 142 | /* number of packets received */ |
| 143 | integer num_pkts_rx, |
| 144 | /* number of Osmux payload bytes received */ |
| 145 | integer bytes_payload_rx, |
| 146 | /* number of packets received out-of-sequence */ |
| 147 | integer num_pkts_rx_err_seq, |
| 148 | /* number of packets received during Rx disable */ |
| 149 | integer num_pkts_rx_err_disabled, |
| 150 | /* number of packets received with mismatching payload */ |
| 151 | integer num_pkts_rx_err_payload |
| 152 | } |
| 153 | |
| 154 | const OsmuxemStats c_OsmuxemStatsReset := { |
| 155 | num_pkts_tx := 0, |
| 156 | bytes_payload_tx := 0, |
| 157 | num_pkts_rx := 0, |
| 158 | bytes_payload_rx := 0, |
| 159 | num_pkts_rx_err_seq := 0, |
| 160 | num_pkts_rx_err_disabled := 0, |
| 161 | num_pkts_rx_err_payload := 0 |
| 162 | } |
| 163 | |
| 164 | type record OsmuxemConfig { |
| 165 | INT3b batch_size, |
| 166 | integer tx_duration_ms, |
| 167 | octetstring tx_fixed_payload optional, |
| 168 | octetstring rx_fixed_payload optional |
| 169 | }; |
| 170 | |
| 171 | const OsmuxemConfig c_OsmuxemDefaultCfg := { |
| 172 | batch_size := 4, |
| 173 | tx_duration_ms := 20 * 4, /* 4 is batch_size */ |
| 174 | tx_fixed_payload := '010203040102030401020304010203040102030401020304'O, |
| 175 | rx_fixed_payload := '010203040102030401020304010203040102030401020304'O |
| 176 | } |
| 177 | |
| 178 | signature OsmuxEM_bind(in HostName local_host, inout PortNumber local_port); |
| 179 | signature OsmuxEM_connect(in HostName remote_host, in PortNumber remote_port); |
| 180 | signature OsmuxEM_mode(in OsmuxemMode mode); |
| 181 | signature OsmuxEM_configure(in OsmuxemConfig cfg); |
| 182 | signature OsmuxEM_stats_get(out OsmuxemStats stats); |
| 183 | signature OsmuxEM_register_rxhandle(in OsmuxRxHandle hdl); |
| 184 | signature OsmuxEM_register_txhandle(in OsmuxTxHandle hdl); |
| 185 | |
| 186 | type port OsmuxEM_CTRL_PT procedure { |
| 187 | inout OsmuxEM_bind, OsmuxEM_connect, OsmuxEM_mode, OsmuxEM_configure, |
| 188 | OsmuxEM_stats_get, OsmuxEM_register_rxhandle, OsmuxEM_register_txhandle; |
| 189 | } with { extension "internal" }; |
| 190 | |
| 191 | function f_osmuxem_bind(OsmuxEM_CTRL_PT pt, in HostName local_host, inout PortNumber local_port) { |
| 192 | pt.call(OsmuxEM_bind:{local_host, local_port}) { |
| 193 | [] pt.getreply(OsmuxEM_bind:{local_host, ?}) -> param (local_port) {}; |
| 194 | } |
| 195 | } |
| 196 | function f_osmuxem_connect(OsmuxEM_CTRL_PT pt, in HostName remote_host, in PortNumber remote_port) { |
| 197 | pt.call(OsmuxEM_connect:{remote_host, remote_port}) { |
| 198 | [] pt.getreply(OsmuxEM_connect:{remote_host, remote_port}) {}; |
| 199 | } |
| 200 | } |
| 201 | function f_osmuxem_mode(OsmuxEM_CTRL_PT pt, in OsmuxemMode mode) { |
| 202 | pt.call(OsmuxEM_mode:{mode}) { |
| 203 | [] pt.getreply(OsmuxEM_mode:{mode}) {}; |
| 204 | } |
| 205 | } |
| 206 | function f_osmuxem_configure(OsmuxEM_CTRL_PT pt, in OsmuxemConfig cfg) { |
| 207 | pt.call(OsmuxEM_configure:{cfg}) { |
| 208 | [] pt.getreply(OsmuxEM_configure:{cfg}) {}; |
| 209 | } |
| 210 | } |
| 211 | function f_osmuxem_stats_get(OsmuxEM_CTRL_PT pt) return OsmuxemStats { |
| 212 | var OsmuxemStats stats; |
| 213 | pt.call(OsmuxEM_stats_get:{-}) { |
| 214 | [] pt.getreply(OsmuxEM_stats_get:{?}) -> param(stats) {}; |
| 215 | } |
| 216 | return stats; |
| 217 | } |
| 218 | |
| 219 | function f_osmuxem_register_rxhandle(OsmuxEM_CTRL_PT pt, OsmuxRxHandle hdl) { |
| 220 | pt.call(OsmuxEM_register_rxhandle:{hdl}) { |
| 221 | [] pt.getreply(OsmuxEM_register_rxhandle:{hdl}) {}; |
| 222 | } |
| 223 | } |
| 224 | |
| 225 | function f_osmuxem_register_txhandle(OsmuxEM_CTRL_PT pt, OsmuxTxHandle hdl) { |
| 226 | pt.call(OsmuxEM_register_txhandle:{hdl}) { |
| 227 | [] pt.getreply(OsmuxEM_register_txhandle:{hdl}) {}; |
| 228 | } |
| 229 | } |
| 230 | |
| 231 | |
| 232 | function f_osmuxem_stats_compare_value(integer a, integer b, integer tolerance := 0) return boolean { |
| 233 | var integer temp; |
| 234 | |
| 235 | temp := (a - b) |
| 236 | if (temp < 0) { |
| 237 | temp := -temp; |
| 238 | } |
| 239 | |
| 240 | if (temp > tolerance) { |
| 241 | return false; |
| 242 | } |
| 243 | |
| 244 | return true; |
| 245 | } |
| 246 | |
| 247 | /* Cross-compare two osmuxem-statistics. The transmission statistics on the a side |
| 248 | * must match the reception statistics on the other side and vice versa. The |
| 249 | * user may also supply a tolerance value (number of packets) when deviations |
| 250 | * are acceptable */ |
| 251 | function f_osmuxem_stats_compare(OsmuxemStats a, OsmuxemStats b, integer tolerance := 0) return boolean { |
| 252 | var integer plen; |
| 253 | |
| 254 | log("stats A: ", a); |
| 255 | log("stats B: ", b); |
| 256 | log("tolerance: ", tolerance, " packets"); |
| 257 | |
| 258 | if (f_osmuxem_stats_compare_value(a.num_pkts_tx, b.num_pkts_rx, tolerance) == false) { |
| 259 | return false; |
| 260 | } |
| 261 | |
| 262 | if (f_osmuxem_stats_compare_value(a.num_pkts_rx, b.num_pkts_tx, tolerance) == false) { |
| 263 | return false; |
| 264 | } |
| 265 | |
| 266 | if(a.num_pkts_tx > 0) { |
| 267 | plen := a.bytes_payload_tx / a.num_pkts_tx; |
| 268 | } else { |
| 269 | plen := 0; |
| 270 | } |
| 271 | |
| 272 | if (f_osmuxem_stats_compare_value(a.bytes_payload_tx, b.bytes_payload_rx, tolerance * plen) == false) { |
| 273 | return false; |
| 274 | } |
| 275 | |
| 276 | if (f_osmuxem_stats_compare_value(a.bytes_payload_rx, b.bytes_payload_tx, tolerance * plen) == false) { |
| 277 | return false; |
| 278 | } |
| 279 | |
| 280 | return true; |
| 281 | } |
| 282 | |
| 283 | /* Check the statistics for general signs of errors. This is a basic general |
| 284 | * check that will fit most situations and is intended to be executed by |
| 285 | * the testcases as as needed. */ |
| 286 | function f_osmuxem_stats_err_check(OsmuxemStats s) { |
| 287 | log("stats: ", s); |
| 288 | |
| 289 | /* Check if there was some activity at either on the RX or on the |
| 290 | * TX side, but complete silence would indicate some problem */ |
| 291 | if (s.num_pkts_tx < 1 and s.num_pkts_rx < 1) { |
| 292 | setverdict(fail, "no Osmux packet activity detected (packets)"); |
| 293 | mtc.stop; |
| 294 | } |
| 295 | if (s.bytes_payload_tx < 1 and s.bytes_payload_rx < 1) { |
| 296 | setverdict(fail, "no Osmux packet activity detected (bytes)"); |
| 297 | mtc.stop; |
| 298 | } |
| 299 | |
| 300 | /* Check error counters */ |
| 301 | if (s.num_pkts_rx_err_seq != 0) { |
| 302 | setverdict(fail, "Osmux packet sequence number errors occurred"); |
| 303 | mtc.stop; |
| 304 | } |
| 305 | if (s.num_pkts_rx_err_disabled != 0) { |
| 306 | setverdict(fail, "Osmux packets received while RX was disabled"); |
| 307 | mtc.stop; |
| 308 | } |
| 309 | if (s.num_pkts_rx_err_payload != 0) { |
| 310 | setverdict(fail, "Osmux packets with mismatching payload received"); |
| 311 | mtc.stop; |
| 312 | } |
| 313 | } |
| 314 | |
| 315 | template PDU_Osmux_AMR ts_OsmuxAMR(BIT1 marker, INT3b ctr, BIT1 amr_f, BIT1 amr_q, INT1 seq, |
| 316 | OsmuxCID cid, INT4b amr_ft, INT4b amr_cmr, |
| 317 | octetstring payload) := { |
| 318 | header := { |
| 319 | marker := marker, |
| 320 | ft := 1, |
| 321 | ctr := ctr, |
| 322 | amr_f := amr_f, |
| 323 | amr_q := amr_q, |
| 324 | seq := seq, |
| 325 | cid := cid, |
| 326 | amr_ft := amr_ft, |
| 327 | amr_cmr := amr_cmr |
| 328 | }, |
| 329 | data := payload |
| 330 | } |
| 331 | |
| 332 | private function f_rxhandle_get_by_cid(OsmuxCID cid) runs on OSMUX_Emulation_CT return OsmuxRxHandle { |
| 333 | var integer i; |
| 334 | for (i := 0; i < sizeof(RxHandleTable); i := i+1) { |
| 335 | if (isbound(RxHandleTable[i].cid) and RxHandleTable[i].cid == cid) { |
| 336 | return RxHandleTable[i].vc_conn; |
| 337 | } |
| 338 | } |
| 339 | setverdict(fail, "No Component for CID ", cid); |
| 340 | mtc.stop; |
| 341 | } |
| 342 | |
| 343 | private function f_rxhandle_cid_add(OsmuxRxHandle hdl) runs on OSMUX_Emulation_CT { |
| 344 | var integer i; |
| 345 | for (i := 0; i < sizeof(RxHandleTable); i := i+1) { |
| 346 | if (not isbound(RxHandleTable[i].cid)) { |
| 347 | RxHandleTable[i].cid := hdl.cid; |
| 348 | RxHandleTable[i].vc_conn := hdl; |
| 349 | return; |
| 350 | } |
| 351 | } |
| 352 | testcase.stop("No Space in RxHandleTable for ", hdl.cid); |
| 353 | mtc.stop; |
| 354 | } |
| 355 | |
| 356 | private function f_txhandle_cid_add(OsmuxTxHandle hdl) runs on OSMUX_Emulation_CT { |
| 357 | var integer i; |
| 358 | for (i := 0; i < sizeof(TxHandleList); i := i+1) { |
| 359 | if (not isbound(TxHandleList[i])) { |
| 360 | TxHandleList[i] := hdl; |
| 361 | return; |
| 362 | } |
| 363 | } |
| 364 | testcase.stop("No Space in TxHandleList for ", hdl.cid); |
| 365 | mtc.stop; |
| 366 | } |
| 367 | |
| 368 | function f_osmux_gen_expected_rx_rtp_payload(INT4b amr_ft, octetstring tx_fixed_payload) return octetstring { |
| 369 | var integer payload_len; |
| 370 | var octetstring payload_truncated; |
| 371 | var integer i; |
| 372 | payload_len := f_amrft_payload_len(amr_ft); |
| 373 | payload_truncated := substr(tx_fixed_payload, 0, payload_len); |
| 374 | return payload_truncated; |
| 375 | } |
| 376 | |
| 377 | private function f_osmux_gen_payload(INT3b ctr, INT4b amr_ft) runs on OSMUX_Emulation_CT return octetstring { |
| 378 | var octetstring payload_truncated := ''O; |
| 379 | var integer i; |
| 380 | |
| 381 | for (i := 0; i < ctr + 1; i := i+1) { |
| 382 | payload_truncated := payload_truncated & f_osmux_gen_expected_rx_rtp_payload(amr_ft, g_cfg.tx_fixed_payload); |
| 383 | } |
| 384 | return payload_truncated; |
| 385 | } |
| 386 | |
| 387 | private function f_tx_osmux(integer i, INT3b ctr, octetstring payload, BIT1 marker := '0'B) runs on OSMUX_Emulation_CT { |
| 388 | var OsmuxTxHandle hdl := TxHandleList[i]; |
| 389 | var PDU_Osmux_AMR osmux_amr := valueof(ts_OsmuxAMR(marker, ctr, hdl.amr_f, |
| 390 | hdl.amr_q, hdl.seq, hdl.cid, hdl.amr_ft, |
| 391 | hdl.amr_cmr, payload)); |
| 392 | OSMUX.send(t_Osmux_Send(g_osmux_conn_id, OSMUX_PDU:{osmux_amr:=osmux_amr})); |
| 393 | /* increment sequence + timestamp for next transmit */ |
| 394 | TxHandleList[i].seq := TxHandleList[i].seq + 1; |
| 395 | |
| 396 | /* update counters */ |
| 397 | g_stat.num_pkts_tx := g_stat.num_pkts_tx+1; |
| 398 | g_stat.bytes_payload_tx := g_stat.bytes_payload_tx + |
| 399 | lengthof(payload); |
| 400 | } |
| 401 | |
| 402 | private function f_tx_osmux_all_cid(BIT1 marker := '0'B) runs on OSMUX_Emulation_CT { |
| 403 | /* TODO: append all in one UDP packet and send together */ |
| 404 | var integer i; |
| 405 | var octetstring payload_truncated; |
| 406 | var INT3b ctr := g_cfg.batch_size - 1; |
| 407 | |
| 408 | for (i := 0; i < sizeof(TxHandleList); i := i+1) { |
| 409 | if (isbound(TxHandleList[i])) { |
| 410 | payload_truncated := f_osmux_gen_payload(ctr, TxHandleList[i].amr_ft); |
| 411 | f_tx_osmux(i, ctr, payload_truncated, marker); |
| 412 | |
| 413 | } |
| 414 | } |
| 415 | } |
| 416 | |
| 417 | function f_main() runs on OSMUX_Emulation_CT |
| 418 | { |
| 419 | var Result res; |
| 420 | var OsmuxRxHandle rx_hdl; |
| 421 | var OsmuxTxHandle tx_hdl; |
| 422 | var octetstring payload_truncated; |
| 423 | |
| 424 | timer T_transmit := int2float(g_cfg.tx_duration_ms)/1000.0; |
| 425 | var Osmux_RecvFrom rx_osmux; |
| 426 | var PDU_Osmux_AMR rx_amr; |
| 427 | var PDU_Osmux_DUMMY osmux_dummy; |
| 428 | var OsmuxemConfig cfg; |
| 429 | var template Osmux_RecvFrom tr_osmux_amr := { |
| 430 | connId := ?, |
| 431 | remName := ?, |
| 432 | remPort := ?, |
| 433 | locName := ?, |
| 434 | locPort := ?, |
| 435 | msg := ? |
| 436 | }; |
| 437 | tr_osmux_amr.msg := { osmux_amr := ? }; |
| 438 | var template Osmux_RecvFrom tr_osmux_dummy := { |
| 439 | connId := ?, |
| 440 | remName := ?, |
| 441 | remPort := ?, |
| 442 | locName := ?, |
| 443 | locPort := ?, |
| 444 | msg := ? |
| 445 | }; |
| 446 | tr_osmux_dummy.msg := { osmux_dummy := ? }; |
| 447 | |
| 448 | while (true) { |
| 449 | alt { |
| 450 | /* control procedures (calls) from the user */ |
| 451 | [] CTRL.getcall(OsmuxEM_bind:{?,?}) -> param(g_local_host, g_local_port) { |
| 452 | |
| 453 | 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] | 454 | |
| 455 | if (g_osmux_conn_id != -1) { |
| 456 | res := OSMUX_CodecPort_CtrlFunct.f_IPL4_close(OSMUX, g_osmux_conn_id, {udp := {}}); |
| 457 | g_osmux_conn_id := -1; |
| 458 | } |
Pau Espin Pedrol | b2c6b38 | 2019-05-14 13:40:49 +0200 | [diff] [blame] | 459 | res := OSMUX_CodecPort_CtrlFunct.f_IPL4_listen(OSMUX, g_local_host, |
| 460 | g_local_port, {udp:={}}); |
| 461 | if (not ispresent(res.connId)) { |
| 462 | setverdict(fail, "Could not listen on Osmux socket, check your configuration"); |
| 463 | mtc.stop; |
| 464 | } |
| 465 | g_osmux_conn_id := res.connId; |
| 466 | tr_osmux_amr.connId := g_osmux_conn_id; |
| 467 | tr_osmux_dummy.connId := g_osmux_conn_id; |
| 468 | |
| 469 | CTRL.reply(OsmuxEM_bind:{g_local_host, g_local_port}); |
| 470 | } |
| 471 | [] CTRL.getcall(OsmuxEM_connect:{?,?}) -> param (g_remote_host, g_remote_port) { |
| 472 | res := OSMUX_CodecPort_CtrlFunct.f_IPL4_connect(OSMUX, g_remote_host, |
| 473 | g_remote_port, |
| 474 | g_local_host, g_local_port, |
| 475 | g_osmux_conn_id, {udp:={}}); |
| 476 | if (not ispresent(res.connId)) { |
| 477 | setverdict(fail, "Could not connect to Osmux socket, check your configuration"); |
| 478 | mtc.stop; |
| 479 | } |
| 480 | g_tx_connected := true; |
| 481 | CTRL.reply(OsmuxEM_connect:{g_remote_host, g_remote_port}); |
| 482 | } |
| 483 | [] CTRL.getcall(OsmuxEM_mode:{OSMUXEM_MODE_NONE}) { |
| 484 | T_transmit.stop; |
| 485 | g_rx_enabled := false; |
| 486 | CTRL.reply(OsmuxEM_mode:{OSMUXEM_MODE_NONE}); |
| 487 | } |
| 488 | [] CTRL.getcall(OsmuxEM_mode:{OSMUXEM_MODE_TXONLY}) { |
| 489 | /* start transmit timer */ |
| 490 | T_transmit.start; |
| 491 | g_rx_enabled := false; |
| 492 | CTRL.reply(OsmuxEM_mode:{OSMUXEM_MODE_TXONLY}); |
| 493 | } |
| 494 | [] CTRL.getcall(OsmuxEM_mode:{OSMUXEM_MODE_RXONLY}) { |
| 495 | |
| 496 | T_transmit.stop; |
| 497 | if (g_rx_enabled == false) { |
| 498 | /* flush queues */ |
| 499 | OSMUX.clear; |
| 500 | g_rx_enabled := true; |
| 501 | } |
| 502 | CTRL.reply(OsmuxEM_mode:{OSMUXEM_MODE_RXONLY}); |
| 503 | } |
| 504 | [] CTRL.getcall(OsmuxEM_mode:{OSMUXEM_MODE_BIDIR}) { |
| 505 | T_transmit.start; |
| 506 | if (g_rx_enabled == false) { |
| 507 | /* flush queues */ |
| 508 | OSMUX.clear; |
| 509 | g_rx_enabled := true; |
| 510 | } |
| 511 | CTRL.reply(OsmuxEM_mode:{OSMUXEM_MODE_BIDIR}); |
| 512 | } |
| 513 | [] CTRL.getcall(OsmuxEM_configure:{?}) -> param (cfg) { |
| 514 | g_cfg := cfg; |
| 515 | CTRL.reply(OsmuxEM_configure:{cfg}); |
| 516 | } |
| 517 | [] CTRL.getcall(OsmuxEM_register_txhandle:{?}) -> param (tx_hdl) { |
| 518 | f_txhandle_cid_add(tx_hdl); |
| 519 | CTRL.reply(OsmuxEM_register_txhandle:{tx_hdl}); |
| 520 | } |
| 521 | [] CTRL.getcall(OsmuxEM_register_rxhandle:{?}) -> param (rx_hdl) { |
| 522 | f_rxhandle_cid_add(rx_hdl); |
| 523 | CTRL.reply(OsmuxEM_register_rxhandle:{rx_hdl}); |
| 524 | } |
| 525 | [] CTRL.getcall(OsmuxEM_stats_get:{?}) { |
| 526 | CTRL.reply(OsmuxEM_stats_get:{g_stat}); |
| 527 | } |
| 528 | |
| 529 | /* simply ignore any Osmux AMR if receiver not enabled */ |
| 530 | [g_rx_enabled==false] OSMUX.receive(tr_osmux_amr) { |
| 531 | g_stat.num_pkts_rx_err_disabled := g_stat.num_pkts_rx_err_disabled+1; |
| 532 | } |
| 533 | /* simply ignore any Osmux Dummy if receiver not enabled */ |
| 534 | [g_rx_enabled==false] OSMUX.receive(tr_osmux_dummy) -> value rx_osmux { |
| 535 | log("Osmux Dummy received on CID ", rx_osmux.msg.osmux_dummy.header.cid, " (rx_disabled)"); |
| 536 | } |
| 537 | |
| 538 | /* process received Osmux AMR if receiver enabled */ |
| 539 | [g_rx_enabled] OSMUX.receive(tr_osmux_amr) -> value rx_osmux { |
| 540 | /* increment counters */ |
| 541 | g_stat.num_pkts_rx := g_stat.num_pkts_rx+1; |
| 542 | g_stat.bytes_payload_rx := g_stat.bytes_payload_rx + |
| 543 | lengthof(rx_osmux.msg.osmux_amr.data); |
| 544 | rx_hdl := f_rxhandle_get_by_cid(rx_osmux.msg.osmux_amr.header.cid); |
| 545 | |
| 546 | if (rx_hdl.first_seq_seen and rx_hdl.last_seq_ack != rx_osmux.msg.osmux_amr.header.seq - 1 ) { |
| 547 | g_stat.num_pkts_rx_err_seq := g_stat.num_pkts_rx_err_seq + 1; |
| 548 | } |
| 549 | rx_hdl.first_seq_seen := true; |
| 550 | rx_hdl.last_seq_ack := rx_osmux.msg.osmux_amr.header.seq; |
| 551 | |
| 552 | payload_truncated := f_osmux_gen_payload(rx_osmux.msg.osmux_amr.header.ctr, rx_osmux.msg.osmux_amr.header.amr_ft); |
| 553 | if (ispresent(g_cfg.rx_fixed_payload) and rx_osmux.msg.osmux_amr.data != payload_truncated) { |
| 554 | g_stat.num_pkts_rx_err_payload := g_stat.num_pkts_rx_err_payload + 1; |
| 555 | } |
| 556 | } |
| 557 | /* process received Osmux Dummy if receiver enabled */ |
| 558 | [g_rx_enabled] OSMUX.receive(tr_osmux_dummy) -> value rx_osmux { |
| 559 | log("Osmux Dummy received on CID", rx_osmux.msg.osmux_dummy.header.cid); |
| 560 | rx_hdl := f_rxhandle_get_by_cid(rx_osmux.msg.osmux_dummy.header.cid); |
| 561 | } |
| 562 | |
| 563 | /* transmit if timer has expired */ |
| 564 | [g_tx_connected] T_transmit.timeout { |
| 565 | /* send one Osmux frame, re-start timer */ |
| 566 | f_tx_osmux_all_cid(); |
| 567 | T_transmit.start; |
| 568 | } |
| 569 | |
| 570 | /* fail on any unexpected messages */ |
| 571 | [] OSMUX.receive { |
| 572 | setverdict(fail, "Received unexpected type from Osmux"); |
| 573 | mtc.stop; |
| 574 | } |
| 575 | } |
| 576 | } |
| 577 | } |
| 578 | |
| 579 | |
| 580 | } |