capi.c 36.4 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20
/* $Id: capi.c,v 1.1.2.7 2004/04/28 09:48:59 armin Exp $
 *
 * CAPI 2.0 Interface for Linux
 *
 * Copyright 1996 by Carsten Paeth <calle@calle.de>
 *
 * This software may be used and distributed according to the terms
 * of the GNU General Public License, incorporated herein by reference.
 *
 */

#include <linux/module.h>
#include <linux/errno.h>
#include <linux/kernel.h>
#include <linux/major.h>
#include <linux/sched.h>
#include <linux/slab.h>
#include <linux/fcntl.h>
#include <linux/fs.h>
#include <linux/signal.h>
21
#include <linux/mutex.h>
L
Linus Torvalds 已提交
22
#include <linux/mm.h>
J
Jonathan Corbet 已提交
23
#include <linux/smp_lock.h>
L
Linus Torvalds 已提交
24 25 26 27 28 29 30 31
#include <linux/timer.h>
#include <linux/wait.h>
#include <linux/tty.h>
#include <linux/netdevice.h>
#include <linux/ppp_defs.h>
#include <linux/if_ppp.h>
#include <linux/skbuff.h>
#include <linux/proc_fs.h>
32
#include <linux/seq_file.h>
L
Linus Torvalds 已提交
33 34 35 36 37 38 39 40
#include <linux/poll.h>
#include <linux/capi.h>
#include <linux/kernelcapi.h>
#include <linux/init.h>
#include <linux/device.h>
#include <linux/moduleparam.h>
#include <linux/isdn/capiutil.h>
#include <linux/isdn/capicmd.h>
J
Jan Kiszka 已提交
41

L
Linus Torvalds 已提交
42 43 44 45 46 47 48 49 50 51 52 53
#include "capifs.h"

MODULE_DESCRIPTION("CAPI4Linux: Userspace /dev/capi20 interface");
MODULE_AUTHOR("Carsten Paeth");
MODULE_LICENSE("GPL");

#undef _DEBUG_REFCOUNT		/* alloc/free and open/close debug */
#undef _DEBUG_TTYFUNCS		/* call to tty_driver */
#undef _DEBUG_DATAFLOW		/* data flow */

/* -------- driver information -------------------------------------- */

54
static struct class *capi_class;
A
Adrian Bunk 已提交
55
static int capi_major = 68;		/* allocated */
56 57 58

module_param_named(major, capi_major, uint, 0);

L
Linus Torvalds 已提交
59
#ifdef CONFIG_ISDN_CAPI_MIDDLEWARE
60
#define CAPINC_NR_PORTS		32
L
Linus Torvalds 已提交
61
#define CAPINC_MAX_PORTS	256
62

A
Adrian Bunk 已提交
63
static int capi_ttyminors = CAPINC_NR_PORTS;
L
Linus Torvalds 已提交
64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79

module_param_named(ttyminors, capi_ttyminors, uint, 0);
#endif /* CONFIG_ISDN_CAPI_MIDDLEWARE */

/* -------- defines ------------------------------------------------- */

#define CAPINC_MAX_RECVQUEUE	10
#define CAPINC_MAX_SENDQUEUE	10
#define CAPI_MAX_BLKSIZE	2048

/* -------- data structures ----------------------------------------- */

struct capidev;
struct capincci;
struct capiminor;

80 81 82 83 84
struct datahandle_queue {
	struct list_head	list;
	u16			datahandle;
};

L
Linus Torvalds 已提交
85
struct capiminor {
J
Jan Kiszka 已提交
86 87
	struct kref kref;

L
Linus Torvalds 已提交
88 89
	struct capincci  *nccip;
	unsigned int      minor;
J
Jan Kiszka 已提交
90
	struct dentry *capifs_dentry;
L
Linus Torvalds 已提交
91 92 93 94 95 96

	struct capi20_appl *ap;
	u32		 ncci;
	u16		 datahandle;
	u16		 msgid;

97
	struct tty_port port;
L
Linus Torvalds 已提交
98 99 100 101 102 103 104 105 106 107 108
	int                ttyinstop;
	int                ttyoutstop;
	struct sk_buff    *ttyskb;
	atomic_t           ttyopencount;

	struct sk_buff_head inqueue;
	int                 inbytes;
	struct sk_buff_head outqueue;
	int                 outbytes;

	/* transmit path */
109
	struct list_head ackqueue;
L
Linus Torvalds 已提交
110
	int nack;
111
	spinlock_t ackqlock;
L
Linus Torvalds 已提交
112 113
};

114 115 116 117 118 119 120 121 122
/* FIXME: The following lock is a sledgehammer-workaround to a
 * locking issue with the capiminor (and maybe other) data structure(s).
 * Access to this data is done in a racy way and crashes the machine with
 * a FritzCard DSL driver; sooner or later. This is a workaround
 * which trades scalability vs stability, so it doesn't crash the kernel anymore.
 * The correct (and scalable) fix for the issue seems to require
 * an API change to the drivers... . */
static DEFINE_SPINLOCK(workaround_lock);

L
Linus Torvalds 已提交
123
struct capincci {
124
	struct list_head list;
L
Linus Torvalds 已提交
125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140
	u32		 ncci;
	struct capidev	*cdev;
#ifdef CONFIG_ISDN_CAPI_MIDDLEWARE
	struct capiminor *minorp;
#endif /* CONFIG_ISDN_CAPI_MIDDLEWARE */
};

struct capidev {
	struct list_head list;
	struct capi20_appl ap;
	u16		errcode;
	unsigned        userflags;

	struct sk_buff_head recvqueue;
	wait_queue_head_t recvwait;

141
	struct list_head nccis;
L
Linus Torvalds 已提交
142

143
	struct mutex lock;
L
Linus Torvalds 已提交
144 145 146 147
};

/* -------- global variables ---------------------------------------- */

148
static DEFINE_MUTEX(capidev_list_lock);
L
Linus Torvalds 已提交
149 150 151
static LIST_HEAD(capidev_list);

#ifdef CONFIG_ISDN_CAPI_MIDDLEWARE
152

153 154
static DEFINE_RWLOCK(capiminors_lock);
static struct capiminor **capiminors;
L
Linus Torvalds 已提交
155

156 157
static struct tty_driver *capinc_tty_driver;

L
Linus Torvalds 已提交
158 159
/* -------- datahandles --------------------------------------------- */

160
static int capiminor_add_ack(struct capiminor *mp, u16 datahandle)
L
Linus Torvalds 已提交
161
{
162 163
	struct datahandle_queue *n;
	unsigned long flags;
L
Linus Torvalds 已提交
164 165

	n = kmalloc(sizeof(*n), GFP_ATOMIC);
166 167 168
	if (unlikely(!n)) {
		printk(KERN_ERR "capi: alloc datahandle failed\n");
		return -1;
L
Linus Torvalds 已提交
169 170
	}
	n->datahandle = datahandle;
171 172 173
	INIT_LIST_HEAD(&n->list);
	spin_lock_irqsave(&mp->ackqlock, flags);
	list_add_tail(&n->list, &mp->ackqueue);
L
Linus Torvalds 已提交
174
	mp->nack++;
175
	spin_unlock_irqrestore(&mp->ackqlock, flags);
L
Linus Torvalds 已提交
176 177 178 179 180
	return 0;
}

static int capiminor_del_ack(struct capiminor *mp, u16 datahandle)
{
181 182
	struct datahandle_queue *p, *tmp;
	unsigned long flags;
L
Linus Torvalds 已提交
183

184 185 186 187
	spin_lock_irqsave(&mp->ackqlock, flags);
	list_for_each_entry_safe(p, tmp, &mp->ackqueue, list) {
 		if (p->datahandle == datahandle) {
			list_del(&p->list);
L
Linus Torvalds 已提交
188 189
			kfree(p);
			mp->nack--;
190
			spin_unlock_irqrestore(&mp->ackqlock, flags);
L
Linus Torvalds 已提交
191 192 193
			return 0;
		}
	}
194
	spin_unlock_irqrestore(&mp->ackqlock, flags);
L
Linus Torvalds 已提交
195 196 197 198 199
	return -1;
}

static void capiminor_del_all_ack(struct capiminor *mp)
{
200 201
	struct datahandle_queue *p, *tmp;
	unsigned long flags;
L
Linus Torvalds 已提交
202

203 204 205
	spin_lock_irqsave(&mp->ackqlock, flags);
	list_for_each_entry_safe(p, tmp, &mp->ackqueue, list) {
		list_del(&p->list);
L
Linus Torvalds 已提交
206 207 208
		kfree(p);
		mp->nack--;
	}
209
	spin_unlock_irqrestore(&mp->ackqlock, flags);
L
Linus Torvalds 已提交
210 211 212 213 214
}


