blob: 9e0a23dd17a987a58eb2abeba1753563c213b2cd [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 Freyther6c45f2e2010-06-15 19:06:18 +080052struct debug_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 Freytherd131b792010-03-31 07:30:58 +0200130static void send_mgcp_reset(struct bsc_connection *bsc)
131{
132 static const u_int8_t mgcp_reset[] = {
133 "RSIP 1 13@mgw MGCP 1.0\r\n"
134 };
135
136 bsc_write_mgcp(bsc, mgcp_reset, sizeof mgcp_reset - 1);
137}
138
Holger Hans Peter Freyther6ace5222010-01-12 21:15:08 +0100139/*
140 * Below is the handling of messages coming
141 * from the MSC and need to be forwarded to
142 * a real BSC.
143 */
144static void initialize_msc_if_needed()
145{
146 static int init = 0;
147 init = 1;
148
149 /* do we need to send a GSM 08.08 message here? */
150}
151
Holger Hans Peter Freyther3025e192010-03-26 09:18:02 +0100152/*
153 * Currently we are lacking refcounting so we need to copy each message.
154 */
155static void bsc_write(struct bsc_connection *bsc, const u_int8_t *data, unsigned int length)
Holger Hans Peter Freytherf7cb33c2010-03-26 07:20:59 +0100156{
Holger Hans Peter Freyther3025e192010-03-26 09:18:02 +0100157 struct msgb *msg;
158
159 if (length > 4096) {
160 LOGP(DINP, LOGL_ERROR, "Can not send message of that size.\n");
161 return;
162 }
163
164 msg = msgb_alloc(4096, "to-bsc");
165 if (!msg) {
166 LOGP(DINP, LOGL_ERROR, "Failed to allocate memory for BSC msg.\n");
167 return;
168 }
169
170 msgb_put(msg, length);
171 memcpy(msg->data, data, length);
172 if (write_queue_enqueue(&bsc->write_queue, msg) != 0) {
173 LOGP(DINP, LOGL_ERROR, "Failed to enqueue the write.\n");
174 msgb_free(msg);
175 }
Holger Hans Peter Freytherf7cb33c2010-03-26 07:20:59 +0100176}
177
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100178static int forward_sccp_to_bts(struct msgb *msg)
Holger Hans Peter Freyther6ace5222010-01-12 21:15:08 +0100179{
Holger Hans Peter Freyther49c7fb52010-06-15 18:48:55 +0800180 struct sccp_connections *con;
181 struct bsc_connection *bsc;
Holger Hans Peter Freyther0b8f69d2010-06-15 18:45:38 +0800182 struct bsc_nat_parsed *parsed;
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100183
Holger Hans Peter Freyther6ace5222010-01-12 21:15:08 +0100184 /* filter, drop, patch the message? */
Holger Hans Peter Freyther0b8f69d2010-06-15 18:45:38 +0800185 parsed = bsc_nat_parse(msg);
186 if (!parsed) {
187 LOGP(DNAT, LOGL_ERROR, "Can not parse msg from BSC.\n");
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100188 return -1;
Holger Hans Peter Freyther0b8f69d2010-06-15 18:45:38 +0800189 }
190
Holger Hans Peter Freyther1d6fb182010-01-30 11:53:30 +0100191 if (bsc_nat_filter_ipa(DIR_BSC, msg, parsed))
Holger Hans Peter Freyther0b8f69d2010-06-15 18:45:38 +0800192 goto exit;
Holger Hans Peter Freyther6a97b8d2010-06-15 18:45:26 +0800193
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100194 /* Route and modify the SCCP packet */
195 if (parsed->ipa_proto == IPAC_PROTO_SCCP) {
196 switch (parsed->sccp_type) {
197 case SCCP_MSG_TYPE_UDT:
198 /* forward UDT messages to every BSC */
199 goto send_to_all;
200 break;
201 case SCCP_MSG_TYPE_RLSD:
202 case SCCP_MSG_TYPE_CREF:
203 case SCCP_MSG_TYPE_DT1:
Holger Hans Peter Freytherf46ce532010-04-06 10:22:34 +0200204 case SCCP_MSG_TYPE_IT:
Holger Hans Peter Freyther49c7fb52010-06-15 18:48:55 +0800205 con = patch_sccp_src_ref_to_bsc(msg, parsed, nat);
Holger Hans Peter Freyther465313e2010-06-15 18:49:53 +0800206 if (parsed->gsm_type == BSS_MAP_MSG_ASSIGMENT_RQST) {
207 if (con) {
208 if (bsc_mgcp_assign(con, msg) != 0)
209 LOGP(DNAT, LOGL_ERROR, "Failed to assign...\n");
210 } else
211 LOGP(DNAT, LOGL_ERROR, "Assignment command but no BSC.\n");
212 }
Holger Hans Peter Freyther16a6f702010-03-29 17:18:42 +0200213 break;
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100214 case SCCP_MSG_TYPE_CC:
Holger Hans Peter Freyther49c7fb52010-06-15 18:48:55 +0800215 con = patch_sccp_src_ref_to_bsc(msg, parsed, nat);
216 if (!con || update_sccp_src_ref(con, parsed) != 0)
Holger Hans Peter Freyther16a6f702010-03-29 17:18:42 +0200217 goto exit;
Holger Hans Peter Freyther0ab6bab2010-06-15 18:47:49 +0800218 break;
219 case SCCP_MSG_TYPE_RLC:
220 LOGP(DNAT, LOGL_ERROR, "Unexpected release complete from MSC.\n");
221 goto exit;
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100222 break;
223 case SCCP_MSG_TYPE_CR:
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100224 /* MSC never opens a SCCP connection, fall through */
225 default:
226 goto exit;
227 }
228 }
229
230 talloc_free(parsed);
Holger Hans Peter Freyther49c7fb52010-06-15 18:48:55 +0800231 if (!con)
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100232 return -1;
Holger Hans Peter Freyther49c7fb52010-06-15 18:48:55 +0800233 if (!con->bsc->authenticated) {
Holger Hans Peter Freyther6c45f2e2010-06-15 19:06:18 +0800234 LOGP(DNAT, LOGL_ERROR, "Selected BSC not authenticated.\n");
Holger Hans Peter Freyther3f37b8f2010-02-08 23:24:32 +0100235 return -1;
236 }
237
Holger Hans Peter Freyther49c7fb52010-06-15 18:48:55 +0800238 bsc_write(con->bsc, msg->data, msg->len);
Holger Hans Peter Freyther3025e192010-03-26 09:18:02 +0100239 return 0;
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100240
241send_to_all:
Holger Hans Peter Freyther45d11812010-06-15 18:46:36 +0800242 /*
243 * Filter Paging from the network. We do not want to send a PAGING
244 * Command to every BSC in our network. We will analys the PAGING
245 * message and then send it to the authenticated messages...
246 */
247 if (parsed->ipa_proto == IPAC_PROTO_SCCP && parsed->gsm_type == BSS_MAP_MSG_PAGING) {
Holger Hans Peter Freytherbae9da42010-03-30 05:57:42 +0200248 bsc = bsc_nat_find_bsc(nat, msg);
249 if (bsc)
250 bsc_write(bsc, msg->data, msg->len);
251 else
252 LOGP(DNAT, LOGL_ERROR, "Could not determine BSC for paging.\n");
Holger Hans Peter Freyther45d11812010-06-15 18:46:36 +0800253
254 goto exit;
255 }
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100256 /* currently send this to every BSC connected */
Holger Hans Peter Freyther9a85ef32010-06-15 18:46:11 +0800257 llist_for_each_entry(bsc, &nat->bsc_connections, list_entry) {
Holger Hans Peter Freyther3f37b8f2010-02-08 23:24:32 +0100258 if (!bsc->authenticated)
259 continue;
260
Holger Hans Peter Freyther3025e192010-03-26 09:18:02 +0100261 bsc_write(bsc, msg->data, msg->len);
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100262 }
Holger Hans Peter Freyther0b8f69d2010-06-15 18:45:38 +0800263
264exit:
265 talloc_free(parsed);
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100266 return 0;
Holger Hans Peter Freyther6ace5222010-01-12 21:15:08 +0100267}
268
Holger Hans Peter Freytherbaf2abe2010-06-15 18:47:29 +0800269static void msc_connection_was_lost(struct bsc_msc_connection *con)
270{
Holger Hans Peter Freythercd895372010-03-29 08:04:09 +0200271 struct bsc_connection *bsc, *tmp;
272
273 LOGP(DMSC, LOGL_ERROR, "Closing all connections downstream.\n");
274 llist_for_each_entry_safe(bsc, tmp, &nat->bsc_connections, list_entry)
275 remove_bsc_connection(bsc);
276
Holger Hans Peter Freyther241e1302010-03-31 09:16:56 +0200277 bsc_mgcp_free_endpoints(nat);
Holger Hans Peter Freythercd895372010-03-29 08:04:09 +0200278 bsc_msc_schedule_connect(con);
Holger Hans Peter Freytherbaf2abe2010-06-15 18:47:29 +0800279}
280
Holger Hans Peter Freyther6f5fbfd2010-06-15 18:47:02 +0800281static int ipaccess_msc_read_cb(struct bsc_fd *bfd)
Holger Hans Peter Freyther6ace5222010-01-12 21:15:08 +0100282{
283 int error;
284 struct msgb *msg = ipaccess_read_msg(bfd, &error);
285 struct ipaccess_head *hh;
286
287 if (!msg) {
288 if (error == 0) {
Holger Hans Peter Freyther418f3942010-01-29 05:58:43 +0100289 LOGP(DNAT, LOGL_FATAL, "The connection the MSC was lost, exiting\n");
Holger Hans Peter Freytherbaf2abe2010-06-15 18:47:29 +0800290 bsc_msc_lost(msc_con);
291 return -1;
Holger Hans Peter Freyther6ace5222010-01-12 21:15:08 +0100292 }
293
Holger Hans Peter Freyther418f3942010-01-29 05:58:43 +0100294 LOGP(DNAT, LOGL_ERROR, "Failed to parse ip access message: %d\n", error);
Holger Hans Peter Freyther6ace5222010-01-12 21:15:08 +0100295 return -1;
296 }
297
Holger Hans Peter Freyther418f3942010-01-29 05:58:43 +0100298 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 +0100299
300 /* handle base message handling */
301 hh = (struct ipaccess_head *) msg->data;
302 ipaccess_rcvmsg_base(msg, bfd);
303
304 /* initialize the networking. This includes sending a GSM08.08 message */
305 if (hh->proto == IPAC_PROTO_IPACCESS && msg->l2h[0] == IPAC_MSGT_ID_ACK)
306 initialize_msc_if_needed();
307 else if (hh->proto == IPAC_PROTO_SCCP)
308 forward_sccp_to_bts(msg);
309
Holger Hans Peter Freytheraad68b52010-06-15 18:46:48 +0800310 msgb_free(msg);
Holger Hans Peter Freyther6ace5222010-01-12 21:15:08 +0100311 return 0;
312}
Holger Hans Peter Freyther9e2c5f52010-06-15 18:44:42 +0800313
Holger Hans Peter Freyther6f5fbfd2010-06-15 18:47:02 +0800314static int ipaccess_msc_write_cb(struct bsc_fd *bfd, struct msgb *msg)
315{
316 int rc;
317 rc = write(bfd->fd, msg->data, msg->len);
318
319 if (rc != msg->len) {
320 LOGP(DNAT, LOGL_ERROR, "Failed to write MSG to MSC.\n");
321 return -1;
322 }
323
324 return rc;
325}
326
Holger Hans Peter Freyther49d80682010-01-12 21:34:54 +0100327/*
328 * Below is the handling of messages coming
329 * from the BSC and need to be forwarded to
330 * a real BSC.
331 */
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100332
333/*
334 * Remove the connection from the connections list,
335 * remove it from the patching of SCCP header lists
336 * as well. Maybe in the future even close connection..
337 */
338static void remove_bsc_connection(struct bsc_connection *connection)
339{
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100340 struct sccp_connections *sccp_patch, *tmp;
Holger Hans Peter Freythered07a3f2010-06-15 18:47:10 +0800341 bsc_unregister_fd(&connection->write_queue.bfd);
342 close(connection->write_queue.bfd.fd);
Holger Hans Peter Freytherf38e8792010-03-26 09:27:08 +0100343 write_queue_clear(&connection->write_queue);
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100344 llist_del(&connection->list_entry);
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100345
Holger Hans Peter Freytheraa698242010-06-15 18:46:19 +0800346 /* stop the timeout timer */
347 bsc_del_timer(&connection->id_timeout);
348
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100349 /* remove all SCCP connections */
Holger Hans Peter Freyther9a85ef32010-06-15 18:46:11 +0800350 llist_for_each_entry_safe(sccp_patch, tmp, &nat->sccp_connections, list_entry) {
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100351 if (sccp_patch->bsc != connection)
352 continue;
353
Holger Hans Peter Freyther7c99d4f2010-03-26 09:28:40 +0100354#warning "TODO: Send a RLSD to the MSC. Or at least a clear command."
Holger Hans Peter Freyther23fe7be2010-03-30 10:45:48 +0200355 sccp_connection_destroy(sccp_patch);
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100356 }
357
Holger Hans Peter Freyther26a43892010-04-05 23:09:27 +0200358 /* close endpoints allocated by this BSC */
359 bsc_mgcp_clear_endpoints_for(connection);
360
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100361 talloc_free(connection);
362}
363
Holger Hans Peter Freytheraa698242010-06-15 18:46:19 +0800364static void ipaccess_close_bsc(void *data)
365{
366 struct bsc_connection *conn = data;
367
368 LOGP(DNAT, LOGL_ERROR, "BSC didn't respond to identity request. Closing.\n");
369 remove_bsc_connection(conn);
370}
371
372static void ipaccess_auth_bsc(struct tlv_parsed *tvp, struct bsc_connection *bsc)
373{
374 struct bsc_config *conf;
375 const char* token = (const char *) TLVP_VAL(tvp, IPAC_IDTAG_UNITNAME);
376
377 llist_for_each_entry(conf, &bsc->nat->bsc_configs, entry) {
378 if (strcmp(conf->token, token) == 0) {
379 bsc->authenticated = 1;
380 bsc->lac = conf->lac;
381 bsc_del_timer(&bsc->id_timeout);
Holger Hans Peter Freytherb9ac37d2010-04-05 17:58:52 +0200382 LOGP(DNAT, LOGL_NOTICE, "Authenticated bsc %d\n", bsc->lac);
Holger Hans Peter Freytheraa698242010-06-15 18:46:19 +0800383 break;
384 }
385 }
386}
387
Holger Hans Peter Freyther747d6542010-03-26 07:24:34 +0100388static int forward_sccp_to_msc(struct bsc_connection *bsc, struct msgb *msg)
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100389{
Holger Hans Peter Freyther49c7fb52010-06-15 18:48:55 +0800390 struct sccp_connections *con;
Holger Hans Peter Freyther0b8f69d2010-06-15 18:45:38 +0800391 struct bsc_nat_parsed *parsed;
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100392
Holger Hans Peter Freyther0b8f69d2010-06-15 18:45:38 +0800393 /* Parse and filter messages */
394 parsed = bsc_nat_parse(msg);
395 if (!parsed) {
396 LOGP(DNAT, LOGL_ERROR, "Can not parse msg from BSC.\n");
Holger Hans Peter Freytherd7657ff2010-03-30 07:35:46 +0200397 msgb_free(msg);
Holger Hans Peter Freyther0b8f69d2010-06-15 18:45:38 +0800398 return -1;
399 }
400
Holger Hans Peter Freyther1d6fb182010-01-30 11:53:30 +0100401 if (bsc_nat_filter_ipa(DIR_MSC, msg, parsed))
Holger Hans Peter Freyther0b8f69d2010-06-15 18:45:38 +0800402 goto exit;
Holger Hans Peter Freyther6a97b8d2010-06-15 18:45:26 +0800403
Holger Hans Peter Freytherbbb9d392010-04-02 03:42:44 +0200404 /*
405 * check authentication after filtering to not reject auth
406 * responses coming from the BSC. We have to make sure that
407 * nothing from the exit path will forward things to the MSC
408 */
409 if (!bsc->authenticated) {
410 LOGP(DNAT, LOGL_ERROR, "BSC is not authenticated.\n");
411 msgb_free(msg);
412 return -1;
413 }
414
415
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100416 /* modify the SCCP entries */
417 if (parsed->ipa_proto == IPAC_PROTO_SCCP) {
418 switch (parsed->sccp_type) {
419 case SCCP_MSG_TYPE_CR:
420 if (create_sccp_src_ref(bsc, msg, parsed) != 0)
421 goto exit2;
Holger Hans Peter Freyther49c7fb52010-06-15 18:48:55 +0800422 con = patch_sccp_src_ref_to_msc(msg, parsed, nat);
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100423 break;
424 case SCCP_MSG_TYPE_RLSD:
425 case SCCP_MSG_TYPE_CREF:
426 case SCCP_MSG_TYPE_DT1:
427 case SCCP_MSG_TYPE_CC:
Holger Hans Peter Freytherf46ce532010-04-06 10:22:34 +0200428 case SCCP_MSG_TYPE_IT:
Holger Hans Peter Freyther49c7fb52010-06-15 18:48:55 +0800429 con = patch_sccp_src_ref_to_msc(msg, parsed, nat);
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100430 break;
431 case SCCP_MSG_TYPE_RLC:
Holger Hans Peter Freyther49c7fb52010-06-15 18:48:55 +0800432 con = patch_sccp_src_ref_to_msc(msg, parsed, nat);
Holger Hans Peter Freytherf4cfc4f2010-03-31 09:15:05 +0200433 remove_sccp_src_ref(bsc, msg, parsed);
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100434 break;
435 case SCCP_MSG_TYPE_UDT:
436 /* simply forward everything */
Holger Hans Peter Freyther49c7fb52010-06-15 18:48:55 +0800437 con = NULL;
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100438 break;
439 default:
Holger Hans Peter Freyther0ab6bab2010-06-15 18:47:49 +0800440 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 +0800441 con = NULL;
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100442 goto exit2;
443 break;
444 }
Holger Hans Peter Freyther3c3bce12010-04-01 10:16:28 +0200445 } else if (parsed->ipa_proto == NAT_IPAC_PROTO_MGCP) {
446 bsc_mgcp_forward(bsc, msg);
447 goto exit2;
Holger Hans Peter Freyther49c7fb52010-06-15 18:48:55 +0800448 } else {
449 LOGP(DNAT, LOGL_ERROR, "Not forwarding unknown stream id: 0x%x\n", parsed->ipa_proto);
450 goto exit2;
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100451 }
452
Holger Hans Peter Freyther49c7fb52010-06-15 18:48:55 +0800453 if (con && con->bsc != bsc) {
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100454 LOGP(DNAT, LOGL_ERROR, "Found the wrong entry.\n");
455 goto exit2;
456 }
457
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100458 /* send the non-filtered but maybe modified msg */
Holger Hans Peter Freytherbaf2abe2010-06-15 18:47:29 +0800459 if (write_queue_enqueue(&msc_con->write_queue, msg) != 0) {
Holger Hans Peter Freyther6f5fbfd2010-06-15 18:47:02 +0800460 LOGP(DNAT, LOGL_ERROR, "Can not queue message for the MSC.\n");
461 msgb_free(msg);
462 }
Holger Hans Peter Freyther38a77d02010-01-30 12:45:10 +0100463 talloc_free(parsed);
Holger Hans Peter Freyther6f5fbfd2010-06-15 18:47:02 +0800464 return 0;
Holger Hans Peter Freyther0b8f69d2010-06-15 18:45:38 +0800465
466exit:
Holger Hans Peter Freyther38a77d02010-01-30 12:45:10 +0100467 /* if we filter out the reset send an ack to the BSC */
468 if (parsed->bssap == 0 && parsed->gsm_type == BSS_MAP_MSG_RESET) {
Holger Hans Peter Freyther747d6542010-03-26 07:24:34 +0100469 send_reset_ack(bsc);
470 send_reset_ack(bsc);
Holger Hans Peter Freytheraa698242010-06-15 18:46:19 +0800471 } else if (parsed->ipa_proto == IPAC_PROTO_IPACCESS) {
472 /* do we know who is handling this? */
473 if (msg->l2h[0] == IPAC_MSGT_ID_RESP) {
474 struct tlv_parsed tvp;
475 ipaccess_idtag_parse(&tvp,
476 (unsigned char *) msg->l2h + 2,
477 msgb_l2len(msg) - 2);
478 if (TLVP_PRESENT(&tvp, IPAC_IDTAG_UNITNAME))
479 ipaccess_auth_bsc(&tvp, bsc);
480 }
481
482 goto exit2;
Holger Hans Peter Freyther38a77d02010-01-30 12:45:10 +0100483 }
484
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100485exit2:
Holger Hans Peter Freyther0b8f69d2010-06-15 18:45:38 +0800486 talloc_free(parsed);
Holger Hans Peter Freyther6f5fbfd2010-06-15 18:47:02 +0800487 msgb_free(msg);
488 return -1;
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100489}
490
Holger Hans Peter Freythered07a3f2010-06-15 18:47:10 +0800491static int ipaccess_bsc_read_cb(struct bsc_fd *bfd)
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100492{
493 int error;
Holger Hans Peter Freyther747d6542010-03-26 07:24:34 +0100494 struct bsc_connection *bsc = bfd->data;
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100495 struct msgb *msg = ipaccess_read_msg(bfd, &error);
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100496
497 if (!msg) {
498 if (error == 0) {
Holger Hans Peter Freyther418f3942010-01-29 05:58:43 +0100499 LOGP(DNAT, LOGL_ERROR, "The connection to the BSC was lost. Cleaning it\n");
Holger Hans Peter Freyther747d6542010-03-26 07:24:34 +0100500 remove_bsc_connection(bsc);
Holger Hans Peter Freyther418f3942010-01-29 05:58:43 +0100501 } else {
502 LOGP(DNAT, LOGL_ERROR, "Failed to parse ip access message: %d\n", error);
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100503 }
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100504 return -1;
505 }
506
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100507
Holger Hans Peter Freyther418f3942010-01-29 05:58:43 +0100508 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 +0100509
510 /* Handle messages from the BSC */
511 /* FIXME: Currently no PONG is sent to the BSC */
512 /* FIXME: Currently no ID ACK is sent to the BSC */
Holger Hans Peter Freyther747d6542010-03-26 07:24:34 +0100513 forward_sccp_to_msc(bsc, msg);
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100514
515 return 0;
516}
517
Holger Hans Peter Freyther3025e192010-03-26 09:18:02 +0100518static int ipaccess_bsc_write_cb(struct bsc_fd *bfd, struct msgb *msg)
519{
520 int rc;
521
522 rc = write(bfd->fd, msg->data, msg->len);
523 if (rc != msg->len)
524 LOGP(DNAT, LOGL_ERROR, "Failed to write message to the BSC.\n");
525
526 return rc;
527}
528
Holger Hans Peter Freyther49d80682010-01-12 21:34:54 +0100529static int ipaccess_listen_bsc_cb(struct bsc_fd *bfd, unsigned int what)
530{
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100531 struct bsc_connection *bsc;
Holger Hans Peter Freyther49d80682010-01-12 21:34:54 +0100532 int ret;
533 struct sockaddr_in sa;
534 socklen_t sa_len = sizeof(sa);
535
536 if (!(what & BSC_FD_READ))
537 return 0;
538
539 ret = accept(bfd->fd, (struct sockaddr *) &sa, &sa_len);
540 if (ret < 0) {
541 perror("accept");
542 return ret;
543 }
544
Holger Hans Peter Freythercd895372010-03-29 08:04:09 +0200545 /*
546 * if we are not connected to a msc... just close the socket
547 */
548 if (!msc_con->is_connected) {
549 LOGP(DNAT, LOGL_NOTICE, "Disconnecting BSC due lack of MSC connection.\n");
550 return 0;
551 }
552
Holger Hans Peter Freyther49d80682010-01-12 21:34:54 +0100553 /* todo... do something with the connection */
Holger Hans Peter Freytherda86c0a2010-01-12 21:35:32 +0100554 /* todo... use GNUtls to see if we want to trust this as a BTS */
Holger Hans Peter Freyther49d80682010-01-12 21:34:54 +0100555
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100556 /*
557 *
558 */
Holger Hans Peter Freytherdcf8a7d2010-06-15 18:48:01 +0800559 bsc = bsc_connection_alloc(nat);
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100560 if (!bsc) {
Holger Hans Peter Freyther418f3942010-01-29 05:58:43 +0100561 LOGP(DNAT, LOGL_ERROR, "Failed to allocate BSC struct.\n");
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100562 close(ret);
563 return -1;
564 }
565
Holger Hans Peter Freythered07a3f2010-06-15 18:47:10 +0800566 write_queue_init(&bsc->write_queue, 100);
567 bsc->write_queue.bfd.data = bsc;
568 bsc->write_queue.bfd.fd = ret;
569 bsc->write_queue.read_cb = ipaccess_bsc_read_cb;
Holger Hans Peter Freyther3025e192010-03-26 09:18:02 +0100570 bsc->write_queue.write_cb = ipaccess_bsc_write_cb;
Holger Hans Peter Freythered07a3f2010-06-15 18:47:10 +0800571 bsc->write_queue.bfd.when = BSC_FD_READ;
572 if (bsc_register_fd(&bsc->write_queue.bfd) < 0) {
Holger Hans Peter Freyther418f3942010-01-29 05:58:43 +0100573 LOGP(DNAT, LOGL_ERROR, "Failed to register BSC fd.\n");
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100574 close(ret);
575 talloc_free(bsc);
576 return -2;
577 }
578
Holger Hans Peter Freytherb9ac37d2010-04-05 17:58:52 +0200579 LOGP(DNAT, LOGL_NOTICE, "Registered new BSC\n");
Holger Hans Peter Freyther9a85ef32010-06-15 18:46:11 +0800580 llist_add(&bsc->list_entry, &nat->bsc_connections);
Holger Hans Peter Freytherdb7ba7d2010-03-26 07:41:54 +0100581 send_id_ack(bsc);
582 send_id_req(bsc);
Holger Hans Peter Freytherd131b792010-03-31 07:30:58 +0200583 send_mgcp_reset(bsc);
Holger Hans Peter Freytheraa698242010-06-15 18:46:19 +0800584
585 /*
586 * start the hangup timer
587 */
588 bsc->id_timeout.data = bsc;
589 bsc->id_timeout.cb = ipaccess_close_bsc;
590 bsc_schedule_timer(&bsc->id_timeout, 2, 0);
Holger Hans Peter Freyther49d80682010-01-12 21:34:54 +0100591 return 0;
592}
593
594static int listen_for_bsc(struct bsc_fd *bfd, struct in_addr *in_addr, int port)
595{
596 struct sockaddr_in addr;
597 int ret, on = 1;
598
599 bfd->fd = socket(AF_INET, SOCK_STREAM, IPPROTO_TCP);
600 bfd->cb = ipaccess_listen_bsc_cb;
601 bfd->when = BSC_FD_READ;
602
603 memset(&addr, 0, sizeof(addr));
604 addr.sin_family = AF_INET;
605 addr.sin_port = htons(port);
606 addr.sin_addr.s_addr = in_addr->s_addr;
607
608 setsockopt(bfd->fd, SOL_SOCKET, SO_REUSEADDR, &on, sizeof(on));
609
610 ret = bind(bfd->fd, (struct sockaddr *) &addr, sizeof(addr));
611 if (ret < 0) {
612 fprintf(stderr, "Could not bind the BSC socket %s\n",
613 strerror(errno));
614 return -EIO;
615 }
616
617 ret = listen(bfd->fd, 1);
618 if (ret < 0) {
619 perror("listen");
620 return ret;
621 }
622
623 ret = bsc_register_fd(bfd);
624 if (ret < 0) {
625 perror("register_listen_fd");
626 return ret;
627 }
628 return 0;
629}
630
Holger Hans Peter Freyther9e2c5f52010-06-15 18:44:42 +0800631static void print_usage()
632{
633 printf("Usage: bsc_nat\n");
634}
635
636static void print_help()
637{
638 printf(" Some useful help...\n");
639 printf(" -h --help this text\n");
640 printf(" -d option --debug=DRLL:DCC:DMM:DRR:DRSL:DNM enable debugging\n");
641 printf(" -s --disable-color\n");
642 printf(" -c --config-file filename The config file to use.\n");
643 printf(" -m --msc=IP. The address of the MSC.\n");
Holger Hans Peter Freyther49d80682010-01-12 21:34:54 +0100644 printf(" -l --local=IP. The local address of this BSC.\n");
Holger Hans Peter Freyther9e2c5f52010-06-15 18:44:42 +0800645}
646
647static void handle_options(int argc, char** argv)
648{
649 while (1) {
650 int option_index = 0, c;
651 static struct option long_options[] = {
652 {"help", 0, 0, 'h'},
653 {"debug", 1, 0, 'd'},
654 {"config-file", 1, 0, 'c'},
655 {"disable-color", 0, 0, 's'},
656 {"timestamp", 0, 0, 'T'},
657 {"msc", 1, 0, 'm'},
658 {"local", 1, 0, 'l'},
659 {0, 0, 0, 0}
660 };
661
662 c = getopt_long(argc, argv, "hd:sTPc:m:l:",
663 long_options, &option_index);
664 if (c == -1)
665 break;
666
667 switch (c) {
668 case 'h':
669 print_usage();
670 print_help();
671 exit(0);
672 case 's':
Holger Hans Peter Freyther6c45f2e2010-06-15 19:06:18 +0800673 debug_set_use_color(stderr_target, 0);
Holger Hans Peter Freyther9e2c5f52010-06-15 18:44:42 +0800674 break;
675 case 'd':
Holger Hans Peter Freyther6c45f2e2010-06-15 19:06:18 +0800676 debug_parse_category_mask(stderr_target, optarg);
Holger Hans Peter Freyther9e2c5f52010-06-15 18:44:42 +0800677 break;
678 case 'c':
679 config_file = strdup(optarg);
680 break;
681 case 'T':
Holger Hans Peter Freyther6c45f2e2010-06-15 19:06:18 +0800682 debug_set_print_timestamp(stderr_target, 1);
Holger Hans Peter Freyther9e2c5f52010-06-15 18:44:42 +0800683 break;
684 case 'm':
685 msc_address = strdup(optarg);
686 break;
687 case 'l':
688 inet_aton(optarg, &local_addr);
689 break;
690 default:
691 /* ignore */
692 break;
693 }
694 }
695}
696
Holger Hans Peter Freyther6ace5222010-01-12 21:15:08 +0100697static void signal_handler(int signal)
698{
Holger Hans Peter Freyther6ace5222010-01-12 21:15:08 +0100699 switch (signal) {
700 case SIGABRT:
701 /* in case of abort, we want to obtain a talloc report
702 * and then return to the caller, who will abort the process */
703 case SIGUSR1:
704 talloc_report_full(tall_bsc_ctx, stderr);
705 break;
706 default:
707 break;
708 }
709}
710
Holger Hans Peter Freyther9e2c5f52010-06-15 18:44:42 +0800711int main(int argc, char** argv)
712{
Holger Hans Peter Freyther6ace5222010-01-12 21:15:08 +0100713
Holger Hans Peter Freyther6c45f2e2010-06-15 19:06:18 +0800714 debug_init();
715 stderr_target = debug_target_create_stderr();
716 debug_add_target(stderr_target);
717 debug_set_all_filter(stderr_target, 1);
718
Holger Hans Peter Freyther9e2c5f52010-06-15 18:44:42 +0800719 /* parse options */
Holger Hans Peter Freyther49d80682010-01-12 21:34:54 +0100720 local_addr.s_addr = INADDR_ANY;
Holger Hans Peter Freyther9e2c5f52010-06-15 18:44:42 +0800721 handle_options(argc, argv);
722
Holger Hans Peter Freyther9a85ef32010-06-15 18:46:11 +0800723 nat = bsc_nat_alloc();
724 if (!nat) {
725 fprintf(stderr, "Failed to allocate the BSC nat.\n");
726 return -4;
727 }
728
Holger Hans Peter Freytherf7d33352010-06-15 18:50:26 +0800729 nat->mgcp_cfg = talloc_zero(nat, struct mgcp_config);
730
Holger Hans Peter Freyther9a85ef32010-06-15 18:46:11 +0800731 /* init vty and parse */
732 bsc_nat_vty_init(nat);
733 telnet_init(NULL, 4244);
Holger Hans Peter Freytherf7d33352010-06-15 18:50:26 +0800734 if (mgcp_parse_config(config_file, nat->mgcp_cfg) < 0) {
Holger Hans Peter Freyther9a85ef32010-06-15 18:46:11 +0800735 fprintf(stderr, "Failed to parse the config file: '%s'\n", config_file);
736 return -3;
737 }
738
Holger Hans Peter Freyther9e2c5f52010-06-15 18:44:42 +0800739 /* seed the PRNG */
740 srand(time(NULL));
741
Holger Hans Peter Freythera7f80182010-03-31 13:02:22 +0200742 /*
743 * Setup the MGCP code..
744 */
745 if (bsc_mgcp_init(nat) != 0)
746 return -4;
747
Holger Hans Peter Freyther49d80682010-01-12 21:34:54 +0100748 /* connect to the MSC */
Holger Hans Peter Freytherbaf2abe2010-06-15 18:47:29 +0800749 msc_con = bsc_msc_create(msc_address, 5000);
750 if (!msc_con) {
751 fprintf(stderr, "Creating a bsc_msc_connection failed.\n");
Holger Hans Peter Freyther6ace5222010-01-12 21:15:08 +0100752 exit(1);
753 }
754
Holger Hans Peter Freytherbaf2abe2010-06-15 18:47:29 +0800755 msc_con->connection_loss = msc_connection_was_lost;
756 msc_con->write_queue.read_cb = ipaccess_msc_read_cb;
757 msc_con->write_queue.write_cb = ipaccess_msc_write_cb;;
758 bsc_msc_connect(msc_con);
759
Holger Hans Peter Freyther49d80682010-01-12 21:34:54 +0100760 /* wait for the BSC */
Holger Hans Peter Freyther2d677c62010-03-26 06:51:04 +0100761 if (listen_for_bsc(&bsc_listen, &local_addr, 5000) < 0) {
Holger Hans Peter Freyther49d80682010-01-12 21:34:54 +0100762 fprintf(stderr, "Failed to listen for BSC.\n");
763 exit(1);
764 }
765
Holger Hans Peter Freyther6ace5222010-01-12 21:15:08 +0100766 signal(SIGABRT, &signal_handler);
767 signal(SIGUSR1, &signal_handler);
768 signal(SIGPIPE, SIG_IGN);
769
770 while (1) {
771 bsc_select_main(0);
772 }
773
Holger Hans Peter Freyther9e2c5f52010-06-15 18:44:42 +0800774 return 0;
775}