blob: 6663b9f3d59ba3d23ead59082061ef881022b8e8 [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>
31#include <string.h>
32#include <time.h>
33#include <sys/fcntl.h>
34#include <sys/socket.h>
35#include <sys/ioctl.h>
36#include <arpa/inet.h>
37
38#include <osmocom/core/select.h>
39#include <osmocom/gsm/tlv.h>
40#include <osmocom/core/msgb.h>
41#include <osmocom/core/logging.h>
Harald Welte71d87b22011-07-18 14:49:56 +020042#include <osmocom/core/talloc.h>
Pablo Neira Ayuso177094b2011-06-07 12:21:51 +020043#include <osmocom/abis/e1_input.h>
44#include <osmocom/abis/ipaccess.h>
Pablo Neira Ayusof67471f2011-06-07 11:25:49 +020045#include <osmocom/core/socket.h>
Pablo Neira Ayuso96e81282011-06-09 15:06:11 +020046#include <osmocom/abis/ipa.h>
Pablo Neira Ayusoef132692013-07-08 01:17:27 +020047#include <osmocom/core/backtrace.h>
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +020048
Pablo Neira Ayuso54b49792011-06-07 12:15:26 +020049static void *tall_ipa_ctx;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +020050
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +020051#define TS1_ALLOC_SIZE 900
52
53/*
54 * Common propietary IPA messages:
55 * - PONG: in reply to PING.
56 * - ID_REQUEST: first messages once OML has been established.
57 * - ID_ACK: in reply to ID_ACK.
58 */
59const uint8_t ipa_pong_msg[] = {
60 0, 1, IPAC_PROTO_IPACCESS, IPAC_MSGT_PONG
61};
62
63const uint8_t ipa_id_ack_msg[] = {
64 0, 1, IPAC_PROTO_IPACCESS, IPAC_MSGT_ID_ACK
65};
66
67const uint8_t ipa_id_req_msg[] = {
68 0, 17, IPAC_PROTO_IPACCESS, IPAC_MSGT_ID_GET,
69 0x01, IPAC_IDTAG_UNIT,
70 0x01, IPAC_IDTAG_MACADDR,
71 0x01, IPAC_IDTAG_LOCATION1,
72 0x01, IPAC_IDTAG_LOCATION2,
73 0x01, IPAC_IDTAG_EQUIPVERS,
74 0x01, IPAC_IDTAG_SWVERSION,
75 0x01, IPAC_IDTAG_UNITNAME,
76 0x01, IPAC_IDTAG_SERNR,
77};
78
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +020079static const char *idtag_names[] = {
80 [IPAC_IDTAG_SERNR] = "Serial_Number",
81 [IPAC_IDTAG_UNITNAME] = "Unit_Name",
82 [IPAC_IDTAG_LOCATION1] = "Location_1",
83 [IPAC_IDTAG_LOCATION2] = "Location_2",
84 [IPAC_IDTAG_EQUIPVERS] = "Equipment_Version",
85 [IPAC_IDTAG_SWVERSION] = "Software_Version",
86 [IPAC_IDTAG_IPADDR] = "IP_Address",
87 [IPAC_IDTAG_MACADDR] = "MAC_Address",
88 [IPAC_IDTAG_UNIT] = "Unit_ID",
89};
90
91const char *ipaccess_idtag_name(uint8_t tag)
92{
93 if (tag >= ARRAY_SIZE(idtag_names))
94 return "unknown";
95
96 return idtag_names[tag];
97}
98
99int ipaccess_idtag_parse(struct tlv_parsed *dec, unsigned char *buf, int len)
100{
101 uint8_t t_len;
102 uint8_t t_tag;
103 uint8_t *cur = buf;
104
105 memset(dec, 0, sizeof(*dec));
106
107 while (len >= 2) {
108 len -= 2;
109 t_len = *cur++;
110 t_tag = *cur++;
111
112 if (t_len > len + 1) {
Harald Weltecc2241b2011-07-19 16:06:06 +0200113 LOGP(DLMI, LOGL_ERROR, "The tag does not fit: %d\n", t_len);
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200114 return -EINVAL;
115 }
116
Harald Weltecc2241b2011-07-19 16:06:06 +0200117 DEBUGPC(DLMI, "%s='%s' ", ipaccess_idtag_name(t_tag), cur);
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200118
119 dec->lv[t_tag].len = t_len;
120 dec->lv[t_tag].val = cur;
121
122 cur += t_len;
123 len -= t_len;
124 }
125 return 0;
126}
127
128int ipaccess_parse_unitid(const char *str, struct ipaccess_unit *unit_data)
129{
130 unsigned long ul;
131 char *endptr;
132 const char *nptr;
133
134 nptr = str;
135 ul = strtoul(nptr, &endptr, 10);
136 if (endptr <= nptr)
137 return -EINVAL;
Pablo Neira Ayuso62d345a2011-07-05 16:37:37 +0200138 unit_data->site_id = ul & 0xffff;
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200139
140 if (*endptr++ != '/')
141 return -EINVAL;
142
143 nptr = endptr;
144 ul = strtoul(nptr, &endptr, 10);
145 if (endptr <= nptr)
146 return -EINVAL;
Pablo Neira Ayuso62d345a2011-07-05 16:37:37 +0200147 unit_data->bts_id = ul & 0xffff;
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200148
149 if (*endptr++ != '/')
150 return -EINVAL;
151
152 nptr = endptr;
153 ul = strtoul(nptr, &endptr, 10);
154 if (endptr <= nptr)
155 return -EINVAL;
Pablo Neira Ayuso62d345a2011-07-05 16:37:37 +0200156 unit_data->trx_id = ul & 0xffff;
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200157
158 return 0;
159}
160
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200161static int ipaccess_send(int fd, const void *msg, size_t msglen)
162{
163 int ret;
164
165 ret = write(fd, msg, msglen);
166 if (ret < 0)
167 return ret;
168 if (ret < msglen) {
Harald Weltecc2241b2011-07-19 16:06:06 +0200169 LOGP(DLINP, LOGL_ERROR, "ipaccess_send: short write\n");
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200170 return -EIO;
171 }
172 return ret;
173}
174
175int ipaccess_send_pong(int fd)
176{
177 return ipaccess_send(fd, ipa_pong_msg, sizeof(ipa_pong_msg));
178}
179
180int ipaccess_send_id_ack(int fd)
181{
182 return ipaccess_send(fd, ipa_id_ack_msg, sizeof(ipa_id_ack_msg));
183}
184
185int ipaccess_send_id_req(int fd)
186{
187 return ipaccess_send(fd, ipa_id_req_msg, sizeof(ipa_id_req_msg));
188}
189
Pablo Neira Ayuso5a4b7c52011-06-07 14:07:48 +0200190/* base handling of the ip.access protocol */
Harald Weltebc25bca2011-08-19 22:32:38 +0200191int ipaccess_rcvmsg_base(struct msgb *msg, struct osmo_fd *bfd)
Pablo Neira Ayuso5a4b7c52011-06-07 14:07:48 +0200192{
193 uint8_t msg_type = *(msg->l2h);
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200194 int ret;
Pablo Neira Ayuso5a4b7c52011-06-07 14:07:48 +0200195
196 switch (msg_type) {
197 case IPAC_MSGT_PING:
198 ret = ipaccess_send_pong(bfd->fd);
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200199 if (ret < 0) {
200 LOGP(DLINP, LOGL_ERROR, "Cannot send PING "
201 "message. Reason: %s\n", strerror(errno));
202 break;
203 }
204 ret = 1;
Pablo Neira Ayuso5a4b7c52011-06-07 14:07:48 +0200205 break;
206 case IPAC_MSGT_PONG:
Harald Weltecc2241b2011-07-19 16:06:06 +0200207 DEBUGP(DLMI, "PONG!\n");
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200208 ret = 1;
Pablo Neira Ayuso5a4b7c52011-06-07 14:07:48 +0200209 break;
210 case IPAC_MSGT_ID_ACK:
Harald Weltecc2241b2011-07-19 16:06:06 +0200211 DEBUGP(DLMI, "ID_ACK? -> ACK!\n");
Pablo Neira Ayuso5a4b7c52011-06-07 14:07:48 +0200212 ret = ipaccess_send_id_ack(bfd->fd);
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200213 if (ret < 0) {
214 LOGP(DLINP, LOGL_ERROR, "Cannot send ID_ACK "
215 "message. Reason: %s\n", strerror(errno));
216 break;
217 }
218 ret = 1;
219 break;
220 default:
221 /* This is not an IPA PING, PONG or ID_ACK message */
222 ret = 0;
Pablo Neira Ayuso5a4b7c52011-06-07 14:07:48 +0200223 break;
224 }
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200225 return ret;
Pablo Neira Ayuso5a4b7c52011-06-07 14:07:48 +0200226}
227
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200228/* base handling of the ip.access protocol */
229int ipaccess_rcvmsg_bts_base(struct msgb *msg,
230 struct osmo_fd *bfd)
231{
232 uint8_t msg_type = *(msg->l2h);
233 int ret = 0;
234
235 switch (msg_type) {
236 case IPAC_MSGT_PING:
237 ret = ipaccess_send_pong(bfd->fd);
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200238 if (ret < 0) {
239 LOGP(DLINP, LOGL_ERROR, "Cannot send PONG "
240 "message. Reason: %s\n", strerror(errno));
241 }
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200242 break;
243 case IPAC_MSGT_PONG:
Harald Weltecc2241b2011-07-19 16:06:06 +0200244 DEBUGP(DLMI, "PONG!\n");
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200245 break;
246 case IPAC_MSGT_ID_ACK:
Harald Weltecc2241b2011-07-19 16:06:06 +0200247 DEBUGP(DLMI, "ID_ACK\n");
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200248 break;
249 }
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200250 return ret;
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200251}
252
Harald Welte10b41302013-06-30 14:05:49 +0200253static int ipaccess_drop(struct osmo_fd *bfd, struct e1inp_line *line)
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200254{
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200255 int ret = 1;
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200256
Pablo Neira Ayuso466c5462011-07-07 19:17:20 +0200257 /* Error case: we did not see any ID_RESP yet for this socket. */
258 if (bfd->fd != -1) {
Harald Weltecc2241b2011-07-19 16:06:06 +0200259 LOGP(DLINP, LOGL_ERROR, "Forcing socket shutdown with "
Pablo Neira Ayuso466c5462011-07-07 19:17:20 +0200260 "no signal link set\n");
Pablo Neira Ayuso9621b412011-07-07 16:19:21 +0200261 osmo_fd_unregister(bfd);
262 close(bfd->fd);
263 bfd->fd = -1;
Pablo Neira Ayuso466c5462011-07-07 19:17:20 +0200264 ret = -ENOENT;
Pablo Neira Ayuso9621b412011-07-07 16:19:21 +0200265 }
Pablo Neira Ayuso6cc3f922012-08-22 13:57:58 +0200266
267 /* e1inp_sign_link_destroy releases the socket descriptors for us. */
268 line->ops->sign_link_down(line);
269
Pablo Neira Ayuso466c5462011-07-07 19:17:20 +0200270 return ret;
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200271}
272
Pablo Neira Ayuso5a4b7c52011-06-07 14:07:48 +0200273static int ipaccess_rcvmsg(struct e1inp_line *line, struct msgb *msg,
274 struct osmo_fd *bfd)
275{
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200276 struct tlv_parsed tlvp;
Pablo Neira Ayuso5a4b7c52011-06-07 14:07:48 +0200277 uint8_t msg_type = *(msg->l2h);
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200278 struct ipaccess_unit unit_data = {};
279 struct e1inp_sign_link *sign_link;
280 char *unitid;
281 int len, ret;
Pablo Neira Ayuso5a4b7c52011-06-07 14:07:48 +0200282
Pablo Neira Ayusoeb434132011-07-07 19:19:46 +0200283 /* Handle IPA PING, PONG and ID_ACK messages. */
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200284 ret = ipaccess_rcvmsg_base(msg, bfd);
285 switch(ret) {
286 case -1:
287 /* error in IPA control message handling */
288 goto err;
289 case 1:
290 /* this is an IPA control message, skip further processing */
Pablo Neira Ayusoeb434132011-07-07 19:19:46 +0200291 return 0;
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200292 case 0:
293 /* this is not an IPA control message, continue */
294 break;
295 default:
296 LOGP(DLINP, LOGL_ERROR, "Unexpected return from "
297 "ipaccess_rcvmsg_base "
298 "(ret=%d)\n", ret);
299 goto err;
300 }
Pablo Neira Ayuso5a4b7c52011-06-07 14:07:48 +0200301
302 switch (msg_type) {
303 case IPAC_MSGT_ID_RESP:
Harald Weltecc2241b2011-07-19 16:06:06 +0200304 DEBUGP(DLMI, "ID_RESP\n");
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200305 /* parse tags, search for Unit ID */
306 ret = ipaccess_idtag_parse(&tlvp, (uint8_t *)msg->l2h + 2,
307 msgb_l2len(msg)-2);
Harald Weltecc2241b2011-07-19 16:06:06 +0200308 DEBUGP(DLMI, "\n");
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200309 if (ret < 0) {
Harald Weltecc2241b2011-07-19 16:06:06 +0200310 LOGP(DLINP, LOGL_ERROR, "IPA response message "
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200311 "with malformed TLVs\n");
Pablo Neira Ayuso466c5462011-07-07 19:17:20 +0200312 ret = -EINVAL;
313 goto err;
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200314 }
Pablo Neira Ayuso466c5462011-07-07 19:17:20 +0200315 if (!TLVP_PRESENT(&tlvp, IPAC_IDTAG_UNIT)) {
Harald Weltecc2241b2011-07-19 16:06:06 +0200316 LOGP(DLINP, LOGL_ERROR, "IPA response message "
Pablo Neira Ayuso466c5462011-07-07 19:17:20 +0200317 "without unit ID\n");
318 ret = -EINVAL;
319 goto err;
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200320
Pablo Neira Ayuso466c5462011-07-07 19:17:20 +0200321 }
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200322 len = TLVP_LEN(&tlvp, IPAC_IDTAG_UNIT);
Pablo Neira Ayuso466c5462011-07-07 19:17:20 +0200323 if (len < 1) {
Harald Weltecc2241b2011-07-19 16:06:06 +0200324 LOGP(DLINP, LOGL_ERROR, "IPA response message "
Pablo Neira Ayuso466c5462011-07-07 19:17:20 +0200325 "with too small unit ID\n");
326 ret = -EINVAL;
327 goto err;
328 }
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200329 unitid = (char *) TLVP_VAL(&tlvp, IPAC_IDTAG_UNIT);
330 unitid[len - 1] = '\0';
331 ipaccess_parse_unitid(unitid, &unit_data);
332
Pablo Neira Ayusof163d232011-06-25 18:42:55 +0200333 if (!line->ops->sign_link_up) {
Harald Weltecc2241b2011-07-19 16:06:06 +0200334 LOGP(DLINP, LOGL_ERROR,
Pablo Neira Ayusocd8d2e52011-07-02 17:05:21 +0200335 "Unable to set signal link, closing socket.\n");
Pablo Neira Ayuso466c5462011-07-07 19:17:20 +0200336 ret = -EINVAL;
337 goto err;
Pablo Neira Ayuso5a4b7c52011-06-07 14:07:48 +0200338 }
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200339 /* the BSC creates the new sign links at this stage. */
340 if (bfd->priv_nr == E1INP_SIGN_OML) {
341 sign_link =
342 line->ops->sign_link_up(&unit_data, line,
343 E1INP_SIGN_OML);
344 if (sign_link == NULL) {
Harald Weltecc2241b2011-07-19 16:06:06 +0200345 LOGP(DLINP, LOGL_ERROR,
Pablo Neira Ayusocd8d2e52011-07-02 17:05:21 +0200346 "Unable to set signal link, "
347 "closing socket.\n");
Pablo Neira Ayuso466c5462011-07-07 19:17:20 +0200348 ret = -EINVAL;
349 goto err;
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200350 }
351 } else if (bfd->priv_nr == E1INP_SIGN_RSL) {
Pablo Neira Ayuso3832c4f2011-07-07 17:47:26 +0200352 struct e1inp_ts *ts;
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200353 struct osmo_fd *newbfd;
Pablo Neira Ayuso3832c4f2011-07-07 17:47:26 +0200354 struct e1inp_line *new_line;
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200355
356 sign_link =
357 line->ops->sign_link_up(&unit_data, line,
358 E1INP_SIGN_RSL);
359 if (sign_link == NULL) {
Harald Weltecc2241b2011-07-19 16:06:06 +0200360 LOGP(DLINP, LOGL_ERROR,
Pablo Neira Ayusocd8d2e52011-07-02 17:05:21 +0200361 "Unable to set signal link, "
362 "closing socket.\n");
Pablo Neira Ayuso466c5462011-07-07 19:17:20 +0200363 ret = -EINVAL;
364 goto err;
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200365 }
Pablo Neira Ayusodb1c8a72011-07-08 15:12:03 +0200366 /* this is a bugtrap, the BSC should be using the
367 * virtual E1 line used by OML for this RSL link. */
368 if (sign_link->ts->line == line) {
Harald Weltecc2241b2011-07-19 16:06:06 +0200369 LOGP(DLINP, LOGL_ERROR,
Pablo Neira Ayusodb1c8a72011-07-08 15:12:03 +0200370 "Fix your BSC, you should use the "
371 "E1 line used by the OML link for "
372 "your RSL link.\n");
373 return 0;
374 }
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200375 /* Finally, we know which OML link is associated with
376 * this RSL link, attach it to this socket. */
Pablo Neira Ayuso3832c4f2011-07-07 17:47:26 +0200377 bfd->data = new_line = sign_link->ts->line;
378 e1inp_line_get(new_line);
379 ts = &new_line->ts[E1INP_SIGN_RSL+unit_data.trx_id-1];
380 newbfd = &ts->driver.ipaccess.fd;
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200381
382 /* get rid of our old temporary bfd */
383 memcpy(newbfd, bfd, sizeof(*newbfd));
384 newbfd->priv_nr = E1INP_SIGN_RSL + unit_data.trx_id;
385 osmo_fd_unregister(bfd);
386 bfd->fd = -1;
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200387 osmo_fd_register(newbfd);
Pablo Neira Ayuso3832c4f2011-07-07 17:47:26 +0200388 /* now we can release the dummy RSL line. */
389 e1inp_line_put(line);
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200390 }
Pablo Neira Ayuso5a4b7c52011-06-07 14:07:48 +0200391 break;
Pablo Neira Ayuso466c5462011-07-07 19:17:20 +0200392 default:
Harald Weltecc2241b2011-07-19 16:06:06 +0200393 LOGP(DLINP, LOGL_ERROR, "Unknown IPA message type\n");
Pablo Neira Ayuso466c5462011-07-07 19:17:20 +0200394 ret = -EINVAL;
395 goto err;
Pablo Neira Ayuso5a4b7c52011-06-07 14:07:48 +0200396 }
397 return 0;
Pablo Neira Ayuso466c5462011-07-07 19:17:20 +0200398err:
399 osmo_fd_unregister(bfd);
400 close(bfd->fd);
401 bfd->fd = -1;
Pablo Neira Ayuso3832c4f2011-07-07 17:47:26 +0200402 e1inp_line_put(line);
Pablo Neira Ayuso466c5462011-07-07 19:17:20 +0200403 return ret;
Pablo Neira Ayuso5a4b7c52011-06-07 14:07:48 +0200404}
405
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200406static int handle_ts1_read(struct osmo_fd *bfd)
407{
408 struct e1inp_line *line = bfd->data;
409 unsigned int ts_nr = bfd->priv_nr;
Pablo Neira Ayuso3832c4f2011-07-07 17:47:26 +0200410 struct e1inp_ts *e1i_ts = &line->ts[ts_nr-1];
Pablo Neira Ayuso5a4b7c52011-06-07 14:07:48 +0200411 struct e1inp_sign_link *link;
412 struct ipaccess_head *hh;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200413 struct msgb *msg;
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200414 int ret;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200415
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200416 ret = ipa_msg_recv(bfd->fd, &msg);
417 if (ret < 0) {
418 LOGP(DLINP, LOGL_NOTICE, "Sign link problems, "
419 "closing socket. Reason: %s\n", strerror(errno));
420 goto err;
421 } else if (ret == 0) {
422 LOGP(DLINP, LOGL_NOTICE, "Sign link vanished, dead socket\n");
423 goto err;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200424 }
Harald Weltecc2241b2011-07-19 16:06:06 +0200425 DEBUGP(DLMI, "RX %u: %s\n", ts_nr, osmo_hexdump(msgb_l2(msg), msgb_l2len(msg)));
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200426
Pablo Neira Ayuso5a4b7c52011-06-07 14:07:48 +0200427 hh = (struct ipaccess_head *) msg->data;
428 if (hh->proto == IPAC_PROTO_IPACCESS) {
429 ipaccess_rcvmsg(line, msg, bfd);
430 msgb_free(msg);
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200431 return 0;
Pablo Neira Ayuso5a4b7c52011-06-07 14:07:48 +0200432 }
433 /* BIG FAT WARNING: bfd might no longer exist here, since ipaccess_rcvmsg()
434 * might have free'd it !!! */
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200435
Pablo Neira Ayuso5a4b7c52011-06-07 14:07:48 +0200436 link = e1inp_lookup_sign_link(e1i_ts, hh->proto, 0);
437 if (!link) {
Harald Weltecc2241b2011-07-19 16:06:06 +0200438 LOGP(DLINP, LOGL_ERROR, "no matching signalling link for "
Pablo Neira Ayuso5a4b7c52011-06-07 14:07:48 +0200439 "hh->proto=0x%02x\n", hh->proto);
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200440 ret = -EINVAL;
441 goto err_msg;
Pablo Neira Ayuso5a4b7c52011-06-07 14:07:48 +0200442 }
443 msg->dst = link;
444
445 /* XXX better use e1inp_ts_rx? */
Pablo Neira Ayusof163d232011-06-25 18:42:55 +0200446 if (!e1i_ts->line->ops->sign_link) {
Harald Weltecc2241b2011-07-19 16:06:06 +0200447 LOGP(DLINP, LOGL_ERROR, "Fix your application, "
Pablo Neira Ayuso5a4b7c52011-06-07 14:07:48 +0200448 "no action set for signalling messages.\n");
Pablo Neira Ayuso466c5462011-07-07 19:17:20 +0200449 ret = -EINVAL;
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200450 goto err_msg;
Pablo Neira Ayuso5a4b7c52011-06-07 14:07:48 +0200451 }
Pablo Neira Ayuso466c5462011-07-07 19:17:20 +0200452 if (e1i_ts->line->ops->sign_link(msg) < 0) {
Pablo Neira Ayusoa49c24d2012-10-16 11:24:08 +0200453 /* Don't close the signalling link if the upper layers report
454 * an error, that's too strict. BTW, the signalling layer is
455 * resposible for releasing the message.
456 */
Harald Weltecc2241b2011-07-19 16:06:06 +0200457 LOGP(DLINP, LOGL_ERROR, "Bad signalling message,"
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200458 "sign_link returned error\n");
Pablo Neira Ayuso466c5462011-07-07 19:17:20 +0200459 }
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200460
461 return 0;
462err_msg:
463 msgb_free(msg);
Pablo Neira Ayuso466c5462011-07-07 19:17:20 +0200464err:
Harald Welte10b41302013-06-30 14:05:49 +0200465 ipaccess_drop(bfd, line);
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200466 return ret;
467}
468
469void ipaccess_prepend_header_ext(struct msgb *msg, int proto)
470{
471 struct ipaccess_head_ext *hh_ext;
472
473 /* prepend the osmo ip.access header extension */
474 hh_ext = (struct ipaccess_head_ext *) msgb_push(msg, sizeof(*hh_ext));
475 hh_ext->proto = proto;
476}
477
478void ipaccess_prepend_header(struct msgb *msg, int proto)
479{
480 struct ipaccess_head *hh;
481
482 /* prepend the ip.access header */
483 hh = (struct ipaccess_head *) msgb_push(msg, sizeof(*hh));
484 hh->len = htons(msg->len - sizeof(*hh));
485 hh->proto = proto;
486}
487
488static int ts_want_write(struct e1inp_ts *e1i_ts)
489{
490 e1i_ts->driver.ipaccess.fd.when |= BSC_FD_WRITE;
491
492 return 0;
493}
494
Pablo Neira Ayusoadd3ec82011-07-05 14:45:46 +0200495static void ipaccess_close(struct e1inp_sign_link *sign_link)
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200496{
Pablo Neira Ayusoadd3ec82011-07-05 14:45:46 +0200497 struct e1inp_ts *e1i_ts = sign_link->ts;
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200498 struct osmo_fd *bfd = &e1i_ts->driver.ipaccess.fd;
Holger Hans Peter Freyther55467f02011-12-28 19:47:07 +0100499 return e1inp_close_socket(e1i_ts, sign_link, bfd);
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200500}
501
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200502static void timeout_ts1_write(void *data)
503{
504 struct e1inp_ts *e1i_ts = (struct e1inp_ts *)data;
505
506 /* trigger write of ts1, due to tx delay timer */
507 ts_want_write(e1i_ts);
508}
509
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200510static int __handle_ts1_write(struct osmo_fd *bfd, struct e1inp_line *line)
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200511{
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200512 unsigned int ts_nr = bfd->priv_nr;
513 struct e1inp_ts *e1i_ts = &line->ts[ts_nr-1];
514 struct e1inp_sign_link *sign_link;
515 struct msgb *msg;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200516 int ret;
517
518 bfd->when &= ~BSC_FD_WRITE;
519
520 /* get the next msg for this timeslot */
521 msg = e1inp_tx_ts(e1i_ts, &sign_link);
522 if (!msg) {
523 /* no message after tx delay timer */
524 return 0;
525 }
526
527 switch (sign_link->type) {
528 case E1INP_SIGN_OML:
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200529 break;
530 case E1INP_SIGN_RSL:
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200531 break;
532 default:
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200533 bfd->when |= BSC_FD_WRITE; /* come back for more msg */
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200534 ret = -EINVAL;
535 goto out;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200536 }
537
538 msg->l2h = msg->data;
Pablo Neira Ayusob9ed7e32011-07-05 18:31:59 +0200539 ipaccess_prepend_header(msg, sign_link->tei);
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200540
Harald Weltecc2241b2011-07-19 16:06:06 +0200541 DEBUGP(DLMI, "TX %u: %s\n", ts_nr, osmo_hexdump(msg->l2h, msgb_l2len(msg)));
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200542
543 ret = send(bfd->fd, msg->data, msg->len, 0);
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200544 if (ret != msg->len) {
545 LOGP(DLINP, LOGL_ERROR, "failed to send A-bis IPA signalling "
546 "message. Reason: %s\n", strerror(errno));
547 goto err;
548 }
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200549
550 /* set tx delay timer for next event */
551 e1i_ts->sign.tx_timer.cb = timeout_ts1_write;
552 e1i_ts->sign.tx_timer.data = e1i_ts;
553
554 /* Reducing this might break the nanoBTS 900 init. */
555 osmo_timer_schedule(&e1i_ts->sign.tx_timer, 0, e1i_ts->sign.delay);
556
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200557out:
558 msgb_free(msg);
559 return ret;
560err:
Harald Welte10b41302013-06-30 14:05:49 +0200561 ipaccess_drop(bfd, line);
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200562 msgb_free(msg);
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200563 return ret;
564}
565
Pablo Neira Ayuso88136fc2011-07-08 16:21:55 +0200566static int handle_ts1_write(struct osmo_fd *bfd)
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200567{
568 struct e1inp_line *line = bfd->data;
569
570 return __handle_ts1_write(bfd, line);
571}
572
Pablo Neira Ayusof0995672011-09-08 12:58:38 +0200573static int ipaccess_bts_write_cb(struct ipa_client_conn *link)
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200574{
575 struct e1inp_line *line = link->line;
576
577 return __handle_ts1_write(link->ofd, line);
578}
579
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200580/* callback from select.c in case one of the fd's can be read/written */
Pablo Neira Ayuso495ddb62011-07-08 21:04:11 +0200581int ipaccess_fd_cb(struct osmo_fd *bfd, unsigned int what)
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200582{
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200583 int rc = 0;
584
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200585 if (what & BSC_FD_READ)
586 rc = handle_ts1_read(bfd);
587 if (what & BSC_FD_WRITE)
588 rc = handle_ts1_write(bfd);
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200589
590 return rc;
591}
592
Pablo Neira Ayuso4e862cb2011-08-19 18:43:38 +0200593static int ipaccess_line_update(struct e1inp_line *line);
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200594
595struct e1inp_driver ipaccess_driver = {
596 .name = "ipa",
597 .want_write = ts_want_write,
598 .line_update = ipaccess_line_update,
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200599 .close = ipaccess_close,
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200600 .default_delay = 0,
601};
602
603/* callback of the OML listening filedescriptor */
Pablo Neira Ayuso986191f2011-06-21 19:56:26 +0200604static int ipaccess_bsc_oml_cb(struct ipa_server_link *link, int fd)
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200605{
606 int ret;
607 int idx = 0;
608 int i;
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200609 struct e1inp_line *line;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200610 struct e1inp_ts *e1i_ts;
611 struct osmo_fd *bfd;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200612
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200613 /* clone virtual E1 line for this new OML link. */
Pablo Neira Ayuso3832c4f2011-07-07 17:47:26 +0200614 line = e1inp_line_clone(tall_ipa_ctx, link->line);
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200615 if (line == NULL) {
Harald Weltecc2241b2011-07-19 16:06:06 +0200616 LOGP(DLINP, LOGL_ERROR, "could not clone E1 line\n");
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200617 return -ENOMEM;
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200618 }
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200619
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200620 /* create virrtual E1 timeslots for signalling */
Pablo Neira Ayuso59301852011-06-27 15:44:23 +0200621 e1inp_ts_config_sign(&line->ts[E1INP_SIGN_OML-1], line);
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200622
623 /* initialize the fds */
624 for (i = 0; i < ARRAY_SIZE(line->ts); ++i)
625 line->ts[i].driver.ipaccess.fd.fd = -1;
626
627 e1i_ts = &line->ts[idx];
628
Pablo Neira Ayuso93c62012011-06-26 19:12:47 +0200629 bfd = &e1i_ts->driver.ipaccess.fd;
Pablo Neira Ayuso986191f2011-06-21 19:56:26 +0200630 bfd->fd = fd;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200631 bfd->data = line;
Pablo Neira Ayusof163d232011-06-25 18:42:55 +0200632 bfd->priv_nr = E1INP_SIGN_OML;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200633 bfd->cb = ipaccess_fd_cb;
634 bfd->when = BSC_FD_READ;
635 ret = osmo_fd_register(bfd);
636 if (ret < 0) {
Harald Weltecc2241b2011-07-19 16:06:06 +0200637 LOGP(DLINP, LOGL_ERROR, "could not register FD\n");
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200638 goto err_line;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200639 }
640
641 /* Request ID. FIXME: request LOCATION, HW/SW VErsion, Unit Name, Serno */
642 ret = ipaccess_send_id_req(bfd->fd);
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200643 if (ret < 0) {
644 LOGP(DLINP, LOGL_ERROR, "could not send ID REQ. Reason: %s\n",
645 strerror(errno));
646 goto err_socket;
647 }
648 return ret;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200649
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200650err_socket:
651 osmo_fd_unregister(bfd);
652err_line:
653 close(bfd->fd);
654 bfd->fd = -1;
655 e1inp_line_put(line);
656 return ret;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200657}
658
Pablo Neira Ayuso986191f2011-06-21 19:56:26 +0200659static int ipaccess_bsc_rsl_cb(struct ipa_server_link *link, int fd)
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200660{
Pablo Neira Ayuso3832c4f2011-07-07 17:47:26 +0200661 struct e1inp_line *line;
662 struct e1inp_ts *e1i_ts;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200663 struct osmo_fd *bfd;
Pablo Neira Ayuso3832c4f2011-07-07 17:47:26 +0200664 int i, ret;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200665
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200666 /* We don't know yet which OML link to associate it with. Thus, we
Pablo Neira Ayuso3832c4f2011-07-07 17:47:26 +0200667 * allocate a temporary E1 line until we have received ID. */
668 line = e1inp_line_clone(tall_ipa_ctx, link->line);
669 if (line == NULL) {
Harald Weltecc2241b2011-07-19 16:06:06 +0200670 LOGP(DLINP, LOGL_ERROR, "could not clone E1 line\n");
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200671 return -ENOMEM;
Pablo Neira Ayuso3832c4f2011-07-07 17:47:26 +0200672 }
673 /* initialize the fds */
674 for (i = 0; i < ARRAY_SIZE(line->ts); ++i)
675 line->ts[i].driver.ipaccess.fd.fd = -1;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200676
Pablo Neira Ayuso3832c4f2011-07-07 17:47:26 +0200677 /* we need this to initialize this in case to avoid crashes in case
678 * that the socket is closed before we've seen an ID_RESP. */
679 e1inp_ts_config_sign(&line->ts[E1INP_SIGN_OML-1], line);
680
681 e1i_ts = &line->ts[E1INP_SIGN_RSL-1];
682
683 bfd = &e1i_ts->driver.ipaccess.fd;
Pablo Neira Ayuso986191f2011-06-21 19:56:26 +0200684 bfd->fd = fd;
Pablo Neira Ayuso3832c4f2011-07-07 17:47:26 +0200685 bfd->data = line;
Pablo Neira Ayusof163d232011-06-25 18:42:55 +0200686 bfd->priv_nr = E1INP_SIGN_RSL;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200687 bfd->cb = ipaccess_fd_cb;
688 bfd->when = BSC_FD_READ;
689 ret = osmo_fd_register(bfd);
690 if (ret < 0) {
Harald Weltecc2241b2011-07-19 16:06:06 +0200691 LOGP(DLINP, LOGL_ERROR, "could not register FD\n");
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200692 goto err_line;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200693 }
694 /* Request ID. FIXME: request LOCATION, HW/SW VErsion, Unit Name, Serno */
695 ret = ipaccess_send_id_req(bfd->fd);
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200696 if (ret < 0) {
697 LOGP(DLINP, LOGL_ERROR, "could not send ID REQ. Reason: %s\n",
698 strerror(errno));
699 goto err_socket;
700 }
701 return ret;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200702
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200703err_socket:
704 osmo_fd_unregister(bfd);
705err_line:
706 close(bfd->fd);
707 bfd->fd = -1;
708 e1inp_line_put(line);
709 return ret;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200710}
711
Pablo Neira Ayuso4bab3bf2013-07-05 15:00:13 +0200712#define IPA_STRING_MAX 64
713
Pablo Neira Ayusodfafe682011-07-02 14:32:32 +0200714static struct msgb *
715ipa_bts_id_resp(struct ipaccess_unit *dev, uint8_t *data, int len)
716{
717 struct msgb *nmsg;
Pablo Neira Ayuso4bab3bf2013-07-05 15:00:13 +0200718 char str[IPA_STRING_MAX];
Pablo Neira Ayusodfafe682011-07-02 14:32:32 +0200719 uint8_t *tag;
720
Pablo Neira Ayuso88136fc2011-07-08 16:21:55 +0200721 nmsg = ipa_msg_alloc(0);
Pablo Neira Ayusodfafe682011-07-02 14:32:32 +0200722 if (!nmsg)
723 return NULL;
724
725 *msgb_put(nmsg, 1) = IPAC_MSGT_ID_RESP;
726 while (len) {
727 if (len < 2) {
Harald Weltecc2241b2011-07-19 16:06:06 +0200728 LOGP(DLINP, LOGL_NOTICE,
Pablo Neira Ayusodfafe682011-07-02 14:32:32 +0200729 "Short read of ipaccess tag\n");
730 msgb_free(nmsg);
731 return NULL;
732 }
733 switch (data[1]) {
734 case IPAC_IDTAG_UNIT:
Pablo Neira Ayuso4bab3bf2013-07-05 15:00:13 +0200735 snprintf(str, sizeof(str), "%u/%u/%u",
Pablo Neira Ayusodfafe682011-07-02 14:32:32 +0200736 dev->site_id, dev->bts_id, dev->trx_id);
737 break;
738 case IPAC_IDTAG_MACADDR:
Pablo Neira Ayuso4bab3bf2013-07-05 15:00:13 +0200739 snprintf(str, sizeof(str),
740 "%02x:%02x:%02x:%02x:%02x:%02x",
741 dev->mac_addr[0], dev->mac_addr[1],
742 dev->mac_addr[2], dev->mac_addr[3],
743 dev->mac_addr[4], dev->mac_addr[5]);
Pablo Neira Ayusodfafe682011-07-02 14:32:32 +0200744 break;
745 case IPAC_IDTAG_LOCATION1:
Pablo Neira Ayuso4bab3bf2013-07-05 15:00:13 +0200746 strncpy(str, dev->location1, IPA_STRING_MAX);
Pablo Neira Ayusodfafe682011-07-02 14:32:32 +0200747 break;
748 case IPAC_IDTAG_LOCATION2:
Pablo Neira Ayuso4bab3bf2013-07-05 15:00:13 +0200749 strncpy(str, dev->location2, IPA_STRING_MAX);
Pablo Neira Ayusodfafe682011-07-02 14:32:32 +0200750 break;
751 case IPAC_IDTAG_EQUIPVERS:
Pablo Neira Ayuso4bab3bf2013-07-05 15:00:13 +0200752 strncpy(str, dev->equipvers, IPA_STRING_MAX);
Pablo Neira Ayusodfafe682011-07-02 14:32:32 +0200753 break;
754 case IPAC_IDTAG_SWVERSION:
Pablo Neira Ayuso4bab3bf2013-07-05 15:00:13 +0200755 strncpy(str, dev->swversion, IPA_STRING_MAX);
Pablo Neira Ayusodfafe682011-07-02 14:32:32 +0200756 break;
757 case IPAC_IDTAG_UNITNAME:
Pablo Neira Ayuso4bab3bf2013-07-05 15:00:13 +0200758 snprintf(str, sizeof(str),
759 "%s-%02x-%02x-%02x-%02x-%02x-%02x",
760 dev->unit_name,
761 dev->mac_addr[0], dev->mac_addr[1],
762 dev->mac_addr[2], dev->mac_addr[3],
763 dev->mac_addr[4], dev->mac_addr[5]);
Pablo Neira Ayusodfafe682011-07-02 14:32:32 +0200764 break;
765 case IPAC_IDTAG_SERNR:
Pablo Neira Ayuso4bab3bf2013-07-05 15:00:13 +0200766 strncpy(str, dev->serno, IPA_STRING_MAX);
Pablo Neira Ayusodfafe682011-07-02 14:32:32 +0200767 break;
768 default:
Harald Weltecc2241b2011-07-19 16:06:06 +0200769 LOGP(DLINP, LOGL_NOTICE,
Pablo Neira Ayusodfafe682011-07-02 14:32:32 +0200770 "Unknown ipaccess tag 0x%02x\n", *data);
771 msgb_free(nmsg);
772 return NULL;
773 }
Pablo Neira Ayuso4bab3bf2013-07-05 15:00:13 +0200774 str[IPA_STRING_MAX-1] = '\0';
775
Harald Weltecc2241b2011-07-19 16:06:06 +0200776 LOGP(DLINP, LOGL_INFO, " tag %d: %s\n", data[1], str);
Pablo Neira Ayusodfafe682011-07-02 14:32:32 +0200777 tag = msgb_put(nmsg, 3 + strlen(str) + 1);
778 tag[0] = 0x00;
779 tag[1] = 1 + strlen(str) + 1;
780 tag[2] = data[1];
781 memcpy(tag + 3, str, strlen(str) + 1);
782 data += 2;
783 len -= 2;
784 }
Pablo Neira Ayuso88136fc2011-07-08 16:21:55 +0200785 ipa_msg_push_header(nmsg, IPAC_PROTO_IPACCESS);
Pablo Neira Ayusodfafe682011-07-02 14:32:32 +0200786 return nmsg;
787}
788
789static struct msgb *ipa_bts_id_ack(void)
790{
791 struct msgb *nmsg2;
792
Pablo Neira Ayuso88136fc2011-07-08 16:21:55 +0200793 nmsg2 = ipa_msg_alloc(0);
Pablo Neira Ayusodfafe682011-07-02 14:32:32 +0200794 if (!nmsg2)
795 return NULL;
796
797 *msgb_put(nmsg2, 1) = IPAC_MSGT_ID_ACK;
Pablo Neira Ayuso88136fc2011-07-08 16:21:55 +0200798 ipa_msg_push_header(nmsg2, IPAC_PROTO_IPACCESS);
Pablo Neira Ayusodfafe682011-07-02 14:32:32 +0200799
800 return nmsg2;
801}
802
Harald Weltea3e9dd52013-06-30 14:25:07 +0200803static int ipaccess_bts_read_cb(struct ipa_client_conn *link, struct msgb *msg)
Pablo Neira Ayuso591ddad2011-06-21 18:16:42 +0200804{
805 struct ipaccess_head *hh = (struct ipaccess_head *) msg->data;
806 struct e1inp_ts *e1i_ts = NULL;
807 struct e1inp_sign_link *sign_link;
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200808 struct msgb *rmsg;
809 int ret = 0;
Pablo Neira Ayuso591ddad2011-06-21 18:16:42 +0200810
811 /* special handling for IPA CCM. */
812 if (hh->proto == IPAC_PROTO_IPACCESS) {
813 uint8_t msg_type = *(msg->l2h);
814
815 /* ping, pong and acknowledgment cases. */
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200816 ret = ipaccess_rcvmsg_bts_base(msg, link->ofd);
817 if (ret < 0)
818 goto err;
Pablo Neira Ayuso591ddad2011-06-21 18:16:42 +0200819
820 /* this is a request for identification from the BSC. */
821 if (msg_type == IPAC_MSGT_ID_GET) {
Pablo Neira Ayusodfafe682011-07-02 14:32:32 +0200822 struct e1inp_sign_link *sign_link;
Pablo Neira Ayusodfafe682011-07-02 14:32:32 +0200823 uint8_t *data = msgb_l2(msg);
824 int len = msgb_l2len(msg);
825
Harald Weltecc2241b2011-07-19 16:06:06 +0200826 LOGP(DLINP, LOGL_NOTICE, "received ID get\n");
Pablo Neira Ayusof163d232011-06-25 18:42:55 +0200827 if (!link->line->ops->sign_link_up) {
Harald Weltecc2241b2011-07-19 16:06:06 +0200828 LOGP(DLINP, LOGL_ERROR,
Pablo Neira Ayusocd8d2e52011-07-02 17:05:21 +0200829 "Unable to set signal link, "
830 "closing socket.\n");
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200831 ret = -EINVAL;
832 goto err;
Pablo Neira Ayuso591ddad2011-06-21 18:16:42 +0200833 }
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200834 sign_link = link->line->ops->sign_link_up(msg,
835 link->line,
836 link->ofd->priv_nr);
Pablo Neira Ayusodfafe682011-07-02 14:32:32 +0200837 if (sign_link == NULL) {
Harald Weltecc2241b2011-07-19 16:06:06 +0200838 LOGP(DLINP, LOGL_ERROR,
Pablo Neira Ayusocd8d2e52011-07-02 17:05:21 +0200839 "Unable to set signal link, "
840 "closing socket.\n");
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200841 ret = -EINVAL;
842 goto err;
Pablo Neira Ayusodfafe682011-07-02 14:32:32 +0200843 }
Pablo Neira Ayuso4e862cb2011-08-19 18:43:38 +0200844 rmsg = ipa_bts_id_resp(link->line->ops->cfg.ipa.dev,
Pablo Neira Ayusodfafe682011-07-02 14:32:32 +0200845 data + 1, len - 1);
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200846 ret = ipaccess_send(link->ofd->fd, rmsg->data,
847 rmsg->len);
848 if (ret != rmsg->len) {
849 LOGP(DLINP, LOGL_ERROR, "cannot send ID_RESP "
850 "message. Reason: %s\n", strerror(errno));
851 goto err_rmsg;
852 }
Pablo Neira Ayusodfafe682011-07-02 14:32:32 +0200853 msgb_free(rmsg);
854
855 /* send ID_ACK. */
856 rmsg = ipa_bts_id_ack();
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200857 ret = ipaccess_send(link->ofd->fd, rmsg->data,
858 rmsg->len);
859 if (ret != rmsg->len) {
860 LOGP(DLINP, LOGL_ERROR, "cannot send ID_ACK "
861 "message. Reason: %s\n", strerror(errno));
862 goto err_rmsg;
863 }
Pablo Neira Ayusodfafe682011-07-02 14:32:32 +0200864 msgb_free(rmsg);
Pablo Neira Ayuso591ddad2011-06-21 18:16:42 +0200865 }
Pablo Neira Ayuso84e5cb92012-08-23 23:41:54 +0200866 msgb_free(msg);
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200867 return ret;
Pablo Neira Ayuso591ddad2011-06-21 18:16:42 +0200868 } else if (link->port == IPA_TCP_PORT_OML)
869 e1i_ts = &link->line->ts[0];
870 else if (link->port == IPA_TCP_PORT_RSL)
871 e1i_ts = &link->line->ts[1];
872
Pablo Neira Ayusob9487012013-07-05 14:38:43 +0200873 OSMO_ASSERT(e1i_ts != NULL);
874
Pablo Neira Ayuso591ddad2011-06-21 18:16:42 +0200875 /* look up for some existing signaling link. */
876 sign_link = e1inp_lookup_sign_link(e1i_ts, hh->proto, 0);
877 if (sign_link == NULL) {
Harald Weltecc2241b2011-07-19 16:06:06 +0200878 LOGP(DLINP, LOGL_ERROR, "no matching signalling link for "
Pablo Neira Ayuso591ddad2011-06-21 18:16:42 +0200879 "hh->proto=0x%02x\n", hh->proto);
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200880 ret = -EIO;
881 goto err;
Pablo Neira Ayuso591ddad2011-06-21 18:16:42 +0200882 }
883 msg->dst = sign_link;
884
885 /* XXX better use e1inp_ts_rx? */
Pablo Neira Ayusof163d232011-06-25 18:42:55 +0200886 if (!link->line->ops->sign_link) {
Harald Weltecc2241b2011-07-19 16:06:06 +0200887 LOGP(DLINP, LOGL_ERROR, "Fix your application, "
Pablo Neira Ayuso591ddad2011-06-21 18:16:42 +0200888 "no action set for signalling messages.\n");
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200889 ret = -ENOENT;
890 goto err;
Pablo Neira Ayuso591ddad2011-06-21 18:16:42 +0200891 }
Pablo Neira Ayusodbd82fb2011-07-05 15:29:23 +0200892 link->line->ops->sign_link(msg);
Pablo Neira Ayuso591ddad2011-06-21 18:16:42 +0200893 return 0;
Pablo Neira Ayuso1e401942012-08-22 14:16:24 +0200894
895err_rmsg:
896 msgb_free(rmsg);
897err:
898 osmo_fd_unregister(link->ofd);
899 close(link->ofd->fd);
900 link->ofd->fd = -1;
901 msgb_free(msg);
902 return ret;
Pablo Neira Ayuso591ddad2011-06-21 18:16:42 +0200903}
904
Pablo Neira Ayusod6216402011-08-31 16:47:44 +0200905struct ipaccess_line {
906 int line_already_initialized;
907};
908
Pablo Neira Ayuso4e862cb2011-08-19 18:43:38 +0200909static int ipaccess_line_update(struct e1inp_line *line)
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200910{
911 int ret = -ENOENT;
Pablo Neira Ayusod6216402011-08-31 16:47:44 +0200912 struct ipaccess_line *il;
913
914 if (!line->driver_data)
915 line->driver_data = talloc_zero(line, struct ipaccess_line);
916
917 if (!line->driver_data) {
918 LOGP(DLINP, LOGL_ERROR, "ipaccess: OOM in line update\n");
919 return -ENOMEM;
920 }
921 il = line->driver_data;
922
923 /* We only initialize this line once. */
924 if (il->line_already_initialized)
925 return 0;
926
927 il->line_already_initialized = 1;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200928
Pablo Neira Ayuso4e862cb2011-08-19 18:43:38 +0200929 switch(line->ops->cfg.ipa.role) {
Pablo Neira Ayuso986191f2011-06-21 19:56:26 +0200930 case E1INP_LINE_R_BSC: {
931 struct ipa_server_link *oml_link, *rsl_link;
932
Harald Weltecc2241b2011-07-19 16:06:06 +0200933 LOGP(DLINP, LOGL_NOTICE, "enabling ipaccess BSC mode\n");
Pablo Neira Ayuso96e81282011-06-09 15:06:11 +0200934
Pablo Neira Ayuso986191f2011-06-21 19:56:26 +0200935 oml_link = ipa_server_link_create(tall_ipa_ctx, line,
936 "0.0.0.0", IPA_TCP_PORT_OML,
Pablo Neira Ayusoe009f4a2011-06-23 13:36:34 +0200937 ipaccess_bsc_oml_cb, NULL);
Pablo Neira Ayuso986191f2011-06-21 19:56:26 +0200938 if (oml_link == NULL) {
Harald Weltecc2241b2011-07-19 16:06:06 +0200939 LOGP(DLINP, LOGL_ERROR, "cannot create OML "
Pablo Neira Ayuso986191f2011-06-21 19:56:26 +0200940 "BSC link: %s\n", strerror(errno));
941 return -ENOMEM;
Pablo Neira Ayusof67471f2011-06-07 11:25:49 +0200942 }
Pablo Neira Ayuso986191f2011-06-21 19:56:26 +0200943 if (ipa_server_link_open(oml_link) < 0) {
Harald Weltecc2241b2011-07-19 16:06:06 +0200944 LOGP(DLINP, LOGL_ERROR, "cannot open OML BSC link: %s\n",
Pablo Neira Ayuso986191f2011-06-21 19:56:26 +0200945 strerror(errno));
Pablo Neira Ayuso986191f2011-06-21 19:56:26 +0200946 ipa_server_link_destroy(oml_link);
947 return -EIO;
Pablo Neira Ayusof67471f2011-06-07 11:25:49 +0200948 }
Pablo Neira Ayuso986191f2011-06-21 19:56:26 +0200949 rsl_link = ipa_server_link_create(tall_ipa_ctx, line,
950 "0.0.0.0", IPA_TCP_PORT_RSL,
Pablo Neira Ayusoe009f4a2011-06-23 13:36:34 +0200951 ipaccess_bsc_rsl_cb, NULL);
Pablo Neira Ayuso986191f2011-06-21 19:56:26 +0200952 if (rsl_link == NULL) {
Harald Weltecc2241b2011-07-19 16:06:06 +0200953 LOGP(DLINP, LOGL_ERROR, "cannot create RSL "
Pablo Neira Ayuso986191f2011-06-21 19:56:26 +0200954 "BSC link: %s\n", strerror(errno));
955 return -ENOMEM;
956 }
957 if (ipa_server_link_open(rsl_link) < 0) {
Harald Weltecc2241b2011-07-19 16:06:06 +0200958 LOGP(DLINP, LOGL_ERROR, "cannot open RSL BSC link: %s\n",
Pablo Neira Ayuso986191f2011-06-21 19:56:26 +0200959 strerror(errno));
Pablo Neira Ayuso986191f2011-06-21 19:56:26 +0200960 ipa_server_link_destroy(rsl_link);
961 return -EIO;
962 }
963 ret = 0;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200964 break;
Pablo Neira Ayuso986191f2011-06-21 19:56:26 +0200965 }
Pablo Neira Ayuso96e81282011-06-09 15:06:11 +0200966 case E1INP_LINE_R_BTS: {
Harald Welte84f67b22013-06-30 13:13:59 +0200967 struct ipa_client_conn *link;
Pablo Neira Ayuso96e81282011-06-09 15:06:11 +0200968
Harald Weltecc2241b2011-07-19 16:06:06 +0200969 LOGP(DLINP, LOGL_NOTICE, "enabling ipaccess BTS mode\n");
Pablo Neira Ayuso96e81282011-06-09 15:06:11 +0200970
Pablo Neira Ayusof0995672011-09-08 12:58:38 +0200971 link = ipa_client_conn_create(tall_ipa_ctx,
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200972 &line->ts[E1INP_SIGN_OML-1],
Pablo Neira Ayuso00af7722011-09-08 12:47:06 +0200973 E1INP_SIGN_OML,
Pablo Neira Ayuso4e862cb2011-08-19 18:43:38 +0200974 line->ops->cfg.ipa.addr,
975 IPA_TCP_PORT_OML,
Pablo Neira Ayuso88136fc2011-07-08 16:21:55 +0200976 NULL,
Harald Weltea3e9dd52013-06-30 14:25:07 +0200977 ipaccess_bts_read_cb,
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200978 ipaccess_bts_write_cb,
Harald Welte10b41302013-06-30 14:05:49 +0200979 line);
Pablo Neira Ayuso96e81282011-06-09 15:06:11 +0200980 if (link == NULL) {
Harald Weltecc2241b2011-07-19 16:06:06 +0200981 LOGP(DLINP, LOGL_ERROR, "cannot create OML "
Pablo Neira Ayuso29465d32011-06-21 14:21:33 +0200982 "BTS link: %s\n", strerror(errno));
Pablo Neira Ayuso96e81282011-06-09 15:06:11 +0200983 return -ENOMEM;
984 }
Pablo Neira Ayusof0995672011-09-08 12:58:38 +0200985 if (ipa_client_conn_open(link) < 0) {
Harald Weltecc2241b2011-07-19 16:06:06 +0200986 LOGP(DLINP, LOGL_ERROR, "cannot open OML BTS link: %s\n",
Pablo Neira Ayuso29465d32011-06-21 14:21:33 +0200987 strerror(errno));
Pablo Neira Ayusof0995672011-09-08 12:58:38 +0200988 ipa_client_conn_close(link);
989 ipa_client_conn_destroy(link);
Pablo Neira Ayuso96e81282011-06-09 15:06:11 +0200990 return -EIO;
991 }
992 ret = 0;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200993 break;
Pablo Neira Ayuso96e81282011-06-09 15:06:11 +0200994 }
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200995 default:
996 break;
997 }
998 return ret;
999}
1000
Harald Welte84f67b22013-06-30 13:13:59 +02001001int e1inp_ipa_bts_rsl_connect(struct e1inp_line *line,
1002 const char *rem_addr, uint16_t rem_port)
1003{
1004 struct ipa_client_conn *rsl_link;
1005
1006 rsl_link = ipa_client_conn_create(tall_ipa_ctx,
1007 &line->ts[E1INP_SIGN_RSL-1],
1008 E1INP_SIGN_RSL,
1009 rem_addr, rem_port,
1010 NULL,
Harald Weltea3e9dd52013-06-30 14:25:07 +02001011 ipaccess_bts_read_cb,
Harald Welte84f67b22013-06-30 13:13:59 +02001012 ipaccess_bts_write_cb,
Harald Welte10b41302013-06-30 14:05:49 +02001013 line);
Harald Welte84f67b22013-06-30 13:13:59 +02001014 if (rsl_link == NULL) {
1015 LOGP(DLINP, LOGL_ERROR, "cannot create RSL "
1016 "BTS link: %s\n", strerror(errno));
1017 return -ENOMEM;
1018 }
1019 if (ipa_client_conn_open(rsl_link) < 0) {
1020 LOGP(DLINP, LOGL_ERROR, "cannot open RSL BTS link: %s\n",
1021 strerror(errno));
1022 ipa_client_conn_close(rsl_link);
1023 ipa_client_conn_destroy(rsl_link);
1024 return -EIO;
1025 }
1026 return 0;
1027}
1028
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +02001029void e1inp_ipaccess_init(void)
1030{
Pablo Neira Ayuso54b49792011-06-07 12:15:26 +02001031 tall_ipa_ctx = talloc_named_const(libosmo_abis_ctx, 1, "ipa");
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +02001032 e1inp_driver_register(&ipaccess_driver);
1033}