blob: a3874bed40eeec1f258e3fe671b5148d139c9587 [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 Freytherddf8eae2011-01-22 17:36:01 +010027#include <mtp_pcap.h>
Holger Hans Peter Freythera99b04b2011-01-02 11:23:54 +010028#include <snmp_mtp.h>
29
Holger Hans Peter Freyther644aafb2011-01-03 23:51:07 +010030#include <osmocore/talloc.h>
31
Holger Hans Peter Freyther2ff47b82011-02-15 20:25:10 +010032extern struct bsc_data *bsc;
Holger Hans Peter Freythera99b04b2011-01-02 11:23:54 +010033
Holger Hans Peter Freyther0f833b02011-01-04 13:33:57 +010034int is_one_up(struct mtp_link_set *set)
35{
Holger Hans Peter Freyther0e2f9112011-01-17 11:54:39 +010036 struct mtp_link *entry;
Holger Hans Peter Freyther0f833b02011-01-04 13:33:57 +010037
38 llist_for_each_entry(entry, &set->links, entry)
39 if (entry->available)
40 return 1;
41 return 0;
42}
43
Holger Hans Peter Freyther0e2f9112011-01-17 11:54:39 +010044void mtp_link_down(struct mtp_link *link)
Holger Hans Peter Freytherc8405692011-01-02 20:24:08 +010045{
Holger Hans Peter Freyther0f833b02011-01-04 13:33:57 +010046 int one_up;
47 int was_up;
48
49 was_up = link->available;
50 link->available = 0;
Holger Hans Peter Freythera8ce0612011-01-20 16:30:24 +010051 link->was_up = 0;
Holger Hans Peter Freyther2d845fc2011-01-20 15:42:13 +010052 one_up = is_one_up(link->set);
Holger Hans Peter Freyther0f833b02011-01-04 13:33:57 +010053
54 /* our linkset is now unsuable */
55 if (was_up && !one_up)
Holger Hans Peter Freyther2d845fc2011-01-20 15:42:13 +010056 mtp_linkset_down(link->set);
Holger Hans Peter Freytherc8405692011-01-02 20:24:08 +010057 link->clear_queue(link);
Holger Hans Peter Freythera8ce0612011-01-20 16:30:24 +010058 mtp_link_stop_link_test(link);
Holger Hans Peter Freyther2d845fc2011-01-20 15:42:13 +010059 mtp_link_set_init_slc(link->set);
Holger Hans Peter Freytherc8405692011-01-02 20:24:08 +010060}
61
Holger Hans Peter Freyther0e2f9112011-01-17 11:54:39 +010062void mtp_link_up(struct mtp_link *link)
Holger Hans Peter Freytherc8405692011-01-02 20:24:08 +010063{
Holger Hans Peter Freyther0f833b02011-01-04 13:33:57 +010064 int one_up;
65
Holger Hans Peter Freyther309d79f2011-01-28 18:26:20 +010066 if (link->blocked) {
67 LOGP(DINP, LOGL_ERROR, "Ignoring link up on blocked link %s/%d.\n",
68 link->set->name, link->link_no);
69 return;
70 }
71
Holger Hans Peter Freyther2d845fc2011-01-20 15:42:13 +010072 one_up = is_one_up(link->set);
Holger Hans Peter Freyther0f833b02011-01-04 13:33:57 +010073 link->available = 1;
Holger Hans Peter Freythera8ce0612011-01-20 16:30:24 +010074 link->was_up = 0;
Holger Hans Peter Freyther0f833b02011-01-04 13:33:57 +010075
Holger Hans Peter Freyther2d845fc2011-01-20 15:42:13 +010076 mtp_link_set_init_slc(link->set);
Holger Hans Peter Freyther0f833b02011-01-04 13:33:57 +010077 if (!one_up)
Holger Hans Peter Freyther2d845fc2011-01-20 15:42:13 +010078 mtp_linkset_up(link->set);
Holger Hans Peter Freythera8ce0612011-01-20 16:30:24 +010079 else
80 mtp_link_start_link_test(link);
Holger Hans Peter Freytherc8405692011-01-02 20:24:08 +010081}
82
Holger Hans Peter Freyther0e2f9112011-01-17 11:54:39 +010083void mtp_link_restart(struct mtp_link *link)
Holger Hans Peter Freythera99b04b2011-01-02 11:23:54 +010084{
85 LOGP(DINP, LOGL_ERROR, "Need to restart the SS7 link.\n");
Holger Hans Peter Freytherfe72c162011-01-04 13:21:52 +010086 link->reset(link);
Holger Hans Peter Freythera99b04b2011-01-02 11:23:54 +010087}
88
Holger Hans Peter Freyther89fa11a2011-02-10 18:26:07 +010089struct mtp_link_set *link_init(struct bsc_data *bsc)
Holger Hans Peter Freythera99b04b2011-01-02 11:23:54 +010090{
Holger Hans Peter Freytherc6bfa272011-01-22 17:06:34 +010091 int i;
Holger Hans Peter Freyther0e2f9112011-01-17 11:54:39 +010092 struct mtp_udp_link *lnk;
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");
97 set->dpc = bsc->dpc;
98 set->opc = bsc->opc;
99 set->sccp_opc = bsc->sccp_opc > -1 ? bsc->sccp_opc : bsc->opc;
100 set->isup_opc = bsc->isup_opc > -1 ? bsc->isup_opc : bsc->opc;
101 set->sltm_once = bsc->once;
102 set->ni = bsc->ni_ni;
103 set->spare = bsc->ni_spare;
104 set->bsc = bsc;
105 set->pcap_fd = bsc->pcap_fd;
Holger Hans Peter Freyther644aafb2011-01-03 23:51:07 +0100106
Holger Hans Peter Freythera99b04b2011-01-02 11:23:54 +0100107 if (!bsc->src_port) {
108 LOGP(DINP, LOGL_ERROR, "You need to set a UDP address.\n");
Holger Hans Peter Freyther89fa11a2011-02-10 18:26:07 +0100109 return NULL;
Holger Hans Peter Freythera99b04b2011-01-02 11:23:54 +0100110 }
111
112 LOGP(DINP, LOGL_NOTICE, "Using UDP MTP mode.\n");
113
Holger Hans Peter Freyther3a1c0af2011-01-24 20:21:11 +0100114 if (link_global_init(&bsc->udp_data, bsc->src_port) != 0)
Holger Hans Peter Freyther89fa11a2011-02-10 18:26:07 +0100115 return NULL;
Holger Hans Peter Freythera99b04b2011-01-02 11:23:54 +0100116
Holger Hans Peter Freythera99b04b2011-01-02 11:23:54 +0100117
Holger Hans Peter Freytherc6bfa272011-01-22 17:06:34 +0100118 for (i = 1; i <= bsc->udp_nr_links; ++i) {
Holger Hans Peter Freyther89fa11a2011-02-10 18:26:07 +0100119 lnk = talloc_zero(set, struct mtp_udp_link);
Holger Hans Peter Freytherf6375b42011-01-22 21:01:23 +0100120 lnk->base.pcap_fd = -1;
Holger Hans Peter Freytherc6bfa272011-01-22 17:06:34 +0100121 lnk->bsc = bsc;
122 lnk->data = &bsc->udp_data;
123 lnk->link_index = i;
124 lnk->reset_timeout = bsc->udp_reset_timeout;
Holger Hans Peter Freyther89fa11a2011-02-10 18:26:07 +0100125 mtp_link_set_add_link(set, (struct mtp_link *) lnk);
Holger Hans Peter Freytherc6bfa272011-01-22 17:06:34 +0100126
127
128 /* now connect to the transport */
129 if (link_udp_init(lnk, bsc->udp_ip, bsc->udp_port) != 0)
Holger Hans Peter Freyther89fa11a2011-02-10 18:26:07 +0100130 return NULL;
Holger Hans Peter Freytherc6bfa272011-01-22 17:06:34 +0100131 }
Holger Hans Peter Freythera99b04b2011-01-02 11:23:54 +0100132
Holger Hans Peter Freyther89fa11a2011-02-10 18:26:07 +0100133 return set;
Holger Hans Peter Freythera99b04b2011-01-02 11:23:54 +0100134}
Holger Hans Peter Freytherfe72c162011-01-04 13:21:52 +0100135
136int link_shutdown_all(struct mtp_link_set *set)
137{
Holger Hans Peter Freyther0e2f9112011-01-17 11:54:39 +0100138 struct mtp_link *lnk;
Holger Hans Peter Freytherfe72c162011-01-04 13:21:52 +0100139
140 llist_for_each_entry(lnk, &set->links, entry)
141 lnk->shutdown(lnk);
142 return 0;
143}
144
145int link_reset_all(struct mtp_link_set *set)
146{
Holger Hans Peter Freyther0e2f9112011-01-17 11:54:39 +0100147 struct mtp_link *lnk;
Holger Hans Peter Freytherfe72c162011-01-04 13:21:52 +0100148
149 llist_for_each_entry(lnk, &set->links, entry)
150 lnk->reset(lnk);
151 return 0;
152}
153
154int link_clear_all(struct mtp_link_set *set)
155{
Holger Hans Peter Freyther0e2f9112011-01-17 11:54:39 +0100156 struct mtp_link *lnk;
Holger Hans Peter Freytherfe72c162011-01-04 13:21:52 +0100157
158 llist_for_each_entry(lnk, &set->links, entry)
159 lnk->clear_queue(lnk);
160 return 0;
161}
Holger Hans Peter Freytherddf8eae2011-01-22 17:36:01 +0100162
Holger Hans Peter Freyther36260e92011-01-22 17:37:56 +0100163int mtp_handle_pcap(struct mtp_link *link, int dir, const uint8_t *data, int len)
Holger Hans Peter Freytherddf8eae2011-01-22 17:36:01 +0100164{
Holger Hans Peter Freyther8ade9b72011-01-23 16:18:18 +0100165 if (link->pcap_fd >= 0)
Holger Hans Peter Freytherf6375b42011-01-22 21:01:23 +0100166 mtp_pcap_write_msu(link->pcap_fd, data, len);
Holger Hans Peter Freyther8ade9b72011-01-23 16:18:18 +0100167 if (link->set->pcap_fd >= 0)
Holger Hans Peter Freytherf6375b42011-01-22 21:01:23 +0100168 mtp_pcap_write_msu(link->set->pcap_fd, data, len);
Holger Hans Peter Freyther16b07c62011-01-22 23:19:27 +0100169
170 /* This might be too expensive? */
171 LOGP(DPCAP, LOGL_NOTICE, "Packet: %s\n", hexdump(data, len));
Holger Hans Peter Freytherddf8eae2011-01-22 17:36:01 +0100172 return 0;
173}