blob: ccc8bfb3297f49a6aa0b9468852b26bd631ab225 [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;
Holger Hans Peter Freyther89fa11a2011-02-10 18:26:07 +0100104 set->pcap_fd = bsc->pcap_fd;
Holger Hans Peter Freyther644aafb2011-01-03 23:51:07 +0100105
Holger Hans Peter Freyther1b5d8462011-02-17 01:48:42 +0100106 set->supported_ssn[1] = 1;
107 set->supported_ssn[7] = 1;
108 set->supported_ssn[8] = 1;
109 set->supported_ssn[146] = 1;
110 set->supported_ssn[254] = 1;
111
Holger Hans Peter Freythera99b04b2011-01-02 11:23:54 +0100112 if (!bsc->src_port) {
113 LOGP(DINP, LOGL_ERROR, "You need to set a UDP address.\n");
Holger Hans Peter Freyther89fa11a2011-02-10 18:26:07 +0100114 return NULL;
Holger Hans Peter Freythera99b04b2011-01-02 11:23:54 +0100115 }
116
117 LOGP(DINP, LOGL_NOTICE, "Using UDP MTP mode.\n");
118
Holger Hans Peter Freyther3a1c0af2011-01-24 20:21:11 +0100119 if (link_global_init(&bsc->udp_data, bsc->src_port) != 0)
Holger Hans Peter Freyther89fa11a2011-02-10 18:26:07 +0100120 return NULL;
Holger Hans Peter Freythera99b04b2011-01-02 11:23:54 +0100121
Holger Hans Peter Freythera99b04b2011-01-02 11:23:54 +0100122
Holger Hans Peter Freytherc6bfa272011-01-22 17:06:34 +0100123 for (i = 1; i <= bsc->udp_nr_links; ++i) {
Holger Hans Peter Freyther89fa11a2011-02-10 18:26:07 +0100124 lnk = talloc_zero(set, struct mtp_udp_link);
Holger Hans Peter Freytherf6375b42011-01-22 21:01:23 +0100125 lnk->base.pcap_fd = -1;
Holger Hans Peter Freytherc6bfa272011-01-22 17:06:34 +0100126 lnk->bsc = bsc;
127 lnk->data = &bsc->udp_data;
128 lnk->link_index = i;
129 lnk->reset_timeout = bsc->udp_reset_timeout;
Holger Hans Peter Freyther89fa11a2011-02-10 18:26:07 +0100130 mtp_link_set_add_link(set, (struct mtp_link *) lnk);
Holger Hans Peter Freytherc6bfa272011-01-22 17:06:34 +0100131
132
133 /* now connect to the transport */
134 if (link_udp_init(lnk, bsc->udp_ip, bsc->udp_port) != 0)
Holger Hans Peter Freyther89fa11a2011-02-10 18:26:07 +0100135 return NULL;
Holger Hans Peter Freytherc6bfa272011-01-22 17:06:34 +0100136 }
Holger Hans Peter Freythera99b04b2011-01-02 11:23:54 +0100137
Holger Hans Peter Freyther89fa11a2011-02-10 18:26:07 +0100138 return set;
Holger Hans Peter Freythera99b04b2011-01-02 11:23:54 +0100139}
Holger Hans Peter Freytherfe72c162011-01-04 13:21:52 +0100140
141int link_shutdown_all(struct mtp_link_set *set)
142{
Holger Hans Peter Freyther0e2f9112011-01-17 11:54:39 +0100143 struct mtp_link *lnk;
Holger Hans Peter Freytherfe72c162011-01-04 13:21:52 +0100144
145 llist_for_each_entry(lnk, &set->links, entry)
146 lnk->shutdown(lnk);
147 return 0;
148}
149
150int link_reset_all(struct mtp_link_set *set)
151{
Holger Hans Peter Freyther0e2f9112011-01-17 11:54:39 +0100152 struct mtp_link *lnk;
Holger Hans Peter Freytherfe72c162011-01-04 13:21:52 +0100153
154 llist_for_each_entry(lnk, &set->links, entry)
155 lnk->reset(lnk);
156 return 0;
157}
158
159int link_clear_all(struct mtp_link_set *set)
160{
Holger Hans Peter Freyther0e2f9112011-01-17 11:54:39 +0100161 struct mtp_link *lnk;
Holger Hans Peter Freytherfe72c162011-01-04 13:21:52 +0100162
163 llist_for_each_entry(lnk, &set->links, entry)
164 lnk->clear_queue(lnk);
165 return 0;
166}
Holger Hans Peter Freytherddf8eae2011-01-22 17:36:01 +0100167
Holger Hans Peter Freyther36260e92011-01-22 17:37:56 +0100168int mtp_handle_pcap(struct mtp_link *link, int dir, const uint8_t *data, int len)
Holger Hans Peter Freytherddf8eae2011-01-22 17:36:01 +0100169{
Holger Hans Peter Freyther8ade9b72011-01-23 16:18:18 +0100170 if (link->pcap_fd >= 0)
Holger Hans Peter Freytherf6375b42011-01-22 21:01:23 +0100171 mtp_pcap_write_msu(link->pcap_fd, data, len);
Holger Hans Peter Freyther8ade9b72011-01-23 16:18:18 +0100172 if (link->set->pcap_fd >= 0)
Holger Hans Peter Freytherf6375b42011-01-22 21:01:23 +0100173 mtp_pcap_write_msu(link->set->pcap_fd, data, len);
Holger Hans Peter Freyther16b07c62011-01-22 23:19:27 +0100174
175 /* This might be too expensive? */
176 LOGP(DPCAP, LOGL_NOTICE, "Packet: %s\n", hexdump(data, len));
Holger Hans Peter Freytherddf8eae2011-01-22 17:36:01 +0100177 return 0;
178}