Holger Hans Peter Freyther | 8ec4952 | 2011-08-15 15:53:00 +0200 | [diff] [blame] | 1 | /* (C) 2009-2011 by Holger Hans Peter Freyther <zecke@selfish.org> |
| 2 | * (C) 2009-2011 by On-Waves |
Holger Hans Peter Freyther | 4f448c9 | 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 | 9af6ddf | 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 | 4f448c9 | 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 | 9af6ddf | 2011-01-01 15:25:50 +0100 | [diff] [blame] | 13 | * GNU Affero General Public License for more details. |
Holger Hans Peter Freyther | 4f448c9 | 2010-07-05 16:02:04 +0800 | [diff] [blame] | 14 | * |
Harald Welte | 9af6ddf | 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 | 4f448c9 | 2010-07-05 16:02:04 +0800 | [diff] [blame] | 17 | * |
| 18 | */ |
| 19 | |
| 20 | #include <openbsc/osmo_bsc.h> |
Holger Hans Peter Freyther | 9b17c76 | 2010-11-05 19:48:47 +0100 | [diff] [blame] | 21 | #include <openbsc/osmo_msc_data.h> |
Holger Hans Peter Freyther | 7225fd1 | 2010-11-03 19:03:35 +0100 | [diff] [blame] | 22 | #include <openbsc/debug.h> |
| 23 | |
Jacob Erlbeck | 56595f8 | 2013-09-11 10:46:55 +0200 | [diff] [blame] | 24 | #include <openbsc/gsm_04_80.h> |
| 25 | |
Harald Welte | d36ff76 | 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 | 2d2c910 | 2010-11-04 11:59:41 +0100 | [diff] [blame] | 28 | |
Holger Hans Peter Freyther | 9b9a171 | 2011-06-09 14:44:47 +0200 | [diff] [blame] | 29 | #include <osmocom/sccp/sccp.h> |
| 30 | |
Holger Hans Peter Freyther | 7225fd1 | 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 | 4f448c9 | 2010-07-05 16:02:04 +0800 | [diff] [blame] | 42 | |
Holger Hans Peter Freyther | 46c5ab3 | 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 | 863a55d | 2010-11-10 09:31:41 +0100 | [diff] [blame] | 48 | bsc_queue_for_msc(conn->sccp_con, resp); |
Holger Hans Peter Freyther | 46c5ab3 | 2010-11-05 11:02:28 +0100 | [diff] [blame] | 49 | |
Holger Hans Peter Freyther | 83d2d38 | 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 | 4cdb050 | 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 | 9b17c76 | 2010-11-05 19:48:47 +0100 | [diff] [blame] | 55 | { |
Holger Hans Peter Freyther | 4cdb050 | 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 | 9b17c76 | 2010-11-05 19:48:47 +0100 | [diff] [blame] | 59 | } |
| 60 | |
Holger Hans Peter Freyther | 4cdb050 | 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 | 9b17c76 | 2010-11-05 19:48:47 +0100 | [diff] [blame] | 62 | { |
Holger Hans Peter Freyther | 4cdb050 | 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 | 9b17c76 | 2010-11-05 19:48:47 +0100 | [diff] [blame] | 66 | } |
| 67 | |
Holger Hans Peter Freyther | 32dd2f3 | 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 | |
| 82 | |
Holger Hans Peter Freyther | 32aaef6 | 2010-09-16 17:26:35 +0800 | [diff] [blame] | 83 | static void bsc_sapi_n_reject(struct gsm_subscriber_connection *conn, int dlci) |
| 84 | { |
Holger Hans Peter Freyther | c8166f3 | 2010-11-04 12:28:32 +0100 | [diff] [blame] | 85 | struct msgb *resp; |
Holger Hans Peter Freyther | 7225fd1 | 2010-11-03 19:03:35 +0100 | [diff] [blame] | 86 | return_when_not_connected(conn); |
Holger Hans Peter Freyther | c8166f3 | 2010-11-04 12:28:32 +0100 | [diff] [blame] | 87 | |
Harald Welte | 7d33bdf | 2011-07-12 00:05:11 +0200 | [diff] [blame] | 88 | LOGP(DMSC, LOGL_NOTICE, "Tx MSC SAPI N REJECT DLCI=0x%02x\n", dlci); |
| 89 | |
Holger Hans Peter Freyther | c8166f3 | 2010-11-04 12:28:32 +0100 | [diff] [blame] | 90 | resp = gsm0808_create_sapi_reject(dlci); |
Holger Hans Peter Freyther | 46c5ab3 | 2010-11-05 11:02:28 +0100 | [diff] [blame] | 91 | queue_msg_or_return(resp); |
Holger Hans Peter Freyther | 32aaef6 | 2010-09-16 17:26:35 +0800 | [diff] [blame] | 92 | } |
| 93 | |
| 94 | static void bsc_cipher_mode_compl(struct gsm_subscriber_connection *conn, |
| 95 | struct msgb *msg, uint8_t chosen_encr) |
| 96 | { |
Holger Hans Peter Freyther | 2d2c910 | 2010-11-04 11:59:41 +0100 | [diff] [blame] | 97 | struct msgb *resp; |
Holger Hans Peter Freyther | 7225fd1 | 2010-11-03 19:03:35 +0100 | [diff] [blame] | 98 | return_when_not_connected(conn); |
Holger Hans Peter Freyther | 2d2c910 | 2010-11-04 11:59:41 +0100 | [diff] [blame] | 99 | |
| 100 | LOGP(DMSC, LOGL_DEBUG, "CIPHER MODE COMPLETE from MS, forwarding to MSC\n"); |
| 101 | resp = gsm0808_create_cipher_complete(msg, chosen_encr); |
Holger Hans Peter Freyther | 46c5ab3 | 2010-11-05 11:02:28 +0100 | [diff] [blame] | 102 | queue_msg_or_return(resp); |
Holger Hans Peter Freyther | 32aaef6 | 2010-09-16 17:26:35 +0800 | [diff] [blame] | 103 | } |
| 104 | |
Jacob Erlbeck | aff2d62 | 2013-10-31 15:36:43 +0100 | [diff] [blame] | 105 | static void bsc_send_ussd_no_srv(struct gsm_subscriber_connection *conn, |
| 106 | struct msgb *msg, const char *text) |
Jacob Erlbeck | 56595f8 | 2013-09-11 10:46:55 +0200 | [diff] [blame] | 107 | { |
| 108 | struct gsm48_hdr *gh; |
| 109 | int8_t pdisc; |
| 110 | uint8_t mtype; |
| 111 | int drop_message = 1; |
| 112 | |
| 113 | if (!text) |
| 114 | return; |
| 115 | |
| 116 | if (!msg || msgb_l3len(msg) < sizeof(*gh)) |
| 117 | return; |
| 118 | |
| 119 | gh = msgb_l3(msg); |
| 120 | pdisc = gh->proto_discr & 0x0f; |
| 121 | mtype = gh->msg_type & 0xbf; |
| 122 | |
| 123 | /* Is CM service request? */ |
| 124 | if (pdisc == GSM48_PDISC_MM && mtype == GSM48_MT_MM_CM_SERV_REQ) { |
| 125 | struct gsm48_service_request *cm; |
| 126 | |
| 127 | cm = (struct gsm48_service_request *) &gh->data[0]; |
| 128 | |
| 129 | /* Is type SMS or call? */ |
| 130 | if (cm->cm_service_type == GSM48_CMSERV_SMS) |
| 131 | drop_message = 0; |
| 132 | else if (cm->cm_service_type == GSM48_CMSERV_MO_CALL_PACKET) |
| 133 | drop_message = 0; |
| 134 | } |
| 135 | |
| 136 | if (drop_message) { |
Holger Hans Peter Freyther | 28e183f | 2013-10-31 13:35:28 +0100 | [diff] [blame] | 137 | LOGP(DMSC, LOGL_DEBUG, "Skipping (not sending) USSD message: '%s'\n", text); |
Jacob Erlbeck | 56595f8 | 2013-09-11 10:46:55 +0200 | [diff] [blame] | 138 | return; |
| 139 | } |
| 140 | |
Jacob Erlbeck | b125031 | 2013-10-31 15:36:42 +0100 | [diff] [blame] | 141 | LOGP(DMSC, LOGL_INFO, "Sending CM Service Accept\n"); |
| 142 | gsm48_tx_mm_serv_ack(conn); |
| 143 | |
Jacob Erlbeck | 56595f8 | 2013-09-11 10:46:55 +0200 | [diff] [blame] | 144 | LOGP(DMSC, LOGL_INFO, "Sending USSD message: '%s'\n", text); |
| 145 | gsm0480_send_ussdNotify(conn, 1, text); |
| 146 | gsm0480_send_releaseComplete(conn); |
| 147 | } |
| 148 | |
Holger Hans Peter Freyther | 9b17c76 | 2010-11-05 19:48:47 +0100 | [diff] [blame] | 149 | /* |
| 150 | * Instruct to reserve data for a new connectiom, create the complete |
| 151 | * layer three message, send it to open the connection. |
| 152 | */ |
Holger Hans Peter Freyther | 32aaef6 | 2010-09-16 17:26:35 +0800 | [diff] [blame] | 153 | static int bsc_compl_l3(struct gsm_subscriber_connection *conn, struct msgb *msg, |
| 154 | uint16_t chosen_channel) |
| 155 | { |
Holger Hans Peter Freyther | 354c87c | 2011-06-07 11:40:20 +0200 | [diff] [blame] | 156 | struct osmo_msc_data *msc; |
Holger Hans Peter Freyther | 9b17c76 | 2010-11-05 19:48:47 +0100 | [diff] [blame] | 157 | |
Harald Welte | 7d33bdf | 2011-07-12 00:05:11 +0200 | [diff] [blame] | 158 | LOGP(DMSC, LOGL_INFO, "Tx MSC COMPL L3\n"); |
| 159 | |
Holger Hans Peter Freyther | 354c87c | 2011-06-07 11:40:20 +0200 | [diff] [blame] | 160 | /* find the MSC link we want to use */ |
Holger Hans Peter Freyther | 076af1c | 2011-06-07 19:57:02 +0200 | [diff] [blame] | 161 | msc = bsc_find_msc(conn, msg); |
Holger Hans Peter Freyther | 354c87c | 2011-06-07 11:40:20 +0200 | [diff] [blame] | 162 | if (!msc) { |
| 163 | LOGP(DMSC, LOGL_ERROR, "Failed to find a MSC for a connection.\n"); |
Jacob Erlbeck | aff2d62 | 2013-10-31 15:36:43 +0100 | [diff] [blame] | 164 | bsc_send_ussd_no_srv(conn, msg, |
| 165 | conn->bts->network->bsc_data->ussd_no_msc_txt); |
Holger Hans Peter Freyther | 354c87c | 2011-06-07 11:40:20 +0200 | [diff] [blame] | 166 | return -1; |
| 167 | } |
| 168 | |
Holger Hans Peter Freyther | 83d2d38 | 2011-06-09 17:37:04 +0200 | [diff] [blame] | 169 | return complete_layer3(conn, msg, msc); |
| 170 | } |
| 171 | |
| 172 | static int complete_layer3(struct gsm_subscriber_connection *conn, |
| 173 | struct msgb *msg, struct osmo_msc_data *msc) |
| 174 | { |
Holger Hans Peter Freyther | 56cb729 | 2014-09-02 17:28:40 +0200 | [diff] [blame] | 175 | struct timeval tv; |
Holger Hans Peter Freyther | 83d2d38 | 2011-06-09 17:37:04 +0200 | [diff] [blame] | 176 | struct msgb *resp; |
| 177 | uint16_t network_code; |
| 178 | uint16_t country_code; |
Holger Hans Peter Freyther | 32dd2f3 | 2015-04-01 18:15:48 +0200 | [diff] [blame] | 179 | uint16_t lac; |
| 180 | uint16_t ci; |
Jacob Erlbeck | 56595f8 | 2013-09-11 10:46:55 +0200 | [diff] [blame] | 181 | enum bsc_con ret; |
Holger Hans Peter Freyther | 56cb729 | 2014-09-02 17:28:40 +0200 | [diff] [blame] | 182 | int send_ping = msc->advanced_ping; |
| 183 | |
| 184 | /* Advanced ping/pong handling */ |
| 185 | if (osmo_timer_pending(&msc->pong_timer)) |
| 186 | send_ping = 0; |
Holger Hans Peter Freyther | db64f2e | 2014-10-29 10:06:15 +0100 | [diff] [blame] | 187 | if (msc->ping_timeout <= 0) |
Holger Hans Peter Freyther | 56cb729 | 2014-09-02 17:28:40 +0200 | [diff] [blame] | 188 | send_ping = 0; |
| 189 | if (send_ping && osmo_timer_remaining(&msc->ping_timer, NULL, &tv) == -1) |
| 190 | send_ping = 0; |
Holger Hans Peter Freyther | 83d2d38 | 2011-06-09 17:37:04 +0200 | [diff] [blame] | 191 | |
Holger Hans Peter Freyther | 9b17c76 | 2010-11-05 19:48:47 +0100 | [diff] [blame] | 192 | /* allocate resource for a new connection */ |
Holger Hans Peter Freyther | 56cb729 | 2014-09-02 17:28:40 +0200 | [diff] [blame] | 193 | ret = bsc_create_new_connection(conn, msc, send_ping); |
Jacob Erlbeck | 56595f8 | 2013-09-11 10:46:55 +0200 | [diff] [blame] | 194 | |
| 195 | if (ret != BSC_CON_SUCCESS) { |
| 196 | /* allocation has failed */ |
| 197 | if (ret == BSC_CON_REJECT_NO_LINK) |
Jacob Erlbeck | aff2d62 | 2013-10-31 15:36:43 +0100 | [diff] [blame] | 198 | bsc_send_ussd_no_srv(conn, msg, msc->ussd_msc_lost_txt); |
Jacob Erlbeck | 56595f8 | 2013-09-11 10:46:55 +0200 | [diff] [blame] | 199 | else if (ret == BSC_CON_REJECT_RF_GRACE) |
Jacob Erlbeck | aff2d62 | 2013-10-31 15:36:43 +0100 | [diff] [blame] | 200 | bsc_send_ussd_no_srv(conn, msg, msc->ussd_grace_txt); |
Jacob Erlbeck | 56595f8 | 2013-09-11 10:46:55 +0200 | [diff] [blame] | 201 | |
Holger Hans Peter Freyther | 9b17c76 | 2010-11-05 19:48:47 +0100 | [diff] [blame] | 202 | return BSC_API_CONN_POL_REJECT; |
Jacob Erlbeck | 56595f8 | 2013-09-11 10:46:55 +0200 | [diff] [blame] | 203 | } |
| 204 | |
| 205 | /* check return value, if failed check msg for and send USSD */ |
Holger Hans Peter Freyther | 9b17c76 | 2010-11-05 19:48:47 +0100 | [diff] [blame] | 206 | |
Holger Hans Peter Freyther | 4cdb050 | 2011-06-04 14:51:51 +0200 | [diff] [blame] | 207 | network_code = get_network_code_for_msc(conn->sccp_con->msc); |
| 208 | country_code = get_country_code_for_msc(conn->sccp_con->msc); |
Holger Hans Peter Freyther | 32dd2f3 | 2015-04-01 18:15:48 +0200 | [diff] [blame] | 209 | lac = get_lac_for_msc(conn->sccp_con->msc, conn->bts); |
| 210 | ci = get_ci_for_msc(conn->sccp_con->msc, conn->bts); |
Holger Hans Peter Freyther | 4cdb050 | 2011-06-04 14:51:51 +0200 | [diff] [blame] | 211 | |
Holger Hans Peter Freyther | 9b17c76 | 2010-11-05 19:48:47 +0100 | [diff] [blame] | 212 | bsc_scan_bts_msg(conn, msg); |
Holger Hans Peter Freyther | 32dd2f3 | 2015-04-01 18:15:48 +0200 | [diff] [blame] | 213 | resp = gsm0808_create_layer3(msg, network_code, country_code, lac, ci); |
Holger Hans Peter Freyther | 9b17c76 | 2010-11-05 19:48:47 +0100 | [diff] [blame] | 214 | if (!resp) { |
| 215 | LOGP(DMSC, LOGL_DEBUG, "Failed to create layer3 message.\n"); |
Holger Hans Peter Freyther | 9b9a171 | 2011-06-09 14:44:47 +0200 | [diff] [blame] | 216 | sccp_connection_free(conn->sccp_con->sccp); |
Holger Hans Peter Freyther | 7e90108 | 2010-11-06 20:15:17 +0100 | [diff] [blame] | 217 | bsc_delete_connection(conn->sccp_con); |
Holger Hans Peter Freyther | 9b17c76 | 2010-11-05 19:48:47 +0100 | [diff] [blame] | 218 | return BSC_API_CONN_POL_REJECT; |
Holger Hans Peter Freyther | 5bb874d | 2010-11-05 11:21:18 +0100 | [diff] [blame] | 219 | } |
| 220 | |
Holger Hans Peter Freyther | 7e90108 | 2010-11-06 20:15:17 +0100 | [diff] [blame] | 221 | if (bsc_open_connection(conn->sccp_con, resp) != 0) { |
Holger Hans Peter Freyther | 9b9a171 | 2011-06-09 14:44:47 +0200 | [diff] [blame] | 222 | sccp_connection_free(conn->sccp_con->sccp); |
Holger Hans Peter Freyther | 7e90108 | 2010-11-06 20:15:17 +0100 | [diff] [blame] | 223 | bsc_delete_connection(conn->sccp_con); |
Holger Hans Peter Freyther | 9b17c76 | 2010-11-05 19:48:47 +0100 | [diff] [blame] | 224 | msgb_free(resp); |
| 225 | return BSC_API_CONN_POL_REJECT; |
| 226 | } |
| 227 | |
| 228 | return BSC_API_CONN_POL_ACCEPT; |
Holger Hans Peter Freyther | 32aaef6 | 2010-09-16 17:26:35 +0800 | [diff] [blame] | 229 | } |
| 230 | |
Holger Hans Peter Freyther | 83d2d38 | 2011-06-09 17:37:04 +0200 | [diff] [blame] | 231 | /* |
| 232 | * Plastic surgery... we want to give up the current connection |
| 233 | */ |
| 234 | static int move_to_msc(struct gsm_subscriber_connection *_conn, |
| 235 | struct msgb *msg, struct osmo_msc_data *msc) |
| 236 | { |
| 237 | struct osmo_bsc_sccp_con *old_con = _conn->sccp_con; |
| 238 | |
| 239 | /* |
| 240 | * 1. Give up the old connection. |
| 241 | * This happens by sending a clear request to the MSC, |
| 242 | * it should end with the MSC releasing the connection. |
| 243 | */ |
| 244 | old_con->conn = NULL; |
| 245 | bsc_clear_request(_conn, 0); |
| 246 | |
| 247 | /* |
| 248 | * 2. Attempt to create a new connection to the local |
| 249 | * MSC. If it fails the caller will need to handle this |
| 250 | * properly. |
| 251 | */ |
| 252 | _conn->sccp_con = NULL; |
| 253 | if (complete_layer3(_conn, msg, msc) != BSC_API_CONN_POL_ACCEPT) { |
| 254 | gsm0808_clear(_conn); |
| 255 | subscr_con_free(_conn); |
| 256 | return 1; |
| 257 | } |
| 258 | |
| 259 | return 2; |
| 260 | } |
| 261 | |
| 262 | static int handle_cc_setup(struct gsm_subscriber_connection *conn, |
| 263 | struct msgb *msg) |
| 264 | { |
| 265 | struct gsm48_hdr *gh = msgb_l3(msg); |
| 266 | uint8_t pdisc = gh->proto_discr & 0x0f; |
| 267 | uint8_t mtype = gh->msg_type & 0xbf; |
| 268 | |
| 269 | struct osmo_msc_data *msc; |
| 270 | struct gsm_mncc_number called; |
| 271 | struct tlv_parsed tp; |
| 272 | unsigned payload_len; |
| 273 | |
| 274 | char _dest_nr[35]; |
| 275 | |
| 276 | /* |
| 277 | * Do we have a setup message here? if not return fast. |
| 278 | */ |
| 279 | if (pdisc != GSM48_PDISC_CC || mtype != GSM48_MT_CC_SETUP) |
| 280 | return 0; |
| 281 | |
| 282 | payload_len = msgb_l3len(msg) - sizeof(*gh); |
| 283 | |
| 284 | tlv_parse(&tp, &gsm48_att_tlvdef, gh->data, payload_len, 0, 0); |
| 285 | if (!TLVP_PRESENT(&tp, GSM48_IE_CALLED_BCD)) { |
| 286 | LOGP(DMSC, LOGL_ERROR, "Called BCD not present in setup.\n"); |
| 287 | return -1; |
| 288 | } |
| 289 | |
| 290 | memset(&called, 0, sizeof(called)); |
| 291 | gsm48_decode_called(&called, |
| 292 | TLVP_VAL(&tp, GSM48_IE_CALLED_BCD) - 1); |
| 293 | |
Holger Hans Peter Freyther | 0b19d55 | 2011-09-30 16:24:27 +0200 | [diff] [blame] | 294 | if (called.plan != 1 && called.plan != 0) |
Holger Hans Peter Freyther | 83d2d38 | 2011-06-09 17:37:04 +0200 | [diff] [blame] | 295 | return 0; |
| 296 | |
Holger Hans Peter Freyther | 0b19d55 | 2011-09-30 16:24:27 +0200 | [diff] [blame] | 297 | if (called.plan == 1 && called.type == 1) { |
Holger Hans Peter Freyther | 83d2d38 | 2011-06-09 17:37:04 +0200 | [diff] [blame] | 298 | _dest_nr[0] = _dest_nr[1] = '0'; |
| 299 | memcpy(_dest_nr + 2, called.number, sizeof(called.number)); |
| 300 | } else |
| 301 | memcpy(_dest_nr, called.number, sizeof(called.number)); |
| 302 | |
| 303 | /* |
| 304 | * Check if the connection should be moved... |
| 305 | */ |
| 306 | llist_for_each_entry(msc, &conn->bts->network->bsc_data->mscs, entry) { |
| 307 | if (msc->type != MSC_CON_TYPE_LOCAL) |
| 308 | continue; |
| 309 | if (!msc->local_pref) |
| 310 | continue; |
| 311 | if (regexec(&msc->local_pref_reg, _dest_nr, 0, NULL, 0) != 0) |
| 312 | continue; |
| 313 | |
| 314 | return move_to_msc(conn, msg, msc); |
| 315 | } |
| 316 | |
| 317 | return 0; |
| 318 | } |
| 319 | |
| 320 | |
Holger Hans Peter Freyther | 46caa30 | 2010-11-04 12:18:00 +0100 | [diff] [blame] | 321 | static void bsc_dtap(struct gsm_subscriber_connection *conn, uint8_t link_id, struct msgb *msg) |
Holger Hans Peter Freyther | 32aaef6 | 2010-09-16 17:26:35 +0800 | [diff] [blame] | 322 | { |
Holger Hans Peter Freyther | 58f2cf6 | 2010-11-04 12:24:05 +0100 | [diff] [blame] | 323 | struct msgb *resp; |
Holger Hans Peter Freyther | 7225fd1 | 2010-11-03 19:03:35 +0100 | [diff] [blame] | 324 | return_when_not_connected(conn); |
Holger Hans Peter Freyther | 58f2cf6 | 2010-11-04 12:24:05 +0100 | [diff] [blame] | 325 | |
Harald Welte | 7d33bdf | 2011-07-12 00:05:11 +0200 | [diff] [blame] | 326 | LOGP(DMSC, LOGL_INFO, "Tx MSC DTAP LINK_ID=0x%02x\n", link_id); |
| 327 | |
Holger Hans Peter Freyther | 83d2d38 | 2011-06-09 17:37:04 +0200 | [diff] [blame] | 328 | /* |
| 329 | * We might want to move this connection to a new MSC. Ask someone |
| 330 | * to handle it. If it was handled we will return. |
| 331 | */ |
Holger Hans Peter Freyther | c7db4dc | 2011-06-27 21:29:03 +0200 | [diff] [blame] | 332 | if (handle_cc_setup(conn, msg) >= 1) |
Holger Hans Peter Freyther | 83d2d38 | 2011-06-09 17:37:04 +0200 | [diff] [blame] | 333 | return; |
| 334 | |
Holger Hans Peter Freyther | 5bb874d | 2010-11-05 11:21:18 +0100 | [diff] [blame] | 335 | bsc_scan_bts_msg(conn, msg); |
Holger Hans Peter Freyther | 83d2d38 | 2011-06-09 17:37:04 +0200 | [diff] [blame] | 336 | |
| 337 | |
Holger Hans Peter Freyther | 58f2cf6 | 2010-11-04 12:24:05 +0100 | [diff] [blame] | 338 | resp = gsm0808_create_dtap(msg, link_id); |
Holger Hans Peter Freyther | 46c5ab3 | 2010-11-05 11:02:28 +0100 | [diff] [blame] | 339 | queue_msg_or_return(resp); |
Holger Hans Peter Freyther | 32aaef6 | 2010-09-16 17:26:35 +0800 | [diff] [blame] | 340 | } |
| 341 | |
Holger Hans Peter Freyther | b094171 | 2010-11-04 12:06:57 +0100 | [diff] [blame] | 342 | static void bsc_assign_compl(struct gsm_subscriber_connection *conn, uint8_t rr_cause, |
| 343 | uint8_t chosen_channel, uint8_t encr_alg_id, |
| 344 | uint8_t speech_model) |
Holger Hans Peter Freyther | 32aaef6 | 2010-09-16 17:26:35 +0800 | [diff] [blame] | 345 | { |
Holger Hans Peter Freyther | da488ae | 2010-11-04 12:09:45 +0100 | [diff] [blame] | 346 | struct msgb *resp; |
Holger Hans Peter Freyther | 7225fd1 | 2010-11-03 19:03:35 +0100 | [diff] [blame] | 347 | return_when_not_connected(conn); |
Holger Hans Peter Freyther | da488ae | 2010-11-04 12:09:45 +0100 | [diff] [blame] | 348 | |
Harald Welte | 7d33bdf | 2011-07-12 00:05:11 +0200 | [diff] [blame] | 349 | LOGP(DMSC, LOGL_INFO, "Tx MSC ASSIGN COMPL\n"); |
| 350 | |
Holger Hans Peter Freyther | da488ae | 2010-11-04 12:09:45 +0100 | [diff] [blame] | 351 | resp = gsm0808_create_assignment_completed(rr_cause, chosen_channel, |
| 352 | encr_alg_id, speech_model); |
Holger Hans Peter Freyther | 46c5ab3 | 2010-11-05 11:02:28 +0100 | [diff] [blame] | 353 | queue_msg_or_return(resp); |
Holger Hans Peter Freyther | 32aaef6 | 2010-09-16 17:26:35 +0800 | [diff] [blame] | 354 | } |
| 355 | |
Holger Hans Peter Freyther | 45b575f | 2010-11-05 10:37:17 +0100 | [diff] [blame] | 356 | static void bsc_assign_fail(struct gsm_subscriber_connection *conn, |
| 357 | uint8_t cause, uint8_t *rr_cause) |
Holger Hans Peter Freyther | 32aaef6 | 2010-09-16 17:26:35 +0800 | [diff] [blame] | 358 | { |
Holger Hans Peter Freyther | e46f1d6 | 2010-11-05 10:59:45 +0100 | [diff] [blame] | 359 | struct msgb *resp; |
Holger Hans Peter Freyther | 7225fd1 | 2010-11-03 19:03:35 +0100 | [diff] [blame] | 360 | return_when_not_connected(conn); |
Holger Hans Peter Freyther | e46f1d6 | 2010-11-05 10:59:45 +0100 | [diff] [blame] | 361 | |
Harald Welte | 7d33bdf | 2011-07-12 00:05:11 +0200 | [diff] [blame] | 362 | LOGP(DMSC, LOGL_INFO, "Tx MSC ASSIGN FAIL\n"); |
| 363 | |
Holger Hans Peter Freyther | e46f1d6 | 2010-11-05 10:59:45 +0100 | [diff] [blame] | 364 | resp = gsm0808_create_assignment_failure(cause, rr_cause); |
Holger Hans Peter Freyther | 46c5ab3 | 2010-11-05 11:02:28 +0100 | [diff] [blame] | 365 | queue_msg_or_return(resp); |
Holger Hans Peter Freyther | 32aaef6 | 2010-09-16 17:26:35 +0800 | [diff] [blame] | 366 | } |
| 367 | |
Holger Hans Peter Freyther | 05c6884 | 2010-11-03 19:01:58 +0100 | [diff] [blame] | 368 | static int bsc_clear_request(struct gsm_subscriber_connection *conn, uint32_t cause) |
Holger Hans Peter Freyther | 32aaef6 | 2010-09-16 17:26:35 +0800 | [diff] [blame] | 369 | { |
Holger Hans Peter Freyther | 80c37bd | 2011-08-06 14:52:56 +0200 | [diff] [blame] | 370 | struct osmo_bsc_sccp_con *sccp; |
Holger Hans Peter Freyther | c2b3270 | 2010-11-04 12:47:06 +0100 | [diff] [blame] | 371 | struct msgb *resp; |
Holger Hans Peter Freyther | 7225fd1 | 2010-11-03 19:03:35 +0100 | [diff] [blame] | 372 | return_when_not_connected_val(conn, 1); |
Holger Hans Peter Freyther | c2b3270 | 2010-11-04 12:47:06 +0100 | [diff] [blame] | 373 | |
Harald Welte | 7d33bdf | 2011-07-12 00:05:11 +0200 | [diff] [blame] | 374 | LOGP(DMSC, LOGL_INFO, "Tx MSC CLEAR REQUEST\n"); |
| 375 | |
Holger Hans Peter Freyther | 80c37bd | 2011-08-06 14:52:56 +0200 | [diff] [blame] | 376 | /* |
| 377 | * Remove the connection from BSC<->SCCP part, the SCCP part |
| 378 | * will either be cleared by channel release or MSC disconnect |
| 379 | */ |
| 380 | sccp = conn->sccp_con; |
| 381 | sccp->conn = NULL; |
| 382 | conn->sccp_con = NULL; |
| 383 | |
Holger Hans Peter Freyther | c2b3270 | 2010-11-04 12:47:06 +0100 | [diff] [blame] | 384 | resp = gsm0808_create_clear_rqst(GSM0808_CAUSE_RADIO_INTERFACE_FAILURE); |
| 385 | if (!resp) { |
| 386 | LOGP(DMSC, LOGL_ERROR, "Failed to allocate response.\n"); |
Holger Hans Peter Freyther | 80c37bd | 2011-08-06 14:52:56 +0200 | [diff] [blame] | 387 | return 1; |
Holger Hans Peter Freyther | c2b3270 | 2010-11-04 12:47:06 +0100 | [diff] [blame] | 388 | } |
| 389 | |
Holger Hans Peter Freyther | 80c37bd | 2011-08-06 14:52:56 +0200 | [diff] [blame] | 390 | bsc_queue_for_msc(sccp, resp); |
| 391 | return 1; |
Holger Hans Peter Freyther | 32aaef6 | 2010-09-16 17:26:35 +0800 | [diff] [blame] | 392 | } |
| 393 | |
Harald Welte | 95e862c | 2012-01-23 10:28:35 +0100 | [diff] [blame] | 394 | static void bsc_cm_update(struct gsm_subscriber_connection *conn, |
| 395 | const uint8_t *cm2, uint8_t cm2_len, |
| 396 | const uint8_t *cm3, uint8_t cm3_len) |
| 397 | { |
Harald Welte | 95e862c | 2012-01-23 10:28:35 +0100 | [diff] [blame] | 398 | struct msgb *resp; |
Holger Hans Peter Freyther | dc3389f | 2012-03-16 11:49:46 +0100 | [diff] [blame] | 399 | return_when_not_connected(conn); |
Harald Welte | 95e862c | 2012-01-23 10:28:35 +0100 | [diff] [blame] | 400 | |
| 401 | resp = gsm0808_create_classmark_update(cm2, cm2_len, cm3, cm3_len); |
| 402 | |
| 403 | queue_msg_or_return(resp); |
| 404 | } |
| 405 | |
Holger Hans Peter Freyther | 25aa749 | 2011-08-06 07:00:52 +0200 | [diff] [blame] | 406 | static void bsc_mr_config(struct gsm_subscriber_connection *conn, |
| 407 | struct gsm48_multi_rate_conf *conf) |
| 408 | { |
| 409 | struct osmo_msc_data *msc; |
| 410 | |
| 411 | if (!conn->sccp_con) { |
| 412 | LOGP(DMSC, LOGL_ERROR, |
| 413 | "No msc data available on conn %p. Audio will be broken.\n", |
| 414 | conn); |
| 415 | return; |
| 416 | } |
| 417 | |
| 418 | msc = conn->sccp_con->msc; |
| 419 | |
| 420 | conf->ver = 1; |
| 421 | conf->icmi = 1; |
| 422 | |
| 423 | /* maybe gcc see's it is copy of _one_ byte */ |
| 424 | conf->m4_75 = msc->amr_conf.m4_75; |
| 425 | conf->m5_15 = msc->amr_conf.m5_15; |
| 426 | conf->m5_90 = msc->amr_conf.m5_90; |
| 427 | conf->m6_70 = msc->amr_conf.m6_70; |
| 428 | conf->m7_40 = msc->amr_conf.m7_40; |
| 429 | conf->m7_95 = msc->amr_conf.m7_95; |
| 430 | conf->m10_2 = msc->amr_conf.m10_2; |
| 431 | conf->m12_2 = msc->amr_conf.m12_2; |
| 432 | } |
| 433 | |
Holger Hans Peter Freyther | 32aaef6 | 2010-09-16 17:26:35 +0800 | [diff] [blame] | 434 | static struct bsc_api bsc_handler = { |
| 435 | .sapi_n_reject = bsc_sapi_n_reject, |
| 436 | .cipher_mode_compl = bsc_cipher_mode_compl, |
Holger Hans Peter Freyther | 32aaef6 | 2010-09-16 17:26:35 +0800 | [diff] [blame] | 437 | .compl_l3 = bsc_compl_l3, |
| 438 | .dtap = bsc_dtap, |
| 439 | .assign_compl = bsc_assign_compl, |
| 440 | .assign_fail = bsc_assign_fail, |
| 441 | .clear_request = bsc_clear_request, |
Harald Welte | 95e862c | 2012-01-23 10:28:35 +0100 | [diff] [blame] | 442 | .classmark_chg = bsc_cm_update, |
Holger Hans Peter Freyther | 25aa749 | 2011-08-06 07:00:52 +0200 | [diff] [blame] | 443 | .mr_config = bsc_mr_config, |
Holger Hans Peter Freyther | 32aaef6 | 2010-09-16 17:26:35 +0800 | [diff] [blame] | 444 | }; |
| 445 | |
Holger Hans Peter Freyther | 4f448c9 | 2010-07-05 16:02:04 +0800 | [diff] [blame] | 446 | struct bsc_api *osmo_bsc_api() |
| 447 | { |
Holger Hans Peter Freyther | 32aaef6 | 2010-09-16 17:26:35 +0800 | [diff] [blame] | 448 | return &bsc_handler; |
Holger Hans Peter Freyther | 4f448c9 | 2010-07-05 16:02:04 +0800 | [diff] [blame] | 449 | } |