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