usb-gigaset.c 25.0 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
#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"

T
Tilman Schmidt 已提交
46
#define IF_WRITEBUF 2000	/* arbitrary limit */
47 48 49 50 51 52

/* 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 */
T
Tilman Schmidt 已提交
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
	{ 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
T
Tilman Schmidt 已提交
100 101
 *            in unimodem mode. So, this might be an array of characters that
 *            need special treatment ("commit all bufferd data"?), 11=^Q, 13=^S.
102 103 104 105 106
 *
 * Unimodem mode: use "modprobe ppp_async flag_time=0" as the device _needs_ two
 * flags per packet.
 */

T
Tilman Schmidt 已提交
107
/* functions called if a device of this driver is connected/disconnected */
108
static int gigaset_probe(struct usb_interface *interface,
109
			 const struct usb_device_id *id);
110 111
static void gigaset_disconnect(struct usb_interface *interface);

T
Tilman Schmidt 已提交
112 113 114 115 116
/* functions called before/after suspend */
static int gigaset_suspend(struct usb_interface *intf, pm_message_t message);
static int gigaset_resume(struct usb_interface *intf);
static int gigaset_pre_reset(struct usb_interface *intf);

T
Tilman Schmidt 已提交
117
static struct gigaset_driver *driver;
118 119 120

/* usb specific object needed to register this driver with the usb subsystem */
static struct usb_driver gigaset_usb_driver = {
121 122 123 124
	.name =		GIGASET_MODULENAME,
	.probe =	gigaset_probe,
	.disconnect =	gigaset_disconnect,
	.id_table =	gigaset_table,
T
Tilman Schmidt 已提交
125 126 127 128 129
	.suspend =	gigaset_suspend,
	.resume =	gigaset_resume,
	.reset_resume =	gigaset_resume,
	.pre_reset =	gigaset_pre_reset,
	.post_reset =	gigaset_resume,
130 131 132
};

struct usb_cardstate {
133 134
	struct usb_device	*udev;		/* usb device pointer */
	struct usb_interface	*interface;	/* interface for this device */
T
Tilman Schmidt 已提交
135
	int			busy;		/* bulk output in progress */
136 137

	/* Output buffer */
138 139 140 141
	unsigned char		*bulk_out_buffer;
	int			bulk_out_size;
	__u8			bulk_out_endpointAddr;
	struct urb		*bulk_out_urb;
142 143

	/* Input buffer */
T
Tilman Schmidt 已提交
144
	unsigned char		*rcvbuf;
145 146 147
	int			rcvbuf_size;
	struct urb		*read_urb;
	__u8			int_in_endpointAddr;
148

149
	char			bchars[6];		/* for request 0x19 */
150 151 152 153 154 155 156 157
};

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

static int gigaset_set_modem_ctrl(struct cardstate *cs, unsigned old_state,
158
				  unsigned new_state)
159
{
160
	struct usb_device *udev = cs->hw.usb->udev;
161 162 163 164 165 166
	unsigned mask, val;
	int r;

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

167 168 169 170
	gig_dbg(DEBUG_USBREQ, "set flags 0x%02x with mask 0x%02x", val, mask);
	r = usb_control_msg(udev, usb_sndctrlpipe(udev, 0), 7, 0x41,
			    (val & 0xff) | ((mask & 0xff) << 8), 0,
			    NULL, 0, 2000 /* timeout? */);
171 172 173 174 175
	if (r < 0)
		return r;
	return 0;
}

176 177 178 179 180
/*
 * Set M105 configuration value
 * using undocumented device commands reverse engineered from USB traces
 * of the Siemens Windows driver
 */
181 182
static int set_value(struct cardstate *cs, u8 req, u16 val)
{
183
	struct usb_device *udev = cs->hw.usb->udev;
184 185
	int r, r2;

186 187 188 189 190
	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 */
191
	if (r < 0) {
192
		dev_err(&udev->dev, "error %d on request 0x12\n", -r);
193 194 195
		return r;
	}

196 197
	r = usb_control_msg(udev, usb_sndctrlpipe(udev, 0), req, 0x41,
			    val, 0, NULL, 0, 2000 /*?*/);
198
	if (r < 0)
199 200
		dev_err(&udev->dev, "error %d on request 0x%02x\n",
			-r, (unsigned)req);
201

202 203
	r2 = usb_control_msg(udev, usb_sndctrlpipe(udev, 0), 0x19, 0x41,
			     0, 0, cs->hw.usb->bchars, 6, 2000 /*?*/);
204
	if (r2 < 0)
205
		dev_err(&udev->dev, "error %d on request 0x19\n", -r2);
206 207 208 209

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

210 211 212 213
/*
 * set the baud rate on the internal serial adapter
 * using the undocumented parameter setting command
 */
214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233
static int gigaset_baud_rate(struct cardstate *cs, unsigned cflag)
{
	u16 val;
	u32 rate;

	cflag &= CBAUD;

	switch (cflag) {
	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;
234 235
		dev_err(cs->dev, "unsupported baudrate request 0x%x,"
			" using default of B9600\n", cflag);
236 237 238 239 240 241 242
	}

	val = 0x383fff / rate + 1;

	return set_value(cs, 1, val);
}

243 244 245 246
/*
 * set the line format on the internal serial adapter
 * using the undocumented parameter setting command
 */
247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265
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:
266
		dev_err(cs->dev, "CSIZE was not CS5-CS8, using default of 8\n");
267 268 269 270 271 272 273
		val |= 8 << 8;
		break;
	}

	/* set the number of stop bits */
	if (cflag & CSTOPB) {
		if ((cflag & CSIZE) == CS5)
T
Tilman Schmidt 已提交
274
			val |= 1; /* 1.5 stop bits */
275 276 277 278 279 280 281 282
		else
			val |= 2; /* 2 stop bits */
	}

	return set_value(cs, 3, val);
}