/* -------- struct capiminor ---------------------------------------- */

215 216
static const struct tty_port_operations capiminor_port_ops; /* we have none */

L
Linus Torvalds 已提交
217 218
static struct capiminor *capiminor_alloc(struct capi20_appl *ap, u32 ncci)
{
219
	struct capiminor *mp;
220
	struct device *dev;
221
	unsigned int minor;
L
Linus Torvalds 已提交
222 223
	unsigned long flags;

224
	mp = kzalloc(sizeof(*mp), GFP_KERNEL);
L
Linus Torvalds 已提交
225 226 227 228 229
  	if (!mp) {
  		printk(KERN_ERR "capi: can't alloc capiminor\n");
		return NULL;
	}

J
Jan Kiszka 已提交
230 231
	kref_init(&mp->kref);

L
Linus Torvalds 已提交
232 233 234 235
	mp->ap = ap;
	mp->ncci = ncci;
	mp->msgid = 0;
	atomic_set(&mp->ttyopencount,0);
236 237
	INIT_LIST_HEAD(&mp->ackqueue);
	spin_lock_init(&mp->ackqlock);
L
Linus Torvalds 已提交
238 239 240 241

	skb_queue_head_init(&mp->inqueue);
	skb_queue_head_init(&mp->outqueue);

242 243 244
	tty_port_init(&mp->port);
	mp->port.ops = &capiminor_port_ops;

245 246 247 248 249 250
	/* Allocate the least unused minor number. */
	write_lock_irqsave(&capiminors_lock, flags);
	for (minor = 0; minor < capi_ttyminors; minor++)
		if (!capiminors[minor]) {
			capiminors[minor] = mp;
			break;
L
Linus Torvalds 已提交
251
		}
252
	write_unlock_irqrestore(&capiminors_lock, flags);
L
Linus Torvalds 已提交
253

254
	if (minor == capi_ttyminors) {
L
Linus Torvalds 已提交
255
		printk(KERN_NOTICE "capi: out of minors\n");
256
		goto err_out1;
L
Linus Torvalds 已提交
257 258
	}

259 260
	mp->minor = minor;

261 262 263 264
	dev = tty_register_device(capinc_tty_driver, minor, NULL);
	if (IS_ERR(dev))
		goto err_out2;

L
Linus Torvalds 已提交
265
	return mp;
266 267 268 269 270 271 272 273 274

err_out2:
	write_lock_irqsave(&capiminors_lock, flags);
	capiminors[minor] = NULL;
	write_unlock_irqrestore(&capiminors_lock, flags);

err_out1:
	kfree(mp);
	return NULL;
L
Linus Torvalds 已提交
275 276
}

J
Jan Kiszka 已提交
277
static void capiminor_destroy(struct kref *kref)
L
Linus Torvalds 已提交
278
{
J
Jan Kiszka 已提交
279
	struct capiminor *mp = container_of(kref, struct capiminor, kref);
L
Linus Torvalds 已提交
280

281
	kfree_skb(mp->ttyskb);
L
Linus Torvalds 已提交
282 283 284 285 286 287
	skb_queue_purge(&mp->inqueue);
	skb_queue_purge(&mp->outqueue);
	capiminor_del_all_ack(mp);
	kfree(mp);
}

288
static struct capiminor *capiminor_get(unsigned int minor)
L
Linus Torvalds 已提交
289
{
290
	struct capiminor *mp;
L
Linus Torvalds 已提交
291

292 293
	read_lock(&capiminors_lock);
	mp = capiminors[minor];
J
Jan Kiszka 已提交
294 295
	if (mp)
		kref_get(&mp->kref);
296 297 298
	read_unlock(&capiminors_lock);

	return mp;
L
Linus Torvalds 已提交
299 300
}

J
Jan Kiszka 已提交
301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318
static inline void capiminor_put(struct capiminor *mp)
{
	kref_put(&mp->kref, capiminor_destroy);
}

static void capiminor_free(struct capiminor *mp)
{
	unsigned long flags;

	tty_unregister_device(capinc_tty_driver, mp->minor);

	write_lock_irqsave(&capiminors_lock, flags);
	capiminors[mp->minor] = NULL;
	write_unlock_irqrestore(&capiminors_lock, flags);

	capiminor_put(mp);
}

L
Linus Torvalds 已提交
319 320
/* -------- struct capincci ----------------------------------------- */

321
static void capincci_alloc_minor(struct capidev *cdev, struct capincci *np)
L
Linus Torvalds 已提交
322
{
323
	struct capiminor *mp;
324
	dev_t device;
L
Linus Torvalds 已提交
325

326 327 328 329
	if (!(cdev->userflags & CAPIFLAG_HIGHJACKING))
		return;

	mp = np->minorp = capiminor_alloc(&cdev->ap, np->ncci);
L
Linus Torvalds 已提交
330 331 332 333 334
	if (mp) {
		mp->nccip = np;
#ifdef _DEBUG_REFCOUNT
		printk(KERN_DEBUG "set mp->nccip\n");
#endif
335 336
		device = MKDEV(capinc_tty_driver->major, mp->minor);
		mp->capifs_dentry = capifs_new_ncci(mp->minor, device);
L
Linus Torvalds 已提交
337
	}
338 339 340 341 342
}

static void capincci_free_minor(struct capincci *np)
{
	struct capiminor *mp = np->minorp;
343
	struct tty_struct *tty;
344 345 346

	if (mp) {
		capifs_free_ncci(mp->capifs_dentry);
347 348 349

		tty = tty_port_tty_get(&mp->port);
		if (tty) {
350 351 352 353
			mp->nccip = NULL;
#ifdef _DEBUG_REFCOUNT
			printk(KERN_DEBUG "reset mp->nccip\n");
#endif
354 355
			tty_hangup(tty);
			tty_kref_put(tty);
356
		}
357 358

		capiminor_free(mp);
359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383
	}
}

static inline unsigned int capincci_minor_opencount(struct capincci *np)
{
	struct capiminor *mp = np->minorp;

	return mp ? atomic_read(&mp->ttyopencount) : 0;
}

#else /* !CONFIG_ISDN_CAPI_MIDDLEWARE */

static inline void
capincci_alloc_minor(struct capidev *cdev, struct capincci *np) { }
static inline void capincci_free_minor(struct capincci *np) { }

static inline unsigned int capincci_minor_opencount(struct capincci *np)
{
	return 0;
}

#endif /* !CONFIG_ISDN_CAPI_MIDDLEWARE */

static struct capincci *capincci_alloc(struct capidev *cdev, u32 ncci)
{
384
	struct capincci *np;
385

386
	np = kzalloc(sizeof(*np), GFP_KERNEL);
387 388 389 390 391 392 393
	if (!np)
		return NULL;
	np->ncci = ncci;
	np->cdev = cdev;

	capincci_alloc_minor(cdev, np);

394 395 396
	list_add_tail(&np->list, &cdev->nccis);

	return np;
L
Linus Torvalds 已提交
397 398 399 400
}

static void capincci_free(struct capidev *cdev, u32 ncci)
{
401
	struct capincci *np, *tmp;
L
Linus Torvalds 已提交
402

403
	list_for_each_entry_safe(np, tmp, &cdev->nccis, list)
L
Linus Torvalds 已提交
404
		if (ncci == 0xffffffff || np->ncci == ncci) {
405
			capincci_free_minor(np);
406
			list_del(&np->list);
L
Linus Torvalds 已提交
407 408 409 410 411 412
			kfree(np);
		}
}

static struct capincci *capincci_find(struct capidev *cdev, u32 ncci)
{
413
	struct capincci *np;
L
Linus Torvalds 已提交
414

415 416 417 418
	list_for_each_entry(np, &cdev->nccis, list)
		if (np->ncci == ncci)
			return np;
	return NULL;
L
Linus Torvalds 已提交
419 420 421 422 423 424 425 426 427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444
}

#ifdef CONFIG_ISDN_CAPI_MIDDLEWARE
/* -------- handle data queue --------------------------------------- */

static struct sk_buff *
gen_data_b3_resp_for(struct capiminor *mp, struct sk_buff *skb)
{
	struct sk_buff *nskb;
	nskb = alloc_skb(CAPI_DATA_B3_RESP_LEN, GFP_ATOMIC);
	if (nskb) {
		u16 datahandle = CAPIMSG_U16(skb->data,CAPIMSG_BASELEN+4+4+2);
		unsigned char *s = skb_put(nskb, CAPI_DATA_B3_RESP_LEN);
		capimsg_setu16(s, 0, CAPI_DATA_B3_RESP_LEN);
		capimsg_setu16(s, 2, mp->ap->applid);
		capimsg_setu8 (s, 4, CAPI_DATA_B3);
		capimsg_setu8 (s, 5, CAPI_RESP);
		capimsg_setu16(s, 6, mp->msgid++);
		capimsg_setu32(s, 8, mp->ncci);
		capimsg_setu16(s, 12, datahandle);
	}
	return nskb;
}

