usb-gigaset.c 24.1 KB
Newer Older
1 2 3
/*
 * USB driver for Gigaset 307x directly or using M105 Data.
 *
4
 * Copyright (c) 2001 by Stefan Eilers
5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27
 *                   and Hansjoerg Lipp <hjlipp@web.de>.
 *
 * This driver was derived from the USB skeleton driver by
 * Greg Kroah-Hartman <greg@kroah.com>
 *
 * =====================================================================
 *	This program is free software; you can redistribute it and/or
 *	modify it under the terms of the GNU General Public License as
 *	published by the Free Software Foundation; either version 2 of
 *	the License, or (at your option) any later version.
 * =====================================================================
 */

#include "gigaset.h"

#include <linux/errno.h>
#include <linux/init.h>
#include <linux/slab.h>
#include <linux/usb.h>
#include <linux/module.h>
#include <linux/moduleparam.h>

/* Version Information */
28
#define DRIVER_AUTHOR "Hansjoerg Lipp <hjlipp@web.de>, Stefan Eilers"
29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52
#define DRIVER_DESC "USB Driver for Gigaset 307x using M105"

/* Module parameters */

static int startmode = SM_ISDN;
static int cidmode = 1;

module_param(startmode, int, S_IRUGO);
module_param(cidmode, int, S_IRUGO);
MODULE_PARM_DESC(startmode, "start in isdn4linux mode");
MODULE_PARM_DESC(cidmode, "Call-ID mode");

#define GIGASET_MINORS     1
#define GIGASET_MINOR      8
#define GIGASET_MODULENAME "usb_gigaset"
#define GIGASET_DEVNAME    "ttyGU"

#define IF_WRITEBUF 2000 //FIXME  // WAKEUP_CHARS: 256

/* Values for the Gigaset M105 Data */
#define USB_M105_VENDOR_ID	0x0681
#define USB_M105_PRODUCT_ID	0x0009

/* table of devices that work with this driver */
53
static const struct usb_device_id gigaset_table [] = {
54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107
	{ USB_DEVICE(USB_M105_VENDOR_ID, USB_M105_PRODUCT_ID) },
	{ }					/* Terminating entry */
};

MODULE_DEVICE_TABLE(usb, gigaset_table);

/*
 * Control requests (empty fields: 00)
 *
 *       RT|RQ|VALUE|INDEX|LEN  |DATA
 * In:
 *       C1 08             01
 *            Get flags (1 byte). Bits: 0=dtr,1=rts,3-7:?
 *       C1 0F             ll ll
 *            Get device information/status (llll: 0x200 and 0x40 seen).
 *            Real size: I only saw MIN(llll,0x64).
 *            Contents: seems to be always the same...
 *              offset 0x00: Length of this structure (0x64) (len: 1,2,3 bytes)
 *              offset 0x3c: String (16 bit chars): "MCCI USB Serial V2.0"
 *              rest:        ?
 * Out:
 *       41 11
 *            Initialize/reset device ?
 *       41 00 xx 00
 *            ? (xx=00 or 01; 01 on start, 00 on close)
 *       41 07 vv mm
 *            Set/clear flags vv=value, mm=mask (see RQ 08)
 *       41 12 xx
 *            Used before the following configuration requests are issued
 *            (with xx=0x0f). I've seen other values<0xf, though.
 *       41 01 xx xx
 *            Set baud rate. xxxx=ceil(0x384000/rate)=trunc(0x383fff/rate)+1.
 *       41 03 ps bb
 *            Set byte size and parity. p:  0x20=even,0x10=odd,0x00=no parity
 *                                     [    0x30: m, 0x40: s           ]
 *                                     [s:  0: 1 stop bit; 1: 1.5; 2: 2]
 *                                      bb: bits/byte (seen 7 and 8)
 *       41 13 -- -- -- -- 10 00 ww 00 00 00 xx 00 00 00 yy 00 00 00 zz 00 00 00
 *            ??
 *            Initialization: 01, 40, 00, 00
 *            Open device:    00  40, 00, 00
 *            yy and zz seem to be equal, either 0x00 or 0x0a
 *            (ww,xx) pairs seen: (00,00), (00,40), (01,40), (09,80), (19,80)
 *       41 19 -- -- -- -- 06 00 00 00 00 xx 11 13
 *            Used after every "configuration sequence" (RQ 12, RQs 01/03/13).
 *            xx is usually 0x00 but was 0x7e before starting data transfer
 *            in unimodem mode. So, this might be an array of characters that need
 *            special treatment ("commit all bufferd data"?), 11=^Q, 13=^S.
 *
 * Unimodem mode: use "modprobe ppp_async flag_time=0" as the device _needs_ two
 * flags per packet.
 */

