return -ENOMEM;
 }
 
+static struct tx_agg *r8152_get_tx_agg(struct r8152 *tp)
+{
+       struct tx_agg *agg = NULL;
+       unsigned long flags;
+
+       spin_lock_irqsave(&tp->tx_lock, flags);
+       if (!list_empty(&tp->tx_free)) {
+               struct list_head *cursor;
+
+               cursor = tp->tx_free.next;
+               list_del_init(cursor);
+               agg = list_entry(cursor, struct tx_agg, list);
+       }
+       spin_unlock_irqrestore(&tp->tx_lock, flags);
+
+       return agg;
+}
+
 static void
 r8152_tx_csum(struct r8152 *tp, struct tx_desc *desc, struct sk_buff *skb)
 {
 
                agg = list_entry(cursor, struct rx_agg, list);
                urb = agg->urb;
-               if (urb->actual_length < ETH_ZLEN) {
-                       ret = r8152_submit_rx(tp, agg, GFP_ATOMIC);
-                       spin_lock_irqsave(&tp->rx_lock, flags);
-                       if (ret && ret != -ENODEV) {
-                               list_add_tail(&agg->list, next);
-                               tasklet_schedule(&tp->tl);
-                       }
-                       continue;
-               }
+               if (urb->actual_length < ETH_ZLEN)
+                       goto submit;
 
                len_used = 0;
                rx_desc = agg->head;
                        len_used += sizeof(struct rx_desc) + pkt_len;
                }
 
+submit:
                ret = r8152_submit_rx(tp, agg, GFP_ATOMIC);
                spin_lock_irqsave(&tp->rx_lock, flags);
                if (ret && ret != -ENODEV) {
 
 next_agg:
        agg = NULL;
-       spin_lock_irqsave(&tp->tx_lock, flags);
-       if (!skb_queue_empty(&tp->tx_queue) && !list_empty(&tp->tx_free)) {
-               struct list_head *cursor;
-
-               cursor = tp->tx_free.next;
-               list_del_init(cursor);
-               agg = list_entry(cursor, struct tx_agg, list);
-       }
-       spin_unlock_irqrestore(&tp->tx_lock, flags);
+       if (skb_queue_empty(&tp->tx_queue))
+               return;
 
+       agg = r8152_get_tx_agg(tp);
        if (!agg)
                return;
 
 
        skb_tx_timestamp(skb);
 
-       spin_lock_irqsave(&tp->tx_lock, flags);
-       if (!list_empty(&tp->tx_free) && skb_queue_empty(&tp->tx_queue)) {
-               struct list_head *cursor;
-
-               cursor = tp->tx_free.next;
-               list_del_init(cursor);
-               agg = list_entry(cursor, struct tx_agg, list);
-       }
-       spin_unlock_irqrestore(&tp->tx_lock, flags);
+       /* If tx_queue is not empty, it means at least one previous packt */
+       /* is waiting for sending. Don't send current one before it.      */
+       if (skb_queue_empty(&tp->tx_queue))
+               agg = r8152_get_tx_agg(tp);
 
        if (!agg) {
                skb_queue_tail(&tp->tx_queue, skb);