static int handle_recv_skb(struct capiminor *mp, struct sk_buff *skb)
{
445
	struct tty_struct *tty;
L
Linus Torvalds 已提交
446 447 448 449
	struct sk_buff *nskb;
	int datalen;
	u16 errcode, datahandle;
	struct tty_ldisc *ld;
450 451
	int ret = -1;

L
Linus Torvalds 已提交
452
	datalen = skb->len - CAPIMSG_LEN(skb->data);
453 454 455

	tty = tty_port_tty_get(&mp->port);
	if (!tty) {
L
Linus Torvalds 已提交
456 457 458 459 460 461
#ifdef _DEBUG_DATAFLOW
		printk(KERN_DEBUG "capi: currently no receiver\n");
#endif
		return -1;
	}
	
462 463 464 465
	ld = tty_ldisc_ref(tty);
	if (!ld)
		goto out1;

A
Alan Cox 已提交
466
	if (ld->ops->receive_buf == NULL) {
L
Linus Torvalds 已提交
467 468 469
#if defined(_DEBUG_DATAFLOW) || defined(_DEBUG_TTYFUNCS)
		printk(KERN_DEBUG "capi: ldisc has no receive_buf function\n");
#endif
470
		goto out2;
L
Linus Torvalds 已提交
471 472 473 474 475
	}
	if (mp->ttyinstop) {
#if defined(_DEBUG_DATAFLOW) || defined(_DEBUG_TTYFUNCS)
		printk(KERN_DEBUG "capi: recv tty throttled\n");
#endif
476
		goto out2;
L
Linus Torvalds 已提交
477
	}
478
	if (tty->receive_room < datalen) {
L
Linus Torvalds 已提交
479 480 481
#if defined(_DEBUG_DATAFLOW) || defined(_DEBUG_TTYFUNCS)
		printk(KERN_DEBUG "capi: no room in tty\n");
#endif
482
		goto out2;
L
Linus Torvalds 已提交
483
	}
484
	if ((nskb = gen_data_b3_resp_for(mp, skb)) == NULL) {
L
Linus Torvalds 已提交
485
		printk(KERN_ERR "capi: gen_data_b3_resp failed\n");
486
		goto out2;
L
Linus Torvalds 已提交
487 488 489 490 491 492 493
	}
	datahandle = CAPIMSG_U16(skb->data,CAPIMSG_BASELEN+4);
	errcode = capi20_put_message(mp->ap, nskb);
	if (errcode != CAPI_NOERROR) {
		printk(KERN_ERR "capi: send DATA_B3_RESP failed=%x\n",
				errcode);
		kfree_skb(nskb);
494
		goto out2;
L
Linus Torvalds 已提交
495 496 497 498 499 500
	}
	(void)skb_pull(skb, CAPIMSG_LEN(skb->data));
#ifdef _DEBUG_DATAFLOW
	printk(KERN_DEBUG "capi: DATA_B3_RESP %u len=%d => ldisc\n",
				datahandle, skb->len);
#endif
501
	ld->ops->receive_buf(tty, skb->data, NULL, skb->len);
L
Linus Torvalds 已提交
502
	kfree_skb(skb);
503 504
	ret = 0;
out2:
L
Linus Torvalds 已提交
505
	tty_ldisc_deref(ld);
506 507 508
out1:
	tty_kref_put(tty);
	return ret;
L
Linus Torvalds 已提交
509 510 511 512 513
}

static void handle_minor_recv(struct capiminor *mp)
{
	struct sk_buff *skb;
514
	while ((skb = skb_dequeue(&mp->inqueue)) != NULL) {
L
Linus Torvalds 已提交
515 516 517 518 519 520 521 522 523 524 525 526
		unsigned int len = skb->len;
		mp->inbytes -= len;
		if (handle_recv_skb(mp, skb) < 0) {
			skb_queue_head(&mp->inqueue, skb);
			mp->inbytes += len;
			return;
		}
	}
}

static int handle_minor_send(struct capiminor *mp)
{
527
	struct tty_struct *tty;
L
Linus Torvalds 已提交
528 529 530 531 532 533
	struct sk_buff *skb;
	u16 len;
	int count = 0;
	u16 errcode;
	u16 datahandle;

534 535 536 537 538
	tty = tty_port_tty_get(&mp->port);
	if (!tty)
		return 0;

	if (mp->ttyoutstop) {
L
Linus Torvalds 已提交
539 540 541
#if defined(_DEBUG_DATAFLOW) || defined(_DEBUG_TTYFUNCS)
		printk(KERN_DEBUG "capi: send: tty stopped\n");
#endif
542
		tty_kref_put(tty);
L
Linus Torvalds 已提交
543 544 545
		return 0;
	}

546
	while ((skb = skb_dequeue(&mp->outqueue)) != NULL) {
L
Linus Torvalds 已提交
547 548 549 550 551 552 553 554 555 556
		datahandle = mp->datahandle;
		len = (u16)skb->len;
		skb_push(skb, CAPI_DATA_B3_REQ_LEN);
		memset(skb->data, 0, CAPI_DATA_B3_REQ_LEN);
		capimsg_setu16(skb->data, 0, CAPI_DATA_B3_REQ_LEN);
		capimsg_setu16(skb->data, 2, mp->ap->applid);
		capimsg_setu8 (skb->data, 4, CAPI_DATA_B3);
		capimsg_setu8 (skb->data, 5, CAPI_REQ);
		capimsg_setu16(skb->data, 6, mp->msgid++);
		capimsg_setu32(skb->data, 8, mp->ncci);	/* NCCI */
A
Andrew Morton 已提交
557
		capimsg_setu32(skb->data, 12, (u32)(long)skb->data);/* Data32 */
L
Linus Torvalds 已提交
558 559 560 561
		capimsg_setu16(skb->data, 16, len);	/* Data length */
		capimsg_setu16(skb->data, 18, datahandle);
		capimsg_setu16(skb->data, 20, 0);	/* Flags */

562
		if (capiminor_add_ack(mp, datahandle) < 0) {
L
Linus Torvalds 已提交
563 564
			skb_pull(skb, CAPI_DATA_B3_REQ_LEN);
			skb_queue_head(&mp->outqueue, skb);
565
			tty_kref_put(tty);
L
Linus Torvalds 已提交
566 567 568 569 570 571 572 573 574 575 576 577 578 579 580 581 582 583 584 585 586 587 588 589 590 591
			return count;
		}
		errcode = capi20_put_message(mp->ap, skb);
		if (errcode == CAPI_NOERROR) {
			mp->datahandle++;
			count++;
			mp->outbytes -= len;
#ifdef _DEBUG_DATAFLOW
			printk(KERN_DEBUG "capi: DATA_B3_REQ %u len=%u\n",
							datahandle, len);
#endif
			continue;
		}
		capiminor_del_ack(mp, datahandle);

		if (errcode == CAPI_SENDQUEUEFULL) {
			skb_pull(skb, CAPI_DATA_B3_REQ_LEN);
			skb_queue_head(&mp->outqueue, skb);
			break;
		}

		/* ups, drop packet */
		printk(KERN_ERR "capi: put_message = %x\n", errcode);
		mp->outbytes -= len;
		kfree_skb(skb);
	}
592
	tty_kref_put(tty);
L
Linus Torvalds 已提交
593 594 595 596 597 598 599 600 601 602
	return count;
}

#endif /* CONFIG_ISDN_CAPI_MIDDLEWARE */
/* -------- function called by lower level -------------------------- */