static int gigaset_probe(struct usb_interface *interface,
108
			 const struct usb_device_id *id);
109 110 111 112 113 114 115
static void gigaset_disconnect(struct usb_interface *interface);

static struct gigaset_driver *driver = NULL;
static struct cardstate *cardstate = NULL;

/* usb specific object needed to register this driver with the usb subsystem */
static struct usb_driver gigaset_usb_driver = {
116 117 118 119
	.name =		GIGASET_MODULENAME,
	.probe =	gigaset_probe,
	.disconnect =	gigaset_disconnect,
	.id_table =	gigaset_table,
120 121 122
};

struct usb_cardstate {
123 124 125 126 127
	struct usb_device	*udev;		/* usb device pointer */
	struct usb_interface	*interface;	/* interface for this device */
	atomic_t		busy;		/* bulk output in progress */

	/* Output buffer */
128 129 130 131
	unsigned char		*bulk_out_buffer;
	int			bulk_out_size;
	__u8			bulk_out_endpointAddr;
	struct urb		*bulk_out_urb;
132 133

	/* Input buffer */
134 135 136
	int			rcvbuf_size;
	struct urb		*read_urb;
	__u8			int_in_endpointAddr;
137

138
	char			bchars[6];		/* for request 0x19 */
139 140 141 142 143 144 145 146 147 148
};

static inline unsigned tiocm_to_gigaset(unsigned state)
{
	return ((state & TIOCM_DTR) ? 1 : 0) | ((state & TIOCM_RTS) ? 2 : 0);
}

#ifdef CONFIG_GIGASET_UNDOCREQ
/* WARNING: EXPERIMENTAL! */
static int gigaset_set_modem_ctrl(struct cardstate *cs, unsigned old_state,
149
				  unsigned new_state)
150
{
151
	struct usb_device *udev = cs->hw.usb->udev;
152 153 154 155 156 157
	unsigned mask, val;
	int r;

	mask = tiocm_to_gigaset(old_state ^ new_state);
	val = tiocm_to_gigaset(new_state);

158
	gig_dbg(DEBUG_USBREQ, "set flags 0x%02x with mask 0x%02x", val, mask);
159
	// don't use this in an interrupt/BH
160 161 162
	r = usb_control_msg(udev, usb_sndctrlpipe(udev, 0), 7, 0x41,
			    (val & 0xff) | ((mask & 0xff) << 8), 0,
			    NULL, 0, 2000 /* timeout? */);
163 164 165 166 167 168 169 170
	if (r < 0)
		return r;
	//..
	return 0;
}

static int set_value(struct cardstate *cs, u8 req, u16 val)
{
171
	struct usb_device *udev = cs->hw.usb->udev;
172 173
	int r, r2;

174 175 176 177 178
	gig_dbg(DEBUG_USBREQ, "request %02x (%04x)",
		(unsigned)req, (unsigned)val);
	r = usb_control_msg(udev, usb_sndctrlpipe(udev, 0), 0x12, 0x41,
			    0xf /*?*/, 0, NULL, 0, 2000 /*?*/);
			    /* no idea what this does */
179
	if (r < 0) {
180
		dev_err(&udev->dev, "error %d on request 0x12\n", -r);
181 182 183
		return r;
	}

184 185
	r = usb_control_msg(udev, usb_sndctrlpipe(udev, 0), req, 0x41,
			    val, 0, NULL, 0, 2000 /*?*/);
186
	if (r < 0)
187 188
		dev_err(&udev->dev, "error %d on request 0x%02x\n",
			-r, (unsigned)req);
189

190 191
	r2 = usb_control_msg(udev, usb_sndctrlpipe(udev, 0), 0x19, 0x41,
			     0, 0, cs->hw.usb->bchars, 6, 2000 /*?*/);
192
	if (r2 < 0)
193
		dev_err(&udev->dev, "error %d on request 0x19\n", -r2);
194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220

	return r < 0 ? r : (r2 < 0 ? r2 : 0);
}

