int qeth_do_send_packet_fast(struct qeth_card *card,
                             struct qeth_qdio_out_q *queue, struct sk_buff *skb,
                             struct qeth_hdr *hdr, unsigned int offset,
-                            int hd_len);
-int qeth_do_send_packet(struct qeth_card *, struct qeth_qdio_out_q *,
-                   struct sk_buff *, struct qeth_hdr *, int);
+                            unsigned int hd_len);
+int qeth_do_send_packet(struct qeth_card *card, struct qeth_qdio_out_q *queue,
+                       struct sk_buff *skb, struct qeth_hdr *hdr,
+                       unsigned int hd_len, int elements);
 int qeth_do_ioctl(struct net_device *dev, struct ifreq *rq, int cmd);
 int qeth_core_get_sset_count(struct net_device *, int);
 void qeth_core_get_ethtool_stats(struct net_device *,
 
 static int qeth_fill_buffer(struct qeth_qdio_out_q *queue,
                            struct qeth_qdio_out_buffer *buf,
                            struct sk_buff *skb, struct qeth_hdr *hdr,
-                           unsigned int offset, int hd_len)
+                           unsigned int offset, unsigned int hd_len)
 {
        struct qdio_buffer *buffer;
-       int flush_cnt = 0, hdr_len;
        bool is_first_elem = true;
+       int flush_cnt = 0;
 
        buffer = buf->buffer;
        refcount_inc(&skb->users);
                int element = buf->next_element_to_fill;
                is_first_elem = false;
 
-               hdr_len = sizeof(struct qeth_hdr_tso) +
-                       ((struct qeth_hdr_tso *)hdr)->ext.dg_hdr_len;
                /*fill first buffer entry only with header information */
                buffer->element[element].addr = skb->data;
-               buffer->element[element].length = hdr_len;
+               buffer->element[element].length = hd_len;
                buffer->element[element].eflags = SBAL_EFLAGS_FIRST_FRAG;
                buf->next_element_to_fill++;
-               skb_pull(skb, hdr_len);
+               skb_pull(skb, hd_len);
        }
 
        /* IQD */
 int qeth_do_send_packet_fast(struct qeth_card *card,
                             struct qeth_qdio_out_q *queue, struct sk_buff *skb,
                             struct qeth_hdr *hdr, unsigned int offset,
-                            int hd_len)
+                            unsigned int hd_len)
 {
        struct qeth_qdio_out_buffer *buffer;
        int index;
 EXPORT_SYMBOL_GPL(qeth_do_send_packet_fast);
 
 int qeth_do_send_packet(struct qeth_card *card, struct qeth_qdio_out_q *queue,
-               struct sk_buff *skb, struct qeth_hdr *hdr,
-               int elements_needed)
+                       struct sk_buff *skb, struct qeth_hdr *hdr,
+                       unsigned int hd_len, int elements_needed)
 {
        struct qeth_qdio_out_buffer *buffer;
        int start_index;
                        }
                }
        }
-       tmp = qeth_fill_buffer(queue, buffer, skb, hdr, 0, 0);
+       tmp = qeth_fill_buffer(queue, buffer, skb, hdr, 0, hd_len);
        queue->next_buf_to_fill = (queue->next_buf_to_fill + tmp) %
                                  QDIO_MAX_BUFFERS_PER_Q;
        flush_count += tmp;
 
                rc = -EINVAL;
                goto out;
        }
-       rc = qeth_do_send_packet(card, queue, skb_copy, hdr, elements);
+       rc = qeth_do_send_packet(card, queue, skb_copy, hdr, 0, elements);
 out:
        if (!rc) {
                /* tx success, free dangling original */
                return -E2BIG;
        if (qeth_hdr_chk_and_bounce(skb, &hdr, sizeof(*hdr)))
                return -EINVAL;
-       return qeth_do_send_packet(card, queue, skb, hdr, elements);
+       return qeth_do_send_packet(card, queue, skb, hdr, 0, elements);
 }
 
 static netdev_tx_t qeth_l2_hard_start_xmit(struct sk_buff *skb,
 
                        qeth_get_priority_queue(card, skb, ipv, cast_type) :
                        card->qdio.default_out_queue];
        int tx_bytes = skb->len;
+       unsigned int hd_len = 0;
        bool use_tso;
        int data_offset = -1;
        unsigned int nr_frags;
 
        if (card->info.type != QETH_CARD_TYPE_IQD) {
                int len;
-               if (use_tso)
-                       len = ((unsigned long)tcp_hdr(new_skb) +
-                               tcp_hdrlen(new_skb)) -
-                               (unsigned long)new_skb->data;
-               else
+               if (use_tso) {
+                       hd_len = sizeof(struct qeth_hdr_tso) +
+                                ip_hdrlen(new_skb) + tcp_hdrlen(new_skb);
+                       len = hd_len;
+               } else {
                        len = sizeof(struct qeth_hdr_layer3);
+               }
 
                if (qeth_hdr_chk_and_bounce(new_skb, &hdr, len))
                        goto tx_drop;
-               rc = qeth_do_send_packet(card, queue, new_skb, hdr, elements);
+               rc = qeth_do_send_packet(card, queue, new_skb, hdr, hd_len,
+                                        elements);
        } else
                rc = qeth_do_send_packet_fast(card, queue, new_skb, hdr,
                                              data_offset, 0);