blob: 5fdd8479e5bafea351d5f287c8c93b1fe275a7a8 [file] [log] [blame]
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +02001/* OpenBSC Abis input driver for mISDNuser */
2
Harald Weltece307b42011-08-21 01:18:05 +02003/* (C) 2008-2011 by Harald Welte <laforge@gnumonks.org>
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +02004 * (C) 2009 by Holger Hans Peter Freyther <zecke@selfish.org>
5 *
6 * All Rights Reserved
7 *
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU Affero General Public License as published by
10 * the Free Software Foundation; either version 3 of the License, or
11 * (at your option) any later version.
12 *
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU Affero General Public License for more details.
17 *
18 * You should have received a copy of the GNU Affero General Public License
19 * along with this program. If not, see <http://www.gnu.org/licenses/>.
20 *
21 */
22
Harald Weltece307b42011-08-21 01:18:05 +020023/*! \file misdn.c
24 * \brief Osmocom A-bis input driver for mISDN
25 *
26 * This driver has two modes of operations, exported via two different
27 * \ref e1_input_driver structures:
28 * "misdn" is the classic version and it uses the in-kernel LAPD
29 * implementation. This is somewhat limited in e.g. the fact that
30 * you can only have one E1 timeslot in signaling mode.
31 * "misdn_lapd" is a newer version which uses userspace LAPD code
32 * contained in libosmo-abis. It offers the same flexibilty as the
33 * DAHDI driver, i.e. any number of signaling slots.
34 */
35
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +020036#include "internal.h"
37
38#include <stdio.h>
39#include <unistd.h>
40#include <stdlib.h>
41#include <errno.h>
42#include <string.h>
43#include <time.h>
44#include <sys/fcntl.h>
45#include <sys/socket.h>
46#include <sys/ioctl.h>
47#include <arpa/inet.h>
48#include <mISDNif.h>
49
50//#define AF_COMPATIBILITY_FUNC
51//#include <compat_af_isdn.h>
52#ifndef AF_ISDN
53#define AF_ISDN 34
54#define PF_ISDN AF_ISDN
55#endif
56
57#include <osmocom/core/select.h>
Harald Welte6341aa02011-08-21 00:55:23 +020058#include <osmocom/core/utils.h>
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +020059#include <osmocom/core/msgb.h>
60#include <osmocom/core/logging.h>
Pablo Neira Ayuso177094b2011-06-07 12:21:51 +020061#include <osmocom/abis/e1_input.h>
Harald Weltece307b42011-08-21 01:18:05 +020062#include <osmocom/abis/lapd.h>
Harald Welte71d87b22011-07-18 14:49:56 +020063#include <osmocom/core/talloc.h>
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +020064
65#define TS1_ALLOC_SIZE 300
66
Harald Weltece307b42011-08-21 01:18:05 +020067/*! \brief driver-specific data for \ref e1inp_line::driver_data */
68struct misdn_line {
69 int use_userspace_lapd;
Andreas Eversberga7ff0012011-09-26 11:29:30 +020070 int dummy_dchannel;
Harald Weltece307b42011-08-21 01:18:05 +020071};
72
Harald Welte6341aa02011-08-21 00:55:23 +020073const struct value_string prim_names[] = {
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +020074 { PH_CONTROL_IND, "PH_CONTROL_IND" },
75 { PH_DATA_IND, "PH_DATA_IND" },
76 { PH_DATA_CNF, "PH_DATA_CNF" },
77 { PH_ACTIVATE_IND, "PH_ACTIVATE_IND" },
78 { DL_ESTABLISH_IND, "DL_ESTABLISH_IND" },
79 { DL_ESTABLISH_CNF, "DL_ESTABLISH_CNF" },
80 { DL_RELEASE_IND, "DL_RELEASE_IND" },
81 { DL_RELEASE_CNF, "DL_RELEASE_CNF" },
82 { DL_DATA_IND, "DL_DATA_IND" },
83 { DL_UNITDATA_IND, "DL_UNITDATA_IND" },
84 { DL_INFORMATION_IND, "DL_INFORMATION_IND" },
85 { MPH_ACTIVATE_IND, "MPH_ACTIVATE_IND" },
86 { MPH_DEACTIVATE_IND, "MPH_DEACTIVATE_IND" },
Harald Welte6341aa02011-08-21 00:55:23 +020087 { 0, NULL }
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +020088};
89
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +020090static int handle_ts1_read(struct osmo_fd *bfd)
91{
92 struct e1inp_line *line = bfd->data;
Harald Weltece307b42011-08-21 01:18:05 +020093 struct misdn_line *mline = line->driver_data;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +020094 unsigned int ts_nr = bfd->priv_nr;
95 struct e1inp_ts *e1i_ts = &line->ts[ts_nr-1];
96 struct e1inp_sign_link *link;
97 struct msgb *msg = msgb_alloc(TS1_ALLOC_SIZE, "mISDN TS1");
98 struct sockaddr_mISDN l2addr;
99 struct mISDNhead *hh;
100 socklen_t alen;
101 int ret;
102
103 if (!msg)
104 return -ENOMEM;
105
106 hh = (struct mISDNhead *) msg->data;
107
108 alen = sizeof(l2addr);
109 ret = recvfrom(bfd->fd, msg->data, 300, 0,
110 (struct sockaddr *) &l2addr, &alen);
111 if (ret < 0) {
112 fprintf(stderr, "recvfrom error %s\n", strerror(errno));
Andreas Eversberga7ff0012011-09-26 11:29:30 +0200113 msgb_free(msg);
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200114 return ret;
115 }
116
117 if (alen != sizeof(l2addr)) {
Pablo Neira Ayusoc9c4fd32011-06-30 12:19:42 +0200118 fprintf(stderr, "%s error len\n", __func__);
Andreas Eversberga7ff0012011-09-26 11:29:30 +0200119 msgb_free(msg);
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200120 return -EINVAL;
121 }
122
123 msgb_put(msg, ret);
124
Harald Weltecc2241b2011-07-19 16:06:06 +0200125 DEBUGP(DLMI, "alen =%d, dev(%d) channel(%d) sapi(%d) tei(%d)\n",
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200126 alen, l2addr.dev, l2addr.channel, l2addr.sapi, l2addr.tei);
127
Harald Weltecc2241b2011-07-19 16:06:06 +0200128 DEBUGP(DLMI, "<= len = %d, prim(0x%x) id(0x%x): %s\n",
Harald Welte6341aa02011-08-21 00:55:23 +0200129 ret, hh->prim, hh->id, get_value_string(prim_names, hh->prim));
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200130
131 switch (hh->prim) {
132 case DL_INFORMATION_IND:
133 /* mISDN tells us which channel number is allocated for this
134 * tuple of (SAPI, TEI). */
Harald Weltecc2241b2011-07-19 16:06:06 +0200135 DEBUGP(DLMI, "DL_INFORMATION_IND: use channel(%d) sapi(%d) tei(%d) for now\n",
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200136 l2addr.channel, l2addr.sapi, l2addr.tei);
137 link = e1inp_lookup_sign_link(e1i_ts, l2addr.tei, l2addr.sapi);
138 if (!link) {
Harald Weltecc2241b2011-07-19 16:06:06 +0200139 DEBUGPC(DLMI, "mISDN message for unknown sign_link\n");
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200140 msgb_free(msg);
141 return -EINVAL;
142 }
143 /* save the channel number in the driver private struct */
144 link->driver.misdn.channel = l2addr.channel;
Andreas Eversberga7ff0012011-09-26 11:29:30 +0200145 msgb_free(msg);
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200146 break;
147 case DL_ESTABLISH_IND:
Harald Weltecc2241b2011-07-19 16:06:06 +0200148 DEBUGP(DLMI, "DL_ESTABLISH_IND: channel(%d) sapi(%d) tei(%d)\n",
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200149 l2addr.channel, l2addr.sapi, l2addr.tei);
150 /* For some strange reason, sometimes the DL_INFORMATION_IND tells
151 * us the wrong channel, and we only get the real channel number
152 * during the DL_ESTABLISH_IND */
153 link = e1inp_lookup_sign_link(e1i_ts, l2addr.tei, l2addr.sapi);
154 if (!link) {
Harald Weltecc2241b2011-07-19 16:06:06 +0200155 DEBUGPC(DLMI, "mISDN message for unknown sign_link\n");
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200156 msgb_free(msg);
157 return -EINVAL;
158 }
159 /* save the channel number in the driver private struct */
160 link->driver.misdn.channel = l2addr.channel;
Pablo Neira Ayusode668912011-08-16 17:26:23 +0200161 ret = e1inp_event(e1i_ts, S_L_INP_TEI_UP, l2addr.tei, l2addr.sapi);
Andreas Eversberga7ff0012011-09-26 11:29:30 +0200162 msgb_free(msg);
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200163 break;
164 case DL_RELEASE_IND:
Harald Weltecc2241b2011-07-19 16:06:06 +0200165 DEBUGP(DLMI, "DL_RELEASE_IND: channel(%d) sapi(%d) tei(%d)\n",
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200166 l2addr.channel, l2addr.sapi, l2addr.tei);
Pablo Neira Ayusode668912011-08-16 17:26:23 +0200167 ret = e1inp_event(e1i_ts, S_L_INP_TEI_DN, l2addr.tei, l2addr.sapi);
Andreas Eversberga7ff0012011-09-26 11:29:30 +0200168 msgb_free(msg);
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200169 break;
170 case DL_DATA_IND:
171 case DL_UNITDATA_IND:
172 msg->l2h = msg->data + MISDN_HEADER_LEN;
Harald Weltecc2241b2011-07-19 16:06:06 +0200173 DEBUGP(DLMI, "RX: %s\n", osmo_hexdump(msgb_l2(msg), ret - MISDN_HEADER_LEN));
Harald Weltece307b42011-08-21 01:18:05 +0200174 if (mline->use_userspace_lapd) {
175 LOGP(DLMI, LOGL_ERROR, "DL_DATA_IND but userspace LAPD ?!?\n");
Andreas Eversberga7ff0012011-09-26 11:29:30 +0200176 msgb_free(msg);
Harald Weltece307b42011-08-21 01:18:05 +0200177 return -EIO;
178 }
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200179 ret = e1inp_rx_ts(e1i_ts, msg, l2addr.tei, l2addr.sapi);
180 break;
181 case PH_ACTIVATE_IND:
Harald Weltecc2241b2011-07-19 16:06:06 +0200182 DEBUGP(DLMI, "PH_ACTIVATE_IND: channel(%d) sapi(%d) tei(%d)\n",
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200183 l2addr.channel, l2addr.sapi, l2addr.tei);
Andreas Eversberga7ff0012011-09-26 11:29:30 +0200184 msgb_free(msg);
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200185 break;
186 case PH_DEACTIVATE_IND:
Harald Weltecc2241b2011-07-19 16:06:06 +0200187 DEBUGP(DLMI, "PH_DEACTIVATE_IND: channel(%d) sapi(%d) tei(%d)\n",
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200188 l2addr.channel, l2addr.sapi, l2addr.tei);
Andreas Eversberga7ff0012011-09-26 11:29:30 +0200189 msgb_free(msg);
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200190 break;
Harald Weltece307b42011-08-21 01:18:05 +0200191 case PH_DATA_IND:
192 if (!mline->use_userspace_lapd) {
193 LOGP(DLMI, LOGL_ERROR, "PH_DATA_IND but kernel LAPD ?!?\n");
194 return -EIO;
195 }
196 /* remove the Misdn Header */
197 msgb_pull(msg, MISDN_HEADER_LEN);
198 /* hand into the LAPD code */
199 DEBUGP(DLMI, "RX: %s\n", osmo_hexdump(msg->data, msg->len));
200 ret = e1inp_rx_ts_lapd(e1i_ts, msg);
201 break;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200202 default:
Andreas Eversberga7ff0012011-09-26 11:29:30 +0200203 msgb_free(msg);
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200204 break;
205 }
206 return ret;
207}
208
209static int ts_want_write(struct e1inp_ts *e1i_ts)
210{
211 /* We never include the mISDN B-Channel FD into the
212 * writeset, since it doesn't support poll() based
213 * write flow control */
214 if (e1i_ts->type == E1INP_TS_TYPE_TRAU)
215 return 0;
216
217 e1i_ts->driver.misdn.fd.when |= BSC_FD_WRITE;
218
219 return 0;
220}
221
222static void timeout_ts1_write(void *data)
223{
224 struct e1inp_ts *e1i_ts = (struct e1inp_ts *)data;
225
226 /* trigger write of ts1, due to tx delay timer */
227 ts_want_write(e1i_ts);
228}
229
230static int handle_ts1_write(struct osmo_fd *bfd)
231{
232 struct e1inp_line *line = bfd->data;
Harald Weltece307b42011-08-21 01:18:05 +0200233 struct misdn_line *mline = line->driver_data;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200234 unsigned int ts_nr = bfd->priv_nr;
235 struct e1inp_ts *e1i_ts = &line->ts[ts_nr-1];
236 struct e1inp_sign_link *sign_link;
237 struct sockaddr_mISDN sa;
238 struct msgb *msg;
239 struct mISDNhead *hh;
240 uint8_t *l2_data;
241 int ret;
242
243 bfd->when &= ~BSC_FD_WRITE;
244
245 /* get the next msg for this timeslot */
246 msg = e1inp_tx_ts(e1i_ts, &sign_link);
247 if (!msg) {
248 /* no message after tx delay timer */
249 return 0;
250 }
251
Harald Weltece307b42011-08-21 01:18:05 +0200252 if (mline->use_userspace_lapd) {
253 DEBUGP(DLMI, "TX %u/%u/%u: %s\n",
254 line->num, sign_link->tei, sign_link->sapi,
255 osmo_hexdump(msg->data, msg->len));
256 lapd_transmit(e1i_ts->lapd, sign_link->tei,
Andreas Eversberga7ff0012011-09-26 11:29:30 +0200257 sign_link->sapi, msg);
Harald Weltece307b42011-08-21 01:18:05 +0200258 } else {
259 l2_data = msg->data;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200260
Harald Weltece307b42011-08-21 01:18:05 +0200261 /* prepend the mISDNhead */
262 hh = (struct mISDNhead *) msgb_push(msg, sizeof(*hh));
263 hh->prim = DL_DATA_REQ;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200264
Harald Weltece307b42011-08-21 01:18:05 +0200265 DEBUGP(DLMI, "TX channel(%d) TEI(%d) SAPI(%d): %s\n",
266 sign_link->driver.misdn.channel, sign_link->tei,
267 sign_link->sapi, osmo_hexdump(l2_data, msg->len - MISDN_HEADER_LEN));
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200268
Harald Weltece307b42011-08-21 01:18:05 +0200269 /* construct the sockaddr */
270 sa.family = AF_ISDN;
271 sa.sapi = sign_link->sapi;
272 sa.dev = sign_link->tei;
273 sa.channel = sign_link->driver.misdn.channel;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200274
Harald Weltece307b42011-08-21 01:18:05 +0200275 ret = sendto(bfd->fd, msg->data, msg->len, 0,
276 (struct sockaddr *)&sa, sizeof(sa));
277 if (ret < 0)
278 fprintf(stderr, "%s sendto failed %d\n", __func__, ret);
Andreas Eversberga7ff0012011-09-26 11:29:30 +0200279
280 msgb_free(msg);
Harald Weltece307b42011-08-21 01:18:05 +0200281 }
282
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200283
284 /* set tx delay timer for next event */
285 e1i_ts->sign.tx_timer.cb = timeout_ts1_write;
286 e1i_ts->sign.tx_timer.data = e1i_ts;
287 osmo_timer_schedule(&e1i_ts->sign.tx_timer, 0, e1i_ts->sign.delay);
288
289 return ret;
290}
291
Harald Weltece307b42011-08-21 01:18:05 +0200292/*! \brief call-back from LAPD code, called when it wants to Tx data */
Andreas Eversberga7ff0012011-09-26 11:29:30 +0200293static void misdn_write_msg(struct msgb *msg, void *cbdata)
Harald Weltece307b42011-08-21 01:18:05 +0200294{
295 struct osmo_fd *bfd = cbdata;
Andreas Eversberga7ff0012011-09-26 11:29:30 +0200296// struct e1inp_line *line = bfd->data;
297// unsigned int ts_nr = bfd->priv_nr;
298// struct e1inp_ts *e1i_ts = &line->ts[ts_nr-1];
Harald Weltece307b42011-08-21 01:18:05 +0200299 struct mISDNhead *hh;
300 int ret;
301
Andreas Eversberga7ff0012011-09-26 11:29:30 +0200302 DEBUGP(DLMI, "PH_DATA_REQ: len=%d %s\n", msg->len,
303 osmo_hexdump(msg->data, msg->len));
Harald Weltece307b42011-08-21 01:18:05 +0200304
Andreas Eversberga7ff0012011-09-26 11:29:30 +0200305 hh = (struct mISDNhead *) msgb_push(msg, MISDN_HEADER_LEN);
306 hh->prim = PH_DATA_REQ;
307 hh->id = 0;
Harald Weltece307b42011-08-21 01:18:05 +0200308
309 ret = write(bfd->fd, msg->data, msg->len);
310 if (ret < 0)
311 LOGP(DLMI, LOGL_NOTICE, "write failed %d\n", ret);
312
313 msgb_free(msg);
314}
315
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200316/* write to a B channel TS */
Andreas Eversbergd73c8462011-12-20 18:56:42 +0100317static int handle_tsX_write(struct osmo_fd *bfd, int len)
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200318{
319 struct e1inp_line *line = bfd->data;
320 unsigned int ts_nr = bfd->priv_nr;
321 struct e1inp_ts *e1i_ts = &line->ts[ts_nr-1];
322 struct mISDNhead *hh;
Andreas Eversbergd73c8462011-12-20 18:56:42 +0100323 uint8_t tx_buf[len + sizeof(*hh)];
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200324 struct subch_mux *mx = &e1i_ts->trau.mux;
325 int ret;
326
327 hh = (struct mISDNhead *) tx_buf;
328 hh->prim = PH_DATA_REQ;
Andreas Eversberga7ff0012011-09-26 11:29:30 +0200329 hh->id = 0;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200330
Andreas Eversbergd73c8462011-12-20 18:56:42 +0100331 subchan_mux_out(mx, tx_buf+sizeof(*hh), len);
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200332
Harald Weltecc2241b2011-07-19 16:06:06 +0200333 DEBUGP(DLMIB, "BCHAN TX: %s\n",
Andreas Eversbergd73c8462011-12-20 18:56:42 +0100334 osmo_hexdump(tx_buf+sizeof(*hh), len));
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200335
Andreas Eversbergd73c8462011-12-20 18:56:42 +0100336 ret = send(bfd->fd, tx_buf, sizeof(*hh) + len, 0);
337 if (ret < sizeof(*hh) + len)
Harald Weltecc2241b2011-07-19 16:06:06 +0200338 DEBUGP(DLMIB, "send returns %d instead of %zu\n", ret,
Andreas Eversbergd73c8462011-12-20 18:56:42 +0100339 sizeof(*hh) + len);
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200340
341 return ret;
342}
343
344#define TSX_ALLOC_SIZE 4096
345/* FIXME: read from a B channel TS */
346static int handle_tsX_read(struct osmo_fd *bfd)
347{
348 struct e1inp_line *line = bfd->data;
349 unsigned int ts_nr = bfd->priv_nr;
350 struct e1inp_ts *e1i_ts = &line->ts[ts_nr-1];
351 struct msgb *msg = msgb_alloc(TSX_ALLOC_SIZE, "mISDN TSx");
352 struct mISDNhead *hh;
353 int ret;
354
355 if (!msg)
356 return -ENOMEM;
357
358 hh = (struct mISDNhead *) msg->data;
359
360 ret = recv(bfd->fd, msg->data, TSX_ALLOC_SIZE, 0);
361 if (ret < 0) {
362 fprintf(stderr, "recvfrom error %s\n", strerror(errno));
363 return ret;
364 }
365
366 msgb_put(msg, ret);
367
368 if (hh->prim != PH_CONTROL_IND)
Harald Weltecc2241b2011-07-19 16:06:06 +0200369 DEBUGP(DLMIB, "<= BCHAN len = %d, prim(0x%x) id(0x%x): %s\n",
Harald Welte6341aa02011-08-21 00:55:23 +0200370 ret, hh->prim, hh->id,
371 get_value_string(prim_names, hh->prim));
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200372
373 switch (hh->prim) {
374 case PH_DATA_IND:
375 msg->l2h = msg->data + MISDN_HEADER_LEN;
Harald Weltecc2241b2011-07-19 16:06:06 +0200376 DEBUGP(DLMIB, "BCHAN RX: %s\n",
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200377 osmo_hexdump(msgb_l2(msg), ret - MISDN_HEADER_LEN));
Andreas Eversbergd73c8462011-12-20 18:56:42 +0100378 /* the number of bytes received indicates that data to send */
379 handle_tsX_write(bfd, msgb_l2len(msg));
Andreas Eversberga7ff0012011-09-26 11:29:30 +0200380 return e1inp_rx_ts(e1i_ts, msg, 0, 0);
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200381 case PH_ACTIVATE_IND:
382 case PH_DATA_CNF:
Andreas Eversbergd73c8462011-12-20 18:56:42 +0100383 break;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200384 default:
385 break;
386 }
387 /* FIXME: why do we free signalling msgs in the caller, and trau not? */
388 msgb_free(msg);
389
390 return ret;
391}
392
393/* callback from select.c in case one of the fd's can be read/written */
394static int misdn_fd_cb(struct osmo_fd *bfd, unsigned int what)
395{
396 struct e1inp_line *line = bfd->data;
397 unsigned int ts_nr = bfd->priv_nr;
398 unsigned int idx = ts_nr-1;
399 struct e1inp_ts *e1i_ts = &line->ts[idx];
400 int rc = 0;
401
402 switch (e1i_ts->type) {
403 case E1INP_TS_TYPE_SIGN:
404 if (what & BSC_FD_READ)
405 rc = handle_ts1_read(bfd);
406 if (what & BSC_FD_WRITE)
407 rc = handle_ts1_write(bfd);
408 break;
409 case E1INP_TS_TYPE_TRAU:
410 if (what & BSC_FD_READ)
411 rc = handle_tsX_read(bfd);
412 /* We never include the mISDN B-Channel FD into the
413 * writeset, since it doesn't support poll() based
414 * write flow control */
415 break;
416 default:
417 fprintf(stderr, "unknown E1 TS type %u\n", e1i_ts->type);
418 break;
419 }
420
421 return rc;
422}
423
424static int activate_bchan(struct e1inp_line *line, int ts, int act)
425{
426 struct mISDNhead hh;
427 int ret;
428 unsigned int idx = ts-1;
429 struct e1inp_ts *e1i_ts = &line->ts[idx];
430 struct osmo_fd *bfd = &e1i_ts->driver.misdn.fd;
431
432 fprintf(stdout, "activate bchan\n");
433 if (act)
434 hh.prim = PH_ACTIVATE_REQ;
435 else
436 hh.prim = PH_DEACTIVATE_REQ;
437
438 hh.id = MISDN_ID_ANY;
439 ret = sendto(bfd->fd, &hh, sizeof(hh), 0, NULL, 0);
440 if (ret < 0) {
441 fprintf(stdout, "could not send ACTIVATE_RQ %s\n",
442 strerror(errno));
443 }
444
445 return ret;
446}
447
Pablo Neira Ayuso4e862cb2011-08-19 18:43:38 +0200448static int mi_e1_line_update(struct e1inp_line *line);
Harald Weltece307b42011-08-21 01:18:05 +0200449static int mi_e1_line_update_lapd(struct e1inp_line *line);
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200450
451struct e1inp_driver misdn_driver = {
452 .name = "misdn",
453 .want_write = ts_want_write,
454 .default_delay = 50000,
455 .line_update = &mi_e1_line_update,
456};
457
Harald Weltece307b42011-08-21 01:18:05 +0200458struct e1inp_driver misdn_lapd_driver = {
459 .name = "misdn_lapd",
460 .want_write = ts_want_write,
461 .default_delay = 50000,
462 .line_update = &mi_e1_line_update_lapd,
463};
464
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200465static int mi_e1_setup(struct e1inp_line *line, int release_l2)
466{
Harald Weltece307b42011-08-21 01:18:05 +0200467 struct misdn_line *mline = line->driver_data;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200468 int ts, ret;
469
Andreas Eversberga7ff0012011-09-26 11:29:30 +0200470 mline->dummy_dchannel = -1;
471 if (mline->use_userspace_lapd) {
472 /* Open dummy d-channel in order to use b-channels.
473 * Also it is required to define the mode.
474 */
475 if (mline->dummy_dchannel < 0) {
476 struct sockaddr_mISDN addr;
477
478 mline->dummy_dchannel = socket(PF_ISDN, SOCK_DGRAM,
479 ISDN_P_NT_E1);
480 if (mline->dummy_dchannel < 0) {
481 fprintf(stderr, "%s could not open socket %s\n",
482 __func__, strerror(errno));
483 return mline->dummy_dchannel;
484 }
485 memset(&addr, 0, sizeof(addr));
486 addr.family = AF_ISDN;
Andreas Eversberg43086672012-01-18 19:06:12 +0100487 addr.dev = line->port_nr;
Andreas Eversberga7ff0012011-09-26 11:29:30 +0200488 addr.channel = 0;
489 addr.sapi = 0;
490 addr.tei = GROUP_TEI;
491 ret = bind(mline->dummy_dchannel,
492 (struct sockaddr *) &addr, sizeof(addr));
493 if (ret < 0) {
494 fprintf(stderr, "could not bind l2 socket %s\n",
495 strerror(errno));
496 return -EIO;
497 }
498 }
499 }
500
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200501 /* TS0 is CRC4, don't need any fd for it */
502 for (ts = 1; ts < NUM_E1_TS; ts++) {
503 unsigned int idx = ts-1;
504 struct e1inp_ts *e1i_ts = &line->ts[idx];
505 struct osmo_fd *bfd = &e1i_ts->driver.misdn.fd;
506 struct sockaddr_mISDN addr;
507
508 bfd->data = line;
509 bfd->priv_nr = ts;
510 bfd->cb = misdn_fd_cb;
511
512 switch (e1i_ts->type) {
513 case E1INP_TS_TYPE_NONE:
514 continue;
515 break;
516 case E1INP_TS_TYPE_SIGN:
Harald Weltece307b42011-08-21 01:18:05 +0200517 if (mline->use_userspace_lapd)
Andreas Eversberga7ff0012011-09-26 11:29:30 +0200518 bfd->fd = socket(PF_ISDN, SOCK_DGRAM,
519 ISDN_P_B_HDLC);
Harald Weltece307b42011-08-21 01:18:05 +0200520 else
Andreas Eversberga7ff0012011-09-26 11:29:30 +0200521 bfd->fd = socket(PF_ISDN, SOCK_DGRAM,
522 ISDN_P_LAPD_NT);
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200523 bfd->when = BSC_FD_READ;
524 break;
525 case E1INP_TS_TYPE_TRAU:
526 bfd->fd = socket(PF_ISDN, SOCK_DGRAM, ISDN_P_B_RAW);
527 /* We never include the mISDN B-Channel FD into the
528 * writeset, since it doesn't support poll() based
529 * write flow control */
530 bfd->when = BSC_FD_READ;
531 break;
532 }
533
534 if (bfd->fd < 0) {
535 fprintf(stderr, "%s could not open socket %s\n",
536 __func__, strerror(errno));
537 return bfd->fd;
538 }
539
540 memset(&addr, 0, sizeof(addr));
541 addr.family = AF_ISDN;
Harald Weltec2889512011-09-13 23:49:04 +0100542 addr.dev = line->port_nr;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200543 switch (e1i_ts->type) {
544 case E1INP_TS_TYPE_SIGN:
Harald Weltece307b42011-08-21 01:18:05 +0200545 if (mline->use_userspace_lapd) {
546 addr.channel = ts;
Andreas Eversberga7ff0012011-09-26 11:29:30 +0200547 e1i_ts->lapd = lapd_instance_alloc(1,
548 misdn_write_msg, bfd, e1inp_dlsap_up,
Andreas Eversberg3744b872011-09-27 12:12:36 +0200549 e1i_ts, &lapd_profile_abis);
Harald Weltece307b42011-08-21 01:18:05 +0200550 } else {
551 addr.channel = 0;
552 /* SAPI not supported yet in kernel */
553 //addr.sapi = e1inp_ts->sign.sapi;
554 addr.sapi = 0;
555 addr.tei = GROUP_TEI;
556 }
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200557 break;
558 case E1INP_TS_TYPE_TRAU:
559 addr.channel = ts;
560 break;
561 default:
Harald Weltecc2241b2011-07-19 16:06:06 +0200562 DEBUGP(DLMI, "unsupported E1 TS type: %u\n",
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200563 e1i_ts->type);
564 break;
565 }
566
567 ret = bind(bfd->fd, (struct sockaddr *) &addr, sizeof(addr));
568 if (ret < 0) {
569 fprintf(stderr, "could not bind l2 socket %s\n",
570 strerror(errno));
571 return -EIO;
572 }
573
574 if (e1i_ts->type == E1INP_TS_TYPE_SIGN) {
Harald Weltece307b42011-08-21 01:18:05 +0200575 if (!mline->use_userspace_lapd) {
576 ret = ioctl(bfd->fd, IMCLEAR_L2, &release_l2);
577 if (ret < 0) {
578 fprintf(stderr, "could not send IOCTL IMCLEAN_L2 %s\n", strerror(errno));
579 return -EIO;
580 }
581 } else
582 activate_bchan(line, ts, 1);
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200583 }
584
585 /* FIXME: only activate B-Channels once we start to
586 * use them to conserve CPU power */
587 if (e1i_ts->type == E1INP_TS_TYPE_TRAU)
588 activate_bchan(line, ts, 1);
589
590 ret = osmo_fd_register(bfd);
591 if (ret < 0) {
592 fprintf(stderr, "could not register FD: %s\n",
593 strerror(ret));
594 return ret;
595 }
596 }
597
598 return 0;
599}
600
Harald Weltece307b42011-08-21 01:18:05 +0200601static int _mi_e1_line_update(struct e1inp_line *line)
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200602{
603 struct mISDN_devinfo devinfo;
604 int sk, ret, cnt;
605
Harald Weltece307b42011-08-21 01:18:05 +0200606 if (line->driver != &misdn_driver &&
607 line->driver != &misdn_lapd_driver)
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200608 return -EINVAL;
609
610 /* open the ISDN card device */
611 sk = socket(PF_ISDN, SOCK_RAW, ISDN_P_BASE);
612 if (sk < 0) {
613 fprintf(stderr, "%s could not open socket %s\n",
614 __func__, strerror(errno));
615 return sk;
616 }
617
618 ret = ioctl(sk, IMGETCOUNT, &cnt);
619 if (ret) {
620 fprintf(stderr, "%s error getting interf count: %s\n",
621 __func__, strerror(errno));
622 close(sk);
623 return -ENODEV;
624 }
Harald Weltecc2241b2011-07-19 16:06:06 +0200625 //DEBUGP(DLMI,"%d device%s found\n", cnt, (cnt==1)?"":"s");
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200626 printf("%d device%s found\n", cnt, (cnt==1)?"":"s");
627#if 1
Harald Weltec2889512011-09-13 23:49:04 +0100628 devinfo.id = line->port_nr;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200629 ret = ioctl(sk, IMGETDEVINFO, &devinfo);
630 if (ret < 0) {
631 fprintf(stdout, "error getting info for device %d: %s\n",
Harald Weltec2889512011-09-13 23:49:04 +0100632 line->port_nr, strerror(errno));
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200633 return -ENODEV;
634 }
635 fprintf(stdout, " id: %d\n", devinfo.id);
636 fprintf(stdout, " Dprotocols: %08x\n", devinfo.Dprotocols);
637 fprintf(stdout, " Bprotocols: %08x\n", devinfo.Bprotocols);
638 fprintf(stdout, " protocol: %d\n", devinfo.protocol);
639 fprintf(stdout, " nrbchan: %d\n", devinfo.nrbchan);
640 fprintf(stdout, " name: %s\n", devinfo.name);
641#endif
642
643 if (!(devinfo.Dprotocols & (1 << ISDN_P_NT_E1))) {
644 fprintf(stderr, "error: card is not of type E1 (NT-mode)\n");
645 return -EINVAL;
646 }
647
648 ret = mi_e1_setup(line, 1);
649 if (ret)
650 return ret;
651
652 return 0;
653}
654
Harald Weltece307b42011-08-21 01:18:05 +0200655static int mi_e1_line_update(struct e1inp_line *line)
656{
657 struct misdn_line *ml;
658
659 if (!line->driver_data)
660 line->driver_data = talloc_zero(line, struct misdn_line);
661
662 ml = line->driver_data;
663 ml->use_userspace_lapd = 0;
664
665 return _mi_e1_line_update(line);
666}
667
668static int mi_e1_line_update_lapd(struct e1inp_line *line)
669{
670 struct misdn_line *ml;
671
672 if (!line->driver_data)
673 line->driver_data = talloc_zero(line, struct misdn_line);
674
675 ml = line->driver_data;
676 ml->use_userspace_lapd = 1;
677
678 return _mi_e1_line_update(line);
679}
680
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200681void e1inp_misdn_init(void)
682{
683 /* register the driver with the core */
684 e1inp_driver_register(&misdn_driver);
Harald Weltece307b42011-08-21 01:18:05 +0200685 e1inp_driver_register(&misdn_lapd_driver);
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200686}