/* WARNING: HIGHLY EXPERIMENTAL! */
// don't use this in an interrupt/BH
static int gigaset_baud_rate(struct cardstate *cs, unsigned cflag)
{
	u16 val;
	u32 rate;

	cflag &= CBAUD;

	switch (cflag) {
	//FIXME more values?
	case    B300: rate =     300; break;
	case    B600: rate =     600; break;
	case   B1200: rate =    1200; break;
	case   B2400: rate =    2400; break;
	case   B4800: rate =    4800; break;
	case   B9600: rate =    9600; break;
	case  B19200: rate =   19200; break;
	case  B38400: rate =   38400; break;
	case  B57600: rate =   57600; break;
	case B115200: rate =  115200; break;
	default:
		rate =  9600;
221 222
		dev_err(cs->dev, "unsupported baudrate request 0x%x,"
			" using default of B9600\n", cflag);
223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250
	}

	val = 0x383fff / rate + 1;

	return set_value(cs, 1, val);
}

/* WARNING: HIGHLY EXPERIMENTAL! */
// don't use this in an interrupt/BH
static int gigaset_set_line_ctrl(struct cardstate *cs, unsigned cflag)
{
	u16 val = 0;

	/* set the parity */
	if (cflag & PARENB)
		val |= (cflag & PARODD) ? 0x10 : 0x20;

	/* set the number of data bits */
	switch (cflag & CSIZE) {
	case CS5:
		val |= 5 << 8; break;
	case CS6:
		val |= 6 << 8; break;
	case CS7:
		val |= 7 << 8; break;
	case CS8:
		val |= 8 << 8; break;
	default:
251
		dev_err(cs->dev, "CSIZE was not CS5-CS8, using default of 8\n");
252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268
		val |= 8 << 8;
		break;
	}

	/* set the number of stop bits */
	if (cflag & CSTOPB) {
		if ((cflag & CSIZE) == CS5)
			val |= 1; /* 1.5 stop bits */ //FIXME is this okay?
		else
			val |= 2; /* 2 stop bits */
	}

	return set_value(cs, 3, val);
}

#else
static int gigaset_set_modem_ctrl(struct cardstate *cs, unsigned old_state,
269
				  unsigned new_state)
270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304
{
	return -EINVAL;
}

static int gigaset_set_line_ctrl(struct cardstate *cs, unsigned cflag)
{
	return -EINVAL;
}

static int gigaset_baud_rate(struct cardstate *cs, unsigned cflag)
{
	return -EINVAL;
}
#endif


 /*================================================================================================================*/
static int gigaset_init_bchannel(struct bc_state *bcs)
{
	/* nothing to do for M10x */
	gigaset_bchannel_up(bcs);
	return 0;
}

static int gigaset_close_bchannel(struct bc_state *bcs)
{
	/* nothing to do for M10x */
	gigaset_bchannel_down(bcs);
	return 0;
}

static int write_modem(struct cardstate *cs);
static int send_cb(struct cardstate *cs, struct cmdbuf_t *cb);


305 306
/* Write tasklet handler: Continue sending current skb, or send command, or
 * start sending an skb from the send queue.
307 308 309 310 311 312 313 314
 */
static void gigaset_modem_fill(unsigned long data)
{
	struct cardstate *cs = (struct cardstate *) data;
	struct bc_state *bcs = &cs->bcs[0]; /* only one channel */
	struct cmdbuf_t *cb;
	int again;

315
	gig_dbg(DEBUG_OUTPUT, "modem_fill");
316 317

	if (atomic_read(&cs->hw.usb->busy)) {
318
		gig_dbg(DEBUG_OUTPUT, "modem_fill: busy");
319 320 321 322 323 324 325 326
		return;
	}

	do {
		again = 0;
		if (!bcs->tx_skb) { /* no skb is being sent */
			cb = cs->cmdbuf;
			if (cb) { /* commands to send? */
327
				gig_dbg(DEBUG_OUTPUT, "modem_fill: cb");
328
				if (send_cb(cs, cb) < 0) {
329 330
					gig_dbg(DEBUG_OUTPUT,
						"modem_fill: send_cb failed");
331 332
					again = 1; /* no callback will be
						      called! */
333 334 335 336
				}
			} else { /* skbs to send? */
				bcs->tx_skb = skb_dequeue(&bcs->squeue);
				if (bcs->tx_skb)
337 338 339
					gig_dbg(DEBUG_INTR,
						"Dequeued skb (Adr: %lx)!",
						(unsigned long) bcs->tx_skb);
340 341 342 343
			}
		}

		if (bcs->tx_skb) {
344
			gig_dbg(DEBUG_OUTPUT, "modem_fill: tx_skb");
345
			if (write_modem(cs) < 0) {
346 347
				gig_dbg(DEBUG_OUTPUT,
					"modem_fill: write_modem failed");
348 349 350 351 352 353 354 355 356 357
				// FIXME should we tell the LL?
				again = 1; /* no callback will be called! */
			}
		}
	} while (again);
}