T
Tilman Schmidt 已提交
283
/*============================================================================*/
284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301
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);


302 303
/* Write tasklet handler: Continue sending current skb, or send command, or
 * start sending an skb from the send queue.
304 305 306 307 308 309 310 311
 */
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;

312
	gig_dbg(DEBUG_OUTPUT, "modem_fill");
313

T
Tilman Schmidt 已提交
314
	if (cs->hw.usb->busy) {
315
		gig_dbg(DEBUG_OUTPUT, "modem_fill: busy");
316 317 318 319 320 321 322 323
		return;
	}

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

		if (bcs->tx_skb) {
341
			gig_dbg(DEBUG_OUTPUT, "modem_fill: tx_skb");
342
			if (write_modem(cs) < 0) {
343 344
				gig_dbg(DEBUG_OUTPUT,
					"modem_fill: write_modem failed");
345 346 347 348 349 350
				again = 1; /* no callback will be called! */
			}
		}
	} while (again);
}

351 352
/*
 * Interrupt Input URB completion routine
353
 */
354
static void gigaset_read_int_callback(struct urb *urb)
355
{
T
Tilman Schmidt 已提交
356 357
	struct cardstate *cs = urb->context;
	struct inbuf_t *inbuf = cs->inbuf;
358
	int status = urb->status;
359 360 361
	int r;
	unsigned numbytes;
	unsigned char *src;
362
	unsigned long flags;
363

364
	if (!status) {
365 366 367
		numbytes = urb->actual_length;

		if (numbytes) {
T
Tilman Schmidt 已提交
368
			src = cs->hw.usb->rcvbuf;
369
			if (unlikely(*src))
370 371 372
				dev_warn(cs->dev,
				    "%s: There was no leading 0, but 0x%02x!\n",
					 __func__, (unsigned) *src);
373 374 375
			++src; /* skip leading 0x00 */
			--numbytes;
			if (gigaset_fill_inbuf(inbuf, src, numbytes)) {
376
				gig_dbg(DEBUG_INTR, "%s-->BH", __func__);
377 378 379
				gigaset_schedule_event(inbuf->cs);
			}
		} else
380
			gig_dbg(DEBUG_INTR, "Received zero block length");
381 382
	} else {
		/* The urb might have been killed. */
T
Tilman Schmidt 已提交
383
		gig_dbg(DEBUG_ANY, "%s - nonzero status received: %d",
384
			__func__, status);
T
Tilman Schmidt 已提交
385 386 387
		if (status == -ENOENT || status == -ESHUTDOWN)
			/* killed or endpoint shutdown: don't resubmit */
			return;
388
	}
389

T
Tilman Schmidt 已提交
390 391 392
	/* resubmit URB */
	spin_lock_irqsave(&cs->lock, flags);
	if (!cs->connected) {
393
		spin_unlock_irqrestore(&cs->lock, flags);
394
		pr_err("%s: disconnected\n", __func__);
T
Tilman Schmidt 已提交
395
		return;
396
	}
T
Tilman Schmidt 已提交
397 398 399 400
	r = usb_submit_urb(urb, GFP_ATOMIC);
	spin_unlock_irqrestore(&cs->lock, flags);
	if (r)
		dev_err(cs->dev, "error %d resubmitting URB\n", -r);
401 402 403
}


