blob: 2449e261d21674d5a6e1d86c640e0de51fc48ce5 [file] [log] [blame]
Harald Welte5fd8a542009-02-13 02:43:36 +00001/* OpenBSC Abis input driver for ip.access */
2
3/* (C) 2009 by Harald Welte <laforge@gnumonks.org>
4 *
5 * All Rights Reserved
6 *
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License as published by
9 * the Free Software Foundation; either version 2 of the License, or
10 * (at your option) any later version.
11 *
12 * This program is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU General Public License for more details.
16 *
17 * You should have received a copy of the GNU General Public License along
18 * with this program; if not, write to the Free Software Foundation, Inc.,
19 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
20 *
21 */
22
23#include <stdio.h>
24#include <unistd.h>
25#include <stdlib.h>
26#include <errno.h>
27#include <string.h>
28#include <time.h>
29#include <sys/fcntl.h>
30#include <sys/types.h>
31#include <sys/socket.h>
32#include <sys/ioctl.h>
33#include <arpa/inet.h>
34
Harald Weltedfe6c7d2010-02-20 16:24:02 +010035#include <osmocore/select.h>
36#include <osmocore/tlv.h>
37#include <osmocore/msgb.h>
Harald Welte5fd8a542009-02-13 02:43:36 +000038#include <openbsc/debug.h>
39#include <openbsc/gsm_data.h>
40#include <openbsc/abis_nm.h>
41#include <openbsc/abis_rsl.h>
42#include <openbsc/subchan_demux.h>
43#include <openbsc/e1_input.h>
Harald Welte4f361fc2009-02-15 15:32:53 +000044#include <openbsc/ipaccess.h>
Harald Weltedfe6c7d2010-02-20 16:24:02 +010045#include <osmocore/talloc.h>
Harald Welte5fd8a542009-02-13 02:43:36 +000046
Holger Hans Peter Freytherdc6af632010-03-24 04:56:13 +010047#define PRIV_OML 1
48#define PRIV_RSL 2
49
Harald Welte5fd8a542009-02-13 02:43:36 +000050/* data structure for one E1 interface with A-bis */
51struct ia_e1_handle {
52 struct bsc_fd listen_fd;
Harald Welte5c1e4582009-02-15 11:57:29 +000053 struct bsc_fd rsl_listen_fd;
Harald Welteedb37782009-05-01 14:59:07 +000054 struct gsm_network *gsmnet;
Harald Welte5fd8a542009-02-13 02:43:36 +000055};
56
Harald Welteedb37782009-05-01 14:59:07 +000057static struct ia_e1_handle *e1h;
58
59
Holger Hans Peter Freyther6c8c0dd2010-04-04 18:12:37 +020060#define TS1_ALLOC_SIZE 900
Harald Welte5fd8a542009-02-13 02:43:36 +000061
Harald Welte4f361fc2009-02-15 15:32:53 +000062static const u_int8_t pong[] = { 0, 1, IPAC_PROTO_IPACCESS, IPAC_MSGT_PONG };
63static const u_int8_t id_ack[] = { 0, 1, IPAC_PROTO_IPACCESS, IPAC_MSGT_ID_ACK };
Harald Welteedb37782009-05-01 14:59:07 +000064static const u_int8_t id_req[] = { 0, 17, IPAC_PROTO_IPACCESS, IPAC_MSGT_ID_GET,
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +020065 0x01, IPAC_IDTAG_UNIT,
Harald Welteedb37782009-05-01 14:59:07 +000066 0x01, IPAC_IDTAG_MACADDR,
67 0x01, IPAC_IDTAG_LOCATION1,
68 0x01, IPAC_IDTAG_LOCATION2,
69 0x01, IPAC_IDTAG_EQUIPVERS,
70 0x01, IPAC_IDTAG_SWVERSION,
71 0x01, IPAC_IDTAG_UNITNAME,
72 0x01, IPAC_IDTAG_SERNR,
73 };
Harald Welte5fd8a542009-02-13 02:43:36 +000074
Harald Welteedb37782009-05-01 14:59:07 +000075static const char *idtag_names[] = {
76 [IPAC_IDTAG_SERNR] = "Serial_Number",
77 [IPAC_IDTAG_UNITNAME] = "Unit_Name",
78 [IPAC_IDTAG_LOCATION1] = "Location_1",
79 [IPAC_IDTAG_LOCATION2] = "Location_2",
80 [IPAC_IDTAG_EQUIPVERS] = "Equipment_Version",
81 [IPAC_IDTAG_SWVERSION] = "Software_Version",
82 [IPAC_IDTAG_IPADDR] = "IP_Address",
83 [IPAC_IDTAG_MACADDR] = "MAC_Address",
84 [IPAC_IDTAG_UNIT] = "Unit_ID",
85};
86
87static const char *ipac_idtag_name(int tag)
Harald Welte5fd8a542009-02-13 02:43:36 +000088{
Harald Welteedb37782009-05-01 14:59:07 +000089 if (tag >= ARRAY_SIZE(idtag_names))
90 return "unknown";
91
92 return idtag_names[tag];
93}
94
Holger Hans Peter Freytherd3d5be12010-02-09 14:37:23 +010095int ipaccess_idtag_parse(struct tlv_parsed *dec, unsigned char *buf, int len)
Harald Welteedb37782009-05-01 14:59:07 +000096{
97 u_int8_t t_len;
98 u_int8_t t_tag;
99 u_int8_t *cur = buf;
100
101 while (cur < buf + len) {
102 t_len = *cur++;
103 t_tag = *cur++;
104
105 DEBUGPC(DMI, "%s='%s' ", ipac_idtag_name(t_tag), cur);
106
107 dec->lv[t_tag].len = t_len;
108 dec->lv[t_tag].val = cur;
109
110 cur += t_len;
111 }
112 return 0;
113}
114
115struct gsm_bts *find_bts_by_unitid(struct gsm_network *net,
116 u_int16_t site_id, u_int16_t bts_id)
117{
Harald Weltee441d9c2009-06-21 16:17:15 +0200118 struct gsm_bts *bts;
Harald Welteedb37782009-05-01 14:59:07 +0000119
Harald Weltee441d9c2009-06-21 16:17:15 +0200120 llist_for_each_entry(bts, &net->bts_list, list) {
Harald Welteedb37782009-05-01 14:59:07 +0000121
122 if (!is_ipaccess_bts(bts))
123 continue;
124
125 if (bts->ip_access.site_id == site_id &&
126 bts->ip_access.bts_id == bts_id)
127 return bts;
128 }
129
130 return NULL;
131}
132
133static int parse_unitid(const char *str, u_int16_t *site_id, u_int16_t *bts_id,
134 u_int16_t *trx_id)
135{
136 unsigned long ul;
137 char *endptr;
138 const char *nptr;
139
140 nptr = str;
141 ul = strtoul(nptr, &endptr, 10);
142 if (endptr <= nptr)
143 return -EINVAL;
144 if (site_id)
145 *site_id = ul & 0xffff;
146
147 if (*endptr++ != '/')
148 return -EINVAL;
149
150 nptr = endptr;
151 ul = strtoul(nptr, &endptr, 10);
152 if (endptr <= nptr)
153 return -EINVAL;
154 if (bts_id)
155 *bts_id = ul & 0xffff;
156
157 if (*endptr++ != '/')
158 return -EINVAL;
159
160 nptr = endptr;
161 ul = strtoul(nptr, &endptr, 10);
162 if (endptr <= nptr)
163 return -EINVAL;
164 if (trx_id)
165 *trx_id = ul & 0xffff;
166
167 return 0;
168}
169
Holger Hans Peter Freyther301e6282010-01-13 09:06:46 +0100170/* send the id ack */
171int ipaccess_send_id_ack(int fd)
172{
173 return write(fd, id_ack, sizeof(id_ack));
174}
175
Holger Hans Peter Freyther3bc856b2010-02-07 12:04:07 +0100176int ipaccess_send_id_req(int fd)
177{
178 return write(fd, id_req, sizeof(id_req));
179}
180
Holger Hans Peter Freytherd5f05222009-08-18 10:05:45 +0200181/* base handling of the ip.access protocol */
182int ipaccess_rcvmsg_base(struct msgb *msg,
183 struct bsc_fd *bfd)
Harald Welteedb37782009-05-01 14:59:07 +0000184{
Harald Welte5fd8a542009-02-13 02:43:36 +0000185 u_int8_t msg_type = *(msg->l2h);
Holger Freytherff9592f2009-03-09 16:17:14 +0000186 int ret = 0;
Harald Welte5fd8a542009-02-13 02:43:36 +0000187
Harald Welte5fd8a542009-02-13 02:43:36 +0000188 switch (msg_type) {
Harald Welte4f361fc2009-02-15 15:32:53 +0000189 case IPAC_MSGT_PING:
Harald Welteedb37782009-05-01 14:59:07 +0000190 ret = write(bfd->fd, pong, sizeof(pong));
Harald Welte5fd8a542009-02-13 02:43:36 +0000191 break;
Harald Welte4f361fc2009-02-15 15:32:53 +0000192 case IPAC_MSGT_PONG:
Harald Welte5fd8a542009-02-13 02:43:36 +0000193 DEBUGP(DMI, "PONG!\n");
194 break;
Holger Hans Peter Freytherd5f05222009-08-18 10:05:45 +0200195 case IPAC_MSGT_ID_ACK:
196 DEBUGP(DMI, "ID_ACK? -> ACK!\n");
Holger Hans Peter Freyther301e6282010-01-13 09:06:46 +0100197 ret = ipaccess_send_id_ack(bfd->fd);
Holger Hans Peter Freytherd5f05222009-08-18 10:05:45 +0200198 break;
199 }
200 return 0;
201}
202
203static int ipaccess_rcvmsg(struct e1inp_line *line, struct msgb *msg,
204 struct bsc_fd *bfd)
205{
206 struct tlv_parsed tlvp;
207 u_int8_t msg_type = *(msg->l2h);
208 u_int16_t site_id = 0, bts_id = 0, trx_id = 0;
209 struct gsm_bts *bts;
210
211 /* handle base messages */
212 ipaccess_rcvmsg_base(msg, bfd);
213
214 switch (msg_type) {
Harald Welte4f361fc2009-02-15 15:32:53 +0000215 case IPAC_MSGT_ID_RESP:
Harald Welteedb37782009-05-01 14:59:07 +0000216 DEBUGP(DMI, "ID_RESP ");
217 /* parse tags, search for Unit ID */
Holger Hans Peter Freytherd3d5be12010-02-09 14:37:23 +0100218 ipaccess_idtag_parse(&tlvp, (u_int8_t *)msg->l2h + 2,
Harald Welteedb37782009-05-01 14:59:07 +0000219 msgb_l2len(msg)-2);
220 DEBUGP(DMI, "\n");
221
222 if (!TLVP_PRESENT(&tlvp, IPAC_IDTAG_UNIT))
223 break;
224
225 /* lookup BTS, create sign_link, ... */
226 parse_unitid((char *)TLVP_VAL(&tlvp, IPAC_IDTAG_UNIT),
227 &site_id, &bts_id, &trx_id);
228 bts = find_bts_by_unitid(e1h->gsmnet, site_id, bts_id);
229 if (!bts) {
Harald Welteafdca0f2009-12-23 23:01:04 +0100230 LOGP(DINP, LOGL_ERROR, "Unable to find BTS configuration for "
Harald Welteedb37782009-05-01 14:59:07 +0000231 " %u/%u/%u, disconnecting\n", site_id, bts_id,
232 trx_id);
233 return -EIO;
234 }
235 DEBUGP(DINP, "Identified BTS %u/%u/%u\n", site_id, bts_id, trx_id);
Holger Hans Peter Freytherdc6af632010-03-24 04:56:13 +0100236 if (bfd->priv_nr == PRIV_OML) {
237 bts->oml_link = e1inp_sign_link_create(&line->ts[PRIV_OML - 1],
Harald Welteedb37782009-05-01 14:59:07 +0000238 E1INP_SIGN_OML, bts->c0,
Harald Welte8175e952009-10-20 00:22:00 +0200239 bts->oml_tei, 0);
Holger Hans Peter Freytherdc6af632010-03-24 04:56:13 +0100240 } else if (bfd->priv_nr == PRIV_RSL) {
Harald Welteedb37782009-05-01 14:59:07 +0000241 struct e1inp_ts *e1i_ts;
242 struct bsc_fd *newbfd;
Harald Welte8175e952009-10-20 00:22:00 +0200243 struct gsm_bts_trx *trx = gsm_bts_trx_num(bts, trx_id);
Harald Welteedb37782009-05-01 14:59:07 +0000244
Harald Welteedb37782009-05-01 14:59:07 +0000245 bfd->data = line = bts->oml_link->ts->line;
Holger Hans Peter Freytherdc6af632010-03-24 04:56:13 +0100246 e1i_ts = &line->ts[PRIV_RSL + trx_id - 1];
Harald Welteedb37782009-05-01 14:59:07 +0000247 newbfd = &e1i_ts->driver.ipaccess.fd;
Harald Welte8175e952009-10-20 00:22:00 +0200248 e1inp_ts_config(e1i_ts, line, E1INP_TS_TYPE_SIGN);
Harald Welteedb37782009-05-01 14:59:07 +0000249
Harald Welte8175e952009-10-20 00:22:00 +0200250 trx->rsl_link = e1inp_sign_link_create(e1i_ts,
251 E1INP_SIGN_RSL, trx,
252 trx->rsl_tei, 0);
Holger Hans Peter Freyther354ef812010-03-24 04:02:55 +0100253
254 if (newbfd->fd >= 0) {
255 LOGP(DINP, LOGL_ERROR, "BTS is still registered. Closing old connection.\n");
256 bsc_unregister_fd(newbfd);
257 close(newbfd->fd);
Holger Hans Peter Freytheredee7942010-03-24 11:20:27 +0100258 newbfd->fd = -1;
Holger Hans Peter Freyther354ef812010-03-24 04:02:55 +0100259 }
260
Harald Welteedb37782009-05-01 14:59:07 +0000261 /* get rid of our old temporary bfd */
262 memcpy(newbfd, bfd, sizeof(*newbfd));
Holger Hans Peter Freytherdc6af632010-03-24 04:56:13 +0100263 newbfd->priv_nr = PRIV_RSL + trx_id;
Harald Welteedb37782009-05-01 14:59:07 +0000264 bsc_unregister_fd(bfd);
265 bsc_register_fd(newbfd);
Harald Weltea4ffea92009-06-22 01:36:25 +0200266 talloc_free(bfd);
Harald Welteedb37782009-05-01 14:59:07 +0000267 }
Harald Welte5fd8a542009-02-13 02:43:36 +0000268 break;
Harald Welte5fd8a542009-02-13 02:43:36 +0000269 }
Harald Welte5fd8a542009-02-13 02:43:36 +0000270 return 0;
271}
272
Harald Welte88a412a2009-12-16 17:32:37 +0100273#define OML_UP 0x0001
274#define RSL_UP 0x0002
Harald Welte7782c142009-02-15 03:39:51 +0000275
Holger Hans Peter Freytherd5f05222009-08-18 10:05:45 +0200276/*
277 * read one ipa message from the socket
278 * return NULL in case of error
279 */
280struct msgb *ipaccess_read_msg(struct bsc_fd *bfd, int *error)
Harald Welte5fd8a542009-02-13 02:43:36 +0000281{
Harald Welte966636f2009-06-26 19:39:35 +0200282 struct msgb *msg = msgb_alloc(TS1_ALLOC_SIZE, "Abis/IP");
Harald Welte5fd8a542009-02-13 02:43:36 +0000283 struct ipaccess_head *hh;
Sylvain Munautd7d1c992009-10-29 16:33:59 +0100284 int len, ret = 0;
Harald Welte5fd8a542009-02-13 02:43:36 +0000285
Holger Hans Peter Freytherd5f05222009-08-18 10:05:45 +0200286 if (!msg) {
287 *error = -ENOMEM;
288 return NULL;
289 }
Harald Welte5fd8a542009-02-13 02:43:36 +0000290
291 /* first read our 3-byte header */
292 hh = (struct ipaccess_head *) msg->data;
Holger Hans Peter Freytherb3121c52010-03-24 08:40:55 +0100293 ret = recv(bfd->fd, msg->data, sizeof(*hh), 0);
294 if (ret == 0) {
Holger Hans Peter Freytherd5f05222009-08-18 10:05:45 +0200295 msgb_free(msg);
296 *error = ret;
297 return NULL;
Holger Hans Peter Freytherb3121c52010-03-24 08:40:55 +0100298 } else if (ret != sizeof(*hh)) {
299 if (errno != EAGAIN)
300 LOGP(DINP, LOGL_ERROR, "recv error %d %s\n", ret, strerror(errno));
Holger Hans Peter Freytherd5f05222009-08-18 10:05:45 +0200301 msgb_free(msg);
302 *error = ret;
303 return NULL;
Harald Welte5fd8a542009-02-13 02:43:36 +0000304 }
Holger Hans Peter Freytherd5f05222009-08-18 10:05:45 +0200305
Harald Welte5fd8a542009-02-13 02:43:36 +0000306 msgb_put(msg, ret);
307
308 /* then read te length as specified in header */
309 msg->l2h = msg->data + sizeof(*hh);
Sylvain Munautd7d1c992009-10-29 16:33:59 +0100310 len = ntohs(hh->len);
Holger Hans Peter Freytherb3121c52010-03-24 08:40:55 +0100311
312 if (len < 0 || TS1_ALLOC_SIZE < len + sizeof(*hh)) {
313 LOGP(DINP, LOGL_ERROR, "Can not read this packet. %d avail\n", len);
314 msgb_free(msg);
315 *error = -EIO;
316 return NULL;
317 }
318
Sylvain Munautd7d1c992009-10-29 16:33:59 +0100319 ret = recv(bfd->fd, msg->l2h, len, 0);
320 if (ret < len) {
Holger Hans Peter Freytherb3121c52010-03-24 08:40:55 +0100321 LOGP(DINP, LOGL_ERROR, "short read! Got %d from %d\n", ret, len);
Harald Welte5c1e4582009-02-15 11:57:29 +0000322 msgb_free(msg);
Holger Hans Peter Freytherd5f05222009-08-18 10:05:45 +0200323 *error = -EIO;
324 return NULL;
Harald Welte5fd8a542009-02-13 02:43:36 +0000325 }
326 msgb_put(msg, ret);
Holger Hans Peter Freytherd5f05222009-08-18 10:05:45 +0200327
328 return msg;
329}
330
331static int handle_ts1_read(struct bsc_fd *bfd)
332{
333 struct e1inp_line *line = bfd->data;
334 unsigned int ts_nr = bfd->priv_nr;
335 struct e1inp_ts *e1i_ts = &line->ts[ts_nr-1];
336 struct e1inp_sign_link *link;
337 struct msgb *msg;
338 struct ipaccess_head *hh;
Holger Hans Peter Freyther67b59612009-10-27 10:08:38 +0100339 int ret = 0, error;
Holger Hans Peter Freytherd5f05222009-08-18 10:05:45 +0200340
341 msg = ipaccess_read_msg(bfd, &error);
342 if (!msg) {
343 if (error == 0) {
Harald Welte (local)7971d3d2009-12-28 17:52:11 +0100344 link = e1inp_lookup_sign_link(e1i_ts, IPAC_PROTO_OML, 0);
345 if (link) {
346 link->trx->bts->ip_access.flags = 0;
347 LOGP(DINP, LOGL_NOTICE, "BTS %u disappeared, dead socket\n",
348 link->trx->bts->nr);
349 } else
350 LOGP(DINP, LOGL_NOTICE, "unknown BTS disappeared, dead socket\n");
Holger Hans Peter Freytherd5f05222009-08-18 10:05:45 +0200351 e1inp_event(e1i_ts, EVT_E1_TEI_DN, 0, IPAC_PROTO_RSL);
352 e1inp_event(e1i_ts, EVT_E1_TEI_DN, 0, IPAC_PROTO_OML);
353 bsc_unregister_fd(bfd);
354 close(bfd->fd);
355 bfd->fd = -1;
356 }
357 return error;
358 }
359
Sylvain Munaut86538c72009-09-30 22:35:04 +0200360 DEBUGP(DMI, "RX %u: %s\n", ts_nr, hexdump(msgb_l2(msg), msgb_l2len(msg)));
Harald Welte5fd8a542009-02-13 02:43:36 +0000361
Holger Hans Peter Freytherd5f05222009-08-18 10:05:45 +0200362 hh = (struct ipaccess_head *) msg->data;
Harald Welteedb37782009-05-01 14:59:07 +0000363 if (hh->proto == IPAC_PROTO_IPACCESS) {
364 ret = ipaccess_rcvmsg(line, msg, bfd);
365 if (ret < 0) {
366 e1inp_event(e1i_ts, EVT_E1_TEI_DN, 0, IPAC_PROTO_RSL);
367 e1inp_event(e1i_ts, EVT_E1_TEI_DN, 0, IPAC_PROTO_OML);
368 bsc_unregister_fd(bfd);
369 close(bfd->fd);
370 bfd->fd = -1;
371 }
372 msgb_free(msg);
373 return ret;
374 }
375 /* BIG FAT WARNING: bfd might no longer exist here, since ipaccess_rcvmsg()
376 * might have free'd it !!! */
377
Harald Welte8175e952009-10-20 00:22:00 +0200378 link = e1inp_lookup_sign_link(e1i_ts, hh->proto, 0);
Harald Welte5fd8a542009-02-13 02:43:36 +0000379 if (!link) {
Harald Welteafdca0f2009-12-23 23:01:04 +0100380 LOGP(DINP, LOGL_ERROR, "no matching signalling link for "
381 "hh->proto=0x%02x\n", hh->proto);
Harald Welte5fd8a542009-02-13 02:43:36 +0000382 msgb_free(msg);
383 return -EIO;
384 }
385 msg->trx = link->trx;
386
Harald Welte8175e952009-10-20 00:22:00 +0200387 switch (link->type) {
388 case E1INP_SIGN_RSL:
Harald Welte1394fea2009-12-21 23:01:33 +0100389 if (!(msg->trx->bts->ip_access.flags & (RSL_UP << msg->trx->nr))) {
Harald Weltee73501a2009-10-21 21:16:00 +0200390 e1inp_event(e1i_ts, EVT_E1_TEI_UP, link->tei, link->sapi);
Harald Welte1394fea2009-12-21 23:01:33 +0100391 msg->trx->bts->ip_access.flags |= (RSL_UP << msg->trx->nr);
Harald Weltee73501a2009-10-21 21:16:00 +0200392 }
Harald Welte5fd8a542009-02-13 02:43:36 +0000393 ret = abis_rsl_rcvmsg(msg);
394 break;
Harald Welte8175e952009-10-20 00:22:00 +0200395 case E1INP_SIGN_OML:
Harald Welte88a412a2009-12-16 17:32:37 +0100396 if (!(msg->trx->bts->ip_access.flags & OML_UP)) {
Harald Welte8175e952009-10-20 00:22:00 +0200397 e1inp_event(e1i_ts, EVT_E1_TEI_UP, link->tei, link->sapi);
Harald Welte88a412a2009-12-16 17:32:37 +0100398 msg->trx->bts->ip_access.flags |= OML_UP;
Harald Welte7782c142009-02-15 03:39:51 +0000399 }
Harald Welte5fd8a542009-02-13 02:43:36 +0000400 ret = abis_nm_rcvmsg(msg);
401 break;
402 default:
Harald Welteafdca0f2009-12-23 23:01:04 +0100403 LOGP(DINP, LOGL_NOTICE, "Unknown IP.access protocol proto=0x%02x\n", hh->proto);
Harald Welte5fd8a542009-02-13 02:43:36 +0000404 msgb_free(msg);
405 break;
406 }
407 return ret;
408}
409
Holger Hans Peter Freytherd5f05222009-08-18 10:05:45 +0200410void ipaccess_prepend_header(struct msgb *msg, int proto)
411{
412 struct ipaccess_head *hh;
413
414 /* prepend the ip.access header */
415 hh = (struct ipaccess_head *) msgb_push(msg, sizeof(*hh));
Sylvain Munautd7d1c992009-10-29 16:33:59 +0100416 hh->len = htons(msg->len - sizeof(*hh));
Holger Hans Peter Freytherd5f05222009-08-18 10:05:45 +0200417 hh->proto = proto;
418}
419
Andreas Eversberg38ae5cb2009-10-08 12:53:16 +0200420static int ts_want_write(struct e1inp_ts *e1i_ts)
421{
422 e1i_ts->driver.ipaccess.fd.when |= BSC_FD_WRITE;
423
424 return 0;
425}
426
427static void timeout_ts1_write(void *data)
428{
429 struct e1inp_ts *e1i_ts = (struct e1inp_ts *)data;
430
431 /* trigger write of ts1, due to tx delay timer */
432 ts_want_write(e1i_ts);
433}
434
Harald Welte5fd8a542009-02-13 02:43:36 +0000435static int handle_ts1_write(struct bsc_fd *bfd)
436{
437 struct e1inp_line *line = bfd->data;
438 unsigned int ts_nr = bfd->priv_nr;
439 struct e1inp_ts *e1i_ts = &line->ts[ts_nr-1];
440 struct e1inp_sign_link *sign_link;
441 struct msgb *msg;
Holger Hans Peter Freytherd5f05222009-08-18 10:05:45 +0200442 u_int8_t proto;
Harald Welte5fd8a542009-02-13 02:43:36 +0000443 int ret;
444
Andreas Eversberg38ae5cb2009-10-08 12:53:16 +0200445 bfd->when &= ~BSC_FD_WRITE;
446
Harald Welte5fd8a542009-02-13 02:43:36 +0000447 /* get the next msg for this timeslot */
448 msg = e1inp_tx_ts(e1i_ts, &sign_link);
449 if (!msg) {
Andreas Eversberg38ae5cb2009-10-08 12:53:16 +0200450 /* no message after tx delay timer */
Harald Welte5fd8a542009-02-13 02:43:36 +0000451 return 0;
452 }
453
Harald Welte5fd8a542009-02-13 02:43:36 +0000454 switch (sign_link->type) {
455 case E1INP_SIGN_OML:
Holger Hans Peter Freytherd5f05222009-08-18 10:05:45 +0200456 proto = IPAC_PROTO_OML;
Harald Welte5fd8a542009-02-13 02:43:36 +0000457 break;
458 case E1INP_SIGN_RSL:
Holger Hans Peter Freytherd5f05222009-08-18 10:05:45 +0200459 proto = IPAC_PROTO_RSL;
Harald Welte5fd8a542009-02-13 02:43:36 +0000460 break;
461 default:
462 msgb_free(msg);
Andreas Eversberg38ae5cb2009-10-08 12:53:16 +0200463 bfd->when |= BSC_FD_WRITE; /* come back for more msg */
Harald Welte5fd8a542009-02-13 02:43:36 +0000464 return -EINVAL;
465 }
466
Holger Hans Peter Freytherd5f05222009-08-18 10:05:45 +0200467 msg->l2h = msg->data;
Harald Welte8175e952009-10-20 00:22:00 +0200468 ipaccess_prepend_header(msg, sign_link->tei);
Holger Hans Peter Freytherd5f05222009-08-18 10:05:45 +0200469
470 DEBUGP(DMI, "TX %u: %s\n", ts_nr, hexdump(msg->l2h, msgb_l2len(msg)));
Harald Welte5fd8a542009-02-13 02:43:36 +0000471
472 ret = send(bfd->fd, msg->data, msg->len, 0);
473 msgb_free(msg);
Andreas Eversberg38ae5cb2009-10-08 12:53:16 +0200474
475 /* set tx delay timer for next event */
476 e1i_ts->sign.tx_timer.cb = timeout_ts1_write;
477 e1i_ts->sign.tx_timer.data = e1i_ts;
Holger Hans Peter Freytherf5284ae2010-03-24 08:27:37 +0100478 bsc_schedule_timer(&e1i_ts->sign.tx_timer, 0, 100);
Harald Welte5fd8a542009-02-13 02:43:36 +0000479
480 return ret;
481}
482
Harald Welte5fd8a542009-02-13 02:43:36 +0000483/* callback from select.c in case one of the fd's can be read/written */
484static int ipaccess_fd_cb(struct bsc_fd *bfd, unsigned int what)
485{
486 struct e1inp_line *line = bfd->data;
487 unsigned int ts_nr = bfd->priv_nr;
488 unsigned int idx = ts_nr-1;
Harald Welteedb37782009-05-01 14:59:07 +0000489 struct e1inp_ts *e1i_ts;
Harald Welte5fd8a542009-02-13 02:43:36 +0000490 int rc = 0;
491
Harald Welteedb37782009-05-01 14:59:07 +0000492 /* In case of early RSL we might not yet have a line */
493
494 if (line)
495 e1i_ts = &line->ts[idx];
496
497 if (!line || e1i_ts->type == E1INP_TS_TYPE_SIGN) {
Harald Welte5fd8a542009-02-13 02:43:36 +0000498 if (what & BSC_FD_READ)
499 rc = handle_ts1_read(bfd);
500 if (what & BSC_FD_WRITE)
501 rc = handle_ts1_write(bfd);
Harald Welteedb37782009-05-01 14:59:07 +0000502 } else
Harald Welteafdca0f2009-12-23 23:01:04 +0100503 LOGP(DINP, LOGL_ERROR, "unknown E1 TS type %u\n", e1i_ts->type);
Harald Welte5fd8a542009-02-13 02:43:36 +0000504
505 return rc;
506}
507
508
Harald Welte5fd8a542009-02-13 02:43:36 +0000509struct e1inp_driver ipaccess_driver = {
510 .name = "ip.access",
511 .want_write = ts_want_write,
512};
513
Harald Welteedb37782009-05-01 14:59:07 +0000514/* callback of the OML listening filedescriptor */
Harald Welte5fd8a542009-02-13 02:43:36 +0000515static int listen_fd_cb(struct bsc_fd *listen_bfd, unsigned int what)
516{
Harald Welte5fd8a542009-02-13 02:43:36 +0000517 int ret;
Harald Welteedb37782009-05-01 14:59:07 +0000518 int idx = 0;
Holger Hans Peter Freytheredee7942010-03-24 11:20:27 +0100519 int i;
Harald Welteedb37782009-05-01 14:59:07 +0000520 struct e1inp_line *line;
521 struct e1inp_ts *e1i_ts;
522 struct bsc_fd *bfd;
523 struct sockaddr_in sa;
524 socklen_t sa_len = sizeof(sa);
Harald Welte5fd8a542009-02-13 02:43:36 +0000525
Harald Welteedb37782009-05-01 14:59:07 +0000526 if (!(what & BSC_FD_READ))
527 return 0;
Harald Welte5fd8a542009-02-13 02:43:36 +0000528
Harald Welteedb37782009-05-01 14:59:07 +0000529 ret = accept(listen_bfd->fd, (struct sockaddr *) &sa, &sa_len);
530 if (ret < 0) {
531 perror("accept");
532 return ret;
Harald Welte5fd8a542009-02-13 02:43:36 +0000533 }
Harald Welteafdca0f2009-12-23 23:01:04 +0100534 LOGP(DINP, LOGL_NOTICE, "accept()ed new OML link from %s\n",
535 inet_ntoa(sa.sin_addr));
Harald Welteedb37782009-05-01 14:59:07 +0000536
Holger Hans Peter Freyther5ea73132009-10-29 02:29:45 +0100537 line = talloc_zero(tall_bsc_ctx, struct e1inp_line);
Harald Welteedb37782009-05-01 14:59:07 +0000538 if (!line) {
539 close(ret);
540 return -ENOMEM;
541 }
Harald Welteedb37782009-05-01 14:59:07 +0000542 line->driver = &ipaccess_driver;
543 //line->driver_data = e1h;
544 /* create virrtual E1 timeslots for signalling */
545 e1inp_ts_config(&line->ts[1-1], line, E1INP_TS_TYPE_SIGN);
Harald Welteedb37782009-05-01 14:59:07 +0000546
Holger Hans Peter Freytheredee7942010-03-24 11:20:27 +0100547 /* initialize the fds */
548 for (i = 0; i < ARRAY_SIZE(line->ts); ++i)
549 line->ts[i].driver.ipaccess.fd.fd = -1;
550
Harald Welteedb37782009-05-01 14:59:07 +0000551 e1i_ts = &line->ts[idx];
552
553 bfd = &e1i_ts->driver.ipaccess.fd;
554 bfd->fd = ret;
555 bfd->data = line;
Holger Hans Peter Freytherdc6af632010-03-24 04:56:13 +0100556 bfd->priv_nr = PRIV_OML;
Harald Welteedb37782009-05-01 14:59:07 +0000557 bfd->cb = ipaccess_fd_cb;
558 bfd->when = BSC_FD_READ;
559 ret = bsc_register_fd(bfd);
560 if (ret < 0) {
Harald Welteafdca0f2009-12-23 23:01:04 +0100561 LOGP(DINP, LOGL_ERROR, "could not register FD\n");
Harald Welteedb37782009-05-01 14:59:07 +0000562 close(bfd->fd);
Harald Weltea4ffea92009-06-22 01:36:25 +0200563 talloc_free(line);
Harald Welteedb37782009-05-01 14:59:07 +0000564 return ret;
565 }
566
567 /* Request ID. FIXME: request LOCATION, HW/SW VErsion, Unit Name, Serno */
Holger Hans Peter Freyther3bc856b2010-02-07 12:04:07 +0100568 ret = ipaccess_send_id_req(bfd->fd);
Harald Welteedb37782009-05-01 14:59:07 +0000569
Holger Hans Peter Freyther09e364b2009-08-10 07:59:27 +0200570 return ret;
Harald Welte42581822009-08-08 16:12:58 +0200571 //return e1inp_line_register(line);
Harald Welte5fd8a542009-02-13 02:43:36 +0000572}
573
Harald Welte5c1e4582009-02-15 11:57:29 +0000574static int rsl_listen_fd_cb(struct bsc_fd *listen_bfd, unsigned int what)
575{
Harald Welteedb37782009-05-01 14:59:07 +0000576 struct sockaddr_in sa;
577 socklen_t sa_len = sizeof(sa);
Harald Weltea4ffea92009-06-22 01:36:25 +0200578 struct bsc_fd *bfd;
Harald Welte5c1e4582009-02-15 11:57:29 +0000579 int ret;
580
Harald Welteedb37782009-05-01 14:59:07 +0000581 if (!(what & BSC_FD_READ))
582 return 0;
Harald Welte5c1e4582009-02-15 11:57:29 +0000583
Holger Hans Peter Freyther5ea73132009-10-29 02:29:45 +0100584 bfd = talloc_zero(tall_bsc_ctx, struct bsc_fd);
Harald Weltea4ffea92009-06-22 01:36:25 +0200585 if (!bfd)
586 return -ENOMEM;
Harald Weltea4ffea92009-06-22 01:36:25 +0200587
Harald Welteedb37782009-05-01 14:59:07 +0000588 /* Some BTS has connected to us, but we don't know yet which line
589 * (as created by the OML link) to associate it with. Thus, we
Holger Hans Peter Freytherc7df7c62009-11-15 13:50:39 +0100590 * allocate a temporary bfd until we have received ID from BTS */
Harald Welteedb37782009-05-01 14:59:07 +0000591
592 bfd->fd = accept(listen_bfd->fd, (struct sockaddr *) &sa, &sa_len);
593 if (bfd->fd < 0) {
594 perror("accept");
595 return bfd->fd;
Harald Welte5c1e4582009-02-15 11:57:29 +0000596 }
Harald Welteafdca0f2009-12-23 23:01:04 +0100597 LOGP(DINP, LOGL_NOTICE, "accept()ed new RSL link from %s\n", inet_ntoa(sa.sin_addr));
Holger Hans Peter Freytherdc6af632010-03-24 04:56:13 +0100598 bfd->priv_nr = PRIV_RSL;
Harald Welteedb37782009-05-01 14:59:07 +0000599 bfd->cb = ipaccess_fd_cb;
600 bfd->when = BSC_FD_READ;
601 ret = bsc_register_fd(bfd);
602 if (ret < 0) {
Harald Welteafdca0f2009-12-23 23:01:04 +0100603 LOGP(DINP, LOGL_ERROR, "could not register FD\n");
Harald Welteedb37782009-05-01 14:59:07 +0000604 close(bfd->fd);
Harald Weltea4ffea92009-06-22 01:36:25 +0200605 talloc_free(bfd);
Harald Welteedb37782009-05-01 14:59:07 +0000606 return ret;
607 }
608 /* Request ID. FIXME: request LOCATION, HW/SW VErsion, Unit Name, Serno */
609 ret = write(bfd->fd, id_req, sizeof(id_req));
610
Harald Welte5c1e4582009-02-15 11:57:29 +0000611 return 0;
612}
613
614static int make_sock(struct bsc_fd *bfd, u_int16_t port,
Harald Welte5c1e4582009-02-15 11:57:29 +0000615 int (*cb)(struct bsc_fd *fd, unsigned int what))
Harald Welte5fd8a542009-02-13 02:43:36 +0000616{
617 struct sockaddr_in addr;
Harald Welte5c1e4582009-02-15 11:57:29 +0000618 int ret, on = 1;
619
620 bfd->fd = socket(AF_INET, SOCK_STREAM, IPPROTO_TCP);
621 bfd->cb = cb;
622 bfd->when = BSC_FD_READ;
Harald Welteedb37782009-05-01 14:59:07 +0000623 //bfd->data = line;
Harald Welte5c1e4582009-02-15 11:57:29 +0000624
Holger Hans Peter Freyther4d2d95b2010-02-19 13:07:05 +0100625 if (bfd->fd < 0) {
626 LOGP(DINP, LOGL_ERROR, "could not create TCP socket.\n");
627 return -EIO;
628 }
629
Harald Welte5c1e4582009-02-15 11:57:29 +0000630 memset(&addr, 0, sizeof(addr));
631 addr.sin_family = AF_INET;
632 addr.sin_port = htons(port);
633 addr.sin_addr.s_addr = INADDR_ANY;
634
635 setsockopt(bfd->fd, SOL_SOCKET, SO_REUSEADDR, &on, sizeof(on));
636
637 ret = bind(bfd->fd, (struct sockaddr *) &addr, sizeof(addr));
638 if (ret < 0) {
Harald Welteafdca0f2009-12-23 23:01:04 +0100639 LOGP(DINP, LOGL_ERROR, "could not bind l2 socket %s\n",
Harald Welte5c1e4582009-02-15 11:57:29 +0000640 strerror(errno));
Holger Hans Peter Freyther4d2d95b2010-02-19 13:07:05 +0100641 close(bfd->fd);
Harald Welte5c1e4582009-02-15 11:57:29 +0000642 return -EIO;
643 }
644
645 ret = listen(bfd->fd, 1);
646 if (ret < 0) {
647 perror("listen");
Holger Hans Peter Freyther4d2d95b2010-02-19 13:07:05 +0100648 close(bfd->fd);
Harald Welte5c1e4582009-02-15 11:57:29 +0000649 return ret;
650 }
651
652 ret = bsc_register_fd(bfd);
653 if (ret < 0) {
654 perror("register_listen_fd");
Holger Hans Peter Freyther4d2d95b2010-02-19 13:07:05 +0100655 close(bfd->fd);
Harald Welte5c1e4582009-02-15 11:57:29 +0000656 return ret;
657 }
658 return 0;
659}
660
Harald Welte25de9912009-04-30 15:53:07 +0000661/* Actively connect to a BTS. Currently used by ipaccess-config.c */
662int ipaccess_connect(struct e1inp_line *line, struct sockaddr_in *sa)
663{
664 struct e1inp_ts *e1i_ts = &line->ts[0];
665 struct bsc_fd *bfd = &e1i_ts->driver.ipaccess.fd;
666 int ret, on = 1;
667
668 bfd->fd = socket(AF_INET, SOCK_STREAM, IPPROTO_TCP);
669 bfd->cb = ipaccess_fd_cb;
670 bfd->when = BSC_FD_READ | BSC_FD_WRITE;
671 bfd->data = line;
Holger Hans Peter Freytherdc6af632010-03-24 04:56:13 +0100672 bfd->priv_nr = PRIV_OML;
Harald Welte25de9912009-04-30 15:53:07 +0000673
Holger Hans Peter Freyther4d2d95b2010-02-19 13:07:05 +0100674 if (bfd->fd < 0) {
675 LOGP(DINP, LOGL_ERROR, "could not create TCP socket.\n");
676 return -EIO;
677 }
678
Harald Welte25de9912009-04-30 15:53:07 +0000679 setsockopt(bfd->fd, SOL_SOCKET, SO_REUSEADDR, &on, sizeof(on));
680
681 ret = connect(bfd->fd, (struct sockaddr *) sa, sizeof(*sa));
682 if (ret < 0) {
Harald Welteafdca0f2009-12-23 23:01:04 +0100683 LOGP(DINP, LOGL_ERROR, "could not connect socket\n");
Harald Welte25de9912009-04-30 15:53:07 +0000684 close(bfd->fd);
685 return ret;
686 }
687
688 ret = bsc_register_fd(bfd);
689 if (ret < 0) {
690 close(bfd->fd);
691 return ret;
692 }
693
694 line->driver = &ipaccess_driver;
695
Holger Hans Peter Freyther09e364b2009-08-10 07:59:27 +0200696 return ret;
Harald Welte42581822009-08-08 16:12:58 +0200697 //return e1inp_line_register(line);
Harald Welte25de9912009-04-30 15:53:07 +0000698}
699
Harald Welteedb37782009-05-01 14:59:07 +0000700int ipaccess_setup(struct gsm_network *gsmnet)
Harald Welte5c1e4582009-02-15 11:57:29 +0000701{
Harald Welte5c1e4582009-02-15 11:57:29 +0000702 int ret;
Harald Welte5fd8a542009-02-13 02:43:36 +0000703
704 /* register the driver with the core */
705 /* FIXME: do this in the plugin initializer function */
706 ret = e1inp_driver_register(&ipaccess_driver);
707 if (ret)
708 return ret;
709
Holger Hans Peter Freyther5ea73132009-10-29 02:29:45 +0100710 e1h = talloc_zero(tall_bsc_ctx, struct ia_e1_handle);
Harald Weltea4ffea92009-06-22 01:36:25 +0200711 if (!e1h)
712 return -ENOMEM;
Harald Weltea4ffea92009-06-22 01:36:25 +0200713
Harald Welteedb37782009-05-01 14:59:07 +0000714 e1h->gsmnet = gsmnet;
Harald Welte5fd8a542009-02-13 02:43:36 +0000715
Harald Welte5c1e4582009-02-15 11:57:29 +0000716 /* Listen for OML connections */
Harald Welte87ed5cd2009-12-23 22:47:53 +0100717 ret = make_sock(&e1h->listen_fd, IPA_TCP_PORT_OML, listen_fd_cb);
Harald Weltecf559782009-05-01 15:43:49 +0000718 if (ret < 0)
719 return ret;
Harald Welte5fd8a542009-02-13 02:43:36 +0000720
Harald Welte5c1e4582009-02-15 11:57:29 +0000721 /* Listen for RSL connections */
Harald Welte87ed5cd2009-12-23 22:47:53 +0100722 ret = make_sock(&e1h->rsl_listen_fd, IPA_TCP_PORT_RSL, rsl_listen_fd_cb);
Harald Welte5fd8a542009-02-13 02:43:36 +0000723
Harald Welteedb37782009-05-01 14:59:07 +0000724 return ret;
Harald Welte5fd8a542009-02-13 02:43:36 +0000725}