/**
 *	gigaset_read_int_callback
 *
358
 *	It is called if the data was received from the device.
359
 */
360
static void gigaset_read_int_callback(struct urb *urb)
361
{
362 363
	struct inbuf_t *inbuf = urb->context;
	struct cardstate *cs = inbuf->cs;
364 365 366 367
	int resubmit = 0;
	int r;
	unsigned numbytes;
	unsigned char *src;
368
	unsigned long flags;
369 370

	if (!urb->status) {
371 372 373 374 375
		if (!cs->connected) {
			err("%s: disconnected", __func__); /* should never happen */
			return;
		}

376 377 378 379 380
		numbytes = urb->actual_length;

		if (numbytes) {
			src = inbuf->rcvbuf;
			if (unlikely(*src))
381 382 383
				dev_warn(cs->dev,
				    "%s: There was no leading 0, but 0x%02x!\n",
					 __func__, (unsigned) *src);
384 385 386
			++src; /* skip leading 0x00 */
			--numbytes;
			if (gigaset_fill_inbuf(inbuf, src, numbytes)) {
387
				gig_dbg(DEBUG_INTR, "%s-->BH", __func__);
388 389 390
				gigaset_schedule_event(inbuf->cs);
			}
		} else
391
			gig_dbg(DEBUG_INTR, "Received zero block length");
392 393 394
		resubmit = 1;
	} else {
		/* The urb might have been killed. */
395 396
		gig_dbg(DEBUG_ANY, "%s - nonzero read bulk status received: %d",
			__func__, urb->status);
397 398 399 400 401
		if (urb->status != -ENOENT) { /* not killed */
			if (!cs->connected) {
				err("%s: disconnected", __func__); /* should never happen */
				return;
			}
402
			resubmit = 1;
403
		}
404
	}
405

406
	if (resubmit) {
407
		spin_lock_irqsave(&cs->lock, flags);
408
		r = cs->connected ? usb_submit_urb(urb, GFP_ATOMIC) : -ENODEV;
409
		spin_unlock_irqrestore(&cs->lock, flags);
410
		if (r)
411 412
			dev_err(cs->dev, "error %d when resubmitting urb.\n",
				-r);
413 414 415 416
	}
}


417
/* This callback routine is called when data was transmitted to the device. */
418
static void gigaset_write_bulk_callback(struct urb *urb)
419
{
420
	struct cardstate *cs = urb->context;
421
	unsigned long flags;
422 423

	if (urb->status)
424 425
		dev_err(cs->dev, "bulk transfer failed (status %d)\n",
			-urb->status);
426
		/* That's all we can do. Communication problems
427
		   are handled by timeouts or network protocols. */
428

429 430 431 432 433 434 435 436
	spin_lock_irqsave(&cs->lock, flags);
	if (!cs->connected) {
		err("%s: not connected", __func__);
	} else {
		atomic_set(&cs->hw.usb->busy, 0);
		tasklet_schedule(&cs->write_tasklet);
	}
	spin_unlock_irqrestore(&cs->lock, flags);
437 438 439 440 441 442 443 444 445 446 447 448 449 450 451 452
}

static int send_cb(struct cardstate *cs, struct cmdbuf_t *cb)
{
	struct cmdbuf_t *tcb;
	unsigned long flags;
	int count;
	int status = -ENOENT; // FIXME
	struct usb_cardstate *ucs = cs->hw.usb;

	do {
		if (!cb->len) {
			tcb = cb;

			spin_lock_irqsave(&cs->cmdlock, flags);
			cs->cmdbytes -= cs->curlen;
453 454
			gig_dbg(DEBUG_OUTPUT, "send_cb: sent %u bytes, %u left",
				cs->curlen, cs->cmdbytes);
455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470
			cs->cmdbuf = cb = cb->next;
			if (cb) {
				cb->prev = NULL;
				cs->curlen = cb->len;
			} else {
				cs->lastcmdbuf = NULL;
				cs->curlen = 0;
			}
			spin_unlock_irqrestore(&cs->cmdlock, flags);

			if (tcb->wake_tasklet)
				tasklet_schedule(tcb->wake_tasklet);
			kfree(tcb);
		}
		if (cb) {
			count = min(cb->len, ucs->bulk_out_size);
471 472
			gig_dbg(DEBUG_OUTPUT, "send_cb: send %d bytes", count);

473
			usb_fill_bulk_urb(ucs->bulk_out_urb, ucs->udev,
474 475 476 477
					  usb_sndbulkpipe(ucs->udev,
					     ucs->bulk_out_endpointAddr & 0x0f),
					  cb->buf + cb->offset, count,
					  gigaset_write_bulk_callback, cs);
478 479 480 481 482

			cb->offset += count;
			cb->len -= count;
			atomic_set(&ucs->busy, 1);

483
			spin_lock_irqsave(&cs->lock, flags);
484
			status = cs->connected ? usb_submit_urb(ucs->bulk_out_urb, GFP_ATOMIC) : -ENODEV;
485 486
			spin_unlock_irqrestore(&cs->lock, flags);

487 488
			if (status) {
				atomic_set(&ucs->busy, 0);
489 490
				err("could not submit urb (error %d)\n",
				    -status);
491 492
				cb->len = 0; /* skip urb => remove cb+wakeup
						in next loop cycle */
493 494
			}
		}
495
	} while (cb && status); /* next command on error */
496 497 498 499

	return status;
}

