blob: 09e1c2f02e426c1a323dbe396d4f43987fb2738b [file] [log] [blame]
Holger Hans Peter Freythera99b04b2011-01-02 11:23:54 +01001/* link management code */
2/*
3 * (C) 2010-2011 by Holger Hans Peter Freyther <zecke@selfish.org>
4 * (C) 2010-2011 by On-Waves
5 * All Rights Reserved
6 *
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License as published by
9 * the Free Software Foundation; either version 2 of the License, or
10 * (at your option) any later version.
11 *
12 * This program is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU General Public License for more details.
16 *
17 * You should have received a copy of the GNU General Public License along
18 * with this program; if not, write to the Free Software Foundation, Inc.,
19 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
20 *
21 */
22
23#include <bsc_data.h>
24#include <cellmgr_debug.h>
Holger Hans Peter Freyther84ec8712011-02-15 20:01:47 +010025#include <msc_connection.h>
Holger Hans Peter Freythera99b04b2011-01-02 11:23:54 +010026#include <mtp_data.h>
Holger Hans Peter Freythercfe9d712011-02-17 20:32:09 +010027#include <mtp_level3.h>
Holger Hans Peter Freytherddf8eae2011-01-22 17:36:01 +010028#include <mtp_pcap.h>
Holger Hans Peter Freythera99b04b2011-01-02 11:23:54 +010029#include <snmp_mtp.h>
30
Holger Hans Peter Freyther644aafb2011-01-03 23:51:07 +010031#include <osmocore/talloc.h>
32
Holger Hans Peter Freyther2ff47b82011-02-15 20:25:10 +010033extern struct bsc_data *bsc;
Holger Hans Peter Freythera99b04b2011-01-02 11:23:54 +010034
Holger Hans Peter Freyther0f833b02011-01-04 13:33:57 +010035int is_one_up(struct mtp_link_set *set)
36{
Holger Hans Peter Freyther0e2f9112011-01-17 11:54:39 +010037 struct mtp_link *entry;
Holger Hans Peter Freyther0f833b02011-01-04 13:33:57 +010038
39 llist_for_each_entry(entry, &set->links, entry)
40 if (entry->available)
41 return 1;
42 return 0;
43}
44
Holger Hans Peter Freyther0e2f9112011-01-17 11:54:39 +010045void mtp_link_down(struct mtp_link *link)
Holger Hans Peter Freytherc8405692011-01-02 20:24:08 +010046{
Holger Hans Peter Freyther0f833b02011-01-04 13:33:57 +010047 int one_up;
48 int was_up;
49
50 was_up = link->available;
51 link->available = 0;
Holger Hans Peter Freythera8ce0612011-01-20 16:30:24 +010052 link->was_up = 0;
Holger Hans Peter Freyther2d845fc2011-01-20 15:42:13 +010053 one_up = is_one_up(link->set);
Holger Hans Peter Freyther0f833b02011-01-04 13:33:57 +010054
55 /* our linkset is now unsuable */
56 if (was_up && !one_up)
Holger Hans Peter Freyther2d845fc2011-01-20 15:42:13 +010057 mtp_linkset_down(link->set);
Holger Hans Peter Freytherc8405692011-01-02 20:24:08 +010058 link->clear_queue(link);
Holger Hans Peter Freythera8ce0612011-01-20 16:30:24 +010059 mtp_link_stop_link_test(link);
Holger Hans Peter Freyther2d845fc2011-01-20 15:42:13 +010060 mtp_link_set_init_slc(link->set);
Holger Hans Peter Freytherc8405692011-01-02 20:24:08 +010061}
62
Holger Hans Peter Freyther0e2f9112011-01-17 11:54:39 +010063void mtp_link_up(struct mtp_link *link)
Holger Hans Peter Freytherc8405692011-01-02 20:24:08 +010064{
Holger Hans Peter Freyther0f833b02011-01-04 13:33:57 +010065 int one_up;
66
Holger Hans Peter Freyther309d79f2011-01-28 18:26:20 +010067 if (link->blocked) {
Holger Hans Peter Freyther5a34c7f2011-02-17 03:23:42 +010068 LOGP(DINP, LOGL_ERROR,
69 "Ignoring link up on blocked link %d/%s of linkset %d/%s.\n",
70 link->nr, link->name, link->set->nr, link->set->name);
Holger Hans Peter Freyther309d79f2011-01-28 18:26:20 +010071 return;
72 }
73
Holger Hans Peter Freyther2d845fc2011-01-20 15:42:13 +010074 one_up = is_one_up(link->set);
Holger Hans Peter Freyther0f833b02011-01-04 13:33:57 +010075 link->available = 1;
Holger Hans Peter Freythera8ce0612011-01-20 16:30:24 +010076 link->was_up = 0;
Holger Hans Peter Freyther0f833b02011-01-04 13:33:57 +010077
Holger Hans Peter Freyther2d845fc2011-01-20 15:42:13 +010078 mtp_link_set_init_slc(link->set);
Holger Hans Peter Freyther0f833b02011-01-04 13:33:57 +010079 if (!one_up)
Holger Hans Peter Freyther2d845fc2011-01-20 15:42:13 +010080 mtp_linkset_up(link->set);
Holger Hans Peter Freythera8ce0612011-01-20 16:30:24 +010081 else
82 mtp_link_start_link_test(link);
Holger Hans Peter Freytherc8405692011-01-02 20:24:08 +010083}
84
Holger Hans Peter Freyther0e2f9112011-01-17 11:54:39 +010085void mtp_link_restart(struct mtp_link *link)
Holger Hans Peter Freythera99b04b2011-01-02 11:23:54 +010086{
87 LOGP(DINP, LOGL_ERROR, "Need to restart the SS7 link.\n");
Holger Hans Peter Freytherfe72c162011-01-04 13:21:52 +010088 link->reset(link);
Holger Hans Peter Freythera99b04b2011-01-02 11:23:54 +010089}
90
Holger Hans Peter Freythercfe9d712011-02-17 20:32:09 +010091struct mtp_link_set *link_set_create(struct bsc_data *bsc)
Holger Hans Peter Freythera99b04b2011-01-02 11:23:54 +010092{
Holger Hans Peter Freyther89fa11a2011-02-10 18:26:07 +010093 struct mtp_link_set *set;
Holger Hans Peter Freytherfe72c162011-01-04 13:21:52 +010094
Holger Hans Peter Freyther599c9a42011-02-15 11:18:38 +010095 set = mtp_link_set_alloc(bsc);
Holger Hans Peter Freyther89fa11a2011-02-10 18:26:07 +010096 set->name = talloc_strdup(set, "MTP");
Holger Hans Peter Freyther644aafb2011-01-03 23:51:07 +010097
Holger Hans Peter Freythercfe9d712011-02-17 20:32:09 +010098 set->ni = MTP_NI_NATION_NET;
99 set->spare = 0;
100
Holger Hans Peter Freyther1b5d8462011-02-17 01:48:42 +0100101 set->supported_ssn[1] = 1;
102 set->supported_ssn[7] = 1;
103 set->supported_ssn[8] = 1;
104 set->supported_ssn[146] = 1;
105 set->supported_ssn[254] = 1;
106
Holger Hans Peter Freythercfe9d712011-02-17 20:32:09 +0100107 return set;
108}
109
110int link_init(struct bsc_data *bsc, struct mtp_link_set *set)
111{
112 int i;
113 struct mtp_udp_link *lnk;
114 struct mtp_link *blnk;
115
116
Holger Hans Peter Freyther71760302011-02-22 20:57:08 +0100117 if (!bsc->udp_src_port) {
Holger Hans Peter Freythera99b04b2011-01-02 11:23:54 +0100118 LOGP(DINP, LOGL_ERROR, "You need to set a UDP address.\n");
Holger Hans Peter Freythercfe9d712011-02-17 20:32:09 +0100119 return -1;
Holger Hans Peter Freythera99b04b2011-01-02 11:23:54 +0100120 }
121
122 LOGP(DINP, LOGL_NOTICE, "Using UDP MTP mode.\n");
123
Holger Hans Peter Freyther71760302011-02-22 20:57:08 +0100124 if (link_global_init(&bsc->udp_data) != 0)
Holger Hans Peter Freythercfe9d712011-02-17 20:32:09 +0100125 return -1;
Holger Hans Peter Freythera99b04b2011-01-02 11:23:54 +0100126
Holger Hans Peter Freyther71760302011-02-22 20:57:08 +0100127 if (link_global_bind(&bsc->udp_data, bsc->udp_src_port) != 0)
128 return -1;
Holger Hans Peter Freythera99b04b2011-01-02 11:23:54 +0100129
Holger Hans Peter Freytherc6bfa272011-01-22 17:06:34 +0100130 for (i = 1; i <= bsc->udp_nr_links; ++i) {
Holger Hans Peter Freyther6c0b2e52011-02-17 02:18:38 +0100131 blnk = mtp_link_alloc(set);
Holger Hans Peter Freyther71760302011-02-22 20:57:08 +0100132 lnk = mtp_udp_link_init(blnk);
133
134 lnk->link_index = 1;
Holger Hans Peter Freytherc6bfa272011-01-22 17:06:34 +0100135
136 /* now connect to the transport */
Holger Hans Peter Freyther71760302011-02-22 20:57:08 +0100137 if (snmp_mtp_peer_name(lnk->session, bsc->udp_ip) != 0)
138 return -1;
139
Holger Hans Peter Freytherc6bfa272011-01-22 17:06:34 +0100140 if (link_udp_init(lnk, bsc->udp_ip, bsc->udp_port) != 0)
Holger Hans Peter Freythercfe9d712011-02-17 20:32:09 +0100141 return -1;
Holger Hans Peter Freytherc6bfa272011-01-22 17:06:34 +0100142 }
Holger Hans Peter Freythera99b04b2011-01-02 11:23:54 +0100143
Holger Hans Peter Freythercfe9d712011-02-17 20:32:09 +0100144 return 0;
Holger Hans Peter Freythera99b04b2011-01-02 11:23:54 +0100145}
Holger Hans Peter Freytherfe72c162011-01-04 13:21:52 +0100146
147int link_shutdown_all(struct mtp_link_set *set)
148{
Holger Hans Peter Freyther0e2f9112011-01-17 11:54:39 +0100149 struct mtp_link *lnk;
Holger Hans Peter Freytherfe72c162011-01-04 13:21:52 +0100150
151 llist_for_each_entry(lnk, &set->links, entry)
152 lnk->shutdown(lnk);
153 return 0;
154}
155
156int link_reset_all(struct mtp_link_set *set)
157{
Holger Hans Peter Freyther0e2f9112011-01-17 11:54:39 +0100158 struct mtp_link *lnk;
Holger Hans Peter Freytherfe72c162011-01-04 13:21:52 +0100159
160 llist_for_each_entry(lnk, &set->links, entry)
161 lnk->reset(lnk);
162 return 0;
163}
164
165int link_clear_all(struct mtp_link_set *set)
166{
Holger Hans Peter Freyther0e2f9112011-01-17 11:54:39 +0100167 struct mtp_link *lnk;
Holger Hans Peter Freytherfe72c162011-01-04 13:21:52 +0100168
169 llist_for_each_entry(lnk, &set->links, entry)
170 lnk->clear_queue(lnk);
171 return 0;
172}
Holger Hans Peter Freytherddf8eae2011-01-22 17:36:01 +0100173
Holger Hans Peter Freyther36260e92011-01-22 17:37:56 +0100174int mtp_handle_pcap(struct mtp_link *link, int dir, const uint8_t *data, int len)
Holger Hans Peter Freytherddf8eae2011-01-22 17:36:01 +0100175{
Holger Hans Peter Freyther8ade9b72011-01-23 16:18:18 +0100176 if (link->pcap_fd >= 0)
Holger Hans Peter Freytherf6375b42011-01-22 21:01:23 +0100177 mtp_pcap_write_msu(link->pcap_fd, data, len);
Holger Hans Peter Freyther8ade9b72011-01-23 16:18:18 +0100178 if (link->set->pcap_fd >= 0)
Holger Hans Peter Freytherf6375b42011-01-22 21:01:23 +0100179 mtp_pcap_write_msu(link->set->pcap_fd, data, len);
Holger Hans Peter Freyther16b07c62011-01-22 23:19:27 +0100180
181 /* This might be too expensive? */
182 LOGP(DPCAP, LOGL_NOTICE, "Packet: %s\n", hexdump(data, len));
Holger Hans Peter Freytherddf8eae2011-01-22 17:36:01 +0100183 return 0;
184}