404
/* This callback routine is called when data was transmitted to the device. */
405
static void gigaset_write_bulk_callback(struct urb *urb)
406
{
407
	struct cardstate *cs = urb->context;
408
	int status = urb->status;
409
	unsigned long flags;
410

T
Tilman Schmidt 已提交
411 412 413 414 415
	switch (status) {
	case 0:			/* normal completion */
		break;
	case -ENOENT:		/* killed */
		gig_dbg(DEBUG_ANY, "%s: killed", __func__);
T
Tilman Schmidt 已提交
416
		cs->hw.usb->busy = 0;
T
Tilman Schmidt 已提交
417 418
		return;
	default:
419
		dev_err(cs->dev, "bulk transfer failed (status %d)\n",
420
			-status);
421
		/* That's all we can do. Communication problems
422
		   are handled by timeouts or network protocols. */
T
Tilman Schmidt 已提交
423
	}
424

425 426
	spin_lock_irqsave(&cs->lock, flags);
	if (!cs->connected) {
427
		pr_err("%s: disconnected\n", __func__);
428
	} else {
T
Tilman Schmidt 已提交
429
		cs->hw.usb->busy = 0;
430 431 432
		tasklet_schedule(&cs->write_tasklet);
	}
	spin_unlock_irqrestore(&cs->lock, flags);
433 434 435 436 437 438 439
}

static int send_cb(struct cardstate *cs, struct cmdbuf_t *cb)
{
	struct cmdbuf_t *tcb;
	unsigned long flags;
	int count;
T
Tilman Schmidt 已提交
440
	int status = -ENOENT;
441 442 443 444 445 446 447 448
	struct usb_cardstate *ucs = cs->hw.usb;

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

			spin_lock_irqsave(&cs->cmdlock, flags);
			cs->cmdbytes -= cs->curlen;
449 450
			gig_dbg(DEBUG_OUTPUT, "send_cb: sent %u bytes, %u left",
				cs->curlen, cs->cmdbytes);
451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466
			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);
467 468
			gig_dbg(DEBUG_OUTPUT, "send_cb: send %d bytes", count);

469
			usb_fill_bulk_urb(ucs->bulk_out_urb, ucs->udev,
470 471 472 473
					  usb_sndbulkpipe(ucs->udev,
					     ucs->bulk_out_endpointAddr & 0x0f),
					  cb->buf + cb->offset, count,
					  gigaset_write_bulk_callback, cs);
474 475 476

			cb->offset += count;
			cb->len -= count;
T
Tilman Schmidt 已提交
477
			ucs->busy = 1;
478

479
			spin_lock_irqsave(&cs->lock, flags);
T
Tilman Schmidt 已提交
480 481 482
			status = cs->connected ?
				usb_submit_urb(ucs->bulk_out_urb, GFP_ATOMIC) :
				-ENODEV;
483 484
			spin_unlock_irqrestore(&cs->lock, flags);

485
			if (status) {
T
Tilman Schmidt 已提交
486
				ucs->busy = 0;
487 488 489
				dev_err(cs->dev,
					"could not submit urb (error %d)\n",
					-status);
490 491
				cb->len = 0; /* skip urb => remove cb+wakeup
						in next loop cycle */
492 493
			}
		}
494
	} while (cb && status); /* next command on error */
495 496 497 498

	return status;
}

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

T
Tilman Schmidt 已提交
506
	gigaset_dbg_buffer(cs->mstate != MS_LOCKED ?
507
			     DEBUG_TRANSCMD : DEBUG_LOCKCMD,
508
			   "CMD Transmit", len, buf);
509 510 511

	if (len <= 0)
		return 0;