500
/* Send command to device. */
501
static int gigaset_write_cmd(struct cardstate *cs, const unsigned char *buf,
502
			     int len, struct tasklet_struct *wake_tasklet)
503 504 505 506 507
{
	struct cmdbuf_t *cb;
	unsigned long flags;

	gigaset_dbg_buffer(atomic_read(&cs->mstate) != MS_LOCKED ?
508
			     DEBUG_TRANSCMD : DEBUG_LOCKCMD,
509
			   "CMD Transmit", len, buf);
510 511 512 513 514

	if (len <= 0)
		return 0;

	if (!(cb = kmalloc(sizeof(struct cmdbuf_t) + len, GFP_ATOMIC))) {
515
		dev_err(cs->dev, "%s: out of memory\n", __func__);
516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533 534 535 536
		return -ENOMEM;
	}

	memcpy(cb->buf, buf, len);
	cb->len = len;
	cb->offset = 0;
	cb->next = NULL;
	cb->wake_tasklet = wake_tasklet;

	spin_lock_irqsave(&cs->cmdlock, flags);
	cb->prev = cs->lastcmdbuf;
	if (cs->lastcmdbuf)
		cs->lastcmdbuf->next = cb;
	else {
		cs->cmdbuf = cb;
		cs->curlen = len;
	}
	cs->cmdbytes += len;
	cs->lastcmdbuf = cb;
	spin_unlock_irqrestore(&cs->cmdlock, flags);

537 538 539 540
	spin_lock_irqsave(&cs->lock, flags);
	if (cs->connected)
		tasklet_schedule(&cs->write_tasklet);
	spin_unlock_irqrestore(&cs->lock, flags);
541 542 543 544 545 546 547 548 549 550 551 552 553 554 555 556 557 558 559
	return len;
}

static int gigaset_write_room(struct cardstate *cs)
{
	unsigned bytes;

	bytes = cs->cmdbytes;
	return bytes < IF_WRITEBUF ? IF_WRITEBUF - bytes : 0;
}

static int gigaset_chars_in_buffer(struct cardstate *cs)
{
	return cs->cmdbytes;
}

static int gigaset_brkchars(struct cardstate *cs, const unsigned char buf[6])
{
#ifdef CONFIG_GIGASET_UNDOCREQ
560 561
	struct usb_device *udev = cs->hw.usb->udev;

562
	gigaset_dbg_buffer(DEBUG_USBREQ, "brkchars", 6, buf);
563
	memcpy(cs->hw.usb->bchars, buf, 6);
564 565
	return usb_control_msg(udev, usb_sndctrlpipe(udev, 0), 0x19, 0x41,
			       0, 0, &buf, 6, 2000);
566 567 568 569 570 571 572
#else
	return -EINVAL;
#endif
}

static int gigaset_freebcshw(struct bc_state *bcs)
{
T
Tilman Schmidt 已提交
573
	/* unused */
574 575 576 577 578 579
	return 1;
}

/* Initialize the b-channel structure */
static int gigaset_initbcshw(struct bc_state *bcs)
{
T
Tilman Schmidt 已提交
580 581
	/* unused */
	bcs->hw.usb = NULL;
582 583 584 585 586
	return 1;
}

static void gigaset_reinitbcshw(struct bc_state *bcs)
{
T
Tilman Schmidt 已提交
587
	/* nothing to do for M10x */
588 589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615
}

static void gigaset_freecshw(struct cardstate *cs)
{
	tasklet_kill(&cs->write_tasklet);
	kfree(cs->hw.usb);
}

