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
 *                   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/usb.h>
#include <linux/module.h>
#include <linux/moduleparam.h>

/* Version Information */
24
#define DRIVER_AUTHOR "Hansjoerg Lipp <hjlipp@web.de>, Stefan Eilers"
25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41
#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 已提交
42
#define IF_WRITEBUF 2000	/* arbitrary limit */
43 44 45 46 47 48

/* 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 已提交
49
static const struct usb_device_id gigaset_table[] = {
50 51 52 53 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
	{ 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 已提交
96 97
 *            in unimodem mode. So, this might be an array of characters that
 *            need special treatment ("commit all bufferd data"?), 11=^Q, 13=^S.
98 99 100 101 102
 *
 * Unimodem mode: use "modprobe ppp_async flag_time=0" as the device _needs_ two
 * flags per packet.
 */

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

T
Tilman Schmidt 已提交
108 109 110 111 112
/* 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 已提交
113
static struct gigaset_driver *driver;
114 115 116

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

struct usb_cardstate {
129 130
	struct usb_device	*udev;		/* usb device pointer */
	struct usb_interface	*interface;	/* interface for this device */
T
Tilman Schmidt 已提交
131
	int			busy;		/* bulk output in progress */
132 133

	/* Output buffer */
134 135 136 137
	unsigned char		*bulk_out_buffer;
	int			bulk_out_size;
	__u8			bulk_out_endpointAddr;
	struct urb		*bulk_out_urb;
138 139

	/* Input buffer */
T
Tilman Schmidt 已提交
140
	unsigned char		*rcvbuf;
141 142 143
	int			rcvbuf_size;
	struct urb		*read_urb;
	__u8			int_in_endpointAddr;
144

145
	char			bchars[6];		/* for request 0x19 */
146 147 148 149 150 151 152 153
};

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,
154
				  unsigned new_state)
155
{
156
	struct usb_device *udev = cs->hw.usb->udev;
157 158 159 160 161 162
	unsigned mask, val;
	int r;

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

163 164 165 166
	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? */);
167 168 169 170 171
	if (r < 0)
		return r;
	return 0;
}

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

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

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

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

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

206 207 208 209
/*
 * set the baud rate on the internal serial adapter
 * using the undocumented parameter setting command
 */
210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229
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;
230 231
		dev_err(cs->dev, "unsupported baudrate request 0x%x,"
			" using default of B9600\n", cflag);
232 233 234 235 236 237 238
	}

	val = 0x383fff / rate + 1;

	return set_value(cs, 1, val);
}

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

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

	return set_value(cs, 3, val);
}


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


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

308
	gig_dbg(DEBUG_OUTPUT, "modem_fill");
309

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

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

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

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

360
	if (!status) {
361 362 363
		numbytes = urb->actual_length;

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

T
Tilman Schmidt 已提交
386 387 388
	/* resubmit URB */
	spin_lock_irqsave(&cs->lock, flags);
	if (!cs->connected) {
389
		spin_unlock_irqrestore(&cs->lock, flags);
390
		pr_err("%s: disconnected\n", __func__);
T
Tilman Schmidt 已提交
391
		return;
392
	}
T
Tilman Schmidt 已提交
393 394 395 396
	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);
397 398 399
}


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

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

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

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

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

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

465
			usb_fill_bulk_urb(ucs->bulk_out_urb, ucs->udev,
466 467 468 469
					  usb_sndbulkpipe(ucs->udev,
					     ucs->bulk_out_endpointAddr & 0x0f),
					  cb->buf + cb->offset, count,
					  gigaset_write_bulk_callback, cs);
470 471 472

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

475
			spin_lock_irqsave(&cs->lock, flags);
T
Tilman Schmidt 已提交
476 477 478
			status = cs->connected ?
				usb_submit_urb(ucs->bulk_out_urb, GFP_ATOMIC) :
				-ENODEV;
479 480
			spin_unlock_irqrestore(&cs->lock, flags);

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

	return status;
}

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

T
Tilman Schmidt 已提交
502
	gigaset_dbg_buffer(cs->mstate != MS_LOCKED ?
503
			     DEBUG_TRANSCMD : DEBUG_LOCKCMD,
504
			   "CMD Transmit", len, buf);
505 506 507

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

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

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

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

static int gigaset_freebcshw(struct bc_state *bcs)
{
T
Tilman Schmidt 已提交
569
	/* unused */
570 571 572 573 574 575
	return 1;
}

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

static void gigaset_reinitbcshw(struct bc_state *bcs)
{
T
Tilman Schmidt 已提交
583
	/* nothing to do for M10x */
584 585 586 587 588 589 590 591 592 593 594 595 596 597
}

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

	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,
613
		     gigaset_modem_fill, (unsigned long) cs);
614 615 616 617

	return 1;
}

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

T
Tilman Schmidt 已提交
627
	gig_dbg(DEBUG_OUTPUT, "len: %d...", bcs->tx_skb->len);
628 629 630 631 632 633 634

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

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

642 643 644 645
	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 已提交
646 647
						  ucs->bulk_out_endpointAddr &
						  0x0f),