T
Tilman Schmidt 已提交
512 513
	cb = kmalloc(sizeof(struct cmdbuf_t) + len, GFP_ATOMIC);
	if (!cb) {
514
		dev_err(cs->dev, "%s: out of memory\n", __func__);
515 516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533 534 535
		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);

536 537 538 539
	spin_lock_irqsave(&cs->lock, flags);
	if (cs->connected)
		tasklet_schedule(&cs->write_tasklet);
	spin_unlock_irqrestore(&cs->lock, flags);
540 541 542 543 544 545 546 547 548 549 550 551 552 553 554 555
	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;
}

556 557 558 559 560
/*
 * set the break characters on the internal serial adapter
 * using undocumented device commands reverse engineered from USB traces
 * of the Siemens Windows driver
 */
561 562
static int gigaset_brkchars(struct cardstate *cs, const unsigned char buf[6])
{
563 564
	struct usb_device *udev = cs->hw.usb->udev;

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

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
}

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);
602 603
	if (!ucs) {
		pr_err("out of memory\n");
604
		return 0;
605
	}
606 607 608 609 610 611 612 613 614 615 616

	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->read_urb = NULL;
	tasklet_init(&cs->write_tasklet,
617
		     gigaset_modem_fill, (unsigned long) cs);
618 619 620 621

	return 1;
}

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

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

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

T
Tilman Schmidt 已提交
639
	/* Copy data to bulk out buffer and transmit data */
640
	count = min(bcs->tx_skb->len, (unsigned) ucs->bulk_out_size);
641
	skb_copy_from_linear_data(bcs->tx_skb, ucs->bulk_out_buffer, count);
642
	skb_pull(bcs->tx_skb, count);
T
Tilman Schmidt 已提交
643
	ucs->busy = 1;
644
	gig_dbg(DEBUG_OUTPUT, "write_modem: send %d bytes", count);
645

