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 | 5bb874d | 2010-11-05 11:21:18 +0100 | [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 | 5bb874d | 2010-11-05 11:21:18 +0100 | [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 | 5bb874d | 2010-11-05 11:21:18 +0100 | [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 | 5bb874d | 2010-11-05 11:21:18 +0100 | [diff] [blame] | 17 | * |
| 18 | */ |
| 19 | |
| 20 | #include <openbsc/osmo_bsc.h> |
Neels Hofmeyr | a42855f | 2017-02-23 21:49:55 +0100 | [diff] [blame] | 21 | #include <openbsc/bsc_msc_data.h> |
Holger Hans Peter Freyther | 52d42ab | 2010-11-05 18:41:04 +0100 | [diff] [blame] | 22 | #include <openbsc/gsm_04_80.h> |
Holger Hans Peter Freyther | 16e958d | 2010-11-15 13:34:03 +0100 | [diff] [blame] | 23 | #include <openbsc/gsm_subscriber.h> |
Neels Hofmeyr | 6d804b1 | 2017-02-18 22:20:46 +0100 | [diff] [blame] | 24 | #include <openbsc/bsc_subscriber.h> |
Holger Hans Peter Freyther | d65305f | 2010-11-05 11:31:08 +0100 | [diff] [blame] | 25 | #include <openbsc/debug.h> |
Holger Hans Peter Freyther | 16e958d | 2010-11-15 13:34:03 +0100 | [diff] [blame] | 26 | #include <openbsc/paging.h> |
| 27 | |
| 28 | #include <stdlib.h> |
Holger Hans Peter Freyther | d65305f | 2010-11-05 11:31:08 +0100 | [diff] [blame] | 29 | |
| 30 | static void handle_lu_request(struct gsm_subscriber_connection *conn, |
| 31 | struct msgb *msg) |
| 32 | { |
| 33 | struct gsm48_hdr *gh; |
| 34 | struct gsm48_loc_upd_req *lu; |
| 35 | struct gsm48_loc_area_id lai; |
| 36 | struct gsm_network *net; |
| 37 | |
| 38 | if (msgb_l3len(msg) < sizeof(*gh) + sizeof(*lu)) { |
| 39 | LOGP(DMSC, LOGL_ERROR, "LU too small to look at: %u\n", msgb_l3len(msg)); |
| 40 | return; |
| 41 | } |
| 42 | |
| 43 | net = conn->bts->network; |
| 44 | |
| 45 | gh = msgb_l3(msg); |
| 46 | lu = (struct gsm48_loc_upd_req *) gh->data; |
| 47 | |
| 48 | gsm48_generate_lai(&lai, net->country_code, net->network_code, |
| 49 | conn->bts->location_area_code); |
| 50 | |
| 51 | if (memcmp(&lai, &lu->lai, sizeof(lai)) != 0) { |
| 52 | LOGP(DMSC, LOGL_DEBUG, "Marking con for welcome USSD.\n"); |
| 53 | conn->sccp_con->new_subscriber = 1; |
| 54 | } |
| 55 | } |
Holger Hans Peter Freyther | 5bb874d | 2010-11-05 11:21:18 +0100 | [diff] [blame] | 56 | |
Holger Hans Peter Freyther | f67d9a9 | 2011-06-07 20:12:33 +0200 | [diff] [blame] | 57 | /* extract a subscriber from the paging response */ |
Neels Hofmeyr | 6d804b1 | 2017-02-18 22:20:46 +0100 | [diff] [blame] | 58 | static struct bsc_subscr *extract_sub(struct gsm_subscriber_connection *conn, |
| 59 | struct msgb *msg) |
Holger Hans Peter Freyther | 16e958d | 2010-11-15 13:34:03 +0100 | [diff] [blame] | 60 | { |
| 61 | uint8_t mi_type; |
| 62 | char mi_string[GSM48_MI_SIZE]; |
| 63 | struct gsm48_hdr *gh; |
| 64 | struct gsm48_pag_resp *resp; |
Neels Hofmeyr | 6d804b1 | 2017-02-18 22:20:46 +0100 | [diff] [blame] | 65 | struct bsc_subscr *subscr; |
Holger Hans Peter Freyther | 16e958d | 2010-11-15 13:34:03 +0100 | [diff] [blame] | 66 | |
| 67 | if (msgb_l3len(msg) < sizeof(*gh) + sizeof(*resp)) { |
| 68 | LOGP(DMSC, LOGL_ERROR, "PagingResponse too small: %u\n", msgb_l3len(msg)); |
Holger Hans Peter Freyther | f67d9a9 | 2011-06-07 20:12:33 +0200 | [diff] [blame] | 69 | return NULL; |
Holger Hans Peter Freyther | 16e958d | 2010-11-15 13:34:03 +0100 | [diff] [blame] | 70 | } |
| 71 | |
| 72 | gh = msgb_l3(msg); |
| 73 | resp = (struct gsm48_pag_resp *) &gh->data[0]; |
| 74 | |
| 75 | gsm48_paging_extract_mi(resp, msgb_l3len(msg) - sizeof(*gh), |
| 76 | mi_string, &mi_type); |
Harald Welte | b9845f9 | 2015-08-16 18:07:48 +0200 | [diff] [blame] | 77 | DEBUGP(DRR, "PAGING RESPONSE: MI(%s)=%s\n", |
| 78 | gsm48_mi_type_name(mi_type), mi_string); |
Holger Hans Peter Freyther | 16e958d | 2010-11-15 13:34:03 +0100 | [diff] [blame] | 79 | |
| 80 | switch (mi_type) { |
| 81 | case GSM_MI_TYPE_TMSI: |
Neels Hofmeyr | 6d804b1 | 2017-02-18 22:20:46 +0100 | [diff] [blame] | 82 | subscr = bsc_subscr_find_by_tmsi(conn->network->bsc_subscribers, |
| 83 | tmsi_from_string(mi_string)); |
Holger Hans Peter Freyther | 16e958d | 2010-11-15 13:34:03 +0100 | [diff] [blame] | 84 | break; |
| 85 | case GSM_MI_TYPE_IMSI: |
Neels Hofmeyr | 6d804b1 | 2017-02-18 22:20:46 +0100 | [diff] [blame] | 86 | subscr = bsc_subscr_find_by_imsi(conn->network->bsc_subscribers, |
| 87 | mi_string); |
Holger Hans Peter Freyther | 16e958d | 2010-11-15 13:34:03 +0100 | [diff] [blame] | 88 | break; |
Holger Hans Peter Freyther | 3fbd244 | 2011-01-16 18:18:56 +0100 | [diff] [blame] | 89 | default: |
| 90 | subscr = NULL; |
| 91 | break; |
Holger Hans Peter Freyther | 16e958d | 2010-11-15 13:34:03 +0100 | [diff] [blame] | 92 | } |
| 93 | |
Holger Hans Peter Freyther | f67d9a9 | 2011-06-07 20:12:33 +0200 | [diff] [blame] | 94 | return subscr; |
| 95 | } |
| 96 | |
| 97 | /* we will need to stop the paging request */ |
| 98 | static int handle_page_resp(struct gsm_subscriber_connection *conn, struct msgb *msg) |
| 99 | { |
Neels Hofmeyr | 6d804b1 | 2017-02-18 22:20:46 +0100 | [diff] [blame] | 100 | struct bsc_subscr *subscr = extract_sub(conn, msg); |
Holger Hans Peter Freyther | f67d9a9 | 2011-06-07 20:12:33 +0200 | [diff] [blame] | 101 | |
Holger Hans Peter Freyther | 16e958d | 2010-11-15 13:34:03 +0100 | [diff] [blame] | 102 | if (!subscr) { |
| 103 | LOGP(DMSC, LOGL_ERROR, "Non active subscriber got paged.\n"); |
| 104 | return -1; |
| 105 | } |
| 106 | |
Neels Hofmeyr | 6d804b1 | 2017-02-18 22:20:46 +0100 | [diff] [blame] | 107 | paging_request_stop(&conn->network->bts_list, conn->bts, subscr, conn, |
| 108 | msg); |
| 109 | bsc_subscr_put(subscr); |
Holger Hans Peter Freyther | 16e958d | 2010-11-15 13:34:03 +0100 | [diff] [blame] | 110 | return 0; |
| 111 | } |
Holger Hans Peter Freyther | 18fa70a | 2011-06-08 19:25:38 +0200 | [diff] [blame] | 112 | |
| 113 | static int is_cm_service_for_emerg(struct msgb *msg) |
| 114 | { |
| 115 | struct gsm48_service_request *cm; |
| 116 | struct gsm48_hdr *gh = msgb_l3(msg); |
| 117 | |
| 118 | if (msgb_l3len(msg) < sizeof(*gh) + sizeof(*cm)) { |
| 119 | LOGP(DMSC, LOGL_ERROR, "CM ServiceRequest does not fit.\n"); |
| 120 | return 0; |
| 121 | } |
| 122 | |
| 123 | cm = (struct gsm48_service_request *) &gh->data[0]; |
| 124 | return cm->cm_service_type == GSM48_CMSERV_EMERGENCY; |
| 125 | } |
| 126 | |
Neels Hofmeyr | a369e24 | 2017-02-23 21:57:23 +0100 | [diff] [blame] | 127 | struct bsc_msc_data *bsc_find_msc(struct gsm_subscriber_connection *conn, |
Holger Hans Peter Freyther | 076af1c | 2011-06-07 19:57:02 +0200 | [diff] [blame] | 128 | struct msgb *msg) |
| 129 | { |
Holger Hans Peter Freyther | f67d9a9 | 2011-06-07 20:12:33 +0200 | [diff] [blame] | 130 | struct gsm48_hdr *gh; |
| 131 | int8_t pdisc; |
| 132 | uint8_t mtype; |
Holger Hans Peter Freyther | 076af1c | 2011-06-07 19:57:02 +0200 | [diff] [blame] | 133 | struct osmo_bsc_data *bsc; |
Neels Hofmeyr | a369e24 | 2017-02-23 21:57:23 +0100 | [diff] [blame] | 134 | struct bsc_msc_data *msc, *pag_msc; |
Neels Hofmeyr | 6d804b1 | 2017-02-18 22:20:46 +0100 | [diff] [blame] | 135 | struct bsc_subscr *subscr; |
Holger Hans Peter Freyther | 18fa70a | 2011-06-08 19:25:38 +0200 | [diff] [blame] | 136 | int is_emerg = 0; |
Holger Hans Peter Freyther | 076af1c | 2011-06-07 19:57:02 +0200 | [diff] [blame] | 137 | |
| 138 | bsc = conn->bts->network->bsc_data; |
Holger Hans Peter Freyther | f67d9a9 | 2011-06-07 20:12:33 +0200 | [diff] [blame] | 139 | |
| 140 | if (msgb_l3len(msg) < sizeof(*gh)) { |
| 141 | LOGP(DMSC, LOGL_ERROR, "There is no GSM48 header here.\n"); |
| 142 | return NULL; |
| 143 | } |
| 144 | |
| 145 | gh = msgb_l3(msg); |
Neels Hofmeyr | 531734a | 2016-03-14 16:13:24 +0100 | [diff] [blame] | 146 | pdisc = gsm48_hdr_pdisc(gh); |
| 147 | mtype = gsm48_hdr_msg_type(gh); |
Holger Hans Peter Freyther | f67d9a9 | 2011-06-07 20:12:33 +0200 | [diff] [blame] | 148 | |
| 149 | /* |
| 150 | * We are asked to select a MSC here but they are not equal. We |
| 151 | * want to respond to a paging request on the MSC where we got the |
| 152 | * request from. This is where we need to decide where this connection |
| 153 | * will go. |
| 154 | */ |
| 155 | if (pdisc == GSM48_PDISC_RR && mtype == GSM48_MT_RR_PAG_RESP) |
| 156 | goto paging; |
Holger Hans Peter Freyther | 18fa70a | 2011-06-08 19:25:38 +0200 | [diff] [blame] | 157 | else if (pdisc == GSM48_PDISC_MM && mtype == GSM48_MT_MM_CM_SERV_REQ) { |
| 158 | is_emerg = is_cm_service_for_emerg(msg); |
| 159 | goto round_robin; |
| 160 | } else |
Holger Hans Peter Freyther | f67d9a9 | 2011-06-07 20:12:33 +0200 | [diff] [blame] | 161 | goto round_robin; |
| 162 | |
| 163 | round_robin: |
Holger Hans Peter Freyther | 076af1c | 2011-06-07 19:57:02 +0200 | [diff] [blame] | 164 | llist_for_each_entry(msc, &bsc->mscs, entry) { |
| 165 | if (!msc->msc_con->is_authenticated) |
| 166 | continue; |
Holger Hans Peter Freyther | 18fa70a | 2011-06-08 19:25:38 +0200 | [diff] [blame] | 167 | if (!is_emerg && msc->type != MSC_CON_TYPE_NORMAL) |
| 168 | continue; |
| 169 | if (is_emerg && !msc->allow_emerg) |
Holger Hans Peter Freyther | 210565e | 2011-06-07 20:56:18 +0200 | [diff] [blame] | 170 | continue; |
Holger Hans Peter Freyther | 076af1c | 2011-06-07 19:57:02 +0200 | [diff] [blame] | 171 | |
| 172 | /* force round robin by moving it to the end */ |
| 173 | llist_move_tail(&msc->entry, &bsc->mscs); |
| 174 | return msc; |
| 175 | } |
| 176 | |
| 177 | return NULL; |
Holger Hans Peter Freyther | f67d9a9 | 2011-06-07 20:12:33 +0200 | [diff] [blame] | 178 | |
| 179 | paging: |
| 180 | subscr = extract_sub(conn, msg); |
| 181 | |
| 182 | if (!subscr) { |
| 183 | LOGP(DMSC, LOGL_ERROR, "Got paged but no subscriber found.\n"); |
| 184 | return NULL; |
| 185 | } |
| 186 | |
| 187 | pag_msc = paging_get_data(conn->bts, subscr); |
Neels Hofmeyr | 6d804b1 | 2017-02-18 22:20:46 +0100 | [diff] [blame] | 188 | bsc_subscr_put(subscr); |
Holger Hans Peter Freyther | f67d9a9 | 2011-06-07 20:12:33 +0200 | [diff] [blame] | 189 | |
| 190 | llist_for_each_entry(msc, &bsc->mscs, entry) { |
| 191 | if (msc != pag_msc) |
| 192 | continue; |
| 193 | |
| 194 | /* |
| 195 | * We don't check if the MSC is connected. In case it |
| 196 | * is not the connection will be dropped. |
| 197 | */ |
| 198 | |
| 199 | /* force round robin by moving it to the end */ |
| 200 | llist_move_tail(&msc->entry, &bsc->mscs); |
| 201 | return msc; |
| 202 | } |
| 203 | |
| 204 | LOGP(DMSC, LOGL_ERROR, "Got paged but no request found.\n"); |
| 205 | return NULL; |
Holger Hans Peter Freyther | 076af1c | 2011-06-07 19:57:02 +0200 | [diff] [blame] | 206 | } |
| 207 | |
Holger Hans Peter Freyther | 16e958d | 2010-11-15 13:34:03 +0100 | [diff] [blame] | 208 | |
Holger Hans Peter Freyther | 5bb874d | 2010-11-05 11:21:18 +0100 | [diff] [blame] | 209 | /** |
| 210 | * This is used to scan a message for extra functionality of the BSC. This |
| 211 | * includes scanning for location updating requests/acceptd and then send |
| 212 | * a welcome USSD message to the subscriber. |
| 213 | */ |
| 214 | int bsc_scan_bts_msg(struct gsm_subscriber_connection *conn, struct msgb *msg) |
| 215 | { |
Holger Hans Peter Freyther | d65305f | 2010-11-05 11:31:08 +0100 | [diff] [blame] | 216 | struct gsm48_hdr *gh = msgb_l3(msg); |
Neels Hofmeyr | 531734a | 2016-03-14 16:13:24 +0100 | [diff] [blame] | 217 | uint8_t pdisc = gsm48_hdr_pdisc(gh); |
| 218 | uint8_t mtype = gsm48_hdr_msg_type(gh); |
Holger Hans Peter Freyther | d65305f | 2010-11-05 11:31:08 +0100 | [diff] [blame] | 219 | |
| 220 | if (pdisc == GSM48_PDISC_MM) { |
| 221 | if (mtype == GSM48_MT_MM_LOC_UPD_REQUEST) |
| 222 | handle_lu_request(conn, msg); |
Holger Hans Peter Freyther | 16e958d | 2010-11-15 13:34:03 +0100 | [diff] [blame] | 223 | } else if (pdisc == GSM48_PDISC_RR) { |
| 224 | if (mtype == GSM48_MT_RR_PAG_RESP) |
| 225 | handle_page_resp(conn, msg); |
Holger Hans Peter Freyther | d65305f | 2010-11-05 11:31:08 +0100 | [diff] [blame] | 226 | } |
| 227 | |
Holger Hans Peter Freyther | 5bb874d | 2010-11-05 11:21:18 +0100 | [diff] [blame] | 228 | return 0; |
| 229 | } |
Holger Hans Peter Freyther | a54732d | 2010-11-05 18:11:19 +0100 | [diff] [blame] | 230 | |
Holger Hans Peter Freyther | d2361d9 | 2012-12-03 15:32:54 +0100 | [diff] [blame] | 231 | static int send_welcome_ussd(struct gsm_subscriber_connection *conn) |
Holger Hans Peter Freyther | 52d42ab | 2010-11-05 18:41:04 +0100 | [diff] [blame] | 232 | { |
Holger Hans Peter Freyther | 383d3c3 | 2012-07-19 14:22:42 +0200 | [diff] [blame] | 233 | struct osmo_bsc_sccp_con *bsc_con; |
Holger Hans Peter Freyther | 52d42ab | 2010-11-05 18:41:04 +0100 | [diff] [blame] | 234 | |
Holger Hans Peter Freyther | 383d3c3 | 2012-07-19 14:22:42 +0200 | [diff] [blame] | 235 | bsc_con = conn->sccp_con; |
Holger Hans Peter Freyther | f589221 | 2012-08-30 13:05:15 +0200 | [diff] [blame] | 236 | if (!bsc_con) { |
| 237 | LOGP(DMSC, LOGL_DEBUG, "No SCCP connection associated.\n"); |
Holger Hans Peter Freyther | d2361d9 | 2012-12-03 15:32:54 +0100 | [diff] [blame] | 238 | return 0; |
Holger Hans Peter Freyther | f589221 | 2012-08-30 13:05:15 +0200 | [diff] [blame] | 239 | } |
| 240 | |
| 241 | if (!bsc_con->msc->ussd_welcome_txt) { |
| 242 | LOGP(DMSC, LOGL_DEBUG, "No USSD Welcome text defined.\n"); |
Holger Hans Peter Freyther | d2361d9 | 2012-12-03 15:32:54 +0100 | [diff] [blame] | 243 | return 0; |
Holger Hans Peter Freyther | f589221 | 2012-08-30 13:05:15 +0200 | [diff] [blame] | 244 | } |
Holger Hans Peter Freyther | 52d42ab | 2010-11-05 18:41:04 +0100 | [diff] [blame] | 245 | |
Holger Hans Peter Freyther | d2361d9 | 2012-12-03 15:32:54 +0100 | [diff] [blame] | 246 | return BSS_SEND_USSD; |
| 247 | } |
| 248 | |
| 249 | int bsc_send_welcome_ussd(struct gsm_subscriber_connection *conn) |
| 250 | { |
Neels Hofmeyr | 43273c6 | 2016-05-10 12:50:31 +0200 | [diff] [blame] | 251 | bsc_send_ussd_notify(conn, 1, conn->sccp_con->msc->ussd_welcome_txt); |
| 252 | bsc_send_ussd_release_complete(conn); |
Holger Hans Peter Freyther | d2361d9 | 2012-12-03 15:32:54 +0100 | [diff] [blame] | 253 | |
| 254 | return 0; |
Holger Hans Peter Freyther | 52d42ab | 2010-11-05 18:41:04 +0100 | [diff] [blame] | 255 | } |
| 256 | |
Jacob Erlbeck | 946d141 | 2013-09-17 13:59:29 +0200 | [diff] [blame] | 257 | static int bsc_patch_mm_info(struct gsm_subscriber_connection *conn, |
| 258 | uint8_t *data, unsigned int length) |
| 259 | { |
| 260 | struct tlv_parsed tp; |
| 261 | int parse_res; |
| 262 | struct gsm_bts *bts = conn->bts; |
| 263 | int tzunits; |
| 264 | uint8_t tzbsd = 0; |
| 265 | uint8_t dst = 0; |
| 266 | |
| 267 | parse_res = tlv_parse(&tp, &gsm48_mm_att_tlvdef, data, length, 0, 0); |
| 268 | if (parse_res <= 0 && parse_res != -3) |
Neels Hofmeyr | a7313dd | 2016-02-29 09:35:54 +0100 | [diff] [blame] | 269 | /* FIXME: -3 means unknown IE error, so this accepts messages |
| 270 | * with unknown IEs. But parsing has aborted with the unknown |
| 271 | * IE and the message is broken or parsed incompletely. */ |
Jacob Erlbeck | 946d141 | 2013-09-17 13:59:29 +0200 | [diff] [blame] | 272 | return 0; |
| 273 | |
| 274 | /* Is TZ patching enabled? */ |
Neels Hofmeyr | 7398395 | 2016-05-10 13:29:33 +0200 | [diff] [blame] | 275 | struct gsm_tz *tz = &bts->network->tz; |
| 276 | if (!tz->override) |
Jacob Erlbeck | 946d141 | 2013-09-17 13:59:29 +0200 | [diff] [blame] | 277 | return 0; |
| 278 | |
| 279 | /* Convert tz.hr and tz.mn to units */ |
Neels Hofmeyr | 7398395 | 2016-05-10 13:29:33 +0200 | [diff] [blame] | 280 | if (tz->hr < 0) { |
| 281 | tzunits = -tz->hr*4; |
Jacob Erlbeck | 946d141 | 2013-09-17 13:59:29 +0200 | [diff] [blame] | 282 | tzbsd |= 0x08; |
| 283 | } else |
Neels Hofmeyr | 7398395 | 2016-05-10 13:29:33 +0200 | [diff] [blame] | 284 | tzunits = tz->hr*4; |
Jacob Erlbeck | 946d141 | 2013-09-17 13:59:29 +0200 | [diff] [blame] | 285 | |
Neels Hofmeyr | 7398395 | 2016-05-10 13:29:33 +0200 | [diff] [blame] | 286 | tzunits = tzunits + (tz->mn/15); |
Jacob Erlbeck | 946d141 | 2013-09-17 13:59:29 +0200 | [diff] [blame] | 287 | |
| 288 | tzbsd |= (tzunits % 10)*0x10 + (tzunits / 10); |
| 289 | |
| 290 | /* Convert DST value */ |
Neels Hofmeyr | 7398395 | 2016-05-10 13:29:33 +0200 | [diff] [blame] | 291 | if (tz->dst >= 0 && tz->dst <= 2) |
| 292 | dst = tz->dst; |
Jacob Erlbeck | 946d141 | 2013-09-17 13:59:29 +0200 | [diff] [blame] | 293 | |
| 294 | if (TLVP_PRESENT(&tp, GSM48_IE_UTC)) { |
| 295 | LOGP(DMSC, LOGL_DEBUG, |
| 296 | "Changing 'Local time zone' from 0x%02x to 0x%02x.\n", |
| 297 | TLVP_VAL(&tp, GSM48_IE_UTC)[6], tzbsd); |
| 298 | ((uint8_t *)(TLVP_VAL(&tp, GSM48_IE_UTC)))[0] = tzbsd; |
| 299 | } |
| 300 | if (TLVP_PRESENT(&tp, GSM48_IE_NET_TIME_TZ)) { |
| 301 | LOGP(DMSC, LOGL_DEBUG, |
| 302 | "Changing 'Universal time and local time zone' TZ from " |
| 303 | "0x%02x to 0x%02x.\n", |
| 304 | TLVP_VAL(&tp, GSM48_IE_NET_TIME_TZ)[6], tzbsd); |
| 305 | ((uint8_t *)(TLVP_VAL(&tp, GSM48_IE_NET_TIME_TZ)))[6] = tzbsd; |
| 306 | } |
| 307 | #ifdef GSM48_IE_NET_DST |
| 308 | if (TLVP_PRESENT(&tp, GSM48_IE_NET_DST)) { |
| 309 | LOGP(DMSC, LOGL_DEBUG, |
| 310 | "Changing 'Network daylight saving time' from " |
| 311 | "0x%02x to 0x%02x.\n", |
| 312 | TLVP_VAL(&tp, GSM48_IE_NET_DST)[0], dst); |
| 313 | ((uint8_t *)(TLVP_VAL(&tp, GSM48_IE_NET_DST)))[0] = dst; |
| 314 | } |
| 315 | #endif |
| 316 | |
| 317 | return 0; |
| 318 | } |
| 319 | |
Neels Hofmeyr | a369e24 | 2017-02-23 21:57:23 +0100 | [diff] [blame] | 320 | static int has_core_identity(struct bsc_msc_data *msc) |
Holger Hans Peter Freyther | 32dd2f3 | 2015-04-01 18:15:48 +0200 | [diff] [blame] | 321 | { |
Holger Hans Peter Freyther | 1e36547 | 2015-07-13 11:06:10 +0200 | [diff] [blame] | 322 | if (msc->core_mnc != -1) |
Holger Hans Peter Freyther | 32dd2f3 | 2015-04-01 18:15:48 +0200 | [diff] [blame] | 323 | return 1; |
| 324 | if (msc->core_mcc != -1) |
| 325 | return 1; |
| 326 | if (msc->core_lac != -1) |
| 327 | return 1; |
| 328 | if (msc->core_ci != -1) |
| 329 | return 1; |
| 330 | return 0; |
| 331 | } |
| 332 | |
Holger Hans Peter Freyther | a54732d | 2010-11-05 18:11:19 +0100 | [diff] [blame] | 333 | /** |
| 334 | * Messages coming back from the MSC. |
| 335 | */ |
| 336 | int bsc_scan_msc_msg(struct gsm_subscriber_connection *conn, struct msgb *msg) |
| 337 | { |
Neels Hofmeyr | a369e24 | 2017-02-23 21:57:23 +0100 | [diff] [blame] | 338 | struct bsc_msc_data *msc; |
Holger Hans Peter Freyther | 52d42ab | 2010-11-05 18:41:04 +0100 | [diff] [blame] | 339 | struct gsm_network *net; |
| 340 | struct gsm48_loc_area_id *lai; |
| 341 | struct gsm48_hdr *gh; |
Neels Hofmeyr | 10cd113 | 2016-03-14 16:15:02 +0100 | [diff] [blame] | 342 | uint8_t pdisc; |
Holger Hans Peter Freyther | 52d42ab | 2010-11-05 18:41:04 +0100 | [diff] [blame] | 343 | uint8_t mtype; |
Jacob Erlbeck | 946d141 | 2013-09-17 13:59:29 +0200 | [diff] [blame] | 344 | int length = msgb_l3len(msg); |
Holger Hans Peter Freyther | 52d42ab | 2010-11-05 18:41:04 +0100 | [diff] [blame] | 345 | |
Jacob Erlbeck | 946d141 | 2013-09-17 13:59:29 +0200 | [diff] [blame] | 346 | if (length < sizeof(*gh)) { |
Holger Hans Peter Freyther | 52d42ab | 2010-11-05 18:41:04 +0100 | [diff] [blame] | 347 | LOGP(DMSC, LOGL_ERROR, "GSM48 header does not fit.\n"); |
| 348 | return -1; |
| 349 | } |
| 350 | |
| 351 | gh = (struct gsm48_hdr *) msgb_l3(msg); |
Jacob Erlbeck | 946d141 | 2013-09-17 13:59:29 +0200 | [diff] [blame] | 352 | length -= (const char *)&gh->data[0] - (const char *)gh; |
| 353 | |
Neels Hofmeyr | 10cd113 | 2016-03-14 16:15:02 +0100 | [diff] [blame] | 354 | pdisc = gsm48_hdr_pdisc(gh); |
| 355 | if (pdisc != GSM48_PDISC_MM) |
| 356 | return 0; |
| 357 | |
Neels Hofmeyr | 531734a | 2016-03-14 16:13:24 +0100 | [diff] [blame] | 358 | mtype = gsm48_hdr_msg_type(gh); |
Holger Hans Peter Freyther | 52d42ab | 2010-11-05 18:41:04 +0100 | [diff] [blame] | 359 | net = conn->bts->network; |
Holger Hans Peter Freyther | f936fb4 | 2011-06-04 15:12:57 +0200 | [diff] [blame] | 360 | msc = conn->sccp_con->msc; |
Holger Hans Peter Freyther | 52d42ab | 2010-11-05 18:41:04 +0100 | [diff] [blame] | 361 | |
| 362 | if (mtype == GSM48_MT_MM_LOC_UPD_ACCEPT) { |
Holger Hans Peter Freyther | 32dd2f3 | 2015-04-01 18:15:48 +0200 | [diff] [blame] | 363 | if (has_core_identity(msc)) { |
Holger Hans Peter Freyther | 52d42ab | 2010-11-05 18:41:04 +0100 | [diff] [blame] | 364 | if (msgb_l3len(msg) >= sizeof(*gh) + sizeof(*lai)) { |
Neels Hofmeyr | 49b83d8 | 2016-02-29 09:40:22 +0100 | [diff] [blame] | 365 | /* overwrite LAI in the message */ |
Holger Hans Peter Freyther | 52d42ab | 2010-11-05 18:41:04 +0100 | [diff] [blame] | 366 | lai = (struct gsm48_loc_area_id *) &gh->data[0]; |
| 367 | gsm48_generate_lai(lai, net->country_code, |
| 368 | net->network_code, |
| 369 | conn->bts->location_area_code); |
| 370 | } |
| 371 | } |
| 372 | |
| 373 | if (conn->sccp_con->new_subscriber) |
Holger Hans Peter Freyther | d2361d9 | 2012-12-03 15:32:54 +0100 | [diff] [blame] | 374 | return send_welcome_ussd(conn); |
| 375 | return 0; |
Jacob Erlbeck | 946d141 | 2013-09-17 13:59:29 +0200 | [diff] [blame] | 376 | } else if (mtype == GSM48_MT_MM_INFO) { |
| 377 | bsc_patch_mm_info(conn, &gh->data[0], length); |
Holger Hans Peter Freyther | 52d42ab | 2010-11-05 18:41:04 +0100 | [diff] [blame] | 378 | } |
| 379 | |
Holger Hans Peter Freyther | a54732d | 2010-11-05 18:11:19 +0100 | [diff] [blame] | 380 | return 0; |
| 381 | } |