static void capi_recv_message(struct capi20_appl *ap, struct sk_buff *skb)
{
	struct capidev *cdev = ap->private;
#ifdef CONFIG_ISDN_CAPI_MIDDLEWARE
603
	struct tty_struct *tty;
L
Linus Torvalds 已提交
604 605 606 607
	struct capiminor *mp;
	u16 datahandle;
#endif /* CONFIG_ISDN_CAPI_MIDDLEWARE */
	struct capincci *np;
608
	unsigned long flags;
L
Linus Torvalds 已提交
609

610 611
	mutex_lock(&cdev->lock);

L
Linus Torvalds 已提交
612 613
	if (CAPIMSG_CMD(skb->data) == CAPI_CONNECT_B3_CONF) {
		u16 info = CAPIMSG_U16(skb->data, 12); // Info field
614
		if ((info & 0xff00) == 0)
L
Linus Torvalds 已提交
615 616
			capincci_alloc(cdev, CAPIMSG_NCCI(skb->data));
	}
617
	if (CAPIMSG_CMD(skb->data) == CAPI_CONNECT_B3_IND)
L
Linus Torvalds 已提交
618
		capincci_alloc(cdev, CAPIMSG_NCCI(skb->data));
619

620
	spin_lock_irqsave(&workaround_lock, flags);
L
Linus Torvalds 已提交
621 622 623
	if (CAPIMSG_COMMAND(skb->data) != CAPI_DATA_B3) {
		skb_queue_tail(&cdev->recvqueue, skb);
		wake_up_interruptible(&cdev->recvwait);
624
		goto unlock_out;
L
Linus Torvalds 已提交
625
	}
626 627

	np = capincci_find(cdev, CAPIMSG_CONTROL(skb->data));
L
Linus Torvalds 已提交
628 629 630 631
	if (!np) {
		printk(KERN_ERR "BUG: capi_signal: ncci not found\n");
		skb_queue_tail(&cdev->recvqueue, skb);
		wake_up_interruptible(&cdev->recvwait);
632
		goto unlock_out;
L
Linus Torvalds 已提交
633
	}
634

L
Linus Torvalds 已提交
635 636 637
#ifndef CONFIG_ISDN_CAPI_MIDDLEWARE
	skb_queue_tail(&cdev->recvqueue, skb);
	wake_up_interruptible(&cdev->recvwait);
638

L
Linus Torvalds 已提交
639
#else /* CONFIG_ISDN_CAPI_MIDDLEWARE */
640

L
Linus Torvalds 已提交
641 642 643 644
	mp = np->minorp;
	if (!mp) {
		skb_queue_tail(&cdev->recvqueue, skb);
		wake_up_interruptible(&cdev->recvwait);
645
		goto unlock_out;
L
Linus Torvalds 已提交
646 647 648 649 650 651 652 653 654 655 656 657 658 659 660 661 662 663 664 665 666
	}
	if (CAPIMSG_SUBCOMMAND(skb->data) == CAPI_IND) {
		datahandle = CAPIMSG_U16(skb->data, CAPIMSG_BASELEN+4+4+2);
#ifdef _DEBUG_DATAFLOW
		printk(KERN_DEBUG "capi_signal: DATA_B3_IND %u len=%d\n",
				datahandle, skb->len-CAPIMSG_LEN(skb->data));
#endif
		skb_queue_tail(&mp->inqueue, skb);
		mp->inbytes += skb->len;
		handle_minor_recv(mp);

	} else if (CAPIMSG_SUBCOMMAND(skb->data) == CAPI_CONF) {

		datahandle = CAPIMSG_U16(skb->data, CAPIMSG_BASELEN+4);
#ifdef _DEBUG_DATAFLOW
		printk(KERN_DEBUG "capi_signal: DATA_B3_CONF %u 0x%x\n",
				datahandle,
				CAPIMSG_U16(skb->data, CAPIMSG_BASELEN+4+2));
#endif
		kfree_skb(skb);
		(void)capiminor_del_ack(mp, datahandle);
667 668 669 670 671
		tty = tty_port_tty_get(&mp->port);
		if (tty) {
			tty_wakeup(tty);
			tty_kref_put(tty);
		}
L
Linus Torvalds 已提交
672 673 674 675 676 677 678 679
		(void)handle_minor_send(mp);

	} else {
		/* ups, let capi application handle it :-) */
		skb_queue_tail(&cdev->recvqueue, skb);
		wake_up_interruptible(&cdev->recvwait);
	}
#endif /* CONFIG_ISDN_CAPI_MIDDLEWARE */
680

681
unlock_out:
682
	spin_unlock_irqrestore(&workaround_lock, flags);
683
	mutex_unlock(&cdev->lock);
L
Linus Torvalds 已提交
684 685 686 687 688 689 690 691 692 693
}

/* -------- file_operations for capidev ----------------------------- */

static ssize_t
capi_read(struct file *file, char __user *buf, size_t count, loff_t *ppos)
{
	struct capidev *cdev = (struct capidev *)file->private_data;
	struct sk_buff *skb;
	size_t copied;
J
Jan Kiszka 已提交
694
	int err;
L
Linus Torvalds 已提交
695 696 697 698

	if (!cdev->ap.applid)
		return -ENODEV;

J
Jan Kiszka 已提交
699 700
	skb = skb_dequeue(&cdev->recvqueue);
	if (!skb) {
L
Linus Torvalds 已提交
701 702
		if (file->f_flags & O_NONBLOCK)
			return -EAGAIN;
J
Jan Kiszka 已提交
703 704 705 706
		err = wait_event_interruptible(cdev->recvwait,
				(skb = skb_dequeue(&cdev->recvqueue)));
		if (err)
			return err;
L
Linus Torvalds 已提交
707 708 709 710 711 712 713 714 715 716 717 718 719 720 721 722 723 724 725 726 727 728 729 730 731 732 733 734 735 736 737 738 739 740 741 742 743 744 745 746 747 748 749 750 751 752 753 754 755
	}
	if (skb->len > count) {
		skb_queue_head(&cdev->recvqueue, skb);
		return -EMSGSIZE;
	}
	if (copy_to_user(buf, skb->data, skb->len)) {
		skb_queue_head(&cdev->recvqueue, skb);
		return -EFAULT;
	}
	copied = skb->len;

	kfree_skb(skb);

	return copied;
}

static ssize_t
capi_write(struct file *file, const char __user *buf, size_t count, loff_t *ppos)
{
	struct capidev *cdev = (struct capidev *)file->private_data;
	struct sk_buff *skb;
	u16 mlen;

	if (!cdev->ap.applid)
		return -ENODEV;

	skb = alloc_skb(count, GFP_USER);
	if (!skb)
		return -ENOMEM;

	if (copy_from_user(skb_put(skb, count), buf, count)) {
		kfree_skb(skb);
		return -EFAULT;
	}
	mlen = CAPIMSG_LEN(skb->data);
	if (CAPIMSG_CMD(skb->data) == CAPI_DATA_B3_REQ) {
		if ((size_t)(mlen + CAPIMSG_DATALEN(skb->data)) != count) {
			kfree_skb(skb);
			return -EINVAL;
		}
	} else {
		if (mlen != count) {
			kfree_skb(skb);
			return -EINVAL;
		}
	}
	CAPIMSG_SETAPPID(skb->data, cdev->ap.applid);

	if (CAPIMSG_CMD(skb->data) == CAPI_DISCONNECT_B3_RESP) {
756
		mutex_lock(&cdev->lock);
L
Linus Torvalds 已提交
757
		capincci_free(cdev, CAPIMSG_NCCI(skb->data));
758
		mutex_unlock(&cdev->lock);
L
Linus Torvalds 已提交
759 760 761 762 763 764 765 766 767 768 769 770 771 772 773 774 775 776 777 778 779 780 781 782 783 784 785 786 787 788 789 790 791 792 793 794 795 796
	}

	cdev->errcode = capi20_put_message(&cdev->ap, skb);

	if (cdev->errcode) {
		kfree_skb(skb);
		return -EIO;
	}
	return count;
}

static unsigned int
capi_poll(struct file *file, poll_table * wait)
{
	struct capidev *cdev = (struct capidev *)file->private_data;
	unsigned int mask = 0;

	if (!cdev->ap.applid)
		return POLLERR;

	poll_wait(file, &(cdev->recvwait), wait);
	mask = POLLOUT | POLLWRNORM;
	if (!skb_queue_empty(&cdev->recvqueue))
		mask |= POLLIN | POLLRDNORM;
	return mask;
}

