1 files changed, 11 insertions, 29 deletions

diff --git a/net/bluetooth/hidp/core.c b/net/bluetooth/hidp/core.c
index 3f6ef0630a8e..8f81379e9907 100644
--- a/net/bluetooth/hidp/core.c
+++ b/net/bluetooth/hidp/core.c
@@ -636,40 +636,20 @@ static int hidp_send_frame(struct socket *sock, unsigned char *data, int len)
         return kernel_sendmsg(sock, &msg, &iv, 1, len);
 }
 
-static void hidp_process_intr_transmit(struct hidp_session *session)
+/* dequeue message from @transmit and send via @sock */
+static void hidp_process_transmit(struct hidp_session *session,
+                                  struct sk_buff_head *transmit,
+                                  struct socket *sock)
 {
         struct sk_buff *skb;
         int ret;
 
         BT_DBG("session %p", session);
 
-        while ((skb = skb_dequeue(&session->intr_transmit))) {
-                ret = hidp_send_frame(session->intr_sock, skb->data, skb->len);
+        while ((skb = skb_dequeue(transmit))) {
+                ret = hidp_send_frame(sock, skb->data, skb->len);
                 if (ret == -EAGAIN) {
-                        skb_queue_head(&session->intr_transmit, skb);
-                        break;
-                } else if (ret < 0) {
-                        hidp_session_terminate(session);
-                        kfree_skb(skb);
-                        break;
-                }
-
-                hidp_set_timer(session);
-                kfree_skb(skb);
-        }
-}
-
-static void hidp_process_ctrl_transmit(struct hidp_session *session)
-{
-        struct sk_buff *skb;
-        int ret;
-
-        BT_DBG("session %p", session);
-
-        while ((skb = skb_dequeue(&session->ctrl_transmit))) {
-                ret = hidp_send_frame(session->ctrl_sock, skb->data, skb->len);
-                if (ret == -EAGAIN) {
-                        skb_queue_head(&session->ctrl_transmit, skb);
+                        skb_queue_head(transmit, skb);
                         break;
                 } else if (ret < 0) {
                         hidp_session_terminate(session);
@@ -1224,7 +1204,8 @@ static void hidp_session_run(struct hidp_session *session)
                 }
 
                 /* send pending intr-skbs */
-                hidp_process_intr_transmit(session);
+                hidp_process_transmit(session, &session->intr_transmit,
+                                      session->intr_sock);
 
                 /* parse incoming ctrl-skbs */
                 while ((skb = skb_dequeue(&ctrl_sk->sk_receive_queue))) {
@@ -1236,7 +1217,8 @@ static void hidp_session_run(struct hidp_session *session)
                 }
 
                 /* send pending ctrl-skbs */
-                hidp_process_ctrl_transmit(session);
+                hidp_process_transmit(session, &session->ctrl_transmit,
+                                      session->ctrl_sock);
 
                 schedule();
         }