blob: d75c01dabd363110232682c7572b1fdbf9e8c903 [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 Freytherd131b792010-03-31 07:30:58 +0200178int bsc_write_mgcp(struct bsc_connection *bsc, const u_int8_t *data, unsigned int length)
179{
180 struct msgb *msg;
181
182 if (length > 4096 - 128) {
183 LOGP(DINP, LOGL_ERROR, "Can not send message of that size.\n");
184 return -1;
185 }
186
187 msg = msgb_alloc_headroom(4096, 128, "to-bsc");
188 if (!msg) {
189 LOGP(DINP, LOGL_ERROR, "Failed to allocate memory for BSC msg.\n");
190 return -1;
191 }
192
193 /* copy the data */
194 msg->l3h = msgb_put(msg, length);
195 memcpy(msg->l3h, data, length);
196
197 /* prepend the header */
198 ipaccess_prepend_header(msg, NAT_IPAC_PROTO_MGCP);
199
200 if (write_queue_enqueue(&bsc->write_queue, msg) != 0) {
201 LOGP(DINP, LOGL_ERROR, "Failed to enqueue the write.\n");
202 msgb_free(msg);
203 return -1;
204 }
205
206 return 0;
207}
208
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100209static int forward_sccp_to_bts(struct msgb *msg)
Holger Hans Peter Freyther6ace5222010-01-12 21:15:08 +0100210{
Holger Hans Peter Freyther49c7fb52010-06-15 18:48:55 +0800211 struct sccp_connections *con;
212 struct bsc_connection *bsc;
Holger Hans Peter Freyther0b8f69d2010-06-15 18:45:38 +0800213 struct bsc_nat_parsed *parsed;
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100214
Holger Hans Peter Freyther6ace5222010-01-12 21:15:08 +0100215 /* filter, drop, patch the message? */
Holger Hans Peter Freyther0b8f69d2010-06-15 18:45:38 +0800216 parsed = bsc_nat_parse(msg);
217 if (!parsed) {
218 LOGP(DNAT, LOGL_ERROR, "Can not parse msg from BSC.\n");
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100219 return -1;
Holger Hans Peter Freyther0b8f69d2010-06-15 18:45:38 +0800220 }
221
Holger Hans Peter Freyther1d6fb182010-01-30 11:53:30 +0100222 if (bsc_nat_filter_ipa(DIR_BSC, msg, parsed))
Holger Hans Peter Freyther0b8f69d2010-06-15 18:45:38 +0800223 goto exit;
Holger Hans Peter Freyther6a97b8d2010-06-15 18:45:26 +0800224
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100225 /* Route and modify the SCCP packet */
226 if (parsed->ipa_proto == IPAC_PROTO_SCCP) {
227 switch (parsed->sccp_type) {
228 case SCCP_MSG_TYPE_UDT:
229 /* forward UDT messages to every BSC */
230 goto send_to_all;
231 break;
232 case SCCP_MSG_TYPE_RLSD:
233 case SCCP_MSG_TYPE_CREF:
234 case SCCP_MSG_TYPE_DT1:
Holger Hans Peter Freyther49c7fb52010-06-15 18:48:55 +0800235 con = patch_sccp_src_ref_to_bsc(msg, parsed, nat);
Holger Hans Peter Freyther465313e2010-06-15 18:49:53 +0800236 if (parsed->gsm_type == BSS_MAP_MSG_ASSIGMENT_RQST) {
237 if (con) {
238 if (bsc_mgcp_assign(con, msg) != 0)
239 LOGP(DNAT, LOGL_ERROR, "Failed to assign...\n");
240 } else
241 LOGP(DNAT, LOGL_ERROR, "Assignment command but no BSC.\n");
242 }
Holger Hans Peter Freyther16a6f702010-03-29 17:18:42 +0200243 break;
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100244 case SCCP_MSG_TYPE_CC:
Holger Hans Peter Freyther49c7fb52010-06-15 18:48:55 +0800245 con = patch_sccp_src_ref_to_bsc(msg, parsed, nat);
246 if (!con || update_sccp_src_ref(con, parsed) != 0)
Holger Hans Peter Freyther16a6f702010-03-29 17:18:42 +0200247 goto exit;
Holger Hans Peter Freyther0ab6bab2010-06-15 18:47:49 +0800248 break;
249 case SCCP_MSG_TYPE_RLC:
250 LOGP(DNAT, LOGL_ERROR, "Unexpected release complete from MSC.\n");
251 goto exit;
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100252 break;
253 case SCCP_MSG_TYPE_CR:
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100254 /* MSC never opens a SCCP connection, fall through */
255 default:
256 goto exit;
257 }
258 }
259
260 talloc_free(parsed);
Holger Hans Peter Freyther49c7fb52010-06-15 18:48:55 +0800261 if (!con)
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100262 return -1;
Holger Hans Peter Freyther49c7fb52010-06-15 18:48:55 +0800263 if (!con->bsc->authenticated) {
Holger Hans Peter Freyther6c45f2e2010-06-15 19:06:18 +0800264 LOGP(DNAT, LOGL_ERROR, "Selected BSC not authenticated.\n");
Holger Hans Peter Freyther3f37b8f2010-02-08 23:24:32 +0100265 return -1;
266 }
267
Holger Hans Peter Freyther49c7fb52010-06-15 18:48:55 +0800268 bsc_write(con->bsc, msg->data, msg->len);
Holger Hans Peter Freyther3025e192010-03-26 09:18:02 +0100269 return 0;
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100270
271send_to_all:
Holger Hans Peter Freyther45d11812010-06-15 18:46:36 +0800272 /*
273 * Filter Paging from the network. We do not want to send a PAGING
274 * Command to every BSC in our network. We will analys the PAGING
275 * message and then send it to the authenticated messages...
276 */
277 if (parsed->ipa_proto == IPAC_PROTO_SCCP && parsed->gsm_type == BSS_MAP_MSG_PAGING) {
Holger Hans Peter Freytherbae9da42010-03-30 05:57:42 +0200278 bsc = bsc_nat_find_bsc(nat, msg);
279 if (bsc)
280 bsc_write(bsc, msg->data, msg->len);
281 else
282 LOGP(DNAT, LOGL_ERROR, "Could not determine BSC for paging.\n");
Holger Hans Peter Freyther45d11812010-06-15 18:46:36 +0800283
284 goto exit;
285 }
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100286 /* currently send this to every BSC connected */
Holger Hans Peter Freyther9a85ef32010-06-15 18:46:11 +0800287 llist_for_each_entry(bsc, &nat->bsc_connections, list_entry) {
Holger Hans Peter Freyther3f37b8f2010-02-08 23:24:32 +0100288 if (!bsc->authenticated)
289 continue;
290
Holger Hans Peter Freyther3025e192010-03-26 09:18:02 +0100291 bsc_write(bsc, msg->data, msg->len);
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100292 }
Holger Hans Peter Freyther0b8f69d2010-06-15 18:45:38 +0800293
294exit:
295 talloc_free(parsed);
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100296 return 0;
Holger Hans Peter Freyther6ace5222010-01-12 21:15:08 +0100297}
298
Holger Hans Peter Freytherbaf2abe2010-06-15 18:47:29 +0800299static void msc_connection_was_lost(struct bsc_msc_connection *con)
300{
Holger Hans Peter Freythercd895372010-03-29 08:04:09 +0200301 struct bsc_connection *bsc, *tmp;
302
303 LOGP(DMSC, LOGL_ERROR, "Closing all connections downstream.\n");
304 llist_for_each_entry_safe(bsc, tmp, &nat->bsc_connections, list_entry)
305 remove_bsc_connection(bsc);
306
Holger Hans Peter Freyther241e1302010-03-31 09:16:56 +0200307 bsc_mgcp_free_endpoints(nat);
Holger Hans Peter Freythercd895372010-03-29 08:04:09 +0200308 bsc_msc_schedule_connect(con);
Holger Hans Peter Freytherbaf2abe2010-06-15 18:47:29 +0800309}
310
Holger Hans Peter Freyther6f5fbfd2010-06-15 18:47:02 +0800311static int ipaccess_msc_read_cb(struct bsc_fd *bfd)
Holger Hans Peter Freyther6ace5222010-01-12 21:15:08 +0100312{
313 int error;
314 struct msgb *msg = ipaccess_read_msg(bfd, &error);
315 struct ipaccess_head *hh;
316
317 if (!msg) {
318 if (error == 0) {
Holger Hans Peter Freyther418f3942010-01-29 05:58:43 +0100319 LOGP(DNAT, LOGL_FATAL, "The connection the MSC was lost, exiting\n");
Holger Hans Peter Freytherbaf2abe2010-06-15 18:47:29 +0800320 bsc_msc_lost(msc_con);
321 return -1;
Holger Hans Peter Freyther6ace5222010-01-12 21:15:08 +0100322 }
323
Holger Hans Peter Freyther418f3942010-01-29 05:58:43 +0100324 LOGP(DNAT, LOGL_ERROR, "Failed to parse ip access message: %d\n", error);
Holger Hans Peter Freyther6ace5222010-01-12 21:15:08 +0100325 return -1;
326 }
327
Holger Hans Peter Freyther418f3942010-01-29 05:58:43 +0100328 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 +0100329
330 /* handle base message handling */
331 hh = (struct ipaccess_head *) msg->data;
332 ipaccess_rcvmsg_base(msg, bfd);
333
334 /* initialize the networking. This includes sending a GSM08.08 message */
335 if (hh->proto == IPAC_PROTO_IPACCESS && msg->l2h[0] == IPAC_MSGT_ID_ACK)
336 initialize_msc_if_needed();
337 else if (hh->proto == IPAC_PROTO_SCCP)
338 forward_sccp_to_bts(msg);
339
Holger Hans Peter Freytheraad68b52010-06-15 18:46:48 +0800340 msgb_free(msg);
Holger Hans Peter Freyther6ace5222010-01-12 21:15:08 +0100341 return 0;
342}
Holger Hans Peter Freyther9e2c5f52010-06-15 18:44:42 +0800343
Holger Hans Peter Freyther6f5fbfd2010-06-15 18:47:02 +0800344static int ipaccess_msc_write_cb(struct bsc_fd *bfd, struct msgb *msg)
345{
346 int rc;
347 rc = write(bfd->fd, msg->data, msg->len);
348
349 if (rc != msg->len) {
350 LOGP(DNAT, LOGL_ERROR, "Failed to write MSG to MSC.\n");
351 return -1;
352 }
353
354 return rc;
355}
356
Holger Hans Peter Freyther49d80682010-01-12 21:34:54 +0100357/*
358 * Below is the handling of messages coming
359 * from the BSC and need to be forwarded to
360 * a real BSC.
361 */
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100362
363/*
364 * Remove the connection from the connections list,
365 * remove it from the patching of SCCP header lists
366 * as well. Maybe in the future even close connection..
367 */
368static void remove_bsc_connection(struct bsc_connection *connection)
369{
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100370 struct sccp_connections *sccp_patch, *tmp;
Holger Hans Peter Freythered07a3f2010-06-15 18:47:10 +0800371 bsc_unregister_fd(&connection->write_queue.bfd);
372 close(connection->write_queue.bfd.fd);
Holger Hans Peter Freytherf38e8792010-03-26 09:27:08 +0100373 write_queue_clear(&connection->write_queue);
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100374 llist_del(&connection->list_entry);
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100375
Holger Hans Peter Freytheraa698242010-06-15 18:46:19 +0800376 /* stop the timeout timer */
377 bsc_del_timer(&connection->id_timeout);
378
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100379 /* remove all SCCP connections */
Holger Hans Peter Freyther9a85ef32010-06-15 18:46:11 +0800380 llist_for_each_entry_safe(sccp_patch, tmp, &nat->sccp_connections, list_entry) {
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100381 if (sccp_patch->bsc != connection)
382 continue;
383
Holger Hans Peter Freyther7c99d4f2010-03-26 09:28:40 +0100384#warning "TODO: Send a RLSD to the MSC. Or at least a clear command."
Holger Hans Peter Freyther23fe7be2010-03-30 10:45:48 +0200385 sccp_connection_destroy(sccp_patch);
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100386 }
387
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100388 talloc_free(connection);
389}
390
Holger Hans Peter Freytheraa698242010-06-15 18:46:19 +0800391static void ipaccess_close_bsc(void *data)
392{
393 struct bsc_connection *conn = data;
394
395 LOGP(DNAT, LOGL_ERROR, "BSC didn't respond to identity request. Closing.\n");
396 remove_bsc_connection(conn);
397}
398
399static void ipaccess_auth_bsc(struct tlv_parsed *tvp, struct bsc_connection *bsc)
400{
401 struct bsc_config *conf;
402 const char* token = (const char *) TLVP_VAL(tvp, IPAC_IDTAG_UNITNAME);
403
404 llist_for_each_entry(conf, &bsc->nat->bsc_configs, entry) {
405 if (strcmp(conf->token, token) == 0) {
406 bsc->authenticated = 1;
407 bsc->lac = conf->lac;
408 bsc_del_timer(&bsc->id_timeout);
409 break;
410 }
411 }
412}
413
Holger Hans Peter Freyther747d6542010-03-26 07:24:34 +0100414static int forward_sccp_to_msc(struct bsc_connection *bsc, struct msgb *msg)
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100415{
Holger Hans Peter Freyther49c7fb52010-06-15 18:48:55 +0800416 struct sccp_connections *con;
Holger Hans Peter Freyther0b8f69d2010-06-15 18:45:38 +0800417 struct bsc_nat_parsed *parsed;
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100418
Holger Hans Peter Freytherd7657ff2010-03-30 07:35:46 +0200419 if (!bsc->authenticated) {
420 LOGP(DNAT, LOGL_ERROR, "BSC is not authenticated.\n");
421 msgb_free(msg);
422 return -1;
423 }
424
Holger Hans Peter Freyther0b8f69d2010-06-15 18:45:38 +0800425 /* Parse and filter messages */
426 parsed = bsc_nat_parse(msg);
427 if (!parsed) {
428 LOGP(DNAT, LOGL_ERROR, "Can not parse msg from BSC.\n");
Holger Hans Peter Freytherd7657ff2010-03-30 07:35:46 +0200429 msgb_free(msg);
Holger Hans Peter Freyther0b8f69d2010-06-15 18:45:38 +0800430 return -1;
431 }
432
Holger Hans Peter Freyther1d6fb182010-01-30 11:53:30 +0100433 if (bsc_nat_filter_ipa(DIR_MSC, msg, parsed))
Holger Hans Peter Freyther0b8f69d2010-06-15 18:45:38 +0800434 goto exit;
Holger Hans Peter Freyther6a97b8d2010-06-15 18:45:26 +0800435
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100436 /* modify the SCCP entries */
437 if (parsed->ipa_proto == IPAC_PROTO_SCCP) {
438 switch (parsed->sccp_type) {
439 case SCCP_MSG_TYPE_CR:
440 if (create_sccp_src_ref(bsc, msg, parsed) != 0)
441 goto exit2;
Holger Hans Peter Freyther49c7fb52010-06-15 18:48:55 +0800442 con = patch_sccp_src_ref_to_msc(msg, parsed, nat);
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100443 break;
444 case SCCP_MSG_TYPE_RLSD:
445 case SCCP_MSG_TYPE_CREF:
446 case SCCP_MSG_TYPE_DT1:
447 case SCCP_MSG_TYPE_CC:
Holger Hans Peter Freyther49c7fb52010-06-15 18:48:55 +0800448 con = patch_sccp_src_ref_to_msc(msg, parsed, nat);
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100449 break;
450 case SCCP_MSG_TYPE_RLC:
Holger Hans Peter Freyther49c7fb52010-06-15 18:48:55 +0800451 con = patch_sccp_src_ref_to_msc(msg, parsed, nat);
Holger Hans Peter Freytherf4cfc4f2010-03-31 09:15:05 +0200452 remove_sccp_src_ref(bsc, msg, parsed);
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100453 break;
454 case SCCP_MSG_TYPE_UDT:
455 /* simply forward everything */
Holger Hans Peter Freyther49c7fb52010-06-15 18:48:55 +0800456 con = NULL;
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100457 break;
458 default:
Holger Hans Peter Freyther0ab6bab2010-06-15 18:47:49 +0800459 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 +0800460 con = NULL;
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100461 goto exit2;
462 break;
463 }
Holger Hans Peter Freyther49c7fb52010-06-15 18:48:55 +0800464 } else {
465 LOGP(DNAT, LOGL_ERROR, "Not forwarding unknown stream id: 0x%x\n", parsed->ipa_proto);
466 goto exit2;
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100467 }
468
Holger Hans Peter Freyther49c7fb52010-06-15 18:48:55 +0800469 if (con && con->bsc != bsc) {
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100470 LOGP(DNAT, LOGL_ERROR, "Found the wrong entry.\n");
471 goto exit2;
472 }
473
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100474 /* send the non-filtered but maybe modified msg */
Holger Hans Peter Freytherbaf2abe2010-06-15 18:47:29 +0800475 if (write_queue_enqueue(&msc_con->write_queue, msg) != 0) {
Holger Hans Peter Freyther6f5fbfd2010-06-15 18:47:02 +0800476 LOGP(DNAT, LOGL_ERROR, "Can not queue message for the MSC.\n");
477 msgb_free(msg);
478 }
Holger Hans Peter Freyther38a77d02010-01-30 12:45:10 +0100479 talloc_free(parsed);
Holger Hans Peter Freyther6f5fbfd2010-06-15 18:47:02 +0800480 return 0;
Holger Hans Peter Freyther0b8f69d2010-06-15 18:45:38 +0800481
482exit:
Holger Hans Peter Freyther38a77d02010-01-30 12:45:10 +0100483 /* if we filter out the reset send an ack to the BSC */
484 if (parsed->bssap == 0 && parsed->gsm_type == BSS_MAP_MSG_RESET) {
Holger Hans Peter Freyther747d6542010-03-26 07:24:34 +0100485 send_reset_ack(bsc);
486 send_reset_ack(bsc);
Holger Hans Peter Freytheraa698242010-06-15 18:46:19 +0800487 } else if (parsed->ipa_proto == IPAC_PROTO_IPACCESS) {
488 /* do we know who is handling this? */
489 if (msg->l2h[0] == IPAC_MSGT_ID_RESP) {
490 struct tlv_parsed tvp;
491 ipaccess_idtag_parse(&tvp,
492 (unsigned char *) msg->l2h + 2,
493 msgb_l2len(msg) - 2);
494 if (TLVP_PRESENT(&tvp, IPAC_IDTAG_UNITNAME))
495 ipaccess_auth_bsc(&tvp, bsc);
496 }
497
498 goto exit2;
Holger Hans Peter Freyther38a77d02010-01-30 12:45:10 +0100499 }
500
Holger Hans Peter Freyther058eeb72010-01-31 09:46:21 +0100501exit2:
Holger Hans Peter Freyther0b8f69d2010-06-15 18:45:38 +0800502 talloc_free(parsed);
Holger Hans Peter Freyther6f5fbfd2010-06-15 18:47:02 +0800503 msgb_free(msg);
504 return -1;
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100505}
506
Holger Hans Peter Freythered07a3f2010-06-15 18:47:10 +0800507static int ipaccess_bsc_read_cb(struct bsc_fd *bfd)
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100508{
509 int error;
Holger Hans Peter Freyther747d6542010-03-26 07:24:34 +0100510 struct bsc_connection *bsc = bfd->data;
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100511 struct msgb *msg = ipaccess_read_msg(bfd, &error);
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100512
513 if (!msg) {
514 if (error == 0) {
Holger Hans Peter Freyther418f3942010-01-29 05:58:43 +0100515 LOGP(DNAT, LOGL_ERROR, "The connection to the BSC was lost. Cleaning it\n");
Holger Hans Peter Freyther747d6542010-03-26 07:24:34 +0100516 remove_bsc_connection(bsc);
Holger Hans Peter Freyther418f3942010-01-29 05:58:43 +0100517 } else {
518 LOGP(DNAT, LOGL_ERROR, "Failed to parse ip access message: %d\n", error);
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100519 }
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100520 return -1;
521 }
522
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100523
Holger Hans Peter Freyther418f3942010-01-29 05:58:43 +0100524 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 +0100525
526 /* Handle messages from the BSC */
527 /* FIXME: Currently no PONG is sent to the BSC */
528 /* FIXME: Currently no ID ACK is sent to the BSC */
Holger Hans Peter Freyther747d6542010-03-26 07:24:34 +0100529 forward_sccp_to_msc(bsc, msg);
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100530
531 return 0;
532}
533
Holger Hans Peter Freyther3025e192010-03-26 09:18:02 +0100534static int ipaccess_bsc_write_cb(struct bsc_fd *bfd, struct msgb *msg)
535{
536 int rc;
537
538 rc = write(bfd->fd, msg->data, msg->len);
539 if (rc != msg->len)
540 LOGP(DNAT, LOGL_ERROR, "Failed to write message to the BSC.\n");
541
542 return rc;
543}
544
Holger Hans Peter Freyther49d80682010-01-12 21:34:54 +0100545static int ipaccess_listen_bsc_cb(struct bsc_fd *bfd, unsigned int what)
546{
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100547 struct bsc_connection *bsc;
Holger Hans Peter Freyther49d80682010-01-12 21:34:54 +0100548 int ret;
549 struct sockaddr_in sa;
550 socklen_t sa_len = sizeof(sa);
551
552 if (!(what & BSC_FD_READ))
553 return 0;
554
555 ret = accept(bfd->fd, (struct sockaddr *) &sa, &sa_len);
556 if (ret < 0) {
557 perror("accept");
558 return ret;
559 }
560
Holger Hans Peter Freythercd895372010-03-29 08:04:09 +0200561 /*
562 * if we are not connected to a msc... just close the socket
563 */
564 if (!msc_con->is_connected) {
565 LOGP(DNAT, LOGL_NOTICE, "Disconnecting BSC due lack of MSC connection.\n");
566 return 0;
567 }
568
Holger Hans Peter Freyther49d80682010-01-12 21:34:54 +0100569 /* todo... do something with the connection */
Holger Hans Peter Freytherda86c0a2010-01-12 21:35:32 +0100570 /* todo... use GNUtls to see if we want to trust this as a BTS */
Holger Hans Peter Freyther49d80682010-01-12 21:34:54 +0100571
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100572 /*
573 *
574 */
Holger Hans Peter Freytherdcf8a7d2010-06-15 18:48:01 +0800575 bsc = bsc_connection_alloc(nat);
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100576 if (!bsc) {
Holger Hans Peter Freyther418f3942010-01-29 05:58:43 +0100577 LOGP(DNAT, LOGL_ERROR, "Failed to allocate BSC struct.\n");
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100578 close(ret);
579 return -1;
580 }
581
Holger Hans Peter Freythered07a3f2010-06-15 18:47:10 +0800582 write_queue_init(&bsc->write_queue, 100);
583 bsc->write_queue.bfd.data = bsc;
584 bsc->write_queue.bfd.fd = ret;
585 bsc->write_queue.read_cb = ipaccess_bsc_read_cb;
Holger Hans Peter Freyther3025e192010-03-26 09:18:02 +0100586 bsc->write_queue.write_cb = ipaccess_bsc_write_cb;
Holger Hans Peter Freythered07a3f2010-06-15 18:47:10 +0800587 bsc->write_queue.bfd.when = BSC_FD_READ;
588 if (bsc_register_fd(&bsc->write_queue.bfd) < 0) {
Holger Hans Peter Freyther418f3942010-01-29 05:58:43 +0100589 LOGP(DNAT, LOGL_ERROR, "Failed to register BSC fd.\n");
Holger Hans Peter Freyther24614ad2010-01-13 09:28:12 +0100590 close(ret);
591 talloc_free(bsc);
592 return -2;
593 }
594
Holger Hans Peter Freyther418f3942010-01-29 05:58:43 +0100595 LOGP(DNAT, LOGL_INFO, "Registered new BSC\n");
Holger Hans Peter Freyther9a85ef32010-06-15 18:46:11 +0800596 llist_add(&bsc->list_entry, &nat->bsc_connections);
Holger Hans Peter Freytherdb7ba7d2010-03-26 07:41:54 +0100597 send_id_ack(bsc);
598 send_id_req(bsc);
Holger Hans Peter Freytherd131b792010-03-31 07:30:58 +0200599 send_mgcp_reset(bsc);
Holger Hans Peter Freytheraa698242010-06-15 18:46:19 +0800600
601 /*
602 * start the hangup timer
603 */
604 bsc->id_timeout.data = bsc;
605 bsc->id_timeout.cb = ipaccess_close_bsc;
606 bsc_schedule_timer(&bsc->id_timeout, 2, 0);
Holger Hans Peter Freyther49d80682010-01-12 21:34:54 +0100607 return 0;
608}
609
610static int listen_for_bsc(struct bsc_fd *bfd, struct in_addr *in_addr, int port)
611{
612 struct sockaddr_in addr;
613 int ret, on = 1;
614
615 bfd->fd = socket(AF_INET, SOCK_STREAM, IPPROTO_TCP);
616 bfd->cb = ipaccess_listen_bsc_cb;
617 bfd->when = BSC_FD_READ;
618
619 memset(&addr, 0, sizeof(addr));
620 addr.sin_family = AF_INET;
621 addr.sin_port = htons(port);
622 addr.sin_addr.s_addr = in_addr->s_addr;
623
624 setsockopt(bfd->fd, SOL_SOCKET, SO_REUSEADDR, &on, sizeof(on));
625
626 ret = bind(bfd->fd, (struct sockaddr *) &addr, sizeof(addr));
627 if (ret < 0) {
628 fprintf(stderr, "Could not bind the BSC socket %s\n",
629 strerror(errno));
630 return -EIO;
631 }
632
633 ret = listen(bfd->fd, 1);
634 if (ret < 0) {
635 perror("listen");
636 return ret;
637 }
638
639 ret = bsc_register_fd(bfd);
640 if (ret < 0) {
641 perror("register_listen_fd");
642 return ret;
643 }
644 return 0;
645}
646
Holger Hans Peter Freyther9e2c5f52010-06-15 18:44:42 +0800647static void print_usage()
648{
649 printf("Usage: bsc_nat\n");
650}
651
652static void print_help()
653{
654 printf(" Some useful help...\n");
655 printf(" -h --help this text\n");
656 printf(" -d option --debug=DRLL:DCC:DMM:DRR:DRSL:DNM enable debugging\n");
657 printf(" -s --disable-color\n");
658 printf(" -c --config-file filename The config file to use.\n");
659 printf(" -m --msc=IP. The address of the MSC.\n");
Holger Hans Peter Freyther49d80682010-01-12 21:34:54 +0100660 printf(" -l --local=IP. The local address of this BSC.\n");
Holger Hans Peter Freyther9e2c5f52010-06-15 18:44:42 +0800661}
662
663static void handle_options(int argc, char** argv)
664{
665 while (1) {
666 int option_index = 0, c;
667 static struct option long_options[] = {
668 {"help", 0, 0, 'h'},
669 {"debug", 1, 0, 'd'},
670 {"config-file", 1, 0, 'c'},
671 {"disable-color", 0, 0, 's'},
672 {"timestamp", 0, 0, 'T'},
673 {"msc", 1, 0, 'm'},
674 {"local", 1, 0, 'l'},
675 {0, 0, 0, 0}
676 };
677
678 c = getopt_long(argc, argv, "hd:sTPc:m:l:",
679 long_options, &option_index);
680 if (c == -1)
681 break;
682
683 switch (c) {
684 case 'h':
685 print_usage();
686 print_help();
687 exit(0);
688 case 's':
Holger Hans Peter Freyther6c45f2e2010-06-15 19:06:18 +0800689 debug_set_use_color(stderr_target, 0);
Holger Hans Peter Freyther9e2c5f52010-06-15 18:44:42 +0800690 break;
691 case 'd':
Holger Hans Peter Freyther6c45f2e2010-06-15 19:06:18 +0800692 debug_parse_category_mask(stderr_target, optarg);
Holger Hans Peter Freyther9e2c5f52010-06-15 18:44:42 +0800693 break;
694 case 'c':
695 config_file = strdup(optarg);
696 break;
697 case 'T':
Holger Hans Peter Freyther6c45f2e2010-06-15 19:06:18 +0800698 debug_set_print_timestamp(stderr_target, 1);
Holger Hans Peter Freyther9e2c5f52010-06-15 18:44:42 +0800699 break;
700 case 'm':
701 msc_address = strdup(optarg);
702 break;
703 case 'l':
704 inet_aton(optarg, &local_addr);
705 break;
706 default:
707 /* ignore */
708 break;
709 }
710 }
711}
712
Holger Hans Peter Freyther6ace5222010-01-12 21:15:08 +0100713static void signal_handler(int signal)
714{
Holger Hans Peter Freyther6ace5222010-01-12 21:15:08 +0100715 switch (signal) {
716 case SIGABRT:
717 /* in case of abort, we want to obtain a talloc report
718 * and then return to the caller, who will abort the process */
719 case SIGUSR1:
720 talloc_report_full(tall_bsc_ctx, stderr);
721 break;
722 default:
723 break;
724 }
725}
726
Holger Hans Peter Freyther9e2c5f52010-06-15 18:44:42 +0800727int main(int argc, char** argv)
728{
Holger Hans Peter Freyther6ace5222010-01-12 21:15:08 +0100729
Holger Hans Peter Freyther6c45f2e2010-06-15 19:06:18 +0800730 debug_init();
731 stderr_target = debug_target_create_stderr();
732 debug_add_target(stderr_target);
733 debug_set_all_filter(stderr_target, 1);
734
Holger Hans Peter Freyther9e2c5f52010-06-15 18:44:42 +0800735 /* parse options */
Holger Hans Peter Freyther49d80682010-01-12 21:34:54 +0100736 local_addr.s_addr = INADDR_ANY;
Holger Hans Peter Freyther9e2c5f52010-06-15 18:44:42 +0800737 handle_options(argc, argv);
738
Holger Hans Peter Freyther9a85ef32010-06-15 18:46:11 +0800739 nat = bsc_nat_alloc();
740 if (!nat) {
741 fprintf(stderr, "Failed to allocate the BSC nat.\n");
742 return -4;
743 }
744
Holger Hans Peter Freytherf7d33352010-06-15 18:50:26 +0800745 nat->mgcp_cfg = talloc_zero(nat, struct mgcp_config);
746
Holger Hans Peter Freyther9a85ef32010-06-15 18:46:11 +0800747 /* init vty and parse */
748 bsc_nat_vty_init(nat);
749 telnet_init(NULL, 4244);
Holger Hans Peter Freytherf7d33352010-06-15 18:50:26 +0800750 if (mgcp_parse_config(config_file, nat->mgcp_cfg) < 0) {
Holger Hans Peter Freyther9a85ef32010-06-15 18:46:11 +0800751 fprintf(stderr, "Failed to parse the config file: '%s'\n", config_file);
752 return -3;
753 }
754
Holger Hans Peter Freyther9e2c5f52010-06-15 18:44:42 +0800755 /* seed the PRNG */
756 srand(time(NULL));
757
Holger Hans Peter Freythera7f80182010-03-31 13:02:22 +0200758 /*
759 * Setup the MGCP code..
760 */
761 if (bsc_mgcp_init(nat) != 0)
762 return -4;
763
Holger Hans Peter Freyther49d80682010-01-12 21:34:54 +0100764 /* connect to the MSC */
Holger Hans Peter Freytherbaf2abe2010-06-15 18:47:29 +0800765 msc_con = bsc_msc_create(msc_address, 5000);
766 if (!msc_con) {
767 fprintf(stderr, "Creating a bsc_msc_connection failed.\n");
Holger Hans Peter Freyther6ace5222010-01-12 21:15:08 +0100768 exit(1);
769 }
770
Holger Hans Peter Freytherbaf2abe2010-06-15 18:47:29 +0800771 msc_con->connection_loss = msc_connection_was_lost;
772 msc_con->write_queue.read_cb = ipaccess_msc_read_cb;
773 msc_con->write_queue.write_cb = ipaccess_msc_write_cb;;
774 bsc_msc_connect(msc_con);
775
Holger Hans Peter Freyther49d80682010-01-12 21:34:54 +0100776 /* wait for the BSC */
Holger Hans Peter Freyther2d677c62010-03-26 06:51:04 +0100777 if (listen_for_bsc(&bsc_listen, &local_addr, 5000) < 0) {
Holger Hans Peter Freyther49d80682010-01-12 21:34:54 +0100778 fprintf(stderr, "Failed to listen for BSC.\n");
779 exit(1);
780 }
781
Holger Hans Peter Freyther6ace5222010-01-12 21:15:08 +0100782 signal(SIGABRT, &signal_handler);
783 signal(SIGUSR1, &signal_handler);
784 signal(SIGPIPE, SIG_IGN);
785
786 while (1) {
787 bsc_select_main(0);
788 }
789
Holger Hans Peter Freyther9e2c5f52010-06-15 18:44:42 +0800790 return 0;
791}