static int gigaset_initcshw(struct cardstate *cs)
{
	struct usb_cardstate *ucs;

	cs->hw.usb = ucs =
		kmalloc(sizeof(struct usb_cardstate), GFP_KERNEL);
	if (!ucs)
		return 0;

	ucs->bchars[0] = 0;
	ucs->bchars[1] = 0;
	ucs->bchars[2] = 0;
	ucs->bchars[3] = 0;
	ucs->bchars[4] = 0x11;
	ucs->bchars[5] = 0x13;
	ucs->bulk_out_buffer = NULL;
	ucs->bulk_out_urb = NULL;
	//ucs->urb_cmd_out = NULL;
	ucs->read_urb = NULL;
	tasklet_init(&cs->write_tasklet,
616
		     &gigaset_modem_fill, (unsigned long) cs);
617 618 619 620

	return 1;
}

621
/* Send data from current skb to the device. */
622 623
static int write_modem(struct cardstate *cs)
{
624
	int ret = 0;
625 626 627
	int count;
	struct bc_state *bcs = &cs->bcs[0]; /* only one channel */
	struct usb_cardstate *ucs = cs->hw.usb;
628
	unsigned long flags;
629

630
	gig_dbg(DEBUG_WRITE, "len: %d...", bcs->tx_skb->len);
631 632 633 634 635 636 637 638 639 640 641

	if (!bcs->tx_skb->len) {
		dev_kfree_skb_any(bcs->tx_skb);
		bcs->tx_skb = NULL;
		return -EINVAL;
	}

	/* Copy data to bulk out buffer and  // FIXME copying not necessary
	 * transmit data
	 */
	count = min(bcs->tx_skb->len, (unsigned) ucs->bulk_out_size);
642
	skb_copy_from_linear_data(bcs->tx_skb, ucs->bulk_out_buffer, count);
643 644
	skb_pull(bcs->tx_skb, count);
	atomic_set(&ucs->busy, 1);
645
	gig_dbg(DEBUG_OUTPUT, "write_modem: send %d bytes", count);
646

647 648 649 650 651 652 653
	spin_lock_irqsave(&cs->lock, flags);
	if (cs->connected) {
		usb_fill_bulk_urb(ucs->bulk_out_urb, ucs->udev,
				  usb_sndbulkpipe(ucs->udev,
						  ucs->bulk_out_endpointAddr & 0x0f),
				  ucs->bulk_out_buffer, count,
				  gigaset_write_bulk_callback, cs);
654
		ret = usb_submit_urb(ucs->bulk_out_urb, GFP_ATOMIC);
655 656 657 658 659
	} else {
		ret = -ENODEV;
	}
	spin_unlock_irqrestore(&cs->lock, flags);

660
	if (ret) {
661
		err("could not submit urb (error %d)\n", -ret);
662 663
		atomic_set(&ucs->busy, 0);
	}
664

665 666 667 668
	if (!bcs->tx_skb->len) {
		/* skb sent completely */
		gigaset_skb_sent(bcs, bcs->tx_skb); //FIXME also, when ret<0?

669 670
		gig_dbg(DEBUG_INTR, "kfree skb (Adr: %lx)!",
			(unsigned long) bcs->tx_skb);
671 672 673 674 675 676 677 678
		dev_kfree_skb_any(bcs->tx_skb);
		bcs->tx_skb = NULL;
	}

	return ret;
}

static int gigaset_probe(struct usb_interface *interface,
679
			 const struct usb_device_id *id)
