capi.c 36.7 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 1100 1101
}

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

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

	if (!mp || !mp->nccip) {
#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 1144
{
	struct capiminor *mp = (struct capiminor *)tty->driver_data;
	struct sk_buff *skb;
1145
	unsigned long flags;
A
Alan Cox 已提交
1146
	int ret = 1;
L
Linus Torvalds 已提交
1147 1148 1149 1150 1151 1152 1153 1154 1155

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

	if (!mp || !mp->nccip) {
#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 1187 1188
}

static void capinc_tty_flush_chars(struct tty_struct *tty)
{
	struct capiminor *mp = (struct capiminor *)tty->driver_data;
	struct sk_buff *skb;
1189
	unsigned long flags;
L
Linus Torvalds 已提交
1190 1191 1192 1193 1194 1195 1196 1197 1198 1199 1200 1201

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

	if (!mp || !mp->nccip) {
#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 1216 1217 1218 1219 1220 1221 1222 1223 1224 1225 1226 1227 1228 1229 1230 1231
}

static int capinc_tty_write_room(struct tty_struct *tty)
{
	struct capiminor *mp = (struct capiminor *)tty->driver_data;
	int room;
	if (!mp || !mp->nccip) {
#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 已提交
1232
static int capinc_tty_chars_in_buffer(struct tty_struct *tty)
L
Linus Torvalds 已提交
1233 1234 1235 1236 1237 1238 1239 1240 1241 1242 1243 1244 1245 1246 1247 1248 1249 1250 1251 1252 1253 1254 1255
{
	struct capiminor *mp = (struct capiminor *)tty->driver_data;
	if (!mp || !mp->nccip) {
#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:
1256
		error = n_tty_ioctl_helper(tty, file, cmd, arg);
L
Linus Torvalds 已提交
1257 1258 1259 1260 1261
		break;
	}
	return error;
}

A
Alan Cox 已提交
1262
static void capinc_tty_set_termios(struct tty_struct *tty, struct ktermios * old)
L
Linus Torvalds 已提交
1263 1264 1265 1266 1267 1268 1269 1270 1271 1272 1273 1274 1275 1276 1277 1278 1279 1280 1281
{
#ifdef _DEBUG_TTYFUNCS
	printk(KERN_DEBUG "capinc_tty_set_termios\n");
#endif
}

static void capinc_tty_throttle(struct tty_struct * tty)
{
	struct capiminor *mp = (struct capiminor *)tty->driver_data;
#ifdef _DEBUG_TTYFUNCS
	printk(KERN_DEBUG "capinc_tty_throttle\n");
#endif
	if (mp)
		mp->ttyinstop = 1;
}

static void capinc_tty_unthrottle(struct tty_struct * tty)
{
	struct capiminor *mp = (struct capiminor *)tty->driver_data;
1282
	unsigned long flags;
L
Linus Torvalds 已提交
1283 1284 1285 1286
#ifdef _DEBUG_TTYFUNCS
	printk(KERN_DEBUG "capinc_tty_unthrottle\n");
#endif
	if (mp) {
1287
		spin_lock_irqsave(&workaround_lock, flags);
L
Linus Torvalds 已提交
1288 1289
		mp->ttyinstop = 0;
		handle_minor_recv(mp);
1290
		spin_unlock_irqrestore(&workaround_lock, flags);
L
Linus Torvalds 已提交
1291 1292 1293 1294 1295 1296 1297 1298 1299 1300 1301 1302 1303 1304 1305 1306 1307
	}
}

static void capinc_tty_stop(struct tty_struct *tty)
{
	struct capiminor *mp = (struct capiminor *)tty->driver_data;
#ifdef _DEBUG_TTYFUNCS
	printk(KERN_DEBUG "capinc_tty_stop\n");
#endif
	if (mp) {
		mp->ttyoutstop = 1;
	}
}

static void capinc_tty_start(struct tty_struct *tty)
{
	struct capiminor *mp = (struct capiminor *)tty->driver_data;
1308
	unsigned long flags;
L
Linus Torvalds 已提交
1309 1310 1311 1312
#ifdef _DEBUG_TTYFUNCS
	printk(KERN_DEBUG "capinc_tty_start\n");
#endif
	if (mp) {
1313
		spin_lock_irqsave(&workaround_lock, flags);
L
Linus Torvalds 已提交
1314 1315
		mp->ttyoutstop = 0;
		(void)handle_minor_send(mp);
1316
		spin_unlock_irqrestore(&workaround_lock, flags);
L
Linus Torvalds 已提交
1317 1318 1319 1320 1321
	}
}

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

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

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

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 已提交
1359
static const struct tty_operations capinc_ops = {
L
Linus Torvalds 已提交
1360 1361 1362 1363 1364 1365 1366 1367 1368 1369 1370 1371 1372 1373 1374 1375 1376 1377
	.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,
1378 1379
	.install = capinc_tty_install,
	.cleanup = capinc_tty_cleanup,
L
Linus Torvalds 已提交
1380 1381
};

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

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

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

1397 1398 1399 1400 1401
	drv = alloc_tty_driver(capi_ttyminors);
	if (!drv) {
		kfree(capiminors);
		return -ENOMEM;
	}
L
Linus Torvalds 已提交
1402 1403 1404
	drv->owner = THIS_MODULE;
	drv->driver_name = "capi_nc";
	drv->name = "capi";
1405
	drv->major = 0;
L
Linus Torvalds 已提交
1406 1407 1408 1409 1410 1411 1412 1413
	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;
1414 1415 1416
	drv->flags =
		TTY_DRIVER_REAL_RAW | TTY_DRIVER_RESET_TERMIOS |
		TTY_DRIVER_DYNAMIC_DEV;
L
Linus Torvalds 已提交
1417
	tty_set_operations(drv, &capinc_ops);
J
Jan Kiszka 已提交
1418 1419 1420

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

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

1437 1438 1439 1440 1441 1442 1443 1444 1445 1446
#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 已提交
1447 1448 1449 1450 1451 1452 1453

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

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

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

1473 1474 1475 1476 1477 1478 1479 1480 1481 1482 1483 1484 1485
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 已提交
1486 1487 1488 1489
/*
 * /proc/capi/capi20ncci:
 *  applid ncci
 */
1490
static int capi20ncci_proc_show(struct seq_file *m, void *v)
L
Linus Torvalds 已提交
1491
{
1492 1493
	struct capidev *cdev;
	struct capincci *np;
L
Linus Torvalds 已提交
1494

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

1506 1507 1508 1509 1510 1511 1512 1513 1514 1515 1516
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 已提交
1517 1518 1519 1520
};

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

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

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


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

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

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

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

	proc_init();

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

	return 0;
}

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

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

	capinc_tty_exit();
}

module_init(capi_init);
module_exit(capi_exit);