648 649
				  ucs->bulk_out_buffer, count,
				  gigaset_write_bulk_callback, cs);
650
		ret = usb_submit_urb(ucs->bulk_out_urb, GFP_ATOMIC);
651 652 653 654 655
	} else {
		ret = -ENODEV;
	}
	spin_unlock_irqrestore(&cs->lock, flags);

656
	if (ret) {
657
		dev_err(cs->dev, "could not submit urb (error %d)\n", -ret);
T
Tilman Schmidt 已提交
658
		ucs->busy = 0;
659
	}
660

661 662
	if (!bcs->tx_skb->len) {
		/* skb sent completely */
T
Tilman Schmidt 已提交
663
		gigaset_skb_sent(bcs, bcs->tx_skb);
664

665 666
		gig_dbg(DEBUG_INTR, "kfree skb (Adr: %lx)!",
			(unsigned long) bcs->tx_skb);
667 668 669 670 671 672 673 674
		dev_kfree_skb_any(bcs->tx_skb);
		bcs->tx_skb = NULL;
	}

	return ret;
}

static int gigaset_probe(struct usb_interface *interface,
675
			 const struct usb_device_id *id)
676 677 678
{
	int retval;
	struct usb_device *udev = interface_to_usbdev(interface);
T
Tilman Schmidt 已提交
679
	struct usb_host_interface *hostif = interface->cur_altsetting;
680 681 682 683 684
	struct cardstate *cs = NULL;
	struct usb_cardstate *ucs = NULL;
	struct usb_endpoint_descriptor *endpoint;
	int buffer_size;

T
Tilman Schmidt 已提交
685
	gig_dbg(DEBUG_ANY, "%s: Check if device matches ...", __func__);
686 687

	/* See if the device offered us matches what we can accept */
A
Alexey Dobriyan 已提交
688
	if ((le16_to_cpu(udev->descriptor.idVendor)  != USB_M105_VENDOR_ID) ||
T
Tilman Schmidt 已提交
689 690 691 692
	    (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));
693
		return -ENODEV;
T
Tilman Schmidt 已提交
694 695 696 697 698 699 700 701 702
	}
	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);
703 704 705
		return -ENODEV;
	}
	if (hostif->desc.bInterfaceClass != 255) {
T
Tilman Schmidt 已提交
706 707
		dev_notice(&udev->dev, "unsupported interface class %d - skip",
			   hostif->desc.bInterfaceClass);
708 709 710
		return -ENODEV;
	}

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

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

719 720 721 722
	/* save off device structure ptrs for later use */
	usb_get_dev(udev);
	ucs->udev = udev;
	ucs->interface = interface;
723 724 725
	cs->dev = &interface->dev;

	/* save address of controller structure */
726
	usb_set_intfdata(interface, cs);
727

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

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

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

T
Tilman Schmidt 已提交
749
	ucs->busy = 0;
750

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

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

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

784 785
	if (!gigaset_start(cs)) {
		tasklet_kill(&cs->write_tasklet);
T
Tilman Schmidt 已提交
786
		retval = -ENODEV;
787 788 789 790 791
		goto error;
	}
	return 0;

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

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

817 818 819 820
	usb_kill_urb(ucs->read_urb);

	gigaset_stop(cs);

821
	usb_set_intfdata(interface, NULL);
822 823
	tasklet_kill(&cs->write_tasklet);

T
Tilman Schmidt 已提交
824
	usb_kill_urb(ucs->bulk_out_urb);
825 826

	kfree(ucs->bulk_out_buffer);
827
	usb_free_urb(ucs->bulk_out_urb);
T
Tilman Schmidt 已提交
828
	kfree(ucs->rcvbuf);
829
	usb_free_urb(ucs->read_urb);
830
	ucs->read_urb = ucs->bulk_out_urb = NULL;
T
Tilman Schmidt 已提交
831
	ucs->rcvbuf = ucs->bulk_out_buffer = NULL;
832

833 834 835 836
	usb_put_dev(ucs->udev);
	ucs->interface = NULL;
	ucs->udev = NULL;
	cs->dev = NULL;
T
Tilman Schmidt 已提交
837
	gigaset_freecs(cs);
838 839
}

T
Tilman Schmidt 已提交
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
/* 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);
}

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

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

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

926
	pr_info(DRIVER_DESC "\n");
927 928
	return 0;

T
Tilman Schmidt 已提交
929
error:
930 931 932 933 934 935
	if (driver)
		gigaset_freedriver(driver);
	driver = NULL;
	return -1;
}

936
/*
937 938 939 940
 * This function is called while unloading the kernel-module
 */
static void __exit usb_gigaset_exit(void)
{
T
Tilman Schmidt 已提交
941 942
	int i;

943
	gigaset_blockdriver(driver); /* => probe will fail
944 945
				      * => no gigaset_start any more
				      */
946

T
Tilman Schmidt 已提交
947 948 949 950
	/* stop all connected devices */
	for (i = 0; i < driver->minors; i++)
		gigaset_shutdown(driver->cs + i);

951 952 953 954 955 956 957 958 959 960 961 962 963 964 965 966 967 968 969
	/* 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");