blob: 631d8999435dfa40c293f0595cd7166074fa8ad9 [file] [log] [blame]
Holger Hans Peter Freyther9e2c5f52010-06-15 18:44:42 +08001/* BSC Multiplexer/NAT */
2
3/*
4 * (C) 2010 by Holger Hans Peter Freyther <zecke@selfish.org>
Holger Hans Peter Freytherdf6143a2010-06-15 18:46:56 +08005 * (C) 2010 by On-Waves
Holger Hans Peter Freyther49d80682010-01-12 21:34:54 +01006 * (C) 2009 by Harald Welte <laforge@gnumonks.org>
Holger Hans Peter Freyther9e2c5f52010-06-15 18:44:42 +08007 * All Rights Reserved
8 *
9 * This program is free software; you can redistribute it and/or modify
10 * it under the terms of the GNU General Public License as published by
11 * the Free Software Foundation; either version 2 of the License, or
12 * (at your option) any later version.
13 *
14 * This program is distributed in the hope that it will be useful,
15 * but WITHOUT ANY WARRANTY; without even the implied warranty of
16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
17 * GNU General Public License for more details.
18 *
19 * You should have received a copy of the GNU General Public License along
20 * with this program; if not, write to the Free Software Foundation, Inc.,
21 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
22 *
23 */
24#include <sys/socket.h>
25#include <netinet/in.h>
26#include <arpa/inet.h>
27
Holger Hans Peter Freyther49d80682010-01-12 21:34:54 +010028#include <errno.h>
Holger Hans Peter Freyther6ace5222010-01-12 21:15:08 +010029#include <signal.h>
Holger Hans Peter Freyther9e2c5f52010-06-15 18:44:42 +080030#include <stdio.h>
31#include <stdlib.h>
Holger Hans Peter Freyther5aa25ae2010-01-12 21:36:08 +010032#include <time.h>
Holger Hans Peter Freyther9e2c5f52010-06-15 18:44:42 +080033#include <unistd.h>
34
35#define _GNU_SOURCE
36#include <getopt.h>
37
38#include <openbsc/debug.h>
Holger Hans Peter Freyther6ace5222010-01-12 21:15:08 +010039#include <openbsc/bsc_msc.h>
Holger Hans Peter Freyther6a97b8d2010-06-15 18:45:26 +080040#include <openbsc/bsc_nat.h>
Holger Hans Peter Freyther38a77d02010-01-30 12:45:10 +010041#include <openbsc/bssap.h>
Holger Hans Peter Freyther6ace5222010-01-12 21:15:08 +010042#include <openbsc/ipaccess.h>
43#include <openbsc/abis_nm.h>
Holger Hans Peter Freyther9a85ef32010-06-15 18:46:11 +080044#include <openbsc/telnet_interface.h>
45
Holger Hans Peter Freyther6c45f2e2010-06-15 19:06:18 +080046#include <osmocore/talloc.h>
47
Holger Hans Peter Freyther9a85ef32010-06-15 18:46:11 +080048#include <vty/vty.h>
Holger Hans Peter Freyther9e2c5f52010-06-15 18:44:42 +080049
Holger Hans Peter Freyther6a97b8d2010-06-15 18:45:26 +080050#include <sccp/sccp.h>
51
Holger Hans Peter Freytherfb7a9342010-06-15 19:14:12 +080052struct log_target *stderr_target;
Holger Hans Peter Freyther9a85ef32010-06-15 18:46:11 +080053static const char *config_file = "bsc-nat.cfg";
Holger Hans Peter Freyther9e2c5f52010-06-15 18:44:42 +080054static char *msc_address = "127.0.0.1";
55static struct in_addr local_addr;
Holger Hans Peter Freytherbaf2abe2010-06-15 18:47:29 +080056static struct bsc_msc_connection *msc_con;
Holger Hans Peter Freyther2d677c62010-03-26 06:51:04 +010057static struct bsc_fd bsc_listen;
Holger Hans Peter Freyther6ace5222010-01-12 21:15:08 +010058
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +010059
Holger Hans Peter Freyther9a85ef32010-06-15 18:46:11 +080060static struct bsc_nat *nat;
Holger Hans Peter Freyther3025e192010-03-26 09:18:02 +010061static void bsc_write(struct bsc_connection *bsc, const u_int8_t *data, unsigned int length);
Holger Hans Peter Freythercd895372010-03-29 08:04:09 +020062static void remove_bsc_connection(struct bsc_connection *connection);
Holger Hans Peter Freyther9a85ef32010-06-15 18:46:11 +080063
Holger Hans Peter Freyther9a85ef32010-06-15 18:46:11 +080064struct bsc_config *bsc_config_num(struct bsc_nat *nat, int num)
65{
66 struct bsc_config *conf;
67
68 llist_for_each_entry(conf, &nat->bsc_configs, entry)
69 if (conf->nr == num)
70 return conf;
71
72 return NULL;
73}
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +010074
Holger Hans Peter Freyther6ace5222010-01-12 21:15:08 +010075/*
76 * below are stubs we need to link
77 */
78int nm_state_event(enum nm_evt evt, u_int8_t obj_class, void *obj,
79 struct gsm_nm_state *old_state, struct gsm_nm_state *new_state)
80{
81 return -1;
82}
83
84void input_event(int event, enum e1inp_sign_type type, struct gsm_bts_trx *trx)
85{}
86
87int gsm0408_rcvmsg(struct msgb *msg, u_int8_t link_id)
88{
89 return -1;
90}
91
Holger Hans Peter Freyther3025e192010-03-26 09:18:02 +010092static void send_reset_ack(struct bsc_connection *bsc)
Holger Hans Peter Freyther38a77d02010-01-30 12:45:10 +010093{
94 static const u_int8_t gsm_reset_ack[] = {
95 0x00, 0x13, 0xfd,
96 0x09, 0x00, 0x03, 0x07, 0x0b, 0x04, 0x43, 0x01,
97 0x00, 0xfe, 0x04, 0x43, 0x5c, 0x00, 0xfe, 0x03,
98 0x00, 0x01, 0x31,
99 };
100
Holger Hans Peter Freyther3025e192010-03-26 09:18:02 +0100101 bsc_write(bsc, gsm_reset_ack, sizeof(gsm_reset_ack));
Holger Hans Peter Freyther38a77d02010-01-30 12:45:10 +0100102}
103
Holger Hans Peter Freyther3025e192010-03-26 09:18:02 +0100104static void send_id_ack(struct bsc_connection *bsc)
Holger Hans Peter Freytherdb7ba7d2010-03-26 07:41:54 +0100105{
106 static const u_int8_t id_ack[] = {
107 0, 1, IPAC_PROTO_IPACCESS, IPAC_MSGT_ID_ACK
108 };
109
Holger Hans Peter Freyther3025e192010-03-26 09:18:02 +0100110 bsc_write(bsc, id_ack, sizeof(id_ack));
Holger Hans Peter Freytherdb7ba7d2010-03-26 07:41:54 +0100111}
112
Holger Hans Peter Freyther3025e192010-03-26 09:18:02 +0100113static void send_id_req(struct bsc_connection *bsc)
Holger Hans Peter Freytherdb7ba7d2010-03-26 07:41:54 +0100114{
115 static const u_int8_t id_req[] = {
116 0, 17, IPAC_PROTO_IPACCESS, IPAC_MSGT_ID_GET,
117 0x01, IPAC_IDTAG_UNIT,
118 0x01, IPAC_IDTAG_MACADDR,
119 0x01, IPAC_IDTAG_LOCATION1,
120 0x01, IPAC_IDTAG_LOCATION2,
121 0x01, IPAC_IDTAG_EQUIPVERS,
122 0x01, IPAC_IDTAG_SWVERSION,
123 0x01, IPAC_IDTAG_UNITNAME,
124 0x01, IPAC_IDTAG_SERNR,
125 };
126
Holger Hans Peter Freyther3025e192010-03-26 09:18:02 +0100127 bsc_write(bsc, id_req, sizeof(id_req));
Holger Hans Peter Freytherdb7ba7d2010-03-26 07:41:54 +0100128}
129
Holger Hans Peter Freyther6b087d12010-04-06 17:32:58 +0200130static void nat_send_rlsd(struct sccp_connections *conn)
131{
132 struct sccp_connection_released *rel;
133 struct msgb *msg;
134
135 msg = msgb_alloc_headroom(4096, 128, "rlsd");
136 if (!msg) {
137 LOGP(DNAT, LOGL_ERROR, "Failed to allocate clear command.\n");
138 return;
139 }
140
141 msg->l2h = msgb_put(msg, sizeof(*rel));
142 rel = (struct sccp_connection_released *) msg->l2h;
143 rel->type = SCCP_MSG_TYPE_RLSD;
144 rel->release_cause = SCCP_RELEASE_CAUSE_SCCP_FAILURE;
145 rel->destination_local_reference = conn->remote_ref;
146 rel->source_local_reference = conn->patched_ref;
147
148 ipaccess_prepend_header(msg, IPAC_PROTO_SCCP);
149
150 if (write_queue_enqueue(&msc_con->write_queue, msg) != 0) {
151 LOGP(DINP, LOGL_ERROR, "Failed to enqueue the write.\n");
152 msgb_free(msg);
153 }
154}
155
Holger Hans Peter Freytherd131b792010-03-31 07:30:58 +0200156static void send_mgcp_reset(struct bsc_connection *bsc)
157{
158 static const u_int8_t mgcp_reset[] = {
159 "RSIP 1 13@mgw MGCP 1.0\r\n"
160 };
161
162 bsc_write_mgcp(bsc, mgcp_reset, sizeof mgcp_reset - 1);
163}
164
Holger Hans Peter Freyther6ace5222010-01-12 21:15:08 +0100165/*
166 * Below is the handling of messages coming
167 * from the MSC and need to be forwarded to
168 * a real BSC.
169 */
170static void initialize_msc_if_needed()
171{
172 static int init = 0;
173 init = 1;
174
175 /* do we need to send a GSM 08.08 message here? */
176}
177
Holger Hans Peter Freyther3025e192010-03-26 09:18:02 +0100178/*
179 * Currently we are lacking refcounting so we need to copy each message.
180 */
181static void bsc_write(struct bsc_connection *bsc, const u_int8_t *data, unsigned int length)
Holger Hans Peter Freytherf7cb33c2010-03-26 07:20:59 +0100182{
Holger Hans Peter Freyther3025e192010-03-26 09:18:02 +0100183 struct msgb *msg;
184
185 if (length > 4096) {
186 LOGP(DINP, LOGL_ERROR, "Can not send message of that size.\n");
187 return;
188 }
189
190 msg = msgb_alloc(4096, "to-bsc");
191 if (!msg) {
192 LOGP(DINP, LOGL_ERROR, "Failed to allocate memory for BSC msg.\n");
193 return;
194 }
195
196 msgb_put(msg, length);
197 memcpy(msg->data, data, length);
198 if (write_queue_enqueue(&bsc->write_queue, msg) != 0) {
199 LOGP(DINP, LOGL_ERROR, "Failed to enqueue the write.\n");
200 msgb_free(msg);
201 }
Holger Hans Peter Freytherf7cb33c2010-03-26 07:20:59 +0100202}
203
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100204static int forward_sccp_to_bts(struct msgb *msg)
Holger Hans Peter Freyther6ace5222010-01-12 21:15:08 +0100205{
Holger Hans Peter Freyther49c7fb52010-06-15 18:48:55 +0800206 struct sccp_connections *con;
207 struct bsc_connection *bsc;
Holger Hans Peter Freyther0b8f69d2010-06-15 18:45:38 +0800208 struct bsc_nat_parsed *parsed;
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100209
Holger Hans Peter Freyther6ace5222010-01-12 21:15:08 +0100210 /* filter, drop, patch the message? */
Holger Hans Peter Freyther0b8f69d2010-06-15 18:45:38 +0800211 parsed = bsc_nat_parse(msg);
212 if (!parsed) {
213 LOGP(DNAT, LOGL_ERROR, "Can not parse msg from BSC.\n");
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100214 return -1;
Holger Hans Peter Freyther0b8f69d2010-06-15 18:45:38 +0800215 }
216
Holger Hans Peter Freyther1d6fb182010-01-30 11:53:30 +0100217 if (bsc_nat_filter_ipa(DIR_BSC, msg, parsed))
Holger Hans Peter Freyther0b8f69d2010-06-15 18:45:38 +0800218 goto exit;
Holger Hans Peter Freyther6a97b8d2010-06-15 18:45:26 +0800219
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100220 /* Route and modify the SCCP packet */
221 if (parsed->ipa_proto == IPAC_PROTO_SCCP) {
222 switch (parsed->sccp_type) {
223 case SCCP_MSG_TYPE_UDT:
224 /* forward UDT messages to every BSC */
225 goto send_to_all;
226 break;
227 case SCCP_MSG_TYPE_RLSD:
228 case SCCP_MSG_TYPE_CREF:
229 case SCCP_MSG_TYPE_DT1:
Holger Hans Peter Freytherf46ce532010-04-06 10:22:34 +0200230 case SCCP_MSG_TYPE_IT:
Holger Hans Peter Freyther49c7fb52010-06-15 18:48:55 +0800231 con = patch_sccp_src_ref_to_bsc(msg, parsed, nat);
Holger Hans Peter Freyther465313e2010-06-15 18:49:53 +0800232 if (parsed->gsm_type == BSS_MAP_MSG_ASSIGMENT_RQST) {
233 if (con) {
234 if (bsc_mgcp_assign(con, msg) != 0)
235 LOGP(DNAT, LOGL_ERROR, "Failed to assign...\n");
236 } else
237 LOGP(DNAT, LOGL_ERROR, "Assignment command but no BSC.\n");
238 }
Holger Hans Peter Freyther16a6f702010-03-29 17:18:42 +0200239 break;
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100240 case SCCP_MSG_TYPE_CC:
Holger Hans Peter Freyther49c7fb52010-06-15 18:48:55 +0800241 con = patch_sccp_src_ref_to_bsc(msg, parsed, nat);
242 if (!con || update_sccp_src_ref(con, parsed) != 0)
Holger Hans Peter Freyther16a6f702010-03-29 17:18:42 +0200243 goto exit;
Holger Hans Peter Freyther0ab6bab2010-06-15 18:47:49 +0800244 break;
245 case SCCP_MSG_TYPE_RLC:
246 LOGP(DNAT, LOGL_ERROR, "Unexpected release complete from MSC.\n");
247 goto exit;
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100248 break;
249 case SCCP_MSG_TYPE_CR:
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100250 /* MSC never opens a SCCP connection, fall through */
251 default:
252 goto exit;
253 }
Holger Hans Peter Freytherf464ea52010-04-06 16:07:44 +0200254
255 if (!con)
256 LOGP(DNAT, LOGL_ERROR, "Unknown connection for msg type: 0x%x.\n", parsed->sccp_type);
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100257 }
258
259 talloc_free(parsed);
Holger Hans Peter Freyther49c7fb52010-06-15 18:48:55 +0800260 if (!con)
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100261 return -1;
Holger Hans Peter Freyther49c7fb52010-06-15 18:48:55 +0800262 if (!con->bsc->authenticated) {
Holger Hans Peter Freyther6c45f2e2010-06-15 19:06:18 +0800263 LOGP(DNAT, LOGL_ERROR, "Selected BSC not authenticated.\n");
Holger Hans Peter Freyther3f37b8f2010-02-08 23:24:32 +0100264 return -1;
265 }
266
Holger Hans Peter Freyther49c7fb52010-06-15 18:48:55 +0800267 bsc_write(con->bsc, msg->data, msg->len);
Holger Hans Peter Freyther3025e192010-03-26 09:18:02 +0100268 return 0;
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100269
270send_to_all:
Holger Hans Peter Freyther45d11812010-06-15 18:46:36 +0800271 /*
272 * Filter Paging from the network. We do not want to send a PAGING
273 * Command to every BSC in our network. We will analys the PAGING
274 * message and then send it to the authenticated messages...
275 */
276 if (parsed->ipa_proto == IPAC_PROTO_SCCP && parsed->gsm_type == BSS_MAP_MSG_PAGING) {
Holger Hans Peter Freytherbae9da42010-03-30 05:57:42 +0200277 bsc = bsc_nat_find_bsc(nat, msg);
278 if (bsc)
279 bsc_write(bsc, msg->data, msg->len);
280 else
281 LOGP(DNAT, LOGL_ERROR, "Could not determine BSC for paging.\n");
Holger Hans Peter Freyther45d11812010-06-15 18:46:36 +0800282
283 goto exit;
284 }
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100285 /* currently send this to every BSC connected */
Holger Hans Peter Freyther9a85ef32010-06-15 18:46:11 +0800286 llist_for_each_entry(bsc, &nat->bsc_connections, list_entry) {
Holger Hans Peter Freyther3f37b8f2010-02-08 23:24:32 +0100287 if (!bsc->authenticated)
288 continue;
289
Holger Hans Peter Freyther3025e192010-03-26 09:18:02 +0100290 bsc_write(bsc, msg->data, msg->len);
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100291 }
Holger Hans Peter Freyther0b8f69d2010-06-15 18:45:38 +0800292
293exit:
294 talloc_free(parsed);
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100295 return 0;
Holger Hans Peter Freyther6ace5222010-01-12 21:15:08 +0100296}
297
Holger Hans Peter Freytherbaf2abe2010-06-15 18:47:29 +0800298static void msc_connection_was_lost(struct bsc_msc_connection *con)
299{
Holger Hans Peter Freythercd895372010-03-29 08:04:09 +0200300 struct bsc_connection *bsc, *tmp;
301
302 LOGP(DMSC, LOGL_ERROR, "Closing all connections downstream.\n");
303 llist_for_each_entry_safe(bsc, tmp, &nat->bsc_connections, list_entry)
304 remove_bsc_connection(bsc);
305
Holger Hans Peter Freyther241e1302010-03-31 09:16:56 +0200306 bsc_mgcp_free_endpoints(nat);
Holger Hans Peter Freythercd895372010-03-29 08:04:09 +0200307 bsc_msc_schedule_connect(con);
Holger Hans Peter Freytherbaf2abe2010-06-15 18:47:29 +0800308}
309
Holger Hans Peter Freyther6f5fbfd2010-06-15 18:47:02 +0800310static int ipaccess_msc_read_cb(struct bsc_fd *bfd)
Holger Hans Peter Freyther6ace5222010-01-12 21:15:08 +0100311{
312 int error;
313 struct msgb *msg = ipaccess_read_msg(bfd, &error);
314 struct ipaccess_head *hh;
315
316 if (!msg) {
317 if (error == 0) {
Holger Hans Peter Freyther418f3942010-01-29 05:58:43 +0100318 LOGP(DNAT, LOGL_FATAL, "The connection the MSC was lost, exiting\n");
Holger Hans Peter Freytherbaf2abe2010-06-15 18:47:29 +0800319 bsc_msc_lost(msc_con);
320 return -1;
Holger Hans Peter Freyther6ace5222010-01-12 21:15:08 +0100321 }
322
Holger Hans Peter Freyther418f3942010-01-29 05:58:43 +0100323 LOGP(DNAT, LOGL_ERROR, "Failed to parse ip access message: %d\n", error);
Holger Hans Peter Freyther6ace5222010-01-12 21:15:08 +0100324 return -1;
325 }
326
Holger Hans Peter Freyther418f3942010-01-29 05:58:43 +0100327 LOGP(DNAT, LOGL_DEBUG, "MSG from MSC: %s proto: %d\n", hexdump(msg->data, msg->len), msg->l2h[0]);
Holger Hans Peter Freyther6ace5222010-01-12 21:15:08 +0100328
329 /* handle base message handling */
330 hh = (struct ipaccess_head *) msg->data;
331 ipaccess_rcvmsg_base(msg, bfd);
332
333 /* initialize the networking. This includes sending a GSM08.08 message */
334 if (hh->proto == IPAC_PROTO_IPACCESS && msg->l2h[0] == IPAC_MSGT_ID_ACK)
335 initialize_msc_if_needed();
336 else if (hh->proto == IPAC_PROTO_SCCP)
337 forward_sccp_to_bts(msg);
338
Holger Hans Peter Freytheraad68b52010-06-15 18:46:48 +0800339 msgb_free(msg);
Holger Hans Peter Freyther6ace5222010-01-12 21:15:08 +0100340 return 0;
341}
Holger Hans Peter Freyther9e2c5f52010-06-15 18:44:42 +0800342
Holger Hans Peter Freyther6f5fbfd2010-06-15 18:47:02 +0800343static int ipaccess_msc_write_cb(struct bsc_fd *bfd, struct msgb *msg)
344{
345 int rc;
346 rc = write(bfd->fd, msg->data, msg->len);
347
348 if (rc != msg->len) {
349 LOGP(DNAT, LOGL_ERROR, "Failed to write MSG to MSC.\n");
350 return -1;
351 }
352
353 return rc;
354}
355
Holger Hans Peter Freyther49d80682010-01-12 21:34:54 +0100356/*
357 * Below is the handling of messages coming
358 * from the BSC and need to be forwarded to
359 * a real BSC.
360 */
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100361
362/*
363 * Remove the connection from the connections list,
364 * remove it from the patching of SCCP header lists
365 * as well. Maybe in the future even close connection..
366 */
367static void remove_bsc_connection(struct bsc_connection *connection)
368{
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100369 struct sccp_connections *sccp_patch, *tmp;
Holger Hans Peter Freythered07a3f2010-06-15 18:47:10 +0800370 bsc_unregister_fd(&connection->write_queue.bfd);
371 close(connection->write_queue.bfd.fd);
Holger Hans Peter Freytherf38e8792010-03-26 09:27:08 +0100372 write_queue_clear(&connection->write_queue);
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100373 llist_del(&connection->list_entry);
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100374
Holger Hans Peter Freytheraa698242010-06-15 18:46:19 +0800375 /* stop the timeout timer */
376 bsc_del_timer(&connection->id_timeout);
377
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100378 /* remove all SCCP connections */
Holger Hans Peter Freyther9a85ef32010-06-15 18:46:11 +0800379 llist_for_each_entry_safe(sccp_patch, tmp, &nat->sccp_connections, list_entry) {
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100380 if (sccp_patch->bsc != connection)
381 continue;
382
Holger Hans Peter Freyther6b087d12010-04-06 17:32:58 +0200383 nat_send_rlsd(sccp_patch);
Holger Hans Peter Freyther23fe7be2010-03-30 10:45:48 +0200384 sccp_connection_destroy(sccp_patch);
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100385 }
386
Holger Hans Peter Freyther26a43892010-04-05 23:09:27 +0200387 /* close endpoints allocated by this BSC */
388 bsc_mgcp_clear_endpoints_for(connection);
389
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100390 talloc_free(connection);
391}
392
Holger Hans Peter Freytheraa698242010-06-15 18:46:19 +0800393static void ipaccess_close_bsc(void *data)
394{
395 struct bsc_connection *conn = data;
396
397 LOGP(DNAT, LOGL_ERROR, "BSC didn't respond to identity request. Closing.\n");
398 remove_bsc_connection(conn);
399}
400
401static void ipaccess_auth_bsc(struct tlv_parsed *tvp, struct bsc_connection *bsc)
402{
403 struct bsc_config *conf;
404 const char* token = (const char *) TLVP_VAL(tvp, IPAC_IDTAG_UNITNAME);
405
406 llist_for_each_entry(conf, &bsc->nat->bsc_configs, entry) {
407 if (strcmp(conf->token, token) == 0) {
408 bsc->authenticated = 1;
Holger Hans Peter Freyther47dd4942010-04-06 15:11:34 +0200409 bsc->cfg = conf;
Holger Hans Peter Freytheraa698242010-06-15 18:46:19 +0800410 bsc_del_timer(&bsc->id_timeout);
Holger Hans Peter Freyther47dd4942010-04-06 15:11:34 +0200411 LOGP(DNAT, LOGL_NOTICE, "Authenticated bsc nr: %d lac: %d\n", conf->nr, conf->lac);
Holger Hans Peter Freytheraa698242010-06-15 18:46:19 +0800412 break;
413 }
414 }
415}
416
Holger Hans Peter Freyther747d6542010-03-26 07:24:34 +0100417static int forward_sccp_to_msc(struct bsc_connection *bsc, struct msgb *msg)
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100418{
Holger Hans Peter Freyther49c7fb52010-06-15 18:48:55 +0800419 struct sccp_connections *con;
Holger Hans Peter Freyther0b8f69d2010-06-15 18:45:38 +0800420 struct bsc_nat_parsed *parsed;
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100421
Holger Hans Peter Freyther0b8f69d2010-06-15 18:45:38 +0800422 /* Parse and filter messages */
423 parsed = bsc_nat_parse(msg);
424 if (!parsed) {
425 LOGP(DNAT, LOGL_ERROR, "Can not parse msg from BSC.\n");
Holger Hans Peter Freytherd7657ff2010-03-30 07:35:46 +0200426 msgb_free(msg);
Holger Hans Peter Freyther0b8f69d2010-06-15 18:45:38 +0800427 return -1;
428 }
429
Holger Hans Peter Freyther1d6fb182010-01-30 11:53:30 +0100430 if (bsc_nat_filter_ipa(DIR_MSC, msg, parsed))
Holger Hans Peter Freyther0b8f69d2010-06-15 18:45:38 +0800431 goto exit;
Holger Hans Peter Freyther6a97b8d2010-06-15 18:45:26 +0800432
Holger Hans Peter Freytherbbb9d392010-04-02 03:42:44 +0200433 /*
434 * check authentication after filtering to not reject auth
435 * responses coming from the BSC. We have to make sure that
436 * nothing from the exit path will forward things to the MSC
437 */
438 if (!bsc->authenticated) {
439 LOGP(DNAT, LOGL_ERROR, "BSC is not authenticated.\n");
440 msgb_free(msg);
441 return -1;
442 }
443
444
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100445 /* modify the SCCP entries */
446 if (parsed->ipa_proto == IPAC_PROTO_SCCP) {
447 switch (parsed->sccp_type) {
448 case SCCP_MSG_TYPE_CR:
449 if (create_sccp_src_ref(bsc, msg, parsed) != 0)
450 goto exit2;
Holger Hans Peter Freyther49c7fb52010-06-15 18:48:55 +0800451 con = patch_sccp_src_ref_to_msc(msg, parsed, nat);
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100452 break;
453 case SCCP_MSG_TYPE_RLSD:
454 case SCCP_MSG_TYPE_CREF:
455 case SCCP_MSG_TYPE_DT1:
456 case SCCP_MSG_TYPE_CC:
Holger Hans Peter Freytherf46ce532010-04-06 10:22:34 +0200457 case SCCP_MSG_TYPE_IT:
Holger Hans Peter Freyther49c7fb52010-06-15 18:48:55 +0800458 con = patch_sccp_src_ref_to_msc(msg, parsed, nat);
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100459 break;
460 case SCCP_MSG_TYPE_RLC:
Holger Hans Peter Freyther49c7fb52010-06-15 18:48:55 +0800461 con = patch_sccp_src_ref_to_msc(msg, parsed, nat);
Holger Hans Peter Freytherf4cfc4f2010-03-31 09:15:05 +0200462 remove_sccp_src_ref(bsc, msg, parsed);
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100463 break;
464 case SCCP_MSG_TYPE_UDT:
465 /* simply forward everything */
Holger Hans Peter Freyther49c7fb52010-06-15 18:48:55 +0800466 con = NULL;
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100467 break;
468 default:
Holger Hans Peter Freyther0ab6bab2010-06-15 18:47:49 +0800469 LOGP(DNAT, LOGL_ERROR, "Not forwarding to msc sccp type: 0x%x\n", parsed->sccp_type);
Holger Hans Peter Freyther49c7fb52010-06-15 18:48:55 +0800470 con = NULL;
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100471 goto exit2;
472 break;
473 }
Holger Hans Peter Freyther3c3bce12010-04-01 10:16:28 +0200474 } else if (parsed->ipa_proto == NAT_IPAC_PROTO_MGCP) {
475 bsc_mgcp_forward(bsc, msg);
476 goto exit2;
Holger Hans Peter Freyther49c7fb52010-06-15 18:48:55 +0800477 } else {
478 LOGP(DNAT, LOGL_ERROR, "Not forwarding unknown stream id: 0x%x\n", parsed->ipa_proto);
479 goto exit2;
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100480 }
481
Holger Hans Peter Freyther49c7fb52010-06-15 18:48:55 +0800482 if (con && con->bsc != bsc) {
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100483 LOGP(DNAT, LOGL_ERROR, "Found the wrong entry.\n");
484 goto exit2;
485 }
486
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100487 /* send the non-filtered but maybe modified msg */
Holger Hans Peter Freytherbaf2abe2010-06-15 18:47:29 +0800488 if (write_queue_enqueue(&msc_con->write_queue, msg) != 0) {
Holger Hans Peter Freyther6f5fbfd2010-06-15 18:47:02 +0800489 LOGP(DNAT, LOGL_ERROR, "Can not queue message for the MSC.\n");
490 msgb_free(msg);
491 }
Holger Hans Peter Freyther38a77d02010-01-30 12:45:10 +0100492 talloc_free(parsed);
Holger Hans Peter Freyther6f5fbfd2010-06-15 18:47:02 +0800493 return 0;
Holger Hans Peter Freyther0b8f69d2010-06-15 18:45:38 +0800494
495exit:
Holger Hans Peter Freyther38a77d02010-01-30 12:45:10 +0100496 /* if we filter out the reset send an ack to the BSC */
497 if (parsed->bssap == 0 && parsed->gsm_type == BSS_MAP_MSG_RESET) {
Holger Hans Peter Freyther747d6542010-03-26 07:24:34 +0100498 send_reset_ack(bsc);
499 send_reset_ack(bsc);
Holger Hans Peter Freytheraa698242010-06-15 18:46:19 +0800500 } else if (parsed->ipa_proto == IPAC_PROTO_IPACCESS) {
501 /* do we know who is handling this? */
502 if (msg->l2h[0] == IPAC_MSGT_ID_RESP) {
503 struct tlv_parsed tvp;
504 ipaccess_idtag_parse(&tvp,
505 (unsigned char *) msg->l2h + 2,
506 msgb_l2len(msg) - 2);
507 if (TLVP_PRESENT(&tvp, IPAC_IDTAG_UNITNAME))
508 ipaccess_auth_bsc(&tvp, bsc);
509 }
510
511 goto exit2;
Holger Hans Peter Freyther38a77d02010-01-30 12:45:10 +0100512 }
513
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100514exit2:
Holger Hans Peter Freyther0b8f69d2010-06-15 18:45:38 +0800515 talloc_free(parsed);
Holger Hans Peter Freyther6f5fbfd2010-06-15 18:47:02 +0800516 msgb_free(msg);
517 return -1;
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100518}
519
Holger Hans Peter Freythered07a3f2010-06-15 18:47:10 +0800520static int ipaccess_bsc_read_cb(struct bsc_fd *bfd)
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100521{
522 int error;
Holger Hans Peter Freyther747d6542010-03-26 07:24:34 +0100523 struct bsc_connection *bsc = bfd->data;
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100524 struct msgb *msg = ipaccess_read_msg(bfd, &error);
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100525
526 if (!msg) {
527 if (error == 0) {
Holger Hans Peter Freyther418f3942010-01-29 05:58:43 +0100528 LOGP(DNAT, LOGL_ERROR, "The connection to the BSC was lost. Cleaning it\n");
Holger Hans Peter Freyther747d6542010-03-26 07:24:34 +0100529 remove_bsc_connection(bsc);
Holger Hans Peter Freyther418f3942010-01-29 05:58:43 +0100530 } else {
531 LOGP(DNAT, LOGL_ERROR, "Failed to parse ip access message: %d\n", error);
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100532 }
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100533 return -1;
534 }
535
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100536
Holger Hans Peter Freyther418f3942010-01-29 05:58:43 +0100537 LOGP(DNAT, LOGL_DEBUG, "MSG from BSC: %s proto: %d\n", hexdump(msg->data, msg->len), msg->l2h[0]);
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100538
539 /* Handle messages from the BSC */
540 /* FIXME: Currently no PONG is sent to the BSC */
541 /* FIXME: Currently no ID ACK is sent to the BSC */
Holger Hans Peter Freyther747d6542010-03-26 07:24:34 +0100542 forward_sccp_to_msc(bsc, msg);
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100543
544 return 0;
545}
546
Holger Hans Peter Freyther3025e192010-03-26 09:18:02 +0100547static int ipaccess_bsc_write_cb(struct bsc_fd *bfd, struct msgb *msg)
548{
549 int rc;
550
551 rc = write(bfd->fd, msg->data, msg->len);
552 if (rc != msg->len)
553 LOGP(DNAT, LOGL_ERROR, "Failed to write message to the BSC.\n");
554
555 return rc;
556}
557
Holger Hans Peter Freyther49d80682010-01-12 21:34:54 +0100558static int ipaccess_listen_bsc_cb(struct bsc_fd *bfd, unsigned int what)
559{
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100560 struct bsc_connection *bsc;
Holger Hans Peter Freyther49d80682010-01-12 21:34:54 +0100561 int ret;
562 struct sockaddr_in sa;
563 socklen_t sa_len = sizeof(sa);
564
565 if (!(what & BSC_FD_READ))
566 return 0;
567
568 ret = accept(bfd->fd, (struct sockaddr *) &sa, &sa_len);
569 if (ret < 0) {
570 perror("accept");
571 return ret;
572 }
573
Holger Hans Peter Freythercd895372010-03-29 08:04:09 +0200574 /*
575 * if we are not connected to a msc... just close the socket
576 */
577 if (!msc_con->is_connected) {
578 LOGP(DNAT, LOGL_NOTICE, "Disconnecting BSC due lack of MSC connection.\n");
Holger Hans Peter Freythera7c377d2010-04-06 12:42:35 +0200579 close(ret);
Holger Hans Peter Freythercd895372010-03-29 08:04:09 +0200580 return 0;
581 }
582
Holger Hans Peter Freyther49d80682010-01-12 21:34:54 +0100583 /* todo... do something with the connection */
Holger Hans Peter Freytherda86c0a2010-01-12 21:35:32 +0100584 /* todo... use GNUtls to see if we want to trust this as a BTS */
Holger Hans Peter Freyther49d80682010-01-12 21:34:54 +0100585
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100586 /*
587 *
588 */
Holger Hans Peter Freytherdcf8a7d2010-06-15 18:48:01 +0800589 bsc = bsc_connection_alloc(nat);
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100590 if (!bsc) {
Holger Hans Peter Freyther418f3942010-01-29 05:58:43 +0100591 LOGP(DNAT, LOGL_ERROR, "Failed to allocate BSC struct.\n");
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100592 close(ret);
593 return -1;
594 }
595
Holger Hans Peter Freythered07a3f2010-06-15 18:47:10 +0800596 write_queue_init(&bsc->write_queue, 100);
597 bsc->write_queue.bfd.data = bsc;
598 bsc->write_queue.bfd.fd = ret;
599 bsc->write_queue.read_cb = ipaccess_bsc_read_cb;
Holger Hans Peter Freyther3025e192010-03-26 09:18:02 +0100600 bsc->write_queue.write_cb = ipaccess_bsc_write_cb;
Holger Hans Peter Freythered07a3f2010-06-15 18:47:10 +0800601 bsc->write_queue.bfd.when = BSC_FD_READ;
602 if (bsc_register_fd(&bsc->write_queue.bfd) < 0) {
Holger Hans Peter Freyther418f3942010-01-29 05:58:43 +0100603 LOGP(DNAT, LOGL_ERROR, "Failed to register BSC fd.\n");
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100604 close(ret);
605 talloc_free(bsc);
606 return -2;
607 }
608
Holger Hans Peter Freytherb9ac37d2010-04-05 17:58:52 +0200609 LOGP(DNAT, LOGL_NOTICE, "Registered new BSC\n");
Holger Hans Peter Freyther9a85ef32010-06-15 18:46:11 +0800610 llist_add(&bsc->list_entry, &nat->bsc_connections);
Holger Hans Peter Freytherdb7ba7d2010-03-26 07:41:54 +0100611 send_id_ack(bsc);
612 send_id_req(bsc);
Holger Hans Peter Freytherd131b792010-03-31 07:30:58 +0200613 send_mgcp_reset(bsc);
Holger Hans Peter Freytheraa698242010-06-15 18:46:19 +0800614
615 /*
616 * start the hangup timer
617 */
618 bsc->id_timeout.data = bsc;
619 bsc->id_timeout.cb = ipaccess_close_bsc;
620 bsc_schedule_timer(&bsc->id_timeout, 2, 0);
Holger Hans Peter Freyther49d80682010-01-12 21:34:54 +0100621 return 0;
622}
623
624static int listen_for_bsc(struct bsc_fd *bfd, struct in_addr *in_addr, int port)
625{
626 struct sockaddr_in addr;
627 int ret, on = 1;
628
629 bfd->fd = socket(AF_INET, SOCK_STREAM, IPPROTO_TCP);
630 bfd->cb = ipaccess_listen_bsc_cb;
631 bfd->when = BSC_FD_READ;
632
633 memset(&addr, 0, sizeof(addr));
634 addr.sin_family = AF_INET;
635 addr.sin_port = htons(port);
636 addr.sin_addr.s_addr = in_addr->s_addr;
637
638 setsockopt(bfd->fd, SOL_SOCKET, SO_REUSEADDR, &on, sizeof(on));
639
640 ret = bind(bfd->fd, (struct sockaddr *) &addr, sizeof(addr));
641 if (ret < 0) {
642 fprintf(stderr, "Could not bind the BSC socket %s\n",
643 strerror(errno));
644 return -EIO;
645 }
646
647 ret = listen(bfd->fd, 1);
648 if (ret < 0) {
649 perror("listen");
650 return ret;
651 }
652
653 ret = bsc_register_fd(bfd);
654 if (ret < 0) {
655 perror("register_listen_fd");
656 return ret;
657 }
658 return 0;
659}
660
Holger Hans Peter Freyther9e2c5f52010-06-15 18:44:42 +0800661static void print_usage()
662{
663 printf("Usage: bsc_nat\n");
664}
665
666static void print_help()
667{
668 printf(" Some useful help...\n");
669 printf(" -h --help this text\n");
670 printf(" -d option --debug=DRLL:DCC:DMM:DRR:DRSL:DNM enable debugging\n");
671 printf(" -s --disable-color\n");
672 printf(" -c --config-file filename The config file to use.\n");
673 printf(" -m --msc=IP. The address of the MSC.\n");
Holger Hans Peter Freyther49d80682010-01-12 21:34:54 +0100674 printf(" -l --local=IP. The local address of this BSC.\n");
Holger Hans Peter Freyther9e2c5f52010-06-15 18:44:42 +0800675}
676
677static void handle_options(int argc, char** argv)
678{
679 while (1) {
680 int option_index = 0, c;
681 static struct option long_options[] = {
682 {"help", 0, 0, 'h'},
683 {"debug", 1, 0, 'd'},
684 {"config-file", 1, 0, 'c'},
685 {"disable-color", 0, 0, 's'},
686 {"timestamp", 0, 0, 'T'},
687 {"msc", 1, 0, 'm'},
688 {"local", 1, 0, 'l'},
689 {0, 0, 0, 0}
690 };
691
692 c = getopt_long(argc, argv, "hd:sTPc:m:l:",
693 long_options, &option_index);
694 if (c == -1)
695 break;
696
697 switch (c) {
698 case 'h':
699 print_usage();
700 print_help();
701 exit(0);
702 case 's':
Holger Hans Peter Freytherfb7a9342010-06-15 19:14:12 +0800703 log_set_use_color(stderr_target, 0);
Holger Hans Peter Freyther9e2c5f52010-06-15 18:44:42 +0800704 break;
705 case 'd':
Holger Hans Peter Freytherfb7a9342010-06-15 19:14:12 +0800706 log_parse_category_mask(stderr_target, optarg);
Holger Hans Peter Freyther9e2c5f52010-06-15 18:44:42 +0800707 break;
708 case 'c':
709 config_file = strdup(optarg);
710 break;
711 case 'T':
Holger Hans Peter Freytherfb7a9342010-06-15 19:14:12 +0800712 log_set_print_timestamp(stderr_target, 1);
Holger Hans Peter Freyther9e2c5f52010-06-15 18:44:42 +0800713 break;
714 case 'm':
715 msc_address = strdup(optarg);
716 break;
717 case 'l':
718 inet_aton(optarg, &local_addr);
719 break;
720 default:
721 /* ignore */
722 break;
723 }
724 }
725}
726
Holger Hans Peter Freyther6ace5222010-01-12 21:15:08 +0100727static void signal_handler(int signal)
728{
Holger Hans Peter Freyther6ace5222010-01-12 21:15:08 +0100729 switch (signal) {
730 case SIGABRT:
731 /* in case of abort, we want to obtain a talloc report
732 * and then return to the caller, who will abort the process */
733 case SIGUSR1:
734 talloc_report_full(tall_bsc_ctx, stderr);
735 break;
736 default:
737 break;
738 }
739}
740
Holger Hans Peter Freyther9e2c5f52010-06-15 18:44:42 +0800741int main(int argc, char** argv)
742{
Holger Hans Peter Freytherfb7a9342010-06-15 19:14:12 +0800743 log_init(&log_info);
744 stderr_target = log_target_create_stderr();
745 log_add_target(stderr_target);
746 log_set_all_filter(stderr_target, 1);
Holger Hans Peter Freyther6c45f2e2010-06-15 19:06:18 +0800747
Holger Hans Peter Freyther9e2c5f52010-06-15 18:44:42 +0800748 /* parse options */
Holger Hans Peter Freyther49d80682010-01-12 21:34:54 +0100749 local_addr.s_addr = INADDR_ANY;
Holger Hans Peter Freyther9e2c5f52010-06-15 18:44:42 +0800750 handle_options(argc, argv);
751
Holger Hans Peter Freyther9a85ef32010-06-15 18:46:11 +0800752 nat = bsc_nat_alloc();
753 if (!nat) {
754 fprintf(stderr, "Failed to allocate the BSC nat.\n");
755 return -4;
756 }
757
Holger Hans Peter Freytherf7d33352010-06-15 18:50:26 +0800758 nat->mgcp_cfg = talloc_zero(nat, struct mgcp_config);
759
Holger Hans Peter Freyther9a85ef32010-06-15 18:46:11 +0800760 /* init vty and parse */
761 bsc_nat_vty_init(nat);
762 telnet_init(NULL, 4244);
Holger Hans Peter Freytherf7d33352010-06-15 18:50:26 +0800763 if (mgcp_parse_config(config_file, nat->mgcp_cfg) < 0) {
Holger Hans Peter Freyther9a85ef32010-06-15 18:46:11 +0800764 fprintf(stderr, "Failed to parse the config file: '%s'\n", config_file);
765 return -3;
766 }
767
Holger Hans Peter Freyther9e2c5f52010-06-15 18:44:42 +0800768 /* seed the PRNG */
769 srand(time(NULL));
770
Holger Hans Peter Freythera7f80182010-03-31 13:02:22 +0200771 /*
772 * Setup the MGCP code..
773 */
774 if (bsc_mgcp_init(nat) != 0)
775 return -4;
776
Holger Hans Peter Freyther49d80682010-01-12 21:34:54 +0100777 /* connect to the MSC */
Holger Hans Peter Freytherbaf2abe2010-06-15 18:47:29 +0800778 msc_con = bsc_msc_create(msc_address, 5000);
779 if (!msc_con) {
780 fprintf(stderr, "Creating a bsc_msc_connection failed.\n");
Holger Hans Peter Freyther6ace5222010-01-12 21:15:08 +0100781 exit(1);
782 }
783
Holger Hans Peter Freytherbaf2abe2010-06-15 18:47:29 +0800784 msc_con->connection_loss = msc_connection_was_lost;
785 msc_con->write_queue.read_cb = ipaccess_msc_read_cb;
786 msc_con->write_queue.write_cb = ipaccess_msc_write_cb;;
787 bsc_msc_connect(msc_con);
788
Holger Hans Peter Freyther49d80682010-01-12 21:34:54 +0100789 /* wait for the BSC */
Holger Hans Peter Freyther2d677c62010-03-26 06:51:04 +0100790 if (listen_for_bsc(&bsc_listen, &local_addr, 5000) < 0) {
Holger Hans Peter Freyther49d80682010-01-12 21:34:54 +0100791 fprintf(stderr, "Failed to listen for BSC.\n");
792 exit(1);
793 }
794
Holger Hans Peter Freyther6ace5222010-01-12 21:15:08 +0100795 signal(SIGABRT, &signal_handler);
796 signal(SIGUSR1, &signal_handler);
797 signal(SIGPIPE, SIG_IGN);
798
799 while (1) {
800 bsc_select_main(0);
801 }
802
Holger Hans Peter Freyther9e2c5f52010-06-15 18:44:42 +0800803 return 0;
804}