blob: f131eca74d20149d26a9c070e8fd7154cdf17159 [file] [log] [blame]
Philipp Maierfbf66102017-04-09 12:32:51 +02001/* (C) 2017 by Sysmocom s.f.m.c. GmbH
Harald Weltec9e78592018-02-09 01:42:50 +01002 * (C) 2018 by Harald Welte <laforge@gnumonks.org>
Philipp Maierfbf66102017-04-09 12:32:51 +02003 * All Rights Reserved
4 *
5 * Author: Philipp Maier
6 *
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU Affero General Public License as published by
9 * the Free Software Foundation; either version 3 of the License, or
10 * (at your option) any later version.
11 *
12 * This program is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU Affero General Public License for more details.
16 *
17 * You should have received a copy of the GNU Affero General Public License
18 * along with this program. If not, see <http://www.gnu.org/licenses/>.
19 *
20 */
21
22#include <osmocom/core/utils.h>
23#include <osmocom/core/msgb.h>
24#include <osmocom/core/logging.h>
25#include <osmocom/sigtran/sccp_helpers.h>
26#include <osmocom/sccp/sccp_types.h>
27#include <osmocom/gsm/gsm0808.h>
Max43b01b02017-09-15 11:22:30 +020028#include <osmocom/gsm/gsm48.h>
Philipp Maierfbf66102017-04-09 12:32:51 +020029#include <osmocom/gsm/gsm0808_utils.h>
Neels Hofmeyr90843962017-09-04 15:04:35 +020030#include <osmocom/msc/debug.h>
31#include <osmocom/msc/gsm_data.h>
32#include <osmocom/msc/a_iface_bssap.h>
33#include <osmocom/msc/a_iface.h>
34#include <osmocom/msc/osmo_msc.h>
Philipp Maierfbf66102017-04-09 12:32:51 +020035#include <osmocom/core/byteswap.h>
Neels Hofmeyr90843962017-09-04 15:04:35 +020036#include <osmocom/msc/a_reset.h>
Max43b01b02017-09-15 11:22:30 +020037#include <osmocom/msc/transaction.h>
Philipp Maier621ba032017-11-07 17:19:25 +010038#include <osmocom/msc/msc_mgcp.h>
Max43b01b02017-09-15 11:22:30 +020039
40#include <errno.h>
Philipp Maierfbf66102017-04-09 12:32:51 +020041
42#define IP_V4_ADDR_LEN 4
43
44/*
45 * Helper functions to lookup and allocate subscribers
46 */
47
48/* Allocate a new subscriber connection */
49static struct gsm_subscriber_connection *subscr_conn_allocate_a(const struct a_conn_info *a_conn_info,
50 struct gsm_network *network,
51 uint16_t lac, struct osmo_sccp_user *scu, int conn_id)
52{
53 struct gsm_subscriber_connection *conn;
54
Harald Weltef0dc1be2018-02-09 00:37:56 +010055 LOGP(DMSC, LOGL_DEBUG, "Allocating A-Interface subscriber conn: lac %i, conn_id %i\n", lac, conn_id);
Philipp Maierfbf66102017-04-09 12:32:51 +020056
57 conn = talloc_zero(network, struct gsm_subscriber_connection);
58 if (!conn)
59 return NULL;
60
61 conn->network = network;
62 conn->via_ran = RAN_GERAN_A;
63 conn->lac = lac;
64
65 conn->a.conn_id = conn_id;
66 conn->a.scu = scu;
67
68 /* Also backup the calling address of the BSC, this allows us to
69 * identify later which BSC is responsible for this subscriber connection */
Harald Welte54a10ef2018-02-09 00:09:16 +010070 memcpy(&conn->a.bsc_addr, &a_conn_info->bsc->bsc_addr, sizeof(conn->a.bsc_addr));
Philipp Maierfbf66102017-04-09 12:32:51 +020071
72 llist_add_tail(&conn->entry, &network->subscr_conns);
Harald Welte6de46592018-02-09 00:53:17 +010073 LOGPCONN(conn, LOGL_DEBUG, "A-Interface subscriber connection successfully allocated!\n");
Philipp Maierfbf66102017-04-09 12:32:51 +020074 return conn;
75}
76
77/* Return an existing A subscriber connection record for the given
78 * connection IDs, or return NULL if not found. */
79static struct gsm_subscriber_connection *subscr_conn_lookup_a(const struct gsm_network *network, int conn_id)
80{
81 struct gsm_subscriber_connection *conn;
82
83 OSMO_ASSERT(network);
84
85 DEBUGP(DMSC, "Looking for A subscriber: conn_id %i\n", conn_id);
86
87 /* FIXME: log_subscribers() is defined in iucs.c as static inline, if
88 * maybe this function should be public to reach it from here? */
89 /* log_subscribers(network); */
90
91 llist_for_each_entry(conn, &network->subscr_conns, entry) {
92 if (conn->via_ran == RAN_GERAN_A && conn->a.conn_id == conn_id) {
Harald Welte6de46592018-02-09 00:53:17 +010093 LOGPCONN(conn, LOGL_DEBUG, "Found A subscriber for conn_id %i\n", conn_id);
Philipp Maierfbf66102017-04-09 12:32:51 +020094 return conn;
95 }
96 }
97 DEBUGP(DMSC, "No A subscriber found for conn_id %i\n", conn_id);
98 return NULL;
99}
100
101/*
102 * BSSMAP handling for UNITDATA
103 */
104
105/* Endpoint to handle BSSMAP reset */
106static void bssmap_rx_reset(struct osmo_sccp_user *scu, const struct a_conn_info *a_conn_info, struct msgb *msg)
107{
108 struct gsm_network *network = a_conn_info->network;
109 struct osmo_ss7_instance *ss7;
110
111 ss7 = osmo_ss7_instance_find(network->a.cs7_instance);
112 OSMO_ASSERT(ss7);
113
Harald Welte1f477442018-02-09 01:49:01 +0100114 LOGP(DBSSAP, LOGL_NOTICE, "Rx BSSMAP RESET from BSC %s, sending RESET ACK\n",
Harald Welte54a10ef2018-02-09 00:09:16 +0100115 osmo_sccp_addr_name(ss7, &a_conn_info->bsc->bsc_addr));
116 osmo_sccp_tx_unitdata_msg(scu, &a_conn_info->bsc->msc_addr, &a_conn_info->bsc->bsc_addr,
117 gsm0808_create_reset_ack());
Philipp Maierfbf66102017-04-09 12:32:51 +0200118
119 /* Make sure all orphand subscriber connections will be cleard */
Harald Welte54a10ef2018-02-09 00:09:16 +0100120 a_clear_all(scu, &a_conn_info->bsc->bsc_addr);
121
122 if (!a_conn_info->bsc->reset)
123 a_start_reset(a_conn_info->bsc, true);
Philipp Maierfbf66102017-04-09 12:32:51 +0200124}
125
126/* Endpoint to handle BSSMAP reset acknowlegement */
127static void bssmap_rx_reset_ack(const struct osmo_sccp_user *scu, const struct a_conn_info *a_conn_info,
128 struct msgb *msg)
129{
130
131 struct gsm_network *network = a_conn_info->network;
132 struct osmo_ss7_instance *ss7;
133
134 ss7 = osmo_ss7_instance_find(network->a.cs7_instance);
135 OSMO_ASSERT(ss7);
136
Harald Welte54a10ef2018-02-09 00:09:16 +0100137 if (a_conn_info->bsc->reset == NULL) {
Harald Welte1f477442018-02-09 01:49:01 +0100138 LOGP(DBSSAP, LOGL_ERROR, "Received RESET ACK from an unknown BSC %s, ignoring...\n",
Harald Welte54a10ef2018-02-09 00:09:16 +0100139 osmo_sccp_addr_name(ss7, &a_conn_info->bsc->bsc_addr));
Harald Weltea172e9e2018-02-09 21:33:24 +0100140 return;
Philipp Maierfbf66102017-04-09 12:32:51 +0200141 }
142
Harald Welte1f477442018-02-09 01:49:01 +0100143 LOGP(DBSSAP, LOGL_NOTICE, "Received RESET ACK from BSC %s\n",
Harald Welte54a10ef2018-02-09 00:09:16 +0100144 osmo_sccp_addr_name(ss7, &a_conn_info->bsc->bsc_addr));
Philipp Maierfbf66102017-04-09 12:32:51 +0200145
146 /* Confirm that we managed to get the reset ack message
147 * towards the connection reset logic */
Harald Welte54a10ef2018-02-09 00:09:16 +0100148 a_reset_ack_confirm(a_conn_info->bsc->reset);
Philipp Maierfbf66102017-04-09 12:32:51 +0200149}
150
151/* Handle UNITDATA BSSMAP messages */
152static void bssmap_rcvmsg_udt(struct osmo_sccp_user *scu, const struct a_conn_info *a_conn_info, struct msgb *msg)
153{
154 /* Note: When in the MSC role, RESET ACK is the only valid message that
155 * can be received via UNITDATA */
156
157 if (msgb_l3len(msg) < 1) {
Harald Welte1f477442018-02-09 01:49:01 +0100158 LOGP(DBSSAP, LOGL_NOTICE, "Error: No data received -- discarding message!\n");
Philipp Maierfbf66102017-04-09 12:32:51 +0200159 return;
160 }
161
Harald Welte1f477442018-02-09 01:49:01 +0100162 LOGP(DBSSAP, LOGL_DEBUG, "Rx BSSMAP UDT %s\n", gsm0808_bssmap_name(msg->l3h[0]));
Philipp Maierfbf66102017-04-09 12:32:51 +0200163
164 switch (msg->l3h[0]) {
165 case BSS_MAP_MSG_RESET:
166 bssmap_rx_reset(scu, a_conn_info, msg);
167 break;
168 case BSS_MAP_MSG_RESET_ACKNOWLEDGE:
169 bssmap_rx_reset_ack(scu, a_conn_info, msg);
170 break;
171 default:
Harald Welte1f477442018-02-09 01:49:01 +0100172 LOGP(DBSSAP, LOGL_NOTICE, "Unimplemented message format: %s -- message discarded!\n",
Philipp Maierfbf66102017-04-09 12:32:51 +0200173 gsm0808_bssmap_name(msg->l3h[0]));
Philipp Maierfbf66102017-04-09 12:32:51 +0200174 }
175}
176
177/* Receive incoming connection less data messages via sccp */
Neels Hofmeyrc1d69252017-12-18 04:06:04 +0100178void a_sccp_rx_udt(struct osmo_sccp_user *scu, const struct a_conn_info *a_conn_info, struct msgb *msg)
Philipp Maierfbf66102017-04-09 12:32:51 +0200179{
180 /* Note: The only valid message type that can be received
181 * via UNITDATA are BSS Management messages */
182 struct bssmap_header *bs;
183
184 OSMO_ASSERT(scu);
185 OSMO_ASSERT(a_conn_info);
186 OSMO_ASSERT(msg);
187
Harald Welte1f477442018-02-09 01:49:01 +0100188 LOGP(DBSSAP, LOGL_DEBUG, "Rx BSSMAP UDT: %s\n", msgb_hexdump_l2(msg));
Philipp Maierfbf66102017-04-09 12:32:51 +0200189
190 if (msgb_l2len(msg) < sizeof(*bs)) {
Harald Welte1f477442018-02-09 01:49:01 +0100191 LOGP(DBSSAP, LOGL_ERROR, "Error: Header is too short -- discarding message!\n");
Philipp Maierfbf66102017-04-09 12:32:51 +0200192 return;
193 }
194
195 bs = (struct bssmap_header *)msgb_l2(msg);
196 if (bs->length < msgb_l2len(msg) - sizeof(*bs)) {
Harald Welte1f477442018-02-09 01:49:01 +0100197 LOGP(DBSSAP, LOGL_ERROR, "Error: Message is too short -- discarding message!\n");
Philipp Maierfbf66102017-04-09 12:32:51 +0200198 return;
199 }
200
201 switch (bs->type) {
202 case BSSAP_MSG_BSS_MANAGEMENT:
203 msg->l3h = &msg->l2h[sizeof(struct bssmap_header)];
204 bssmap_rcvmsg_udt(scu, a_conn_info, msg);
205 break;
206 default:
Harald Welte1f477442018-02-09 01:49:01 +0100207 LOGP(DBSSAP, LOGL_ERROR,
Philipp Maierfbf66102017-04-09 12:32:51 +0200208 "Error: Unimplemented message type: %s -- message discarded!\n", gsm0808_bssmap_name(bs->type));
Philipp Maierfbf66102017-04-09 12:32:51 +0200209 }
210}
211
212/*
213 * BSSMAP handling for connection oriented data
214 */
215
216/* Endpoint to handle BSSMAP clear request */
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100217static int bssmap_rx_clear_rqst(struct gsm_subscriber_connection *conn,
218 struct msgb *msg, struct tlv_parsed *tp)
Philipp Maierfbf66102017-04-09 12:32:51 +0200219{
Philipp Maierfbf66102017-04-09 12:32:51 +0200220 int rc;
221 struct msgb *msg_resp;
222 uint8_t cause;
Philipp Maierfbf66102017-04-09 12:32:51 +0200223
Harald Welte35284462018-02-09 01:31:29 +0100224 LOGPCONN(conn, LOGL_INFO, "Rx BSSMAP CLEAR REQUEST\n");
Philipp Maierfbf66102017-04-09 12:32:51 +0200225
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100226 if (!TLVP_PRESENT(tp, GSM0808_IE_CAUSE)) {
Harald Welte1f477442018-02-09 01:49:01 +0100227 LOGP(DBSSAP, LOGL_ERROR, "Cause code is missing -- discarding message!\n");
Harald Weltea172e9e2018-02-09 21:33:24 +0100228 return -EINVAL;
Philipp Maierfbf66102017-04-09 12:32:51 +0200229 }
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100230 cause = TLVP_VAL(tp, GSM0808_IE_CAUSE)[0];
Philipp Maierfbf66102017-04-09 12:32:51 +0200231
232 /* Respond with clear command */
233 msg_resp = gsm0808_create_clear_command(GSM0808_CAUSE_CALL_CONTROL);
Harald Weltec27ef652018-02-09 01:23:25 +0100234 rc = osmo_sccp_tx_data_msg(conn->a.scu, conn->a.conn_id, msg_resp);
Philipp Maierfbf66102017-04-09 12:32:51 +0200235
Philipp Maierfbf66102017-04-09 12:32:51 +0200236 msc_clear_request(conn, cause);
237
Philipp Maierfbf66102017-04-09 12:32:51 +0200238 return rc;
Philipp Maierfbf66102017-04-09 12:32:51 +0200239}
240
241/* Endpoint to handle BSSMAP clear complete */
Harald Weltec27ef652018-02-09 01:23:25 +0100242static int bssmap_rx_clear_complete(struct osmo_sccp_user *scu,
243 const struct a_conn_info *a_conn_info, struct msgb *msg)
Philipp Maierfbf66102017-04-09 12:32:51 +0200244{
245 int rc;
246
Pau Espin Pedrol9f055f52018-02-14 14:11:58 +0100247 LOGP(DMSC, LOGL_INFO, "Rx BSSMAP CLEAR COMPLETE, releasing SCCP connection\n");
Philipp Maierfbf66102017-04-09 12:32:51 +0200248 rc = osmo_sccp_tx_disconn(scu, a_conn_info->conn_id,
Harald Welte54a10ef2018-02-09 00:09:16 +0100249 NULL, SCCP_RELEASE_CAUSE_END_USER_ORIGINATED);
Philipp Maierfbf66102017-04-09 12:32:51 +0200250
251 /* Remove the record from the list with active connections. */
252 a_delete_bsc_con(a_conn_info->conn_id);
253
Philipp Maierfbf66102017-04-09 12:32:51 +0200254 return rc;
255}
256
257/* Endpoint to handle layer 3 complete messages */
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100258static int bssmap_rx_l3_compl(struct osmo_sccp_user *scu, const struct a_conn_info *a_conn_info,
259 struct msgb *msg, struct tlv_parsed *tp)
Philipp Maierfbf66102017-04-09 12:32:51 +0200260{
Stefan Sperlingbe7e0692018-03-14 14:00:00 +0100261 struct gsm0808_cell_id_list2 cil;
262 uint16_t lac = 0;
Philipp Maierfbf66102017-04-09 12:32:51 +0200263 uint8_t data_length;
264 const uint8_t *data;
265 int rc;
266
267 struct gsm_network *network = a_conn_info->network;
268 struct gsm_subscriber_connection *conn;
269
Harald Welte1f477442018-02-09 01:49:01 +0100270 LOGP(DBSSAP, LOGL_INFO, "Rx BSSMAP COMPLETE L3 INFO (conn_id=%i)\n", a_conn_info->conn_id);
Philipp Maierfbf66102017-04-09 12:32:51 +0200271
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100272 if (!TLVP_PRESENT(tp, GSM0808_IE_CELL_IDENTIFIER)) {
Harald Welte1f477442018-02-09 01:49:01 +0100273 LOGP(DBSSAP, LOGL_ERROR, "Mandatory CELL IDENTIFIER not present -- discarding message!\n");
Harald Weltea172e9e2018-02-09 21:33:24 +0100274 return -EINVAL;
Philipp Maierfbf66102017-04-09 12:32:51 +0200275 }
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100276 if (!TLVP_PRESENT(tp, GSM0808_IE_LAYER_3_INFORMATION)) {
Harald Welte1f477442018-02-09 01:49:01 +0100277 LOGP(DBSSAP, LOGL_ERROR, "Mandatory LAYER 3 INFORMATION not present -- discarding message!\n");
Harald Weltea172e9e2018-02-09 21:33:24 +0100278 return -EINVAL;
Philipp Maierfbf66102017-04-09 12:32:51 +0200279 }
280
Stefan Sperlingbe7e0692018-03-14 14:00:00 +0100281 /* Parse Cell ID element -- this should yield a cell identifier "list" with 1 element. */
282
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100283 data_length = TLVP_LEN(tp, GSM0808_IE_CELL_IDENTIFIER);
284 data = TLVP_VAL(tp, GSM0808_IE_CELL_IDENTIFIER);
Stefan Sperlingbe7e0692018-03-14 14:00:00 +0100285 if (gsm0808_dec_cell_id_list2(&cil, data, data_length) < 0 || cil.id_list_len != 1) {
Harald Welte1f477442018-02-09 01:49:01 +0100286 LOGP(DBSSAP, LOGL_ERROR,
Stefan Sperlingbe7e0692018-03-14 14:00:00 +0100287 "Unable to parse element CELL IDENTIFIER -- discarding message!\n");
Harald Weltea172e9e2018-02-09 21:33:24 +0100288 return -EINVAL;
Philipp Maierfbf66102017-04-09 12:32:51 +0200289 }
Stefan Sperlingbe7e0692018-03-14 14:00:00 +0100290
291 /* Determine the LAC which we will use for this subscriber. */
292 switch (cil.id_discr) {
293 case CELL_IDENT_WHOLE_GLOBAL: {
294 const struct osmo_cell_global_id *id = &cil.id_list[0].global;
295 if (osmo_plmn_cmp(&id->lai.plmn, &network->plmn) != 0) {
296 LOGP(DBSSAP, LOGL_ERROR,
297 "WHOLE GLOBAL CELL IDENTIFIER does not match network MCC/MNC -- discarding message!\n");
298 return -EINVAL;
299 }
300 lac = id->lai.lac;
301 break;
302 }
303 case CELL_IDENT_LAC_AND_CI: {
304 const struct osmo_lac_and_ci_id *id = &cil.id_list[0].lac_and_ci;
305 lac = id->lac;
306 break;
307 }
308 case CELL_IDENT_LAI_AND_LAC: {
309 const struct osmo_location_area_id *id = &cil.id_list[0].lai_and_lac;
310 if (osmo_plmn_cmp(&id->plmn, &network->plmn) != 0) {
311 LOGP(DBSSAP, LOGL_ERROR,
312 "LAI AND LAC CELL IDENTIFIER does not match network MCC/MNC -- discarding message!\n");
313 return -EINVAL;
314 }
315 lac = id->lac;
316 break;
317 }
318 case CELL_IDENT_LAC:
319 lac = cil.id_list[0].lac;
320 break;
321
322 case CELL_IDENT_CI:
323 case CELL_IDENT_NO_CELL:
324 case CELL_IDENT_BSS:
Harald Welte1f477442018-02-09 01:49:01 +0100325 LOGP(DBSSAP, LOGL_ERROR,
Stefan Sperlingbe7e0692018-03-14 14:00:00 +0100326 "CELL IDENTIFIER does not specify a LAC -- discarding message!\n");
327 return -EINVAL;
328
329 default:
330 LOGP(DBSSAP, LOGL_ERROR,
331 "Unable to parse element CELL IDENTIFIER (unknown cell identification discriminator 0x%x) "
332 "-- discarding message!\n", cil.id_discr);
Harald Weltea172e9e2018-02-09 21:33:24 +0100333 return -EINVAL;
Philipp Maierfbf66102017-04-09 12:32:51 +0200334 }
Philipp Maierfbf66102017-04-09 12:32:51 +0200335
336 /* Parse Layer 3 Information element */
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100337 msg->l3h = (uint8_t*)TLVP_VAL(tp, GSM0808_IE_LAYER_3_INFORMATION);
Pau Espin Pedrol02a79d82017-12-15 18:55:43 +0100338 msgb_l3trim(msg, TLVP_LEN(tp, GSM0808_IE_LAYER_3_INFORMATION));
Philipp Maierfbf66102017-04-09 12:32:51 +0200339
Harald Welte5060f562018-03-18 21:55:37 +0100340 if (msgb_l3len(msg) < sizeof(struct gsm48_hdr)) {
341 LOGP(DBSSAP, LOGL_ERROR, "COMPL_L3 with too short L3 (%d) -- discarding\n",
342 msgb_l3len(msg));
343 return -ENODATA;
344 }
345
Philipp Maierfbf66102017-04-09 12:32:51 +0200346 /* Create new subscriber context */
Stefan Sperlingbe7e0692018-03-14 14:00:00 +0100347 conn = subscr_conn_allocate_a(a_conn_info, network, lac, scu, a_conn_info->conn_id);
Philipp Maierfbf66102017-04-09 12:32:51 +0200348
349 /* Handover location update to the MSC code */
Philipp Maierfbf66102017-04-09 12:32:51 +0200350 rc = msc_compl_l3(conn, msg, 0);
Philipp Maier4502f5f2017-09-07 11:39:58 +0200351
Philipp Maierfbf66102017-04-09 12:32:51 +0200352 if (rc == MSC_CONN_ACCEPT) {
Harald Weltef0dc1be2018-02-09 00:37:56 +0100353 LOGP(DMSC, LOGL_INFO, "User has been accepted by MSC.\n");
Philipp Maierfbf66102017-04-09 12:32:51 +0200354 return 0;
355 } else if (rc == MSC_CONN_REJECT)
Harald Weltef0dc1be2018-02-09 00:37:56 +0100356 LOGP(DMSC, LOGL_INFO, "User has been rejected by MSC.\n");
Philipp Maierfbf66102017-04-09 12:32:51 +0200357 else
Harald Weltef0dc1be2018-02-09 00:37:56 +0100358 LOGP(DMSC, LOGL_INFO, "User has been rejected by MSC (unknown error)\n");
Philipp Maierfbf66102017-04-09 12:32:51 +0200359
360 return -EINVAL;
Philipp Maierfbf66102017-04-09 12:32:51 +0200361}
362
363/* Endpoint to handle BSSMAP classmark update */
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100364static int bssmap_rx_classmark_upd(struct gsm_subscriber_connection *conn, struct msgb *msg,
365 struct tlv_parsed *tp)
Philipp Maierfbf66102017-04-09 12:32:51 +0200366{
Philipp Maierfbf66102017-04-09 12:32:51 +0200367 const uint8_t *cm2 = NULL;
368 const uint8_t *cm3 = NULL;
369 uint8_t cm2_len = 0;
370 uint8_t cm3_len = 0;
371
Harald Weltefb7ba912018-02-09 01:05:27 +0100372 LOGPCONN(conn, LOGL_DEBUG, "Rx BSSMAP CLASSMARK UPDATE\n");
Philipp Maierfbf66102017-04-09 12:32:51 +0200373
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100374 if (!TLVP_PRESENT(tp, GSM0808_IE_CLASSMARK_INFORMATION_T2)) {
Harald Welte6de46592018-02-09 00:53:17 +0100375 LOGPCONN(conn, LOGL_ERROR, "Mandatory Classmark Information Type 2 not present -- discarding message!\n");
Harald Weltea172e9e2018-02-09 21:33:24 +0100376 return -EINVAL;
Philipp Maierfbf66102017-04-09 12:32:51 +0200377 }
378
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100379 cm2 = TLVP_VAL(tp, GSM0808_IE_CLASSMARK_INFORMATION_T2);
380 cm2_len = TLVP_LEN(tp, GSM0808_IE_CLASSMARK_INFORMATION_T2);
Philipp Maierfbf66102017-04-09 12:32:51 +0200381
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100382 if (TLVP_PRESENT(tp, GSM0808_IE_CLASSMARK_INFORMATION_T3)) {
383 cm3 = TLVP_VAL(tp, GSM0808_IE_CLASSMARK_INFORMATION_T3);
384 cm3_len = TLVP_LEN(tp, GSM0808_IE_CLASSMARK_INFORMATION_T3);
Philipp Maierfbf66102017-04-09 12:32:51 +0200385 }
386
387 /* Inform MSC about the classmark change */
388 msc_classmark_chg(conn, cm2, cm2_len, cm3, cm3_len);
389
Philipp Maierfbf66102017-04-09 12:32:51 +0200390 return 0;
Philipp Maierfbf66102017-04-09 12:32:51 +0200391}
392
393/* Endpoint to handle BSSMAP cipher mode complete */
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100394static int bssmap_rx_ciph_compl(struct gsm_subscriber_connection *conn, struct msgb *msg,
395 struct tlv_parsed *tp)
Philipp Maierfbf66102017-04-09 12:32:51 +0200396{
397 /* FIXME: The field GSM0808_IE_LAYER_3_MESSAGE_CONTENTS is optional by
398 * means of the specification. So there can be messages without L3 info.
399 * In this case, the code will crash becrause msc_cipher_mode_compl()
400 * is not able to deal with msg = NULL and apperently
401 * msc_cipher_mode_compl() was never meant to be used without L3 data.
402 * This needs to be discussed further! */
403
Philipp Maierfbf66102017-04-09 12:32:51 +0200404 uint8_t alg_id = 1;
405
Harald Weltefb7ba912018-02-09 01:05:27 +0100406 LOGPCONN(conn, LOGL_DEBUG, "Rx BSSMAP CIPHER MODE COMPLETE\n");
Philipp Maierfbf66102017-04-09 12:32:51 +0200407
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100408 if (TLVP_PRESENT(tp, GSM0808_IE_CHOSEN_ENCR_ALG)) {
409 alg_id = TLVP_VAL(tp, GSM0808_IE_CHOSEN_ENCR_ALG)[0] - 1;
Philipp Maierfbf66102017-04-09 12:32:51 +0200410 }
411
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100412 if (TLVP_PRESENT(tp, GSM0808_IE_LAYER_3_MESSAGE_CONTENTS)) {
413 msg->l3h = (uint8_t*)TLVP_VAL(tp, GSM0808_IE_LAYER_3_MESSAGE_CONTENTS);
Pau Espin Pedrol02a79d82017-12-15 18:55:43 +0100414 msgb_l3trim(msg, TLVP_LEN(tp, GSM0808_IE_LAYER_3_MESSAGE_CONTENTS));
Philipp Maierfbf66102017-04-09 12:32:51 +0200415 } else {
Philipp Maierfbf66102017-04-09 12:32:51 +0200416 msg = NULL;
417 }
418
Philipp Maier4502f5f2017-09-07 11:39:58 +0200419 /* Hand over cipher mode complete message to the MSC */
Philipp Maierfbf66102017-04-09 12:32:51 +0200420 msc_cipher_mode_compl(conn, msg, alg_id);
421
422 return 0;
Philipp Maierfbf66102017-04-09 12:32:51 +0200423}
424
425/* Endpoint to handle BSSMAP cipher mode reject */
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100426static int bssmap_rx_ciph_rej(struct gsm_subscriber_connection *conn,
427 struct msgb *msg, struct tlv_parsed *tp)
Philipp Maierfbf66102017-04-09 12:32:51 +0200428{
Philipp Maierfbf66102017-04-09 12:32:51 +0200429 uint8_t cause;
430
Harald Weltefb7ba912018-02-09 01:05:27 +0100431 LOGPCONN(conn, LOGL_NOTICE, "RX BSSMAP CIPHER MODE REJECT\n");
Philipp Maierfbf66102017-04-09 12:32:51 +0200432
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100433 if (!TLVP_PRESENT(tp, BSS_MAP_MSG_CIPHER_MODE_REJECT)) {
Harald Welte6de46592018-02-09 00:53:17 +0100434 LOGPCONN(conn, LOGL_ERROR, "Cause code is missing -- discarding message!\n");
Harald Weltea172e9e2018-02-09 21:33:24 +0100435 return -EINVAL;
Philipp Maierfbf66102017-04-09 12:32:51 +0200436 }
437
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100438 cause = TLVP_VAL(tp, BSS_MAP_MSG_CIPHER_MODE_REJECT)[0];
Harald Welte6de46592018-02-09 00:53:17 +0100439 LOGPCONN(conn, LOGL_NOTICE, "Cipher mode rejection cause: %i\n", cause);
Philipp Maierfbf66102017-04-09 12:32:51 +0200440
441 /* FIXME: Can we do something meaningful here? e.g. report to the
442 * msc code somehow that the cipher mode command has failed. */
443
Philipp Maierfbf66102017-04-09 12:32:51 +0200444 return 0;
Philipp Maierfbf66102017-04-09 12:32:51 +0200445}
446
447/* Endpoint to handle BSSMAP assignment failure */
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100448static int bssmap_rx_ass_fail(struct gsm_subscriber_connection *conn, struct msgb *msg,
449 struct tlv_parsed *tp)
Philipp Maierfbf66102017-04-09 12:32:51 +0200450{
Philipp Maierfbf66102017-04-09 12:32:51 +0200451 uint8_t cause;
452 uint8_t *rr_cause_ptr = NULL;
453 uint8_t rr_cause;
454
Harald Weltefb7ba912018-02-09 01:05:27 +0100455 LOGPCONN(conn, LOGL_NOTICE, "Rx BSSMAP ASSIGNMENT FAILURE message\n");
Philipp Maierfbf66102017-04-09 12:32:51 +0200456
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100457 if (!TLVP_PRESENT(tp, GSM0808_IE_CAUSE)) {
Harald Welte6de46592018-02-09 00:53:17 +0100458 LOGPCONN(conn, LOGL_ERROR, "Cause code is missing -- discarding message!\n");
Harald Weltea172e9e2018-02-09 21:33:24 +0100459 return -EINVAL;
Philipp Maierfbf66102017-04-09 12:32:51 +0200460 }
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100461 cause = TLVP_VAL(tp, GSM0808_IE_CAUSE)[0];
Philipp Maierfbf66102017-04-09 12:32:51 +0200462
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100463 if (TLVP_PRESENT(tp, GSM0808_IE_RR_CAUSE)) {
464 rr_cause = TLVP_VAL(tp, GSM0808_IE_RR_CAUSE)[0];
Philipp Maierfbf66102017-04-09 12:32:51 +0200465 rr_cause_ptr = &rr_cause;
466 }
467
468 /* FIXME: In AoIP, the Assignment failure will carry also an optional
469 * Codec List (BSS Supported) element. It has to be discussed if we
470 * can ignore this element. If not, The msc_assign_fail() function
471 * call has to change. However msc_assign_fail() does nothing in the
472 * end. So probably we can just leave it as it is. Even for AoIP */
473
474 /* Inform the MSC about the assignment failure event */
475 msc_assign_fail(conn, cause, rr_cause_ptr);
476
Philipp Maierfbf66102017-04-09 12:32:51 +0200477 return 0;
Philipp Maierfbf66102017-04-09 12:32:51 +0200478}
479
480/* Endpoint to handle sapi "n" reject */
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100481static int bssmap_rx_sapi_n_rej(struct gsm_subscriber_connection *conn, struct msgb *msg,
482 struct tlv_parsed *tp)
Philipp Maierfbf66102017-04-09 12:32:51 +0200483{
Philipp Maierfbf66102017-04-09 12:32:51 +0200484 uint8_t dlci;
485
Harald Welte35284462018-02-09 01:31:29 +0100486 LOGPCONN(conn, LOGL_NOTICE, "Rx BSSMAP SAPI-N-REJECT message\n");
Philipp Maierfbf66102017-04-09 12:32:51 +0200487
488 /* Note: The MSC code seems not to care about the cause code, but by
489 * the specification it is mandatory, so we check its presence. See
490 * also 3GPP TS 48.008 3.2.1.34 SAPI "n" REJECT */
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100491 if (!TLVP_PRESENT(tp, GSM0808_IE_CAUSE)) {
Harald Welte6de46592018-02-09 00:53:17 +0100492 LOGPCONN(conn, LOGL_ERROR, "Cause code is missing -- discarding message!\n");
Harald Weltea172e9e2018-02-09 21:33:24 +0100493 return -EINVAL;
Philipp Maierfbf66102017-04-09 12:32:51 +0200494 }
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100495 if (!TLVP_PRESENT(tp, GSM0808_IE_DLCI)) {
Harald Welte6de46592018-02-09 00:53:17 +0100496 LOGPCONN(conn, LOGL_ERROR, "DLCI is missing -- discarding message!\n");
Harald Weltea172e9e2018-02-09 21:33:24 +0100497 return -EINVAL;
Philipp Maierfbf66102017-04-09 12:32:51 +0200498 }
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100499 dlci = TLVP_VAL(tp, GSM0808_IE_DLCI)[0];
Philipp Maierfbf66102017-04-09 12:32:51 +0200500
501 /* Inform the MSC about the sapi "n" reject event */
502 msc_sapi_n_reject(conn, dlci);
503
Philipp Maierfbf66102017-04-09 12:32:51 +0200504 return 0;
Philipp Maierfbf66102017-04-09 12:32:51 +0200505}
506
507/* Endpoint to handle assignment complete */
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100508static int bssmap_rx_ass_compl(struct gsm_subscriber_connection *conn, struct msgb *msg,
509 struct tlv_parsed *tp)
Philipp Maierfbf66102017-04-09 12:32:51 +0200510{
Neels Hofmeyr6c8afe12017-09-04 01:03:58 +0200511 struct mgcp_client *mgcp;
Philipp Maierfbf66102017-04-09 12:32:51 +0200512 struct sockaddr_storage rtp_addr;
513 struct sockaddr_in *rtp_addr_in;
514 int rc;
515
Neels Hofmeyr6c8afe12017-09-04 01:03:58 +0200516 mgcp = conn->network->mgw.client;
Philipp Maierfbf66102017-04-09 12:32:51 +0200517 OSMO_ASSERT(mgcp);
518
Harald Welte35284462018-02-09 01:31:29 +0100519 LOGPCONN(conn, LOGL_INFO, "Rx BSSMAP ASSIGNMENT COMPLETE message\n");
Philipp Maierfbf66102017-04-09 12:32:51 +0200520
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100521 if (!TLVP_PRESENT(tp, GSM0808_IE_AOIP_TRASP_ADDR)) {
Harald Welte6de46592018-02-09 00:53:17 +0100522 LOGPCONN(conn, LOGL_ERROR, "AoIP transport identifier missing -- discarding message!\n");
Harald Weltea172e9e2018-02-09 21:33:24 +0100523 return -EINVAL;
Philipp Maierfbf66102017-04-09 12:32:51 +0200524 }
525
526 /* Decode AoIP transport address element */
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100527 rc = gsm0808_dec_aoip_trasp_addr(&rtp_addr, TLVP_VAL(tp, GSM0808_IE_AOIP_TRASP_ADDR),
528 TLVP_LEN(tp, GSM0808_IE_AOIP_TRASP_ADDR));
Philipp Maierfbf66102017-04-09 12:32:51 +0200529 if (rc < 0) {
Harald Welte6de46592018-02-09 00:53:17 +0100530 LOGPCONN(conn, LOGL_ERROR, "Unable to decode aoip transport address.\n");
Harald Weltea172e9e2018-02-09 21:33:24 +0100531 return -EINVAL;
Philipp Maierfbf66102017-04-09 12:32:51 +0200532 }
533
534 /* use address / port supplied with the AoIP
535 * transport address element */
536 if (rtp_addr.ss_family == AF_INET) {
537 rtp_addr_in = (struct sockaddr_in *)&rtp_addr;
Philipp Maier621ba032017-11-07 17:19:25 +0100538 msc_mgcp_ass_complete(conn, osmo_ntohs(rtp_addr_in->sin_port), inet_ntoa(rtp_addr_in->sin_addr));
Philipp Maierfbf66102017-04-09 12:32:51 +0200539 } else {
Harald Welte6de46592018-02-09 00:53:17 +0100540 LOGPCONN(conn, LOGL_ERROR, "Unsopported addressing scheme. (supports only IPV4)\n");
Harald Weltea172e9e2018-02-09 21:33:24 +0100541 return -EINVAL;
Philipp Maierfbf66102017-04-09 12:32:51 +0200542 }
543
544 /* FIXME: Seems to be related to authentication or,
545 encryption. Is this really in the right place? */
546 msc_rx_sec_mode_compl(conn);
547
Philipp Maierfbf66102017-04-09 12:32:51 +0200548 return 0;
Philipp Maierfbf66102017-04-09 12:32:51 +0200549}
550
551/* Handle incoming connection oriented BSSMAP messages */
552static int rx_bssmap(struct osmo_sccp_user *scu, const struct a_conn_info *a_conn_info, struct msgb *msg)
553{
Harald Weltec27ef652018-02-09 01:23:25 +0100554 struct gsm_subscriber_connection *conn;
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100555 struct tlv_parsed tp;
Pau Espin Pedrol75559282018-02-14 14:12:24 +0100556 int rc;
Harald Weltec27ef652018-02-09 01:23:25 +0100557
Philipp Maierfbf66102017-04-09 12:32:51 +0200558 if (msgb_l3len(msg) < 1) {
Harald Welte1f477442018-02-09 01:49:01 +0100559 LOGP(DBSSAP, LOGL_NOTICE, "Error: No data received -- discarding message!\n");
Philipp Maierfbf66102017-04-09 12:32:51 +0200560 return -1;
561 }
562
Pau Espin Pedrol75559282018-02-14 14:12:24 +0100563 rc = tlv_parse(&tp, gsm0808_att_tlvdef(), msg->l3h + 1, msgb_l3len(msg) - 1, 0, 0);
564 if (rc < 0) {
565 LOGP(DBSSAP, LOGL_ERROR, "Failed parsing TLV -- discarding message! %s\n",
566 osmo_hexdump(msg->l3h, msgb_l3len(msg)));
567 return -EINVAL;
568 }
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100569
Harald Weltec27ef652018-02-09 01:23:25 +0100570 /* Only message types allowed without a 'conn' */
571 switch (msg->l3h[0]) {
572 case BSS_MAP_MSG_COMPLETE_LAYER_3:
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100573 return bssmap_rx_l3_compl(scu, a_conn_info, msg, &tp);
Harald Weltec27ef652018-02-09 01:23:25 +0100574 case BSS_MAP_MSG_CLEAR_COMPLETE:
575 return bssmap_rx_clear_complete(scu, a_conn_info, msg);
576 default:
577 break;
578 }
579
580 conn = subscr_conn_lookup_a(a_conn_info->network, a_conn_info->conn_id);
581 if (!conn) {
Harald Welte1f477442018-02-09 01:49:01 +0100582 LOGP(DBSSAP, LOGL_ERROR, "Couldn't find subscr_conn for conn_id=%d\n", a_conn_info->conn_id);
Harald Weltec27ef652018-02-09 01:23:25 +0100583 return -EINVAL;
584 }
585
586 LOGPCONN(conn, LOGL_DEBUG, "Rx BSSMAP DT1 %s\n", gsm0808_bssmap_name(msg->l3h[0]));
Philipp Maierfbf66102017-04-09 12:32:51 +0200587
588 switch (msg->l3h[0]) {
589 case BSS_MAP_MSG_CLEAR_RQST:
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100590 return bssmap_rx_clear_rqst(conn, msg, &tp);
Philipp Maierfbf66102017-04-09 12:32:51 +0200591 case BSS_MAP_MSG_CLASSMARK_UPDATE:
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100592 return bssmap_rx_classmark_upd(conn, msg, &tp);
Philipp Maierfbf66102017-04-09 12:32:51 +0200593 case BSS_MAP_MSG_CIPHER_MODE_COMPLETE:
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100594 return bssmap_rx_ciph_compl(conn, msg, &tp);
Philipp Maierfbf66102017-04-09 12:32:51 +0200595 case BSS_MAP_MSG_CIPHER_MODE_REJECT:
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100596 return bssmap_rx_ciph_rej(conn, msg, &tp);
Philipp Maierfbf66102017-04-09 12:32:51 +0200597 case BSS_MAP_MSG_ASSIGMENT_FAILURE:
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100598 return bssmap_rx_ass_fail(conn, msg, &tp);
Philipp Maierfbf66102017-04-09 12:32:51 +0200599 case BSS_MAP_MSG_SAPI_N_REJECT:
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100600 return bssmap_rx_sapi_n_rej(conn, msg, &tp);
Philipp Maierfbf66102017-04-09 12:32:51 +0200601 case BSS_MAP_MSG_ASSIGMENT_COMPLETE:
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100602 return bssmap_rx_ass_compl(conn, msg, &tp);
Philipp Maierfbf66102017-04-09 12:32:51 +0200603 default:
Harald Weltec27ef652018-02-09 01:23:25 +0100604 LOGPCONN(conn, LOGL_ERROR, "Unimplemented msg type: %s\n", gsm0808_bssmap_name(msg->l3h[0]));
Philipp Maierfbf66102017-04-09 12:32:51 +0200605 return -EINVAL;
606 }
607
608 return -EINVAL;
609}
610
Harald Weltea172e9e2018-02-09 21:33:24 +0100611/* Endpoint to handle regular BSSAP DTAP messages. No ownership of 'msg' is passed on! */
Philipp Maierfbf66102017-04-09 12:32:51 +0200612static int rx_dtap(const struct osmo_sccp_user *scu, const struct a_conn_info *a_conn_info, struct msgb *msg)
613{
614 struct gsm_network *network = a_conn_info->network;
615 struct gsm_subscriber_connection *conn;
616
617 conn = subscr_conn_lookup_a(network, a_conn_info->conn_id);
618 if (!conn) {
Philipp Maierfbf66102017-04-09 12:32:51 +0200619 return -EINVAL;
620 }
621
Harald Weltefb7ba912018-02-09 01:05:27 +0100622 LOGPCONN(conn, LOGL_DEBUG, "Rx DTAP %s\n", msgb_hexdump_l2(msg));
Philipp Maierfbf66102017-04-09 12:32:51 +0200623
624 /* msc_dtap expects the dtap payload in l3h */
625 msg->l3h = msg->l2h + 3;
626
Philipp Maier4502f5f2017-09-07 11:39:58 +0200627 /* Forward dtap payload into the msc */
Philipp Maierfbf66102017-04-09 12:32:51 +0200628 msc_dtap(conn, conn->a.conn_id, msg);
629
630 return 0;
631}
632
Harald Weltea172e9e2018-02-09 21:33:24 +0100633/* Handle incoming connection oriented messages. No ownership of 'msg' is passed on! */
Neels Hofmeyrc1d69252017-12-18 04:06:04 +0100634int a_sccp_rx_dt(struct osmo_sccp_user *scu, const struct a_conn_info *a_conn_info, struct msgb *msg)
Philipp Maierfbf66102017-04-09 12:32:51 +0200635{
636 OSMO_ASSERT(scu);
637 OSMO_ASSERT(a_conn_info);
638 OSMO_ASSERT(msg);
639
Philipp Maierfbf66102017-04-09 12:32:51 +0200640 if (msgb_l2len(msg) < sizeof(struct bssmap_header)) {
Harald Welte1f477442018-02-09 01:49:01 +0100641 LOGP(DBSSAP, LOGL_NOTICE, "The header is too short -- discarding message!\n");
Philipp Maier4502f5f2017-09-07 11:39:58 +0200642 return -EINVAL;
Philipp Maierfbf66102017-04-09 12:32:51 +0200643 }
644
645 switch (msg->l2h[0]) {
646 case BSSAP_MSG_BSS_MANAGEMENT:
647 msg->l3h = &msg->l2h[sizeof(struct bssmap_header)];
648 return rx_bssmap(scu, a_conn_info, msg);
Philipp Maierfbf66102017-04-09 12:32:51 +0200649 case BSSAP_MSG_DTAP:
650 return rx_dtap(scu, a_conn_info, msg);
Philipp Maierfbf66102017-04-09 12:32:51 +0200651 default:
Harald Welte1f477442018-02-09 01:49:01 +0100652 LOGP(DBSSAP, LOGL_ERROR, "Unimplemented BSSAP msg type: %s\n", gsm0808_bssap_name(msg->l2h[0]));
Philipp Maierfbf66102017-04-09 12:32:51 +0200653 return -EINVAL;
654 }
655
656 return -EINVAL;
657}