680 681 682 683 684 685 686 687 688 689 690
{
	int retval;
	struct usb_device *udev = interface_to_usbdev(interface);
	unsigned int ifnum;
	struct usb_host_interface *hostif;
	struct cardstate *cs = NULL;
	struct usb_cardstate *ucs = NULL;
	struct usb_endpoint_descriptor *endpoint;
	int buffer_size;
	int alt;

691 692 693 694
	gig_dbg(DEBUG_ANY,
		"%s: Check if device matches .. (Vendor: 0x%x, Product: 0x%x)",
		__func__, le16_to_cpu(udev->descriptor.idVendor),
		le16_to_cpu(udev->descriptor.idProduct));
695 696 697 698

	retval = -ENODEV; //FIXME

	/* See if the device offered us matches what we can accept */
A
Alexey Dobriyan 已提交
699 700
	if ((le16_to_cpu(udev->descriptor.idVendor)  != USB_M105_VENDOR_ID) ||
	    (le16_to_cpu(udev->descriptor.idProduct) != USB_M105_PRODUCT_ID))
701 702 703 704 705 706 707 708
		return -ENODEV;

	/* this starts to become ascii art... */
	hostif = interface->cur_altsetting;
	alt = hostif->desc.bAlternateSetting;
	ifnum = hostif->desc.bInterfaceNumber; // FIXME ?

	if (alt != 0 || ifnum != 0) {
709
		dev_warn(&udev->dev, "ifnum %d, alt %d\n", ifnum, alt);
710 711 712 713 714 715 716
		return -ENODEV;
	}

	/* Reject application specific intefaces
	 *
	 */
	if (hostif->desc.bInterfaceClass != 255) {
717 718 719
		dev_info(&udev->dev,
		"%s: Device matched but iface_desc[%d]->bInterfaceClass==%d!\n",
			 __func__, ifnum, hostif->desc.bInterfaceClass);
720 721 722
		return -ENODEV;
	}

723
	dev_info(&udev->dev, "%s: Device matched ... !\n", __func__);
724 725 726

	cs = gigaset_getunassignedcs(driver);
	if (!cs) {
727
		dev_warn(&udev->dev, "no free cardstate\n");
728 729 730 731
		return -ENODEV;
	}
	ucs = cs->hw.usb;

732 733 734 735
	/* save off device structure ptrs for later use */
	usb_get_dev(udev);
	ucs->udev = udev;
	ucs->interface = interface;
736 737 738 739
	cs->dev = &interface->dev;

	/* save address of controller structure */
	usb_set_intfdata(interface, cs); // dev_set_drvdata(&interface->dev, cs);
740

741 742 743 744 745 746 747
	endpoint = &hostif->endpoint[0].desc;

	buffer_size = le16_to_cpu(endpoint->wMaxPacketSize);
	ucs->bulk_out_size = buffer_size;
	ucs->bulk_out_endpointAddr = endpoint->bEndpointAddress;
	ucs->bulk_out_buffer = kmalloc(buffer_size, GFP_KERNEL);
	if (!ucs->bulk_out_buffer) {
748
		dev_err(cs->dev, "Couldn't allocate bulk_out_buffer\n");
749 750 751 752
		retval = -ENOMEM;
		goto error;
	}

753
	ucs->bulk_out_urb = usb_alloc_urb(0, GFP_KERNEL);
754
	if (!ucs->bulk_out_urb) {
755
		dev_err(cs->dev, "Couldn't allocate bulk_out_urb\n");
756 757 758 759 760 761 762 763
		retval = -ENOMEM;
		goto error;
	}

	endpoint = &hostif->endpoint[1].desc;

	atomic_set(&ucs->busy, 0);

764
	ucs->read_urb = usb_alloc_urb(0, GFP_KERNEL);
765
	if (!ucs->read_urb) {
766
		dev_err(cs->dev, "No free urbs available\n");
767 768 769 770 771 772 773 774
		retval = -ENOMEM;
		goto error;
	}
	buffer_size = le16_to_cpu(endpoint->wMaxPacketSize);
	ucs->rcvbuf_size = buffer_size;
	ucs->int_in_endpointAddr = endpoint->bEndpointAddress;
	cs->inbuf[0].rcvbuf = kmalloc(buffer_size, GFP_KERNEL);
	if (!cs->inbuf[0].rcvbuf) {
775
		dev_err(cs->dev, "Couldn't allocate rcvbuf\n");
776 777 778 779 780
		retval = -ENOMEM;
		goto error;
	}
	/* Fill the interrupt urb and send it to the core */
	usb_fill_int_urb(ucs->read_urb, udev,
781 782 783 784 785
			 usb_rcvintpipe(udev,
					endpoint->bEndpointAddress & 0x0f),
			 cs->inbuf[0].rcvbuf, buffer_size,
			 gigaset_read_int_callback,
			 cs->inbuf + 0, endpoint->bInterval);
786

787
	retval = usb_submit_urb(ucs->read_urb, GFP_KERNEL);
788
	if (retval) {
789
		dev_err(cs->dev, "Could not submit URB (error %d)\n", -retval);
790 791 792 793 794 795
		goto error;
	}

	/* tell common part that the device is ready */
	if (startmode == SM_LOCKED)
		atomic_set(&cs->mstate, MS_LOCKED);
796

797 798 799 800 801 802 803 804
	if (!gigaset_start(cs)) {
		tasklet_kill(&cs->write_tasklet);
		retval = -ENODEV; //FIXME
		goto error;
	}
	return 0;

error:
805
	usb_kill_urb(ucs->read_urb);
806
	kfree(ucs->bulk_out_buffer);
807
	usb_free_urb(ucs->bulk_out_urb);
808
	kfree(cs->inbuf[0].rcvbuf);
809
	usb_free_urb(ucs->read_urb);
810
	usb_set_intfdata(interface, NULL);
811 812
	ucs->read_urb = ucs->bulk_out_urb = NULL;
	cs->inbuf[0].rcvbuf = ucs->bulk_out_buffer = NULL;
813 814 815
	usb_put_dev(ucs->udev);
	ucs->udev = NULL;
	ucs->interface = NULL;
816 817 818 819 820 821 822 823 824 825 826 827 828 829 830
	gigaset_unassign(cs);
	return retval;
}

