Holger Hans Peter Freyther | 48f9a4e | 2015-04-05 20:53:42 +0200 | [diff] [blame^] | 1 | /* (C) 2009-2015 by Holger Hans Peter Freyther <zecke@selfish.org> |
Holger Hans Peter Freyther | 4d61417 | 2011-08-15 15:53:00 +0200 | [diff] [blame] | 2 | * (C) 2009-2011 by On-Waves |
Holger Hans Peter Freyther | 22e9ac3 | 2010-07-05 16:02:04 +0800 | [diff] [blame] | 3 | * All Rights Reserved |
| 4 | * |
| 5 | * This program is free software; you can redistribute it and/or modify |
Harald Welte | 0e3e88e | 2011-01-01 15:25:50 +0100 | [diff] [blame] | 6 | * it under the terms of the GNU Affero General Public License as published by |
| 7 | * the Free Software Foundation; either version 3 of the License, or |
Holger Hans Peter Freyther | 22e9ac3 | 2010-07-05 16:02:04 +0800 | [diff] [blame] | 8 | * (at your option) any later version. |
| 9 | * |
| 10 | * This program is distributed in the hope that it will be useful, |
| 11 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| 12 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
Harald Welte | 0e3e88e | 2011-01-01 15:25:50 +0100 | [diff] [blame] | 13 | * GNU Affero General Public License for more details. |
Holger Hans Peter Freyther | 22e9ac3 | 2010-07-05 16:02:04 +0800 | [diff] [blame] | 14 | * |
Harald Welte | 0e3e88e | 2011-01-01 15:25:50 +0100 | [diff] [blame] | 15 | * You should have received a copy of the GNU Affero General Public License |
| 16 | * along with this program. If not, see <http://www.gnu.org/licenses/>. |
Holger Hans Peter Freyther | 22e9ac3 | 2010-07-05 16:02:04 +0800 | [diff] [blame] | 17 | * |
| 18 | */ |
| 19 | |
| 20 | #include <openbsc/osmo_bsc.h> |
Holger Hans Peter Freyther | 9c61b2a | 2010-11-05 19:48:47 +0100 | [diff] [blame] | 21 | #include <openbsc/osmo_msc_data.h> |
Holger Hans Peter Freyther | b6d7014 | 2010-11-03 19:03:35 +0100 | [diff] [blame] | 22 | #include <openbsc/debug.h> |
| 23 | |
Jacob Erlbeck | 3ccb86b | 2013-09-11 10:46:55 +0200 | [diff] [blame] | 24 | #include <openbsc/gsm_04_80.h> |
| 25 | |
Harald Welte | 8b1713a | 2011-03-23 18:26:56 +0100 | [diff] [blame] | 26 | #include <osmocom/gsm/protocol/gsm_08_08.h> |
| 27 | #include <osmocom/gsm/gsm0808.h> |
Holger Hans Peter Freyther | a62919e | 2010-11-04 11:59:41 +0100 | [diff] [blame] | 28 | |
Holger Hans Peter Freyther | 326a124 | 2011-06-09 14:44:47 +0200 | [diff] [blame] | 29 | #include <osmocom/sccp/sccp.h> |
| 30 | |
Holger Hans Peter Freyther | b6d7014 | 2010-11-03 19:03:35 +0100 | [diff] [blame] | 31 | #define return_when_not_connected(conn) \ |
| 32 | if (!conn->sccp_con) {\ |
| 33 | LOGP(DMSC, LOGL_ERROR, "MSC Connection not present.\n"); \ |
| 34 | return; \ |
| 35 | } |
| 36 | |
| 37 | #define return_when_not_connected_val(conn, ret) \ |
| 38 | if (!conn->sccp_con) {\ |
| 39 | LOGP(DMSC, LOGL_ERROR, "MSC Connection not present.\n"); \ |
| 40 | return ret; \ |
| 41 | } |
Holger Hans Peter Freyther | 22e9ac3 | 2010-07-05 16:02:04 +0800 | [diff] [blame] | 42 | |
Holger Hans Peter Freyther | 5f2184c | 2010-11-05 11:02:28 +0100 | [diff] [blame] | 43 | #define queue_msg_or_return(resp) \ |
| 44 | if (!resp) { \ |
| 45 | LOGP(DMSC, LOGL_ERROR, "Failed to allocate response.\n"); \ |
| 46 | return; \ |
| 47 | } \ |
Holger Hans Peter Freyther | 1f334cc | 2010-11-10 09:31:41 +0100 | [diff] [blame] | 48 | bsc_queue_for_msc(conn->sccp_con, resp); |
Holger Hans Peter Freyther | 5f2184c | 2010-11-05 11:02:28 +0100 | [diff] [blame] | 49 | |
Holger Hans Peter Freyther | 260440b | 2011-06-09 17:37:04 +0200 | [diff] [blame] | 50 | static int bsc_clear_request(struct gsm_subscriber_connection *conn, uint32_t cause); |
| 51 | static int complete_layer3(struct gsm_subscriber_connection *conn, |
| 52 | struct msgb *msg, struct osmo_msc_data *msc); |
| 53 | |
Holger Hans Peter Freyther | 5e84584 | 2011-06-04 14:51:51 +0200 | [diff] [blame] | 54 | static uint16_t get_network_code_for_msc(struct osmo_msc_data *msc) |
Holger Hans Peter Freyther | 9c61b2a | 2010-11-05 19:48:47 +0100 | [diff] [blame] | 55 | { |
Holger Hans Peter Freyther | 5e84584 | 2011-06-04 14:51:51 +0200 | [diff] [blame] | 56 | if (msc->core_ncc != -1) |
| 57 | return msc->core_ncc; |
| 58 | return msc->network->network_code; |
Holger Hans Peter Freyther | 9c61b2a | 2010-11-05 19:48:47 +0100 | [diff] [blame] | 59 | } |
| 60 | |
Holger Hans Peter Freyther | 5e84584 | 2011-06-04 14:51:51 +0200 | [diff] [blame] | 61 | static uint16_t get_country_code_for_msc(struct osmo_msc_data *msc) |
Holger Hans Peter Freyther | 9c61b2a | 2010-11-05 19:48:47 +0100 | [diff] [blame] | 62 | { |
Holger Hans Peter Freyther | 5e84584 | 2011-06-04 14:51:51 +0200 | [diff] [blame] | 63 | if (msc->core_mcc != -1) |
| 64 | return msc->core_mcc; |
| 65 | return msc->network->country_code; |
Holger Hans Peter Freyther | 9c61b2a | 2010-11-05 19:48:47 +0100 | [diff] [blame] | 66 | } |
| 67 | |
Holger Hans Peter Freyther | 05e2770 | 2015-04-01 18:15:48 +0200 | [diff] [blame] | 68 | static uint16_t get_lac_for_msc(struct osmo_msc_data *msc, struct gsm_bts *bts) |
| 69 | { |
| 70 | if (msc->core_lac != -1) |
| 71 | return msc->core_lac; |
| 72 | return bts->location_area_code; |
| 73 | } |
| 74 | |
| 75 | static uint16_t get_ci_for_msc(struct osmo_msc_data *msc, struct gsm_bts *bts) |
| 76 | { |
| 77 | if (msc->core_ci != -1) |
| 78 | return msc->core_ci; |
| 79 | return bts->cell_identity; |
| 80 | } |
| 81 | |
Holger Hans Peter Freyther | 48f9a4e | 2015-04-05 20:53:42 +0200 | [diff] [blame^] | 82 | static int bsc_filter_initial(struct osmo_bsc_data *bsc, |
| 83 | struct osmo_msc_data *msc, |
| 84 | struct gsm_subscriber_connection *conn, |
| 85 | struct msgb *msg, char **imsi) |
| 86 | { |
| 87 | int con_type; |
| 88 | struct bsc_filter_request req; |
| 89 | struct bsc_filter_reject_cause cause; |
| 90 | struct gsm48_hdr *gh = msgb_l3(msg); |
| 91 | |
| 92 | req.ctx = conn; |
| 93 | req.black_list = NULL; |
| 94 | req.access_lists = bsc_access_lists(); |
| 95 | req.local_lst_name = msc->acc_lst_name; |
| 96 | req.global_lst_name = conn->bts->network->bsc_data->acc_lst_name; |
| 97 | req.bsc_nr = 0; |
| 98 | |
| 99 | return bsc_msg_filter_initial(gh, msgb_l3len(msg), &req, |
| 100 | &con_type, imsi, &cause); |
| 101 | } |
| 102 | |
| 103 | static int bsc_filter_data(struct gsm_subscriber_connection *conn, |
| 104 | struct msgb *msg) |
| 105 | { |
| 106 | struct bsc_filter_request req; |
| 107 | struct gsm48_hdr *gh = msgb_l3(msg); |
| 108 | struct bsc_filter_reject_cause cause; |
| 109 | |
| 110 | req.ctx = conn; |
| 111 | req.black_list = NULL; |
| 112 | req.access_lists = bsc_access_lists(); |
| 113 | req.local_lst_name = conn->sccp_con->msc->acc_lst_name; |
| 114 | req.global_lst_name = conn->bts->network->bsc_data->acc_lst_name; |
| 115 | req.bsc_nr = 0; |
| 116 | |
| 117 | return bsc_msg_filter_data(gh, msgb_l3len(msg), &req, |
| 118 | &conn->sccp_con->filter_state, |
| 119 | &cause); |
| 120 | } |
Holger Hans Peter Freyther | 05e2770 | 2015-04-01 18:15:48 +0200 | [diff] [blame] | 121 | |
Holger Hans Peter Freyther | 7d23130 | 2010-09-16 17:26:35 +0800 | [diff] [blame] | 122 | static void bsc_sapi_n_reject(struct gsm_subscriber_connection *conn, int dlci) |
| 123 | { |
Holger Hans Peter Freyther | 313324e | 2010-11-04 12:28:32 +0100 | [diff] [blame] | 124 | struct msgb *resp; |
Holger Hans Peter Freyther | b6d7014 | 2010-11-03 19:03:35 +0100 | [diff] [blame] | 125 | return_when_not_connected(conn); |
Holger Hans Peter Freyther | 313324e | 2010-11-04 12:28:32 +0100 | [diff] [blame] | 126 | |
Harald Welte | 98833af | 2011-07-12 00:05:11 +0200 | [diff] [blame] | 127 | LOGP(DMSC, LOGL_NOTICE, "Tx MSC SAPI N REJECT DLCI=0x%02x\n", dlci); |
| 128 | |
Holger Hans Peter Freyther | 313324e | 2010-11-04 12:28:32 +0100 | [diff] [blame] | 129 | resp = gsm0808_create_sapi_reject(dlci); |
Holger Hans Peter Freyther | 5f2184c | 2010-11-05 11:02:28 +0100 | [diff] [blame] | 130 | queue_msg_or_return(resp); |
Holger Hans Peter Freyther | 7d23130 | 2010-09-16 17:26:35 +0800 | [diff] [blame] | 131 | } |
| 132 | |
| 133 | static void bsc_cipher_mode_compl(struct gsm_subscriber_connection *conn, |
| 134 | struct msgb *msg, uint8_t chosen_encr) |
| 135 | { |
Holger Hans Peter Freyther | a62919e | 2010-11-04 11:59:41 +0100 | [diff] [blame] | 136 | struct msgb *resp; |
Holger Hans Peter Freyther | b6d7014 | 2010-11-03 19:03:35 +0100 | [diff] [blame] | 137 | return_when_not_connected(conn); |
Holger Hans Peter Freyther | a62919e | 2010-11-04 11:59:41 +0100 | [diff] [blame] | 138 | |
| 139 | LOGP(DMSC, LOGL_DEBUG, "CIPHER MODE COMPLETE from MS, forwarding to MSC\n"); |
| 140 | resp = gsm0808_create_cipher_complete(msg, chosen_encr); |
Holger Hans Peter Freyther | 5f2184c | 2010-11-05 11:02:28 +0100 | [diff] [blame] | 141 | queue_msg_or_return(resp); |
Holger Hans Peter Freyther | 7d23130 | 2010-09-16 17:26:35 +0800 | [diff] [blame] | 142 | } |
| 143 | |
Jacob Erlbeck | e4cca68 | 2013-10-31 15:36:43 +0100 | [diff] [blame] | 144 | static void bsc_send_ussd_no_srv(struct gsm_subscriber_connection *conn, |
| 145 | struct msgb *msg, const char *text) |
Jacob Erlbeck | 3ccb86b | 2013-09-11 10:46:55 +0200 | [diff] [blame] | 146 | { |
| 147 | struct gsm48_hdr *gh; |
| 148 | int8_t pdisc; |
| 149 | uint8_t mtype; |
| 150 | int drop_message = 1; |
| 151 | |
| 152 | if (!text) |
| 153 | return; |
| 154 | |
| 155 | if (!msg || msgb_l3len(msg) < sizeof(*gh)) |
| 156 | return; |
| 157 | |
| 158 | gh = msgb_l3(msg); |
| 159 | pdisc = gh->proto_discr & 0x0f; |
| 160 | mtype = gh->msg_type & 0xbf; |
| 161 | |
| 162 | /* Is CM service request? */ |
| 163 | if (pdisc == GSM48_PDISC_MM && mtype == GSM48_MT_MM_CM_SERV_REQ) { |
| 164 | struct gsm48_service_request *cm; |
| 165 | |
| 166 | cm = (struct gsm48_service_request *) &gh->data[0]; |
| 167 | |
| 168 | /* Is type SMS or call? */ |
| 169 | if (cm->cm_service_type == GSM48_CMSERV_SMS) |
| 170 | drop_message = 0; |
| 171 | else if (cm->cm_service_type == GSM48_CMSERV_MO_CALL_PACKET) |
| 172 | drop_message = 0; |
| 173 | } |
| 174 | |
| 175 | if (drop_message) { |
Holger Hans Peter Freyther | 8bdc5ee | 2013-10-31 13:35:28 +0100 | [diff] [blame] | 176 | LOGP(DMSC, LOGL_DEBUG, "Skipping (not sending) USSD message: '%s'\n", text); |
Jacob Erlbeck | 3ccb86b | 2013-09-11 10:46:55 +0200 | [diff] [blame] | 177 | return; |
| 178 | } |
| 179 | |
Jacob Erlbeck | 51f814a | 2013-10-31 15:36:42 +0100 | [diff] [blame] | 180 | LOGP(DMSC, LOGL_INFO, "Sending CM Service Accept\n"); |
| 181 | gsm48_tx_mm_serv_ack(conn); |
| 182 | |
Jacob Erlbeck | 3ccb86b | 2013-09-11 10:46:55 +0200 | [diff] [blame] | 183 | LOGP(DMSC, LOGL_INFO, "Sending USSD message: '%s'\n", text); |
| 184 | gsm0480_send_ussdNotify(conn, 1, text); |
| 185 | gsm0480_send_releaseComplete(conn); |
| 186 | } |
| 187 | |
Holger Hans Peter Freyther | 9c61b2a | 2010-11-05 19:48:47 +0100 | [diff] [blame] | 188 | /* |
| 189 | * Instruct to reserve data for a new connectiom, create the complete |
| 190 | * layer three message, send it to open the connection. |
| 191 | */ |
Holger Hans Peter Freyther | 7d23130 | 2010-09-16 17:26:35 +0800 | [diff] [blame] | 192 | static int bsc_compl_l3(struct gsm_subscriber_connection *conn, struct msgb *msg, |
| 193 | uint16_t chosen_channel) |
| 194 | { |
Holger Hans Peter Freyther | 508e662 | 2011-06-07 11:40:20 +0200 | [diff] [blame] | 195 | struct osmo_msc_data *msc; |
Holger Hans Peter Freyther | 9c61b2a | 2010-11-05 19:48:47 +0100 | [diff] [blame] | 196 | |
Harald Welte | 98833af | 2011-07-12 00:05:11 +0200 | [diff] [blame] | 197 | LOGP(DMSC, LOGL_INFO, "Tx MSC COMPL L3\n"); |
| 198 | |
Holger Hans Peter Freyther | 508e662 | 2011-06-07 11:40:20 +0200 | [diff] [blame] | 199 | /* find the MSC link we want to use */ |
Holger Hans Peter Freyther | e592cb1 | 2011-06-07 19:57:02 +0200 | [diff] [blame] | 200 | msc = bsc_find_msc(conn, msg); |
Holger Hans Peter Freyther | 508e662 | 2011-06-07 11:40:20 +0200 | [diff] [blame] | 201 | if (!msc) { |
| 202 | LOGP(DMSC, LOGL_ERROR, "Failed to find a MSC for a connection.\n"); |
Jacob Erlbeck | e4cca68 | 2013-10-31 15:36:43 +0100 | [diff] [blame] | 203 | bsc_send_ussd_no_srv(conn, msg, |
| 204 | conn->bts->network->bsc_data->ussd_no_msc_txt); |
Holger Hans Peter Freyther | 508e662 | 2011-06-07 11:40:20 +0200 | [diff] [blame] | 205 | return -1; |
| 206 | } |
| 207 | |
Holger Hans Peter Freyther | 260440b | 2011-06-09 17:37:04 +0200 | [diff] [blame] | 208 | return complete_layer3(conn, msg, msc); |
| 209 | } |
| 210 | |
| 211 | static int complete_layer3(struct gsm_subscriber_connection *conn, |
| 212 | struct msgb *msg, struct osmo_msc_data *msc) |
| 213 | { |
Holger Hans Peter Freyther | 48f9a4e | 2015-04-05 20:53:42 +0200 | [diff] [blame^] | 214 | char *imsi = NULL; |
Holger Hans Peter Freyther | 903dff7 | 2014-09-02 17:28:40 +0200 | [diff] [blame] | 215 | struct timeval tv; |
Holger Hans Peter Freyther | 260440b | 2011-06-09 17:37:04 +0200 | [diff] [blame] | 216 | struct msgb *resp; |
| 217 | uint16_t network_code; |
| 218 | uint16_t country_code; |
Holger Hans Peter Freyther | 05e2770 | 2015-04-01 18:15:48 +0200 | [diff] [blame] | 219 | uint16_t lac; |
| 220 | uint16_t ci; |
Jacob Erlbeck | 3ccb86b | 2013-09-11 10:46:55 +0200 | [diff] [blame] | 221 | enum bsc_con ret; |
Holger Hans Peter Freyther | 903dff7 | 2014-09-02 17:28:40 +0200 | [diff] [blame] | 222 | int send_ping = msc->advanced_ping; |
| 223 | |
| 224 | /* Advanced ping/pong handling */ |
| 225 | if (osmo_timer_pending(&msc->pong_timer)) |
| 226 | send_ping = 0; |
Holger Hans Peter Freyther | d2b37c5 | 2014-10-29 10:06:15 +0100 | [diff] [blame] | 227 | if (msc->ping_timeout <= 0) |
Holger Hans Peter Freyther | 903dff7 | 2014-09-02 17:28:40 +0200 | [diff] [blame] | 228 | send_ping = 0; |
| 229 | if (send_ping && osmo_timer_remaining(&msc->ping_timer, NULL, &tv) == -1) |
| 230 | send_ping = 0; |
Holger Hans Peter Freyther | 260440b | 2011-06-09 17:37:04 +0200 | [diff] [blame] | 231 | |
Holger Hans Peter Freyther | 48f9a4e | 2015-04-05 20:53:42 +0200 | [diff] [blame^] | 232 | /* Check the filter */ |
| 233 | if (bsc_filter_initial(msc->network->bsc_data, msc, conn, msg, &imsi) < 0) |
| 234 | return BSC_API_CONN_POL_REJECT; |
| 235 | |
Holger Hans Peter Freyther | 9c61b2a | 2010-11-05 19:48:47 +0100 | [diff] [blame] | 236 | /* allocate resource for a new connection */ |
Holger Hans Peter Freyther | 903dff7 | 2014-09-02 17:28:40 +0200 | [diff] [blame] | 237 | ret = bsc_create_new_connection(conn, msc, send_ping); |
Jacob Erlbeck | 3ccb86b | 2013-09-11 10:46:55 +0200 | [diff] [blame] | 238 | |
| 239 | if (ret != BSC_CON_SUCCESS) { |
| 240 | /* allocation has failed */ |
| 241 | if (ret == BSC_CON_REJECT_NO_LINK) |
Jacob Erlbeck | e4cca68 | 2013-10-31 15:36:43 +0100 | [diff] [blame] | 242 | bsc_send_ussd_no_srv(conn, msg, msc->ussd_msc_lost_txt); |
Jacob Erlbeck | 3ccb86b | 2013-09-11 10:46:55 +0200 | [diff] [blame] | 243 | else if (ret == BSC_CON_REJECT_RF_GRACE) |
Jacob Erlbeck | e4cca68 | 2013-10-31 15:36:43 +0100 | [diff] [blame] | 244 | bsc_send_ussd_no_srv(conn, msg, msc->ussd_grace_txt); |
Jacob Erlbeck | 3ccb86b | 2013-09-11 10:46:55 +0200 | [diff] [blame] | 245 | |
Holger Hans Peter Freyther | 9c61b2a | 2010-11-05 19:48:47 +0100 | [diff] [blame] | 246 | return BSC_API_CONN_POL_REJECT; |
Jacob Erlbeck | 3ccb86b | 2013-09-11 10:46:55 +0200 | [diff] [blame] | 247 | } |
| 248 | |
Holger Hans Peter Freyther | 48f9a4e | 2015-04-05 20:53:42 +0200 | [diff] [blame^] | 249 | if (imsi) |
| 250 | conn->sccp_con->filter_state.imsi = talloc_steal(conn, imsi); |
| 251 | |
Jacob Erlbeck | 3ccb86b | 2013-09-11 10:46:55 +0200 | [diff] [blame] | 252 | /* check return value, if failed check msg for and send USSD */ |
Holger Hans Peter Freyther | 9c61b2a | 2010-11-05 19:48:47 +0100 | [diff] [blame] | 253 | |
Holger Hans Peter Freyther | 5e84584 | 2011-06-04 14:51:51 +0200 | [diff] [blame] | 254 | network_code = get_network_code_for_msc(conn->sccp_con->msc); |
| 255 | country_code = get_country_code_for_msc(conn->sccp_con->msc); |
Holger Hans Peter Freyther | 05e2770 | 2015-04-01 18:15:48 +0200 | [diff] [blame] | 256 | lac = get_lac_for_msc(conn->sccp_con->msc, conn->bts); |
| 257 | ci = get_ci_for_msc(conn->sccp_con->msc, conn->bts); |
Holger Hans Peter Freyther | 5e84584 | 2011-06-04 14:51:51 +0200 | [diff] [blame] | 258 | |
Holger Hans Peter Freyther | 9c61b2a | 2010-11-05 19:48:47 +0100 | [diff] [blame] | 259 | bsc_scan_bts_msg(conn, msg); |
Holger Hans Peter Freyther | e192c7b | 2015-04-05 21:03:49 +0200 | [diff] [blame] | 260 | |
Holger Hans Peter Freyther | 05e2770 | 2015-04-01 18:15:48 +0200 | [diff] [blame] | 261 | resp = gsm0808_create_layer3(msg, network_code, country_code, lac, ci); |
Holger Hans Peter Freyther | 9c61b2a | 2010-11-05 19:48:47 +0100 | [diff] [blame] | 262 | if (!resp) { |
| 263 | LOGP(DMSC, LOGL_DEBUG, "Failed to create layer3 message.\n"); |
Holger Hans Peter Freyther | 326a124 | 2011-06-09 14:44:47 +0200 | [diff] [blame] | 264 | sccp_connection_free(conn->sccp_con->sccp); |
Holger Hans Peter Freyther | 288b80a | 2010-11-06 20:15:17 +0100 | [diff] [blame] | 265 | bsc_delete_connection(conn->sccp_con); |
Holger Hans Peter Freyther | 9c61b2a | 2010-11-05 19:48:47 +0100 | [diff] [blame] | 266 | return BSC_API_CONN_POL_REJECT; |
Holger Hans Peter Freyther | b408d79 | 2010-11-05 11:21:18 +0100 | [diff] [blame] | 267 | } |
| 268 | |
Holger Hans Peter Freyther | 288b80a | 2010-11-06 20:15:17 +0100 | [diff] [blame] | 269 | if (bsc_open_connection(conn->sccp_con, resp) != 0) { |
Holger Hans Peter Freyther | 326a124 | 2011-06-09 14:44:47 +0200 | [diff] [blame] | 270 | sccp_connection_free(conn->sccp_con->sccp); |
Holger Hans Peter Freyther | 288b80a | 2010-11-06 20:15:17 +0100 | [diff] [blame] | 271 | bsc_delete_connection(conn->sccp_con); |
Holger Hans Peter Freyther | 9c61b2a | 2010-11-05 19:48:47 +0100 | [diff] [blame] | 272 | msgb_free(resp); |
| 273 | return BSC_API_CONN_POL_REJECT; |
| 274 | } |
| 275 | |
| 276 | return BSC_API_CONN_POL_ACCEPT; |
Holger Hans Peter Freyther | 7d23130 | 2010-09-16 17:26:35 +0800 | [diff] [blame] | 277 | } |
| 278 | |
Holger Hans Peter Freyther | 260440b | 2011-06-09 17:37:04 +0200 | [diff] [blame] | 279 | /* |
| 280 | * Plastic surgery... we want to give up the current connection |
| 281 | */ |
| 282 | static int move_to_msc(struct gsm_subscriber_connection *_conn, |
| 283 | struct msgb *msg, struct osmo_msc_data *msc) |
| 284 | { |
| 285 | struct osmo_bsc_sccp_con *old_con = _conn->sccp_con; |
| 286 | |
| 287 | /* |
| 288 | * 1. Give up the old connection. |
| 289 | * This happens by sending a clear request to the MSC, |
| 290 | * it should end with the MSC releasing the connection. |
| 291 | */ |
| 292 | old_con->conn = NULL; |
| 293 | bsc_clear_request(_conn, 0); |
| 294 | |
| 295 | /* |
| 296 | * 2. Attempt to create a new connection to the local |
| 297 | * MSC. If it fails the caller will need to handle this |
| 298 | * properly. |
| 299 | */ |
| 300 | _conn->sccp_con = NULL; |
| 301 | if (complete_layer3(_conn, msg, msc) != BSC_API_CONN_POL_ACCEPT) { |
| 302 | gsm0808_clear(_conn); |
| 303 | subscr_con_free(_conn); |
| 304 | return 1; |
| 305 | } |
| 306 | |
| 307 | return 2; |
| 308 | } |
| 309 | |
| 310 | static int handle_cc_setup(struct gsm_subscriber_connection *conn, |
| 311 | struct msgb *msg) |
| 312 | { |
| 313 | struct gsm48_hdr *gh = msgb_l3(msg); |
| 314 | uint8_t pdisc = gh->proto_discr & 0x0f; |
| 315 | uint8_t mtype = gh->msg_type & 0xbf; |
| 316 | |
| 317 | struct osmo_msc_data *msc; |
| 318 | struct gsm_mncc_number called; |
| 319 | struct tlv_parsed tp; |
| 320 | unsigned payload_len; |
| 321 | |
| 322 | char _dest_nr[35]; |
| 323 | |
| 324 | /* |
| 325 | * Do we have a setup message here? if not return fast. |
| 326 | */ |
| 327 | if (pdisc != GSM48_PDISC_CC || mtype != GSM48_MT_CC_SETUP) |
| 328 | return 0; |
| 329 | |
| 330 | payload_len = msgb_l3len(msg) - sizeof(*gh); |
| 331 | |
| 332 | tlv_parse(&tp, &gsm48_att_tlvdef, gh->data, payload_len, 0, 0); |
| 333 | if (!TLVP_PRESENT(&tp, GSM48_IE_CALLED_BCD)) { |
| 334 | LOGP(DMSC, LOGL_ERROR, "Called BCD not present in setup.\n"); |
| 335 | return -1; |
| 336 | } |
| 337 | |
| 338 | memset(&called, 0, sizeof(called)); |
| 339 | gsm48_decode_called(&called, |
| 340 | TLVP_VAL(&tp, GSM48_IE_CALLED_BCD) - 1); |
| 341 | |
Holger Hans Peter Freyther | cba5609 | 2011-09-30 16:24:27 +0200 | [diff] [blame] | 342 | if (called.plan != 1 && called.plan != 0) |
Holger Hans Peter Freyther | 260440b | 2011-06-09 17:37:04 +0200 | [diff] [blame] | 343 | return 0; |
| 344 | |
Holger Hans Peter Freyther | cba5609 | 2011-09-30 16:24:27 +0200 | [diff] [blame] | 345 | if (called.plan == 1 && called.type == 1) { |
Holger Hans Peter Freyther | 260440b | 2011-06-09 17:37:04 +0200 | [diff] [blame] | 346 | _dest_nr[0] = _dest_nr[1] = '0'; |
| 347 | memcpy(_dest_nr + 2, called.number, sizeof(called.number)); |
| 348 | } else |
| 349 | memcpy(_dest_nr, called.number, sizeof(called.number)); |
| 350 | |
| 351 | /* |
| 352 | * Check if the connection should be moved... |
| 353 | */ |
| 354 | llist_for_each_entry(msc, &conn->bts->network->bsc_data->mscs, entry) { |
| 355 | if (msc->type != MSC_CON_TYPE_LOCAL) |
| 356 | continue; |
| 357 | if (!msc->local_pref) |
| 358 | continue; |
| 359 | if (regexec(&msc->local_pref_reg, _dest_nr, 0, NULL, 0) != 0) |
| 360 | continue; |
| 361 | |
| 362 | return move_to_msc(conn, msg, msc); |
| 363 | } |
| 364 | |
| 365 | return 0; |
| 366 | } |
| 367 | |
| 368 | |
Holger Hans Peter Freyther | 767ff3c | 2010-11-04 12:18:00 +0100 | [diff] [blame] | 369 | static void bsc_dtap(struct gsm_subscriber_connection *conn, uint8_t link_id, struct msgb *msg) |
Holger Hans Peter Freyther | 7d23130 | 2010-09-16 17:26:35 +0800 | [diff] [blame] | 370 | { |
Holger Hans Peter Freyther | 3623d6b | 2010-11-04 12:24:05 +0100 | [diff] [blame] | 371 | struct msgb *resp; |
Holger Hans Peter Freyther | b6d7014 | 2010-11-03 19:03:35 +0100 | [diff] [blame] | 372 | return_when_not_connected(conn); |
Holger Hans Peter Freyther | 3623d6b | 2010-11-04 12:24:05 +0100 | [diff] [blame] | 373 | |
Harald Welte | 98833af | 2011-07-12 00:05:11 +0200 | [diff] [blame] | 374 | LOGP(DMSC, LOGL_INFO, "Tx MSC DTAP LINK_ID=0x%02x\n", link_id); |
| 375 | |
Holger Hans Peter Freyther | 260440b | 2011-06-09 17:37:04 +0200 | [diff] [blame] | 376 | /* |
| 377 | * We might want to move this connection to a new MSC. Ask someone |
| 378 | * to handle it. If it was handled we will return. |
| 379 | */ |
Holger Hans Peter Freyther | 54f4ad9 | 2011-06-27 21:29:03 +0200 | [diff] [blame] | 380 | if (handle_cc_setup(conn, msg) >= 1) |
Holger Hans Peter Freyther | 260440b | 2011-06-09 17:37:04 +0200 | [diff] [blame] | 381 | return; |
| 382 | |
Holger Hans Peter Freyther | 48f9a4e | 2015-04-05 20:53:42 +0200 | [diff] [blame^] | 383 | /* Check the filter */ |
| 384 | if (bsc_filter_data(conn, msg) < 0) { |
| 385 | bsc_clear_request(conn, 0); |
| 386 | return; |
| 387 | } |
Holger Hans Peter Freyther | 260440b | 2011-06-09 17:37:04 +0200 | [diff] [blame] | 388 | |
Holger Hans Peter Freyther | 48f9a4e | 2015-04-05 20:53:42 +0200 | [diff] [blame^] | 389 | bsc_scan_bts_msg(conn, msg); |
Holger Hans Peter Freyther | 260440b | 2011-06-09 17:37:04 +0200 | [diff] [blame] | 390 | |
Holger Hans Peter Freyther | 3623d6b | 2010-11-04 12:24:05 +0100 | [diff] [blame] | 391 | resp = gsm0808_create_dtap(msg, link_id); |
Holger Hans Peter Freyther | 5f2184c | 2010-11-05 11:02:28 +0100 | [diff] [blame] | 392 | queue_msg_or_return(resp); |
Holger Hans Peter Freyther | 7d23130 | 2010-09-16 17:26:35 +0800 | [diff] [blame] | 393 | } |
| 394 | |
Holger Hans Peter Freyther | 8dd01ef | 2010-11-04 12:06:57 +0100 | [diff] [blame] | 395 | static void bsc_assign_compl(struct gsm_subscriber_connection *conn, uint8_t rr_cause, |
| 396 | uint8_t chosen_channel, uint8_t encr_alg_id, |
| 397 | uint8_t speech_model) |
Holger Hans Peter Freyther | 7d23130 | 2010-09-16 17:26:35 +0800 | [diff] [blame] | 398 | { |
Holger Hans Peter Freyther | 03a61d1 | 2010-11-04 12:09:45 +0100 | [diff] [blame] | 399 | struct msgb *resp; |
Holger Hans Peter Freyther | b6d7014 | 2010-11-03 19:03:35 +0100 | [diff] [blame] | 400 | return_when_not_connected(conn); |
Holger Hans Peter Freyther | 03a61d1 | 2010-11-04 12:09:45 +0100 | [diff] [blame] | 401 | |
Harald Welte | 98833af | 2011-07-12 00:05:11 +0200 | [diff] [blame] | 402 | LOGP(DMSC, LOGL_INFO, "Tx MSC ASSIGN COMPL\n"); |
| 403 | |
Holger Hans Peter Freyther | 03a61d1 | 2010-11-04 12:09:45 +0100 | [diff] [blame] | 404 | resp = gsm0808_create_assignment_completed(rr_cause, chosen_channel, |
| 405 | encr_alg_id, speech_model); |
Holger Hans Peter Freyther | 5f2184c | 2010-11-05 11:02:28 +0100 | [diff] [blame] | 406 | queue_msg_or_return(resp); |
Holger Hans Peter Freyther | 7d23130 | 2010-09-16 17:26:35 +0800 | [diff] [blame] | 407 | } |
| 408 | |
Holger Hans Peter Freyther | 9ff6568 | 2010-11-05 10:37:17 +0100 | [diff] [blame] | 409 | static void bsc_assign_fail(struct gsm_subscriber_connection *conn, |
| 410 | uint8_t cause, uint8_t *rr_cause) |
Holger Hans Peter Freyther | 7d23130 | 2010-09-16 17:26:35 +0800 | [diff] [blame] | 411 | { |
Holger Hans Peter Freyther | cfa3747 | 2010-11-05 10:59:45 +0100 | [diff] [blame] | 412 | struct msgb *resp; |
Holger Hans Peter Freyther | b6d7014 | 2010-11-03 19:03:35 +0100 | [diff] [blame] | 413 | return_when_not_connected(conn); |
Holger Hans Peter Freyther | cfa3747 | 2010-11-05 10:59:45 +0100 | [diff] [blame] | 414 | |
Harald Welte | 98833af | 2011-07-12 00:05:11 +0200 | [diff] [blame] | 415 | LOGP(DMSC, LOGL_INFO, "Tx MSC ASSIGN FAIL\n"); |
| 416 | |
Holger Hans Peter Freyther | cfa3747 | 2010-11-05 10:59:45 +0100 | [diff] [blame] | 417 | resp = gsm0808_create_assignment_failure(cause, rr_cause); |
Holger Hans Peter Freyther | 5f2184c | 2010-11-05 11:02:28 +0100 | [diff] [blame] | 418 | queue_msg_or_return(resp); |
Holger Hans Peter Freyther | 7d23130 | 2010-09-16 17:26:35 +0800 | [diff] [blame] | 419 | } |
| 420 | |
Holger Hans Peter Freyther | 0aa55a3 | 2010-11-03 19:01:58 +0100 | [diff] [blame] | 421 | static int bsc_clear_request(struct gsm_subscriber_connection *conn, uint32_t cause) |
Holger Hans Peter Freyther | 7d23130 | 2010-09-16 17:26:35 +0800 | [diff] [blame] | 422 | { |
Holger Hans Peter Freyther | 97f5a1a | 2011-08-06 14:52:56 +0200 | [diff] [blame] | 423 | struct osmo_bsc_sccp_con *sccp; |
Holger Hans Peter Freyther | ef2d1bf | 2010-11-04 12:47:06 +0100 | [diff] [blame] | 424 | struct msgb *resp; |
Holger Hans Peter Freyther | b6d7014 | 2010-11-03 19:03:35 +0100 | [diff] [blame] | 425 | return_when_not_connected_val(conn, 1); |
Holger Hans Peter Freyther | ef2d1bf | 2010-11-04 12:47:06 +0100 | [diff] [blame] | 426 | |
Harald Welte | 98833af | 2011-07-12 00:05:11 +0200 | [diff] [blame] | 427 | LOGP(DMSC, LOGL_INFO, "Tx MSC CLEAR REQUEST\n"); |
| 428 | |
Holger Hans Peter Freyther | 97f5a1a | 2011-08-06 14:52:56 +0200 | [diff] [blame] | 429 | /* |
| 430 | * Remove the connection from BSC<->SCCP part, the SCCP part |
| 431 | * will either be cleared by channel release or MSC disconnect |
| 432 | */ |
| 433 | sccp = conn->sccp_con; |
| 434 | sccp->conn = NULL; |
| 435 | conn->sccp_con = NULL; |
| 436 | |
Holger Hans Peter Freyther | ef2d1bf | 2010-11-04 12:47:06 +0100 | [diff] [blame] | 437 | resp = gsm0808_create_clear_rqst(GSM0808_CAUSE_RADIO_INTERFACE_FAILURE); |
| 438 | if (!resp) { |
| 439 | LOGP(DMSC, LOGL_ERROR, "Failed to allocate response.\n"); |
Holger Hans Peter Freyther | 97f5a1a | 2011-08-06 14:52:56 +0200 | [diff] [blame] | 440 | return 1; |
Holger Hans Peter Freyther | ef2d1bf | 2010-11-04 12:47:06 +0100 | [diff] [blame] | 441 | } |
| 442 | |
Holger Hans Peter Freyther | 97f5a1a | 2011-08-06 14:52:56 +0200 | [diff] [blame] | 443 | bsc_queue_for_msc(sccp, resp); |
| 444 | return 1; |
Holger Hans Peter Freyther | 7d23130 | 2010-09-16 17:26:35 +0800 | [diff] [blame] | 445 | } |
| 446 | |
Harald Welte | cd4acaf | 2012-01-23 10:28:35 +0100 | [diff] [blame] | 447 | static void bsc_cm_update(struct gsm_subscriber_connection *conn, |
| 448 | const uint8_t *cm2, uint8_t cm2_len, |
| 449 | const uint8_t *cm3, uint8_t cm3_len) |
| 450 | { |
Harald Welte | cd4acaf | 2012-01-23 10:28:35 +0100 | [diff] [blame] | 451 | struct msgb *resp; |
Holger Hans Peter Freyther | 93b0a14 | 2012-03-16 11:49:46 +0100 | [diff] [blame] | 452 | return_when_not_connected(conn); |
Harald Welte | cd4acaf | 2012-01-23 10:28:35 +0100 | [diff] [blame] | 453 | |
| 454 | resp = gsm0808_create_classmark_update(cm2, cm2_len, cm3, cm3_len); |
| 455 | |
| 456 | queue_msg_or_return(resp); |
| 457 | } |
| 458 | |
Holger Hans Peter Freyther | ce6d3d7 | 2011-08-06 07:00:52 +0200 | [diff] [blame] | 459 | static void bsc_mr_config(struct gsm_subscriber_connection *conn, |
| 460 | struct gsm48_multi_rate_conf *conf) |
| 461 | { |
| 462 | struct osmo_msc_data *msc; |
| 463 | |
| 464 | if (!conn->sccp_con) { |
| 465 | LOGP(DMSC, LOGL_ERROR, |
| 466 | "No msc data available on conn %p. Audio will be broken.\n", |
| 467 | conn); |
| 468 | return; |
| 469 | } |
| 470 | |
| 471 | msc = conn->sccp_con->msc; |
| 472 | |
| 473 | conf->ver = 1; |
| 474 | conf->icmi = 1; |
| 475 | |
| 476 | /* maybe gcc see's it is copy of _one_ byte */ |
| 477 | conf->m4_75 = msc->amr_conf.m4_75; |
| 478 | conf->m5_15 = msc->amr_conf.m5_15; |
| 479 | conf->m5_90 = msc->amr_conf.m5_90; |
| 480 | conf->m6_70 = msc->amr_conf.m6_70; |
| 481 | conf->m7_40 = msc->amr_conf.m7_40; |
| 482 | conf->m7_95 = msc->amr_conf.m7_95; |
| 483 | conf->m10_2 = msc->amr_conf.m10_2; |
| 484 | conf->m12_2 = msc->amr_conf.m12_2; |
| 485 | } |
| 486 | |
Holger Hans Peter Freyther | 7d23130 | 2010-09-16 17:26:35 +0800 | [diff] [blame] | 487 | static struct bsc_api bsc_handler = { |
| 488 | .sapi_n_reject = bsc_sapi_n_reject, |
| 489 | .cipher_mode_compl = bsc_cipher_mode_compl, |
Holger Hans Peter Freyther | 7d23130 | 2010-09-16 17:26:35 +0800 | [diff] [blame] | 490 | .compl_l3 = bsc_compl_l3, |
| 491 | .dtap = bsc_dtap, |
| 492 | .assign_compl = bsc_assign_compl, |
| 493 | .assign_fail = bsc_assign_fail, |
| 494 | .clear_request = bsc_clear_request, |
Harald Welte | cd4acaf | 2012-01-23 10:28:35 +0100 | [diff] [blame] | 495 | .classmark_chg = bsc_cm_update, |
Holger Hans Peter Freyther | ce6d3d7 | 2011-08-06 07:00:52 +0200 | [diff] [blame] | 496 | .mr_config = bsc_mr_config, |
Holger Hans Peter Freyther | 7d23130 | 2010-09-16 17:26:35 +0800 | [diff] [blame] | 497 | }; |
| 498 | |
Holger Hans Peter Freyther | 22e9ac3 | 2010-07-05 16:02:04 +0800 | [diff] [blame] | 499 | struct bsc_api *osmo_bsc_api() |
| 500 | { |
Holger Hans Peter Freyther | 7d23130 | 2010-09-16 17:26:35 +0800 | [diff] [blame] | 501 | return &bsc_handler; |
Holger Hans Peter Freyther | 22e9ac3 | 2010-07-05 16:02:04 +0800 | [diff] [blame] | 502 | } |