Current musb host driver does the giveback of completed urb first and
then start the next request. This is significantly affecting the streaming
from an USB camera wherein we observe huge delay between the two IN tokens
from musb host. This is due to the fact that UVC driver is doing decoding
and further processing in giveback context.
The patch tries to defer the giveback part to a workqueue and continues
with the start of new request in completion path.
Signed-off-by: Ajay Kumar Gupta <ajay.gupta@xxxxxx>
---
drivers/usb/musb/musb_core.c | 21 ++++++++-
drivers/usb/musb/musb_core.h | 19 ++++++++
drivers/usb/musb/musb_host.c | 106 +++++++++++++++++++++++++++++++++++++----
drivers/usb/musb/musb_host.h | 2 +
4 files changed, 136 insertions(+), 12 deletions(-)
diff --git a/drivers/usb/musb/musb_core.c b/drivers/usb/musb/musb_core.c
index bcce8e8..1189f2f 100644
--- a/drivers/usb/musb/musb_core.c
+++ b/drivers/usb/musb/musb_core.c
@@ -1868,6 +1868,9 @@ static void musb_free(struct musb *musb)
}
#ifdef CONFIG_USB_MUSB_HDRC_HCD
+ if (musb->gb_queue)
+ destroy_workqueue(musb->gb_queue);
+ free_queue(musb);
usb_put_hcd(musb_to_hcd(musb));
#else
kfree(musb);
@@ -1926,6 +1929,9 @@ bad_config:
return -ENOMEM;
spin_lock_init(&musb->lock);
+#ifdef CONFIG_USB_MUSB_HDRC_HCD
+ spin_lock_init(&musb->qlock);
+#endif
musb->board_mode = plat->mode;
musb->board_set_power = plat->set_power;
musb->set_clock = plat->set_clock;
@@ -2090,8 +2096,21 @@ bad_config:
if (status)
goto fail2;
- return 0;
+#ifdef CONFIG_USB_MUSB_HDRC_HCD
+ musb->gb_queue = create_singlethread_workqueue(dev_name(dev));
+ if (musb->gb_queue == NULL)
+ goto fail2;
+ /* Init giveback workqueue */
+ INIT_WORK(&musb->gb_work, musb_gb_work);
+ /* init queue */
+ init_queue(musb);
+ if (!musb->qhead)
+ goto fail3;
+#endif
+ return 0;
+fail3:
+ destroy_workqueue(musb->gb_queue);
fail2:
musb_platform_exit(musb);
fail:
diff --git a/drivers/usb/musb/musb_core.h b/drivers/usb/musb/musb_core.h
index 57612f0..0fb8ae8 100644
--- a/drivers/usb/musb/musb_core.h
+++ b/drivers/usb/musb/musb_core.h
@@ -313,6 +313,17 @@ static inline struct usb_request *next_out_request(struct musb_hw_ep *hw_ep)
#endif
}
+#ifdef CONFIG_USB_MUSB_HDRC_HCD
+/*
+ * struct queue - Queue data structure
+ */
+struct queue {
+ struct urb *urb;
+ int status;
+ struct queue *next;
+};
+#endif
+
/*
* struct musb - Driver instance data.
*/
@@ -353,6 +364,11 @@ struct musb {
struct list_head in_bulk; /* of musb_qh */
struct list_head out_bulk; /* of musb_qh */
+ struct workqueue_struct *gb_queue;
+ struct work_struct gb_work;
+ spinlock_t qlock;
+ struct queue *qhead;
+
struct timer_list otg_timer;
#endif
@@ -569,5 +585,8 @@ extern int musb_platform_get_vbus_status(struct musb *musb);
extern int __init musb_platform_init(struct musb *musb);
extern int musb_platform_exit(struct musb *musb);
+#ifdef CONFIG_USB_MUSB_HDRC_HCD
+extern void musb_gb_work(struct work_struct *data);
+#endif
#endif /* __MUSB_CORE_H__ */
diff --git a/drivers/usb/musb/musb_host.c b/drivers/usb/musb/musb_host.c
index c3fdd6d..e342fc0 100644
--- a/drivers/usb/musb/musb_host.c
+++ b/drivers/usb/musb/musb_host.c
@@ -99,7 +99,62 @@
static void musb_ep_program(struct musb *musb, u8 epnum,
struct urb *urb, int is_out,
u8 *buf, u32 offset, u32 len);
+struct queue *create(void)
+{
+ struct queue *new;
+ new = kmalloc(sizeof(struct queue), GFP_ATOMIC);
+ if (!new)
+ return NULL;
+ new->next = NULL;
+ return new;
+}
+void push_queue(struct musb *musb, struct urb *urb, int status)
+{
+ struct queue *new, *temp;
+
+ new = create();
+ new->urb = urb;
+ new->status = status;
+
+ temp = musb->qhead;
+ if (!temp)
+ return;
+
+ spin_lock(&musb->qlock);
+ while (temp->next != NULL)
+ temp = temp->next;
+ temp->next = new;
+ spin_unlock(&musb->qlock);
+}
+struct urb *pop_queue(struct musb *musb, int *psts)
+{
+ struct urb *urb;
+ struct queue *head = musb->qhead;
+ struct queue *temp;
+ unsigned long flags;
+
+ if (!head)
+ return NULL;
+ spin_lock_irqsave(&musb->qlock, flags);
+ temp = head->next;
+ if (!temp) {
+ spin_unlock_irqrestore(&musb->qlock, flags);
+ return NULL;
+ }
+ head->next = head->next->next;
+ spin_unlock_irqrestore(&musb->qlock, flags);
+
+ urb = temp->urb;
+ *psts = temp->status;
+ kfree(temp);
+ return urb;
+}
+
+void init_queue(struct musb *musb)
+{
+ musb->qhead = create();
+}
/*
* Clear TX fifo. Needed to avoid BABBLE errors.
*/
@@ -297,8 +352,6 @@ start:
/* Context: caller owns controller lock, IRQs are blocked */
static void musb_giveback(struct musb *musb, struct urb *urb, int status)
-__releases(musb->lock)
-__acquires(musb->lock)
{
DBG(({ int level; switch (status) {
case 0:
@@ -323,10 +376,21 @@ __acquires(musb->lock)
urb->actual_length, urb->transfer_buffer_length
);
- usb_hcd_unlink_urb_from_ep(musb_to_hcd(musb), urb);
- spin_unlock(&musb->lock);
usb_hcd_giveback_urb(musb_to_hcd(musb), urb, status);
- spin_lock(&musb->lock);
+}
+
+void free_queue(struct musb *musb)
+{
+ struct urb *urb;
+ int status;
+
+ /* giveback any urb still in queue */
+ while ((urb = pop_queue(musb, &status)) != 0)
+ musb_giveback(musb, urb, status);
+
+ /* free up the queue head memory */
+ kfree(musb->qhead);
+ musb->qhead = NULL;
}
/* For bulk/interrupt endpoints only */
@@ -348,6 +412,16 @@ static inline void musb_save_toggle(struct musb_qh *qh, int is_in,
usb_settoggle(urb->dev, qh->epnum, !is_in, csr ? 1 : 0);
}
+/* Used to complete urb giveback */
+void musb_gb_work(struct work_struct *data)
+{
+ struct musb *musb = container_of(data, struct musb, gb_work);
+ struct urb *urb;
+ int status;
+
+ while ((urb = pop_queue(musb, &status)) != 0)
+ musb_giveback(musb, urb, status);
+}
/*
* Advance this hardware endpoint's queue, completing the specified URB and
@@ -361,7 +435,6 @@ static void musb_advance_schedule(struct musb *musb, struct urb *urb,
{
struct musb_qh *qh = musb_ep_get_qh(hw_ep, is_in);
struct musb_hw_ep *ep = qh->hw_ep;
- int ready = qh->is_ready;
int status;
status = (urb->status == -EINPROGRESS) ? 0 : urb->status;
@@ -378,9 +451,7 @@ static void musb_advance_schedule(struct musb *musb, struct urb *urb,
break;
}
- qh->is_ready = 0;
- musb_giveback(musb, urb, status);
- qh->is_ready = ready;
+ usb_hcd_unlink_urb_from_ep(musb_to_hcd(musb), urb);
/* reclaim resources (and bandwidth) ASAP; deschedule it, and
* invalidate qh as soon as list_empty(&hep->urb_list)
@@ -429,6 +500,10 @@ static void musb_advance_schedule(struct musb *musb, struct urb *urb,
hw_ep->epnum, is_in ? 'R' : 'T', next_urb(qh));
musb_start_urb(musb, is_in, qh);
}
+
+ /* schedule the workqueue */
+ push_queue(musb, urb, status);
+ queue_work(musb->gb_queue, &musb->gb_work);
}
static u16 musb_h_flush_rxfifo(struct musb_hw_ep *hw_ep, u16 csr)
@@ -2161,8 +2236,12 @@ static int musb_urb_dequeue(struct usb_hcd *hcd, struct urb *urb, int status)
|| musb_ep_get_qh(qh->hw_ep, is_in) != qh) {
int ready = qh->is_ready;
+ usb_hcd_unlink_urb_from_ep(musb_to_hcd(musb), urb);
+
qh->is_ready = 0;
+ spin_unlock(&musb->lock);
musb_giveback(musb, urb, 0);
+ spin_lock(&musb->lock);
qh->is_ready = ready;
/* If nothing else (usually musb_giveback) is using it
@@ -2223,8 +2302,13 @@ musb_h_disable(struct usb_hcd *hcd, struct usb_host_endpoint *hep)
* other transfers, and since !qh->is_ready nothing
* will activate any of these as it advances.
*/
- while (!list_empty(&hep->urb_list))
- musb_giveback(musb, next_urb(qh), -ESHUTDOWN);
+ while (!list_empty(&hep->urb_list)) {
+ urb = next_urb(qh);
+ usb_hcd_unlink_urb_from_ep(musb_to_hcd(musb), urb);
+ spin_unlock(&musb->lock);
+ musb_giveback(musb, urb, -ESHUTDOWN);
+ spin_lock(&musb->lock);
+ }
hep->hcpriv = NULL;
list_del(&qh->ring);
diff --git a/drivers/usb/musb/musb_host.h b/drivers/usb/musb/musb_host.h
index 14b0077..a1a01df 100644
--- a/drivers/usb/musb/musb_host.h
+++ b/drivers/usb/musb/musb_host.h
@@ -83,6 +83,8 @@ static inline struct musb_qh *first_qh(struct list_head *q)
extern void musb_root_disconnect(struct musb *musb);
+extern void init_queue(struct musb *musb);
+extern void free_queue(struct musb *musb);
struct usb_hcd;
--
1.6.2.4
--
To unsubscribe from this list: send the line "unsubscribe linux-usb" in
the body of a message to majordomo@xxxxxxxxxxxxxxx
More majordomo info at http://vger.kernel.org/majordomo-info.html