static void gigaset_disconnect(struct usb_interface *interface)
{
	struct cardstate *cs;
	struct usb_cardstate *ucs;

	cs = usb_get_intfdata(interface);
	ucs = cs->hw.usb;
	usb_kill_urb(ucs->read_urb);

	gigaset_stop(cs);

831
	usb_set_intfdata(interface, NULL);
832 833
	tasklet_kill(&cs->write_tasklet);

834
	usb_kill_urb(ucs->bulk_out_urb);	/* FIXME: only if active? */
835 836

	kfree(ucs->bulk_out_buffer);
837
	usb_free_urb(ucs->bulk_out_urb);
838
	kfree(cs->inbuf[0].rcvbuf);
839
	usb_free_urb(ucs->read_urb);
840
	ucs->read_urb = ucs->bulk_out_urb = NULL;
841 842
	cs->inbuf[0].rcvbuf = ucs->bulk_out_buffer = NULL;

843 844 845 846
	usb_put_dev(ucs->udev);
	ucs->interface = NULL;
	ucs->udev = NULL;
	cs->dev = NULL;
847 848 849
	gigaset_unassign(cs);
}

850
static const struct gigaset_ops ops = {
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
	gigaset_write_cmd,
	gigaset_write_room,
	gigaset_chars_in_buffer,
	gigaset_brkchars,
	gigaset_init_bchannel,
	gigaset_close_bchannel,
	gigaset_initbcshw,
	gigaset_freebcshw,
	gigaset_reinitbcshw,
	gigaset_initcshw,
	gigaset_freecshw,
	gigaset_set_modem_ctrl,
	gigaset_baud_rate,
	gigaset_set_line_ctrl,
	gigaset_m10x_send_skb,
	gigaset_m10x_input,
};

/**
 *	usb_gigaset_init
 * This function is called while kernel-module is loaded
 */
static int __init usb_gigaset_init(void)
{
	int result;

	/* allocate memory for our driver state and intialize it */
	if ((driver = gigaset_initdriver(GIGASET_MINOR, GIGASET_MINORS,
879
				       GIGASET_MODULENAME, GIGASET_DEVNAME,
880
				       &ops, THIS_MODULE)) == NULL)
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
		goto error;

	/* allocate memory for our device state and intialize it */
	cardstate = gigaset_initcs(driver, 1, 1, 0, cidmode, GIGASET_MODULENAME);
	if (!cardstate)
		goto error;

	/* register this driver with the USB subsystem */
	result = usb_register(&gigaset_usb_driver);
	if (result < 0) {
		err("usb_gigaset: usb_register failed (error %d)",
		    -result);
		goto error;
	}

	info(DRIVER_AUTHOR);
	info(DRIVER_DESC);
	return 0;

error:	if (cardstate)
		gigaset_freecs(cardstate);
	cardstate = NULL;
	if (driver)
		gigaset_freedriver(driver);
	driver = NULL;
	return -1;
}


/**
 *	usb_gigaset_exit
 * This function is called while unloading the kernel-module
 */
static void __exit usb_gigaset_exit(void)
{
	gigaset_blockdriver(driver); /* => probe will fail
917 918
				      * => no gigaset_start any more
				      */
919 920 921 922 923 924 925 926 927 928 929 930 931 932 933 934 935 936 937 938 939 940 941

	gigaset_shutdown(cardstate);
	/* from now on, no isdn callback should be possible */

	/* deregister this driver with the USB subsystem */
	usb_deregister(&gigaset_usb_driver);
	/* this will call the disconnect-callback */
	/* from now on, no disconnect/probe callback should be running */

	gigaset_freecs(cardstate);
	cardstate = NULL;
	gigaset_freedriver(driver);
	driver = NULL;
}


module_init(usb_gigaset_init);
module_exit(usb_gigaset_exit);

MODULE_AUTHOR(DRIVER_AUTHOR);
MODULE_DESCRIPTION(DRIVER_DESC);

MODULE_LICENSE("GPL");