blob: b3754da431f66aa5eb7622c5352f318d2925cfa9 [file] [log] [blame]
Holger Hans Peter Freyther89d9fd92010-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 Freyther98e49d42010-06-15 18:46:56 +08005 * (C) 2010 by On-Waves
Holger Hans Peter Freythere8fa0f12010-01-12 21:34:54 +01006 * (C) 2009 by Harald Welte <laforge@gnumonks.org>
Holger Hans Peter Freyther89d9fd92010-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 Freythere8fa0f12010-01-12 21:34:54 +010028#include <errno.h>
Holger Hans Peter Freythere907cb22010-01-12 21:15:08 +010029#include <signal.h>
Holger Hans Peter Freyther89d9fd92010-06-15 18:44:42 +080030#include <stdio.h>
31#include <stdlib.h>
Holger Hans Peter Freytherfd012d52010-01-12 21:36:08 +010032#include <time.h>
Holger Hans Peter Freyther89d9fd92010-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 Freythere907cb22010-01-12 21:15:08 +010039#include <openbsc/bsc_msc.h>
Holger Hans Peter Freyther57adba52010-06-15 18:45:26 +080040#include <openbsc/bsc_nat.h>
Holger Hans Peter Freyther722ead82010-01-30 12:45:10 +010041#include <openbsc/bssap.h>
Holger Hans Peter Freythere907cb22010-01-12 21:15:08 +010042#include <openbsc/ipaccess.h>
43#include <openbsc/abis_nm.h>
Holger Hans Peter Freyther5e547882010-06-15 18:46:11 +080044#include <openbsc/telnet_interface.h>
45
Holger Hans Peter Freyther3b960892010-06-15 19:06:18 +080046#include <osmocore/talloc.h>
47
Holger Hans Peter Freyther5e547882010-06-15 18:46:11 +080048#include <vty/vty.h>
Holger Hans Peter Freyther89d9fd92010-06-15 18:44:42 +080049
Holger Hans Peter Freyther57adba52010-06-15 18:45:26 +080050#include <sccp/sccp.h>
51
Holger Hans Peter Freyther3b960892010-06-15 19:06:18 +080052struct debug_target *stderr_target;
Holger Hans Peter Freyther5e547882010-06-15 18:46:11 +080053static const char *config_file = "bsc-nat.cfg";
Holger Hans Peter Freyther89d9fd92010-06-15 18:44:42 +080054static char *msc_address = "127.0.0.1";
55static struct in_addr local_addr;
Holger Hans Peter Freyther4a860a02010-06-15 18:47:29 +080056static struct bsc_msc_connection *msc_con;
Holger Hans Peter Freytherbea0ac62010-03-26 06:51:04 +010057static struct bsc_fd bsc_listen;
Holger Hans Peter Freythere907cb22010-01-12 21:15:08 +010058
Holger Hans Peter Freyther4a629602010-01-13 09:28:12 +010059
Holger Hans Peter Freyther5e547882010-06-15 18:46:11 +080060static struct bsc_nat *nat;
Holger Hans Peter Freyther2ec55172010-03-26 09:18:02 +010061static void bsc_write(struct bsc_connection *bsc, const u_int8_t *data, unsigned int length);
Holger Hans Peter Freyther3399df32010-03-29 08:04:09 +020062static void remove_bsc_connection(struct bsc_connection *connection);
Holger Hans Peter Freyther5e547882010-06-15 18:46:11 +080063
Holger Hans Peter Freyther5e547882010-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 Freyther4a629602010-01-13 09:28:12 +010074
Holger Hans Peter Freythere907cb22010-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 Freyther2ec55172010-03-26 09:18:02 +010092static void send_reset_ack(struct bsc_connection *bsc)
Holger Hans Peter Freyther722ead82010-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 Freyther2ec55172010-03-26 09:18:02 +0100101 bsc_write(bsc, gsm_reset_ack, sizeof(gsm_reset_ack));
Holger Hans Peter Freyther722ead82010-01-30 12:45:10 +0100102}
103
Holger Hans Peter Freyther2ec55172010-03-26 09:18:02 +0100104static void send_id_ack(struct bsc_connection *bsc)
Holger Hans Peter Freyther809d6fa2010-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 Freyther2ec55172010-03-26 09:18:02 +0100110 bsc_write(bsc, id_ack, sizeof(id_ack));
Holger Hans Peter Freyther809d6fa2010-03-26 07:41:54 +0100111}
112
Holger Hans Peter Freyther2ec55172010-03-26 09:18:02 +0100113static void send_id_req(struct bsc_connection *bsc)
Holger Hans Peter Freyther809d6fa2010-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 Freyther2ec55172010-03-26 09:18:02 +0100127 bsc_write(bsc, id_req, sizeof(id_req));
Holger Hans Peter Freyther809d6fa2010-03-26 07:41:54 +0100128}
129
Holger Hans Peter Freyther8c61cdb2010-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 Freythere907cb22010-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 Freyther2ec55172010-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 Freytherad2136b2010-03-26 07:20:59 +0100156{
Holger Hans Peter Freyther2ec55172010-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 Freytherad2136b2010-03-26 07:20:59 +0100176}
177
Holger Hans Peter Freyther8c61cdb2010-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 Freythere83917d2010-01-31 09:46:21 +0100209static int forward_sccp_to_bts(struct msgb *msg)
Holger Hans Peter Freythere907cb22010-01-12 21:15:08 +0100210{
Holger Hans Peter Freyther75ee8412010-06-15 18:48:55 +0800211 struct sccp_connections *con;
212 struct bsc_connection *bsc;
Holger Hans Peter Freytherf75a6802010-06-15 18:45:38 +0800213 struct bsc_nat_parsed *parsed;
Holger Hans Peter Freyther4a629602010-01-13 09:28:12 +0100214
Holger Hans Peter Freythere907cb22010-01-12 21:15:08 +0100215 /* filter, drop, patch the message? */
Holger Hans Peter Freytherf75a6802010-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 Freythere83917d2010-01-31 09:46:21 +0100219 return -1;
Holger Hans Peter Freytherf75a6802010-06-15 18:45:38 +0800220 }
221
Holger Hans Peter Freytherbbf6b652010-01-30 11:53:30 +0100222 if (bsc_nat_filter_ipa(DIR_BSC, msg, parsed))
Holger Hans Peter Freytherf75a6802010-06-15 18:45:38 +0800223 goto exit;
Holger Hans Peter Freyther57adba52010-06-15 18:45:26 +0800224
Holger Hans Peter Freythere83917d2010-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 Freyther75ee8412010-06-15 18:48:55 +0800235 con = patch_sccp_src_ref_to_bsc(msg, parsed, nat);
Holger Hans Peter Freytherdccb9152010-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 Freythera25e3ec2010-03-29 17:18:42 +0200243 break;
Holger Hans Peter Freythere83917d2010-01-31 09:46:21 +0100244 case SCCP_MSG_TYPE_CC:
Holger Hans Peter Freyther75ee8412010-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 Freythera25e3ec2010-03-29 17:18:42 +0200247 goto exit;
Holger Hans Peter Freyther2f1f55d2010-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 Freythere83917d2010-01-31 09:46:21 +0100252 break;
253 case SCCP_MSG_TYPE_CR:
Holger Hans Peter Freythere83917d2010-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 Freyther75ee8412010-06-15 18:48:55 +0800261 if (!con)
Holger Hans Peter Freythere83917d2010-01-31 09:46:21 +0100262 return -1;
Holger Hans Peter Freyther75ee8412010-06-15 18:48:55 +0800263 if (!con->bsc->authenticated) {
Holger Hans Peter Freyther3b960892010-06-15 19:06:18 +0800264 LOGP(DNAT, LOGL_ERROR, "Selected BSC not authenticated.\n");
Holger Hans Peter Freytherfb5a4872010-02-08 23:24:32 +0100265 return -1;
266 }
267
Holger Hans Peter Freyther75ee8412010-06-15 18:48:55 +0800268 bsc_write(con->bsc, msg->data, msg->len);
Holger Hans Peter Freyther2ec55172010-03-26 09:18:02 +0100269 return 0;
Holger Hans Peter Freythere83917d2010-01-31 09:46:21 +0100270
271send_to_all:
Holger Hans Peter Freytherfd2c7572010-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 Freyther21c4d9e2010-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 Freytherfd2c7572010-06-15 18:46:36 +0800283
284 goto exit;
285 }
Holger Hans Peter Freyther4a629602010-01-13 09:28:12 +0100286 /* currently send this to every BSC connected */
Holger Hans Peter Freyther5e547882010-06-15 18:46:11 +0800287 llist_for_each_entry(bsc, &nat->bsc_connections, list_entry) {
Holger Hans Peter Freytherfb5a4872010-02-08 23:24:32 +0100288 if (!bsc->authenticated)
289 continue;
290
Holger Hans Peter Freyther2ec55172010-03-26 09:18:02 +0100291 bsc_write(bsc, msg->data, msg->len);
Holger Hans Peter Freyther4a629602010-01-13 09:28:12 +0100292 }
Holger Hans Peter Freytherf75a6802010-06-15 18:45:38 +0800293
294exit:
295 talloc_free(parsed);
Holger Hans Peter Freythere83917d2010-01-31 09:46:21 +0100296 return 0;
Holger Hans Peter Freythere907cb22010-01-12 21:15:08 +0100297}
298
Holger Hans Peter Freyther4a860a02010-06-15 18:47:29 +0800299static void msc_connection_was_lost(struct bsc_msc_connection *con)
300{
Holger Hans Peter Freyther3399df32010-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
307 bsc_msc_schedule_connect(con);
Holger Hans Peter Freyther4a860a02010-06-15 18:47:29 +0800308}
309
Holger Hans Peter Freyther257a8cc2010-06-15 18:47:02 +0800310static int ipaccess_msc_read_cb(struct bsc_fd *bfd)
Holger Hans Peter Freythere907cb22010-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 Freyther8f99b822010-01-29 05:58:43 +0100318 LOGP(DNAT, LOGL_FATAL, "The connection the MSC was lost, exiting\n");
Holger Hans Peter Freyther4a860a02010-06-15 18:47:29 +0800319 bsc_msc_lost(msc_con);
320 return -1;
Holger Hans Peter Freythere907cb22010-01-12 21:15:08 +0100321 }
322
Holger Hans Peter Freyther8f99b822010-01-29 05:58:43 +0100323 LOGP(DNAT, LOGL_ERROR, "Failed to parse ip access message: %d\n", error);
Holger Hans Peter Freythere907cb22010-01-12 21:15:08 +0100324 return -1;
325 }
326
Holger Hans Peter Freyther8f99b822010-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 Freythere907cb22010-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 Freyther418fe112010-06-15 18:46:48 +0800339 msgb_free(msg);
Holger Hans Peter Freythere907cb22010-01-12 21:15:08 +0100340 return 0;
341}
Holger Hans Peter Freyther89d9fd92010-06-15 18:44:42 +0800342
Holger Hans Peter Freyther257a8cc2010-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 Freythere8fa0f12010-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 Freyther4a629602010-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 Freythere83917d2010-01-31 09:46:21 +0100369 struct sccp_connections *sccp_patch, *tmp;
Holger Hans Peter Freyther84010542010-06-15 18:47:10 +0800370 bsc_unregister_fd(&connection->write_queue.bfd);
371 close(connection->write_queue.bfd.fd);
Holger Hans Peter Freytherffcf79c2010-03-26 09:27:08 +0100372 write_queue_clear(&connection->write_queue);
Holger Hans Peter Freyther4a629602010-01-13 09:28:12 +0100373 llist_del(&connection->list_entry);
Holger Hans Peter Freythere83917d2010-01-31 09:46:21 +0100374
Holger Hans Peter Freytherde557662010-06-15 18:46:19 +0800375 /* stop the timeout timer */
376 bsc_del_timer(&connection->id_timeout);
377
Holger Hans Peter Freythere83917d2010-01-31 09:46:21 +0100378 /* remove all SCCP connections */
Holger Hans Peter Freyther5e547882010-06-15 18:46:11 +0800379 llist_for_each_entry_safe(sccp_patch, tmp, &nat->sccp_connections, list_entry) {
Holger Hans Peter Freythere83917d2010-01-31 09:46:21 +0100380 if (sccp_patch->bsc != connection)
381 continue;
382
Holger Hans Peter Freythera207db22010-03-26 09:28:40 +0100383#warning "TODO: Send a RLSD to the MSC. Or at least a clear command."
Holger Hans Peter Freyther8be49b32010-03-30 10:45:48 +0200384 sccp_connection_destroy(sccp_patch);
Holger Hans Peter Freythere83917d2010-01-31 09:46:21 +0100385 }
386
Holger Hans Peter Freyther4a629602010-01-13 09:28:12 +0100387 talloc_free(connection);
388}
389
Holger Hans Peter Freytherde557662010-06-15 18:46:19 +0800390static void ipaccess_close_bsc(void *data)
391{
392 struct bsc_connection *conn = data;
393
394 LOGP(DNAT, LOGL_ERROR, "BSC didn't respond to identity request. Closing.\n");
395 remove_bsc_connection(conn);
396}
397
398static void ipaccess_auth_bsc(struct tlv_parsed *tvp, struct bsc_connection *bsc)
399{
400 struct bsc_config *conf;
401 const char* token = (const char *) TLVP_VAL(tvp, IPAC_IDTAG_UNITNAME);
402
403 llist_for_each_entry(conf, &bsc->nat->bsc_configs, entry) {
404 if (strcmp(conf->token, token) == 0) {
405 bsc->authenticated = 1;
406 bsc->lac = conf->lac;
407 bsc_del_timer(&bsc->id_timeout);
408 break;
409 }
410 }
411}
412
Holger Hans Peter Freyther4ce32702010-03-26 07:24:34 +0100413static int forward_sccp_to_msc(struct bsc_connection *bsc, struct msgb *msg)
Holger Hans Peter Freyther4a629602010-01-13 09:28:12 +0100414{
Holger Hans Peter Freyther75ee8412010-06-15 18:48:55 +0800415 struct sccp_connections *con;
Holger Hans Peter Freytherf75a6802010-06-15 18:45:38 +0800416 struct bsc_nat_parsed *parsed;
Holger Hans Peter Freyther4a629602010-01-13 09:28:12 +0100417
Holger Hans Peter Freyther45f62952010-03-30 07:35:46 +0200418 if (!bsc->authenticated) {
419 LOGP(DNAT, LOGL_ERROR, "BSC is not authenticated.\n");
420 msgb_free(msg);
421 return -1;
422 }
423
Holger Hans Peter Freytherf75a6802010-06-15 18:45:38 +0800424 /* Parse and filter messages */
425 parsed = bsc_nat_parse(msg);
426 if (!parsed) {
427 LOGP(DNAT, LOGL_ERROR, "Can not parse msg from BSC.\n");
Holger Hans Peter Freyther45f62952010-03-30 07:35:46 +0200428 msgb_free(msg);
Holger Hans Peter Freytherf75a6802010-06-15 18:45:38 +0800429 return -1;
430 }
431
Holger Hans Peter Freytherbbf6b652010-01-30 11:53:30 +0100432 if (bsc_nat_filter_ipa(DIR_MSC, msg, parsed))
Holger Hans Peter Freytherf75a6802010-06-15 18:45:38 +0800433 goto exit;
Holger Hans Peter Freyther57adba52010-06-15 18:45:26 +0800434
Holger Hans Peter Freythere83917d2010-01-31 09:46:21 +0100435 /* modify the SCCP entries */
436 if (parsed->ipa_proto == IPAC_PROTO_SCCP) {
437 switch (parsed->sccp_type) {
438 case SCCP_MSG_TYPE_CR:
439 if (create_sccp_src_ref(bsc, msg, parsed) != 0)
440 goto exit2;
Holger Hans Peter Freyther75ee8412010-06-15 18:48:55 +0800441 con = patch_sccp_src_ref_to_msc(msg, parsed, nat);
Holger Hans Peter Freythere83917d2010-01-31 09:46:21 +0100442 break;
443 case SCCP_MSG_TYPE_RLSD:
444 case SCCP_MSG_TYPE_CREF:
445 case SCCP_MSG_TYPE_DT1:
446 case SCCP_MSG_TYPE_CC:
Holger Hans Peter Freyther75ee8412010-06-15 18:48:55 +0800447 con = patch_sccp_src_ref_to_msc(msg, parsed, nat);
Holger Hans Peter Freythere83917d2010-01-31 09:46:21 +0100448 break;
449 case SCCP_MSG_TYPE_RLC:
Holger Hans Peter Freyther75ee8412010-06-15 18:48:55 +0800450 con = patch_sccp_src_ref_to_msc(msg, parsed, nat);
Holger Hans Peter Freytherdccb9152010-06-15 18:49:53 +0800451 if (con) {
452 remove_sccp_src_ref(bsc, msg, parsed);
453 bsc_mgcp_clear(con);
454 }
Holger Hans Peter Freythere83917d2010-01-31 09:46:21 +0100455 break;
456 case SCCP_MSG_TYPE_UDT:
457 /* simply forward everything */
Holger Hans Peter Freyther75ee8412010-06-15 18:48:55 +0800458 con = NULL;
Holger Hans Peter Freythere83917d2010-01-31 09:46:21 +0100459 break;
460 default:
Holger Hans Peter Freyther2f1f55d2010-06-15 18:47:49 +0800461 LOGP(DNAT, LOGL_ERROR, "Not forwarding to msc sccp type: 0x%x\n", parsed->sccp_type);
Holger Hans Peter Freyther75ee8412010-06-15 18:48:55 +0800462 con = NULL;
Holger Hans Peter Freythere83917d2010-01-31 09:46:21 +0100463 goto exit2;
464 break;
465 }
Holger Hans Peter Freyther75ee8412010-06-15 18:48:55 +0800466 } else {
467 LOGP(DNAT, LOGL_ERROR, "Not forwarding unknown stream id: 0x%x\n", parsed->ipa_proto);
468 goto exit2;
Holger Hans Peter Freythere83917d2010-01-31 09:46:21 +0100469 }
470
Holger Hans Peter Freyther75ee8412010-06-15 18:48:55 +0800471 if (con && con->bsc != bsc) {
Holger Hans Peter Freythere83917d2010-01-31 09:46:21 +0100472 LOGP(DNAT, LOGL_ERROR, "Found the wrong entry.\n");
473 goto exit2;
474 }
475
Holger Hans Peter Freyther4a629602010-01-13 09:28:12 +0100476 /* send the non-filtered but maybe modified msg */
Holger Hans Peter Freyther4a860a02010-06-15 18:47:29 +0800477 if (write_queue_enqueue(&msc_con->write_queue, msg) != 0) {
Holger Hans Peter Freyther257a8cc2010-06-15 18:47:02 +0800478 LOGP(DNAT, LOGL_ERROR, "Can not queue message for the MSC.\n");
479 msgb_free(msg);
480 }
Holger Hans Peter Freyther722ead82010-01-30 12:45:10 +0100481 talloc_free(parsed);
Holger Hans Peter Freyther257a8cc2010-06-15 18:47:02 +0800482 return 0;
Holger Hans Peter Freytherf75a6802010-06-15 18:45:38 +0800483
484exit:
Holger Hans Peter Freyther722ead82010-01-30 12:45:10 +0100485 /* if we filter out the reset send an ack to the BSC */
486 if (parsed->bssap == 0 && parsed->gsm_type == BSS_MAP_MSG_RESET) {
Holger Hans Peter Freyther4ce32702010-03-26 07:24:34 +0100487 send_reset_ack(bsc);
488 send_reset_ack(bsc);
Holger Hans Peter Freytherde557662010-06-15 18:46:19 +0800489 } else if (parsed->ipa_proto == IPAC_PROTO_IPACCESS) {
490 /* do we know who is handling this? */
491 if (msg->l2h[0] == IPAC_MSGT_ID_RESP) {
492 struct tlv_parsed tvp;
493 ipaccess_idtag_parse(&tvp,
494 (unsigned char *) msg->l2h + 2,
495 msgb_l2len(msg) - 2);
496 if (TLVP_PRESENT(&tvp, IPAC_IDTAG_UNITNAME))
497 ipaccess_auth_bsc(&tvp, bsc);
498 }
499
500 goto exit2;
Holger Hans Peter Freyther722ead82010-01-30 12:45:10 +0100501 }
502
Holger Hans Peter Freythere83917d2010-01-31 09:46:21 +0100503exit2:
Holger Hans Peter Freytherf75a6802010-06-15 18:45:38 +0800504 talloc_free(parsed);
Holger Hans Peter Freyther257a8cc2010-06-15 18:47:02 +0800505 msgb_free(msg);
506 return -1;
Holger Hans Peter Freyther4a629602010-01-13 09:28:12 +0100507}
508
Holger Hans Peter Freyther84010542010-06-15 18:47:10 +0800509static int ipaccess_bsc_read_cb(struct bsc_fd *bfd)
Holger Hans Peter Freyther4a629602010-01-13 09:28:12 +0100510{
511 int error;
Holger Hans Peter Freyther4ce32702010-03-26 07:24:34 +0100512 struct bsc_connection *bsc = bfd->data;
Holger Hans Peter Freyther4a629602010-01-13 09:28:12 +0100513 struct msgb *msg = ipaccess_read_msg(bfd, &error);
Holger Hans Peter Freyther4a629602010-01-13 09:28:12 +0100514
515 if (!msg) {
516 if (error == 0) {
Holger Hans Peter Freyther8f99b822010-01-29 05:58:43 +0100517 LOGP(DNAT, LOGL_ERROR, "The connection to the BSC was lost. Cleaning it\n");
Holger Hans Peter Freyther4ce32702010-03-26 07:24:34 +0100518 remove_bsc_connection(bsc);
Holger Hans Peter Freyther8f99b822010-01-29 05:58:43 +0100519 } else {
520 LOGP(DNAT, LOGL_ERROR, "Failed to parse ip access message: %d\n", error);
Holger Hans Peter Freyther4a629602010-01-13 09:28:12 +0100521 }
Holger Hans Peter Freyther4a629602010-01-13 09:28:12 +0100522 return -1;
523 }
524
Holger Hans Peter Freyther4a629602010-01-13 09:28:12 +0100525
Holger Hans Peter Freyther8f99b822010-01-29 05:58:43 +0100526 LOGP(DNAT, LOGL_DEBUG, "MSG from BSC: %s proto: %d\n", hexdump(msg->data, msg->len), msg->l2h[0]);
Holger Hans Peter Freyther4a629602010-01-13 09:28:12 +0100527
528 /* Handle messages from the BSC */
529 /* FIXME: Currently no PONG is sent to the BSC */
530 /* FIXME: Currently no ID ACK is sent to the BSC */
Holger Hans Peter Freyther4ce32702010-03-26 07:24:34 +0100531 forward_sccp_to_msc(bsc, msg);
Holger Hans Peter Freyther4a629602010-01-13 09:28:12 +0100532
533 return 0;
534}
535
Holger Hans Peter Freyther2ec55172010-03-26 09:18:02 +0100536static int ipaccess_bsc_write_cb(struct bsc_fd *bfd, struct msgb *msg)
537{
538 int rc;
539
540 rc = write(bfd->fd, msg->data, msg->len);
541 if (rc != msg->len)
542 LOGP(DNAT, LOGL_ERROR, "Failed to write message to the BSC.\n");
543
544 return rc;
545}
546
Holger Hans Peter Freythere8fa0f12010-01-12 21:34:54 +0100547static int ipaccess_listen_bsc_cb(struct bsc_fd *bfd, unsigned int what)
548{
Holger Hans Peter Freyther4a629602010-01-13 09:28:12 +0100549 struct bsc_connection *bsc;
Holger Hans Peter Freythere8fa0f12010-01-12 21:34:54 +0100550 int ret;
551 struct sockaddr_in sa;
552 socklen_t sa_len = sizeof(sa);
553
554 if (!(what & BSC_FD_READ))
555 return 0;
556
557 ret = accept(bfd->fd, (struct sockaddr *) &sa, &sa_len);
558 if (ret < 0) {
559 perror("accept");
560 return ret;
561 }
562
Holger Hans Peter Freyther3399df32010-03-29 08:04:09 +0200563 /*
564 * if we are not connected to a msc... just close the socket
565 */
566 if (!msc_con->is_connected) {
567 LOGP(DNAT, LOGL_NOTICE, "Disconnecting BSC due lack of MSC connection.\n");
568 return 0;
569 }
570
Holger Hans Peter Freythere8fa0f12010-01-12 21:34:54 +0100571 /* todo... do something with the connection */
Holger Hans Peter Freyther738dbdf2010-01-12 21:35:32 +0100572 /* todo... use GNUtls to see if we want to trust this as a BTS */
Holger Hans Peter Freythere8fa0f12010-01-12 21:34:54 +0100573
Holger Hans Peter Freyther4a629602010-01-13 09:28:12 +0100574 /*
575 *
576 */
Holger Hans Peter Freyther090a4d82010-06-15 18:48:01 +0800577 bsc = bsc_connection_alloc(nat);
Holger Hans Peter Freyther4a629602010-01-13 09:28:12 +0100578 if (!bsc) {
Holger Hans Peter Freyther8f99b822010-01-29 05:58:43 +0100579 LOGP(DNAT, LOGL_ERROR, "Failed to allocate BSC struct.\n");
Holger Hans Peter Freyther4a629602010-01-13 09:28:12 +0100580 close(ret);
581 return -1;
582 }
583
Holger Hans Peter Freyther84010542010-06-15 18:47:10 +0800584 write_queue_init(&bsc->write_queue, 100);
585 bsc->write_queue.bfd.data = bsc;
586 bsc->write_queue.bfd.fd = ret;
587 bsc->write_queue.read_cb = ipaccess_bsc_read_cb;
Holger Hans Peter Freyther2ec55172010-03-26 09:18:02 +0100588 bsc->write_queue.write_cb = ipaccess_bsc_write_cb;
Holger Hans Peter Freyther84010542010-06-15 18:47:10 +0800589 bsc->write_queue.bfd.when = BSC_FD_READ;
590 if (bsc_register_fd(&bsc->write_queue.bfd) < 0) {
Holger Hans Peter Freyther8f99b822010-01-29 05:58:43 +0100591 LOGP(DNAT, LOGL_ERROR, "Failed to register BSC fd.\n");
Holger Hans Peter Freyther4a629602010-01-13 09:28:12 +0100592 close(ret);
593 talloc_free(bsc);
594 return -2;
595 }
596
Holger Hans Peter Freyther8f99b822010-01-29 05:58:43 +0100597 LOGP(DNAT, LOGL_INFO, "Registered new BSC\n");
Holger Hans Peter Freyther5e547882010-06-15 18:46:11 +0800598 llist_add(&bsc->list_entry, &nat->bsc_connections);
Holger Hans Peter Freyther809d6fa2010-03-26 07:41:54 +0100599 send_id_ack(bsc);
600 send_id_req(bsc);
Holger Hans Peter Freyther8c61cdb2010-03-31 07:30:58 +0200601 send_mgcp_reset(bsc);
Holger Hans Peter Freytherde557662010-06-15 18:46:19 +0800602
603 /*
604 * start the hangup timer
605 */
606 bsc->id_timeout.data = bsc;
607 bsc->id_timeout.cb = ipaccess_close_bsc;
608 bsc_schedule_timer(&bsc->id_timeout, 2, 0);
Holger Hans Peter Freythere8fa0f12010-01-12 21:34:54 +0100609 return 0;
610}
611
612static int listen_for_bsc(struct bsc_fd *bfd, struct in_addr *in_addr, int port)
613{
614 struct sockaddr_in addr;
615 int ret, on = 1;
616
617 bfd->fd = socket(AF_INET, SOCK_STREAM, IPPROTO_TCP);
618 bfd->cb = ipaccess_listen_bsc_cb;
619 bfd->when = BSC_FD_READ;
620
621 memset(&addr, 0, sizeof(addr));
622 addr.sin_family = AF_INET;
623 addr.sin_port = htons(port);
624 addr.sin_addr.s_addr = in_addr->s_addr;
625
626 setsockopt(bfd->fd, SOL_SOCKET, SO_REUSEADDR, &on, sizeof(on));
627
628 ret = bind(bfd->fd, (struct sockaddr *) &addr, sizeof(addr));
629 if (ret < 0) {
630 fprintf(stderr, "Could not bind the BSC socket %s\n",
631 strerror(errno));
632 return -EIO;
633 }
634
635 ret = listen(bfd->fd, 1);
636 if (ret < 0) {
637 perror("listen");
638 return ret;
639 }
640
641 ret = bsc_register_fd(bfd);
642 if (ret < 0) {
643 perror("register_listen_fd");
644 return ret;
645 }
646 return 0;
647}
648
Holger Hans Peter Freyther89d9fd92010-06-15 18:44:42 +0800649static void print_usage()
650{
651 printf("Usage: bsc_nat\n");
652}
653
654static void print_help()
655{
656 printf(" Some useful help...\n");
657 printf(" -h --help this text\n");
658 printf(" -d option --debug=DRLL:DCC:DMM:DRR:DRSL:DNM enable debugging\n");
659 printf(" -s --disable-color\n");
660 printf(" -c --config-file filename The config file to use.\n");
661 printf(" -m --msc=IP. The address of the MSC.\n");
Holger Hans Peter Freythere8fa0f12010-01-12 21:34:54 +0100662 printf(" -l --local=IP. The local address of this BSC.\n");
Holger Hans Peter Freyther89d9fd92010-06-15 18:44:42 +0800663}
664
665static void handle_options(int argc, char** argv)
666{
667 while (1) {
668 int option_index = 0, c;
669 static struct option long_options[] = {
670 {"help", 0, 0, 'h'},
671 {"debug", 1, 0, 'd'},
672 {"config-file", 1, 0, 'c'},
673 {"disable-color", 0, 0, 's'},
674 {"timestamp", 0, 0, 'T'},
675 {"msc", 1, 0, 'm'},
676 {"local", 1, 0, 'l'},
677 {0, 0, 0, 0}
678 };
679
680 c = getopt_long(argc, argv, "hd:sTPc:m:l:",
681 long_options, &option_index);
682 if (c == -1)
683 break;
684
685 switch (c) {
686 case 'h':
687 print_usage();
688 print_help();
689 exit(0);
690 case 's':
Holger Hans Peter Freyther3b960892010-06-15 19:06:18 +0800691 debug_set_use_color(stderr_target, 0);
Holger Hans Peter Freyther89d9fd92010-06-15 18:44:42 +0800692 break;
693 case 'd':
Holger Hans Peter Freyther3b960892010-06-15 19:06:18 +0800694 debug_parse_category_mask(stderr_target, optarg);
Holger Hans Peter Freyther89d9fd92010-06-15 18:44:42 +0800695 break;
696 case 'c':
697 config_file = strdup(optarg);
698 break;
699 case 'T':
Holger Hans Peter Freyther3b960892010-06-15 19:06:18 +0800700 debug_set_print_timestamp(stderr_target, 1);
Holger Hans Peter Freyther89d9fd92010-06-15 18:44:42 +0800701 break;
702 case 'm':
703 msc_address = strdup(optarg);
704 break;
705 case 'l':
706 inet_aton(optarg, &local_addr);
707 break;
708 default:
709 /* ignore */
710 break;
711 }
712 }
713}
714
Holger Hans Peter Freythere907cb22010-01-12 21:15:08 +0100715static void signal_handler(int signal)
716{
Holger Hans Peter Freythere907cb22010-01-12 21:15:08 +0100717 switch (signal) {
718 case SIGABRT:
719 /* in case of abort, we want to obtain a talloc report
720 * and then return to the caller, who will abort the process */
721 case SIGUSR1:
722 talloc_report_full(tall_bsc_ctx, stderr);
723 break;
724 default:
725 break;
726 }
727}
728
Holger Hans Peter Freyther89d9fd92010-06-15 18:44:42 +0800729int main(int argc, char** argv)
730{
Holger Hans Peter Freythere907cb22010-01-12 21:15:08 +0100731
Holger Hans Peter Freyther3b960892010-06-15 19:06:18 +0800732 debug_init();
733 stderr_target = debug_target_create_stderr();
734 debug_add_target(stderr_target);
735 debug_set_all_filter(stderr_target, 1);
736
Holger Hans Peter Freyther89d9fd92010-06-15 18:44:42 +0800737 /* parse options */
Holger Hans Peter Freythere8fa0f12010-01-12 21:34:54 +0100738 local_addr.s_addr = INADDR_ANY;
Holger Hans Peter Freyther89d9fd92010-06-15 18:44:42 +0800739 handle_options(argc, argv);
740
Holger Hans Peter Freyther5e547882010-06-15 18:46:11 +0800741 nat = bsc_nat_alloc();
742 if (!nat) {
743 fprintf(stderr, "Failed to allocate the BSC nat.\n");
744 return -4;
745 }
746
Holger Hans Peter Freyther3660e4d2010-06-15 18:50:26 +0800747 nat->mgcp_cfg = talloc_zero(nat, struct mgcp_config);
748
Holger Hans Peter Freyther5e547882010-06-15 18:46:11 +0800749 /* init vty and parse */
750 bsc_nat_vty_init(nat);
751 telnet_init(NULL, 4244);
Holger Hans Peter Freyther3660e4d2010-06-15 18:50:26 +0800752 if (mgcp_parse_config(config_file, nat->mgcp_cfg) < 0) {
Holger Hans Peter Freyther5e547882010-06-15 18:46:11 +0800753 fprintf(stderr, "Failed to parse the config file: '%s'\n", config_file);
754 return -3;
755 }
756
Holger Hans Peter Freyther89d9fd92010-06-15 18:44:42 +0800757 /* seed the PRNG */
758 srand(time(NULL));
759
Holger Hans Peter Freythere8fa0f12010-01-12 21:34:54 +0100760 /* connect to the MSC */
Holger Hans Peter Freyther4a860a02010-06-15 18:47:29 +0800761 msc_con = bsc_msc_create(msc_address, 5000);
762 if (!msc_con) {
763 fprintf(stderr, "Creating a bsc_msc_connection failed.\n");
Holger Hans Peter Freythere907cb22010-01-12 21:15:08 +0100764 exit(1);
765 }
766
Holger Hans Peter Freyther4a860a02010-06-15 18:47:29 +0800767 msc_con->connection_loss = msc_connection_was_lost;
768 msc_con->write_queue.read_cb = ipaccess_msc_read_cb;
769 msc_con->write_queue.write_cb = ipaccess_msc_write_cb;;
770 bsc_msc_connect(msc_con);
771
Holger Hans Peter Freythere8fa0f12010-01-12 21:34:54 +0100772 /* wait for the BSC */
Holger Hans Peter Freytherbea0ac62010-03-26 06:51:04 +0100773 if (listen_for_bsc(&bsc_listen, &local_addr, 5000) < 0) {
Holger Hans Peter Freythere8fa0f12010-01-12 21:34:54 +0100774 fprintf(stderr, "Failed to listen for BSC.\n");
775 exit(1);
776 }
777
Holger Hans Peter Freythere907cb22010-01-12 21:15:08 +0100778 signal(SIGABRT, &signal_handler);
779 signal(SIGUSR1, &signal_handler);
780 signal(SIGPIPE, SIG_IGN);
781
782 while (1) {
783 bsc_select_main(0);
784 }
785
Holger Hans Peter Freyther89d9fd92010-06-15 18:44:42 +0800786 return 0;
787}