blob: 8ffdb19407828a659150bd8e26b79fca85da2e66 [file] [log] [blame]
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +02001/* OpenBSC Abis input driver for ip.access */
2
3/* (C) 2009 by Harald Welte <laforge@gnumonks.org>
4 * (C) 2010 by Holger Hans Peter Freyther
5 * (C) 2010 by On-Waves
6 *
7 * All Rights Reserved
8 *
9 * This program is free software; you can redistribute it and/or modify
10 * it under the terms of the GNU Affero General Public License as published by
11 * the Free Software Foundation; either version 3 of the License, or
12 * (at your option) any later version.
13 *
14 * This program is distributed in the hope that it will be useful,
15 * but WITHOUT ANY WARRANTY; without even the implied warranty of
16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
17 * GNU Affero General Public License for more details.
18 *
19 * You should have received a copy of the GNU Affero General Public License
20 * along with this program. If not, see <http://www.gnu.org/licenses/>.
21 *
22 */
23
24#include "internal.h"
25
26#include <stdio.h>
27#include <unistd.h>
28#include <stdlib.h>
Pablo Neira Ayusoeb434132011-07-07 19:19:46 +020029#include <stdbool.h>
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +020030#include <errno.h>
Daniel Willmann85980722014-01-09 14:30:55 +010031#include <netinet/tcp.h>
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +020032#include <string.h>
33#include <time.h>
34#include <sys/fcntl.h>
35#include <sys/socket.h>
36#include <sys/ioctl.h>
37#include <arpa/inet.h>
38
39#include <osmocom/core/select.h>
40#include <osmocom/gsm/tlv.h>
41#include <osmocom/core/msgb.h>
Harald Weltef5efba42014-08-18 17:30:36 +020042#include <osmocom/core/macaddr.h>
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +020043#include <osmocom/core/logging.h>
Harald Welte71d87b22011-07-18 14:49:56 +020044#include <osmocom/core/talloc.h>
Pablo Neira Ayuso177094b2011-06-07 12:21:51 +020045#include <osmocom/abis/e1_input.h>
46#include <osmocom/abis/ipaccess.h>
Pablo Neira Ayusof67471f2011-06-07 11:25:49 +020047#include <osmocom/core/socket.h>
Pablo Neira Ayuso96e81282011-06-09 15:06:11 +020048#include <osmocom/abis/ipa.h>
Pablo Neira Ayusoef132692013-07-08 01:17:27 +020049#include <osmocom/core/backtrace.h>
Harald Welteb65f58f2014-08-20 22:04:11 +020050#include <osmocom/gsm/ipa.h>
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +020051
Pablo Neira Ayuso54b49792011-06-07 12:15:26 +020052static void *tall_ipa_ctx;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +020053
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +020054#define TS1_ALLOC_SIZE 900
55
Daniel Willmann85980722014-01-09 14:30:55 +010056#define DEFAULT_TCP_KEEPALIVE_IDLE_TIMEOUT 30
57#define DEFAULT_TCP_KEEPALIVE_INTERVAL 3
58#define DEFAULT_TCP_KEEPALIVE_RETRY_COUNT 10
59
Harald Welte10b41302013-06-30 14:05:49 +020060static int ipaccess_drop(struct osmo_fd *bfd, struct e1inp_line *line)
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +020061{
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +020062 int ret = 1;
Jacob Erlbeck98af3c32014-03-31 10:53:32 +020063 unsigned int ts_nr = bfd->priv_nr;
64 struct e1inp_ts *e1i_ts = &line->ts[ts_nr-1];
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +020065
Pablo Neira Ayuso466c5462011-07-07 19:17:20 +020066 /* Error case: we did not see any ID_RESP yet for this socket. */
67 if (bfd->fd != -1) {
Harald Weltecc2241b2011-07-19 16:06:06 +020068 LOGP(DLINP, LOGL_ERROR, "Forcing socket shutdown with "
Pablo Neira Ayuso466c5462011-07-07 19:17:20 +020069 "no signal link set\n");
Pablo Neira Ayuso9621b412011-07-07 16:19:21 +020070 osmo_fd_unregister(bfd);
71 close(bfd->fd);
72 bfd->fd = -1;
Pablo Neira Ayuso466c5462011-07-07 19:17:20 +020073 ret = -ENOENT;
Pablo Neira Ayuso9621b412011-07-07 16:19:21 +020074 }
Pablo Neira Ayuso6cc3f922012-08-22 13:57:58 +020075
Jacob Erlbeck98af3c32014-03-31 10:53:32 +020076 msgb_free(e1i_ts->pending_msg);
77 e1i_ts->pending_msg = NULL;
78
Pablo Neira Ayuso6cc3f922012-08-22 13:57:58 +020079 /* e1inp_sign_link_destroy releases the socket descriptors for us. */
80 line->ops->sign_link_down(line);
81
Pablo Neira Ayuso466c5462011-07-07 19:17:20 +020082 return ret;
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +020083}
84
Pablo Neira Ayuso5a4b7c52011-06-07 14:07:48 +020085static int ipaccess_rcvmsg(struct e1inp_line *line, struct msgb *msg,
86 struct osmo_fd *bfd)
87{
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +020088 struct tlv_parsed tlvp;
Pablo Neira Ayuso5a4b7c52011-06-07 14:07:48 +020089 uint8_t msg_type = *(msg->l2h);
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +020090 struct ipaccess_unit unit_data = {};
91 struct e1inp_sign_link *sign_link;
92 char *unitid;
93 int len, ret;
Pablo Neira Ayuso5a4b7c52011-06-07 14:07:48 +020094
Pablo Neira Ayusoeb434132011-07-07 19:19:46 +020095 /* Handle IPA PING, PONG and ID_ACK messages. */
Harald Welteb65f58f2014-08-20 22:04:11 +020096 ret = ipa_ccm_rcvmsg_base(msg, bfd);
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +020097 switch(ret) {
98 case -1:
99 /* error in IPA control message handling */
100 goto err;
101 case 1:
102 /* this is an IPA control message, skip further processing */
Pablo Neira Ayusoeb434132011-07-07 19:19:46 +0200103 return 0;
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200104 case 0:
105 /* this is not an IPA control message, continue */
106 break;
107 default:
108 LOGP(DLINP, LOGL_ERROR, "Unexpected return from "
Harald Welteb65f58f2014-08-20 22:04:11 +0200109 "ipa_ccm_rcvmsg_base "
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200110 "(ret=%d)\n", ret);
111 goto err;
112 }
Pablo Neira Ayuso5a4b7c52011-06-07 14:07:48 +0200113
114 switch (msg_type) {
115 case IPAC_MSGT_ID_RESP:
Harald Weltecc2241b2011-07-19 16:06:06 +0200116 DEBUGP(DLMI, "ID_RESP\n");
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200117 /* parse tags, search for Unit ID */
Harald Welteb65f58f2014-08-20 22:04:11 +0200118 ret = ipa_ccm_idtag_parse(&tlvp, (uint8_t *)msg->l2h + 2,
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200119 msgb_l2len(msg)-2);
Harald Weltecc2241b2011-07-19 16:06:06 +0200120 DEBUGP(DLMI, "\n");
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200121 if (ret < 0) {
Harald Weltecc2241b2011-07-19 16:06:06 +0200122 LOGP(DLINP, LOGL_ERROR, "IPA response message "
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200123 "with malformed TLVs\n");
Pablo Neira Ayuso466c5462011-07-07 19:17:20 +0200124 ret = -EINVAL;
125 goto err;
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200126 }
Pablo Neira Ayuso466c5462011-07-07 19:17:20 +0200127 if (!TLVP_PRESENT(&tlvp, IPAC_IDTAG_UNIT)) {
Harald Weltecc2241b2011-07-19 16:06:06 +0200128 LOGP(DLINP, LOGL_ERROR, "IPA response message "
Pablo Neira Ayuso466c5462011-07-07 19:17:20 +0200129 "without unit ID\n");
130 ret = -EINVAL;
131 goto err;
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200132
Pablo Neira Ayuso466c5462011-07-07 19:17:20 +0200133 }
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200134 len = TLVP_LEN(&tlvp, IPAC_IDTAG_UNIT);
Pablo Neira Ayuso466c5462011-07-07 19:17:20 +0200135 if (len < 1) {
Harald Weltecc2241b2011-07-19 16:06:06 +0200136 LOGP(DLINP, LOGL_ERROR, "IPA response message "
Pablo Neira Ayuso466c5462011-07-07 19:17:20 +0200137 "with too small unit ID\n");
138 ret = -EINVAL;
139 goto err;
140 }
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200141 unitid = (char *) TLVP_VAL(&tlvp, IPAC_IDTAG_UNIT);
142 unitid[len - 1] = '\0';
Harald Welteb65f58f2014-08-20 22:04:11 +0200143 ipa_parse_unitid(unitid, &unit_data);
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200144
Pablo Neira Ayusof163d232011-06-25 18:42:55 +0200145 if (!line->ops->sign_link_up) {
Harald Weltecc2241b2011-07-19 16:06:06 +0200146 LOGP(DLINP, LOGL_ERROR,
Pablo Neira Ayusocd8d2e52011-07-02 17:05:21 +0200147 "Unable to set signal link, closing socket.\n");
Pablo Neira Ayuso466c5462011-07-07 19:17:20 +0200148 ret = -EINVAL;
149 goto err;
Pablo Neira Ayuso5a4b7c52011-06-07 14:07:48 +0200150 }
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200151 /* the BSC creates the new sign links at this stage. */
152 if (bfd->priv_nr == E1INP_SIGN_OML) {
153 sign_link =
154 line->ops->sign_link_up(&unit_data, line,
155 E1INP_SIGN_OML);
156 if (sign_link == NULL) {
Harald Weltecc2241b2011-07-19 16:06:06 +0200157 LOGP(DLINP, LOGL_ERROR,
Pablo Neira Ayusocd8d2e52011-07-02 17:05:21 +0200158 "Unable to set signal link, "
159 "closing socket.\n");
Pablo Neira Ayuso466c5462011-07-07 19:17:20 +0200160 ret = -EINVAL;
161 goto err;
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200162 }
163 } else if (bfd->priv_nr == E1INP_SIGN_RSL) {
Pablo Neira Ayuso3832c4f2011-07-07 17:47:26 +0200164 struct e1inp_ts *ts;
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200165 struct osmo_fd *newbfd;
Pablo Neira Ayuso3832c4f2011-07-07 17:47:26 +0200166 struct e1inp_line *new_line;
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200167
168 sign_link =
169 line->ops->sign_link_up(&unit_data, line,
170 E1INP_SIGN_RSL);
171 if (sign_link == NULL) {
Harald Weltecc2241b2011-07-19 16:06:06 +0200172 LOGP(DLINP, LOGL_ERROR,
Pablo Neira Ayusocd8d2e52011-07-02 17:05:21 +0200173 "Unable to set signal link, "
174 "closing socket.\n");
Pablo Neira Ayuso466c5462011-07-07 19:17:20 +0200175 ret = -EINVAL;
176 goto err;
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200177 }
Pablo Neira Ayusodb1c8a72011-07-08 15:12:03 +0200178 /* this is a bugtrap, the BSC should be using the
179 * virtual E1 line used by OML for this RSL link. */
180 if (sign_link->ts->line == line) {
Harald Weltecc2241b2011-07-19 16:06:06 +0200181 LOGP(DLINP, LOGL_ERROR,
Pablo Neira Ayusodb1c8a72011-07-08 15:12:03 +0200182 "Fix your BSC, you should use the "
183 "E1 line used by the OML link for "
184 "your RSL link.\n");
185 return 0;
186 }
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200187 /* Finally, we know which OML link is associated with
188 * this RSL link, attach it to this socket. */
Pablo Neira Ayuso3832c4f2011-07-07 17:47:26 +0200189 bfd->data = new_line = sign_link->ts->line;
190 e1inp_line_get(new_line);
191 ts = &new_line->ts[E1INP_SIGN_RSL+unit_data.trx_id-1];
192 newbfd = &ts->driver.ipaccess.fd;
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200193
194 /* get rid of our old temporary bfd */
195 memcpy(newbfd, bfd, sizeof(*newbfd));
196 newbfd->priv_nr = E1INP_SIGN_RSL + unit_data.trx_id;
197 osmo_fd_unregister(bfd);
198 bfd->fd = -1;
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200199 osmo_fd_register(newbfd);
Pablo Neira Ayuso3832c4f2011-07-07 17:47:26 +0200200 /* now we can release the dummy RSL line. */
201 e1inp_line_put(line);
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200202 }
Pablo Neira Ayuso5a4b7c52011-06-07 14:07:48 +0200203 break;
Pablo Neira Ayuso466c5462011-07-07 19:17:20 +0200204 default:
Harald Weltecc2241b2011-07-19 16:06:06 +0200205 LOGP(DLINP, LOGL_ERROR, "Unknown IPA message type\n");
Pablo Neira Ayuso466c5462011-07-07 19:17:20 +0200206 ret = -EINVAL;
207 goto err;
Pablo Neira Ayuso5a4b7c52011-06-07 14:07:48 +0200208 }
209 return 0;
Pablo Neira Ayuso466c5462011-07-07 19:17:20 +0200210err:
211 osmo_fd_unregister(bfd);
212 close(bfd->fd);
213 bfd->fd = -1;
Pablo Neira Ayuso3832c4f2011-07-07 17:47:26 +0200214 e1inp_line_put(line);
Pablo Neira Ayuso466c5462011-07-07 19:17:20 +0200215 return ret;
Pablo Neira Ayuso5a4b7c52011-06-07 14:07:48 +0200216}
217
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200218static int handle_ts1_read(struct osmo_fd *bfd)
219{
220 struct e1inp_line *line = bfd->data;
221 unsigned int ts_nr = bfd->priv_nr;
Pablo Neira Ayuso3832c4f2011-07-07 17:47:26 +0200222 struct e1inp_ts *e1i_ts = &line->ts[ts_nr-1];
Pablo Neira Ayuso5a4b7c52011-06-07 14:07:48 +0200223 struct e1inp_sign_link *link;
224 struct ipaccess_head *hh;
Jacob Erlbeck98af3c32014-03-31 10:53:32 +0200225 struct msgb *msg = NULL;
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200226 int ret;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200227
Jacob Erlbeck98af3c32014-03-31 10:53:32 +0200228 ret = ipa_msg_recv_buffered(bfd->fd, &msg, &e1i_ts->pending_msg);
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200229 if (ret < 0) {
Jacob Erlbeck98af3c32014-03-31 10:53:32 +0200230 if (ret == -EAGAIN)
231 return 0;
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200232 LOGP(DLINP, LOGL_NOTICE, "Sign link problems, "
Jacob Erlbeck98af3c32014-03-31 10:53:32 +0200233 "closing socket. Reason: %s\n", strerror(-ret));
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200234 goto err;
235 } else if (ret == 0) {
236 LOGP(DLINP, LOGL_NOTICE, "Sign link vanished, dead socket\n");
237 goto err;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200238 }
Harald Weltecc2241b2011-07-19 16:06:06 +0200239 DEBUGP(DLMI, "RX %u: %s\n", ts_nr, osmo_hexdump(msgb_l2(msg), msgb_l2len(msg)));
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200240
Pablo Neira Ayuso5a4b7c52011-06-07 14:07:48 +0200241 hh = (struct ipaccess_head *) msg->data;
242 if (hh->proto == IPAC_PROTO_IPACCESS) {
243 ipaccess_rcvmsg(line, msg, bfd);
244 msgb_free(msg);
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200245 return 0;
Holger Hans Peter Freyther63ddf462013-12-28 21:19:19 +0100246 } else if (e1i_ts->type == E1INP_TS_TYPE_NONE) {
247 /* this sign link is not know yet.. complain. */
248 LOGP(DLINP, LOGL_ERROR, "Timeslot is not configured.\n");
249 ret = -EINVAL;
250 goto err_msg;
Pablo Neira Ayuso5a4b7c52011-06-07 14:07:48 +0200251 }
252 /* BIG FAT WARNING: bfd might no longer exist here, since ipaccess_rcvmsg()
253 * might have free'd it !!! */
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200254
Pablo Neira Ayuso5a4b7c52011-06-07 14:07:48 +0200255 link = e1inp_lookup_sign_link(e1i_ts, hh->proto, 0);
256 if (!link) {
Harald Weltecc2241b2011-07-19 16:06:06 +0200257 LOGP(DLINP, LOGL_ERROR, "no matching signalling link for "
Pablo Neira Ayuso5a4b7c52011-06-07 14:07:48 +0200258 "hh->proto=0x%02x\n", hh->proto);
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200259 ret = -EINVAL;
260 goto err_msg;
Pablo Neira Ayuso5a4b7c52011-06-07 14:07:48 +0200261 }
262 msg->dst = link;
263
264 /* XXX better use e1inp_ts_rx? */
Pablo Neira Ayusof163d232011-06-25 18:42:55 +0200265 if (!e1i_ts->line->ops->sign_link) {
Harald Weltecc2241b2011-07-19 16:06:06 +0200266 LOGP(DLINP, LOGL_ERROR, "Fix your application, "
Pablo Neira Ayuso5a4b7c52011-06-07 14:07:48 +0200267 "no action set for signalling messages.\n");
Pablo Neira Ayuso466c5462011-07-07 19:17:20 +0200268 ret = -EINVAL;
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200269 goto err_msg;
Pablo Neira Ayuso5a4b7c52011-06-07 14:07:48 +0200270 }
Pablo Neira Ayuso466c5462011-07-07 19:17:20 +0200271 if (e1i_ts->line->ops->sign_link(msg) < 0) {
Pablo Neira Ayusoa49c24d2012-10-16 11:24:08 +0200272 /* Don't close the signalling link if the upper layers report
273 * an error, that's too strict. BTW, the signalling layer is
274 * resposible for releasing the message.
275 */
Harald Weltecc2241b2011-07-19 16:06:06 +0200276 LOGP(DLINP, LOGL_ERROR, "Bad signalling message,"
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200277 "sign_link returned error\n");
Pablo Neira Ayuso466c5462011-07-07 19:17:20 +0200278 }
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200279
280 return 0;
281err_msg:
282 msgb_free(msg);
Pablo Neira Ayuso466c5462011-07-07 19:17:20 +0200283err:
Harald Welte10b41302013-06-30 14:05:49 +0200284 ipaccess_drop(bfd, line);
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200285 return ret;
286}
287
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200288static int ts_want_write(struct e1inp_ts *e1i_ts)
289{
290 e1i_ts->driver.ipaccess.fd.when |= BSC_FD_WRITE;
291
292 return 0;
293}
294
Pablo Neira Ayusoadd3ec82011-07-05 14:45:46 +0200295static void ipaccess_close(struct e1inp_sign_link *sign_link)
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200296{
Pablo Neira Ayusoadd3ec82011-07-05 14:45:46 +0200297 struct e1inp_ts *e1i_ts = sign_link->ts;
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200298 struct osmo_fd *bfd = &e1i_ts->driver.ipaccess.fd;
Holger Hans Peter Freyther55467f02011-12-28 19:47:07 +0100299 return e1inp_close_socket(e1i_ts, sign_link, bfd);
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200300}
301
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200302static void timeout_ts1_write(void *data)
303{
304 struct e1inp_ts *e1i_ts = (struct e1inp_ts *)data;
305
306 /* trigger write of ts1, due to tx delay timer */
307 ts_want_write(e1i_ts);
308}
309
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200310static int __handle_ts1_write(struct osmo_fd *bfd, struct e1inp_line *line)
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200311{
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200312 unsigned int ts_nr = bfd->priv_nr;
313 struct e1inp_ts *e1i_ts = &line->ts[ts_nr-1];
314 struct e1inp_sign_link *sign_link;
315 struct msgb *msg;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200316 int ret;
317
318 bfd->when &= ~BSC_FD_WRITE;
319
320 /* get the next msg for this timeslot */
321 msg = e1inp_tx_ts(e1i_ts, &sign_link);
322 if (!msg) {
323 /* no message after tx delay timer */
324 return 0;
325 }
326
327 switch (sign_link->type) {
328 case E1INP_SIGN_OML:
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200329 case E1INP_SIGN_RSL:
Harald Welte46fc7e22014-08-18 19:04:26 +0200330 case E1INP_SIGN_OSMO:
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200331 break;
332 default:
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200333 bfd->when |= BSC_FD_WRITE; /* come back for more msg */
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200334 ret = -EINVAL;
335 goto out;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200336 }
337
338 msg->l2h = msg->data;
Harald Welteb65f58f2014-08-20 22:04:11 +0200339 ipa_prepend_header(msg, sign_link->tei);
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200340
Harald Weltecc2241b2011-07-19 16:06:06 +0200341 DEBUGP(DLMI, "TX %u: %s\n", ts_nr, osmo_hexdump(msg->l2h, msgb_l2len(msg)));
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200342
343 ret = send(bfd->fd, msg->data, msg->len, 0);
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200344 if (ret != msg->len) {
345 LOGP(DLINP, LOGL_ERROR, "failed to send A-bis IPA signalling "
346 "message. Reason: %s\n", strerror(errno));
347 goto err;
348 }
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200349
350 /* set tx delay timer for next event */
351 e1i_ts->sign.tx_timer.cb = timeout_ts1_write;
352 e1i_ts->sign.tx_timer.data = e1i_ts;
353
354 /* Reducing this might break the nanoBTS 900 init. */
355 osmo_timer_schedule(&e1i_ts->sign.tx_timer, 0, e1i_ts->sign.delay);
356
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200357out:
358 msgb_free(msg);
359 return ret;
360err:
Harald Welte10b41302013-06-30 14:05:49 +0200361 ipaccess_drop(bfd, line);
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200362 msgb_free(msg);
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200363 return ret;
364}
365
Pablo Neira Ayuso88136fc2011-07-08 16:21:55 +0200366static int handle_ts1_write(struct osmo_fd *bfd)
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200367{
368 struct e1inp_line *line = bfd->data;
369
370 return __handle_ts1_write(bfd, line);
371}
372
Pablo Neira Ayusof0995672011-09-08 12:58:38 +0200373static int ipaccess_bts_write_cb(struct ipa_client_conn *link)
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200374{
375 struct e1inp_line *line = link->line;
376
377 return __handle_ts1_write(link->ofd, line);
378}
379
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200380/* callback from select.c in case one of the fd's can be read/written */
Pablo Neira Ayuso495ddb62011-07-08 21:04:11 +0200381int ipaccess_fd_cb(struct osmo_fd *bfd, unsigned int what)
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200382{
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200383 int rc = 0;
384
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200385 if (what & BSC_FD_READ)
386 rc = handle_ts1_read(bfd);
387 if (what & BSC_FD_WRITE)
388 rc = handle_ts1_write(bfd);
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200389
390 return rc;
391}
392
Pablo Neira Ayuso4e862cb2011-08-19 18:43:38 +0200393static int ipaccess_line_update(struct e1inp_line *line);
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200394
395struct e1inp_driver ipaccess_driver = {
396 .name = "ipa",
397 .want_write = ts_want_write,
398 .line_update = ipaccess_line_update,
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200399 .close = ipaccess_close,
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200400 .default_delay = 0,
Jacob Erlbeck8fe15712014-01-09 14:30:58 +0100401 .has_keepalive = 1,
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200402};
403
Jacob Erlbecka4ec51e2014-01-09 14:30:56 +0100404static void update_fd_settings(struct e1inp_line *line, int fd)
405{
406 int ret;
407 int val;
408
Jacob Erlbeck8fe15712014-01-09 14:30:58 +0100409 if (line->keepalive_num_probes) {
Jacob Erlbecka4ec51e2014-01-09 14:30:56 +0100410 /* Enable TCP keepalive to find out if the connection is gone */
411 val = 1;
412 ret = setsockopt(fd, SOL_SOCKET, SO_KEEPALIVE, &val, sizeof(val));
413 if (ret < 0)
414 LOGP(DLINP, LOGL_NOTICE, "Failed to set keepalive: %s\n",
415 strerror(errno));
416 else
417 LOGP(DLINP, LOGL_NOTICE, "Keepalive is set: %i\n", ret);
418
419#if defined(TCP_KEEPIDLE) && defined(TCP_KEEPINTVL) && defined(TCP_KEEPCNT)
420 /* The following options are not portable! */
Jacob Erlbeck8fe15712014-01-09 14:30:58 +0100421 val = line->keepalive_idle_timeout > 0 ?
422 line->keepalive_idle_timeout :
423 DEFAULT_TCP_KEEPALIVE_IDLE_TIMEOUT;
Jacob Erlbecka4ec51e2014-01-09 14:30:56 +0100424 ret = setsockopt(fd, IPPROTO_TCP, TCP_KEEPIDLE,
425 &val, sizeof(val));
426 if (ret < 0)
427 LOGP(DLINP, LOGL_NOTICE,
428 "Failed to set keepalive idle time: %s\n",
429 strerror(errno));
Jacob Erlbeck8fe15712014-01-09 14:30:58 +0100430 val = line->keepalive_probe_interval > -1 ?
431 line->keepalive_probe_interval :
432 DEFAULT_TCP_KEEPALIVE_INTERVAL;
Jacob Erlbecka4ec51e2014-01-09 14:30:56 +0100433 ret = setsockopt(fd, IPPROTO_TCP, TCP_KEEPINTVL,
434 &val, sizeof(val));
435 if (ret < 0)
436 LOGP(DLINP, LOGL_NOTICE,
437 "Failed to set keepalive interval: %s\n",
438 strerror(errno));
Jacob Erlbeck8fe15712014-01-09 14:30:58 +0100439 val = line->keepalive_num_probes > 0 ?
440 line->keepalive_num_probes :
441 DEFAULT_TCP_KEEPALIVE_RETRY_COUNT;
Jacob Erlbecka4ec51e2014-01-09 14:30:56 +0100442 ret = setsockopt(fd, IPPROTO_TCP, TCP_KEEPCNT,
443 &val, sizeof(val));
444 if (ret < 0)
445 LOGP(DLINP, LOGL_NOTICE,
446 "Failed to set keepalive count: %s\n",
447 strerror(errno));
Jacob Erlbecka4ec51e2014-01-09 14:30:56 +0100448#endif
Holger Hans Peter Freytherf465a4c2014-02-03 09:34:02 +0100449 }
Jacob Erlbecka4ec51e2014-01-09 14:30:56 +0100450}
451
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200452/* callback of the OML listening filedescriptor */
Pablo Neira Ayuso986191f2011-06-21 19:56:26 +0200453static int ipaccess_bsc_oml_cb(struct ipa_server_link *link, int fd)
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200454{
455 int ret;
456 int idx = 0;
Jacob Erlbecka4ec51e2014-01-09 14:30:56 +0100457 int i;
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200458 struct e1inp_line *line;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200459 struct e1inp_ts *e1i_ts;
460 struct osmo_fd *bfd;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200461
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200462 /* clone virtual E1 line for this new OML link. */
Pablo Neira Ayuso3832c4f2011-07-07 17:47:26 +0200463 line = e1inp_line_clone(tall_ipa_ctx, link->line);
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200464 if (line == NULL) {
Harald Weltecc2241b2011-07-19 16:06:06 +0200465 LOGP(DLINP, LOGL_ERROR, "could not clone E1 line\n");
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200466 return -ENOMEM;
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200467 }
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200468
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200469 /* create virrtual E1 timeslots for signalling */
Pablo Neira Ayuso59301852011-06-27 15:44:23 +0200470 e1inp_ts_config_sign(&line->ts[E1INP_SIGN_OML-1], line);
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200471
472 /* initialize the fds */
473 for (i = 0; i < ARRAY_SIZE(line->ts); ++i)
474 line->ts[i].driver.ipaccess.fd.fd = -1;
475
476 e1i_ts = &line->ts[idx];
477
Pablo Neira Ayuso93c62012011-06-26 19:12:47 +0200478 bfd = &e1i_ts->driver.ipaccess.fd;
Pablo Neira Ayuso986191f2011-06-21 19:56:26 +0200479 bfd->fd = fd;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200480 bfd->data = line;
Pablo Neira Ayusof163d232011-06-25 18:42:55 +0200481 bfd->priv_nr = E1INP_SIGN_OML;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200482 bfd->cb = ipaccess_fd_cb;
483 bfd->when = BSC_FD_READ;
484 ret = osmo_fd_register(bfd);
485 if (ret < 0) {
Harald Weltecc2241b2011-07-19 16:06:06 +0200486 LOGP(DLINP, LOGL_ERROR, "could not register FD\n");
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200487 goto err_line;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200488 }
489
Jacob Erlbecka4ec51e2014-01-09 14:30:56 +0100490 update_fd_settings(line, bfd->fd);
Daniel Willmann85980722014-01-09 14:30:55 +0100491
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200492 /* Request ID. FIXME: request LOCATION, HW/SW VErsion, Unit Name, Serno */
Harald Welteb65f58f2014-08-20 22:04:11 +0200493 ret = ipa_ccm_send_id_req(bfd->fd);
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200494 if (ret < 0) {
495 LOGP(DLINP, LOGL_ERROR, "could not send ID REQ. Reason: %s\n",
496 strerror(errno));
497 goto err_socket;
498 }
499 return ret;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200500
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200501err_socket:
502 osmo_fd_unregister(bfd);
503err_line:
504 close(bfd->fd);
505 bfd->fd = -1;
506 e1inp_line_put(line);
507 return ret;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200508}
509
Pablo Neira Ayuso986191f2011-06-21 19:56:26 +0200510static int ipaccess_bsc_rsl_cb(struct ipa_server_link *link, int fd)
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200511{
Pablo Neira Ayuso3832c4f2011-07-07 17:47:26 +0200512 struct e1inp_line *line;
513 struct e1inp_ts *e1i_ts;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200514 struct osmo_fd *bfd;
Pablo Neira Ayuso3832c4f2011-07-07 17:47:26 +0200515 int i, ret;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200516
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200517 /* We don't know yet which OML link to associate it with. Thus, we
Pablo Neira Ayuso3832c4f2011-07-07 17:47:26 +0200518 * allocate a temporary E1 line until we have received ID. */
519 line = e1inp_line_clone(tall_ipa_ctx, link->line);
520 if (line == NULL) {
Harald Weltecc2241b2011-07-19 16:06:06 +0200521 LOGP(DLINP, LOGL_ERROR, "could not clone E1 line\n");
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200522 return -ENOMEM;
Pablo Neira Ayuso3832c4f2011-07-07 17:47:26 +0200523 }
524 /* initialize the fds */
525 for (i = 0; i < ARRAY_SIZE(line->ts); ++i)
526 line->ts[i].driver.ipaccess.fd.fd = -1;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200527
Pablo Neira Ayuso3832c4f2011-07-07 17:47:26 +0200528 /* we need this to initialize this in case to avoid crashes in case
529 * that the socket is closed before we've seen an ID_RESP. */
530 e1inp_ts_config_sign(&line->ts[E1INP_SIGN_OML-1], line);
531
532 e1i_ts = &line->ts[E1INP_SIGN_RSL-1];
533
534 bfd = &e1i_ts->driver.ipaccess.fd;
Pablo Neira Ayuso986191f2011-06-21 19:56:26 +0200535 bfd->fd = fd;
Pablo Neira Ayuso3832c4f2011-07-07 17:47:26 +0200536 bfd->data = line;
Pablo Neira Ayusof163d232011-06-25 18:42:55 +0200537 bfd->priv_nr = E1INP_SIGN_RSL;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200538 bfd->cb = ipaccess_fd_cb;
539 bfd->when = BSC_FD_READ;
540 ret = osmo_fd_register(bfd);
541 if (ret < 0) {
Harald Weltecc2241b2011-07-19 16:06:06 +0200542 LOGP(DLINP, LOGL_ERROR, "could not register FD\n");
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200543 goto err_line;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200544 }
545 /* Request ID. FIXME: request LOCATION, HW/SW VErsion, Unit Name, Serno */
Harald Welteb65f58f2014-08-20 22:04:11 +0200546 ret = ipa_ccm_send_id_req(bfd->fd);
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200547 if (ret < 0) {
548 LOGP(DLINP, LOGL_ERROR, "could not send ID REQ. Reason: %s\n",
549 strerror(errno));
550 goto err_socket;
551 }
Jacob Erlbecka4ec51e2014-01-09 14:30:56 +0100552 update_fd_settings(line, bfd->fd);
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200553 return ret;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200554
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200555err_socket:
556 osmo_fd_unregister(bfd);
557err_line:
558 close(bfd->fd);
559 bfd->fd = -1;
560 e1inp_line_put(line);
561 return ret;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200562}
563
Pablo Neira Ayuso4bab3bf2013-07-05 15:00:13 +0200564#define IPA_STRING_MAX 64
565
Pablo Neira Ayusodfafe682011-07-02 14:32:32 +0200566static struct msgb *
Andreas Eversbergf422a752014-01-21 14:54:41 +0100567ipa_bts_id_resp(struct ipaccess_unit *dev, uint8_t *data, int len, int trx_nr)
Pablo Neira Ayusodfafe682011-07-02 14:32:32 +0200568{
569 struct msgb *nmsg;
Pablo Neira Ayuso4bab3bf2013-07-05 15:00:13 +0200570 char str[IPA_STRING_MAX];
Pablo Neira Ayusodfafe682011-07-02 14:32:32 +0200571 uint8_t *tag;
572
Pablo Neira Ayuso88136fc2011-07-08 16:21:55 +0200573 nmsg = ipa_msg_alloc(0);
Pablo Neira Ayusodfafe682011-07-02 14:32:32 +0200574 if (!nmsg)
575 return NULL;
576
577 *msgb_put(nmsg, 1) = IPAC_MSGT_ID_RESP;
578 while (len) {
579 if (len < 2) {
Harald Weltecc2241b2011-07-19 16:06:06 +0200580 LOGP(DLINP, LOGL_NOTICE,
Pablo Neira Ayusodfafe682011-07-02 14:32:32 +0200581 "Short read of ipaccess tag\n");
582 msgb_free(nmsg);
583 return NULL;
584 }
585 switch (data[1]) {
586 case IPAC_IDTAG_UNIT:
Pablo Neira Ayuso4bab3bf2013-07-05 15:00:13 +0200587 snprintf(str, sizeof(str), "%u/%u/%u",
Andreas Eversbergf422a752014-01-21 14:54:41 +0100588 dev->site_id, dev->bts_id, trx_nr);
Pablo Neira Ayusodfafe682011-07-02 14:32:32 +0200589 break;
590 case IPAC_IDTAG_MACADDR:
Pablo Neira Ayuso4bab3bf2013-07-05 15:00:13 +0200591 snprintf(str, sizeof(str),
592 "%02x:%02x:%02x:%02x:%02x:%02x",
593 dev->mac_addr[0], dev->mac_addr[1],
594 dev->mac_addr[2], dev->mac_addr[3],
595 dev->mac_addr[4], dev->mac_addr[5]);
Pablo Neira Ayusodfafe682011-07-02 14:32:32 +0200596 break;
597 case IPAC_IDTAG_LOCATION1:
Pablo Neira Ayuso4bab3bf2013-07-05 15:00:13 +0200598 strncpy(str, dev->location1, IPA_STRING_MAX);
Pablo Neira Ayusodfafe682011-07-02 14:32:32 +0200599 break;
600 case IPAC_IDTAG_LOCATION2:
Pablo Neira Ayuso4bab3bf2013-07-05 15:00:13 +0200601 strncpy(str, dev->location2, IPA_STRING_MAX);
Pablo Neira Ayusodfafe682011-07-02 14:32:32 +0200602 break;
603 case IPAC_IDTAG_EQUIPVERS:
Pablo Neira Ayuso4bab3bf2013-07-05 15:00:13 +0200604 strncpy(str, dev->equipvers, IPA_STRING_MAX);
Pablo Neira Ayusodfafe682011-07-02 14:32:32 +0200605 break;
606 case IPAC_IDTAG_SWVERSION:
Pablo Neira Ayuso4bab3bf2013-07-05 15:00:13 +0200607 strncpy(str, dev->swversion, IPA_STRING_MAX);
Pablo Neira Ayusodfafe682011-07-02 14:32:32 +0200608 break;
609 case IPAC_IDTAG_UNITNAME:
Pablo Neira Ayuso4bab3bf2013-07-05 15:00:13 +0200610 snprintf(str, sizeof(str),
611 "%s-%02x-%02x-%02x-%02x-%02x-%02x",
612 dev->unit_name,
613 dev->mac_addr[0], dev->mac_addr[1],
614 dev->mac_addr[2], dev->mac_addr[3],
615 dev->mac_addr[4], dev->mac_addr[5]);
Pablo Neira Ayusodfafe682011-07-02 14:32:32 +0200616 break;
617 case IPAC_IDTAG_SERNR:
Pablo Neira Ayuso4bab3bf2013-07-05 15:00:13 +0200618 strncpy(str, dev->serno, IPA_STRING_MAX);
Pablo Neira Ayusodfafe682011-07-02 14:32:32 +0200619 break;
620 default:
Harald Weltecc2241b2011-07-19 16:06:06 +0200621 LOGP(DLINP, LOGL_NOTICE,
Pablo Neira Ayusodfafe682011-07-02 14:32:32 +0200622 "Unknown ipaccess tag 0x%02x\n", *data);
623 msgb_free(nmsg);
624 return NULL;
625 }
Pablo Neira Ayuso4bab3bf2013-07-05 15:00:13 +0200626 str[IPA_STRING_MAX-1] = '\0';
627
Harald Weltecc2241b2011-07-19 16:06:06 +0200628 LOGP(DLINP, LOGL_INFO, " tag %d: %s\n", data[1], str);
Pablo Neira Ayusodfafe682011-07-02 14:32:32 +0200629 tag = msgb_put(nmsg, 3 + strlen(str) + 1);
630 tag[0] = 0x00;
631 tag[1] = 1 + strlen(str) + 1;
632 tag[2] = data[1];
633 memcpy(tag + 3, str, strlen(str) + 1);
634 data += 2;
635 len -= 2;
636 }
Pablo Neira Ayuso88136fc2011-07-08 16:21:55 +0200637 ipa_msg_push_header(nmsg, IPAC_PROTO_IPACCESS);
Pablo Neira Ayusodfafe682011-07-02 14:32:32 +0200638 return nmsg;
639}
640
641static struct msgb *ipa_bts_id_ack(void)
642{
643 struct msgb *nmsg2;
644
Pablo Neira Ayuso88136fc2011-07-08 16:21:55 +0200645 nmsg2 = ipa_msg_alloc(0);
Pablo Neira Ayusodfafe682011-07-02 14:32:32 +0200646 if (!nmsg2)
647 return NULL;
648
649 *msgb_put(nmsg2, 1) = IPAC_MSGT_ID_ACK;
Pablo Neira Ayuso88136fc2011-07-08 16:21:55 +0200650 ipa_msg_push_header(nmsg2, IPAC_PROTO_IPACCESS);
Pablo Neira Ayusodfafe682011-07-02 14:32:32 +0200651
652 return nmsg2;
653}
654
Harald Welte51de9ca2013-06-30 20:13:16 +0200655static void ipaccess_bts_updown_cb(struct ipa_client_conn *link, int up)
656{
657 struct e1inp_line *line = link->line;
658
659 if (up)
660 return;
661
662 if (line->ops->sign_link_down)
663 line->ops->sign_link_down(line);
664}
665
Harald Welte783715b2014-08-17 18:24:51 +0200666/* handle incoming message to BTS, check if it is an IPA CCM, and if yes,
667 * handle it accordingly (PING/PONG/ID_REQ/ID_RESP/ID_ACK) */
668int ipaccess_bts_handle_ccm(struct ipa_client_conn *link,
669 struct ipaccess_unit *dev, struct msgb *msg)
Pablo Neira Ayuso591ddad2011-06-21 18:16:42 +0200670{
671 struct ipaccess_head *hh = (struct ipaccess_head *) msg->data;
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200672 struct msgb *rmsg;
673 int ret = 0;
Pablo Neira Ayuso591ddad2011-06-21 18:16:42 +0200674
675 /* special handling for IPA CCM. */
676 if (hh->proto == IPAC_PROTO_IPACCESS) {
677 uint8_t msg_type = *(msg->l2h);
678
679 /* ping, pong and acknowledgment cases. */
Harald Welteb65f58f2014-08-20 22:04:11 +0200680 ret = ipa_ccm_rcvmsg_bts_base(msg, link->ofd);
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200681 if (ret < 0)
682 goto err;
Pablo Neira Ayuso591ddad2011-06-21 18:16:42 +0200683
684 /* this is a request for identification from the BSC. */
685 if (msg_type == IPAC_MSGT_ID_GET) {
Pablo Neira Ayusodfafe682011-07-02 14:32:32 +0200686 uint8_t *data = msgb_l2(msg);
687 int len = msgb_l2len(msg);
Andreas Eversbergf422a752014-01-21 14:54:41 +0100688 int trx_nr = 0;
689
690 if (link->ofd->priv_nr >= E1INP_SIGN_RSL)
691 trx_nr = link->ofd->priv_nr - E1INP_SIGN_RSL;
Pablo Neira Ayusodfafe682011-07-02 14:32:32 +0200692
Harald Weltecc2241b2011-07-19 16:06:06 +0200693 LOGP(DLINP, LOGL_NOTICE, "received ID get\n");
Andreas Eversbergf422a752014-01-21 14:54:41 +0100694 rmsg = ipa_bts_id_resp(dev, data + 1, len - 1, trx_nr);
Harald Welteb65f58f2014-08-20 22:04:11 +0200695 ret = ipa_send(link->ofd->fd, rmsg->data, rmsg->len);
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200696 if (ret != rmsg->len) {
697 LOGP(DLINP, LOGL_ERROR, "cannot send ID_RESP "
698 "message. Reason: %s\n", strerror(errno));
699 goto err_rmsg;
700 }
Pablo Neira Ayusodfafe682011-07-02 14:32:32 +0200701 msgb_free(rmsg);
702
703 /* send ID_ACK. */
704 rmsg = ipa_bts_id_ack();
Harald Welteb65f58f2014-08-20 22:04:11 +0200705 ret = ipa_send(link->ofd->fd, rmsg->data, rmsg->len);
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200706 if (ret != rmsg->len) {
707 LOGP(DLINP, LOGL_ERROR, "cannot send ID_ACK "
708 "message. Reason: %s\n", strerror(errno));
709 goto err_rmsg;
710 }
Pablo Neira Ayusodfafe682011-07-02 14:32:32 +0200711 msgb_free(rmsg);
Harald Welte783715b2014-08-17 18:24:51 +0200712 }
713 return 1;
714 }
Harald Welte6eddd472013-06-30 20:18:53 +0200715
Harald Welte783715b2014-08-17 18:24:51 +0200716 return 0;
717
718err_rmsg:
719 msgb_free(rmsg);
720err:
721 ipa_client_conn_close(link);
722 return -1;
723}
724
725static int ipaccess_bts_read_cb(struct ipa_client_conn *link, struct msgb *msg)
726{
727 struct ipaccess_head *hh = (struct ipaccess_head *) msg->data;
728 struct e1inp_ts *e1i_ts = NULL;
729 struct e1inp_sign_link *sign_link;
730 int ret = 0;
731
732 /* special handling for IPA CCM. */
733 if (hh->proto == IPAC_PROTO_IPACCESS) {
734 uint8_t msg_type = *(msg->l2h);
735
736 /* this is a request for identification from the BSC. */
737 if (msg_type == IPAC_MSGT_ID_GET) {
738 if (!link->line->ops->sign_link_up) {
739 LOGP(DLINP, LOGL_ERROR,
740 "Unable to set signal link, "
741 "closing socket.\n");
742 ret = -EINVAL;
743 goto err;
744 }
745 }
746 }
747
748 /* core CCM handling */
749 ret = ipaccess_bts_handle_ccm(link, link->line->ops->cfg.ipa.dev, msg);
750 if (ret < 0)
751 goto err;
752
753 if (ret == 1 && hh->proto == IPAC_PROTO_IPACCESS) {
754 uint8_t msg_type = *(msg->l2h);
755
756 if (msg_type == IPAC_MSGT_ID_GET) {
Harald Welte6eddd472013-06-30 20:18:53 +0200757 sign_link = link->line->ops->sign_link_up(msg,
758 link->line,
759 link->ofd->priv_nr);
760 if (sign_link == NULL) {
761 LOGP(DLINP, LOGL_ERROR,
762 "Unable to set signal link, "
763 "closing socket.\n");
764 ret = -EINVAL;
765 goto err;
766 }
Pablo Neira Ayuso591ddad2011-06-21 18:16:42 +0200767 }
Pablo Neira Ayuso84e5cb92012-08-23 23:41:54 +0200768 msgb_free(msg);
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200769 return ret;
Pablo Neira Ayuso591ddad2011-06-21 18:16:42 +0200770 } else if (link->port == IPA_TCP_PORT_OML)
771 e1i_ts = &link->line->ts[0];
772 else if (link->port == IPA_TCP_PORT_RSL)
Andreas Eversbergf422a752014-01-21 14:54:41 +0100773 e1i_ts = &link->line->ts[link->ofd->priv_nr-1];
Pablo Neira Ayuso591ddad2011-06-21 18:16:42 +0200774
Pablo Neira Ayusob9487012013-07-05 14:38:43 +0200775 OSMO_ASSERT(e1i_ts != NULL);
776
Pablo Neira Ayuso591ddad2011-06-21 18:16:42 +0200777 /* look up for some existing signaling link. */
778 sign_link = e1inp_lookup_sign_link(e1i_ts, hh->proto, 0);
779 if (sign_link == NULL) {
Harald Weltecc2241b2011-07-19 16:06:06 +0200780 LOGP(DLINP, LOGL_ERROR, "no matching signalling link for "
Pablo Neira Ayuso591ddad2011-06-21 18:16:42 +0200781 "hh->proto=0x%02x\n", hh->proto);
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200782 ret = -EIO;
783 goto err;
Pablo Neira Ayuso591ddad2011-06-21 18:16:42 +0200784 }
785 msg->dst = sign_link;
786
787 /* XXX better use e1inp_ts_rx? */
Pablo Neira Ayusof163d232011-06-25 18:42:55 +0200788 if (!link->line->ops->sign_link) {
Harald Weltecc2241b2011-07-19 16:06:06 +0200789 LOGP(DLINP, LOGL_ERROR, "Fix your application, "
Pablo Neira Ayuso591ddad2011-06-21 18:16:42 +0200790 "no action set for signalling messages.\n");
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200791 ret = -ENOENT;
792 goto err;
Pablo Neira Ayuso591ddad2011-06-21 18:16:42 +0200793 }
Pablo Neira Ayusodbd82fb2011-07-05 15:29:23 +0200794 link->line->ops->sign_link(msg);
Pablo Neira Ayuso591ddad2011-06-21 18:16:42 +0200795 return 0;
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200796
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200797err:
Harald Welte783715b2014-08-17 18:24:51 +0200798 ipa_client_conn_close(link);
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200799 msgb_free(msg);
800 return ret;
Pablo Neira Ayuso591ddad2011-06-21 18:16:42 +0200801}
802
Pablo Neira Ayusod6216402011-08-31 16:47:44 +0200803struct ipaccess_line {
804 int line_already_initialized;
805};
806
Pablo Neira Ayuso4e862cb2011-08-19 18:43:38 +0200807static int ipaccess_line_update(struct e1inp_line *line)
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200808{
809 int ret = -ENOENT;
Pablo Neira Ayusod6216402011-08-31 16:47:44 +0200810 struct ipaccess_line *il;
811
812 if (!line->driver_data)
813 line->driver_data = talloc_zero(line, struct ipaccess_line);
814
815 if (!line->driver_data) {
816 LOGP(DLINP, LOGL_ERROR, "ipaccess: OOM in line update\n");
817 return -ENOMEM;
818 }
819 il = line->driver_data;
820
821 /* We only initialize this line once. */
822 if (il->line_already_initialized)
823 return 0;
824
825 il->line_already_initialized = 1;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200826
Pablo Neira Ayuso4e862cb2011-08-19 18:43:38 +0200827 switch(line->ops->cfg.ipa.role) {
Pablo Neira Ayuso986191f2011-06-21 19:56:26 +0200828 case E1INP_LINE_R_BSC: {
829 struct ipa_server_link *oml_link, *rsl_link;
830
Harald Weltecc2241b2011-07-19 16:06:06 +0200831 LOGP(DLINP, LOGL_NOTICE, "enabling ipaccess BSC mode\n");
Pablo Neira Ayuso96e81282011-06-09 15:06:11 +0200832
Pablo Neira Ayuso986191f2011-06-21 19:56:26 +0200833 oml_link = ipa_server_link_create(tall_ipa_ctx, line,
834 "0.0.0.0", IPA_TCP_PORT_OML,
Pablo Neira Ayusoe009f4a2011-06-23 13:36:34 +0200835 ipaccess_bsc_oml_cb, NULL);
Pablo Neira Ayuso986191f2011-06-21 19:56:26 +0200836 if (oml_link == NULL) {
Harald Weltecc2241b2011-07-19 16:06:06 +0200837 LOGP(DLINP, LOGL_ERROR, "cannot create OML "
Pablo Neira Ayuso986191f2011-06-21 19:56:26 +0200838 "BSC link: %s\n", strerror(errno));
839 return -ENOMEM;
Pablo Neira Ayusof67471f2011-06-07 11:25:49 +0200840 }
Pablo Neira Ayuso986191f2011-06-21 19:56:26 +0200841 if (ipa_server_link_open(oml_link) < 0) {
Harald Weltecc2241b2011-07-19 16:06:06 +0200842 LOGP(DLINP, LOGL_ERROR, "cannot open OML BSC link: %s\n",
Pablo Neira Ayuso986191f2011-06-21 19:56:26 +0200843 strerror(errno));
Pablo Neira Ayuso986191f2011-06-21 19:56:26 +0200844 ipa_server_link_destroy(oml_link);
845 return -EIO;
Pablo Neira Ayusof67471f2011-06-07 11:25:49 +0200846 }
Pablo Neira Ayuso986191f2011-06-21 19:56:26 +0200847 rsl_link = ipa_server_link_create(tall_ipa_ctx, line,
848 "0.0.0.0", IPA_TCP_PORT_RSL,
Pablo Neira Ayusoe009f4a2011-06-23 13:36:34 +0200849 ipaccess_bsc_rsl_cb, NULL);
Pablo Neira Ayuso986191f2011-06-21 19:56:26 +0200850 if (rsl_link == NULL) {
Harald Weltecc2241b2011-07-19 16:06:06 +0200851 LOGP(DLINP, LOGL_ERROR, "cannot create RSL "
Pablo Neira Ayuso986191f2011-06-21 19:56:26 +0200852 "BSC link: %s\n", strerror(errno));
853 return -ENOMEM;
854 }
855 if (ipa_server_link_open(rsl_link) < 0) {
Harald Weltecc2241b2011-07-19 16:06:06 +0200856 LOGP(DLINP, LOGL_ERROR, "cannot open RSL BSC link: %s\n",
Pablo Neira Ayuso986191f2011-06-21 19:56:26 +0200857 strerror(errno));
Pablo Neira Ayuso986191f2011-06-21 19:56:26 +0200858 ipa_server_link_destroy(rsl_link);
859 return -EIO;
860 }
861 ret = 0;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200862 break;
Pablo Neira Ayuso986191f2011-06-21 19:56:26 +0200863 }
Pablo Neira Ayuso96e81282011-06-09 15:06:11 +0200864 case E1INP_LINE_R_BTS: {
Harald Welte84f67b22013-06-30 13:13:59 +0200865 struct ipa_client_conn *link;
Pablo Neira Ayuso96e81282011-06-09 15:06:11 +0200866
Harald Weltecc2241b2011-07-19 16:06:06 +0200867 LOGP(DLINP, LOGL_NOTICE, "enabling ipaccess BTS mode\n");
Pablo Neira Ayuso96e81282011-06-09 15:06:11 +0200868
Pablo Neira Ayusof0995672011-09-08 12:58:38 +0200869 link = ipa_client_conn_create(tall_ipa_ctx,
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200870 &line->ts[E1INP_SIGN_OML-1],
Pablo Neira Ayuso00af7722011-09-08 12:47:06 +0200871 E1INP_SIGN_OML,
Pablo Neira Ayuso4e862cb2011-08-19 18:43:38 +0200872 line->ops->cfg.ipa.addr,
873 IPA_TCP_PORT_OML,
Harald Welte51de9ca2013-06-30 20:13:16 +0200874 ipaccess_bts_updown_cb,
Harald Weltea3e9dd52013-06-30 14:25:07 +0200875 ipaccess_bts_read_cb,
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200876 ipaccess_bts_write_cb,
Harald Welte10b41302013-06-30 14:05:49 +0200877 line);
Pablo Neira Ayuso96e81282011-06-09 15:06:11 +0200878 if (link == NULL) {
Harald Weltecc2241b2011-07-19 16:06:06 +0200879 LOGP(DLINP, LOGL_ERROR, "cannot create OML "
Pablo Neira Ayuso29465d32011-06-21 14:21:33 +0200880 "BTS link: %s\n", strerror(errno));
Pablo Neira Ayuso96e81282011-06-09 15:06:11 +0200881 return -ENOMEM;
882 }
Pablo Neira Ayusof0995672011-09-08 12:58:38 +0200883 if (ipa_client_conn_open(link) < 0) {
Harald Weltecc2241b2011-07-19 16:06:06 +0200884 LOGP(DLINP, LOGL_ERROR, "cannot open OML BTS link: %s\n",
Pablo Neira Ayuso29465d32011-06-21 14:21:33 +0200885 strerror(errno));
Pablo Neira Ayusof0995672011-09-08 12:58:38 +0200886 ipa_client_conn_close(link);
887 ipa_client_conn_destroy(link);
Pablo Neira Ayuso96e81282011-06-09 15:06:11 +0200888 return -EIO;
889 }
890 ret = 0;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200891 break;
Pablo Neira Ayuso96e81282011-06-09 15:06:11 +0200892 }
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200893 default:
894 break;
895 }
896 return ret;
897}
898
Andreas Eversbergf422a752014-01-21 14:54:41 +0100899
900/* backwards compatibility */
Harald Welte84f67b22013-06-30 13:13:59 +0200901int e1inp_ipa_bts_rsl_connect(struct e1inp_line *line,
902 const char *rem_addr, uint16_t rem_port)
903{
Andreas Eversbergf422a752014-01-21 14:54:41 +0100904 return e1inp_ipa_bts_rsl_connect_n(line, rem_addr, rem_port, 0);
905}
906
907int e1inp_ipa_bts_rsl_connect_n(struct e1inp_line *line,
908 const char *rem_addr, uint16_t rem_port,
909 uint8_t trx_nr)
910{
Harald Welte84f67b22013-06-30 13:13:59 +0200911 struct ipa_client_conn *rsl_link;
912
Andreas Eversbergf422a752014-01-21 14:54:41 +0100913 if (E1INP_SIGN_RSL+trx_nr-1 >= NUM_E1_TS) {
914 LOGP(DLINP, LOGL_ERROR, "cannot create RSL BTS link: "
915 "trx_nr (%d) out of range\n", trx_nr);
916 return -EINVAL;
917 }
Andreas Eversbergf422a752014-01-21 14:54:41 +0100918
Harald Welte84f67b22013-06-30 13:13:59 +0200919 rsl_link = ipa_client_conn_create(tall_ipa_ctx,
Andreas Eversbergf422a752014-01-21 14:54:41 +0100920 &line->ts[E1INP_SIGN_RSL+trx_nr-1],
921 E1INP_SIGN_RSL+trx_nr,
Harald Welte84f67b22013-06-30 13:13:59 +0200922 rem_addr, rem_port,
Harald Welte51de9ca2013-06-30 20:13:16 +0200923 ipaccess_bts_updown_cb,
Harald Weltea3e9dd52013-06-30 14:25:07 +0200924 ipaccess_bts_read_cb,
Harald Welte84f67b22013-06-30 13:13:59 +0200925 ipaccess_bts_write_cb,
Harald Welte10b41302013-06-30 14:05:49 +0200926 line);
Harald Welte84f67b22013-06-30 13:13:59 +0200927 if (rsl_link == NULL) {
928 LOGP(DLINP, LOGL_ERROR, "cannot create RSL "
929 "BTS link: %s\n", strerror(errno));
930 return -ENOMEM;
931 }
932 if (ipa_client_conn_open(rsl_link) < 0) {
933 LOGP(DLINP, LOGL_ERROR, "cannot open RSL BTS link: %s\n",
934 strerror(errno));
935 ipa_client_conn_close(rsl_link);
936 ipa_client_conn_destroy(rsl_link);
937 return -EIO;
938 }
939 return 0;
940}
941
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200942void e1inp_ipaccess_init(void)
943{
Pablo Neira Ayuso54b49792011-06-07 12:15:26 +0200944 tall_ipa_ctx = talloc_named_const(libosmo_abis_ctx, 1, "ipa");
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200945 e1inp_driver_register(&ipaccess_driver);
946}