blob: f24fb05a97c420543c3cbda9137bdf5c535c2d7e [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
Neels Hofmeyr93c74632018-04-02 23:10:28 +020057 conn = msc_subscr_conn_alloc(network, RAN_GERAN_A, lac);
Philipp Maierfbf66102017-04-09 12:32:51 +020058 if (!conn)
59 return NULL;
60
Philipp Maierfbf66102017-04-09 12:32:51 +020061 conn->a.conn_id = conn_id;
62 conn->a.scu = scu;
63
64 /* Also backup the calling address of the BSC, this allows us to
65 * identify later which BSC is responsible for this subscriber connection */
Harald Welte54a10ef2018-02-09 00:09:16 +010066 memcpy(&conn->a.bsc_addr, &a_conn_info->bsc->bsc_addr, sizeof(conn->a.bsc_addr));
Philipp Maierfbf66102017-04-09 12:32:51 +020067
Harald Welte6de46592018-02-09 00:53:17 +010068 LOGPCONN(conn, LOGL_DEBUG, "A-Interface subscriber connection successfully allocated!\n");
Philipp Maierfbf66102017-04-09 12:32:51 +020069 return conn;
70}
71
72/* Return an existing A subscriber connection record for the given
73 * connection IDs, or return NULL if not found. */
74static struct gsm_subscriber_connection *subscr_conn_lookup_a(const struct gsm_network *network, int conn_id)
75{
76 struct gsm_subscriber_connection *conn;
77
78 OSMO_ASSERT(network);
79
80 DEBUGP(DMSC, "Looking for A subscriber: conn_id %i\n", conn_id);
81
82 /* FIXME: log_subscribers() is defined in iucs.c as static inline, if
83 * maybe this function should be public to reach it from here? */
84 /* log_subscribers(network); */
85
86 llist_for_each_entry(conn, &network->subscr_conns, entry) {
87 if (conn->via_ran == RAN_GERAN_A && conn->a.conn_id == conn_id) {
Harald Welte6de46592018-02-09 00:53:17 +010088 LOGPCONN(conn, LOGL_DEBUG, "Found A subscriber for conn_id %i\n", conn_id);
Philipp Maierfbf66102017-04-09 12:32:51 +020089 return conn;
90 }
91 }
92 DEBUGP(DMSC, "No A subscriber found for conn_id %i\n", conn_id);
93 return NULL;
94}
95
96/*
97 * BSSMAP handling for UNITDATA
98 */
99
100/* Endpoint to handle BSSMAP reset */
101static void bssmap_rx_reset(struct osmo_sccp_user *scu, const struct a_conn_info *a_conn_info, struct msgb *msg)
102{
103 struct gsm_network *network = a_conn_info->network;
104 struct osmo_ss7_instance *ss7;
105
106 ss7 = osmo_ss7_instance_find(network->a.cs7_instance);
107 OSMO_ASSERT(ss7);
108
Harald Welte1f477442018-02-09 01:49:01 +0100109 LOGP(DBSSAP, LOGL_NOTICE, "Rx BSSMAP RESET from BSC %s, sending RESET ACK\n",
Harald Welte54a10ef2018-02-09 00:09:16 +0100110 osmo_sccp_addr_name(ss7, &a_conn_info->bsc->bsc_addr));
111 osmo_sccp_tx_unitdata_msg(scu, &a_conn_info->bsc->msc_addr, &a_conn_info->bsc->bsc_addr,
112 gsm0808_create_reset_ack());
Philipp Maierfbf66102017-04-09 12:32:51 +0200113
114 /* Make sure all orphand subscriber connections will be cleard */
Harald Welte54a10ef2018-02-09 00:09:16 +0100115 a_clear_all(scu, &a_conn_info->bsc->bsc_addr);
116
Philipp Maierf913e5f2018-05-07 10:15:49 +0200117 if (!a_conn_info->bsc->reset_fsm)
Harald Welte54a10ef2018-02-09 00:09:16 +0100118 a_start_reset(a_conn_info->bsc, true);
Harald Welte4de01152018-03-18 22:20:34 +0100119
120 /* Treat an incoming RESET like an ACK to any RESET request we may have just sent.
121 * After all, what we wanted is the A interface to be reset, which we now know has happened. */
Philipp Maierf913e5f2018-05-07 10:15:49 +0200122 a_reset_ack_confirm(a_conn_info->bsc->reset_fsm);
Philipp Maierfbf66102017-04-09 12:32:51 +0200123}
124
125/* Endpoint to handle BSSMAP reset acknowlegement */
126static void bssmap_rx_reset_ack(const struct osmo_sccp_user *scu, const struct a_conn_info *a_conn_info,
127 struct msgb *msg)
128{
129
130 struct gsm_network *network = a_conn_info->network;
131 struct osmo_ss7_instance *ss7;
132
133 ss7 = osmo_ss7_instance_find(network->a.cs7_instance);
134 OSMO_ASSERT(ss7);
135
Philipp Maierf913e5f2018-05-07 10:15:49 +0200136 if (a_conn_info->bsc->reset_fsm == NULL) {
Harald Welte1f477442018-02-09 01:49:01 +0100137 LOGP(DBSSAP, LOGL_ERROR, "Received RESET ACK from an unknown BSC %s, ignoring...\n",
Harald Welte54a10ef2018-02-09 00:09:16 +0100138 osmo_sccp_addr_name(ss7, &a_conn_info->bsc->bsc_addr));
Harald Weltea172e9e2018-02-09 21:33:24 +0100139 return;
Philipp Maierfbf66102017-04-09 12:32:51 +0200140 }
141
Harald Welte1f477442018-02-09 01:49:01 +0100142 LOGP(DBSSAP, LOGL_NOTICE, "Received RESET ACK from BSC %s\n",
Harald Welte54a10ef2018-02-09 00:09:16 +0100143 osmo_sccp_addr_name(ss7, &a_conn_info->bsc->bsc_addr));
Philipp Maierfbf66102017-04-09 12:32:51 +0200144
145 /* Confirm that we managed to get the reset ack message
146 * towards the connection reset logic */
Philipp Maierf913e5f2018-05-07 10:15:49 +0200147 a_reset_ack_confirm(a_conn_info->bsc->reset_fsm);
Philipp Maierfbf66102017-04-09 12:32:51 +0200148}
149
150/* Handle UNITDATA BSSMAP messages */
151static void bssmap_rcvmsg_udt(struct osmo_sccp_user *scu, const struct a_conn_info *a_conn_info, struct msgb *msg)
152{
153 /* Note: When in the MSC role, RESET ACK is the only valid message that
154 * can be received via UNITDATA */
155
156 if (msgb_l3len(msg) < 1) {
Harald Welte1f477442018-02-09 01:49:01 +0100157 LOGP(DBSSAP, LOGL_NOTICE, "Error: No data received -- discarding message!\n");
Philipp Maierfbf66102017-04-09 12:32:51 +0200158 return;
159 }
160
Harald Welte1f477442018-02-09 01:49:01 +0100161 LOGP(DBSSAP, LOGL_DEBUG, "Rx BSSMAP UDT %s\n", gsm0808_bssmap_name(msg->l3h[0]));
Philipp Maierfbf66102017-04-09 12:32:51 +0200162
163 switch (msg->l3h[0]) {
164 case BSS_MAP_MSG_RESET:
165 bssmap_rx_reset(scu, a_conn_info, msg);
166 break;
167 case BSS_MAP_MSG_RESET_ACKNOWLEDGE:
168 bssmap_rx_reset_ack(scu, a_conn_info, msg);
169 break;
170 default:
Harald Welte1f477442018-02-09 01:49:01 +0100171 LOGP(DBSSAP, LOGL_NOTICE, "Unimplemented message format: %s -- message discarded!\n",
Philipp Maierfbf66102017-04-09 12:32:51 +0200172 gsm0808_bssmap_name(msg->l3h[0]));
Philipp Maierfbf66102017-04-09 12:32:51 +0200173 }
174}
175
176/* Receive incoming connection less data messages via sccp */
Neels Hofmeyrc1d69252017-12-18 04:06:04 +0100177void 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 +0200178{
179 /* Note: The only valid message type that can be received
180 * via UNITDATA are BSS Management messages */
181 struct bssmap_header *bs;
182
183 OSMO_ASSERT(scu);
184 OSMO_ASSERT(a_conn_info);
185 OSMO_ASSERT(msg);
186
Harald Welte1f477442018-02-09 01:49:01 +0100187 LOGP(DBSSAP, LOGL_DEBUG, "Rx BSSMAP UDT: %s\n", msgb_hexdump_l2(msg));
Philipp Maierfbf66102017-04-09 12:32:51 +0200188
189 if (msgb_l2len(msg) < sizeof(*bs)) {
Harald Welte1f477442018-02-09 01:49:01 +0100190 LOGP(DBSSAP, LOGL_ERROR, "Error: Header is too short -- discarding message!\n");
Philipp Maierfbf66102017-04-09 12:32:51 +0200191 return;
192 }
193
194 bs = (struct bssmap_header *)msgb_l2(msg);
195 if (bs->length < msgb_l2len(msg) - sizeof(*bs)) {
Harald Welte1f477442018-02-09 01:49:01 +0100196 LOGP(DBSSAP, LOGL_ERROR, "Error: Message is too short -- discarding message!\n");
Philipp Maierfbf66102017-04-09 12:32:51 +0200197 return;
198 }
199
200 switch (bs->type) {
201 case BSSAP_MSG_BSS_MANAGEMENT:
202 msg->l3h = &msg->l2h[sizeof(struct bssmap_header)];
203 bssmap_rcvmsg_udt(scu, a_conn_info, msg);
204 break;
205 default:
Harald Welte1f477442018-02-09 01:49:01 +0100206 LOGP(DBSSAP, LOGL_ERROR,
Philipp Maierfbf66102017-04-09 12:32:51 +0200207 "Error: Unimplemented message type: %s -- message discarded!\n", gsm0808_bssmap_name(bs->type));
Philipp Maierfbf66102017-04-09 12:32:51 +0200208 }
209}
210
211/*
212 * BSSMAP handling for connection oriented data
213 */
214
215/* Endpoint to handle BSSMAP clear request */
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100216static int bssmap_rx_clear_rqst(struct gsm_subscriber_connection *conn,
217 struct msgb *msg, struct tlv_parsed *tp)
Philipp Maierfbf66102017-04-09 12:32:51 +0200218{
Philipp Maierfbf66102017-04-09 12:32:51 +0200219 uint8_t cause;
Philipp Maierfbf66102017-04-09 12:32:51 +0200220
Harald Welte35284462018-02-09 01:31:29 +0100221 LOGPCONN(conn, LOGL_INFO, "Rx BSSMAP CLEAR REQUEST\n");
Philipp Maierfbf66102017-04-09 12:32:51 +0200222
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100223 if (!TLVP_PRESENT(tp, GSM0808_IE_CAUSE)) {
Harald Welte1f477442018-02-09 01:49:01 +0100224 LOGP(DBSSAP, LOGL_ERROR, "Cause code is missing -- discarding message!\n");
Harald Weltea172e9e2018-02-09 21:33:24 +0100225 return -EINVAL;
Philipp Maierfbf66102017-04-09 12:32:51 +0200226 }
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100227 cause = TLVP_VAL(tp, GSM0808_IE_CAUSE)[0];
Philipp Maierfbf66102017-04-09 12:32:51 +0200228
Neels Hofmeyr2a5cd932018-04-06 01:07:42 +0200229 msc_subscr_conn_mo_close(conn, cause);
Philipp Maierfbf66102017-04-09 12:32:51 +0200230
Neels Hofmeyr2a5cd932018-04-06 01:07:42 +0200231 return 0;
Philipp Maierfbf66102017-04-09 12:32:51 +0200232}
233
234/* Endpoint to handle BSSMAP clear complete */
Harald Weltec27ef652018-02-09 01:23:25 +0100235static int bssmap_rx_clear_complete(struct osmo_sccp_user *scu,
Neels Hofmeyr4068ab22018-04-01 20:55:54 +0200236 const struct a_conn_info *a_conn_info,
237 struct gsm_subscriber_connection *conn)
Philipp Maierfbf66102017-04-09 12:32:51 +0200238{
239 int rc;
240
Neels Hofmeyr4068ab22018-04-01 20:55:54 +0200241 LOGPCONN(conn, LOGL_INFO, "Rx BSSMAP CLEAR COMPLETE, releasing SCCP connection\n");
242
243 if (conn)
244 msc_subscr_conn_rx_bssmap_clear_complete(conn);
245
Philipp Maierfbf66102017-04-09 12:32:51 +0200246 rc = osmo_sccp_tx_disconn(scu, a_conn_info->conn_id,
Harald Welte54a10ef2018-02-09 00:09:16 +0100247 NULL, SCCP_RELEASE_CAUSE_END_USER_ORIGINATED);
Philipp Maierfbf66102017-04-09 12:32:51 +0200248
249 /* Remove the record from the list with active connections. */
250 a_delete_bsc_con(a_conn_info->conn_id);
251
Philipp Maierfbf66102017-04-09 12:32:51 +0200252 return rc;
253}
254
255/* Endpoint to handle layer 3 complete messages */
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100256static int bssmap_rx_l3_compl(struct osmo_sccp_user *scu, const struct a_conn_info *a_conn_info,
257 struct msgb *msg, struct tlv_parsed *tp)
Philipp Maierfbf66102017-04-09 12:32:51 +0200258{
Stefan Sperlingbe7e0692018-03-14 14:00:00 +0100259 struct gsm0808_cell_id_list2 cil;
260 uint16_t lac = 0;
Philipp Maierfbf66102017-04-09 12:32:51 +0200261 uint8_t data_length;
262 const uint8_t *data;
263 int rc;
264
265 struct gsm_network *network = a_conn_info->network;
266 struct gsm_subscriber_connection *conn;
267
Harald Welte1f477442018-02-09 01:49:01 +0100268 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 +0200269
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100270 if (!TLVP_PRESENT(tp, GSM0808_IE_CELL_IDENTIFIER)) {
Harald Welte1f477442018-02-09 01:49:01 +0100271 LOGP(DBSSAP, LOGL_ERROR, "Mandatory CELL IDENTIFIER not present -- discarding message!\n");
Harald Weltea172e9e2018-02-09 21:33:24 +0100272 return -EINVAL;
Philipp Maierfbf66102017-04-09 12:32:51 +0200273 }
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100274 if (!TLVP_PRESENT(tp, GSM0808_IE_LAYER_3_INFORMATION)) {
Harald Welte1f477442018-02-09 01:49:01 +0100275 LOGP(DBSSAP, LOGL_ERROR, "Mandatory LAYER 3 INFORMATION not present -- discarding message!\n");
Harald Weltea172e9e2018-02-09 21:33:24 +0100276 return -EINVAL;
Philipp Maierfbf66102017-04-09 12:32:51 +0200277 }
278
Stefan Sperlingbe7e0692018-03-14 14:00:00 +0100279 /* Parse Cell ID element -- this should yield a cell identifier "list" with 1 element. */
280
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100281 data_length = TLVP_LEN(tp, GSM0808_IE_CELL_IDENTIFIER);
282 data = TLVP_VAL(tp, GSM0808_IE_CELL_IDENTIFIER);
Stefan Sperlingbe7e0692018-03-14 14:00:00 +0100283 if (gsm0808_dec_cell_id_list2(&cil, data, data_length) < 0 || cil.id_list_len != 1) {
Harald Welte1f477442018-02-09 01:49:01 +0100284 LOGP(DBSSAP, LOGL_ERROR,
Stefan Sperlingbe7e0692018-03-14 14:00:00 +0100285 "Unable to parse element CELL IDENTIFIER -- discarding message!\n");
Harald Weltea172e9e2018-02-09 21:33:24 +0100286 return -EINVAL;
Philipp Maierfbf66102017-04-09 12:32:51 +0200287 }
Stefan Sperlingbe7e0692018-03-14 14:00:00 +0100288
289 /* Determine the LAC which we will use for this subscriber. */
290 switch (cil.id_discr) {
291 case CELL_IDENT_WHOLE_GLOBAL: {
292 const struct osmo_cell_global_id *id = &cil.id_list[0].global;
293 if (osmo_plmn_cmp(&id->lai.plmn, &network->plmn) != 0) {
294 LOGP(DBSSAP, LOGL_ERROR,
295 "WHOLE GLOBAL CELL IDENTIFIER does not match network MCC/MNC -- discarding message!\n");
296 return -EINVAL;
297 }
298 lac = id->lai.lac;
299 break;
300 }
301 case CELL_IDENT_LAC_AND_CI: {
302 const struct osmo_lac_and_ci_id *id = &cil.id_list[0].lac_and_ci;
303 lac = id->lac;
304 break;
305 }
306 case CELL_IDENT_LAI_AND_LAC: {
307 const struct osmo_location_area_id *id = &cil.id_list[0].lai_and_lac;
308 if (osmo_plmn_cmp(&id->plmn, &network->plmn) != 0) {
309 LOGP(DBSSAP, LOGL_ERROR,
310 "LAI AND LAC CELL IDENTIFIER does not match network MCC/MNC -- discarding message!\n");
311 return -EINVAL;
312 }
313 lac = id->lac;
314 break;
315 }
316 case CELL_IDENT_LAC:
317 lac = cil.id_list[0].lac;
318 break;
319
320 case CELL_IDENT_CI:
321 case CELL_IDENT_NO_CELL:
322 case CELL_IDENT_BSS:
Harald Welte1f477442018-02-09 01:49:01 +0100323 LOGP(DBSSAP, LOGL_ERROR,
Stefan Sperlingbe7e0692018-03-14 14:00:00 +0100324 "CELL IDENTIFIER does not specify a LAC -- discarding message!\n");
325 return -EINVAL;
326
327 default:
328 LOGP(DBSSAP, LOGL_ERROR,
329 "Unable to parse element CELL IDENTIFIER (unknown cell identification discriminator 0x%x) "
330 "-- discarding message!\n", cil.id_discr);
Harald Weltea172e9e2018-02-09 21:33:24 +0100331 return -EINVAL;
Philipp Maierfbf66102017-04-09 12:32:51 +0200332 }
Philipp Maierfbf66102017-04-09 12:32:51 +0200333
334 /* Parse Layer 3 Information element */
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100335 msg->l3h = (uint8_t*)TLVP_VAL(tp, GSM0808_IE_LAYER_3_INFORMATION);
Pau Espin Pedrol02a79d82017-12-15 18:55:43 +0100336 msgb_l3trim(msg, TLVP_LEN(tp, GSM0808_IE_LAYER_3_INFORMATION));
Philipp Maierfbf66102017-04-09 12:32:51 +0200337
Harald Welte5060f562018-03-18 21:55:37 +0100338 if (msgb_l3len(msg) < sizeof(struct gsm48_hdr)) {
339 LOGP(DBSSAP, LOGL_ERROR, "COMPL_L3 with too short L3 (%d) -- discarding\n",
340 msgb_l3len(msg));
341 return -ENODATA;
342 }
343
Philipp Maierfbf66102017-04-09 12:32:51 +0200344 /* Create new subscriber context */
Stefan Sperlingbe7e0692018-03-14 14:00:00 +0100345 conn = subscr_conn_allocate_a(a_conn_info, network, lac, scu, a_conn_info->conn_id);
Philipp Maierfbf66102017-04-09 12:32:51 +0200346
347 /* Handover location update to the MSC code */
Philipp Maierfbf66102017-04-09 12:32:51 +0200348 rc = msc_compl_l3(conn, msg, 0);
Philipp Maier4502f5f2017-09-07 11:39:58 +0200349
Philipp Maierfbf66102017-04-09 12:32:51 +0200350 if (rc == MSC_CONN_ACCEPT) {
Harald Weltef0dc1be2018-02-09 00:37:56 +0100351 LOGP(DMSC, LOGL_INFO, "User has been accepted by MSC.\n");
Philipp Maierfbf66102017-04-09 12:32:51 +0200352 return 0;
353 } else if (rc == MSC_CONN_REJECT)
Harald Weltef0dc1be2018-02-09 00:37:56 +0100354 LOGP(DMSC, LOGL_INFO, "User has been rejected by MSC.\n");
Philipp Maierfbf66102017-04-09 12:32:51 +0200355 else
Harald Weltef0dc1be2018-02-09 00:37:56 +0100356 LOGP(DMSC, LOGL_INFO, "User has been rejected by MSC (unknown error)\n");
Philipp Maierfbf66102017-04-09 12:32:51 +0200357
358 return -EINVAL;
Philipp Maierfbf66102017-04-09 12:32:51 +0200359}
360
361/* Endpoint to handle BSSMAP classmark update */
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100362static int bssmap_rx_classmark_upd(struct gsm_subscriber_connection *conn, struct msgb *msg,
363 struct tlv_parsed *tp)
Philipp Maierfbf66102017-04-09 12:32:51 +0200364{
Philipp Maierfbf66102017-04-09 12:32:51 +0200365 const uint8_t *cm2 = NULL;
366 const uint8_t *cm3 = NULL;
367 uint8_t cm2_len = 0;
368 uint8_t cm3_len = 0;
369
Harald Weltefb7ba912018-02-09 01:05:27 +0100370 LOGPCONN(conn, LOGL_DEBUG, "Rx BSSMAP CLASSMARK UPDATE\n");
Philipp Maierfbf66102017-04-09 12:32:51 +0200371
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100372 if (!TLVP_PRESENT(tp, GSM0808_IE_CLASSMARK_INFORMATION_T2)) {
Harald Welte6de46592018-02-09 00:53:17 +0100373 LOGPCONN(conn, LOGL_ERROR, "Mandatory Classmark Information Type 2 not present -- discarding message!\n");
Harald Weltea172e9e2018-02-09 21:33:24 +0100374 return -EINVAL;
Philipp Maierfbf66102017-04-09 12:32:51 +0200375 }
376
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100377 cm2 = TLVP_VAL(tp, GSM0808_IE_CLASSMARK_INFORMATION_T2);
378 cm2_len = TLVP_LEN(tp, GSM0808_IE_CLASSMARK_INFORMATION_T2);
Philipp Maierfbf66102017-04-09 12:32:51 +0200379
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100380 if (TLVP_PRESENT(tp, GSM0808_IE_CLASSMARK_INFORMATION_T3)) {
381 cm3 = TLVP_VAL(tp, GSM0808_IE_CLASSMARK_INFORMATION_T3);
382 cm3_len = TLVP_LEN(tp, GSM0808_IE_CLASSMARK_INFORMATION_T3);
Philipp Maierfbf66102017-04-09 12:32:51 +0200383 }
384
385 /* Inform MSC about the classmark change */
386 msc_classmark_chg(conn, cm2, cm2_len, cm3, cm3_len);
387
Philipp Maierfbf66102017-04-09 12:32:51 +0200388 return 0;
Philipp Maierfbf66102017-04-09 12:32:51 +0200389}
390
391/* Endpoint to handle BSSMAP cipher mode complete */
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100392static int bssmap_rx_ciph_compl(struct gsm_subscriber_connection *conn, struct msgb *msg,
393 struct tlv_parsed *tp)
Philipp Maierfbf66102017-04-09 12:32:51 +0200394{
395 /* FIXME: The field GSM0808_IE_LAYER_3_MESSAGE_CONTENTS is optional by
396 * means of the specification. So there can be messages without L3 info.
397 * In this case, the code will crash becrause msc_cipher_mode_compl()
398 * is not able to deal with msg = NULL and apperently
399 * msc_cipher_mode_compl() was never meant to be used without L3 data.
400 * This needs to be discussed further! */
401
Philipp Maierfbf66102017-04-09 12:32:51 +0200402 uint8_t alg_id = 1;
Max366390d2018-11-02 16:01:03 +0100403 struct rate_ctr_group *msc = conn->network->msc_ctrs;
Philipp Maierfbf66102017-04-09 12:32:51 +0200404
Harald Weltefb7ba912018-02-09 01:05:27 +0100405 LOGPCONN(conn, LOGL_DEBUG, "Rx BSSMAP CIPHER MODE COMPLETE\n");
Philipp Maierfbf66102017-04-09 12:32:51 +0200406
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100407 if (TLVP_PRESENT(tp, GSM0808_IE_CHOSEN_ENCR_ALG)) {
408 alg_id = TLVP_VAL(tp, GSM0808_IE_CHOSEN_ENCR_ALG)[0] - 1;
Philipp Maierfbf66102017-04-09 12:32:51 +0200409 }
410
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100411 if (TLVP_PRESENT(tp, GSM0808_IE_LAYER_3_MESSAGE_CONTENTS)) {
412 msg->l3h = (uint8_t*)TLVP_VAL(tp, GSM0808_IE_LAYER_3_MESSAGE_CONTENTS);
Pau Espin Pedrol02a79d82017-12-15 18:55:43 +0100413 msgb_l3trim(msg, TLVP_LEN(tp, GSM0808_IE_LAYER_3_MESSAGE_CONTENTS));
Philipp Maierfbf66102017-04-09 12:32:51 +0200414 } else {
Philipp Maierfbf66102017-04-09 12:32:51 +0200415 msg = NULL;
416 }
417
Max366390d2018-11-02 16:01:03 +0100418 rate_ctr_inc(&msc->ctr[MSC_CTR_BSSMAP_CIPHER_MODE_COMPLETE]);
419
Philipp Maier4502f5f2017-09-07 11:39:58 +0200420 /* Hand over cipher mode complete message to the MSC */
Philipp Maierfbf66102017-04-09 12:32:51 +0200421 msc_cipher_mode_compl(conn, msg, alg_id);
422
423 return 0;
Philipp Maierfbf66102017-04-09 12:32:51 +0200424}
425
Max662e2ba2018-11-01 17:34:12 +0100426/* Endpoint to handle BSSMAP cipher mode reject, 3GPP TS 08.08 §3.2.1.48 */
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100427static int bssmap_rx_ciph_rej(struct gsm_subscriber_connection *conn,
428 struct msgb *msg, struct tlv_parsed *tp)
Philipp Maierfbf66102017-04-09 12:32:51 +0200429{
Max662e2ba2018-11-01 17:34:12 +0100430 enum gsm0808_cause cause;
Max366390d2018-11-02 16:01:03 +0100431 struct rate_ctr_group *msc = conn->network->msc_ctrs;
Philipp Maierfbf66102017-04-09 12:32:51 +0200432
Harald Weltefb7ba912018-02-09 01:05:27 +0100433 LOGPCONN(conn, LOGL_NOTICE, "RX BSSMAP CIPHER MODE REJECT\n");
Philipp Maierfbf66102017-04-09 12:32:51 +0200434
Max662e2ba2018-11-01 17:34:12 +0100435 if (!TLVP_PRES_LEN(tp, GSM0808_IE_CAUSE, 1)) {
Harald Welte6de46592018-02-09 00:53:17 +0100436 LOGPCONN(conn, LOGL_ERROR, "Cause code is missing -- discarding message!\n");
Harald Weltea172e9e2018-02-09 21:33:24 +0100437 return -EINVAL;
Philipp Maierfbf66102017-04-09 12:32:51 +0200438 }
439
Max366390d2018-11-02 16:01:03 +0100440 rate_ctr_inc(&msc->ctr[MSC_CTR_BSSMAP_CIPHER_MODE_REJECT]);
441
Max662e2ba2018-11-01 17:34:12 +0100442 /* FIXME: add support for 2-byte Cause values using libosmocore functions */
443 cause = *TLVP_VAL(tp, GSM0808_IE_CAUSE);
444 LOGPCONN(conn, LOGL_NOTICE, "Cipher mode rejection cause: %s\n", gsm0808_cause_name(cause));
Philipp Maierfbf66102017-04-09 12:32:51 +0200445
446 /* FIXME: Can we do something meaningful here? e.g. report to the
447 * msc code somehow that the cipher mode command has failed. */
448
Philipp Maierfbf66102017-04-09 12:32:51 +0200449 return 0;
Philipp Maierfbf66102017-04-09 12:32:51 +0200450}
451
452/* Endpoint to handle BSSMAP assignment failure */
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100453static int bssmap_rx_ass_fail(struct gsm_subscriber_connection *conn, struct msgb *msg,
454 struct tlv_parsed *tp)
Philipp Maierfbf66102017-04-09 12:32:51 +0200455{
Philipp Maierfbf66102017-04-09 12:32:51 +0200456 uint8_t cause;
457 uint8_t *rr_cause_ptr = NULL;
458 uint8_t rr_cause;
459
Harald Weltefb7ba912018-02-09 01:05:27 +0100460 LOGPCONN(conn, LOGL_NOTICE, "Rx BSSMAP ASSIGNMENT FAILURE message\n");
Philipp Maierfbf66102017-04-09 12:32:51 +0200461
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100462 if (!TLVP_PRESENT(tp, GSM0808_IE_CAUSE)) {
Harald Welte6de46592018-02-09 00:53:17 +0100463 LOGPCONN(conn, LOGL_ERROR, "Cause code is missing -- discarding message!\n");
Harald Weltea172e9e2018-02-09 21:33:24 +0100464 return -EINVAL;
Philipp Maierfbf66102017-04-09 12:32:51 +0200465 }
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100466 cause = TLVP_VAL(tp, GSM0808_IE_CAUSE)[0];
Philipp Maierfbf66102017-04-09 12:32:51 +0200467
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100468 if (TLVP_PRESENT(tp, GSM0808_IE_RR_CAUSE)) {
469 rr_cause = TLVP_VAL(tp, GSM0808_IE_RR_CAUSE)[0];
Philipp Maierfbf66102017-04-09 12:32:51 +0200470 rr_cause_ptr = &rr_cause;
471 }
472
473 /* FIXME: In AoIP, the Assignment failure will carry also an optional
474 * Codec List (BSS Supported) element. It has to be discussed if we
475 * can ignore this element. If not, The msc_assign_fail() function
476 * call has to change. However msc_assign_fail() does nothing in the
477 * end. So probably we can just leave it as it is. Even for AoIP */
478
479 /* Inform the MSC about the assignment failure event */
480 msc_assign_fail(conn, cause, rr_cause_ptr);
481
Philipp Maierfbf66102017-04-09 12:32:51 +0200482 return 0;
Philipp Maierfbf66102017-04-09 12:32:51 +0200483}
484
485/* Endpoint to handle sapi "n" reject */
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100486static int bssmap_rx_sapi_n_rej(struct gsm_subscriber_connection *conn, struct msgb *msg,
487 struct tlv_parsed *tp)
Philipp Maierfbf66102017-04-09 12:32:51 +0200488{
Philipp Maierfbf66102017-04-09 12:32:51 +0200489 uint8_t dlci;
490
Harald Welte35284462018-02-09 01:31:29 +0100491 LOGPCONN(conn, LOGL_NOTICE, "Rx BSSMAP SAPI-N-REJECT message\n");
Philipp Maierfbf66102017-04-09 12:32:51 +0200492
493 /* Note: The MSC code seems not to care about the cause code, but by
494 * the specification it is mandatory, so we check its presence. See
495 * also 3GPP TS 48.008 3.2.1.34 SAPI "n" REJECT */
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100496 if (!TLVP_PRESENT(tp, GSM0808_IE_CAUSE)) {
Harald Welte6de46592018-02-09 00:53:17 +0100497 LOGPCONN(conn, LOGL_ERROR, "Cause code is missing -- discarding message!\n");
Harald Weltea172e9e2018-02-09 21:33:24 +0100498 return -EINVAL;
Philipp Maierfbf66102017-04-09 12:32:51 +0200499 }
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100500 if (!TLVP_PRESENT(tp, GSM0808_IE_DLCI)) {
Harald Welte6de46592018-02-09 00:53:17 +0100501 LOGPCONN(conn, LOGL_ERROR, "DLCI is missing -- discarding message!\n");
Harald Weltea172e9e2018-02-09 21:33:24 +0100502 return -EINVAL;
Philipp Maierfbf66102017-04-09 12:32:51 +0200503 }
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100504 dlci = TLVP_VAL(tp, GSM0808_IE_DLCI)[0];
Philipp Maierfbf66102017-04-09 12:32:51 +0200505
506 /* Inform the MSC about the sapi "n" reject event */
507 msc_sapi_n_reject(conn, dlci);
508
Philipp Maierfbf66102017-04-09 12:32:51 +0200509 return 0;
Philipp Maierfbf66102017-04-09 12:32:51 +0200510}
511
Philipp Maier8ad3dac2018-08-07 13:00:14 +0200512/* Use the speech codec info we go with the assignment complete to dtermine
513 * which codec we will signal to the MGW */
514static enum mgcp_codecs mgcp_codec_from_sc(struct gsm0808_speech_codec *sc)
515{
516 switch (sc->type) {
517 case GSM0808_SCT_FR1:
518 return CODEC_GSM_8000_1;
519 break;
520 case GSM0808_SCT_FR2:
521 return CODEC_GSMEFR_8000_1;
522 break;
523 case GSM0808_SCT_FR3:
524 return CODEC_AMR_8000_1;
525 break;
526 case GSM0808_SCT_FR4:
527 return CODEC_AMRWB_16000_1;
528 break;
529 case GSM0808_SCT_FR5:
530 return CODEC_AMRWB_16000_1;
531 break;
532 case GSM0808_SCT_HR1:
533 return CODEC_GSMHR_8000_1;
534 break;
535 case GSM0808_SCT_HR3:
536 return CODEC_AMR_8000_1;
537 break;
538 case GSM0808_SCT_HR4:
539 return CODEC_AMRWB_16000_1;
540 break;
541 case GSM0808_SCT_HR6:
542 return CODEC_AMRWB_16000_1;
543 break;
544 default:
545 return CODEC_PCMU_8000_1;
546 break;
547 }
548}
549
Philipp Maierfbf66102017-04-09 12:32:51 +0200550/* Endpoint to handle assignment complete */
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100551static int bssmap_rx_ass_compl(struct gsm_subscriber_connection *conn, struct msgb *msg,
552 struct tlv_parsed *tp)
Philipp Maierfbf66102017-04-09 12:32:51 +0200553{
Philipp Maierfbf66102017-04-09 12:32:51 +0200554 struct sockaddr_storage rtp_addr;
Philipp Maier8ad3dac2018-08-07 13:00:14 +0200555 struct gsm0808_speech_codec sc;
Philipp Maierfbf66102017-04-09 12:32:51 +0200556 struct sockaddr_in *rtp_addr_in;
557 int rc;
558
Harald Welte35284462018-02-09 01:31:29 +0100559 LOGPCONN(conn, LOGL_INFO, "Rx BSSMAP ASSIGNMENT COMPLETE message\n");
Philipp Maierfbf66102017-04-09 12:32:51 +0200560
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100561 if (!TLVP_PRESENT(tp, GSM0808_IE_AOIP_TRASP_ADDR)) {
Harald Welte6de46592018-02-09 00:53:17 +0100562 LOGPCONN(conn, LOGL_ERROR, "AoIP transport identifier missing -- discarding message!\n");
Harald Weltea172e9e2018-02-09 21:33:24 +0100563 return -EINVAL;
Philipp Maierfbf66102017-04-09 12:32:51 +0200564 }
565
566 /* Decode AoIP transport address element */
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100567 rc = gsm0808_dec_aoip_trasp_addr(&rtp_addr, TLVP_VAL(tp, GSM0808_IE_AOIP_TRASP_ADDR),
568 TLVP_LEN(tp, GSM0808_IE_AOIP_TRASP_ADDR));
Philipp Maierfbf66102017-04-09 12:32:51 +0200569 if (rc < 0) {
Harald Welte6de46592018-02-09 00:53:17 +0100570 LOGPCONN(conn, LOGL_ERROR, "Unable to decode aoip transport address.\n");
Harald Weltea172e9e2018-02-09 21:33:24 +0100571 return -EINVAL;
Philipp Maierfbf66102017-04-09 12:32:51 +0200572 }
573
Philipp Maier8ad3dac2018-08-07 13:00:14 +0200574 /* Decode speech codec (choosen) element */
575 rc = gsm0808_dec_speech_codec(&sc, TLVP_VAL(tp, GSM0808_IE_SPEECH_CODEC),
576 TLVP_LEN(tp, GSM0808_IE_SPEECH_CODEC));
577 if (rc < 0) {
578 LOGPCONN(conn, LOGL_ERROR, "Unable to decode speech codec (choosen).\n");
579 return -EINVAL;
580 }
581 conn->rtp.codec_ran = mgcp_codec_from_sc(&sc);
582
Philipp Maierfbf66102017-04-09 12:32:51 +0200583 /* use address / port supplied with the AoIP
584 * transport address element */
585 if (rtp_addr.ss_family == AF_INET) {
586 rtp_addr_in = (struct sockaddr_in *)&rtp_addr;
Philipp Maier621ba032017-11-07 17:19:25 +0100587 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 +0200588 } else {
Harald Welte6de46592018-02-09 00:53:17 +0100589 LOGPCONN(conn, LOGL_ERROR, "Unsopported addressing scheme. (supports only IPV4)\n");
Harald Weltea172e9e2018-02-09 21:33:24 +0100590 return -EINVAL;
Philipp Maierfbf66102017-04-09 12:32:51 +0200591 }
592
593 /* FIXME: Seems to be related to authentication or,
594 encryption. Is this really in the right place? */
595 msc_rx_sec_mode_compl(conn);
596
Philipp Maierfbf66102017-04-09 12:32:51 +0200597 return 0;
Philipp Maierfbf66102017-04-09 12:32:51 +0200598}
599
600/* Handle incoming connection oriented BSSMAP messages */
601static int rx_bssmap(struct osmo_sccp_user *scu, const struct a_conn_info *a_conn_info, struct msgb *msg)
602{
Harald Weltec27ef652018-02-09 01:23:25 +0100603 struct gsm_subscriber_connection *conn;
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100604 struct tlv_parsed tp;
Pau Espin Pedrol75559282018-02-14 14:12:24 +0100605 int rc;
Neels Hofmeyrae73d2b2018-04-01 20:58:08 +0200606 uint8_t msg_type;
Harald Weltec27ef652018-02-09 01:23:25 +0100607
Philipp Maierfbf66102017-04-09 12:32:51 +0200608 if (msgb_l3len(msg) < 1) {
Harald Welte1f477442018-02-09 01:49:01 +0100609 LOGP(DBSSAP, LOGL_NOTICE, "Error: No data received -- discarding message!\n");
Philipp Maierfbf66102017-04-09 12:32:51 +0200610 return -1;
611 }
Neels Hofmeyrae73d2b2018-04-01 20:58:08 +0200612 msg_type = msg->l3h[0];
Philipp Maierfbf66102017-04-09 12:32:51 +0200613
Maxf1329c52018-11-19 14:55:56 +0100614 rc = osmo_bssap_tlv_parse(&tp, msg->l3h + 1, msgb_l3len(msg) - 1);
Pau Espin Pedrol75559282018-02-14 14:12:24 +0100615 if (rc < 0) {
616 LOGP(DBSSAP, LOGL_ERROR, "Failed parsing TLV -- discarding message! %s\n",
617 osmo_hexdump(msg->l3h, msgb_l3len(msg)));
618 return -EINVAL;
619 }
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100620
Harald Weltec27ef652018-02-09 01:23:25 +0100621 /* Only message types allowed without a 'conn' */
Neels Hofmeyrae73d2b2018-04-01 20:58:08 +0200622 switch (msg_type) {
Harald Weltec27ef652018-02-09 01:23:25 +0100623 case BSS_MAP_MSG_COMPLETE_LAYER_3:
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100624 return bssmap_rx_l3_compl(scu, a_conn_info, msg, &tp);
Harald Weltec27ef652018-02-09 01:23:25 +0100625 default:
626 break;
627 }
628
629 conn = subscr_conn_lookup_a(a_conn_info->network, a_conn_info->conn_id);
630 if (!conn) {
Harald Welte1f477442018-02-09 01:49:01 +0100631 LOGP(DBSSAP, LOGL_ERROR, "Couldn't find subscr_conn for conn_id=%d\n", a_conn_info->conn_id);
Neels Hofmeyr4068ab22018-04-01 20:55:54 +0200632 /* We expect a Clear Complete to come in on a valid conn. But if for some reason we still
633 * have the SCCP connection while the subscriber connection data is already gone, at
634 * least close the SCCP conn. */
635
636 if (msg_type == BSS_MAP_MSG_CLEAR_COMPLETE)
637 return bssmap_rx_clear_complete(scu, a_conn_info, NULL);
638
Harald Weltec27ef652018-02-09 01:23:25 +0100639 return -EINVAL;
640 }
641
Neels Hofmeyrae73d2b2018-04-01 20:58:08 +0200642 LOGPCONN(conn, LOGL_DEBUG, "Rx BSSMAP DT1 %s\n", gsm0808_bssmap_name(msg_type));
Philipp Maierfbf66102017-04-09 12:32:51 +0200643
Neels Hofmeyrae73d2b2018-04-01 20:58:08 +0200644 switch (msg_type) {
Philipp Maierfbf66102017-04-09 12:32:51 +0200645 case BSS_MAP_MSG_CLEAR_RQST:
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100646 return bssmap_rx_clear_rqst(conn, msg, &tp);
Neels Hofmeyr4068ab22018-04-01 20:55:54 +0200647 case BSS_MAP_MSG_CLEAR_COMPLETE:
648 return bssmap_rx_clear_complete(scu, a_conn_info, conn);
Philipp Maierfbf66102017-04-09 12:32:51 +0200649 case BSS_MAP_MSG_CLASSMARK_UPDATE:
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100650 return bssmap_rx_classmark_upd(conn, msg, &tp);
Philipp Maierfbf66102017-04-09 12:32:51 +0200651 case BSS_MAP_MSG_CIPHER_MODE_COMPLETE:
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100652 return bssmap_rx_ciph_compl(conn, msg, &tp);
Philipp Maierfbf66102017-04-09 12:32:51 +0200653 case BSS_MAP_MSG_CIPHER_MODE_REJECT:
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100654 return bssmap_rx_ciph_rej(conn, msg, &tp);
Philipp Maierfbf66102017-04-09 12:32:51 +0200655 case BSS_MAP_MSG_ASSIGMENT_FAILURE:
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100656 return bssmap_rx_ass_fail(conn, msg, &tp);
Philipp Maierfbf66102017-04-09 12:32:51 +0200657 case BSS_MAP_MSG_SAPI_N_REJECT:
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100658 return bssmap_rx_sapi_n_rej(conn, msg, &tp);
Philipp Maierfbf66102017-04-09 12:32:51 +0200659 case BSS_MAP_MSG_ASSIGMENT_COMPLETE:
Pau Espin Pedrol31776ff2018-02-14 12:13:35 +0100660 return bssmap_rx_ass_compl(conn, msg, &tp);
Philipp Maierfbf66102017-04-09 12:32:51 +0200661 default:
Neels Hofmeyrae73d2b2018-04-01 20:58:08 +0200662 LOGPCONN(conn, LOGL_ERROR, "Unimplemented msg type: %s\n", gsm0808_bssmap_name(msg_type));
Philipp Maierfbf66102017-04-09 12:32:51 +0200663 return -EINVAL;
664 }
665
666 return -EINVAL;
667}
668
Harald Weltea172e9e2018-02-09 21:33:24 +0100669/* Endpoint to handle regular BSSAP DTAP messages. No ownership of 'msg' is passed on! */
Philipp Maierfbf66102017-04-09 12:32:51 +0200670static int rx_dtap(const struct osmo_sccp_user *scu, const struct a_conn_info *a_conn_info, struct msgb *msg)
671{
672 struct gsm_network *network = a_conn_info->network;
673 struct gsm_subscriber_connection *conn;
Harald Welte0e2fa5d2018-04-09 16:35:01 +0200674 struct dtap_header *dtap = (struct dtap_header *) msg->l2h;
Philipp Maierfbf66102017-04-09 12:32:51 +0200675
676 conn = subscr_conn_lookup_a(network, a_conn_info->conn_id);
677 if (!conn) {
Philipp Maierfbf66102017-04-09 12:32:51 +0200678 return -EINVAL;
679 }
680
Harald Weltefb7ba912018-02-09 01:05:27 +0100681 LOGPCONN(conn, LOGL_DEBUG, "Rx DTAP %s\n", msgb_hexdump_l2(msg));
Philipp Maierfbf66102017-04-09 12:32:51 +0200682
683 /* msc_dtap expects the dtap payload in l3h */
684 msg->l3h = msg->l2h + 3;
Harald Welte0e2fa5d2018-04-09 16:35:01 +0200685 OMSC_LINKID_CB(msg) = dtap->link_id;
Philipp Maierfbf66102017-04-09 12:32:51 +0200686
Philipp Maier4502f5f2017-09-07 11:39:58 +0200687 /* Forward dtap payload into the msc */
Philipp Maierfbf66102017-04-09 12:32:51 +0200688 msc_dtap(conn, conn->a.conn_id, msg);
689
690 return 0;
691}
692
Harald Weltea172e9e2018-02-09 21:33:24 +0100693/* Handle incoming connection oriented messages. No ownership of 'msg' is passed on! */
Neels Hofmeyrc1d69252017-12-18 04:06:04 +0100694int 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 +0200695{
696 OSMO_ASSERT(scu);
697 OSMO_ASSERT(a_conn_info);
698 OSMO_ASSERT(msg);
699
Philipp Maierfbf66102017-04-09 12:32:51 +0200700 if (msgb_l2len(msg) < sizeof(struct bssmap_header)) {
Harald Welte1f477442018-02-09 01:49:01 +0100701 LOGP(DBSSAP, LOGL_NOTICE, "The header is too short -- discarding message!\n");
Philipp Maier4502f5f2017-09-07 11:39:58 +0200702 return -EINVAL;
Philipp Maierfbf66102017-04-09 12:32:51 +0200703 }
704
705 switch (msg->l2h[0]) {
706 case BSSAP_MSG_BSS_MANAGEMENT:
707 msg->l3h = &msg->l2h[sizeof(struct bssmap_header)];
708 return rx_bssmap(scu, a_conn_info, msg);
Philipp Maierfbf66102017-04-09 12:32:51 +0200709 case BSSAP_MSG_DTAP:
710 return rx_dtap(scu, a_conn_info, msg);
Philipp Maierfbf66102017-04-09 12:32:51 +0200711 default:
Harald Welte1f477442018-02-09 01:49:01 +0100712 LOGP(DBSSAP, LOGL_ERROR, "Unimplemented BSSAP msg type: %s\n", gsm0808_bssap_name(msg->l2h[0]));
Philipp Maierfbf66102017-04-09 12:32:51 +0200713 return -EINVAL;
714 }
715
716 return -EINVAL;
717}