Commit | Line | Data |
---|---|---|
07dc1f9f HL |
1 | /* |
2 | * USB driver for Gigaset 307x directly or using M105 Data. | |
3 | * | |
70440cf2 | 4 | * Copyright (c) 2001 by Stefan Eilers |
07dc1f9f HL |
5 | * and Hansjoerg Lipp <hjlipp@web.de>. |
6 | * | |
7 | * This driver was derived from the USB skeleton driver by | |
8 | * Greg Kroah-Hartman <greg@kroah.com> | |
9 | * | |
10 | * ===================================================================== | |
11 | * This program is free software; you can redistribute it and/or | |
12 | * modify it under the terms of the GNU General Public License as | |
13 | * published by the Free Software Foundation; either version 2 of | |
14 | * the License, or (at your option) any later version. | |
15 | * ===================================================================== | |
07dc1f9f HL |
16 | */ |
17 | ||
18 | #include "gigaset.h" | |
19 | ||
20 | #include <linux/errno.h> | |
21 | #include <linux/init.h> | |
22 | #include <linux/slab.h> | |
23 | #include <linux/usb.h> | |
24 | #include <linux/module.h> | |
25 | #include <linux/moduleparam.h> | |
26 | ||
27 | /* Version Information */ | |
70440cf2 | 28 | #define DRIVER_AUTHOR "Hansjoerg Lipp <hjlipp@web.de>, Stefan Eilers" |
07dc1f9f HL |
29 | #define DRIVER_DESC "USB Driver for Gigaset 307x using M105" |
30 | ||
31 | /* Module parameters */ | |
32 | ||
33 | static int startmode = SM_ISDN; | |
34 | static int cidmode = 1; | |
35 | ||
36 | module_param(startmode, int, S_IRUGO); | |
37 | module_param(cidmode, int, S_IRUGO); | |
38 | MODULE_PARM_DESC(startmode, "start in isdn4linux mode"); | |
39 | MODULE_PARM_DESC(cidmode, "Call-ID mode"); | |
40 | ||
41 | #define GIGASET_MINORS 1 | |
42 | #define GIGASET_MINOR 8 | |
43 | #define GIGASET_MODULENAME "usb_gigaset" | |
07dc1f9f HL |
44 | #define GIGASET_DEVNAME "ttyGU" |
45 | ||
46 | #define IF_WRITEBUF 2000 //FIXME // WAKEUP_CHARS: 256 | |
47 | ||
48 | /* Values for the Gigaset M105 Data */ | |
49 | #define USB_M105_VENDOR_ID 0x0681 | |
50 | #define USB_M105_PRODUCT_ID 0x0009 | |
51 | ||
52 | /* table of devices that work with this driver */ | |
35dc8457 | 53 | static const struct usb_device_id gigaset_table [] = { |
07dc1f9f HL |
54 | { USB_DEVICE(USB_M105_VENDOR_ID, USB_M105_PRODUCT_ID) }, |
55 | { } /* Terminating entry */ | |
56 | }; | |
57 | ||
58 | MODULE_DEVICE_TABLE(usb, gigaset_table); | |
59 | ||
07dc1f9f HL |
60 | /* |
61 | * Control requests (empty fields: 00) | |
62 | * | |
63 | * RT|RQ|VALUE|INDEX|LEN |DATA | |
64 | * In: | |
65 | * C1 08 01 | |
66 | * Get flags (1 byte). Bits: 0=dtr,1=rts,3-7:? | |
67 | * C1 0F ll ll | |
68 | * Get device information/status (llll: 0x200 and 0x40 seen). | |
69 | * Real size: I only saw MIN(llll,0x64). | |
70 | * Contents: seems to be always the same... | |
71 | * offset 0x00: Length of this structure (0x64) (len: 1,2,3 bytes) | |
72 | * offset 0x3c: String (16 bit chars): "MCCI USB Serial V2.0" | |
73 | * rest: ? | |
74 | * Out: | |
75 | * 41 11 | |
76 | * Initialize/reset device ? | |
77 | * 41 00 xx 00 | |
78 | * ? (xx=00 or 01; 01 on start, 00 on close) | |
79 | * 41 07 vv mm | |
80 | * Set/clear flags vv=value, mm=mask (see RQ 08) | |
81 | * 41 12 xx | |
82 | * Used before the following configuration requests are issued | |
83 | * (with xx=0x0f). I've seen other values<0xf, though. | |
84 | * 41 01 xx xx | |
85 | * Set baud rate. xxxx=ceil(0x384000/rate)=trunc(0x383fff/rate)+1. | |
86 | * 41 03 ps bb | |
87 | * Set byte size and parity. p: 0x20=even,0x10=odd,0x00=no parity | |
88 | * [ 0x30: m, 0x40: s ] | |
89 | * [s: 0: 1 stop bit; 1: 1.5; 2: 2] | |
90 | * bb: bits/byte (seen 7 and 8) | |
91 | * 41 13 -- -- -- -- 10 00 ww 00 00 00 xx 00 00 00 yy 00 00 00 zz 00 00 00 | |
92 | * ?? | |
93 | * Initialization: 01, 40, 00, 00 | |
94 | * Open device: 00 40, 00, 00 | |
95 | * yy and zz seem to be equal, either 0x00 or 0x0a | |
96 | * (ww,xx) pairs seen: (00,00), (00,40), (01,40), (09,80), (19,80) | |
97 | * 41 19 -- -- -- -- 06 00 00 00 00 xx 11 13 | |
98 | * Used after every "configuration sequence" (RQ 12, RQs 01/03/13). | |
99 | * xx is usually 0x00 but was 0x7e before starting data transfer | |
100 | * in unimodem mode. So, this might be an array of characters that need | |
101 | * special treatment ("commit all bufferd data"?), 11=^Q, 13=^S. | |
102 | * | |
103 | * Unimodem mode: use "modprobe ppp_async flag_time=0" as the device _needs_ two | |
104 | * flags per packet. | |
105 | */ | |
106 | ||
107 | static int gigaset_probe(struct usb_interface *interface, | |
784d5858 | 108 | const struct usb_device_id *id); |
07dc1f9f HL |
109 | static void gigaset_disconnect(struct usb_interface *interface); |
110 | ||
111 | static struct gigaset_driver *driver = NULL; | |
112 | static struct cardstate *cardstate = NULL; | |
113 | ||
114 | /* usb specific object needed to register this driver with the usb subsystem */ | |
115 | static struct usb_driver gigaset_usb_driver = { | |
917f5085 TS |
116 | .name = GIGASET_MODULENAME, |
117 | .probe = gigaset_probe, | |
118 | .disconnect = gigaset_disconnect, | |
119 | .id_table = gigaset_table, | |
07dc1f9f HL |
120 | }; |
121 | ||
122 | struct usb_cardstate { | |
917f5085 TS |
123 | struct usb_device *udev; /* usb device pointer */ |
124 | struct usb_interface *interface; /* interface for this device */ | |
125 | atomic_t busy; /* bulk output in progress */ | |
126 | ||
127 | /* Output buffer */ | |
784d5858 TS |
128 | unsigned char *bulk_out_buffer; |
129 | int bulk_out_size; | |
130 | __u8 bulk_out_endpointAddr; | |
131 | struct urb *bulk_out_urb; | |
917f5085 TS |
132 | |
133 | /* Input buffer */ | |
784d5858 TS |
134 | int rcvbuf_size; |
135 | struct urb *read_urb; | |
136 | __u8 int_in_endpointAddr; | |
917f5085 | 137 | |
784d5858 | 138 | char bchars[6]; /* for request 0x19 */ |
07dc1f9f HL |
139 | }; |
140 | ||
07dc1f9f HL |
141 | static inline unsigned tiocm_to_gigaset(unsigned state) |
142 | { | |
143 | return ((state & TIOCM_DTR) ? 1 : 0) | ((state & TIOCM_RTS) ? 2 : 0); | |
144 | } | |
145 | ||
146 | #ifdef CONFIG_GIGASET_UNDOCREQ | |
147 | /* WARNING: EXPERIMENTAL! */ | |
148 | static int gigaset_set_modem_ctrl(struct cardstate *cs, unsigned old_state, | |
784d5858 | 149 | unsigned new_state) |
07dc1f9f | 150 | { |
784d5858 | 151 | struct usb_device *udev = cs->hw.usb->udev; |
07dc1f9f HL |
152 | unsigned mask, val; |
153 | int r; | |
154 | ||
155 | mask = tiocm_to_gigaset(old_state ^ new_state); | |
156 | val = tiocm_to_gigaset(new_state); | |
157 | ||
784d5858 | 158 | gig_dbg(DEBUG_USBREQ, "set flags 0x%02x with mask 0x%02x", val, mask); |
917f5085 | 159 | // don't use this in an interrupt/BH |
784d5858 TS |
160 | r = usb_control_msg(udev, usb_sndctrlpipe(udev, 0), 7, 0x41, |
161 | (val & 0xff) | ((mask & 0xff) << 8), 0, | |
162 | NULL, 0, 2000 /* timeout? */); | |
07dc1f9f HL |
163 | if (r < 0) |
164 | return r; | |
165 | //.. | |
166 | return 0; | |
167 | } | |
168 | ||
169 | static int set_value(struct cardstate *cs, u8 req, u16 val) | |
170 | { | |
784d5858 | 171 | struct usb_device *udev = cs->hw.usb->udev; |
07dc1f9f HL |
172 | int r, r2; |
173 | ||
784d5858 TS |
174 | gig_dbg(DEBUG_USBREQ, "request %02x (%04x)", |
175 | (unsigned)req, (unsigned)val); | |
176 | r = usb_control_msg(udev, usb_sndctrlpipe(udev, 0), 0x12, 0x41, | |
177 | 0xf /*?*/, 0, NULL, 0, 2000 /*?*/); | |
178 | /* no idea what this does */ | |
07dc1f9f | 179 | if (r < 0) { |
784d5858 | 180 | dev_err(&udev->dev, "error %d on request 0x12\n", -r); |
07dc1f9f HL |
181 | return r; |
182 | } | |
183 | ||
784d5858 TS |
184 | r = usb_control_msg(udev, usb_sndctrlpipe(udev, 0), req, 0x41, |
185 | val, 0, NULL, 0, 2000 /*?*/); | |
07dc1f9f | 186 | if (r < 0) |
784d5858 TS |
187 | dev_err(&udev->dev, "error %d on request 0x%02x\n", |
188 | -r, (unsigned)req); | |
07dc1f9f | 189 | |
784d5858 TS |
190 | r2 = usb_control_msg(udev, usb_sndctrlpipe(udev, 0), 0x19, 0x41, |
191 | 0, 0, cs->hw.usb->bchars, 6, 2000 /*?*/); | |
07dc1f9f | 192 | if (r2 < 0) |
784d5858 | 193 | dev_err(&udev->dev, "error %d on request 0x19\n", -r2); |
07dc1f9f HL |
194 | |
195 | return r < 0 ? r : (r2 < 0 ? r2 : 0); | |
196 | } | |
197 | ||
198 | /* WARNING: HIGHLY EXPERIMENTAL! */ | |
199 | // don't use this in an interrupt/BH | |
200 | static int gigaset_baud_rate(struct cardstate *cs, unsigned cflag) | |
201 | { | |
202 | u16 val; | |
203 | u32 rate; | |
204 | ||
205 | cflag &= CBAUD; | |
206 | ||
207 | switch (cflag) { | |
208 | //FIXME more values? | |
209 | case B300: rate = 300; break; | |
210 | case B600: rate = 600; break; | |
211 | case B1200: rate = 1200; break; | |
212 | case B2400: rate = 2400; break; | |
213 | case B4800: rate = 4800; break; | |
214 | case B9600: rate = 9600; break; | |
215 | case B19200: rate = 19200; break; | |
216 | case B38400: rate = 38400; break; | |
217 | case B57600: rate = 57600; break; | |
218 | case B115200: rate = 115200; break; | |
219 | default: | |
220 | rate = 9600; | |
784d5858 TS |
221 | dev_err(cs->dev, "unsupported baudrate request 0x%x," |
222 | " using default of B9600\n", cflag); | |
07dc1f9f HL |
223 | } |
224 | ||
225 | val = 0x383fff / rate + 1; | |
226 | ||
227 | return set_value(cs, 1, val); | |
228 | } | |
229 | ||
230 | /* WARNING: HIGHLY EXPERIMENTAL! */ | |
231 | // don't use this in an interrupt/BH | |
232 | static int gigaset_set_line_ctrl(struct cardstate *cs, unsigned cflag) | |
233 | { | |
234 | u16 val = 0; | |
235 | ||
236 | /* set the parity */ | |
237 | if (cflag & PARENB) | |
238 | val |= (cflag & PARODD) ? 0x10 : 0x20; | |
239 | ||
240 | /* set the number of data bits */ | |
241 | switch (cflag & CSIZE) { | |
242 | case CS5: | |
243 | val |= 5 << 8; break; | |
244 | case CS6: | |
245 | val |= 6 << 8; break; | |
246 | case CS7: | |
247 | val |= 7 << 8; break; | |
248 | case CS8: | |
249 | val |= 8 << 8; break; | |
250 | default: | |
784d5858 | 251 | dev_err(cs->dev, "CSIZE was not CS5-CS8, using default of 8\n"); |
07dc1f9f HL |
252 | val |= 8 << 8; |
253 | break; | |
254 | } | |
255 | ||
256 | /* set the number of stop bits */ | |
257 | if (cflag & CSTOPB) { | |
258 | if ((cflag & CSIZE) == CS5) | |
259 | val |= 1; /* 1.5 stop bits */ //FIXME is this okay? | |
260 | else | |
261 | val |= 2; /* 2 stop bits */ | |
262 | } | |
263 | ||
264 | return set_value(cs, 3, val); | |
265 | } | |
266 | ||
267 | #else | |
268 | static int gigaset_set_modem_ctrl(struct cardstate *cs, unsigned old_state, | |
784d5858 | 269 | unsigned new_state) |
07dc1f9f HL |
270 | { |
271 | return -EINVAL; | |
272 | } | |
273 | ||
274 | static int gigaset_set_line_ctrl(struct cardstate *cs, unsigned cflag) | |
275 | { | |
276 | return -EINVAL; | |
277 | } | |
278 | ||
279 | static int gigaset_baud_rate(struct cardstate *cs, unsigned cflag) | |
280 | { | |
281 | return -EINVAL; | |
282 | } | |
283 | #endif | |
284 | ||
285 | ||
286 | /*================================================================================================================*/ | |
287 | static int gigaset_init_bchannel(struct bc_state *bcs) | |
288 | { | |
289 | /* nothing to do for M10x */ | |
290 | gigaset_bchannel_up(bcs); | |
291 | return 0; | |
292 | } | |
293 | ||
294 | static int gigaset_close_bchannel(struct bc_state *bcs) | |
295 | { | |
296 | /* nothing to do for M10x */ | |
297 | gigaset_bchannel_down(bcs); | |
298 | return 0; | |
299 | } | |
300 | ||
07dc1f9f HL |
301 | static int write_modem(struct cardstate *cs); |
302 | static int send_cb(struct cardstate *cs, struct cmdbuf_t *cb); | |
303 | ||
304 | ||
917f5085 TS |
305 | /* Write tasklet handler: Continue sending current skb, or send command, or |
306 | * start sending an skb from the send queue. | |
07dc1f9f HL |
307 | */ |
308 | static void gigaset_modem_fill(unsigned long data) | |
309 | { | |
310 | struct cardstate *cs = (struct cardstate *) data; | |
311 | struct bc_state *bcs = &cs->bcs[0]; /* only one channel */ | |
312 | struct cmdbuf_t *cb; | |
07dc1f9f HL |
313 | int again; |
314 | ||
784d5858 | 315 | gig_dbg(DEBUG_OUTPUT, "modem_fill"); |
07dc1f9f HL |
316 | |
317 | if (atomic_read(&cs->hw.usb->busy)) { | |
784d5858 | 318 | gig_dbg(DEBUG_OUTPUT, "modem_fill: busy"); |
07dc1f9f HL |
319 | return; |
320 | } | |
321 | ||
322 | do { | |
323 | again = 0; | |
324 | if (!bcs->tx_skb) { /* no skb is being sent */ | |
07dc1f9f | 325 | cb = cs->cmdbuf; |
07dc1f9f | 326 | if (cb) { /* commands to send? */ |
784d5858 | 327 | gig_dbg(DEBUG_OUTPUT, "modem_fill: cb"); |
07dc1f9f | 328 | if (send_cb(cs, cb) < 0) { |
784d5858 TS |
329 | gig_dbg(DEBUG_OUTPUT, |
330 | "modem_fill: send_cb failed"); | |
917f5085 TS |
331 | again = 1; /* no callback will be |
332 | called! */ | |
07dc1f9f HL |
333 | } |
334 | } else { /* skbs to send? */ | |
335 | bcs->tx_skb = skb_dequeue(&bcs->squeue); | |
336 | if (bcs->tx_skb) | |
784d5858 TS |
337 | gig_dbg(DEBUG_INTR, |
338 | "Dequeued skb (Adr: %lx)!", | |
339 | (unsigned long) bcs->tx_skb); | |
07dc1f9f HL |
340 | } |
341 | } | |
342 | ||
343 | if (bcs->tx_skb) { | |
784d5858 | 344 | gig_dbg(DEBUG_OUTPUT, "modem_fill: tx_skb"); |
07dc1f9f | 345 | if (write_modem(cs) < 0) { |
784d5858 TS |
346 | gig_dbg(DEBUG_OUTPUT, |
347 | "modem_fill: write_modem failed"); | |
07dc1f9f HL |
348 | // FIXME should we tell the LL? |
349 | again = 1; /* no callback will be called! */ | |
350 | } | |
351 | } | |
352 | } while (again); | |
353 | } | |
354 | ||
355 | /** | |
356 | * gigaset_read_int_callback | |
357 | * | |
784d5858 | 358 | * It is called if the data was received from the device. |
07dc1f9f | 359 | */ |
7d12e780 | 360 | static void gigaset_read_int_callback(struct urb *urb) |
07dc1f9f | 361 | { |
d48c7784 TS |
362 | struct inbuf_t *inbuf = urb->context; |
363 | struct cardstate *cs = inbuf->cs; | |
07dc1f9f HL |
364 | int resubmit = 0; |
365 | int r; | |
07dc1f9f HL |
366 | unsigned numbytes; |
367 | unsigned char *src; | |
69049cc8 | 368 | unsigned long flags; |
07dc1f9f HL |
369 | |
370 | if (!urb->status) { | |
69049cc8 TS |
371 | if (!cs->connected) { |
372 | err("%s: disconnected", __func__); /* should never happen */ | |
373 | return; | |
374 | } | |
375 | ||
07dc1f9f HL |
376 | numbytes = urb->actual_length; |
377 | ||
378 | if (numbytes) { | |
379 | src = inbuf->rcvbuf; | |
380 | if (unlikely(*src)) | |
784d5858 TS |
381 | dev_warn(cs->dev, |
382 | "%s: There was no leading 0, but 0x%02x!\n", | |
383 | __func__, (unsigned) *src); | |
07dc1f9f HL |
384 | ++src; /* skip leading 0x00 */ |
385 | --numbytes; | |
386 | if (gigaset_fill_inbuf(inbuf, src, numbytes)) { | |
784d5858 | 387 | gig_dbg(DEBUG_INTR, "%s-->BH", __func__); |
07dc1f9f HL |
388 | gigaset_schedule_event(inbuf->cs); |
389 | } | |
390 | } else | |
784d5858 | 391 | gig_dbg(DEBUG_INTR, "Received zero block length"); |
07dc1f9f HL |
392 | resubmit = 1; |
393 | } else { | |
394 | /* The urb might have been killed. */ | |
784d5858 TS |
395 | gig_dbg(DEBUG_ANY, "%s - nonzero read bulk status received: %d", |
396 | __func__, urb->status); | |
69049cc8 TS |
397 | if (urb->status != -ENOENT) { /* not killed */ |
398 | if (!cs->connected) { | |
399 | err("%s: disconnected", __func__); /* should never happen */ | |
400 | return; | |
401 | } | |
07dc1f9f | 402 | resubmit = 1; |
69049cc8 | 403 | } |
07dc1f9f | 404 | } |
784d5858 | 405 | |
07dc1f9f | 406 | if (resubmit) { |
69049cc8 | 407 | spin_lock_irqsave(&cs->lock, flags); |
54e6ecb2 | 408 | r = cs->connected ? usb_submit_urb(urb, GFP_ATOMIC) : -ENODEV; |
69049cc8 | 409 | spin_unlock_irqrestore(&cs->lock, flags); |
07dc1f9f | 410 | if (r) |
784d5858 TS |
411 | dev_err(cs->dev, "error %d when resubmitting urb.\n", |
412 | -r); | |
07dc1f9f HL |
413 | } |
414 | } | |
415 | ||
416 | ||
917f5085 | 417 | /* This callback routine is called when data was transmitted to the device. */ |
7d12e780 | 418 | static void gigaset_write_bulk_callback(struct urb *urb) |
07dc1f9f | 419 | { |
d48c7784 | 420 | struct cardstate *cs = urb->context; |
69049cc8 | 421 | unsigned long flags; |
07dc1f9f | 422 | |
07dc1f9f | 423 | if (urb->status) |
784d5858 TS |
424 | dev_err(cs->dev, "bulk transfer failed (status %d)\n", |
425 | -urb->status); | |
917f5085 | 426 | /* That's all we can do. Communication problems |
784d5858 | 427 | are handled by timeouts or network protocols. */ |
07dc1f9f | 428 | |
69049cc8 TS |
429 | spin_lock_irqsave(&cs->lock, flags); |
430 | if (!cs->connected) { | |
431 | err("%s: not connected", __func__); | |
432 | } else { | |
433 | atomic_set(&cs->hw.usb->busy, 0); | |
434 | tasklet_schedule(&cs->write_tasklet); | |
435 | } | |
436 | spin_unlock_irqrestore(&cs->lock, flags); | |
07dc1f9f HL |
437 | } |
438 | ||
439 | static int send_cb(struct cardstate *cs, struct cmdbuf_t *cb) | |
440 | { | |
441 | struct cmdbuf_t *tcb; | |
442 | unsigned long flags; | |
443 | int count; | |
444 | int status = -ENOENT; // FIXME | |
445 | struct usb_cardstate *ucs = cs->hw.usb; | |
446 | ||
447 | do { | |
448 | if (!cb->len) { | |
449 | tcb = cb; | |
450 | ||
451 | spin_lock_irqsave(&cs->cmdlock, flags); | |
452 | cs->cmdbytes -= cs->curlen; | |
784d5858 TS |
453 | gig_dbg(DEBUG_OUTPUT, "send_cb: sent %u bytes, %u left", |
454 | cs->curlen, cs->cmdbytes); | |
07dc1f9f HL |
455 | cs->cmdbuf = cb = cb->next; |
456 | if (cb) { | |
457 | cb->prev = NULL; | |
458 | cs->curlen = cb->len; | |
459 | } else { | |
460 | cs->lastcmdbuf = NULL; | |
461 | cs->curlen = 0; | |
462 | } | |
463 | spin_unlock_irqrestore(&cs->cmdlock, flags); | |
464 | ||
465 | if (tcb->wake_tasklet) | |
466 | tasklet_schedule(tcb->wake_tasklet); | |
467 | kfree(tcb); | |
468 | } | |
469 | if (cb) { | |
470 | count = min(cb->len, ucs->bulk_out_size); | |
69049cc8 TS |
471 | gig_dbg(DEBUG_OUTPUT, "send_cb: send %d bytes", count); |
472 | ||
07dc1f9f | 473 | usb_fill_bulk_urb(ucs->bulk_out_urb, ucs->udev, |
784d5858 TS |
474 | usb_sndbulkpipe(ucs->udev, |
475 | ucs->bulk_out_endpointAddr & 0x0f), | |
476 | cb->buf + cb->offset, count, | |
477 | gigaset_write_bulk_callback, cs); | |
07dc1f9f HL |
478 | |
479 | cb->offset += count; | |
480 | cb->len -= count; | |
481 | atomic_set(&ucs->busy, 1); | |
07dc1f9f | 482 | |
69049cc8 | 483 | spin_lock_irqsave(&cs->lock, flags); |
54e6ecb2 | 484 | status = cs->connected ? usb_submit_urb(ucs->bulk_out_urb, GFP_ATOMIC) : -ENODEV; |
69049cc8 TS |
485 | spin_unlock_irqrestore(&cs->lock, flags); |
486 | ||
07dc1f9f HL |
487 | if (status) { |
488 | atomic_set(&ucs->busy, 0); | |
69049cc8 TS |
489 | err("could not submit urb (error %d)\n", |
490 | -status); | |
917f5085 TS |
491 | cb->len = 0; /* skip urb => remove cb+wakeup |
492 | in next loop cycle */ | |
07dc1f9f HL |
493 | } |
494 | } | |
917f5085 | 495 | } while (cb && status); /* next command on error */ |
07dc1f9f HL |
496 | |
497 | return status; | |
498 | } | |
499 | ||
917f5085 | 500 | /* Send command to device. */ |
07dc1f9f | 501 | static int gigaset_write_cmd(struct cardstate *cs, const unsigned char *buf, |
784d5858 | 502 | int len, struct tasklet_struct *wake_tasklet) |
07dc1f9f HL |
503 | { |
504 | struct cmdbuf_t *cb; | |
505 | unsigned long flags; | |
506 | ||
507 | gigaset_dbg_buffer(atomic_read(&cs->mstate) != MS_LOCKED ? | |
784d5858 | 508 | DEBUG_TRANSCMD : DEBUG_LOCKCMD, |
01371500 | 509 | "CMD Transmit", len, buf); |
07dc1f9f | 510 | |
07dc1f9f HL |
511 | if (len <= 0) |
512 | return 0; | |
513 | ||
514 | if (!(cb = kmalloc(sizeof(struct cmdbuf_t) + len, GFP_ATOMIC))) { | |
784d5858 | 515 | dev_err(cs->dev, "%s: out of memory\n", __func__); |
07dc1f9f HL |
516 | return -ENOMEM; |
517 | } | |
518 | ||
519 | memcpy(cb->buf, buf, len); | |
520 | cb->len = len; | |
521 | cb->offset = 0; | |
522 | cb->next = NULL; | |
523 | cb->wake_tasklet = wake_tasklet; | |
524 | ||
525 | spin_lock_irqsave(&cs->cmdlock, flags); | |
526 | cb->prev = cs->lastcmdbuf; | |
527 | if (cs->lastcmdbuf) | |
528 | cs->lastcmdbuf->next = cb; | |
529 | else { | |
530 | cs->cmdbuf = cb; | |
531 | cs->curlen = len; | |
532 | } | |
533 | cs->cmdbytes += len; | |
534 | cs->lastcmdbuf = cb; | |
535 | spin_unlock_irqrestore(&cs->cmdlock, flags); | |
536 | ||
69049cc8 TS |
537 | spin_lock_irqsave(&cs->lock, flags); |
538 | if (cs->connected) | |
539 | tasklet_schedule(&cs->write_tasklet); | |
540 | spin_unlock_irqrestore(&cs->lock, flags); | |
07dc1f9f HL |
541 | return len; |
542 | } | |
543 | ||
544 | static int gigaset_write_room(struct cardstate *cs) | |
545 | { | |
07dc1f9f HL |
546 | unsigned bytes; |
547 | ||
07dc1f9f | 548 | bytes = cs->cmdbytes; |
07dc1f9f HL |
549 | return bytes < IF_WRITEBUF ? IF_WRITEBUF - bytes : 0; |
550 | } | |
551 | ||
552 | static int gigaset_chars_in_buffer(struct cardstate *cs) | |
553 | { | |
554 | return cs->cmdbytes; | |
555 | } | |
556 | ||
557 | static int gigaset_brkchars(struct cardstate *cs, const unsigned char buf[6]) | |
558 | { | |
559 | #ifdef CONFIG_GIGASET_UNDOCREQ | |
784d5858 TS |
560 | struct usb_device *udev = cs->hw.usb->udev; |
561 | ||
01371500 | 562 | gigaset_dbg_buffer(DEBUG_USBREQ, "brkchars", 6, buf); |
07dc1f9f | 563 | memcpy(cs->hw.usb->bchars, buf, 6); |
784d5858 TS |
564 | return usb_control_msg(udev, usb_sndctrlpipe(udev, 0), 0x19, 0x41, |
565 | 0, 0, &buf, 6, 2000); | |
07dc1f9f HL |
566 | #else |
567 | return -EINVAL; | |
568 | #endif | |
569 | } | |
570 | ||
571 | static int gigaset_freebcshw(struct bc_state *bcs) | |
572 | { | |
21d36495 | 573 | /* unused */ |
07dc1f9f HL |
574 | return 1; |
575 | } | |
576 | ||
577 | /* Initialize the b-channel structure */ | |
578 | static int gigaset_initbcshw(struct bc_state *bcs) | |
579 | { | |
21d36495 TS |
580 | /* unused */ |
581 | bcs->hw.usb = NULL; | |
07dc1f9f HL |
582 | return 1; |
583 | } | |
584 | ||
585 | static void gigaset_reinitbcshw(struct bc_state *bcs) | |
586 | { | |
21d36495 | 587 | /* nothing to do for M10x */ |
07dc1f9f HL |
588 | } |
589 | ||
590 | static void gigaset_freecshw(struct cardstate *cs) | |
591 | { | |
07dc1f9f HL |
592 | tasklet_kill(&cs->write_tasklet); |
593 | kfree(cs->hw.usb); | |
594 | } | |
595 | ||
596 | static int gigaset_initcshw(struct cardstate *cs) | |
597 | { | |
598 | struct usb_cardstate *ucs; | |
599 | ||
600 | cs->hw.usb = ucs = | |
601 | kmalloc(sizeof(struct usb_cardstate), GFP_KERNEL); | |
602 | if (!ucs) | |
603 | return 0; | |
604 | ||
605 | ucs->bchars[0] = 0; | |
606 | ucs->bchars[1] = 0; | |
607 | ucs->bchars[2] = 0; | |
608 | ucs->bchars[3] = 0; | |
609 | ucs->bchars[4] = 0x11; | |
610 | ucs->bchars[5] = 0x13; | |
611 | ucs->bulk_out_buffer = NULL; | |
612 | ucs->bulk_out_urb = NULL; | |
613 | //ucs->urb_cmd_out = NULL; | |
614 | ucs->read_urb = NULL; | |
615 | tasklet_init(&cs->write_tasklet, | |
784d5858 | 616 | &gigaset_modem_fill, (unsigned long) cs); |
07dc1f9f HL |
617 | |
618 | return 1; | |
619 | } | |
620 | ||
917f5085 | 621 | /* Send data from current skb to the device. */ |
07dc1f9f HL |
622 | static int write_modem(struct cardstate *cs) |
623 | { | |
d48c7784 | 624 | int ret = 0; |
07dc1f9f HL |
625 | int count; |
626 | struct bc_state *bcs = &cs->bcs[0]; /* only one channel */ | |
627 | struct usb_cardstate *ucs = cs->hw.usb; | |
69049cc8 | 628 | unsigned long flags; |
07dc1f9f | 629 | |
784d5858 | 630 | gig_dbg(DEBUG_WRITE, "len: %d...", bcs->tx_skb->len); |
07dc1f9f | 631 | |
07dc1f9f HL |
632 | if (!bcs->tx_skb->len) { |
633 | dev_kfree_skb_any(bcs->tx_skb); | |
634 | bcs->tx_skb = NULL; | |
635 | return -EINVAL; | |
636 | } | |
637 | ||
638 | /* Copy data to bulk out buffer and // FIXME copying not necessary | |
639 | * transmit data | |
640 | */ | |
641 | count = min(bcs->tx_skb->len, (unsigned) ucs->bulk_out_size); | |
d626f62b | 642 | skb_copy_from_linear_data(bcs->tx_skb, ucs->bulk_out_buffer, count); |
07dc1f9f | 643 | skb_pull(bcs->tx_skb, count); |
07dc1f9f | 644 | atomic_set(&ucs->busy, 1); |
784d5858 | 645 | gig_dbg(DEBUG_OUTPUT, "write_modem: send %d bytes", count); |
07dc1f9f | 646 | |
69049cc8 TS |
647 | spin_lock_irqsave(&cs->lock, flags); |
648 | if (cs->connected) { | |
649 | usb_fill_bulk_urb(ucs->bulk_out_urb, ucs->udev, | |
650 | usb_sndbulkpipe(ucs->udev, | |
651 | ucs->bulk_out_endpointAddr & 0x0f), | |
652 | ucs->bulk_out_buffer, count, | |
653 | gigaset_write_bulk_callback, cs); | |
54e6ecb2 | 654 | ret = usb_submit_urb(ucs->bulk_out_urb, GFP_ATOMIC); |
69049cc8 TS |
655 | } else { |
656 | ret = -ENODEV; | |
657 | } | |
658 | spin_unlock_irqrestore(&cs->lock, flags); | |
659 | ||
07dc1f9f | 660 | if (ret) { |
69049cc8 | 661 | err("could not submit urb (error %d)\n", -ret); |
07dc1f9f HL |
662 | atomic_set(&ucs->busy, 0); |
663 | } | |
69049cc8 | 664 | |
07dc1f9f HL |
665 | if (!bcs->tx_skb->len) { |
666 | /* skb sent completely */ | |
667 | gigaset_skb_sent(bcs, bcs->tx_skb); //FIXME also, when ret<0? | |
668 | ||
784d5858 TS |
669 | gig_dbg(DEBUG_INTR, "kfree skb (Adr: %lx)!", |
670 | (unsigned long) bcs->tx_skb); | |
07dc1f9f HL |
671 | dev_kfree_skb_any(bcs->tx_skb); |
672 | bcs->tx_skb = NULL; | |
673 | } | |
674 | ||
675 | return ret; | |
07dc1f9f HL |
676 | } |
677 | ||
678 | static int gigaset_probe(struct usb_interface *interface, | |
784d5858 | 679 | const struct usb_device_id *id) |
07dc1f9f HL |
680 | { |
681 | int retval; | |
682 | struct usb_device *udev = interface_to_usbdev(interface); | |
683 | unsigned int ifnum; | |
684 | struct usb_host_interface *hostif; | |
685 | struct cardstate *cs = NULL; | |
686 | struct usb_cardstate *ucs = NULL; | |
07dc1f9f | 687 | struct usb_endpoint_descriptor *endpoint; |
07dc1f9f HL |
688 | int buffer_size; |
689 | int alt; | |
07dc1f9f | 690 | |
784d5858 TS |
691 | gig_dbg(DEBUG_ANY, |
692 | "%s: Check if device matches .. (Vendor: 0x%x, Product: 0x%x)", | |
693 | __func__, le16_to_cpu(udev->descriptor.idVendor), | |
694 | le16_to_cpu(udev->descriptor.idProduct)); | |
07dc1f9f HL |
695 | |
696 | retval = -ENODEV; //FIXME | |
697 | ||
698 | /* See if the device offered us matches what we can accept */ | |
bfe2e934 AD |
699 | if ((le16_to_cpu(udev->descriptor.idVendor) != USB_M105_VENDOR_ID) || |
700 | (le16_to_cpu(udev->descriptor.idProduct) != USB_M105_PRODUCT_ID)) | |
07dc1f9f HL |
701 | return -ENODEV; |
702 | ||
703 | /* this starts to become ascii art... */ | |
704 | hostif = interface->cur_altsetting; | |
705 | alt = hostif->desc.bAlternateSetting; | |
706 | ifnum = hostif->desc.bInterfaceNumber; // FIXME ? | |
707 | ||
708 | if (alt != 0 || ifnum != 0) { | |
784d5858 | 709 | dev_warn(&udev->dev, "ifnum %d, alt %d\n", ifnum, alt); |
07dc1f9f HL |
710 | return -ENODEV; |
711 | } | |
712 | ||
713 | /* Reject application specific intefaces | |
714 | * | |
715 | */ | |
716 | if (hostif->desc.bInterfaceClass != 255) { | |
784d5858 TS |
717 | dev_info(&udev->dev, |
718 | "%s: Device matched but iface_desc[%d]->bInterfaceClass==%d!\n", | |
719 | __func__, ifnum, hostif->desc.bInterfaceClass); | |
07dc1f9f HL |
720 | return -ENODEV; |
721 | } | |
722 | ||
784d5858 | 723 | dev_info(&udev->dev, "%s: Device matched ... !\n", __func__); |
07dc1f9f HL |
724 | |
725 | cs = gigaset_getunassignedcs(driver); | |
726 | if (!cs) { | |
784d5858 | 727 | dev_warn(&udev->dev, "no free cardstate\n"); |
07dc1f9f HL |
728 | return -ENODEV; |
729 | } | |
730 | ucs = cs->hw.usb; | |
731 | ||
784d5858 TS |
732 | /* save off device structure ptrs for later use */ |
733 | usb_get_dev(udev); | |
734 | ucs->udev = udev; | |
735 | ucs->interface = interface; | |
b1d47464 TS |
736 | cs->dev = &interface->dev; |
737 | ||
738 | /* save address of controller structure */ | |
739 | usb_set_intfdata(interface, cs); // dev_set_drvdata(&interface->dev, cs); | |
784d5858 | 740 | |
07dc1f9f HL |
741 | endpoint = &hostif->endpoint[0].desc; |
742 | ||
743 | buffer_size = le16_to_cpu(endpoint->wMaxPacketSize); | |
744 | ucs->bulk_out_size = buffer_size; | |
745 | ucs->bulk_out_endpointAddr = endpoint->bEndpointAddress; | |
746 | ucs->bulk_out_buffer = kmalloc(buffer_size, GFP_KERNEL); | |
747 | if (!ucs->bulk_out_buffer) { | |
784d5858 | 748 | dev_err(cs->dev, "Couldn't allocate bulk_out_buffer\n"); |
07dc1f9f HL |
749 | retval = -ENOMEM; |
750 | goto error; | |
751 | } | |
752 | ||
e94b1766 | 753 | ucs->bulk_out_urb = usb_alloc_urb(0, GFP_KERNEL); |
07dc1f9f | 754 | if (!ucs->bulk_out_urb) { |
784d5858 | 755 | dev_err(cs->dev, "Couldn't allocate bulk_out_urb\n"); |
07dc1f9f HL |
756 | retval = -ENOMEM; |
757 | goto error; | |
758 | } | |
759 | ||
760 | endpoint = &hostif->endpoint[1].desc; | |
761 | ||
762 | atomic_set(&ucs->busy, 0); | |
07dc1f9f | 763 | |
e94b1766 | 764 | ucs->read_urb = usb_alloc_urb(0, GFP_KERNEL); |
07dc1f9f | 765 | if (!ucs->read_urb) { |
784d5858 | 766 | dev_err(cs->dev, "No free urbs available\n"); |
07dc1f9f HL |
767 | retval = -ENOMEM; |
768 | goto error; | |
769 | } | |
770 | buffer_size = le16_to_cpu(endpoint->wMaxPacketSize); | |
771 | ucs->rcvbuf_size = buffer_size; | |
772 | ucs->int_in_endpointAddr = endpoint->bEndpointAddress; | |
773 | cs->inbuf[0].rcvbuf = kmalloc(buffer_size, GFP_KERNEL); | |
774 | if (!cs->inbuf[0].rcvbuf) { | |
784d5858 | 775 | dev_err(cs->dev, "Couldn't allocate rcvbuf\n"); |
07dc1f9f HL |
776 | retval = -ENOMEM; |
777 | goto error; | |
778 | } | |
779 | /* Fill the interrupt urb and send it to the core */ | |
780 | usb_fill_int_urb(ucs->read_urb, udev, | |
784d5858 TS |
781 | usb_rcvintpipe(udev, |
782 | endpoint->bEndpointAddress & 0x0f), | |
783 | cs->inbuf[0].rcvbuf, buffer_size, | |
784 | gigaset_read_int_callback, | |
785 | cs->inbuf + 0, endpoint->bInterval); | |
07dc1f9f | 786 | |
e94b1766 | 787 | retval = usb_submit_urb(ucs->read_urb, GFP_KERNEL); |
07dc1f9f | 788 | if (retval) { |
784d5858 | 789 | dev_err(cs->dev, "Could not submit URB (error %d)\n", -retval); |
07dc1f9f HL |
790 | goto error; |
791 | } | |
792 | ||
793 | /* tell common part that the device is ready */ | |
794 | if (startmode == SM_LOCKED) | |
795 | atomic_set(&cs->mstate, MS_LOCKED); | |
b1d47464 | 796 | |
07dc1f9f HL |
797 | if (!gigaset_start(cs)) { |
798 | tasklet_kill(&cs->write_tasklet); | |
799 | retval = -ENODEV; //FIXME | |
800 | goto error; | |
801 | } | |
07dc1f9f HL |
802 | return 0; |
803 | ||
804 | error: | |
ead54fcd | 805 | usb_kill_urb(ucs->read_urb); |
07dc1f9f | 806 | kfree(ucs->bulk_out_buffer); |
ead54fcd | 807 | usb_free_urb(ucs->bulk_out_urb); |
07dc1f9f | 808 | kfree(cs->inbuf[0].rcvbuf); |
ead54fcd | 809 | usb_free_urb(ucs->read_urb); |
b1d47464 | 810 | usb_set_intfdata(interface, NULL); |
07dc1f9f HL |
811 | ucs->read_urb = ucs->bulk_out_urb = NULL; |
812 | cs->inbuf[0].rcvbuf = ucs->bulk_out_buffer = NULL; | |
784d5858 TS |
813 | usb_put_dev(ucs->udev); |
814 | ucs->udev = NULL; | |
815 | ucs->interface = NULL; | |
07dc1f9f HL |
816 | gigaset_unassign(cs); |
817 | return retval; | |
818 | } | |
819 | ||
07dc1f9f HL |
820 | static void gigaset_disconnect(struct usb_interface *interface) |
821 | { | |
822 | struct cardstate *cs; | |
823 | struct usb_cardstate *ucs; | |
824 | ||
825 | cs = usb_get_intfdata(interface); | |
07dc1f9f HL |
826 | ucs = cs->hw.usb; |
827 | usb_kill_urb(ucs->read_urb); | |
07dc1f9f HL |
828 | |
829 | gigaset_stop(cs); | |
830 | ||
b1d47464 | 831 | usb_set_intfdata(interface, NULL); |
07dc1f9f HL |
832 | tasklet_kill(&cs->write_tasklet); |
833 | ||
784d5858 | 834 | usb_kill_urb(ucs->bulk_out_urb); /* FIXME: only if active? */ |
07dc1f9f HL |
835 | |
836 | kfree(ucs->bulk_out_buffer); | |
ead54fcd | 837 | usb_free_urb(ucs->bulk_out_urb); |
07dc1f9f | 838 | kfree(cs->inbuf[0].rcvbuf); |
ead54fcd | 839 | usb_free_urb(ucs->read_urb); |
917f5085 | 840 | ucs->read_urb = ucs->bulk_out_urb = NULL; |
07dc1f9f HL |
841 | cs->inbuf[0].rcvbuf = ucs->bulk_out_buffer = NULL; |
842 | ||
b1d47464 TS |
843 | usb_put_dev(ucs->udev); |
844 | ucs->interface = NULL; | |
845 | ucs->udev = NULL; | |
846 | cs->dev = NULL; | |
07dc1f9f HL |
847 | gigaset_unassign(cs); |
848 | } | |
849 | ||
35dc8457 | 850 | static const struct gigaset_ops ops = { |
07dc1f9f HL |
851 | gigaset_write_cmd, |
852 | gigaset_write_room, | |
853 | gigaset_chars_in_buffer, | |
854 | gigaset_brkchars, | |
855 | gigaset_init_bchannel, | |
856 | gigaset_close_bchannel, | |
857 | gigaset_initbcshw, | |
858 | gigaset_freebcshw, | |
859 | gigaset_reinitbcshw, | |
860 | gigaset_initcshw, | |
861 | gigaset_freecshw, | |
862 | gigaset_set_modem_ctrl, | |
863 | gigaset_baud_rate, | |
864 | gigaset_set_line_ctrl, | |
865 | gigaset_m10x_send_skb, | |
866 | gigaset_m10x_input, | |
867 | }; | |
868 | ||
869 | /** | |
870 | * usb_gigaset_init | |
871 | * This function is called while kernel-module is loaded | |
872 | */ | |
873 | static int __init usb_gigaset_init(void) | |
874 | { | |
875 | int result; | |
876 | ||
877 | /* allocate memory for our driver state and intialize it */ | |
878 | if ((driver = gigaset_initdriver(GIGASET_MINOR, GIGASET_MINORS, | |
784d5858 | 879 | GIGASET_MODULENAME, GIGASET_DEVNAME, |
f4eaa370 | 880 | &ops, THIS_MODULE)) == NULL) |
07dc1f9f HL |
881 | goto error; |
882 | ||
883 | /* allocate memory for our device state and intialize it */ | |
884 | cardstate = gigaset_initcs(driver, 1, 1, 0, cidmode, GIGASET_MODULENAME); | |
885 | if (!cardstate) | |
886 | goto error; | |
887 | ||
888 | /* register this driver with the USB subsystem */ | |
889 | result = usb_register(&gigaset_usb_driver); | |
890 | if (result < 0) { | |
891 | err("usb_gigaset: usb_register failed (error %d)", | |
892 | -result); | |
893 | goto error; | |
894 | } | |
895 | ||
896 | info(DRIVER_AUTHOR); | |
897 | info(DRIVER_DESC); | |
898 | return 0; | |
899 | ||
900 | error: if (cardstate) | |
901 | gigaset_freecs(cardstate); | |
902 | cardstate = NULL; | |
903 | if (driver) | |
904 | gigaset_freedriver(driver); | |
905 | driver = NULL; | |
906 | return -1; | |
907 | } | |
908 | ||
909 | ||
910 | /** | |
911 | * usb_gigaset_exit | |
912 | * This function is called while unloading the kernel-module | |
913 | */ | |
914 | static void __exit usb_gigaset_exit(void) | |
915 | { | |
916 | gigaset_blockdriver(driver); /* => probe will fail | |
784d5858 TS |
917 | * => no gigaset_start any more |
918 | */ | |
07dc1f9f HL |
919 | |
920 | gigaset_shutdown(cardstate); | |
921 | /* from now on, no isdn callback should be possible */ | |
922 | ||
923 | /* deregister this driver with the USB subsystem */ | |
924 | usb_deregister(&gigaset_usb_driver); | |
925 | /* this will call the disconnect-callback */ | |
926 | /* from now on, no disconnect/probe callback should be running */ | |
927 | ||
928 | gigaset_freecs(cardstate); | |
929 | cardstate = NULL; | |
930 | gigaset_freedriver(driver); | |
931 | driver = NULL; | |
932 | } | |
933 | ||
934 | ||
935 | module_init(usb_gigaset_init); | |
936 | module_exit(usb_gigaset_exit); | |
937 | ||
938 | MODULE_AUTHOR(DRIVER_AUTHOR); | |
939 | MODULE_DESCRIPTION(DRIVER_DESC); | |
940 | ||
941 | MODULE_LICENSE("GPL"); |