static int
capi_ioctl(struct inode *inode, struct file *file,
	   unsigned int cmd, unsigned long arg)
{
	struct capidev *cdev = file->private_data;
	capi_ioctl_struct data;
	int retval = -EINVAL;
	void __user *argp = (void __user *)arg;

	switch (cmd) {
	case CAPI_REGISTER:
797
		mutex_lock(&cdev->lock);
L
Linus Torvalds 已提交
798

799 800 801 802 803 804 805 806 807 808 809 810 811 812 813 814
		if (cdev->ap.applid) {
			retval = -EEXIST;
			goto register_out;
		}
		if (copy_from_user(&cdev->ap.rparam, argp,
				   sizeof(struct capi_register_params))) {
			retval = -EFAULT;
			goto register_out;
		}
		cdev->ap.private = cdev;
		cdev->ap.recv_message = capi_recv_message;
		cdev->errcode = capi20_register(&cdev->ap);
		retval = (int)cdev->ap.applid;
		if (cdev->errcode) {
			cdev->ap.applid = 0;
			retval = -EIO;
L
Linus Torvalds 已提交
815
		}
816 817 818 819

register_out:
		mutex_unlock(&cdev->lock);
		return retval;
L
Linus Torvalds 已提交
820 821 822 823 824 825 826 827 828 829 830 831 832 833 834 835 836 837 838 839 840 841 842 843 844 845 846 847 848 849 850 851 852 853 854 855 856 857 858 859 860 861 862 863 864 865 866 867 868 869 870 871 872 873 874 875 876 877 878 879 880 881 882 883 884 885 886 887 888 889 890 891 892 893 894 895 896 897 898 899 900 901 902 903 904 905 906 907 908 909 910 911 912 913 914 915 916 917

	case CAPI_GET_VERSION:
		{
			if (copy_from_user(&data.contr, argp,
						sizeof(data.contr)))
				return -EFAULT;
		        cdev->errcode = capi20_get_version(data.contr, &data.version);
			if (cdev->errcode)
				return -EIO;
			if (copy_to_user(argp, &data.version,
					 sizeof(data.version)))
				return -EFAULT;
		}
		return 0;

	case CAPI_GET_SERIAL:
		{
			if (copy_from_user(&data.contr, argp,
					   sizeof(data.contr)))
				return -EFAULT;
			cdev->errcode = capi20_get_serial (data.contr, data.serial);
			if (cdev->errcode)
				return -EIO;
			if (copy_to_user(argp, data.serial,
					 sizeof(data.serial)))
				return -EFAULT;
		}
		return 0;
	case CAPI_GET_PROFILE:
		{
			if (copy_from_user(&data.contr, argp,
					   sizeof(data.contr)))
				return -EFAULT;

			if (data.contr == 0) {
				cdev->errcode = capi20_get_profile(data.contr, &data.profile);
				if (cdev->errcode)
					return -EIO;

				retval = copy_to_user(argp,
				      &data.profile.ncontroller,
				       sizeof(data.profile.ncontroller));

			} else {
				cdev->errcode = capi20_get_profile(data.contr, &data.profile);
				if (cdev->errcode)
					return -EIO;

				retval = copy_to_user(argp, &data.profile,
						   sizeof(data.profile));
			}
			if (retval)
				return -EFAULT;
		}
		return 0;

	case CAPI_GET_MANUFACTURER:
		{
			if (copy_from_user(&data.contr, argp,
					   sizeof(data.contr)))
				return -EFAULT;
			cdev->errcode = capi20_get_manufacturer(data.contr, data.manufacturer);
			if (cdev->errcode)
				return -EIO;

			if (copy_to_user(argp, data.manufacturer,
					 sizeof(data.manufacturer)))
				return -EFAULT;

		}
		return 0;
	case CAPI_GET_ERRCODE:
		data.errcode = cdev->errcode;
		cdev->errcode = CAPI_NOERROR;
		if (arg) {
			if (copy_to_user(argp, &data.errcode,
					 sizeof(data.errcode)))
				return -EFAULT;
		}
		return data.errcode;

	case CAPI_INSTALLED:
		if (capi20_isinstalled() == CAPI_NOERROR)
			return 0;
		return -ENXIO;

	case CAPI_MANUFACTURER_CMD:
		{
			struct capi_manufacturer_cmd mcmd;
			if (!capable(CAP_SYS_ADMIN))
				return -EPERM;
			if (copy_from_user(&mcmd, argp, sizeof(mcmd)))
				return -EFAULT;
			return capi20_manufacturer(mcmd.cmd, mcmd.data);
		}
		return 0;

	case CAPI_SET_FLAGS:
918 919 920 921 922
	case CAPI_CLR_FLAGS: {
		unsigned userflags;

		if (copy_from_user(&userflags, argp, sizeof(userflags)))
			return -EFAULT;
L
Linus Torvalds 已提交
923

924 925 926 927 928 929 930 931
		mutex_lock(&cdev->lock);
		if (cmd == CAPI_SET_FLAGS)
			cdev->userflags |= userflags;
		else
			cdev->userflags &= ~userflags;
		mutex_unlock(&cdev->lock);
		return 0;
	}
L
Linus Torvalds 已提交
932 933 934 935 936 937
	case CAPI_GET_FLAGS:
		if (copy_to_user(argp, &cdev->userflags,
				 sizeof(cdev->userflags)))
			return -EFAULT;
		return 0;

938 939 940 941
	case CAPI_NCCI_OPENCOUNT: {
		struct capincci *nccip;
		unsigned ncci;
		int count = 0;
L
Linus Torvalds 已提交
942

943 944 945 946 947 948 949 950 951 952
		if (copy_from_user(&ncci, argp, sizeof(ncci)))
			return -EFAULT;

		mutex_lock(&cdev->lock);
		nccip = capincci_find(cdev, (u32)ncci);
		if (nccip)
			count = capincci_minor_opencount(nccip);
		mutex_unlock(&cdev->lock);
		return count;
	}
L
Linus Torvalds 已提交
953 954

#ifdef CONFIG_ISDN_CAPI_MIDDLEWARE
955 956 957 958 959 960 961 962 963 964 965 966 967 968 969
	case CAPI_NCCI_GETUNIT: {
		struct capincci *nccip;
		struct capiminor *mp;
		unsigned ncci;
		int unit = -ESRCH;

		if (copy_from_user(&ncci, argp, sizeof(ncci)))
			return -EFAULT;

		mutex_lock(&cdev->lock);
		nccip = capincci_find(cdev, (u32)ncci);
		if (nccip) {
			mp = nccip->minorp;
			if (mp)
				unit = mp->minor;
L
Linus Torvalds 已提交
970
		}
971 972 973
		mutex_unlock(&cdev->lock);
		return unit;
	}
L
Linus Torvalds 已提交
974
#endif /* CONFIG_ISDN_CAPI_MIDDLEWARE */
975 976 977

	default:
		return -EINVAL;
L
Linus Torvalds 已提交
978 979 980
	}
}

J
Jan Kiszka 已提交
981
static int capi_open(struct inode *inode, struct file *file)
L
Linus Torvalds 已提交
982
{
J
Jan Kiszka 已提交
983 984 985 986 987 988
	struct capidev *cdev;

	cdev = kzalloc(sizeof(*cdev), GFP_KERNEL);
	if (!cdev)
		return -ENOMEM;

989
	mutex_init(&cdev->lock);
J
Jan Kiszka 已提交
990 991
	skb_queue_head_init(&cdev->recvqueue);
	init_waitqueue_head(&cdev->recvwait);
992
	INIT_LIST_HEAD(&cdev->nccis);
J
Jan Kiszka 已提交
993 994 995 996 997 998 999
	file->private_data = cdev;

	mutex_lock(&capidev_list_lock);
	list_add_tail(&cdev->list, &capidev_list);
	mutex_unlock(&capidev_list_lock);

	return nonseekable_open(inode, file);
L
Linus Torvalds 已提交
1000 1001
}

J
Jan Kiszka 已提交
1002
static int capi_release(struct inode *inode, struct file *file)
L
Linus Torvalds 已提交
1003
{
J
Jan Kiszka 已提交
1004
	struct capidev *cdev = file->private_data;
L
Linus Torvalds 已提交
1005

J
Jan Kiszka 已提交
1006 1007 1008 1009
	mutex_lock(&capidev_list_lock);
	list_del(&cdev->list);
	mutex_unlock(&capidev_list_lock);

1010
	if (cdev->ap.applid)
J
Jan Kiszka 已提交
1011 1012 1013 1014 1015
		capi20_release(&cdev->ap);
	skb_queue_purge(&cdev->recvqueue);
	capincci_free(cdev, 0xffffffff);

	kfree(cdev);
L
Linus Torvalds 已提交
1016 1017 1018
	return 0;
}

1019
static const struct file_operations capi_fops =
L
Linus Torvalds 已提交
1020 1021 1022 1023 1024 1025 1026 1027 1028 1029 1030 1031 1032 1033
{
	.owner		= THIS_MODULE,
	.llseek		= no_llseek,
	.read		= capi_read,
	.write		= capi_write,
	.poll		= capi_poll,
	.ioctl		= capi_ioctl,
	.open		= capi_open,
	.release	= capi_release,
};

#ifdef CONFIG_ISDN_CAPI_MIDDLEWARE
/* -------- tty_operations for capincci ----------------------------- */