646 647 648 649
	spin_lock_irqsave(&cs->lock, flags);
	if (cs->connected) {
		usb_fill_bulk_urb(ucs->bulk_out_urb, ucs->udev,
				  usb_sndbulkpipe(ucs->udev,
T
Tilman Schmidt 已提交
650 651
						  ucs->bulk_out_endpointAddr &
						  0x0f),
652 653
				  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
		dev_err(cs->dev, "could not submit urb (error %d)\n", -ret);
T
Tilman Schmidt 已提交
662
		ucs->busy = 0;
663
	}
664

665 666
	if (!bcs->tx_skb->len) {
		/* skb sent completely */
T
Tilman Schmidt 已提交
667
		gigaset_skb_sent(bcs, bcs->tx_skb);
668

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
{
	int retval;
	struct usb_device *udev = interface_to_usbdev(interface);
T
Tilman Schmidt 已提交
683
	struct usb_host_interface *hostif = interface->cur_altsetting;
684 685 686 687 688
	struct cardstate *cs = NULL;
	struct usb_cardstate *ucs = NULL;
	struct usb_endpoint_descriptor *endpoint;
	int buffer_size;

T
Tilman Schmidt 已提交
689
	gig_dbg(DEBUG_ANY, "%s: Check if device matches ...", __func__);
690 691

	/* See if the device offered us matches what we can accept */
A
Alexey Dobriyan 已提交
692
	if ((le16_to_cpu(udev->descriptor.idVendor)  != USB_M105_VENDOR_ID) ||
T
Tilman Schmidt 已提交
693 694 695 696
	    (le16_to_cpu(udev->descriptor.idProduct) != USB_M105_PRODUCT_ID)) {
		gig_dbg(DEBUG_ANY, "device ID (0x%x, 0x%x) not for me - skip",
			le16_to_cpu(udev->descriptor.idVendor),
			le16_to_cpu(udev->descriptor.idProduct));
697
		return -ENODEV;
T
Tilman Schmidt 已提交
698 699 700 701 702 703 704 705 706
	}
	if (hostif->desc.bInterfaceNumber != 0) {
		gig_dbg(DEBUG_ANY, "interface %d not for me - skip",
			hostif->desc.bInterfaceNumber);
		return -ENODEV;
	}
	if (hostif->desc.bAlternateSetting != 0) {
		dev_notice(&udev->dev, "unsupported altsetting %d - skip",
			   hostif->desc.bAlternateSetting);
707 708 709
		return -ENODEV;
	}
	if (hostif->desc.bInterfaceClass != 255) {
T
Tilman Schmidt 已提交
710 711
		dev_notice(&udev->dev, "unsupported interface class %d - skip",
			   hostif->desc.bInterfaceClass);
712 713 714
		return -ENODEV;
	}

715
	dev_info(&udev->dev, "%s: Device matched ... !\n", __func__);
716

T
Tilman Schmidt 已提交
717 718 719
	/* allocate memory for our device state and intialize it */
	cs = gigaset_initcs(driver, 1, 1, 0, cidmode, GIGASET_MODULENAME);
	if (!cs)
720 721 722
		return -ENODEV;
	ucs = cs->hw.usb;

723 724 725 726
	/* save off device structure ptrs for later use */
	usb_get_dev(udev);
	ucs->udev = udev;
	ucs->interface = interface;
727 728 729
	cs->dev = &interface->dev;

	/* save address of controller structure */
730
	usb_set_intfdata(interface, cs);
731

732 733 734 735 736 737 738
	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) {
739
		dev_err(cs->dev, "Couldn't allocate bulk_out_buffer\n");
740 741 742 743
		retval = -ENOMEM;
		goto error;
	}

744
	ucs->bulk_out_urb = usb_alloc_urb(0, GFP_KERNEL);
745
	if (!ucs->bulk_out_urb) {
746
		dev_err(cs->dev, "Couldn't allocate bulk_out_urb\n");
747 748 749 750 751 752
		retval = -ENOMEM;
		goto error;
	}

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

T
Tilman Schmidt 已提交
753
	ucs->busy = 0;
754

755
	ucs->read_urb = usb_alloc_urb(0, GFP_KERNEL);
756
	if (!ucs->read_urb) {
757
		dev_err(cs->dev, "No free urbs available\n");
758 759 760 761 762 763
		retval = -ENOMEM;
		goto error;
	}
	buffer_size = le16_to_cpu(endpoint->wMaxPacketSize);
	ucs->rcvbuf_size = buffer_size;
	ucs->int_in_endpointAddr = endpoint->bEndpointAddress;
T
Tilman Schmidt 已提交
764 765
	ucs->rcvbuf = kmalloc(buffer_size, GFP_KERNEL);
	if (!ucs->rcvbuf) {
766
		dev_err(cs->dev, "Couldn't allocate rcvbuf\n");
767 768 769 770 771
		retval = -ENOMEM;
		goto error;
	}
	/* Fill the interrupt urb and send it to the core */
	usb_fill_int_urb(ucs->read_urb, udev,
772 773
			 usb_rcvintpipe(udev,
					endpoint->bEndpointAddress & 0x0f),
T
Tilman Schmidt 已提交
774
			 ucs->rcvbuf, buffer_size,
775
			 gigaset_read_int_callback,
T
Tilman Schmidt 已提交
776
			 cs, endpoint->bInterval);
777

778
	retval = usb_submit_urb(ucs->read_urb, GFP_KERNEL);
779
	if (retval) {
780
		dev_err(cs->dev, "Could not submit URB (error %d)\n", -retval);
781 782 783 784 785
		goto error;
	}

	/* tell common part that the device is ready */
	if (startmode == SM_LOCKED)
T
Tilman Schmidt 已提交
786
		cs->mstate = MS_LOCKED;
787

788 789
	if (!gigaset_start(cs)) {
		tasklet_kill(&cs->write_tasklet);
T
Tilman Schmidt 已提交
790
		retval = -ENODEV;
791 792 793 794 795
		goto error;
	}
	return 0;

error:
796
	usb_kill_urb(ucs->read_urb);
797
	kfree(ucs->bulk_out_buffer);
798
	usb_free_urb(ucs->bulk_out_urb);
T
Tilman Schmidt 已提交
799
	kfree(ucs->rcvbuf);
800
	usb_free_urb(ucs->read_urb);
801
	usb_set_intfdata(interface, NULL);
802
	ucs->read_urb = ucs->bulk_out_urb = NULL;
T
Tilman Schmidt 已提交
803
	ucs->rcvbuf = ucs->bulk_out_buffer = NULL;
804 805 806
	usb_put_dev(ucs->udev);
	ucs->udev = NULL;
	ucs->interface = NULL;
T
Tilman Schmidt 已提交
807
	gigaset_freecs(cs);
808 809 810 811 812 813 814 815 816 817
	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;
T
Tilman Schmidt 已提交
818 819 820

	dev_info(cs->dev, "disconnecting Gigaset USB adapter\n");

821 822 823 824
	usb_kill_urb(ucs->read_urb);

	gigaset_stop(cs);

825
	usb_set_intfdata(interface, NULL);
826 827
	tasklet_kill(&cs->write_tasklet);

T
Tilman Schmidt 已提交
828
	usb_kill_urb(ucs->bulk_out_urb);
829 830

	kfree(ucs->bulk_out_buffer);
831
	usb_free_urb(ucs->bulk_out_urb);
T
Tilman Schmidt 已提交
832
	kfree(ucs->rcvbuf);
833
	usb_free_urb(ucs->read_urb);
834
	ucs->read_urb = ucs->bulk_out_urb = NULL;
T
Tilman Schmidt 已提交
835
	ucs->rcvbuf = ucs->bulk_out_buffer = NULL;
836

837 838 839 840
	usb_put_dev(ucs->udev);
	ucs->interface = NULL;
	ucs->udev = NULL;
	cs->dev = NULL;
T
Tilman Schmidt 已提交
841
	gigaset_freecs(cs);
842 843
}

T
Tilman Schmidt 已提交
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
/* gigaset_suspend
 * This function is called before the USB connection is suspended or reset.
 */
static int gigaset_suspend(struct usb_interface *intf, pm_message_t message)
{
	struct cardstate *cs = usb_get_intfdata(intf);

	/* stop activity */
	cs->connected = 0;	/* prevent rescheduling */
	usb_kill_urb(cs->hw.usb->read_urb);
	tasklet_kill(&cs->write_tasklet);
	usb_kill_urb(cs->hw.usb->bulk_out_urb);

	gig_dbg(DEBUG_SUSPEND, "suspend complete");
	return 0;
}

/* gigaset_resume
 * This function is called after the USB connection has been resumed or reset.
 */
static int gigaset_resume(struct usb_interface *intf)
{
	struct cardstate *cs = usb_get_intfdata(intf);
	int rc;

	/* resubmit interrupt URB */
	cs->connected = 1;
	rc = usb_submit_urb(cs->hw.usb->read_urb, GFP_KERNEL);
	if (rc) {
		dev_err(cs->dev, "Could not submit read URB (error %d)\n", -rc);
		return rc;
	}

	gig_dbg(DEBUG_SUSPEND, "resume complete");
	return 0;
}

/* gigaset_pre_reset
 * This function is called before the USB connection is reset.
 */
static int gigaset_pre_reset(struct usb_interface *intf)
{
	/* same as suspend */
	return gigaset_suspend(intf, PMSG_ON);
}

890
static const struct gigaset_ops ops = {
891 892 893 894 895 896 897 898 899 900 901 902 903 904 905 906 907 908
	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,
};

909
/*
910 911 912 913 914 915 916
 * 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 */
T
Tilman Schmidt 已提交
917 918 919 920
	driver = gigaset_initdriver(GIGASET_MINOR, GIGASET_MINORS,
				    GIGASET_MODULENAME, GIGASET_DEVNAME,
				    &ops, THIS_MODULE);
	if (driver == NULL)
921 922 923 924 925
		goto error;

	/* register this driver with the USB subsystem */
	result = usb_register(&gigaset_usb_driver);
	if (result < 0) {
926
		pr_err("error %d registering USB driver\n", -result);
927 928 929
		goto error;
	}

930
	pr_info(DRIVER_DESC "\n");
931 932
	return 0;

T
Tilman Schmidt 已提交
933
error:
934 935 936 937 938 939
	if (driver)
		gigaset_freedriver(driver);
	driver = NULL;
	return -1;
}

940
/*
941 942 943 944
 * This function is called while unloading the kernel-module
 */
static void __exit usb_gigaset_exit(void)
{
T
Tilman Schmidt 已提交
945 946
	int i;

947
	gigaset_blockdriver(driver); /* => probe will fail
948 949
				      * => no gigaset_start any more
				      */
950

T
Tilman Schmidt 已提交
951 952 953 954
	/* stop all connected devices */
	for (i = 0; i < driver->minors; i++)
		gigaset_shutdown(driver->cs + i);

955 956 957 958 959 960 961 962 963 964 965 966 967 968 969 970 971 972 973
	/* 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_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");