blob: 0b35f0d8be5fe534717f4764a4367f524d8b482d [file] [log] [blame]
Vamsi Krishna5b944712012-06-29 18:36:23 -07001/*
2 * Copyright (c) 2012, Code Aurora Forum. All rights reserved.
3 *
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU General Public License version 2 and
6 * only version 2 as published by the Free Software Foundation.
7 *
8 * This program is distributed in the hope that it will be useful,
9 * but WITHOUT ANY WARRANTY; without even the implied warranty of
10 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
11 * GNU General Public License for more details.
12 */
13
14/* add additional information to our printk's */
15#define pr_fmt(fmt) "%s: " fmt "\n", __func__
16
17#include <linux/kernel.h>
18#include <linux/errno.h>
19#include <linux/init.h>
20#include <linux/slab.h>
21#include <linux/module.h>
22#include <linux/kref.h>
23#include <linux/platform_device.h>
24#include <linux/ratelimit.h>
25#include <linux/uaccess.h>
26#include <linux/usb.h>
27#include <linux/debugfs.h>
28#include <linux/seq_file.h>
29#include <linux/miscdevice.h>
30#include <linux/list.h>
31#include <linux/wait.h>
32
33#define DRIVER_DESC "USB host ks bridge driver"
34#define DRIVER_VERSION "1.0"
35
36struct data_pkt {
37 int n_read;
38 char *buf;
39 size_t len;
40 struct list_head list;
41 void *ctxt;
42};
43
44#define FILE_OPENED BIT(0)
45#define USB_DEV_CONNECTED BIT(1)
46#define NO_RX_REQS 10
47#define NO_BRIDGE_INSTANCES 2
48#define BOOT_BRIDGE_INDEX 0
49#define EFS_BRIDGE_INDEX 1
50#define MAX_DATA_PKT_SIZE 16384
51
52struct ks_bridge {
53 char *name;
54 spinlock_t lock;
55 struct workqueue_struct *wq;
56 struct work_struct to_mdm_work;
57 struct work_struct start_rx_work;
58 struct list_head to_mdm_list;
59 struct list_head to_ks_list;
60 wait_queue_head_t ks_wait_q;
Hemant Kumar38980ec42012-08-24 19:42:31 -070061 struct miscdevice *fs_dev;
Vamsi Krishna5b944712012-06-29 18:36:23 -070062
63 /* usb specific */
64 struct usb_device *udev;
65 struct usb_interface *ifc;
66 __u8 in_epAddr;
67 __u8 out_epAddr;
68 unsigned int in_pipe;
69 unsigned int out_pipe;
70 struct usb_anchor submitted;
71
72 unsigned long flags;
Vamsi Krishna5b944712012-06-29 18:36:23 -070073
74#define DBG_MSG_LEN 40
75#define DBG_MAX_MSG 500
76 unsigned int dbg_idx;
77 rwlock_t dbg_lock;
78 char (dbgbuf[DBG_MAX_MSG])[DBG_MSG_LEN]; /* buffer */
79};
80struct ks_bridge *__ksb[NO_BRIDGE_INSTANCES];
81
82/* by default debugging is enabled */
83static unsigned int enable_dbg = 1;
84module_param(enable_dbg, uint, S_IRUGO | S_IWUSR);
85
86static void
87dbg_log_event(struct ks_bridge *ksb, char *event, int d1, int d2)
88{
89 unsigned long flags;
90 unsigned long long t;
91 unsigned long nanosec;
92
93 if (!enable_dbg)
94 return;
95
96 write_lock_irqsave(&ksb->dbg_lock, flags);
97 t = cpu_clock(smp_processor_id());
98 nanosec = do_div(t, 1000000000)/1000;
99 scnprintf(ksb->dbgbuf[ksb->dbg_idx], DBG_MSG_LEN, "%5lu.%06lu:%s:%x:%x",
100 (unsigned long)t, nanosec, event, d1, d2);
101
102 ksb->dbg_idx++;
103 ksb->dbg_idx = ksb->dbg_idx % DBG_MAX_MSG;
104 write_unlock_irqrestore(&ksb->dbg_lock, flags);
105}
106
107static
108struct data_pkt *ksb_alloc_data_pkt(size_t count, gfp_t flags, void *ctxt)
109{
110 struct data_pkt *pkt;
111
112 pkt = kzalloc(sizeof(struct data_pkt), flags);
113 if (!pkt) {
114 pr_err("failed to allocate data packet\n");
115 return ERR_PTR(-ENOMEM);
116 }
117
118 pkt->buf = kmalloc(count, flags);
119 if (!pkt->buf) {
120 pr_err("failed to allocate data buffer\n");
121 kfree(pkt);
122 return ERR_PTR(-ENOMEM);
123 }
124
125 pkt->len = count;
126 INIT_LIST_HEAD(&pkt->list);
127 pkt->ctxt = ctxt;
128
129 return pkt;
130}
131
132static void ksb_free_data_pkt(struct data_pkt *pkt)
133{
134 kfree(pkt->buf);
135 kfree(pkt);
136}
137
138
Pavankumar Kondeti009bbd62012-12-14 15:12:46 +0530139static void
140submit_one_urb(struct ks_bridge *ksb, gfp_t flags, struct data_pkt *pkt);
Vamsi Krishna5b944712012-06-29 18:36:23 -0700141static ssize_t ksb_fs_read(struct file *fp, char __user *buf,
142 size_t count, loff_t *pos)
143{
144 int ret;
145 unsigned long flags;
146 struct ks_bridge *ksb = fp->private_data;
147 struct data_pkt *pkt;
148 size_t space, copied;
149
150read_start:
151 if (!test_bit(USB_DEV_CONNECTED, &ksb->flags))
152 return -ENODEV;
153
154 spin_lock_irqsave(&ksb->lock, flags);
155 if (list_empty(&ksb->to_ks_list)) {
156 spin_unlock_irqrestore(&ksb->lock, flags);
157 ret = wait_event_interruptible(ksb->ks_wait_q,
158 !list_empty(&ksb->to_ks_list) ||
159 !test_bit(USB_DEV_CONNECTED, &ksb->flags));
160 if (ret < 0)
161 return ret;
162
163 goto read_start;
164 }
165
166 space = count;
167 copied = 0;
168 while (!list_empty(&ksb->to_ks_list) && space) {
169 size_t len;
170
171 pkt = list_first_entry(&ksb->to_ks_list, struct data_pkt, list);
Hemant Kumard45f96c2012-09-24 12:32:32 -0700172 len = min_t(size_t, space, pkt->len - pkt->n_read);
Vamsi Krishna5b944712012-06-29 18:36:23 -0700173 spin_unlock_irqrestore(&ksb->lock, flags);
174
Hemant Kumard45f96c2012-09-24 12:32:32 -0700175 ret = copy_to_user(buf + copied, pkt->buf + pkt->n_read, len);
Vamsi Krishna5b944712012-06-29 18:36:23 -0700176 if (ret) {
177 pr_err("copy_to_user failed err:%d\n", ret);
178 ksb_free_data_pkt(pkt);
Vamsi Krishna5b944712012-06-29 18:36:23 -0700179 return ret;
180 }
181
Hemant Kumard45f96c2012-09-24 12:32:32 -0700182 pkt->n_read += len;
Vamsi Krishna5b944712012-06-29 18:36:23 -0700183 space -= len;
184 copied += len;
185
186 spin_lock_irqsave(&ksb->lock, flags);
187 if (pkt->n_read == pkt->len) {
Pavankumar Kondeti009bbd62012-12-14 15:12:46 +0530188 /*
189 * re-init the packet and queue it
190 * for more data.
191 */
Vamsi Krishna5b944712012-06-29 18:36:23 -0700192 list_del_init(&pkt->list);
Pavankumar Kondeti009bbd62012-12-14 15:12:46 +0530193 pkt->n_read = 0;
194 pkt->len = MAX_DATA_PKT_SIZE;
195 spin_unlock_irqrestore(&ksb->lock, flags);
196 submit_one_urb(ksb, GFP_KERNEL, pkt);
197 spin_lock_irqsave(&ksb->lock, flags);
Vamsi Krishna5b944712012-06-29 18:36:23 -0700198 }
199 }
200 spin_unlock_irqrestore(&ksb->lock, flags);
201
202 dbg_log_event(ksb, "KS_READ", copied, 0);
203
204 pr_debug("count:%d space:%d copied:%d", count, space, copied);
205
206 return copied;
207}
208
209static void ksb_tx_cb(struct urb *urb)
210{
211 struct data_pkt *pkt = urb->context;
212 struct ks_bridge *ksb = pkt->ctxt;
213
214 dbg_log_event(ksb, "C TX_URB", urb->status, 0);
215 pr_debug("status:%d", urb->status);
216
217 if (ksb->ifc)
218 usb_autopm_put_interface_async(ksb->ifc);
219
220 if (urb->status < 0)
221 pr_err_ratelimited("urb failed with err:%d", urb->status);
222
223 ksb_free_data_pkt(pkt);
224}
225
226static void ksb_tomdm_work(struct work_struct *w)
227{
228 struct ks_bridge *ksb = container_of(w, struct ks_bridge, to_mdm_work);
229 struct data_pkt *pkt;
230 unsigned long flags;
231 struct urb *urb;
232 int ret;
233
234 spin_lock_irqsave(&ksb->lock, flags);
235 while (!list_empty(&ksb->to_mdm_list)
236 && test_bit(USB_DEV_CONNECTED, &ksb->flags)) {
237 pkt = list_first_entry(&ksb->to_mdm_list,
238 struct data_pkt, list);
239 list_del_init(&pkt->list);
240 spin_unlock_irqrestore(&ksb->lock, flags);
241
242 urb = usb_alloc_urb(0, GFP_KERNEL);
243 if (!urb) {
244 pr_err_ratelimited("unable to allocate urb");
245 ksb_free_data_pkt(pkt);
246 return;
247 }
248
249 ret = usb_autopm_get_interface(ksb->ifc);
250 if (ret < 0 && ret != -EAGAIN && ret != -EACCES) {
251 pr_err_ratelimited("autopm_get failed:%d", ret);
252 usb_free_urb(urb);
253 ksb_free_data_pkt(pkt);
254 return;
255 }
256 usb_fill_bulk_urb(urb, ksb->udev, ksb->out_pipe,
257 pkt->buf, pkt->len, ksb_tx_cb, pkt);
258 usb_anchor_urb(urb, &ksb->submitted);
259
260 dbg_log_event(ksb, "S TX_URB", pkt->len, 0);
261
262 ret = usb_submit_urb(urb, GFP_KERNEL);
263 if (ret) {
264 pr_err("out urb submission failed");
265 usb_unanchor_urb(urb);
266 usb_free_urb(urb);
267 ksb_free_data_pkt(pkt);
268 usb_autopm_put_interface(ksb->ifc);
269 return;
270 }
271
Hemant Kumar9b230b52012-09-19 12:40:11 -0700272 usb_free_urb(urb);
273
Vamsi Krishna5b944712012-06-29 18:36:23 -0700274 spin_lock_irqsave(&ksb->lock, flags);
275 }
276 spin_unlock_irqrestore(&ksb->lock, flags);
277}
278
279static ssize_t ksb_fs_write(struct file *fp, const char __user *buf,
280 size_t count, loff_t *pos)
281{
282 int ret;
283 struct data_pkt *pkt;
284 unsigned long flags;
285 struct ks_bridge *ksb = fp->private_data;
286
287 pkt = ksb_alloc_data_pkt(count, GFP_KERNEL, ksb);
288 if (IS_ERR(pkt)) {
289 pr_err("unable to allocate data packet");
290 return PTR_ERR(pkt);
291 }
292
293 ret = copy_from_user(pkt->buf, buf, count);
294 if (ret) {
295 pr_err("copy_from_user failed: err:%d", ret);
296 ksb_free_data_pkt(pkt);
297 return ret;
298 }
299
300 spin_lock_irqsave(&ksb->lock, flags);
301 list_add_tail(&pkt->list, &ksb->to_mdm_list);
302 spin_unlock_irqrestore(&ksb->lock, flags);
303
304 queue_work(ksb->wq, &ksb->to_mdm_work);
305
306 return count;
307}
308
309static int efs_fs_open(struct inode *ip, struct file *fp)
310{
311 struct ks_bridge *ksb = __ksb[EFS_BRIDGE_INDEX];
312
313 pr_debug(":%s", ksb->name);
314 dbg_log_event(ksb, "EFS-FS-OPEN", 0, 0);
315
316 if (!ksb) {
317 pr_err("ksb is being removed");
318 return -ENODEV;
319 }
320
321 fp->private_data = ksb;
322 set_bit(FILE_OPENED, &ksb->flags);
323
324 if (test_bit(USB_DEV_CONNECTED, &ksb->flags))
325 queue_work(ksb->wq, &ksb->start_rx_work);
326
327 return 0;
328}
329
330static int ksb_fs_open(struct inode *ip, struct file *fp)
331{
332 struct ks_bridge *ksb = __ksb[BOOT_BRIDGE_INDEX];
333
334 pr_debug(":%s", ksb->name);
335 dbg_log_event(ksb, "KS-FS-OPEN", 0, 0);
336
337 if (!ksb) {
338 pr_err("ksb is being removed");
339 return -ENODEV;
340 }
341
342 fp->private_data = ksb;
343 set_bit(FILE_OPENED, &ksb->flags);
344
345 if (test_bit(USB_DEV_CONNECTED, &ksb->flags))
346 queue_work(ksb->wq, &ksb->start_rx_work);
347
348 return 0;
349}
350
351static int ksb_fs_release(struct inode *ip, struct file *fp)
352{
353 struct ks_bridge *ksb = fp->private_data;
354
355 pr_debug(":%s", ksb->name);
356 dbg_log_event(ksb, "FS-RELEASE", 0, 0);
357
358 clear_bit(FILE_OPENED, &ksb->flags);
359 fp->private_data = NULL;
360
361 return 0;
362}
363
364static const struct file_operations ksb_fops = {
365 .owner = THIS_MODULE,
366 .read = ksb_fs_read,
367 .write = ksb_fs_write,
368 .open = ksb_fs_open,
369 .release = ksb_fs_release,
370};
371
372static struct miscdevice ksb_fboot_dev = {
373 .minor = MISC_DYNAMIC_MINOR,
374 .name = "ks_bridge",
375 .fops = &ksb_fops,
376};
377
378static const struct file_operations efs_fops = {
379 .owner = THIS_MODULE,
380 .read = ksb_fs_read,
381 .write = ksb_fs_write,
382 .open = efs_fs_open,
383 .release = ksb_fs_release,
384};
385
386static struct miscdevice ksb_efs_dev = {
387 .minor = MISC_DYNAMIC_MINOR,
388 .name = "efs_bridge",
389 .fops = &efs_fops,
390};
391
392static const struct usb_device_id ksb_usb_ids[] = {
393 { USB_DEVICE(0x5c6, 0x9008),
394 .driver_info = (unsigned long)&ksb_fboot_dev, },
395 { USB_DEVICE(0x5c6, 0x9048),
396 .driver_info = (unsigned long)&ksb_efs_dev, },
397 { USB_DEVICE(0x5c6, 0x904C),
398 .driver_info = (unsigned long)&ksb_efs_dev, },
399
400 {} /* terminating entry */
401};
402MODULE_DEVICE_TABLE(usb, ksb_usb_ids);
403
404static void ksb_rx_cb(struct urb *urb);
Pavankumar Kondeti009bbd62012-12-14 15:12:46 +0530405static void
406submit_one_urb(struct ks_bridge *ksb, gfp_t flags, struct data_pkt *pkt)
Vamsi Krishna5b944712012-06-29 18:36:23 -0700407{
Vamsi Krishna5b944712012-06-29 18:36:23 -0700408 struct urb *urb;
409 int ret;
410
Pavankumar Kondeti009bbd62012-12-14 15:12:46 +0530411 urb = usb_alloc_urb(0, flags);
Vamsi Krishna5b944712012-06-29 18:36:23 -0700412 if (!urb) {
413 pr_err("unable to allocate urb");
414 ksb_free_data_pkt(pkt);
415 return;
416 }
Vamsi Krishna5b944712012-06-29 18:36:23 -0700417
418 usb_fill_bulk_urb(urb, ksb->udev, ksb->in_pipe,
419 pkt->buf, pkt->len,
420 ksb_rx_cb, pkt);
421 usb_anchor_urb(urb, &ksb->submitted);
422
423 dbg_log_event(ksb, "S RX_URB", pkt->len, 0);
424
Pavankumar Kondeti009bbd62012-12-14 15:12:46 +0530425 ret = usb_submit_urb(urb, flags);
Vamsi Krishna5b944712012-06-29 18:36:23 -0700426 if (ret) {
427 pr_err("in urb submission failed");
428 usb_unanchor_urb(urb);
429 usb_free_urb(urb);
430 ksb_free_data_pkt(pkt);
Vamsi Krishna5b944712012-06-29 18:36:23 -0700431 return;
432 }
433
434 usb_free_urb(urb);
435}
436static void ksb_rx_cb(struct urb *urb)
437{
438 struct data_pkt *pkt = urb->context;
439 struct ks_bridge *ksb = pkt->ctxt;
440
441 dbg_log_event(ksb, "C RX_URB", urb->status, urb->actual_length);
442
443 pr_debug("status:%d actual:%d", urb->status, urb->actual_length);
444
Hemant Kumara6194c12012-08-31 18:38:32 -0700445 /*non zero len of data received while unlinking urb*/
446 if (urb->status == -ENOENT && urb->actual_length > 0)
447 goto add_to_list;
448
Vamsi Krishna5b944712012-06-29 18:36:23 -0700449 if (urb->status < 0) {
Hemant Kumara6194c12012-08-31 18:38:32 -0700450 if (urb->status != -ESHUTDOWN && urb->status != -ENOENT
451 && urb->status != -EPROTO)
Vamsi Krishna5b944712012-06-29 18:36:23 -0700452 pr_err_ratelimited("urb failed with err:%d",
453 urb->status);
454 ksb_free_data_pkt(pkt);
Vamsi Krishna5b944712012-06-29 18:36:23 -0700455 return;
456 }
457
458 if (urb->actual_length == 0) {
Pavankumar Kondeti009bbd62012-12-14 15:12:46 +0530459 submit_one_urb(ksb, GFP_ATOMIC, pkt);
460 return;
Vamsi Krishna5b944712012-06-29 18:36:23 -0700461 }
462
Hemant Kumara6194c12012-08-31 18:38:32 -0700463add_to_list:
Vamsi Krishna5b944712012-06-29 18:36:23 -0700464 spin_lock(&ksb->lock);
465 pkt->len = urb->actual_length;
466 list_add_tail(&pkt->list, &ksb->to_ks_list);
467 spin_unlock(&ksb->lock);
468
469 /* wake up read thread */
470 wake_up(&ksb->ks_wait_q);
Vamsi Krishna5b944712012-06-29 18:36:23 -0700471}
472
473static void ksb_start_rx_work(struct work_struct *w)
474{
475 struct ks_bridge *ksb =
476 container_of(w, struct ks_bridge, start_rx_work);
477 struct data_pkt *pkt;
478 struct urb *urb;
479 int i = 0;
480 int ret;
481
482 for (i = 0; i < NO_RX_REQS; i++) {
483 pkt = ksb_alloc_data_pkt(MAX_DATA_PKT_SIZE, GFP_KERNEL, ksb);
484 if (IS_ERR(pkt)) {
485 pr_err("unable to allocate data pkt");
486 return;
487 }
488
489 urb = usb_alloc_urb(0, GFP_KERNEL);
490 if (!urb) {
491 pr_err("unable to allocate urb");
492 ksb_free_data_pkt(pkt);
493 return;
494 }
495
496 ret = usb_autopm_get_interface(ksb->ifc);
497 if (ret < 0 && ret != -EAGAIN && ret != -EACCES) {
498 pr_err_ratelimited("autopm_get failed:%d", ret);
499 usb_free_urb(urb);
500 ksb_free_data_pkt(pkt);
501 return;
502 }
Vamsi Krishna5b944712012-06-29 18:36:23 -0700503
504 usb_fill_bulk_urb(urb, ksb->udev, ksb->in_pipe,
505 pkt->buf, pkt->len,
506 ksb_rx_cb, pkt);
507 usb_anchor_urb(urb, &ksb->submitted);
508
509 dbg_log_event(ksb, "S RX_URB", pkt->len, 0);
510
511 ret = usb_submit_urb(urb, GFP_KERNEL);
512 if (ret) {
513 pr_err("in urb submission failed");
514 usb_unanchor_urb(urb);
515 usb_free_urb(urb);
516 ksb_free_data_pkt(pkt);
Vamsi Krishna5b944712012-06-29 18:36:23 -0700517 usb_autopm_put_interface(ksb->ifc);
518 return;
519 }
520
521 usb_autopm_put_interface_async(ksb->ifc);
522 usb_free_urb(urb);
523 }
524}
525
526static int
527ksb_usb_probe(struct usb_interface *ifc, const struct usb_device_id *id)
528{
529 __u8 ifc_num;
530 struct usb_host_interface *ifc_desc;
531 struct usb_endpoint_descriptor *ep_desc;
532 int i;
533 struct ks_bridge *ksb;
Vamsi Krishna5b944712012-06-29 18:36:23 -0700534
535 ifc_num = ifc->cur_altsetting->desc.bInterfaceNumber;
536
537 switch (id->idProduct) {
538 case 0x9008:
539 if (ifc_num != 0)
540 return -ENODEV;
541 ksb = __ksb[BOOT_BRIDGE_INDEX];
542 break;
543 case 0x9048:
544 case 0x904C:
545 if (ifc_num != 2)
546 return -ENODEV;
547 ksb = __ksb[EFS_BRIDGE_INDEX];
548 break;
549 default:
550 return -ENODEV;
551 }
552
553 if (!ksb) {
554 pr_err("ksb is not initialized");
555 return -ENODEV;
556 }
557
558 ksb->udev = usb_get_dev(interface_to_usbdev(ifc));
559 ksb->ifc = ifc;
560 ifc_desc = ifc->cur_altsetting;
561
562 for (i = 0; i < ifc_desc->desc.bNumEndpoints; i++) {
563 ep_desc = &ifc_desc->endpoint[i].desc;
564
565 if (!ksb->in_epAddr && usb_endpoint_is_bulk_in(ep_desc))
566 ksb->in_epAddr = ep_desc->bEndpointAddress;
567
568 if (!ksb->out_epAddr && usb_endpoint_is_bulk_out(ep_desc))
569 ksb->out_epAddr = ep_desc->bEndpointAddress;
570 }
571
572 if (!(ksb->in_epAddr && ksb->out_epAddr)) {
573 pr_err("could not find bulk in and bulk out endpoints");
574 usb_put_dev(ksb->udev);
575 ksb->ifc = NULL;
576 return -ENODEV;
577 }
578
579 ksb->in_pipe = usb_rcvbulkpipe(ksb->udev, ksb->in_epAddr);
580 ksb->out_pipe = usb_sndbulkpipe(ksb->udev, ksb->out_epAddr);
581
582 usb_set_intfdata(ifc, ksb);
583 set_bit(USB_DEV_CONNECTED, &ksb->flags);
584
585 dbg_log_event(ksb, "PID-ATT", id->idProduct, 0);
586
Hemant Kumar38980ec42012-08-24 19:42:31 -0700587 ksb->fs_dev = (struct miscdevice *)id->driver_info;
588 misc_register(ksb->fs_dev);
Vamsi Krishna5b944712012-06-29 18:36:23 -0700589
Hemant Kumarf292a322012-09-07 19:00:21 -0700590 ifc->needs_remote_wakeup = 1;
Vamsi Krishna5b944712012-06-29 18:36:23 -0700591 usb_enable_autosuspend(ksb->udev);
592
593 pr_debug("usb dev connected");
594
595 return 0;
596}
597
598static int ksb_usb_suspend(struct usb_interface *ifc, pm_message_t message)
599{
600 struct ks_bridge *ksb = usb_get_intfdata(ifc);
601
602 dbg_log_event(ksb, "SUSPEND", 0, 0);
603
Vamsi Krishna5b944712012-06-29 18:36:23 -0700604 usb_kill_anchored_urbs(&ksb->submitted);
605
606 return 0;
607}
608
609static int ksb_usb_resume(struct usb_interface *ifc)
610{
611 struct ks_bridge *ksb = usb_get_intfdata(ifc);
612
613 dbg_log_event(ksb, "RESUME", 0, 0);
614
615 if (test_bit(FILE_OPENED, &ksb->flags))
616 queue_work(ksb->wq, &ksb->start_rx_work);
617
618 return 0;
619}
620
621static void ksb_usb_disconnect(struct usb_interface *ifc)
622{
623 struct ks_bridge *ksb = usb_get_intfdata(ifc);
624 unsigned long flags;
625 struct data_pkt *pkt;
626
627 dbg_log_event(ksb, "PID-DETACH", 0, 0);
628
629 clear_bit(USB_DEV_CONNECTED, &ksb->flags);
630 wake_up(&ksb->ks_wait_q);
631 cancel_work_sync(&ksb->to_mdm_work);
632
Hemant Kumar38980ec42012-08-24 19:42:31 -0700633 misc_deregister(ksb->fs_dev);
Vamsi Krishna5b944712012-06-29 18:36:23 -0700634
Hemant Kumar38980ec42012-08-24 19:42:31 -0700635 usb_kill_anchored_urbs(&ksb->submitted);
Vamsi Krishna5b944712012-06-29 18:36:23 -0700636 spin_lock_irqsave(&ksb->lock, flags);
637 while (!list_empty(&ksb->to_ks_list)) {
638 pkt = list_first_entry(&ksb->to_ks_list,
639 struct data_pkt, list);
640 list_del_init(&pkt->list);
641 ksb_free_data_pkt(pkt);
642 }
643 while (!list_empty(&ksb->to_mdm_list)) {
644 pkt = list_first_entry(&ksb->to_mdm_list,
645 struct data_pkt, list);
646 list_del_init(&pkt->list);
647 ksb_free_data_pkt(pkt);
648 }
649 spin_unlock_irqrestore(&ksb->lock, flags);
650
Hemant Kumarf292a322012-09-07 19:00:21 -0700651 ifc->needs_remote_wakeup = 0;
Vamsi Krishna5b944712012-06-29 18:36:23 -0700652 usb_put_dev(ksb->udev);
653 ksb->ifc = NULL;
654 usb_set_intfdata(ifc, NULL);
655
656 return;
657}
658
659static struct usb_driver ksb_usb_driver = {
660 .name = "ks_bridge",
661 .probe = ksb_usb_probe,
662 .disconnect = ksb_usb_disconnect,
663 .suspend = ksb_usb_suspend,
664 .resume = ksb_usb_resume,
665 .id_table = ksb_usb_ids,
666 .supports_autosuspend = 1,
667};
668
669static ssize_t ksb_debug_show(struct seq_file *s, void *unused)
670{
671 unsigned long flags;
672 struct ks_bridge *ksb = s->private;
673 int i;
674
675 read_lock_irqsave(&ksb->dbg_lock, flags);
676 for (i = 0; i < DBG_MAX_MSG; i++) {
677 if (i == (ksb->dbg_idx - 1))
678 seq_printf(s, "-->%s\n", ksb->dbgbuf[i]);
679 else
680 seq_printf(s, "%s\n", ksb->dbgbuf[i]);
681 }
682 read_unlock_irqrestore(&ksb->dbg_lock, flags);
683
684 return 0;
685}
686
687static int ksb_debug_open(struct inode *ip, struct file *fp)
688{
689 return single_open(fp, ksb_debug_show, ip->i_private);
690
691 return 0;
692}
693
694static const struct file_operations dbg_fops = {
695 .open = ksb_debug_open,
696 .read = seq_read,
697 .llseek = seq_lseek,
698 .release = single_release,
699};
700static struct dentry *dbg_dir;
701static int __init ksb_init(void)
702{
703 struct ks_bridge *ksb;
704 int num_instances = 0;
705 int ret = 0;
706 int i;
707
708 dbg_dir = debugfs_create_dir("ks_bridge", NULL);
709 if (IS_ERR(dbg_dir))
710 pr_err("unable to create debug dir");
711
712 for (i = 0; i < NO_BRIDGE_INSTANCES; i++) {
713 ksb = kzalloc(sizeof(struct ks_bridge), GFP_KERNEL);
714 if (!ksb) {
715 pr_err("unable to allocat mem for ks_bridge");
Hemant Kumar38980ec42012-08-24 19:42:31 -0700716 ret = -ENOMEM;
717 goto dev_free;
Vamsi Krishna5b944712012-06-29 18:36:23 -0700718 }
719 __ksb[i] = ksb;
720
721 ksb->name = kasprintf(GFP_KERNEL, "ks_bridge:%i", i + 1);
722 if (!ksb->name) {
723 pr_info("unable to allocate name");
724 kfree(ksb);
725 ret = -ENOMEM;
726 goto dev_free;
727 }
728
729 spin_lock_init(&ksb->lock);
730 INIT_LIST_HEAD(&ksb->to_mdm_list);
731 INIT_LIST_HEAD(&ksb->to_ks_list);
732 init_waitqueue_head(&ksb->ks_wait_q);
733 ksb->wq = create_singlethread_workqueue(ksb->name);
734 if (!ksb->wq) {
735 pr_err("unable to allocate workqueue");
736 kfree(ksb->name);
737 kfree(ksb);
738 ret = -ENOMEM;
739 goto dev_free;
740 }
741
742 INIT_WORK(&ksb->to_mdm_work, ksb_tomdm_work);
743 INIT_WORK(&ksb->start_rx_work, ksb_start_rx_work);
744 init_usb_anchor(&ksb->submitted);
745
746 ksb->dbg_idx = 0;
747 ksb->dbg_lock = __RW_LOCK_UNLOCKED(lck);
748
749 if (!IS_ERR(dbg_dir))
750 debugfs_create_file(ksb->name, S_IRUGO, dbg_dir,
751 ksb, &dbg_fops);
752
753 num_instances++;
754 }
755
756 ret = usb_register(&ksb_usb_driver);
757 if (ret) {
758 pr_err("unable to register ks bridge driver");
759 goto dev_free;
760 }
761
762 pr_info("init done");
763
764 return 0;
765
766dev_free:
767 if (!IS_ERR(dbg_dir))
768 debugfs_remove_recursive(dbg_dir);
769
770 for (i = 0; i < num_instances; i++) {
771 ksb = __ksb[i];
772
773 destroy_workqueue(ksb->wq);
774 kfree(ksb->name);
775 kfree(ksb);
776 }
777
778 return ret;
779
780}
781
782static void __exit ksb_exit(void)
783{
784 struct ks_bridge *ksb;
785 int i;
786
787 if (!IS_ERR(dbg_dir))
788 debugfs_remove_recursive(dbg_dir);
789
790 usb_deregister(&ksb_usb_driver);
791
792 for (i = 0; i < NO_BRIDGE_INSTANCES; i++) {
793 ksb = __ksb[i];
794
795 destroy_workqueue(ksb->wq);
796 kfree(ksb->name);
797 kfree(ksb);
798 }
799}
800
801module_init(ksb_init);
802module_exit(ksb_exit);
803
804MODULE_DESCRIPTION(DRIVER_DESC);
805MODULE_VERSION(DRIVER_VERSION);
806MODULE_LICENSE("GPL v2");