1034 1035
static int
capinc_tty_install(struct tty_driver *driver, struct tty_struct *tty)
L
Linus Torvalds 已提交
1036
{
1037 1038 1039 1040 1041 1042 1043 1044 1045 1046 1047 1048 1049
	int idx = tty->index;
	struct capiminor *mp = capiminor_get(idx);
	int ret = tty_init_termios(tty);

	if (ret == 0) {
		tty_driver_kref_get(driver);
		tty->count++;
		tty->driver_data = mp;
		driver->ttys[idx] = tty;
	} else
		capiminor_put(mp);
	return ret;
}
L
Linus Torvalds 已提交
1050

1051 1052 1053 1054 1055 1056
static void capinc_tty_cleanup(struct tty_struct *tty)
{
	struct capiminor *mp = tty->driver_data;
	tty->driver_data = NULL;
	capiminor_put(mp);
}
L
Linus Torvalds 已提交
1057

1058
static int capinc_tty_open(struct tty_struct *tty, struct file *filp)
1059 1060 1061
{
	struct capiminor *mp = tty->driver_data;
	unsigned long flags;
1062 1063 1064 1065 1066
	int err;

	err = tty_port_open(&mp->port, tty, filp);
	if (err)
		return err;
L
Linus Torvalds 已提交
1067

1068
	spin_lock_irqsave(&workaround_lock, flags);
L
Linus Torvalds 已提交
1069 1070 1071 1072 1073
	atomic_inc(&mp->ttyopencount);
#ifdef _DEBUG_REFCOUNT
	printk(KERN_DEBUG "capinc_tty_open ocount=%d\n", atomic_read(&mp->ttyopencount));
#endif
	handle_minor_recv(mp);
1074
	spin_unlock_irqrestore(&workaround_lock, flags);
L
Linus Torvalds 已提交
1075 1076 1077
	return 0;
}

1078
static void capinc_tty_close(struct tty_struct *tty, struct file *filp)
L
Linus Torvalds 已提交
1079
{
1080
	struct capiminor *mp = tty->driver_data;
L
Linus Torvalds 已提交
1081 1082 1083 1084 1085 1086 1087 1088 1089

		if (atomic_dec_and_test(&mp->ttyopencount)) {
#ifdef _DEBUG_REFCOUNT
			printk(KERN_DEBUG "capinc_tty_close lastclose\n");
#endif
		}
#ifdef _DEBUG_REFCOUNT
		printk(KERN_DEBUG "capinc_tty_close ocount=%d\n", atomic_read(&mp->ttyopencount));
#endif
J
Jan Kiszka 已提交
1090

L
Linus Torvalds 已提交
1091 1092 1093
#ifdef _DEBUG_REFCOUNT
	printk(KERN_DEBUG "capinc_tty_close\n");
#endif
1094
	tty_port_close(&mp->port, tty, filp);
L
Linus Torvalds 已提交
1095 1096 1097 1098 1099
}

static int capinc_tty_write(struct tty_struct * tty,
			    const unsigned char *buf, int count)
{
1100
	struct capiminor *mp = tty->driver_data;
L
Linus Torvalds 已提交
1101
	struct sk_buff *skb;
1102
	unsigned long flags;
L
Linus Torvalds 已提交
1103 1104 1105 1106 1107

#ifdef _DEBUG_TTYFUNCS
	printk(KERN_DEBUG "capinc_tty_write(count=%d)\n", count);
#endif

1108
	if (!mp->nccip) {
L
Linus Torvalds 已提交
1109 1110 1111 1112 1113 1114
#ifdef _DEBUG_TTYFUNCS
		printk(KERN_DEBUG "capinc_tty_write: mp or mp->ncci NULL\n");
#endif
		return 0;
	}

1115
	spin_lock_irqsave(&workaround_lock, flags);
L
Linus Torvalds 已提交
1116 1117 1118 1119 1120 1121 1122 1123 1124 1125
	skb = mp->ttyskb;
	if (skb) {
		mp->ttyskb = NULL;
		skb_queue_tail(&mp->outqueue, skb);
		mp->outbytes += skb->len;
	}

	skb = alloc_skb(CAPI_DATA_B3_REQ_LEN+count, GFP_ATOMIC);
	if (!skb) {
		printk(KERN_ERR "capinc_tty_write: alloc_skb failed\n");
1126
		spin_unlock_irqrestore(&workaround_lock, flags);
L
Linus Torvalds 已提交
1127 1128 1129 1130 1131 1132 1133 1134 1135 1136
		return -ENOMEM;
	}

	skb_reserve(skb, CAPI_DATA_B3_REQ_LEN);
	memcpy(skb_put(skb, count), buf, count);

	skb_queue_tail(&mp->outqueue, skb);
	mp->outbytes += skb->len;
	(void)handle_minor_send(mp);
	(void)handle_minor_recv(mp);
1137
	spin_unlock_irqrestore(&workaround_lock, flags);
L
Linus Torvalds 已提交
1138 1139 1140
	return count;
}

A
Alan Cox 已提交
1141
static int capinc_tty_put_char(struct tty_struct *tty, unsigned char ch)
L
Linus Torvalds 已提交
1142
{
1143
	struct capiminor *mp = tty->driver_data;
L
Linus Torvalds 已提交
1144
	struct sk_buff *skb;
1145
	unsigned long flags;
A
Alan Cox 已提交
1146
	int ret = 1;
L
Linus Torvalds 已提交
1147 1148 1149 1150 1151

#ifdef _DEBUG_TTYFUNCS
	printk(KERN_DEBUG "capinc_put_char(%u)\n", ch);
#endif

1152
	if (!mp->nccip) {
L
Linus Torvalds 已提交
1153 1154 1155
#ifdef _DEBUG_TTYFUNCS
		printk(KERN_DEBUG "capinc_tty_put_char: mp or mp->ncci NULL\n");
#endif
A
Alan Cox 已提交
1156
		return 0;
L
Linus Torvalds 已提交
1157 1158
	}

1159
	spin_lock_irqsave(&workaround_lock, flags);
L
Linus Torvalds 已提交
1160 1161 1162 1163
	skb = mp->ttyskb;
	if (skb) {
		if (skb_tailroom(skb) > 0) {
			*(skb_put(skb, 1)) = ch;
1164
			spin_unlock_irqrestore(&workaround_lock, flags);
A
Alan Cox 已提交
1165
			return 1;
L
Linus Torvalds 已提交
1166 1167 1168 1169 1170 1171 1172 1173 1174 1175 1176 1177 1178
		}
		mp->ttyskb = NULL;
		skb_queue_tail(&mp->outqueue, skb);
		mp->outbytes += skb->len;
		(void)handle_minor_send(mp);
	}
	skb = alloc_skb(CAPI_DATA_B3_REQ_LEN+CAPI_MAX_BLKSIZE, GFP_ATOMIC);
	if (skb) {
		skb_reserve(skb, CAPI_DATA_B3_REQ_LEN);
		*(skb_put(skb, 1)) = ch;
		mp->ttyskb = skb;
	} else {
		printk(KERN_ERR "capinc_put_char: char %u lost\n", ch);
A
Alan Cox 已提交
1179
		ret = 0;
L
Linus Torvalds 已提交
1180
	}
1181
	spin_unlock_irqrestore(&workaround_lock, flags);
A
Alan Cox 已提交
1182
	return ret;
L
Linus Torvalds 已提交
1183 1184 1185 1186
}

static void capinc_tty_flush_chars(struct tty_struct *tty)
{
1187
	struct capiminor *mp = tty->driver_data;
L
Linus Torvalds 已提交
1188
	struct sk_buff *skb;
1189
	unsigned long flags;
L
Linus Torvalds 已提交
1190 1191 1192 1193 1194

#ifdef _DEBUG_TTYFUNCS
	printk(KERN_DEBUG "capinc_tty_flush_chars\n");
#endif

1195
	if (!mp->nccip) {
L
Linus Torvalds 已提交
1196 1197 1198 1199 1200 1201
#ifdef _DEBUG_TTYFUNCS
		printk(KERN_DEBUG "capinc_tty_flush_chars: mp or mp->ncci NULL\n");
#endif
		return;
	}

1202
	spin_lock_irqsave(&workaround_lock, flags);
L
Linus Torvalds 已提交
1203 1204 1205 1206 1207 1208 1209 1210
	skb = mp->ttyskb;
	if (skb) {
		mp->ttyskb = NULL;
		skb_queue_tail(&mp->outqueue, skb);
		mp->outbytes += skb->len;
		(void)handle_minor_send(mp);
	}
	(void)handle_minor_recv(mp);
1211
	spin_unlock_irqrestore(&workaround_lock, flags);
L
Linus Torvalds 已提交
1212 1213 1214 1215
}

