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> |
| 25 | #include <mtp_data.h> |
Holger Hans Peter Freyther | ddf8eae | 2011-01-22 17:36:01 +0100 | [diff] [blame] | 26 | #include <mtp_pcap.h> |
Holger Hans Peter Freyther | a99b04b | 2011-01-02 11:23:54 +0100 | [diff] [blame] | 27 | #include <snmp_mtp.h> |
| 28 | |
Holger Hans Peter Freyther | 644aafb | 2011-01-03 23:51:07 +0100 | [diff] [blame] | 29 | #include <osmocore/talloc.h> |
| 30 | |
Holger Hans Peter Freyther | a99b04b | 2011-01-02 11:23:54 +0100 | [diff] [blame] | 31 | extern struct bsc_data bsc; |
| 32 | |
Holger Hans Peter Freyther | 0f833b0 | 2011-01-04 13:33:57 +0100 | [diff] [blame] | 33 | int is_one_up(struct mtp_link_set *set) |
| 34 | { |
Holger Hans Peter Freyther | 0e2f911 | 2011-01-17 11:54:39 +0100 | [diff] [blame] | 35 | struct mtp_link *entry; |
Holger Hans Peter Freyther | 0f833b0 | 2011-01-04 13:33:57 +0100 | [diff] [blame] | 36 | |
| 37 | llist_for_each_entry(entry, &set->links, entry) |
| 38 | if (entry->available) |
| 39 | return 1; |
| 40 | return 0; |
| 41 | } |
| 42 | |
Holger Hans Peter Freyther | 0e2f911 | 2011-01-17 11:54:39 +0100 | [diff] [blame] | 43 | void mtp_link_down(struct mtp_link *link) |
Holger Hans Peter Freyther | c840569 | 2011-01-02 20:24:08 +0100 | [diff] [blame] | 44 | { |
Holger Hans Peter Freyther | 0f833b0 | 2011-01-04 13:33:57 +0100 | [diff] [blame] | 45 | int one_up; |
| 46 | int was_up; |
| 47 | |
| 48 | was_up = link->available; |
| 49 | link->available = 0; |
Holger Hans Peter Freyther | a8ce061 | 2011-01-20 16:30:24 +0100 | [diff] [blame] | 50 | link->was_up = 0; |
Holger Hans Peter Freyther | 2d845fc | 2011-01-20 15:42:13 +0100 | [diff] [blame] | 51 | one_up = is_one_up(link->set); |
Holger Hans Peter Freyther | 0f833b0 | 2011-01-04 13:33:57 +0100 | [diff] [blame] | 52 | |
| 53 | /* our linkset is now unsuable */ |
| 54 | if (was_up && !one_up) |
Holger Hans Peter Freyther | 2d845fc | 2011-01-20 15:42:13 +0100 | [diff] [blame] | 55 | mtp_linkset_down(link->set); |
Holger Hans Peter Freyther | c840569 | 2011-01-02 20:24:08 +0100 | [diff] [blame] | 56 | link->clear_queue(link); |
Holger Hans Peter Freyther | a8ce061 | 2011-01-20 16:30:24 +0100 | [diff] [blame] | 57 | mtp_link_stop_link_test(link); |
Holger Hans Peter Freyther | 2d845fc | 2011-01-20 15:42:13 +0100 | [diff] [blame] | 58 | mtp_link_set_init_slc(link->set); |
Holger Hans Peter Freyther | c840569 | 2011-01-02 20:24:08 +0100 | [diff] [blame] | 59 | } |
| 60 | |
Holger Hans Peter Freyther | 0e2f911 | 2011-01-17 11:54:39 +0100 | [diff] [blame] | 61 | void mtp_link_up(struct mtp_link *link) |
Holger Hans Peter Freyther | c840569 | 2011-01-02 20:24:08 +0100 | [diff] [blame] | 62 | { |
Holger Hans Peter Freyther | 0f833b0 | 2011-01-04 13:33:57 +0100 | [diff] [blame] | 63 | int one_up; |
| 64 | |
Holger Hans Peter Freyther | 2d845fc | 2011-01-20 15:42:13 +0100 | [diff] [blame] | 65 | one_up = is_one_up(link->set); |
Holger Hans Peter Freyther | 0f833b0 | 2011-01-04 13:33:57 +0100 | [diff] [blame] | 66 | link->available = 1; |
Holger Hans Peter Freyther | a8ce061 | 2011-01-20 16:30:24 +0100 | [diff] [blame] | 67 | link->was_up = 0; |
Holger Hans Peter Freyther | 0f833b0 | 2011-01-04 13:33:57 +0100 | [diff] [blame] | 68 | |
Holger Hans Peter Freyther | 2d845fc | 2011-01-20 15:42:13 +0100 | [diff] [blame] | 69 | mtp_link_set_init_slc(link->set); |
Holger Hans Peter Freyther | 0f833b0 | 2011-01-04 13:33:57 +0100 | [diff] [blame] | 70 | if (!one_up) |
Holger Hans Peter Freyther | 2d845fc | 2011-01-20 15:42:13 +0100 | [diff] [blame] | 71 | mtp_linkset_up(link->set); |
Holger Hans Peter Freyther | a8ce061 | 2011-01-20 16:30:24 +0100 | [diff] [blame] | 72 | else |
| 73 | mtp_link_start_link_test(link); |
Holger Hans Peter Freyther | c840569 | 2011-01-02 20:24:08 +0100 | [diff] [blame] | 74 | } |
| 75 | |
Holger Hans Peter Freyther | 0e2f911 | 2011-01-17 11:54:39 +0100 | [diff] [blame] | 76 | void mtp_link_restart(struct mtp_link *link) |
Holger Hans Peter Freyther | a99b04b | 2011-01-02 11:23:54 +0100 | [diff] [blame] | 77 | { |
| 78 | 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] | 79 | link->reset(link); |
Holger Hans Peter Freyther | a99b04b | 2011-01-02 11:23:54 +0100 | [diff] [blame] | 80 | } |
| 81 | |
| 82 | static void start_rest(void *start) |
| 83 | { |
Holger Hans Peter Freyther | 0e2f911 | 2011-01-17 11:54:39 +0100 | [diff] [blame] | 84 | struct mtp_link *data; |
Holger Hans Peter Freyther | a99b04b | 2011-01-02 11:23:54 +0100 | [diff] [blame] | 85 | bsc.setup = 1; |
| 86 | |
| 87 | if (msc_init(&bsc, 1) != 0) { |
| 88 | fprintf(stderr, "Failed to init MSC part.\n"); |
| 89 | exit(3); |
| 90 | } |
| 91 | |
Holger Hans Peter Freyther | fe72c16 | 2011-01-04 13:21:52 +0100 | [diff] [blame] | 92 | llist_for_each_entry(data, &bsc.link_set->links, entry) |
| 93 | data->start(data); |
Holger Hans Peter Freyther | a99b04b | 2011-01-02 11:23:54 +0100 | [diff] [blame] | 94 | } |
| 95 | |
| 96 | int link_init(struct bsc_data *bsc) |
| 97 | { |
Holger Hans Peter Freyther | c6bfa27 | 2011-01-22 17:06:34 +0100 | [diff] [blame] | 98 | int i; |
Holger Hans Peter Freyther | 0e2f911 | 2011-01-17 11:54:39 +0100 | [diff] [blame] | 99 | struct mtp_udp_link *lnk; |
Holger Hans Peter Freyther | fe72c16 | 2011-01-04 13:21:52 +0100 | [diff] [blame] | 100 | |
Holger Hans Peter Freyther | 644aafb | 2011-01-03 23:51:07 +0100 | [diff] [blame] | 101 | bsc->link_set = mtp_link_set_alloc(); |
| 102 | bsc->link_set->dpc = bsc->dpc; |
| 103 | bsc->link_set->opc = bsc->opc; |
| 104 | bsc->link_set->sccp_opc = bsc->sccp_opc > -1 ? bsc->sccp_opc : bsc->opc; |
Holger Hans Peter Freyther | d8a73e2 | 2011-01-17 22:37:11 +0100 | [diff] [blame] | 105 | bsc->link_set->isup_opc = bsc->isup_opc > -1 ? bsc->isup_opc : bsc->opc; |
Holger Hans Peter Freyther | 644aafb | 2011-01-03 23:51:07 +0100 | [diff] [blame] | 106 | bsc->link_set->sltm_once = bsc->once; |
| 107 | bsc->link_set->ni = bsc->ni_ni; |
| 108 | bsc->link_set->spare = bsc->ni_spare; |
| 109 | bsc->link_set->bsc = bsc; |
Holger Hans Peter Freyther | f6375b4 | 2011-01-22 21:01:23 +0100 | [diff] [blame] | 110 | bsc->link_set->pcap_fd = bsc->pcap_fd; |
Holger Hans Peter Freyther | 644aafb | 2011-01-03 23:51:07 +0100 | [diff] [blame] | 111 | |
Holger Hans Peter Freyther | a99b04b | 2011-01-02 11:23:54 +0100 | [diff] [blame] | 112 | if (!bsc->src_port) { |
| 113 | LOGP(DINP, LOGL_ERROR, "You need to set a UDP address.\n"); |
| 114 | return -1; |
| 115 | } |
| 116 | |
| 117 | LOGP(DINP, LOGL_NOTICE, "Using UDP MTP mode.\n"); |
| 118 | |
Holger Hans Peter Freyther | eab2096 | 2011-01-21 18:00:36 +0100 | [diff] [blame] | 119 | if (link_global_init(&bsc->udp_data, bsc->udp_ip, bsc->src_port) != 0) |
Holger Hans Peter Freyther | a99b04b | 2011-01-02 11:23:54 +0100 | [diff] [blame] | 120 | return -1; |
| 121 | |
Holger Hans Peter Freyther | a99b04b | 2011-01-02 11:23:54 +0100 | [diff] [blame] | 122 | |
Holger Hans Peter Freyther | c6bfa27 | 2011-01-22 17:06:34 +0100 | [diff] [blame] | 123 | for (i = 1; i <= bsc->udp_nr_links; ++i) { |
| 124 | lnk = talloc_zero(bsc->link_set, struct mtp_udp_link); |
Holger Hans Peter Freyther | f6375b4 | 2011-01-22 21:01:23 +0100 | [diff] [blame] | 125 | lnk->base.pcap_fd = -1; |
Holger Hans Peter Freyther | c6bfa27 | 2011-01-22 17:06:34 +0100 | [diff] [blame] | 126 | lnk->bsc = bsc; |
| 127 | lnk->data = &bsc->udp_data; |
| 128 | lnk->link_index = i; |
| 129 | lnk->reset_timeout = bsc->udp_reset_timeout; |
| 130 | mtp_link_set_add_link(bsc->link_set, (struct mtp_link *) lnk); |
| 131 | |
| 132 | |
| 133 | /* now connect to the transport */ |
| 134 | if (link_udp_init(lnk, bsc->udp_ip, bsc->udp_port) != 0) |
| 135 | return -1; |
| 136 | |
| 137 | /* |
| 138 | * We will ask the MTP link to be taken down for two |
| 139 | * timeouts of the BSC to make sure we are missing the |
| 140 | * SLTM and it begins a reset. Then we will take it up |
| 141 | * again and do the usual business. |
| 142 | */ |
| 143 | snmp_mtp_deactivate(lnk->data->session, |
| 144 | lnk->link_index); |
| 145 | bsc->start_timer.cb = start_rest; |
| 146 | bsc->start_timer.data = &bsc; |
| 147 | bsc_schedule_timer(&bsc->start_timer, lnk->reset_timeout, 0); |
| 148 | LOGP(DMSC, LOGL_NOTICE, "Making sure SLTM will timeout.\n"); |
| 149 | } |
Holger Hans Peter Freyther | a99b04b | 2011-01-02 11:23:54 +0100 | [diff] [blame] | 150 | |
| 151 | return 0; |
| 152 | } |
Holger Hans Peter Freyther | fe72c16 | 2011-01-04 13:21:52 +0100 | [diff] [blame] | 153 | |
| 154 | int link_shutdown_all(struct mtp_link_set *set) |
| 155 | { |
Holger Hans Peter Freyther | 0e2f911 | 2011-01-17 11:54:39 +0100 | [diff] [blame] | 156 | struct mtp_link *lnk; |
Holger Hans Peter Freyther | fe72c16 | 2011-01-04 13:21:52 +0100 | [diff] [blame] | 157 | |
| 158 | llist_for_each_entry(lnk, &set->links, entry) |
| 159 | lnk->shutdown(lnk); |
| 160 | return 0; |
| 161 | } |
| 162 | |
| 163 | int link_reset_all(struct mtp_link_set *set) |
| 164 | { |
Holger Hans Peter Freyther | 0e2f911 | 2011-01-17 11:54:39 +0100 | [diff] [blame] | 165 | struct mtp_link *lnk; |
Holger Hans Peter Freyther | fe72c16 | 2011-01-04 13:21:52 +0100 | [diff] [blame] | 166 | |
| 167 | llist_for_each_entry(lnk, &set->links, entry) |
| 168 | lnk->reset(lnk); |
| 169 | return 0; |
| 170 | } |
| 171 | |
| 172 | int link_clear_all(struct mtp_link_set *set) |
| 173 | { |
Holger Hans Peter Freyther | 0e2f911 | 2011-01-17 11:54:39 +0100 | [diff] [blame] | 174 | struct mtp_link *lnk; |
Holger Hans Peter Freyther | fe72c16 | 2011-01-04 13:21:52 +0100 | [diff] [blame] | 175 | |
| 176 | llist_for_each_entry(lnk, &set->links, entry) |
| 177 | lnk->clear_queue(lnk); |
| 178 | return 0; |
| 179 | } |
Holger Hans Peter Freyther | ddf8eae | 2011-01-22 17:36:01 +0100 | [diff] [blame] | 180 | |
Holger Hans Peter Freyther | 36260e9 | 2011-01-22 17:37:56 +0100 | [diff] [blame] | 181 | 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] | 182 | { |
Holger Hans Peter Freyther | 8ade9b7 | 2011-01-23 16:18:18 +0100 | [diff] [blame^] | 183 | if (link->pcap_fd >= 0) |
Holger Hans Peter Freyther | f6375b4 | 2011-01-22 21:01:23 +0100 | [diff] [blame] | 184 | mtp_pcap_write_msu(link->pcap_fd, data, len); |
Holger Hans Peter Freyther | 8ade9b7 | 2011-01-23 16:18:18 +0100 | [diff] [blame^] | 185 | if (link->set->pcap_fd >= 0) |
Holger Hans Peter Freyther | f6375b4 | 2011-01-22 21:01:23 +0100 | [diff] [blame] | 186 | mtp_pcap_write_msu(link->set->pcap_fd, data, len); |
Holger Hans Peter Freyther | 16b07c6 | 2011-01-22 23:19:27 +0100 | [diff] [blame] | 187 | |
| 188 | /* This might be too expensive? */ |
| 189 | LOGP(DPCAP, LOGL_NOTICE, "Packet: %s\n", hexdump(data, len)); |
Holger Hans Peter Freyther | ddf8eae | 2011-01-22 17:36:01 +0100 | [diff] [blame] | 190 | return 0; |
| 191 | } |