Holger Hans Peter Freyther | a99b04b | 2011-01-02 11:23:54 +0100 | [diff] [blame] | 1 | /* 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 Freyther | 84ec871 | 2011-02-15 20:01:47 +0100 | [diff] [blame] | 25 | #include <msc_connection.h> |
Holger Hans Peter Freyther | a99b04b | 2011-01-02 11:23:54 +0100 | [diff] [blame] | 26 | #include <mtp_data.h> |
Holger Hans Peter Freyther | cfe9d71 | 2011-02-17 20:32:09 +0100 | [diff] [blame] | 27 | #include <mtp_level3.h> |
Holger Hans Peter Freyther | ddf8eae | 2011-01-22 17:36:01 +0100 | [diff] [blame] | 28 | #include <mtp_pcap.h> |
Holger Hans Peter Freyther | a99b04b | 2011-01-02 11:23:54 +0100 | [diff] [blame] | 29 | #include <snmp_mtp.h> |
| 30 | |
Holger Hans Peter Freyther | 644aafb | 2011-01-03 23:51:07 +0100 | [diff] [blame] | 31 | #include <osmocore/talloc.h> |
| 32 | |
Holger Hans Peter Freyther | 2ff47b8 | 2011-02-15 20:25:10 +0100 | [diff] [blame] | 33 | extern struct bsc_data *bsc; |
Holger Hans Peter Freyther | a99b04b | 2011-01-02 11:23:54 +0100 | [diff] [blame] | 34 | |
Holger Hans Peter Freyther | 0f833b0 | 2011-01-04 13:33:57 +0100 | [diff] [blame] | 35 | int is_one_up(struct mtp_link_set *set) |
| 36 | { |
Holger Hans Peter Freyther | 0e2f911 | 2011-01-17 11:54:39 +0100 | [diff] [blame] | 37 | struct mtp_link *entry; |
Holger Hans Peter Freyther | 0f833b0 | 2011-01-04 13:33:57 +0100 | [diff] [blame] | 38 | |
| 39 | llist_for_each_entry(entry, &set->links, entry) |
| 40 | if (entry->available) |
| 41 | return 1; |
| 42 | return 0; |
| 43 | } |
| 44 | |
Holger Hans Peter Freyther | 0e2f911 | 2011-01-17 11:54:39 +0100 | [diff] [blame] | 45 | void mtp_link_down(struct mtp_link *link) |
Holger Hans Peter Freyther | c840569 | 2011-01-02 20:24:08 +0100 | [diff] [blame] | 46 | { |
Holger Hans Peter Freyther | 0f833b0 | 2011-01-04 13:33:57 +0100 | [diff] [blame] | 47 | int one_up; |
| 48 | int was_up; |
| 49 | |
| 50 | was_up = link->available; |
| 51 | link->available = 0; |
Holger Hans Peter Freyther | a8ce061 | 2011-01-20 16:30:24 +0100 | [diff] [blame] | 52 | link->was_up = 0; |
Holger Hans Peter Freyther | 2d845fc | 2011-01-20 15:42:13 +0100 | [diff] [blame] | 53 | one_up = is_one_up(link->set); |
Holger Hans Peter Freyther | 0f833b0 | 2011-01-04 13:33:57 +0100 | [diff] [blame] | 54 | |
| 55 | /* our linkset is now unsuable */ |
| 56 | if (was_up && !one_up) |
Holger Hans Peter Freyther | 2d845fc | 2011-01-20 15:42:13 +0100 | [diff] [blame] | 57 | mtp_linkset_down(link->set); |
Holger Hans Peter Freyther | c840569 | 2011-01-02 20:24:08 +0100 | [diff] [blame] | 58 | link->clear_queue(link); |
Holger Hans Peter Freyther | a8ce061 | 2011-01-20 16:30:24 +0100 | [diff] [blame] | 59 | mtp_link_stop_link_test(link); |
Holger Hans Peter Freyther | 2d845fc | 2011-01-20 15:42:13 +0100 | [diff] [blame] | 60 | mtp_link_set_init_slc(link->set); |
Holger Hans Peter Freyther | c840569 | 2011-01-02 20:24:08 +0100 | [diff] [blame] | 61 | } |
| 62 | |
Holger Hans Peter Freyther | 0e2f911 | 2011-01-17 11:54:39 +0100 | [diff] [blame] | 63 | void mtp_link_up(struct mtp_link *link) |
Holger Hans Peter Freyther | c840569 | 2011-01-02 20:24:08 +0100 | [diff] [blame] | 64 | { |
Holger Hans Peter Freyther | 0f833b0 | 2011-01-04 13:33:57 +0100 | [diff] [blame] | 65 | int one_up; |
| 66 | |
Holger Hans Peter Freyther | 309d79f | 2011-01-28 18:26:20 +0100 | [diff] [blame] | 67 | if (link->blocked) { |
Holger Hans Peter Freyther | 5a34c7f | 2011-02-17 03:23:42 +0100 | [diff] [blame] | 68 | 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 Freyther | 309d79f | 2011-01-28 18:26:20 +0100 | [diff] [blame] | 71 | return; |
| 72 | } |
| 73 | |
Holger Hans Peter Freyther | 2d845fc | 2011-01-20 15:42:13 +0100 | [diff] [blame] | 74 | one_up = is_one_up(link->set); |
Holger Hans Peter Freyther | 0f833b0 | 2011-01-04 13:33:57 +0100 | [diff] [blame] | 75 | link->available = 1; |
Holger Hans Peter Freyther | a8ce061 | 2011-01-20 16:30:24 +0100 | [diff] [blame] | 76 | link->was_up = 0; |
Holger Hans Peter Freyther | 0f833b0 | 2011-01-04 13:33:57 +0100 | [diff] [blame] | 77 | |
Holger Hans Peter Freyther | 2d845fc | 2011-01-20 15:42:13 +0100 | [diff] [blame] | 78 | mtp_link_set_init_slc(link->set); |
Holger Hans Peter Freyther | 0f833b0 | 2011-01-04 13:33:57 +0100 | [diff] [blame] | 79 | if (!one_up) |
Holger Hans Peter Freyther | 2d845fc | 2011-01-20 15:42:13 +0100 | [diff] [blame] | 80 | mtp_linkset_up(link->set); |
Holger Hans Peter Freyther | a8ce061 | 2011-01-20 16:30:24 +0100 | [diff] [blame] | 81 | else |
| 82 | mtp_link_start_link_test(link); |
Holger Hans Peter Freyther | c840569 | 2011-01-02 20:24:08 +0100 | [diff] [blame] | 83 | } |
| 84 | |
Holger Hans Peter Freyther | 0e2f911 | 2011-01-17 11:54:39 +0100 | [diff] [blame] | 85 | void mtp_link_restart(struct mtp_link *link) |
Holger Hans Peter Freyther | a99b04b | 2011-01-02 11:23:54 +0100 | [diff] [blame] | 86 | { |
| 87 | LOGP(DINP, LOGL_ERROR, "Need to restart the SS7 link.\n"); |
Holger Hans Peter Freyther | fe72c16 | 2011-01-04 13:21:52 +0100 | [diff] [blame] | 88 | link->reset(link); |
Holger Hans Peter Freyther | a99b04b | 2011-01-02 11:23:54 +0100 | [diff] [blame] | 89 | } |
| 90 | |
Holger Hans Peter Freyther | cfe9d71 | 2011-02-17 20:32:09 +0100 | [diff] [blame] | 91 | struct mtp_link_set *link_set_create(struct bsc_data *bsc) |
Holger Hans Peter Freyther | a99b04b | 2011-01-02 11:23:54 +0100 | [diff] [blame] | 92 | { |
Holger Hans Peter Freyther | 89fa11a | 2011-02-10 18:26:07 +0100 | [diff] [blame] | 93 | struct mtp_link_set *set; |
Holger Hans Peter Freyther | fe72c16 | 2011-01-04 13:21:52 +0100 | [diff] [blame] | 94 | |
Holger Hans Peter Freyther | 599c9a4 | 2011-02-15 11:18:38 +0100 | [diff] [blame] | 95 | set = mtp_link_set_alloc(bsc); |
Holger Hans Peter Freyther | 89fa11a | 2011-02-10 18:26:07 +0100 | [diff] [blame] | 96 | set->name = talloc_strdup(set, "MTP"); |
Holger Hans Peter Freyther | 644aafb | 2011-01-03 23:51:07 +0100 | [diff] [blame] | 97 | |
Holger Hans Peter Freyther | cfe9d71 | 2011-02-17 20:32:09 +0100 | [diff] [blame] | 98 | set->ni = MTP_NI_NATION_NET; |
| 99 | set->spare = 0; |
| 100 | |
Holger Hans Peter Freyther | 1b5d846 | 2011-02-17 01:48:42 +0100 | [diff] [blame] | 101 | 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 Freyther | cfe9d71 | 2011-02-17 20:32:09 +0100 | [diff] [blame] | 107 | return set; |
| 108 | } |
| 109 | |
| 110 | int 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 Freyther | 7176030 | 2011-02-22 20:57:08 +0100 | [diff] [blame] | 117 | if (!bsc->udp_src_port) { |
Holger Hans Peter Freyther | a99b04b | 2011-01-02 11:23:54 +0100 | [diff] [blame] | 118 | LOGP(DINP, LOGL_ERROR, "You need to set a UDP address.\n"); |
Holger Hans Peter Freyther | cfe9d71 | 2011-02-17 20:32:09 +0100 | [diff] [blame] | 119 | return -1; |
Holger Hans Peter Freyther | a99b04b | 2011-01-02 11:23:54 +0100 | [diff] [blame] | 120 | } |
| 121 | |
| 122 | LOGP(DINP, LOGL_NOTICE, "Using UDP MTP mode.\n"); |
| 123 | |
Holger Hans Peter Freyther | 7176030 | 2011-02-22 20:57:08 +0100 | [diff] [blame] | 124 | if (link_global_init(&bsc->udp_data) != 0) |
Holger Hans Peter Freyther | cfe9d71 | 2011-02-17 20:32:09 +0100 | [diff] [blame] | 125 | return -1; |
Holger Hans Peter Freyther | a99b04b | 2011-01-02 11:23:54 +0100 | [diff] [blame] | 126 | |
Holger Hans Peter Freyther | 7176030 | 2011-02-22 20:57:08 +0100 | [diff] [blame] | 127 | if (link_global_bind(&bsc->udp_data, bsc->udp_src_port) != 0) |
| 128 | return -1; |
Holger Hans Peter Freyther | a99b04b | 2011-01-02 11:23:54 +0100 | [diff] [blame] | 129 | |
Holger Hans Peter Freyther | c6bfa27 | 2011-01-22 17:06:34 +0100 | [diff] [blame] | 130 | for (i = 1; i <= bsc->udp_nr_links; ++i) { |
Holger Hans Peter Freyther | 6c0b2e5 | 2011-02-17 02:18:38 +0100 | [diff] [blame] | 131 | blnk = mtp_link_alloc(set); |
Holger Hans Peter Freyther | 7176030 | 2011-02-22 20:57:08 +0100 | [diff] [blame] | 132 | lnk = mtp_udp_link_init(blnk); |
| 133 | |
| 134 | lnk->link_index = 1; |
Holger Hans Peter Freyther | c6bfa27 | 2011-01-22 17:06:34 +0100 | [diff] [blame] | 135 | |
| 136 | /* now connect to the transport */ |
Holger Hans Peter Freyther | 7176030 | 2011-02-22 20:57:08 +0100 | [diff] [blame] | 137 | if (snmp_mtp_peer_name(lnk->session, bsc->udp_ip) != 0) |
| 138 | return -1; |
| 139 | |
Holger Hans Peter Freyther | c6bfa27 | 2011-01-22 17:06:34 +0100 | [diff] [blame] | 140 | if (link_udp_init(lnk, bsc->udp_ip, bsc->udp_port) != 0) |
Holger Hans Peter Freyther | cfe9d71 | 2011-02-17 20:32:09 +0100 | [diff] [blame] | 141 | return -1; |
Holger Hans Peter Freyther | c6bfa27 | 2011-01-22 17:06:34 +0100 | [diff] [blame] | 142 | } |
Holger Hans Peter Freyther | a99b04b | 2011-01-02 11:23:54 +0100 | [diff] [blame] | 143 | |
Holger Hans Peter Freyther | cfe9d71 | 2011-02-17 20:32:09 +0100 | [diff] [blame] | 144 | return 0; |
Holger Hans Peter Freyther | a99b04b | 2011-01-02 11:23:54 +0100 | [diff] [blame] | 145 | } |
Holger Hans Peter Freyther | fe72c16 | 2011-01-04 13:21:52 +0100 | [diff] [blame] | 146 | |
| 147 | int link_shutdown_all(struct mtp_link_set *set) |
| 148 | { |
Holger Hans Peter Freyther | 0e2f911 | 2011-01-17 11:54:39 +0100 | [diff] [blame] | 149 | struct mtp_link *lnk; |
Holger Hans Peter Freyther | fe72c16 | 2011-01-04 13:21:52 +0100 | [diff] [blame] | 150 | |
| 151 | llist_for_each_entry(lnk, &set->links, entry) |
| 152 | lnk->shutdown(lnk); |
| 153 | return 0; |
| 154 | } |
| 155 | |
| 156 | int link_reset_all(struct mtp_link_set *set) |
| 157 | { |
Holger Hans Peter Freyther | 0e2f911 | 2011-01-17 11:54:39 +0100 | [diff] [blame] | 158 | struct mtp_link *lnk; |
Holger Hans Peter Freyther | fe72c16 | 2011-01-04 13:21:52 +0100 | [diff] [blame] | 159 | |
| 160 | llist_for_each_entry(lnk, &set->links, entry) |
| 161 | lnk->reset(lnk); |
| 162 | return 0; |
| 163 | } |
| 164 | |
| 165 | int link_clear_all(struct mtp_link_set *set) |
| 166 | { |
Holger Hans Peter Freyther | 0e2f911 | 2011-01-17 11:54:39 +0100 | [diff] [blame] | 167 | struct mtp_link *lnk; |
Holger Hans Peter Freyther | fe72c16 | 2011-01-04 13:21:52 +0100 | [diff] [blame] | 168 | |
| 169 | llist_for_each_entry(lnk, &set->links, entry) |
| 170 | lnk->clear_queue(lnk); |
| 171 | return 0; |
| 172 | } |
Holger Hans Peter Freyther | ddf8eae | 2011-01-22 17:36:01 +0100 | [diff] [blame] | 173 | |
Holger Hans Peter Freyther | 36260e9 | 2011-01-22 17:37:56 +0100 | [diff] [blame] | 174 | int mtp_handle_pcap(struct mtp_link *link, int dir, const uint8_t *data, int len) |
Holger Hans Peter Freyther | ddf8eae | 2011-01-22 17:36:01 +0100 | [diff] [blame] | 175 | { |
Holger Hans Peter Freyther | 8ade9b7 | 2011-01-23 16:18:18 +0100 | [diff] [blame] | 176 | if (link->pcap_fd >= 0) |
Holger Hans Peter Freyther | f6375b4 | 2011-01-22 21:01:23 +0100 | [diff] [blame] | 177 | mtp_pcap_write_msu(link->pcap_fd, data, len); |
Holger Hans Peter Freyther | 8ade9b7 | 2011-01-23 16:18:18 +0100 | [diff] [blame] | 178 | if (link->set->pcap_fd >= 0) |
Holger Hans Peter Freyther | f6375b4 | 2011-01-22 21:01:23 +0100 | [diff] [blame] | 179 | mtp_pcap_write_msu(link->set->pcap_fd, data, len); |
Holger Hans Peter Freyther | 16b07c6 | 2011-01-22 23:19:27 +0100 | [diff] [blame] | 180 | |
| 181 | /* This might be too expensive? */ |
| 182 | LOGP(DPCAP, LOGL_NOTICE, "Packet: %s\n", hexdump(data, len)); |
Holger Hans Peter Freyther | ddf8eae | 2011-01-22 17:36:01 +0100 | [diff] [blame] | 183 | return 0; |
| 184 | } |