static int capinc_tty_write_room(struct tty_struct *tty)
{
1216
	struct capiminor *mp = tty->driver_data;
L
Linus Torvalds 已提交
1217
	int room;
1218 1219

	if (!mp->nccip) {
L
Linus Torvalds 已提交
1220 1221 1222 1223 1224 1225 1226 1227 1228 1229 1230 1231 1232
#ifdef _DEBUG_TTYFUNCS
		printk(KERN_DEBUG "capinc_tty_write_room: mp or mp->ncci NULL\n");
#endif
		return 0;
	}
	room = CAPINC_MAX_SENDQUEUE-skb_queue_len(&mp->outqueue);
	room *= CAPI_MAX_BLKSIZE;
#ifdef _DEBUG_TTYFUNCS
	printk(KERN_DEBUG "capinc_tty_write_room = %d\n", room);
#endif
	return room;
}

A
Adrian Bunk 已提交
1233
static int capinc_tty_chars_in_buffer(struct tty_struct *tty)
L
Linus Torvalds 已提交
1234
{
1235 1236 1237
	struct capiminor *mp = tty->driver_data;

	if (!mp->nccip) {
L
Linus Torvalds 已提交
1238 1239 1240 1241 1242 1243 1244 1245 1246 1247 1248 1249 1250 1251 1252 1253 1254 1255 1256 1257
#ifdef _DEBUG_TTYFUNCS
		printk(KERN_DEBUG "capinc_tty_chars_in_buffer: mp or mp->ncci NULL\n");
#endif
		return 0;
	}
#ifdef _DEBUG_TTYFUNCS
	printk(KERN_DEBUG "capinc_tty_chars_in_buffer = %d nack=%d sq=%d rq=%d\n",
			mp->outbytes, mp->nack,
			skb_queue_len(&mp->outqueue),
			skb_queue_len(&mp->inqueue));
#endif
	return mp->outbytes;
}

static int capinc_tty_ioctl(struct tty_struct *tty, struct file * file,
		    unsigned int cmd, unsigned long arg)
{
	int error = 0;
	switch (cmd) {
	default:
1258
		error = n_tty_ioctl_helper(tty, file, cmd, arg);
L
Linus Torvalds 已提交
1259 1260 1261 1262 1263
		break;
	}
	return error;
}

A
Alan Cox 已提交
1264
static void capinc_tty_set_termios(struct tty_struct *tty, struct ktermios * old)
L
Linus Torvalds 已提交
1265 1266 1267 1268 1269 1270
{
#ifdef _DEBUG_TTYFUNCS
	printk(KERN_DEBUG "capinc_tty_set_termios\n");
#endif
}

1271
static void capinc_tty_throttle(struct tty_struct *tty)
L
Linus Torvalds 已提交
1272
{
1273
	struct capiminor *mp = tty->driver_data;
L
Linus Torvalds 已提交
1274 1275 1276
#ifdef _DEBUG_TTYFUNCS
	printk(KERN_DEBUG "capinc_tty_throttle\n");
#endif
1277
	mp->ttyinstop = 1;
L
Linus Torvalds 已提交
1278 1279
}

1280
static void capinc_tty_unthrottle(struct tty_struct *tty)
L
Linus Torvalds 已提交
1281
{
1282
	struct capiminor *mp = tty->driver_data;
1283
	unsigned long flags;
1284

L
Linus Torvalds 已提交
1285 1286 1287
#ifdef _DEBUG_TTYFUNCS
	printk(KERN_DEBUG "capinc_tty_unthrottle\n");
#endif
1288 1289 1290 1291
	spin_lock_irqsave(&workaround_lock, flags);
	mp->ttyinstop = 0;
	handle_minor_recv(mp);
	spin_unlock_irqrestore(&workaround_lock, flags);
L
Linus Torvalds 已提交
1292 1293 1294 1295
}

static void capinc_tty_stop(struct tty_struct *tty)
{
1296 1297
	struct capiminor *mp = tty->driver_data;

L
Linus Torvalds 已提交
1298 1299 1300
#ifdef _DEBUG_TTYFUNCS
	printk(KERN_DEBUG "capinc_tty_stop\n");
#endif
1301
	mp->ttyoutstop = 1;
L
Linus Torvalds 已提交
1302 1303 1304 1305
}

static void capinc_tty_start(struct tty_struct *tty)
{
1306
	struct capiminor *mp = tty->driver_data;
1307
	unsigned long flags;
1308

L
Linus Torvalds 已提交
1309 1310 1311
#ifdef _DEBUG_TTYFUNCS
	printk(KERN_DEBUG "capinc_tty_start\n");
#endif
1312 1313 1314 1315
	spin_lock_irqsave(&workaround_lock, flags);
	mp->ttyoutstop = 0;
	(void)handle_minor_send(mp);
	spin_unlock_irqrestore(&workaround_lock, flags);
L
Linus Torvalds 已提交
1316 1317 1318 1319
}

static void capinc_tty_hangup(struct tty_struct *tty)
{
1320 1321
	struct capiminor *mp = tty->driver_data;

L
Linus Torvalds 已提交
1322 1323 1324
#ifdef _DEBUG_TTYFUNCS
	printk(KERN_DEBUG "capinc_tty_hangup\n");
#endif
1325
	tty_port_hangup(&mp->port);
L
Linus Torvalds 已提交
1326 1327
}

A
Alan Cox 已提交
1328
static int capinc_tty_break_ctl(struct tty_struct *tty, int state)
L
Linus Torvalds 已提交
1329 1330 1331 1332
{
#ifdef _DEBUG_TTYFUNCS
	printk(KERN_DEBUG "capinc_tty_break_ctl(%d)\n", state);
#endif
A
Alan Cox 已提交
1333
	return 0;
L
Linus Torvalds 已提交
1334 1335 1336 1337 1338 1339 1340 1341 1342 1343 1344 1345 1346 1347 1348 1349 1350 1351 1352 1353 1354 1355 1356
}

static void capinc_tty_flush_buffer(struct tty_struct *tty)
{
#ifdef _DEBUG_TTYFUNCS
	printk(KERN_DEBUG "capinc_tty_flush_buffer\n");
#endif
}

static void capinc_tty_set_ldisc(struct tty_struct *tty)
{
#ifdef _DEBUG_TTYFUNCS
	printk(KERN_DEBUG "capinc_tty_set_ldisc\n");
#endif
}

static void capinc_tty_send_xchar(struct tty_struct *tty, char ch)
{
#ifdef _DEBUG_TTYFUNCS
	printk(KERN_DEBUG "capinc_tty_send_xchar(%d)\n", ch);
#endif
}

J
Jeff Dike 已提交
1357
static const struct tty_operations capinc_ops = {
L
Linus Torvalds 已提交
1358 1359 1360 1361 1362 1363 1364 1365 1366 1367 1368 1369 1370 1371 1372 1373 1374 1375
	.open = capinc_tty_open,
	.close = capinc_tty_close,
	.write = capinc_tty_write,
	.put_char = capinc_tty_put_char,
	.flush_chars = capinc_tty_flush_chars,
	.write_room = capinc_tty_write_room,
	.chars_in_buffer = capinc_tty_chars_in_buffer,
	.ioctl = capinc_tty_ioctl,
	.set_termios = capinc_tty_set_termios,
	.throttle = capinc_tty_throttle,
	.unthrottle = capinc_tty_unthrottle,
	.stop = capinc_tty_stop,
	.start = capinc_tty_start,
	.hangup = capinc_tty_hangup,
	.break_ctl = capinc_tty_break_ctl,
	.flush_buffer = capinc_tty_flush_buffer,
	.set_ldisc = capinc_tty_set_ldisc,
	.send_xchar = capinc_tty_send_xchar,
1376 1377
	.install = capinc_tty_install,
	.cleanup = capinc_tty_cleanup,
L
Linus Torvalds 已提交
1378 1379
};

