Harald Welte | 28d943e | 2017-11-25 15:00:50 +0100 | [diff] [blame] | 1 | module MSC_ConnectionHandler { |
| 2 | |
| 3 | import from General_Types all; |
| 4 | import from Osmocom_Types all; |
Harald Welte | c1a2fff | 2017-12-17 11:06:19 +0100 | [diff] [blame] | 5 | import from GSM_Types all; |
Harald Welte | 28d943e | 2017-11-25 15:00:50 +0100 | [diff] [blame] | 6 | import from SCCPasp_Types all; |
| 7 | import from BSSAP_Types all; |
| 8 | import from BSSMAP_Emulation all; |
| 9 | import from BSSMAP_Templates all; |
| 10 | |
Harald Welte | 211219e | 2018-01-29 22:03:36 +0100 | [diff] [blame] | 11 | import from IPL4asp_Types all; |
| 12 | import from Native_Functions all; |
| 13 | |
Harald Welte | 28d943e | 2017-11-25 15:00:50 +0100 | [diff] [blame] | 14 | import from MGCP_Types all; |
| 15 | import from MGCP_Templates all; |
Daniel Willmann | 191e0d9 | 2018-01-17 12:44:35 +0100 | [diff] [blame] | 16 | import from MGCP_Emulation all; |
Harald Welte | 28d943e | 2017-11-25 15:00:50 +0100 | [diff] [blame] | 17 | import from SDP_Types all; |
| 18 | |
Harald Welte | c1a2fff | 2017-12-17 11:06:19 +0100 | [diff] [blame] | 19 | import from RSL_Emulation all; |
| 20 | import from RSL_Types all; |
| 21 | |
| 22 | import from MobileL3_Types all; |
| 23 | import from MobileL3_CommonIE_Types all; |
Harald Welte | 211219e | 2018-01-29 22:03:36 +0100 | [diff] [blame] | 24 | import from MobileL3_RRM_Types all; |
Harald Welte | c1a2fff | 2017-12-17 11:06:19 +0100 | [diff] [blame] | 25 | import from L3_Templates all; |
| 26 | |
Harald Welte | c20b1c4 | 2018-02-12 20:50:08 +0100 | [diff] [blame^] | 27 | import from TELNETasp_PortType all; |
| 28 | import from Osmocom_VTY_Functions all; |
| 29 | |
Harald Welte | c1a2fff | 2017-12-17 11:06:19 +0100 | [diff] [blame] | 30 | |
Harald Welte | 211219e | 2018-01-29 22:03:36 +0100 | [diff] [blame] | 31 | /*********************************************************************** |
| 32 | * Media related handling |
| 33 | ***********************************************************************/ |
| 34 | |
| 35 | /* Tuple containing host/ip and port */ |
| 36 | type record HostPort { |
| 37 | HostName host, |
| 38 | PortNumber port_nr |
| 39 | }; |
| 40 | |
| 41 | /* State encapsulating one MGCP Connection */ |
| 42 | type record MgcpConnState { |
| 43 | boolean crcx_seen, |
| 44 | MgcpConnectionId conn_id, |
| 45 | charstring mime_type, /* e.g. AMR */ |
| 46 | integer sample_rate, /* 8000 */ |
| 47 | integer ptime, /* 20 */ |
| 48 | uint7_t rtp_pt, /* RTP Payload Type */ |
| 49 | HostPort mgw, /* MGW side */ |
| 50 | HostPort peer /* CA side */ |
| 51 | }; |
| 52 | |
| 53 | /* BTS media state */ |
| 54 | type record BtsMediaState { |
| 55 | boolean ipa_crcx_seen, |
| 56 | uint16_t conn_id, |
| 57 | uint7_t rtp_pt, |
| 58 | HostPort bts, |
| 59 | HostPort peer |
| 60 | }; |
| 61 | |
| 62 | type record MediaState { |
| 63 | MgcpEndpoint mgcp_ep, |
| 64 | MgcpConnState mgcp_conn[2], |
| 65 | BtsMediaState bts |
| 66 | }; |
| 67 | |
| 68 | function f_MediaState_init(inout MediaState g_media, integer nr, HostName bts, HostName mgw) { |
| 69 | /* BTS Side */ |
| 70 | g_media.bts := { |
| 71 | ipa_crcx_seen := false, |
| 72 | conn_id := nr, |
| 73 | rtp_pt := 0, |
| 74 | bts := { |
| 75 | host := bts, |
| 76 | port_nr := 9000 + nr*2 |
| 77 | }, |
| 78 | peer := - |
| 79 | } |
| 80 | |
Harald Welte | 363cb0a | 2018-01-30 19:35:53 +0100 | [diff] [blame] | 81 | g_media.mgcp_ep := "rtpbridge/" & int2str(nr) & "@mgw"; |
Harald Welte | 211219e | 2018-01-29 22:03:36 +0100 | [diff] [blame] | 82 | |
| 83 | for (var integer i:= 0; i < sizeof(g_media.mgcp_conn); i := i+1) { |
| 84 | g_media.mgcp_conn[i].mime_type := "AMR"; |
| 85 | g_media.mgcp_conn[i].sample_rate := 8000; |
| 86 | g_media.mgcp_conn[i].ptime := 20; |
| 87 | g_media.mgcp_conn[i].rtp_pt := 98; |
| 88 | g_media.mgcp_conn[i].crcx_seen := false; |
| 89 | g_media.mgcp_conn[i].conn_id := f_mgcp_alloc_conn_id(); |
| 90 | } |
| 91 | |
| 92 | g_media.mgcp_conn[0].mgw := { |
| 93 | host := mgw, |
| 94 | port_nr := 10000 + nr*2 |
| 95 | } |
| 96 | g_media.mgcp_conn[1].mgw := { |
| 97 | host := mgw, |
| 98 | port_nr := 11000 + nr*2 |
| 99 | } |
| 100 | } |
| 101 | |
| 102 | private function f_get_free_mgcp_conn() runs on MSC_ConnHdlr return integer { |
| 103 | for (var integer i:= 0; i < sizeof(g_media.mgcp_conn); i := i+1) { |
| 104 | if (not g_media.mgcp_conn[i].crcx_seen) { |
| 105 | return i; |
| 106 | } |
| 107 | } |
| 108 | setverdict(fail, "Only 2 Connections per EP!"); |
| 109 | self.stop; |
| 110 | return -1; |
| 111 | } |
| 112 | |
| 113 | private function f_get_mgcp_conn(MgcpConnectionId cid) runs on MSC_ConnHdlr return integer { |
| 114 | for (var integer i:= 0; i < sizeof(g_media.mgcp_conn); i := i+1) { |
| 115 | if (g_media.mgcp_conn[i].conn_id == cid and g_media.mgcp_conn[i].crcx_seen) { |
| 116 | return i; |
| 117 | } |
| 118 | } |
| 119 | setverdict(fail, "No Connection for ID ", cid); |
| 120 | self.stop; |
| 121 | return -1; |
| 122 | } |
| 123 | |
| 124 | |
| 125 | /* altstep for handling of IPA + MGCP media related commands. Can be activated by a given |
| 126 | * test case if it expects to see media related handling (i.e. voice calls */ |
| 127 | altstep as_Media() runs on MSC_ConnHdlr { |
| 128 | var RSL_Message rsl; |
| 129 | var MgcpCommand mgcp_cmd; |
| 130 | var RSL_IE_Body ie; |
| 131 | [not g_media.bts.ipa_crcx_seen] RSL.receive(tr_RSL_IPA_CRCX(g_chan_nr)) -> value rsl { |
| 132 | /* Extract parameters from request + use in response */ |
| 133 | if (f_rsl_find_ie(rsl, RSL_IE_IPAC_RTP_PAYLOAD, ie)) { |
| 134 | g_media.bts.rtp_pt := ie.ipa_rtp_pt; |
| 135 | } |
| 136 | if (f_rsl_find_ie(rsl, RSL_IE_IPAC_RTP_PAYLOAD2, ie)) { |
| 137 | g_media.bts.rtp_pt := ie.ipa_rtp_pt2; |
| 138 | } |
| 139 | RSL.send(ts_RSL_IPA_CRCX_ACK(g_chan_nr, g_media.bts.conn_id, |
| 140 | oct2int(f_inet_addr(g_media.bts.bts.host)), |
| 141 | g_media.bts.bts.port_nr, |
| 142 | g_media.bts.rtp_pt)); |
| 143 | g_media.bts.ipa_crcx_seen := true; |
| 144 | repeat; |
| 145 | } |
| 146 | [g_media.bts.ipa_crcx_seen] RSL.receive(tr_RSL_IPA_MDCX(g_chan_nr, ?)) -> value rsl{ |
| 147 | /* Extract conn_id, ip, port, rtp_pt2 from request + use in response */ |
| 148 | f_rsl_find_ie(rsl, RSL_IE_IPAC_CONN_ID, ie); |
| 149 | if (g_media.bts.conn_id != ie.ipa_conn_id) { |
| 150 | setverdict(fail, "IPA MDCX for unknown ConnId", rsl); |
| 151 | self.stop; |
| 152 | } |
| 153 | /* mandatory */ |
| 154 | f_rsl_find_ie(rsl, RSL_IE_IPAC_REMOTE_IP, ie); |
| 155 | g_media.bts.peer.host := f_inet_ntoa(int2oct(ie.ipa_remote_ip, 4)); |
| 156 | f_rsl_find_ie(rsl, RSL_IE_IPAC_REMOTE_PORT, ie); |
| 157 | g_media.bts.peer.port_nr := ie.ipa_remote_port; |
| 158 | /* optional */ |
| 159 | if (f_rsl_find_ie(rsl, RSL_IE_IPAC_RTP_PAYLOAD, ie)) { |
| 160 | g_media.bts.rtp_pt := ie.ipa_rtp_pt; |
| 161 | } |
| 162 | if (f_rsl_find_ie(rsl, RSL_IE_IPAC_RTP_PAYLOAD2, ie)) { |
| 163 | g_media.bts.rtp_pt := ie.ipa_rtp_pt2; |
| 164 | } |
| 165 | RSL.send(ts_RSL_IPA_MDCX_ACK(g_chan_nr, g_media.bts.conn_id, |
| 166 | oct2int(f_inet_addr(g_media.bts.peer.host)), |
| 167 | g_media.bts.peer.port_nr, |
| 168 | g_media.bts.rtp_pt)); |
| 169 | //g_media.ipa_mdcx_seen := true; |
| 170 | repeat; |
| 171 | } |
| 172 | [] MGCP.receive(tr_CRCX) -> value mgcp_cmd { |
| 173 | var SDP_Message sdp; |
| 174 | var integer cid := f_get_free_mgcp_conn(); |
Harald Welte | 363cb0a | 2018-01-30 19:35:53 +0100 | [diff] [blame] | 175 | if (match(mgcp_cmd.line.ep, t_MGCP_EP_wildcard)) { |
| 176 | if (cid != 0) { |
| 177 | setverdict(fail, "MGCP wildcard EP only works in first CRCX"); |
| 178 | self.stop; |
| 179 | } |
| 180 | /* we keep the endpoint name allocated during MediaState_init */ |
| 181 | } else { |
| 182 | /* Call Agent allocated endpoint, trust/use it always */ |
| 183 | g_media.mgcp_ep := mgcp_cmd.line.ep; |
| 184 | } |
Harald Welte | 211219e | 2018-01-29 22:03:36 +0100 | [diff] [blame] | 185 | if (isvalue(mgcp_cmd.sdp)) { |
| 186 | sdp := mgcp_cmd.sdp; |
| 187 | g_media.mgcp_conn[cid].peer.host := sdp.connection.conn_addr.addr; |
| 188 | g_media.mgcp_conn[cid].peer.port_nr := sdp.media_list[0].media_field.ports.port_number; |
| 189 | } |
| 190 | var MgcpConnState mgcp_conn := g_media.mgcp_conn[cid]; |
| 191 | sdp := valueof(ts_SDP(mgcp_conn.mgw.host, mgcp_conn.mgw.host, "foo", "21", |
| 192 | mgcp_conn.mgw.port_nr, { int2str(mgcp_conn.rtp_pt) }, |
| 193 | {valueof(ts_SDP_rtpmap(mgcp_conn.rtp_pt, |
| 194 | mgcp_conn.mime_type & "/" & |
| 195 | int2str(mgcp_conn.sample_rate))), |
| 196 | valueof(ts_SDP_ptime(mgcp_conn.ptime)) } )); |
Harald Welte | 363cb0a | 2018-01-30 19:35:53 +0100 | [diff] [blame] | 197 | var template MgcpResponse mgcp_resp; |
| 198 | mgcp_resp := ts_CRCX_ACK(mgcp_cmd.line.trans_id, mgcp_conn.conn_id, sdp); |
| 199 | f_mgcp_par_append(mgcp_resp.params, ts_MgcpParSpecEP(g_media.mgcp_ep)); |
| 200 | MGCP.send(mgcp_resp); |
Harald Welte | 211219e | 2018-01-29 22:03:36 +0100 | [diff] [blame] | 201 | g_media.mgcp_conn[cid].crcx_seen := true; |
| 202 | repeat; |
| 203 | } |
| 204 | [] MGCP.receive(tr_MDCX) -> value mgcp_cmd { |
| 205 | var SDP_Message sdp; |
| 206 | var integer cid := f_get_mgcp_conn(f_MgcpCmd_extract_conn_id(mgcp_cmd)); |
| 207 | if (isvalue(mgcp_cmd.sdp)) { |
| 208 | sdp := mgcp_cmd.sdp; |
| 209 | g_media.mgcp_conn[cid].peer.host := sdp.connection.conn_addr.addr; |
| 210 | g_media.mgcp_conn[cid].peer.port_nr := sdp.media_list[0].media_field.ports.port_number; |
| 211 | } else { |
| 212 | setverdict(fail, "MDCX has no [recognizable] SDP"); |
Harald Welte | 211219e | 2018-01-29 22:03:36 +0100 | [diff] [blame] | 213 | } |
| 214 | var MgcpConnState mgcp_conn := g_media.mgcp_conn[cid]; |
| 215 | sdp := valueof(ts_SDP(mgcp_conn.peer.host, mgcp_conn.peer.host, "foo", "21", |
| 216 | mgcp_conn.peer.port_nr, { int2str(mgcp_conn.rtp_pt) }, |
| 217 | {valueof(ts_SDP_rtpmap(mgcp_conn.rtp_pt, |
| 218 | mgcp_conn.mime_type & "/" & |
| 219 | int2str(mgcp_conn.sample_rate))), |
| 220 | valueof(ts_SDP_ptime(mgcp_conn.ptime)) } )); |
| 221 | MGCP.send(ts_MDCX_ACK(mgcp_cmd.line.trans_id, mgcp_conn.conn_id, sdp)); |
| 222 | //mgcp_mdcx_seen := true; |
| 223 | repeat; |
| 224 | } |
| 225 | } |
| 226 | |
| 227 | |
| 228 | |
| 229 | |
Harald Welte | 28d943e | 2017-11-25 15:00:50 +0100 | [diff] [blame] | 230 | /* this component represents a single subscriber connection at the MSC. |
| 231 | * There is a 1:1 mapping between SCCP connections and BSSAP_ConnHdlr components. |
| 232 | * We inherit all component variables, ports, functions, ... from BSSAP_ConnHdlr */ |
Daniel Willmann | 191e0d9 | 2018-01-17 12:44:35 +0100 | [diff] [blame] | 233 | type component MSC_ConnHdlr extends BSSAP_ConnHdlr, RSL_DchanHdlr, MGCP_ConnHdlr { |
Harald Welte | 28d943e | 2017-11-25 15:00:50 +0100 | [diff] [blame] | 234 | /* SCCP Connecction Identifier for the underlying SCCP connection */ |
| 235 | var integer g_sccp_conn_id; |
| 236 | |
Harald Welte | c1a2fff | 2017-12-17 11:06:19 +0100 | [diff] [blame] | 237 | /* procedure port back to our parent (BSSMAP_Emulation_CT) for control */ |
| 238 | port BSSMAPEM_PROC_PT BSSMAPEM; |
Harald Welte | c20b1c4 | 2018-02-12 20:50:08 +0100 | [diff] [blame^] | 239 | port TELNETasp_PT BSCVTY; |
Harald Welte | 28d943e | 2017-11-25 15:00:50 +0100 | [diff] [blame] | 240 | |
Harald Welte | 211219e | 2018-01-29 22:03:36 +0100 | [diff] [blame] | 241 | var MediaState g_media; |
| 242 | } |
| 243 | |
| 244 | /* initialize all parameters */ |
| 245 | function f_MscConnHdlr_init(integer i, HostName bts, HostName mgw) runs on MSC_ConnHdlr { |
| 246 | f_MediaState_init(g_media, i, bts, mgw); |
Harald Welte | c20b1c4 | 2018-02-12 20:50:08 +0100 | [diff] [blame^] | 247 | map(self:BSCVTY, system:BSCVTY); |
| 248 | f_vty_set_prompts(BSCVTY); |
| 249 | f_vty_transceive(BSCVTY, "enable"); |
Harald Welte | 28d943e | 2017-11-25 15:00:50 +0100 | [diff] [blame] | 250 | } |
| 251 | |
| 252 | /* Callback function from general BSSMAP_Emulation whenever a connectionless |
| 253 | * BSSMAP message arrives. Can retunr a PDU_BSSAP that should be sent in return */ |
| 254 | private function UnitdataCallback(PDU_BSSAP bssap) |
| 255 | runs on BSSMAP_Emulation_CT return template PDU_BSSAP { |
| 256 | var template PDU_BSSAP resp := omit; |
| 257 | |
Harald Welte | c1a2fff | 2017-12-17 11:06:19 +0100 | [diff] [blame] | 258 | /* answer all RESET with a RESET ACK */ |
Harald Welte | 28d943e | 2017-11-25 15:00:50 +0100 | [diff] [blame] | 259 | if (match(bssap, tr_BSSMAP_Reset)) { |
| 260 | resp := ts_BSSMAP_ResetAck; |
| 261 | } |
| 262 | |
| 263 | return resp; |
| 264 | } |
| 265 | |
| 266 | const BssmapOps MSC_BssmapOps := { |
Harald Welte | c1a2fff | 2017-12-17 11:06:19 +0100 | [diff] [blame] | 267 | create_cb := refers(BSSMAP_Emulation.ExpectedCreateCallback), |
Harald Welte | 0b47606 | 2018-01-21 19:07:32 +0100 | [diff] [blame] | 268 | unitdata_cb := refers(UnitdataCallback), |
| 269 | decode_dtap := false, |
| 270 | role_ms := false |
Harald Welte | 28d943e | 2017-11-25 15:00:50 +0100 | [diff] [blame] | 271 | } |
| 272 | |
Daniel Willmann | 191e0d9 | 2018-01-17 12:44:35 +0100 | [diff] [blame] | 273 | const MGCPOps MSC_MGCPOps := { |
| 274 | create_cb := refers(MGCP_Emulation.ExpectedCreateCallback) |
| 275 | } |
| 276 | |
Harald Welte | c1a2fff | 2017-12-17 11:06:19 +0100 | [diff] [blame] | 277 | /* register an expect with the BSSMAP core */ |
Daniel Willmann | 191e0d9 | 2018-01-17 12:44:35 +0100 | [diff] [blame] | 278 | private function f_create_bssmap_exp(octetstring l3_enc) runs on MSC_ConnHdlr { |
Harald Welte | c1a2fff | 2017-12-17 11:06:19 +0100 | [diff] [blame] | 279 | BSSMAPEM.call(BSSMAPEM_register:{l3_enc, self}) { |
| 280 | [] BSSMAPEM.getreply(BSSMAPEM_register:{?, ?}) {}; |
Harald Welte | 28d943e | 2017-11-25 15:00:50 +0100 | [diff] [blame] | 281 | } |
| 282 | } |
| 283 | |
Harald Welte | c1a2fff | 2017-12-17 11:06:19 +0100 | [diff] [blame] | 284 | type record TestHdlrParams { |
| 285 | OCT1 ra, |
| 286 | GsmFrameNumber fn, |
| 287 | hexstring imsi, |
| 288 | RslLinkId link_id |
| 289 | }; |
| 290 | |
| 291 | template (value) TestHdlrParams t_def_TestHdlrPars := { |
| 292 | ra := '23'O, |
| 293 | fn := 23, |
| 294 | imsi := '001019876543210'H, |
| 295 | link_id := valueof(ts_RslLinkID_DCCH(0)) |
| 296 | } |
| 297 | |
| 298 | function f_create_chan_and_exp(TestHdlrParams pars) runs on MSC_ConnHdlr { |
| 299 | var MobileIdentityLV mi := valueof(ts_MI_IMSI_LV(pars.imsi)); |
Harald Welte | 6ed6bf9 | 2018-01-24 21:09:15 +0100 | [diff] [blame] | 300 | var PDU_ML3_MS_NW l3_info := valueof(ts_CM_SERV_REQ(CM_TYPE_MO_CALL, mi)); |
Harald Welte | c1a2fff | 2017-12-17 11:06:19 +0100 | [diff] [blame] | 301 | var octetstring l3_enc := enc_PDU_ML3_MS_NW(l3_info); |
| 302 | |
| 303 | /* call helper function for CHAN_RQD -> IMM ASS ->EST_IND */ |
| 304 | RSL_Emulation.f_chan_est(pars.ra, l3_enc, pars.link_id, pars.fn); |
Daniel Willmann | 191e0d9 | 2018-01-17 12:44:35 +0100 | [diff] [blame] | 305 | f_create_bssmap_exp(l3_enc); |
Harald Welte | c1a2fff | 2017-12-17 11:06:19 +0100 | [diff] [blame] | 306 | } |
| 307 | |
Harald Welte | 898113b | 2018-01-31 18:32:21 +0100 | [diff] [blame] | 308 | function f_rsl_send_l3(template PDU_ML3_MS_NW l3, template (omit) RslLinkId link_id := omit, |
| 309 | template (omit) RslChannelNr chan_nr := omit) runs on MSC_ConnHdlr { |
| 310 | if (not isvalue(link_id)) { |
| 311 | link_id := ts_RslLinkID_DCCH(0); |
| 312 | } |
| 313 | if (not isvalue(chan_nr)) { |
| 314 | chan_nr := g_chan_nr; |
| 315 | } |
| 316 | RSL.send(ts_RSL_DATA_IND(valueof(chan_nr), valueof(link_id), enc_PDU_ML3_MS_NW(valueof(l3)))); |
| 317 | } |
| 318 | |
Harald Welte | c1a2fff | 2017-12-17 11:06:19 +0100 | [diff] [blame] | 319 | function f_rsl_reply(template PDU_ML3_MS_NW l3, RSL_Message orig) runs on MSC_ConnHdlr { |
| 320 | var RslChannelNr chan_nr := orig.ies[0].body.chan_nr; |
Harald Welte | 1a40de6 | 2017-12-23 02:28:34 +0100 | [diff] [blame] | 321 | var RslLinkId link_id; |
Harald Welte | 8d5eead | 2017-12-17 18:56:45 +0100 | [diff] [blame] | 322 | if (orig.msg_type == RSL_MT_ENCR_CMD) { |
| 323 | link_id := orig.ies[2].body.link_id; |
| 324 | } else { |
| 325 | link_id := orig.ies[1].body.link_id; |
| 326 | } |
Harald Welte | 898113b | 2018-01-31 18:32:21 +0100 | [diff] [blame] | 327 | f_rsl_send_l3(l3, link_id, chan_nr); |
Harald Welte | c1a2fff | 2017-12-17 11:06:19 +0100 | [diff] [blame] | 328 | } |
| 329 | |
Philipp Maier | b20c3dc | 2018-02-07 18:36:25 +0100 | [diff] [blame] | 330 | /* Convert the chipher representation on BSSMAP to the representation used on RSL */ |
| 331 | function f_chipher_mode_bssmap_to_rsl(OCT1 alg_bssmap) return OCT1 |
| 332 | { |
| 333 | /* A5 0 */ |
| 334 | if (alg_bssmap == '01'O) { |
| 335 | return '01'O; |
| 336 | } |
| 337 | /* A5 1 */ |
| 338 | else if (alg_bssmap == '02'O) { |
| 339 | return '02'O; |
| 340 | } |
| 341 | /* A5 2 */ |
| 342 | else if (alg_bssmap == '04'O) { |
| 343 | return '03'O; |
| 344 | } |
| 345 | /* A5 3 */ |
| 346 | else if (alg_bssmap == '08'O) { |
| 347 | return '04'O; |
| 348 | } |
| 349 | /* A5 4 */ |
| 350 | else if (alg_bssmap == '10'O) { |
| 351 | return '05'O; |
| 352 | } |
| 353 | /* A5 5 */ |
| 354 | else if (alg_bssmap == '20'O) { |
| 355 | return '06'O; |
| 356 | } |
| 357 | /* A5 6 */ |
| 358 | else if (alg_bssmap == '40'O) { |
| 359 | return '07'O; |
| 360 | } |
| 361 | /* A5 7 */ |
| 362 | else if (alg_bssmap == '80'O) { |
| 363 | return '08'O; |
| 364 | } else { |
| 365 | setverdict(fail, "Unexpected Encryption Algorithm"); |
| 366 | return '00'O; |
| 367 | } |
| 368 | } |
| 369 | |
Harald Welte | 38b2a10 | 2017-12-23 02:42:58 +0100 | [diff] [blame] | 370 | function f_cipher_mode(OCT1 alg, OCT8 key, template OCT16 kc128 := omit, boolean exp_fail := false) |
| 371 | runs on MSC_ConnHdlr { |
Harald Welte | 73cd271 | 2017-12-17 00:44:52 +0100 | [diff] [blame] | 372 | var PDU_BSSAP bssap; |
| 373 | var RSL_Message rsl; |
Philipp Maier | b20c3dc | 2018-02-07 18:36:25 +0100 | [diff] [blame] | 374 | var OCT1 alg_rsl; |
Harald Welte | 73cd271 | 2017-12-17 00:44:52 +0100 | [diff] [blame] | 375 | |
| 376 | if (isvalue(kc128)) { |
| 377 | BSSAP.send(ts_BSSMAP_CipherModeCmdKc128(alg, key, valueof(kc128))); |
| 378 | } else { |
| 379 | BSSAP.send(ts_BSSMAP_CipherModeCmd(alg, key)); |
| 380 | } |
Philipp Maier | b20c3dc | 2018-02-07 18:36:25 +0100 | [diff] [blame] | 381 | |
| 382 | /* RSL uses a different representation of the encryption algorithm, |
| 383 | * so we need to convert first */ |
| 384 | alg_rsl := f_chipher_mode_bssmap_to_rsl(alg); |
| 385 | |
Harald Welte | 73cd271 | 2017-12-17 00:44:52 +0100 | [diff] [blame] | 386 | alt { |
| 387 | /* RSL/UE Side */ |
Philipp Maier | b20c3dc | 2018-02-07 18:36:25 +0100 | [diff] [blame] | 388 | [] RSL.receive(tr_RSL_ENCR_CMD(g_chan_nr, ?, alg_rsl, key)) -> value rsl { |
Harald Welte | 73cd271 | 2017-12-17 00:44:52 +0100 | [diff] [blame] | 389 | var PDU_ML3_NW_MS l3 := dec_PDU_ML3_NW_MS(rsl.ies[3].body.l3_info.payload); |
| 390 | log("Rx L3 from net: ", l3); |
| 391 | if (ischosen(l3.msgs.rrm.cipheringModeCommand)) { |
| 392 | f_rsl_reply(ts_RRM_CiphModeCompl, rsl); |
| 393 | } |
| 394 | repeat; |
| 395 | } |
| 396 | [] BSSAP.receive(tr_BSSMAP_CipherModeCompl) -> value bssap { |
| 397 | // bssap.bssmap.cipherModeComplete.chosenEncryptionAlgorithm.algoritmhIdentifier |
Harald Welte | 38b2a10 | 2017-12-23 02:42:58 +0100 | [diff] [blame] | 398 | if (exp_fail == true) { |
| 399 | setverdict(fail, "Unexpected Cipher Mode Complete"); |
| 400 | } else { |
| 401 | setverdict(pass); |
| 402 | } |
Harald Welte | 73cd271 | 2017-12-17 00:44:52 +0100 | [diff] [blame] | 403 | } |
| 404 | [] BSSAP.receive(tr_BSSMAP_CipherModeRej) -> value bssap { |
Harald Welte | 38b2a10 | 2017-12-23 02:42:58 +0100 | [diff] [blame] | 405 | if (exp_fail == false) { |
| 406 | setverdict(fail, "Ciphering Mode Reject"); |
| 407 | } else { |
| 408 | setverdict(pass); |
| 409 | } |
Harald Welte | 73cd271 | 2017-12-17 00:44:52 +0100 | [diff] [blame] | 410 | } |
| 411 | } |
| 412 | } |
| 413 | |
Harald Welte | 211219e | 2018-01-29 22:03:36 +0100 | [diff] [blame] | 414 | /* Convert from Ericsson ChanDesc2 format to Osmocom RslChannelNr format */ |
| 415 | function f_ChDesc2RslChanNr(ChannelDescription2_V ch_desc, out RslChannelNr chan_nr, out GsmArfcn arfcn) { |
| 416 | var BIT5 inp := ch_desc.channelTypeandTDMAOffset; |
| 417 | |
| 418 | chan_nr.tn := bit2int(ch_desc.timeslotNumber); |
| 419 | |
| 420 | if (match(inp, '00001'B)) { /* TCH/F */ |
| 421 | chan_nr.u.ch0 := RSL_CHAN_NR_Bm_ACCH; |
| 422 | } |
| 423 | else if (match(inp, '0001?'B)) { /* TCH/H */ |
| 424 | chan_nr.u.lm.sub_chan := bit2int(substr(inp, 4, 1)); |
| 425 | } |
| 426 | else if (match(inp, '001??'B)) { /* SDCCH/4 */ |
| 427 | chan_nr.u.sdcch4.sub_chan := bit2int(substr(inp, 3, 2)); |
| 428 | } |
| 429 | else if (match(inp, '01???'B)) { /* SDCCH/8 */ |
| 430 | chan_nr.u.sdcch8.sub_chan := bit2int(substr(inp, 2, 3)); |
| 431 | } |
| 432 | else { |
| 433 | setverdict(fail, "Unknown ChDesc!"); |
| 434 | self.stop; |
| 435 | } |
| 436 | |
| 437 | if (ch_desc.octet3 and4b '10'O == '10'O) { |
| 438 | setverdict(fail, "No support for Hopping"); |
| 439 | self.stop; |
| 440 | } else { |
| 441 | var OCT2 concat := ch_desc.octet3 & ch_desc.octet4; |
| 442 | arfcn := oct2int(concat); |
| 443 | } |
| 444 | } |
| 445 | |
| 446 | type record AssignmentState { |
| 447 | /* global */ |
| 448 | boolean voice_call, |
| 449 | boolean is_assignment, |
| 450 | /* Assignment related bits */ |
| 451 | boolean rr_ass_cmpl_seen, |
Harald Welte | 2158308 | 2018-01-29 22:28:26 +0100 | [diff] [blame] | 452 | boolean assignment_done, |
Harald Welte | 211219e | 2018-01-29 22:03:36 +0100 | [diff] [blame] | 453 | RslChannelNr old_chan_nr, |
| 454 | /* Modify related bits */ |
| 455 | boolean rr_modify_seen, |
Harald Welte | 2158308 | 2018-01-29 22:28:26 +0100 | [diff] [blame] | 456 | boolean modify_done |
Harald Welte | 211219e | 2018-01-29 22:03:36 +0100 | [diff] [blame] | 457 | } |
| 458 | |
| 459 | template (value) AssignmentState ts_AssignmentStateInit := { |
| 460 | voice_call := false, |
| 461 | is_assignment := false, |
| 462 | rr_ass_cmpl_seen := false, |
Harald Welte | 2158308 | 2018-01-29 22:28:26 +0100 | [diff] [blame] | 463 | assignment_done := false, |
Harald Welte | 211219e | 2018-01-29 22:03:36 +0100 | [diff] [blame] | 464 | old_chan_nr := -, |
| 465 | rr_modify_seen := false, |
Harald Welte | 2158308 | 2018-01-29 22:28:26 +0100 | [diff] [blame] | 466 | modify_done := false |
Harald Welte | 211219e | 2018-01-29 22:03:36 +0100 | [diff] [blame] | 467 | } |
| 468 | |
| 469 | altstep as_assignment(inout AssignmentState st) runs on MSC_ConnHdlr { |
Harald Welte | c1a2fff | 2017-12-17 11:06:19 +0100 | [diff] [blame] | 470 | var RSL_Message rsl; |
Harald Welte | 211219e | 2018-01-29 22:03:36 +0100 | [diff] [blame] | 471 | [not st.rr_ass_cmpl_seen] RSL.receive(tr_RSL_DATA_REQ(g_chan_nr)) -> value rsl { |
| 472 | var PDU_ML3_NW_MS l3 := dec_PDU_ML3_NW_MS(rsl.ies[2].body.l3_info.payload); |
| 473 | log("Rx L3 from net: ", l3); |
| 474 | if (ischosen(l3.msgs.rrm.assignmentCommand)) { |
| 475 | var RslChannelNr new_chan_nr; |
| 476 | var GsmArfcn arfcn; |
| 477 | f_ChDesc2RslChanNr(l3.msgs.rrm.assignmentCommand.descrOf1stChAfterTime, |
| 478 | new_chan_nr, arfcn); |
| 479 | /* FIXME: Determine TRX NR by ARFCN, instead of hard-coded TRX0! */ |
Harald Welte | c1a2fff | 2017-12-17 11:06:19 +0100 | [diff] [blame] | 480 | |
Harald Welte | 211219e | 2018-01-29 22:03:36 +0100 | [diff] [blame] | 481 | /* register our component for this channel number at the RSL Emulation */ |
| 482 | f_rslem_register(0, new_chan_nr); |
| 483 | var PDU_ML3_MS_NW l3_tx := valueof(ts_RRM_AssignmentComplete('00'O)); |
| 484 | /* send assignment complete over the new channel */ |
| 485 | RSL.send(ts_RSL_DATA_IND(new_chan_nr, valueof(ts_RslLinkID_DCCH(0)), |
| 486 | enc_PDU_ML3_MS_NW(l3_tx))); |
| 487 | /* by default, send via the new channel from now */ |
| 488 | st.old_chan_nr := g_chan_nr; |
| 489 | g_chan_nr := new_chan_nr; |
| 490 | st.rr_ass_cmpl_seen := true; |
| 491 | repeat; |
| 492 | } else { |
| 493 | setverdict(fail, "Unexpected L3 received", l3); |
| 494 | self.stop; |
Harald Welte | c1a2fff | 2017-12-17 11:06:19 +0100 | [diff] [blame] | 495 | } |
Harald Welte | 211219e | 2018-01-29 22:03:36 +0100 | [diff] [blame] | 496 | } |
| 497 | [st.rr_ass_cmpl_seen] RSL.receive(tr_RSL_REL_REQ(st.old_chan_nr, tr_RslLinkID_DCCH(0))) { |
| 498 | RSL.send(ts_RSL_REL_CONF(st.old_chan_nr, valueof(ts_RslLinkID_DCCH(0)))); |
| 499 | repeat; |
| 500 | } |
| 501 | [st.rr_ass_cmpl_seen] RSL.receive(tr_RSL_RF_CHAN_REL(st.old_chan_nr)) { |
| 502 | RSL.send(ts_RSL_RF_CHAN_REL_ACK(st.old_chan_nr)); |
Harald Welte | 1909f46 | 2018-01-29 22:29:29 +0100 | [diff] [blame] | 503 | /* unregister for old channel number in RSL emulation */ |
| 504 | /* FIXME: Determine TRX NR by ARFCN, instead of hard-coded TRX0! */ |
| 505 | f_rslem_unregister(0, st.old_chan_nr); |
Harald Welte | 2158308 | 2018-01-29 22:28:26 +0100 | [diff] [blame] | 506 | st.assignment_done := true; |
Harald Welte | 211219e | 2018-01-29 22:03:36 +0100 | [diff] [blame] | 507 | repeat; |
| 508 | } |
| 509 | } |
| 510 | |
| 511 | altstep as_modify(inout AssignmentState st) runs on MSC_ConnHdlr { |
| 512 | /* no assignment, just mode modify */ |
| 513 | var RSL_Message rsl; |
| 514 | |
| 515 | [st.voice_call and not st.rr_modify_seen] RSL.receive(tr_RSL_DATA_REQ(g_chan_nr)) -> value rsl { |
Harald Welte | c1a2fff | 2017-12-17 11:06:19 +0100 | [diff] [blame] | 516 | var PDU_ML3_NW_MS l3 := dec_PDU_ML3_NW_MS(rsl.ies[2].body.l3_info.payload); |
| 517 | log("Rx L3 from net: ", l3); |
| 518 | if (ischosen(l3.msgs.rrm.channelModeModify)) { |
| 519 | f_rsl_reply(ts_RRM_ModeModifyAck(l3.msgs.rrm.channelModeModify.channelDescription, |
| 520 | l3.msgs.rrm.channelModeModify.channelMode), rsl); |
Harald Welte | 211219e | 2018-01-29 22:03:36 +0100 | [diff] [blame] | 521 | st.rr_modify_seen := true; |
Harald Welte | c1a2fff | 2017-12-17 11:06:19 +0100 | [diff] [blame] | 522 | } |
| 523 | repeat; |
| 524 | } |
Harald Welte | 211219e | 2018-01-29 22:03:36 +0100 | [diff] [blame] | 525 | [st.voice_call and st.rr_modify_seen] RSL.receive(tr_RSL_MsgTypeD(RSL_MT_MODE_MODIFY_REQ)) -> value rsl { |
Harald Welte | c1a2fff | 2017-12-17 11:06:19 +0100 | [diff] [blame] | 526 | RSL.send(ts_RSL_MODE_MODIFY_ACK(g_chan_nr)); |
Harald Welte | 2158308 | 2018-01-29 22:28:26 +0100 | [diff] [blame] | 527 | st.modify_done := true; |
Harald Welte | c1a2fff | 2017-12-17 11:06:19 +0100 | [diff] [blame] | 528 | repeat; |
| 529 | } |
Harald Welte | 211219e | 2018-01-29 22:03:36 +0100 | [diff] [blame] | 530 | } |
Daniel Willmann | 191e0d9 | 2018-01-17 12:44:35 +0100 | [diff] [blame] | 531 | |
Harald Welte | 211219e | 2018-01-29 22:03:36 +0100 | [diff] [blame] | 532 | /* Determine if given rsl_chan_nr is compatible with given BSSMAP ChannelType */ |
| 533 | function f_channel_compatible(BSSMAP_IE_ChannelType bssmap, RslChannelNr rsl_chan_nr) |
| 534 | return boolean { |
| 535 | select (bssmap.speechOrDataIndicator) { |
| 536 | case ('0011'B) { /* Signalling */ |
| 537 | /* all channels support signalling */ |
| 538 | return true; |
| 539 | } |
| 540 | case else { /* Speech, Speech+CTM or CSD */ |
| 541 | select (bssmap.channelRateAndType) { |
| 542 | case ('08'O) { /* TCH/F */ |
| 543 | select (rsl_chan_nr) { |
| 544 | case (t_RslChanNr_Bm(?)) { return true; } |
| 545 | } |
| 546 | } |
| 547 | case ('09'O) { /* TCH/H */ |
| 548 | select (rsl_chan_nr) { |
| 549 | case (t_RslChanNr_Lm(?, ?)) { return true; } |
| 550 | } |
| 551 | } |
| 552 | case else { /* full or half-rate */ |
| 553 | select (rsl_chan_nr) { |
| 554 | case (t_RslChanNr_Bm(?)) { return true; } |
| 555 | case (t_RslChanNr_Lm(?, ?)) { return true; } |
| 556 | } |
| 557 | } |
| 558 | } |
Harald Welte | c1a2fff | 2017-12-17 11:06:19 +0100 | [diff] [blame] | 559 | } |
Harald Welte | 211219e | 2018-01-29 22:03:36 +0100 | [diff] [blame] | 560 | } |
| 561 | return false; |
| 562 | } |
Daniel Willmann | 191e0d9 | 2018-01-17 12:44:35 +0100 | [diff] [blame] | 563 | |
Harald Welte | 211219e | 2018-01-29 22:03:36 +0100 | [diff] [blame] | 564 | /* establish a channel fully, expecting an assignment matching 'exp' */ |
| 565 | function f_establish_fully(TestHdlrParams pars, PDU_BSSAP ass_cmd, template PDU_BSSAP exp_ass_cpl) |
| 566 | runs on MSC_ConnHdlr return PDU_BSSAP { |
| 567 | var PDU_BSSAP bssap; |
| 568 | timer T := 10.0; |
| 569 | var boolean exp_compl := ischosen(exp_ass_cpl.pdu.bssmap.assignmentComplete); |
Philipp Maier | 86f3920 | 2018-02-07 14:40:09 +0100 | [diff] [blame] | 570 | var boolean exp_fail := ischosen(exp_ass_cpl.pdu.bssmap.assignmentFailure); |
Harald Welte | 211219e | 2018-01-29 22:03:36 +0100 | [diff] [blame] | 571 | var ExpectCriteria mgcpcrit := { |
| 572 | connid := omit, |
| 573 | endpoint := omit, |
| 574 | transid := omit |
| 575 | }; |
| 576 | var AssignmentState st := valueof(ts_AssignmentStateInit); |
| 577 | /* if the channel type is SIGNAL, we're not handling a voice call */ |
| 578 | if (ass_cmd.pdu.bssmap.assignmentRequest.channelType.speechOrDataIndicator != '0011'B) { |
| 579 | st.voice_call := true; |
| 580 | } |
| 581 | /* determine if the current channel can support the given service or not */ |
| 582 | if (not f_channel_compatible(ass_cmd.pdu.bssmap.assignmentRequest.channelType, g_chan_nr)) { |
| 583 | st.is_assignment := true; |
| 584 | } |
| 585 | |
Harald Welte | c20b1c4 | 2018-02-12 20:50:08 +0100 | [diff] [blame^] | 586 | f_MscConnHdlr_init(1, "127.0.0.2", "127.0.0.3"); |
Harald Welte | 211219e | 2018-01-29 22:03:36 +0100 | [diff] [blame] | 587 | |
| 588 | f_create_chan_and_exp(pars); |
| 589 | /* we should now have a COMPL_L3 at the MSC */ |
| 590 | BSSAP.receive(tr_BSSMAP_ComplL3); |
| 591 | f_create_mgcp_expect(mgcpcrit); |
| 592 | BSSAP.send(ass_cmd); |
| 593 | |
| 594 | T.start; |
| 595 | alt { |
| 596 | /* assignment related bits */ |
| 597 | [st.is_assignment] as_assignment(st); |
| 598 | |
| 599 | /* modify related bits */ |
| 600 | [not st.is_assignment] as_modify(st); |
| 601 | |
| 602 | /* voice call related bits (IPA CRCX/MDCX + MGCP) */ |
| 603 | [st.voice_call] as_Media(); |
| 604 | |
| 605 | /* if we receive exactly what we expected, always return + pass */ |
Harald Welte | 2158308 | 2018-01-29 22:28:26 +0100 | [diff] [blame] | 606 | [st.is_assignment and st.assignment_done or |
| 607 | (not st.is_assignment and st.modify_done)] BSSAP.receive(exp_ass_cpl) -> value bssap { |
Harald Welte | 211219e | 2018-01-29 22:03:36 +0100 | [diff] [blame] | 608 | setverdict(pass); |
| 609 | } |
Philipp Maier | 86f3920 | 2018-02-07 14:40:09 +0100 | [diff] [blame] | 610 | [exp_fail] BSSAP.receive(exp_ass_cpl) -> value bssap { |
| 611 | setverdict(pass); |
| 612 | } |
Harald Welte | 2158308 | 2018-01-29 22:28:26 +0100 | [diff] [blame] | 613 | [(st.is_assignment and st.assignment_done or |
| 614 | (not st.is_assignment and st.modify_done)) and |
| 615 | exp_compl] BSSAP.receive(tr_BSSMAP_AssignmentComplete) { |
Harald Welte | c1a2fff | 2017-12-17 11:06:19 +0100 | [diff] [blame] | 616 | setverdict(fail, "Received non-matching ASSIGNMENT COMPLETE"); |
| 617 | } |
| 618 | [exp_compl] BSSAP.receive(tr_BSSMAP_AssignmentFail) { |
| 619 | setverdict(fail, "Received unexpected ASSIGNMENT FAIL"); |
| 620 | } |
| 621 | [not exp_compl] BSSAP.receive(tr_BSSMAP_AssignmentComplete) { |
| 622 | setverdict(fail, "Received unexpected ASSIGNMENT COMPLETE"); |
| 623 | } |
| 624 | [not exp_compl] BSSAP.receive(tr_BSSMAP_AssignmentFail) { |
| 625 | setverdict(fail, "Received non-matching ASSIGNMENT FAIL"); |
| 626 | } |
| 627 | [] T.timeout { |
| 628 | setverdict(inconc, "Timeout waiting for ASSIGNMENT COMPLETE"); |
| 629 | } |
| 630 | } |
Harald Welte | 211219e | 2018-01-29 22:03:36 +0100 | [diff] [blame] | 631 | log("g_media ", g_media); |
| 632 | if (not isbound(bssap)) { |
| 633 | self.stop; |
| 634 | } |
| 635 | return bssap; |
Harald Welte | c1a2fff | 2017-12-17 11:06:19 +0100 | [diff] [blame] | 636 | } |
| 637 | |
| 638 | |
Harald Welte | 28d943e | 2017-11-25 15:00:50 +0100 | [diff] [blame] | 639 | } |