blob: 596681793114cf5746b099393e09fc5535e1ef31 [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);
Holger Hans Peter Freyther5731dd72013-03-09 17:35:17 +0100258 ret = 0;
Harald Weltece307b42011-08-21 01:18:05 +0200259 } else {
260 l2_data = msg->data;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200261
Harald Weltece307b42011-08-21 01:18:05 +0200262 /* prepend the mISDNhead */
263 hh = (struct mISDNhead *) msgb_push(msg, sizeof(*hh));
264 hh->prim = DL_DATA_REQ;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200265
Harald Weltece307b42011-08-21 01:18:05 +0200266 DEBUGP(DLMI, "TX channel(%d) TEI(%d) SAPI(%d): %s\n",
267 sign_link->driver.misdn.channel, sign_link->tei,
268 sign_link->sapi, osmo_hexdump(l2_data, msg->len - MISDN_HEADER_LEN));
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200269
Harald Weltece307b42011-08-21 01:18:05 +0200270 /* construct the sockaddr */
271 sa.family = AF_ISDN;
272 sa.sapi = sign_link->sapi;
273 sa.dev = sign_link->tei;
274 sa.channel = sign_link->driver.misdn.channel;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200275
Harald Weltece307b42011-08-21 01:18:05 +0200276 ret = sendto(bfd->fd, msg->data, msg->len, 0,
277 (struct sockaddr *)&sa, sizeof(sa));
278 if (ret < 0)
279 fprintf(stderr, "%s sendto failed %d\n", __func__, ret);
Andreas Eversberga7ff0012011-09-26 11:29:30 +0200280
281 msgb_free(msg);
Harald Weltece307b42011-08-21 01:18:05 +0200282 }
283
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200284
285 /* set tx delay timer for next event */
286 e1i_ts->sign.tx_timer.cb = timeout_ts1_write;
287 e1i_ts->sign.tx_timer.data = e1i_ts;
288 osmo_timer_schedule(&e1i_ts->sign.tx_timer, 0, e1i_ts->sign.delay);
289
290 return ret;
291}
292
Harald Weltece307b42011-08-21 01:18:05 +0200293/*! \brief call-back from LAPD code, called when it wants to Tx data */
Andreas Eversberga7ff0012011-09-26 11:29:30 +0200294static void misdn_write_msg(struct msgb *msg, void *cbdata)
Harald Weltece307b42011-08-21 01:18:05 +0200295{
296 struct osmo_fd *bfd = cbdata;
Andreas Eversberga7ff0012011-09-26 11:29:30 +0200297// struct e1inp_line *line = bfd->data;
298// unsigned int ts_nr = bfd->priv_nr;
299// struct e1inp_ts *e1i_ts = &line->ts[ts_nr-1];
Harald Weltece307b42011-08-21 01:18:05 +0200300 struct mISDNhead *hh;
301 int ret;
302
Andreas Eversberga7ff0012011-09-26 11:29:30 +0200303 DEBUGP(DLMI, "PH_DATA_REQ: len=%d %s\n", msg->len,
304 osmo_hexdump(msg->data, msg->len));
Harald Weltece307b42011-08-21 01:18:05 +0200305
Andreas Eversberga7ff0012011-09-26 11:29:30 +0200306 hh = (struct mISDNhead *) msgb_push(msg, MISDN_HEADER_LEN);
307 hh->prim = PH_DATA_REQ;
308 hh->id = 0;
Harald Weltece307b42011-08-21 01:18:05 +0200309
310 ret = write(bfd->fd, msg->data, msg->len);
311 if (ret < 0)
312 LOGP(DLMI, LOGL_NOTICE, "write failed %d\n", ret);
313
314 msgb_free(msg);
315}
316
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200317/* write to a B channel TS */
Andreas Eversbergd73c8462011-12-20 18:56:42 +0100318static int handle_tsX_write(struct osmo_fd *bfd, int len)
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200319{
320 struct e1inp_line *line = bfd->data;
321 unsigned int ts_nr = bfd->priv_nr;
322 struct e1inp_ts *e1i_ts = &line->ts[ts_nr-1];
323 struct mISDNhead *hh;
Andreas Eversbergd73c8462011-12-20 18:56:42 +0100324 uint8_t tx_buf[len + sizeof(*hh)];
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200325 struct subch_mux *mx = &e1i_ts->trau.mux;
326 int ret;
327
328 hh = (struct mISDNhead *) tx_buf;
329 hh->prim = PH_DATA_REQ;
Andreas Eversberga7ff0012011-09-26 11:29:30 +0200330 hh->id = 0;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200331
Andreas Eversbergd73c8462011-12-20 18:56:42 +0100332 subchan_mux_out(mx, tx_buf+sizeof(*hh), len);
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200333
Harald Weltecc2241b2011-07-19 16:06:06 +0200334 DEBUGP(DLMIB, "BCHAN TX: %s\n",
Andreas Eversbergd73c8462011-12-20 18:56:42 +0100335 osmo_hexdump(tx_buf+sizeof(*hh), len));
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200336
Andreas Eversbergd73c8462011-12-20 18:56:42 +0100337 ret = send(bfd->fd, tx_buf, sizeof(*hh) + len, 0);
338 if (ret < sizeof(*hh) + len)
Harald Weltecc2241b2011-07-19 16:06:06 +0200339 DEBUGP(DLMIB, "send returns %d instead of %zu\n", ret,
Andreas Eversbergd73c8462011-12-20 18:56:42 +0100340 sizeof(*hh) + len);
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200341
342 return ret;
343}
344
345#define TSX_ALLOC_SIZE 4096
346/* FIXME: read from a B channel TS */
347static int handle_tsX_read(struct osmo_fd *bfd)
348{
349 struct e1inp_line *line = bfd->data;
350 unsigned int ts_nr = bfd->priv_nr;
351 struct e1inp_ts *e1i_ts = &line->ts[ts_nr-1];
352 struct msgb *msg = msgb_alloc(TSX_ALLOC_SIZE, "mISDN TSx");
353 struct mISDNhead *hh;
354 int ret;
355
356 if (!msg)
357 return -ENOMEM;
358
359 hh = (struct mISDNhead *) msg->data;
360
361 ret = recv(bfd->fd, msg->data, TSX_ALLOC_SIZE, 0);
362 if (ret < 0) {
363 fprintf(stderr, "recvfrom error %s\n", strerror(errno));
364 return ret;
365 }
366
367 msgb_put(msg, ret);
368
369 if (hh->prim != PH_CONTROL_IND)
Harald Weltecc2241b2011-07-19 16:06:06 +0200370 DEBUGP(DLMIB, "<= BCHAN len = %d, prim(0x%x) id(0x%x): %s\n",
Harald Welte6341aa02011-08-21 00:55:23 +0200371 ret, hh->prim, hh->id,
372 get_value_string(prim_names, hh->prim));
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200373
374 switch (hh->prim) {
375 case PH_DATA_IND:
376 msg->l2h = msg->data + MISDN_HEADER_LEN;
Harald Weltecc2241b2011-07-19 16:06:06 +0200377 DEBUGP(DLMIB, "BCHAN RX: %s\n",
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200378 osmo_hexdump(msgb_l2(msg), ret - MISDN_HEADER_LEN));
Andreas Eversbergd73c8462011-12-20 18:56:42 +0100379 /* the number of bytes received indicates that data to send */
380 handle_tsX_write(bfd, msgb_l2len(msg));
Andreas Eversberga7ff0012011-09-26 11:29:30 +0200381 return e1inp_rx_ts(e1i_ts, msg, 0, 0);
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200382 case PH_ACTIVATE_IND:
383 case PH_DATA_CNF:
Andreas Eversbergd73c8462011-12-20 18:56:42 +0100384 break;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200385 default:
386 break;
387 }
388 /* FIXME: why do we free signalling msgs in the caller, and trau not? */
389 msgb_free(msg);
390
391 return ret;
392}
393
394/* callback from select.c in case one of the fd's can be read/written */
395static int misdn_fd_cb(struct osmo_fd *bfd, unsigned int what)
396{
397 struct e1inp_line *line = bfd->data;
398 unsigned int ts_nr = bfd->priv_nr;
399 unsigned int idx = ts_nr-1;
400 struct e1inp_ts *e1i_ts = &line->ts[idx];
401 int rc = 0;
402
403 switch (e1i_ts->type) {
404 case E1INP_TS_TYPE_SIGN:
405 if (what & BSC_FD_READ)
406 rc = handle_ts1_read(bfd);
407 if (what & BSC_FD_WRITE)
408 rc = handle_ts1_write(bfd);
409 break;
410 case E1INP_TS_TYPE_TRAU:
411 if (what & BSC_FD_READ)
412 rc = handle_tsX_read(bfd);
413 /* We never include the mISDN B-Channel FD into the
414 * writeset, since it doesn't support poll() based
415 * write flow control */
416 break;
417 default:
418 fprintf(stderr, "unknown E1 TS type %u\n", e1i_ts->type);
419 break;
420 }
421
422 return rc;
423}
424
425static int activate_bchan(struct e1inp_line *line, int ts, int act)
426{
427 struct mISDNhead hh;
428 int ret;
429 unsigned int idx = ts-1;
430 struct e1inp_ts *e1i_ts = &line->ts[idx];
431 struct osmo_fd *bfd = &e1i_ts->driver.misdn.fd;
432
433 fprintf(stdout, "activate bchan\n");
434 if (act)
435 hh.prim = PH_ACTIVATE_REQ;
436 else
437 hh.prim = PH_DEACTIVATE_REQ;
438
439 hh.id = MISDN_ID_ANY;
440 ret = sendto(bfd->fd, &hh, sizeof(hh), 0, NULL, 0);
441 if (ret < 0) {
442 fprintf(stdout, "could not send ACTIVATE_RQ %s\n",
443 strerror(errno));
444 }
445
446 return ret;
447}
448
Pablo Neira Ayuso4e862cb2011-08-19 18:43:38 +0200449static int mi_e1_line_update(struct e1inp_line *line);
Harald Weltece307b42011-08-21 01:18:05 +0200450static int mi_e1_line_update_lapd(struct e1inp_line *line);
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200451
452struct e1inp_driver misdn_driver = {
453 .name = "misdn",
454 .want_write = ts_want_write,
455 .default_delay = 50000,
456 .line_update = &mi_e1_line_update,
457};
458
Harald Weltece307b42011-08-21 01:18:05 +0200459struct e1inp_driver misdn_lapd_driver = {
460 .name = "misdn_lapd",
461 .want_write = ts_want_write,
462 .default_delay = 50000,
463 .line_update = &mi_e1_line_update_lapd,
464};
465
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200466static int mi_e1_setup(struct e1inp_line *line, int release_l2)
467{
Harald Weltece307b42011-08-21 01:18:05 +0200468 struct misdn_line *mline = line->driver_data;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200469 int ts, ret;
470
Andreas Eversberga7ff0012011-09-26 11:29:30 +0200471 mline->dummy_dchannel = -1;
472 if (mline->use_userspace_lapd) {
473 /* Open dummy d-channel in order to use b-channels.
474 * Also it is required to define the mode.
475 */
476 if (mline->dummy_dchannel < 0) {
477 struct sockaddr_mISDN addr;
478
479 mline->dummy_dchannel = socket(PF_ISDN, SOCK_DGRAM,
480 ISDN_P_NT_E1);
481 if (mline->dummy_dchannel < 0) {
482 fprintf(stderr, "%s could not open socket %s\n",
483 __func__, strerror(errno));
484 return mline->dummy_dchannel;
485 }
486 memset(&addr, 0, sizeof(addr));
487 addr.family = AF_ISDN;
Andreas Eversberg43086672012-01-18 19:06:12 +0100488 addr.dev = line->port_nr;
Andreas Eversberga7ff0012011-09-26 11:29:30 +0200489 addr.channel = 0;
490 addr.sapi = 0;
491 addr.tei = GROUP_TEI;
492 ret = bind(mline->dummy_dchannel,
493 (struct sockaddr *) &addr, sizeof(addr));
494 if (ret < 0) {
495 fprintf(stderr, "could not bind l2 socket %s\n",
496 strerror(errno));
497 return -EIO;
498 }
499 }
500 }
501
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200502 /* TS0 is CRC4, don't need any fd for it */
503 for (ts = 1; ts < NUM_E1_TS; ts++) {
504 unsigned int idx = ts-1;
505 struct e1inp_ts *e1i_ts = &line->ts[idx];
506 struct osmo_fd *bfd = &e1i_ts->driver.misdn.fd;
507 struct sockaddr_mISDN addr;
508
509 bfd->data = line;
510 bfd->priv_nr = ts;
511 bfd->cb = misdn_fd_cb;
512
513 switch (e1i_ts->type) {
514 case E1INP_TS_TYPE_NONE:
515 continue;
516 break;
517 case E1INP_TS_TYPE_SIGN:
Harald Weltece307b42011-08-21 01:18:05 +0200518 if (mline->use_userspace_lapd)
Andreas Eversberga7ff0012011-09-26 11:29:30 +0200519 bfd->fd = socket(PF_ISDN, SOCK_DGRAM,
520 ISDN_P_B_HDLC);
Harald Weltece307b42011-08-21 01:18:05 +0200521 else
Andreas Eversberga7ff0012011-09-26 11:29:30 +0200522 bfd->fd = socket(PF_ISDN, SOCK_DGRAM,
523 ISDN_P_LAPD_NT);
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200524 bfd->when = BSC_FD_READ;
525 break;
526 case E1INP_TS_TYPE_TRAU:
527 bfd->fd = socket(PF_ISDN, SOCK_DGRAM, ISDN_P_B_RAW);
528 /* We never include the mISDN B-Channel FD into the
529 * writeset, since it doesn't support poll() based
530 * write flow control */
531 bfd->when = BSC_FD_READ;
532 break;
533 }
534
535 if (bfd->fd < 0) {
536 fprintf(stderr, "%s could not open socket %s\n",
537 __func__, strerror(errno));
538 return bfd->fd;
539 }
540
541 memset(&addr, 0, sizeof(addr));
542 addr.family = AF_ISDN;
Harald Weltec2889512011-09-13 23:49:04 +0100543 addr.dev = line->port_nr;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200544 switch (e1i_ts->type) {
545 case E1INP_TS_TYPE_SIGN:
Harald Weltece307b42011-08-21 01:18:05 +0200546 if (mline->use_userspace_lapd) {
547 addr.channel = ts;
Andreas Eversberga7ff0012011-09-26 11:29:30 +0200548 e1i_ts->lapd = lapd_instance_alloc(1,
549 misdn_write_msg, bfd, e1inp_dlsap_up,
Andreas Eversberg3744b872011-09-27 12:12:36 +0200550 e1i_ts, &lapd_profile_abis);
Harald Weltece307b42011-08-21 01:18:05 +0200551 } else {
552 addr.channel = 0;
553 /* SAPI not supported yet in kernel */
554 //addr.sapi = e1inp_ts->sign.sapi;
555 addr.sapi = 0;
556 addr.tei = GROUP_TEI;
557 }
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200558 break;
559 case E1INP_TS_TYPE_TRAU:
560 addr.channel = ts;
561 break;
562 default:
Harald Weltecc2241b2011-07-19 16:06:06 +0200563 DEBUGP(DLMI, "unsupported E1 TS type: %u\n",
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200564 e1i_ts->type);
565 break;
566 }
567
568 ret = bind(bfd->fd, (struct sockaddr *) &addr, sizeof(addr));
569 if (ret < 0) {
570 fprintf(stderr, "could not bind l2 socket %s\n",
571 strerror(errno));
572 return -EIO;
573 }
574
575 if (e1i_ts->type == E1INP_TS_TYPE_SIGN) {
Harald Weltece307b42011-08-21 01:18:05 +0200576 if (!mline->use_userspace_lapd) {
577 ret = ioctl(bfd->fd, IMCLEAR_L2, &release_l2);
578 if (ret < 0) {
579 fprintf(stderr, "could not send IOCTL IMCLEAN_L2 %s\n", strerror(errno));
580 return -EIO;
581 }
582 } else
583 activate_bchan(line, ts, 1);
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200584 }
585
586 /* FIXME: only activate B-Channels once we start to
587 * use them to conserve CPU power */
588 if (e1i_ts->type == E1INP_TS_TYPE_TRAU)
589 activate_bchan(line, ts, 1);
590
591 ret = osmo_fd_register(bfd);
592 if (ret < 0) {
593 fprintf(stderr, "could not register FD: %s\n",
594 strerror(ret));
595 return ret;
596 }
597 }
598
599 return 0;
600}
601
Harald Weltece307b42011-08-21 01:18:05 +0200602static int _mi_e1_line_update(struct e1inp_line *line)
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200603{
604 struct mISDN_devinfo devinfo;
605 int sk, ret, cnt;
606
Harald Weltece307b42011-08-21 01:18:05 +0200607 if (line->driver != &misdn_driver &&
608 line->driver != &misdn_lapd_driver)
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200609 return -EINVAL;
610
611 /* open the ISDN card device */
612 sk = socket(PF_ISDN, SOCK_RAW, ISDN_P_BASE);
613 if (sk < 0) {
614 fprintf(stderr, "%s could not open socket %s\n",
615 __func__, strerror(errno));
616 return sk;
617 }
618
619 ret = ioctl(sk, IMGETCOUNT, &cnt);
620 if (ret) {
621 fprintf(stderr, "%s error getting interf count: %s\n",
622 __func__, strerror(errno));
623 close(sk);
624 return -ENODEV;
625 }
Harald Weltecc2241b2011-07-19 16:06:06 +0200626 //DEBUGP(DLMI,"%d device%s found\n", cnt, (cnt==1)?"":"s");
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200627 printf("%d device%s found\n", cnt, (cnt==1)?"":"s");
628#if 1
Harald Weltec2889512011-09-13 23:49:04 +0100629 devinfo.id = line->port_nr;
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200630 ret = ioctl(sk, IMGETDEVINFO, &devinfo);
631 if (ret < 0) {
632 fprintf(stdout, "error getting info for device %d: %s\n",
Harald Weltec2889512011-09-13 23:49:04 +0100633 line->port_nr, strerror(errno));
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200634 return -ENODEV;
635 }
636 fprintf(stdout, " id: %d\n", devinfo.id);
637 fprintf(stdout, " Dprotocols: %08x\n", devinfo.Dprotocols);
638 fprintf(stdout, " Bprotocols: %08x\n", devinfo.Bprotocols);
639 fprintf(stdout, " protocol: %d\n", devinfo.protocol);
640 fprintf(stdout, " nrbchan: %d\n", devinfo.nrbchan);
641 fprintf(stdout, " name: %s\n", devinfo.name);
642#endif
Holger Hans Peter Freyther219a6a42013-07-06 18:49:59 +0200643 close(sk);
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200644
645 if (!(devinfo.Dprotocols & (1 << ISDN_P_NT_E1))) {
646 fprintf(stderr, "error: card is not of type E1 (NT-mode)\n");
647 return -EINVAL;
648 }
649
650 ret = mi_e1_setup(line, 1);
651 if (ret)
652 return ret;
653
654 return 0;
655}
656
Harald Weltece307b42011-08-21 01:18:05 +0200657static int mi_e1_line_update(struct e1inp_line *line)
658{
659 struct misdn_line *ml;
660
661 if (!line->driver_data)
662 line->driver_data = talloc_zero(line, struct misdn_line);
663
664 ml = line->driver_data;
665 ml->use_userspace_lapd = 0;
666
667 return _mi_e1_line_update(line);
668}
669
670static int mi_e1_line_update_lapd(struct e1inp_line *line)
671{
672 struct misdn_line *ml;
673
674 if (!line->driver_data)
675 line->driver_data = talloc_zero(line, struct misdn_line);
676
677 ml = line->driver_data;
678 ml->use_userspace_lapd = 1;
679
680 return _mi_e1_line_update(line);
681}
682
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200683void e1inp_misdn_init(void)
684{
685 /* register the driver with the core */
686 e1inp_driver_register(&misdn_driver);
Harald Weltece307b42011-08-21 01:18:05 +0200687 e1inp_driver_register(&misdn_lapd_driver);
Pablo Neira Ayuso0ba77d52011-06-05 18:32:44 +0200688}