J
Jan Kiszka 已提交
1380
static int __init capinc_tty_init(void)
L
Linus Torvalds 已提交
1381 1382
{
	struct tty_driver *drv;
J
Jan Kiszka 已提交
1383 1384
	int err;

L
Linus Torvalds 已提交
1385 1386 1387 1388 1389
	if (capi_ttyminors > CAPINC_MAX_PORTS)
		capi_ttyminors = CAPINC_MAX_PORTS;
	if (capi_ttyminors <= 0)
		capi_ttyminors = CAPINC_NR_PORTS;

1390 1391 1392
	capiminors = kzalloc(sizeof(struct capi_minor *) * capi_ttyminors,
			     GFP_KERNEL);
	if (!capiminors)
L
Linus Torvalds 已提交
1393 1394
		return -ENOMEM;

1395 1396 1397 1398 1399
	drv = alloc_tty_driver(capi_ttyminors);
	if (!drv) {
		kfree(capiminors);
		return -ENOMEM;
	}
L
Linus Torvalds 已提交
1400 1401 1402
	drv->owner = THIS_MODULE;
	drv->driver_name = "capi_nc";
	drv->name = "capi";
1403
	drv->major = 0;
L
Linus Torvalds 已提交
1404 1405 1406 1407 1408 1409 1410 1411
	drv->minor_start = 0;
	drv->type = TTY_DRIVER_TYPE_SERIAL;
	drv->subtype = SERIAL_TYPE_NORMAL;
	drv->init_termios = tty_std_termios;
	drv->init_termios.c_iflag = ICRNL;
	drv->init_termios.c_oflag = OPOST | ONLCR;
	drv->init_termios.c_cflag = B9600 | CS8 | CREAD | HUPCL | CLOCAL;
	drv->init_termios.c_lflag = 0;
1412 1413 1414
	drv->flags =
		TTY_DRIVER_REAL_RAW | TTY_DRIVER_RESET_TERMIOS |
		TTY_DRIVER_DYNAMIC_DEV;
L
Linus Torvalds 已提交
1415
	tty_set_operations(drv, &capinc_ops);
J
Jan Kiszka 已提交
1416 1417 1418

	err = tty_register_driver(drv);
	if (err) {
L
Linus Torvalds 已提交
1419
		put_tty_driver(drv);
1420
		kfree(capiminors);
L
Linus Torvalds 已提交
1421
		printk(KERN_ERR "Couldn't register capi_nc driver\n");
J
Jan Kiszka 已提交
1422
		return err;
L
Linus Torvalds 已提交
1423 1424 1425 1426 1427
	}
	capinc_tty_driver = drv;
	return 0;
}

J
Jan Kiszka 已提交
1428
static void __exit capinc_tty_exit(void)
L
Linus Torvalds 已提交
1429
{
J
Jan Kiszka 已提交
1430 1431
	tty_unregister_driver(capinc_tty_driver);
	put_tty_driver(capinc_tty_driver);
1432
	kfree(capiminors);
L
Linus Torvalds 已提交
1433 1434
}

1435 1436 1437 1438 1439 1440 1441 1442 1443 1444
#else /* !CONFIG_ISDN_CAPI_MIDDLEWARE */

static inline int capinc_tty_init(void)
{
	return 0;
}

static inline void capinc_tty_exit(void) { }

#endif /* !CONFIG_ISDN_CAPI_MIDDLEWARE */
L
Linus Torvalds 已提交
1445 1446 1447 1448 1449 1450 1451

/* -------- /proc functions ----------------------------------------- */

/*
 * /proc/capi/capi20:
 *  minor applid nrecvctlpkt nrecvdatapkt nsendctlpkt nsenddatapkt
 */
1452
static int capi20_proc_show(struct seq_file *m, void *v)
L
Linus Torvalds 已提交
1453 1454 1455 1456
{
        struct capidev *cdev;
	struct list_head *l;

1457
	mutex_lock(&capidev_list_lock);
L
Linus Torvalds 已提交
1458 1459
	list_for_each(l, &capidev_list) {
		cdev = list_entry(l, struct capidev, list);
1460
		seq_printf(m, "0 %d %lu %lu %lu %lu\n",
L
Linus Torvalds 已提交
1461 1462 1463 1464 1465 1466
			cdev->ap.applid,
			cdev->ap.nrecvctlpkt,
			cdev->ap.nrecvdatapkt,
			cdev->ap.nsentctlpkt,
			cdev->ap.nsentdatapkt);
	}
1467
	mutex_unlock(&capidev_list_lock);
1468
	return 0;
L
Linus Torvalds 已提交
1469 1470
}

1471 1472 1473 1474 1475 1476 1477 1478 1479 1480 1481 1482 1483
static int capi20_proc_open(struct inode *inode, struct file *file)
{
	return single_open(file, capi20_proc_show, NULL);
}

static const struct file_operations capi20_proc_fops = {
	.owner		= THIS_MODULE,
	.open		= capi20_proc_open,
	.read		= seq_read,
	.llseek		= seq_lseek,
	.release	= single_release,
};

L
Linus Torvalds 已提交
1484 1485 1486 1487
/*
 * /proc/capi/capi20ncci:
 *  applid ncci
 */
1488
static int capi20ncci_proc_show(struct seq_file *m, void *v)
L
Linus Torvalds 已提交
1489
{
1490 1491
	struct capidev *cdev;
	struct capincci *np;
L
Linus Torvalds 已提交
1492

1493
	mutex_lock(&capidev_list_lock);
1494
	list_for_each_entry(cdev, &capidev_list, list) {
1495
		mutex_lock(&cdev->lock);
1496 1497
		list_for_each_entry(np, &cdev->nccis, list)
			seq_printf(m, "%d 0x%x\n", cdev->ap.applid, np->ncci);
1498
		mutex_unlock(&cdev->lock);
L
Linus Torvalds 已提交
1499
	}
1500
	mutex_unlock(&capidev_list_lock);
1501
	return 0;
L
Linus Torvalds 已提交
1502 1503
}

1504 1505 1506 1507 1508 1509 1510 1511 1512 1513 1514
static int capi20ncci_proc_open(struct inode *inode, struct file *file)
{
	return single_open(file, capi20ncci_proc_show, NULL);
}

static const struct file_operations capi20ncci_proc_fops = {
	.owner		= THIS_MODULE,
	.open		= capi20ncci_proc_open,
	.read		= seq_read,
	.llseek		= seq_lseek,
	.release	= single_release,
L
Linus Torvalds 已提交
1515 1516 1517 1518
};

static void __init proc_init(void)
{
1519 1520
	proc_create("capi/capi20", 0, NULL, &capi20_proc_fops);
	proc_create("capi/capi20ncci", 0, NULL, &capi20ncci_proc_fops);
L
Linus Torvalds 已提交
1521 1522 1523 1524
}

static void __exit proc_exit(void)
{
1525 1526
	remove_proc_entry("capi/capi20", NULL);
	remove_proc_entry("capi/capi20ncci", NULL);
L
Linus Torvalds 已提交
1527 1528 1529 1530 1531 1532 1533
}

/* -------- init function and module interface ---------------------- */


static int __init capi_init(void)
{
1534
	const char *compileinfo;
1535
	int major_ret;
L
Linus Torvalds 已提交
1536

1537 1538
	major_ret = register_chrdev(capi_major, "capi20", &capi_fops);
	if (major_ret < 0) {
L
Linus Torvalds 已提交
1539
		printk(KERN_ERR "capi20: unable to get major %d\n", capi_major);
1540
		return major_ret;
L
Linus Torvalds 已提交
1541
	}
1542
	capi_class = class_create(THIS_MODULE, "capi");
L
Linus Torvalds 已提交
1543 1544 1545 1546 1547
	if (IS_ERR(capi_class)) {
		unregister_chrdev(capi_major, "capi20");
		return PTR_ERR(capi_class);
	}

1548
	device_create(capi_class, NULL, MKDEV(capi_major, 0), NULL, "capi");
L
Linus Torvalds 已提交
1549 1550

	if (capinc_tty_init() < 0) {
1551
		device_destroy(capi_class, MKDEV(capi_major, 0));
1552
		class_destroy(capi_class);
L
Linus Torvalds 已提交
1553 1554 1555 1556 1557 1558 1559 1560
		unregister_chrdev(capi_major, "capi20");
		return -ENOMEM;
	}

	proc_init();

#if defined(CONFIG_ISDN_CAPI_CAPIFS) || defined(CONFIG_ISDN_CAPI_CAPIFS_MODULE)
        compileinfo = " (middleware+capifs)";
1561
#elif defined(CONFIG_ISDN_CAPI_MIDDLEWARE)
L
Linus Torvalds 已提交
1562 1563 1564 1565
        compileinfo = " (no capifs)";
#else
        compileinfo = " (no middleware)";
#endif
1566 1567
	printk(KERN_NOTICE "CAPI 2.0 started up with major %d%s\n",
	       capi_major, compileinfo);
L
Linus Torvalds 已提交
1568 1569 1570 1571 1572 1573 1574 1575

	return 0;
}

static void __exit capi_exit(void)
{
	proc_exit();

1576
	device_destroy(capi_class, MKDEV(capi_major, 0));
1577
	class_destroy(capi_class);
L
Linus Torvalds 已提交
1578 1579 1580 1581 1582 1583 1584
	unregister_chrdev(capi_major, "capi20");

	capinc_tty_exit();
}

module_init(capi_init);
module_exit(capi_exit);