Merge branch 'linus' into tracing/mmiotrace-mergefixups
[linux-2.6] / drivers / s390 / net / qeth_core_offl.c
1 /*
2  *  drivers/s390/net/qeth_core_offl.c
3  *
4  *    Copyright IBM Corp. 2007
5  *    Author(s): Thomas Spatzier <tspat@de.ibm.com>,
6  *               Frank Blaschka <frank.blaschka@de.ibm.com>
7  */
8
9 #include <linux/errno.h>
10 #include <linux/ip.h>
11 #include <linux/inetdevice.h>
12 #include <linux/netdevice.h>
13 #include <linux/kernel.h>
14 #include <linux/tcp.h>
15 #include <net/tcp.h>
16 #include <linux/skbuff.h>
17
18 #include <net/ip.h>
19 #include <net/ip6_checksum.h>
20
21 #include "qeth_core.h"
22 #include "qeth_core_mpc.h"
23 #include "qeth_core_offl.h"
24
25 int qeth_eddp_check_buffers_for_context(struct qeth_qdio_out_q *queue,
26                 struct qeth_eddp_context *ctx)
27 {
28         int index = queue->next_buf_to_fill;
29         int elements_needed = ctx->num_elements;
30         int elements_in_buffer;
31         int skbs_in_buffer;
32         int buffers_needed = 0;
33
34         QETH_DBF_TEXT(TRACE, 5, "eddpcbfc");
35         while (elements_needed > 0) {
36                 buffers_needed++;
37                 if (atomic_read(&queue->bufs[index].state) !=
38                                 QETH_QDIO_BUF_EMPTY)
39                         return -EBUSY;
40
41                 elements_in_buffer = QETH_MAX_BUFFER_ELEMENTS(queue->card) -
42                                      queue->bufs[index].next_element_to_fill;
43                 skbs_in_buffer = elements_in_buffer / ctx->elements_per_skb;
44                 elements_needed -= skbs_in_buffer * ctx->elements_per_skb;
45                 index = (index + 1) % QDIO_MAX_BUFFERS_PER_Q;
46         }
47         return buffers_needed;
48 }
49
50 static void qeth_eddp_free_context(struct qeth_eddp_context *ctx)
51 {
52         int i;
53
54         QETH_DBF_TEXT(TRACE, 5, "eddpfctx");
55         for (i = 0; i < ctx->num_pages; ++i)
56                 free_page((unsigned long)ctx->pages[i]);
57         kfree(ctx->pages);
58         kfree(ctx->elements);
59         kfree(ctx);
60 }
61
62
63 static void qeth_eddp_get_context(struct qeth_eddp_context *ctx)
64 {
65         atomic_inc(&ctx->refcnt);
66 }
67
68 void qeth_eddp_put_context(struct qeth_eddp_context *ctx)
69 {
70         if (atomic_dec_return(&ctx->refcnt) == 0)
71                 qeth_eddp_free_context(ctx);
72 }
73 EXPORT_SYMBOL_GPL(qeth_eddp_put_context);
74
75 void qeth_eddp_buf_release_contexts(struct qeth_qdio_out_buffer *buf)
76 {
77         struct qeth_eddp_context_reference *ref;
78
79         QETH_DBF_TEXT(TRACE, 6, "eddprctx");
80         while (!list_empty(&buf->ctx_list)) {
81                 ref = list_entry(buf->ctx_list.next,
82                                  struct qeth_eddp_context_reference, list);
83                 qeth_eddp_put_context(ref->ctx);
84                 list_del(&ref->list);
85                 kfree(ref);
86         }
87 }
88
89 static int qeth_eddp_buf_ref_context(struct qeth_qdio_out_buffer *buf,
90                 struct qeth_eddp_context *ctx)
91 {
92         struct qeth_eddp_context_reference *ref;
93
94         QETH_DBF_TEXT(TRACE, 6, "eddprfcx");
95         ref = kmalloc(sizeof(struct qeth_eddp_context_reference), GFP_ATOMIC);
96         if (ref == NULL)
97                 return -ENOMEM;
98         qeth_eddp_get_context(ctx);
99         ref->ctx = ctx;
100         list_add_tail(&ref->list, &buf->ctx_list);
101         return 0;
102 }
103
104 int qeth_eddp_fill_buffer(struct qeth_qdio_out_q *queue,
105                 struct qeth_eddp_context *ctx, int index)
106 {
107         struct qeth_qdio_out_buffer *buf = NULL;
108         struct qdio_buffer *buffer;
109         int elements = ctx->num_elements;
110         int element = 0;
111         int flush_cnt = 0;
112         int must_refcnt = 1;
113         int i;
114
115         QETH_DBF_TEXT(TRACE, 5, "eddpfibu");
116         while (elements > 0) {
117                 buf = &queue->bufs[index];
118                 if (atomic_read(&buf->state) != QETH_QDIO_BUF_EMPTY) {
119                         /* normally this should not happen since we checked for
120                          * available elements in qeth_check_elements_for_context
121                          */
122                         if (element == 0)
123                                 return -EBUSY;
124                         else {
125                                 QETH_DBF_MESSAGE(2, "could only partially fill"
126                                         "eddp buffer!\n");
127                                 goto out;
128                         }
129                 }
130                 /* check if the whole next skb fits into current buffer */
131                 if ((QETH_MAX_BUFFER_ELEMENTS(queue->card) -
132                                         buf->next_element_to_fill)
133                                 < ctx->elements_per_skb){
134                         /* no -> go to next buffer */
135                         atomic_set(&buf->state, QETH_QDIO_BUF_PRIMED);
136                         index = (index + 1) % QDIO_MAX_BUFFERS_PER_Q;
137                         flush_cnt++;
138                         /* new buffer, so we have to add ctx to buffer'ctx_list
139                          * and increment ctx's refcnt */
140                         must_refcnt = 1;
141                         continue;
142                 }
143                 if (must_refcnt) {
144                         must_refcnt = 0;
145                         if (qeth_eddp_buf_ref_context(buf, ctx)) {
146                                 goto out_check;
147                         }
148                 }
149                 buffer = buf->buffer;
150                 /* fill one skb into buffer */
151                 for (i = 0; i < ctx->elements_per_skb; ++i) {
152                         if (ctx->elements[element].length != 0) {
153                                 buffer->element[buf->next_element_to_fill].
154                                 addr = ctx->elements[element].addr;
155                                 buffer->element[buf->next_element_to_fill].
156                                 length = ctx->elements[element].length;
157                                 buffer->element[buf->next_element_to_fill].
158                                 flags = ctx->elements[element].flags;
159                                 buf->next_element_to_fill++;
160                         }
161                         element++;
162                         elements--;
163                 }
164         }
165 out_check:
166         if (!queue->do_pack) {
167                 QETH_DBF_TEXT(TRACE, 6, "fillbfnp");
168                 /* set state to PRIMED -> will be flushed */
169                 if (buf->next_element_to_fill > 0) {
170                         atomic_set(&buf->state, QETH_QDIO_BUF_PRIMED);
171                         flush_cnt++;
172                 }
173         } else {
174                 if (queue->card->options.performance_stats)
175                         queue->card->perf_stats.skbs_sent_pack++;
176                 QETH_DBF_TEXT(TRACE, 6, "fillbfpa");
177                 if (buf->next_element_to_fill >=
178                                 QETH_MAX_BUFFER_ELEMENTS(queue->card)) {
179                         /*
180                          * packed buffer if full -> set state PRIMED
181                          * -> will be flushed
182                          */
183                         atomic_set(&buf->state, QETH_QDIO_BUF_PRIMED);
184                         flush_cnt++;
185                 }
186         }
187 out:
188         return flush_cnt;
189 }
190
191 static void qeth_eddp_create_segment_hdrs(struct qeth_eddp_context *ctx,
192                 struct qeth_eddp_data *eddp, int data_len)
193 {
194         u8 *page;
195         int page_remainder;
196         int page_offset;
197         int pkt_len;
198         struct qeth_eddp_element *element;
199
200         QETH_DBF_TEXT(TRACE, 5, "eddpcrsh");
201         page = ctx->pages[ctx->offset >> PAGE_SHIFT];
202         page_offset = ctx->offset % PAGE_SIZE;
203         element = &ctx->elements[ctx->num_elements];
204         pkt_len = eddp->nhl + eddp->thl + data_len;
205         /* FIXME: layer2 and VLAN !!! */
206         if (eddp->qh.hdr.l2.id == QETH_HEADER_TYPE_LAYER2)
207                 pkt_len += ETH_HLEN;
208         if (eddp->mac.h_proto == __constant_htons(ETH_P_8021Q))
209                 pkt_len += VLAN_HLEN;
210         /* does complete packet fit in current page ? */
211         page_remainder = PAGE_SIZE - page_offset;
212         if (page_remainder < (sizeof(struct qeth_hdr) + pkt_len)) {
213                 /* no -> go to start of next page */
214                 ctx->offset += page_remainder;
215                 page = ctx->pages[ctx->offset >> PAGE_SHIFT];
216                 page_offset = 0;
217         }
218         memcpy(page + page_offset, &eddp->qh, sizeof(struct qeth_hdr));
219         element->addr = page + page_offset;
220         element->length = sizeof(struct qeth_hdr);
221         ctx->offset += sizeof(struct qeth_hdr);
222         page_offset += sizeof(struct qeth_hdr);
223         /* add mac header (?) */
224         if (eddp->qh.hdr.l2.id == QETH_HEADER_TYPE_LAYER2) {
225                 memcpy(page + page_offset, &eddp->mac, ETH_HLEN);
226                 element->length += ETH_HLEN;
227                 ctx->offset += ETH_HLEN;
228                 page_offset += ETH_HLEN;
229         }
230         /* add VLAN tag */
231         if (eddp->mac.h_proto == __constant_htons(ETH_P_8021Q)) {
232                 memcpy(page + page_offset, &eddp->vlan, VLAN_HLEN);
233                 element->length += VLAN_HLEN;
234                 ctx->offset += VLAN_HLEN;
235                 page_offset += VLAN_HLEN;
236         }
237         /* add network header */
238         memcpy(page + page_offset, (u8 *)&eddp->nh, eddp->nhl);
239         element->length += eddp->nhl;
240         eddp->nh_in_ctx = page + page_offset;
241         ctx->offset += eddp->nhl;
242         page_offset += eddp->nhl;
243         /* add transport header */
244         memcpy(page + page_offset, (u8 *)&eddp->th, eddp->thl);
245         element->length += eddp->thl;
246         eddp->th_in_ctx = page + page_offset;
247         ctx->offset += eddp->thl;
248 }
249
250 static void qeth_eddp_copy_data_tcp(char *dst, struct qeth_eddp_data *eddp,
251                 int len, __wsum *hcsum)
252 {
253         struct skb_frag_struct *frag;
254         int left_in_frag;
255         int copy_len;
256         u8 *src;
257
258         QETH_DBF_TEXT(TRACE, 5, "eddpcdtc");
259         if (skb_shinfo(eddp->skb)->nr_frags == 0) {
260                 skb_copy_from_linear_data_offset(eddp->skb, eddp->skb_offset,
261                                                  dst, len);
262                 *hcsum = csum_partial(eddp->skb->data + eddp->skb_offset, len,
263                                       *hcsum);
264                 eddp->skb_offset += len;
265         } else {
266                 while (len > 0) {
267                         if (eddp->frag < 0) {
268                                 /* we're in skb->data */
269                                 left_in_frag = (eddp->skb->len -
270                                                 eddp->skb->data_len)
271                                                 - eddp->skb_offset;
272                                 src = eddp->skb->data + eddp->skb_offset;
273                         } else {
274                                 frag = &skb_shinfo(eddp->skb)->frags[
275                                         eddp->frag];
276                                 left_in_frag = frag->size - eddp->frag_offset;
277                                 src = (u8 *)((page_to_pfn(frag->page) <<
278                                         PAGE_SHIFT) + frag->page_offset +
279                                         eddp->frag_offset);
280                         }
281                         if (left_in_frag <= 0) {
282                                 eddp->frag++;
283                                 eddp->frag_offset = 0;
284                                 continue;
285                         }
286                         copy_len = min(left_in_frag, len);
287                         memcpy(dst, src, copy_len);
288                         *hcsum = csum_partial(src, copy_len, *hcsum);
289                         dst += copy_len;
290                         eddp->frag_offset += copy_len;
291                         eddp->skb_offset += copy_len;
292                         len -= copy_len;
293                 }
294         }
295 }
296
297 static void qeth_eddp_create_segment_data_tcp(struct qeth_eddp_context *ctx,
298                 struct qeth_eddp_data *eddp, int data_len, __wsum hcsum)
299 {
300         u8 *page;
301         int page_remainder;
302         int page_offset;
303         struct qeth_eddp_element *element;
304         int first_lap = 1;
305
306         QETH_DBF_TEXT(TRACE, 5, "eddpcsdt");
307         page = ctx->pages[ctx->offset >> PAGE_SHIFT];
308         page_offset = ctx->offset % PAGE_SIZE;
309         element = &ctx->elements[ctx->num_elements];
310         while (data_len) {
311                 page_remainder = PAGE_SIZE - page_offset;
312                 if (page_remainder < data_len) {
313                         qeth_eddp_copy_data_tcp(page + page_offset, eddp,
314                                                 page_remainder, &hcsum);
315                         element->length += page_remainder;
316                         if (first_lap)
317                                 element->flags = SBAL_FLAGS_FIRST_FRAG;
318                         else
319                                 element->flags = SBAL_FLAGS_MIDDLE_FRAG;
320                         ctx->num_elements++;
321                         element++;
322                         data_len -= page_remainder;
323                         ctx->offset += page_remainder;
324                         page = ctx->pages[ctx->offset >> PAGE_SHIFT];
325                         page_offset = 0;
326                         element->addr = page + page_offset;
327                 } else {
328                         qeth_eddp_copy_data_tcp(page + page_offset, eddp,
329                                                 data_len, &hcsum);
330                         element->length += data_len;
331                         if (!first_lap)
332                                 element->flags = SBAL_FLAGS_LAST_FRAG;
333                         ctx->num_elements++;
334                         ctx->offset += data_len;
335                         data_len = 0;
336                 }
337                 first_lap = 0;
338         }
339         ((struct tcphdr *)eddp->th_in_ctx)->check = csum_fold(hcsum);
340 }
341
342 static __wsum qeth_eddp_check_tcp4_hdr(struct qeth_eddp_data *eddp,
343                 int data_len)
344 {
345         __wsum phcsum; /* pseudo header checksum */
346
347         QETH_DBF_TEXT(TRACE, 5, "eddpckt4");
348         eddp->th.tcp.h.check = 0;
349         /* compute pseudo header checksum */
350         phcsum = csum_tcpudp_nofold(eddp->nh.ip4.h.saddr, eddp->nh.ip4.h.daddr,
351                                     eddp->thl + data_len, IPPROTO_TCP, 0);
352         /* compute checksum of tcp header */
353         return csum_partial((u8 *)&eddp->th, eddp->thl, phcsum);
354 }
355
356 static __wsum qeth_eddp_check_tcp6_hdr(struct qeth_eddp_data *eddp,
357                 int data_len)
358 {
359         __be32 proto;
360         __wsum phcsum; /* pseudo header checksum */
361
362         QETH_DBF_TEXT(TRACE, 5, "eddpckt6");
363         eddp->th.tcp.h.check = 0;
364         /* compute pseudo header checksum */
365         phcsum = csum_partial((u8 *)&eddp->nh.ip6.h.saddr,
366                               sizeof(struct in6_addr), 0);
367         phcsum = csum_partial((u8 *)&eddp->nh.ip6.h.daddr,
368                               sizeof(struct in6_addr), phcsum);
369         proto = htonl(IPPROTO_TCP);
370         phcsum = csum_partial((u8 *)&proto, sizeof(u32), phcsum);
371         return phcsum;
372 }
373
374 static struct qeth_eddp_data *qeth_eddp_create_eddp_data(struct qeth_hdr *qh,
375                 u8 *nh, u8 nhl, u8 *th, u8 thl)
376 {
377         struct qeth_eddp_data *eddp;
378
379         QETH_DBF_TEXT(TRACE, 5, "eddpcrda");
380         eddp = kzalloc(sizeof(struct qeth_eddp_data), GFP_ATOMIC);
381         if (eddp) {
382                 eddp->nhl = nhl;
383                 eddp->thl = thl;
384                 memcpy(&eddp->qh, qh, sizeof(struct qeth_hdr));
385                 memcpy(&eddp->nh, nh, nhl);
386                 memcpy(&eddp->th, th, thl);
387                 eddp->frag = -1; /* initially we're in skb->data */
388         }
389         return eddp;
390 }
391
392 static void __qeth_eddp_fill_context_tcp(struct qeth_eddp_context *ctx,
393                 struct qeth_eddp_data *eddp)
394 {
395         struct tcphdr *tcph;
396         int data_len;
397         __wsum hcsum;
398
399         QETH_DBF_TEXT(TRACE, 5, "eddpftcp");
400         eddp->skb_offset = sizeof(struct qeth_hdr) + eddp->nhl + eddp->thl;
401         if (eddp->qh.hdr.l2.id == QETH_HEADER_TYPE_LAYER2) {
402                 eddp->skb_offset += sizeof(struct ethhdr);
403                 if (eddp->mac.h_proto == __constant_htons(ETH_P_8021Q))
404                         eddp->skb_offset += VLAN_HLEN;
405         }
406         tcph = tcp_hdr(eddp->skb);
407         while (eddp->skb_offset < eddp->skb->len) {
408                 data_len = min((int)skb_shinfo(eddp->skb)->gso_size,
409                                (int)(eddp->skb->len - eddp->skb_offset));
410                 /* prepare qdio hdr */
411                 if (eddp->qh.hdr.l2.id == QETH_HEADER_TYPE_LAYER2) {
412                         eddp->qh.hdr.l2.pkt_length = data_len + ETH_HLEN +
413                                                      eddp->nhl + eddp->thl;
414                         if (eddp->mac.h_proto == __constant_htons(ETH_P_8021Q))
415                                 eddp->qh.hdr.l2.pkt_length += VLAN_HLEN;
416                 } else
417                         eddp->qh.hdr.l3.length = data_len + eddp->nhl +
418                                                  eddp->thl;
419                 /* prepare ip hdr */
420                 if (eddp->skb->protocol == htons(ETH_P_IP)) {
421                         eddp->nh.ip4.h.tot_len = htons(data_len + eddp->nhl +
422                                                  eddp->thl);
423                         eddp->nh.ip4.h.check = 0;
424                         eddp->nh.ip4.h.check =
425                                 ip_fast_csum((u8 *)&eddp->nh.ip4.h,
426                                                 eddp->nh.ip4.h.ihl);
427                 } else
428                         eddp->nh.ip6.h.payload_len = htons(data_len +
429                                                                 eddp->thl);
430                 /* prepare tcp hdr */
431                 if (data_len == (eddp->skb->len - eddp->skb_offset)) {
432                         /* last segment -> set FIN and PSH flags */
433                         eddp->th.tcp.h.fin = tcph->fin;
434                         eddp->th.tcp.h.psh = tcph->psh;
435                 }
436                 if (eddp->skb->protocol == htons(ETH_P_IP))
437                         hcsum = qeth_eddp_check_tcp4_hdr(eddp, data_len);
438                 else
439                         hcsum = qeth_eddp_check_tcp6_hdr(eddp, data_len);
440                 /* fill the next segment into the context */
441                 qeth_eddp_create_segment_hdrs(ctx, eddp, data_len);
442                 qeth_eddp_create_segment_data_tcp(ctx, eddp, data_len, hcsum);
443                 if (eddp->skb_offset >= eddp->skb->len)
444                         break;
445                 /* prepare headers for next round */
446                 if (eddp->skb->protocol == htons(ETH_P_IP))
447                         eddp->nh.ip4.h.id = htons(ntohs(eddp->nh.ip4.h.id) + 1);
448                 eddp->th.tcp.h.seq = htonl(ntohl(eddp->th.tcp.h.seq) +
449                         data_len);
450         }
451 }
452
453 static int qeth_eddp_fill_context_tcp(struct qeth_eddp_context *ctx,
454                 struct sk_buff *skb, struct qeth_hdr *qhdr)
455 {
456         struct qeth_eddp_data *eddp = NULL;
457
458         QETH_DBF_TEXT(TRACE, 5, "eddpficx");
459         /* create our segmentation headers and copy original headers */
460         if (skb->protocol == htons(ETH_P_IP))
461                 eddp = qeth_eddp_create_eddp_data(qhdr,
462                                                   skb_network_header(skb),
463                                                   ip_hdrlen(skb),
464                                                   skb_transport_header(skb),
465                                                   tcp_hdrlen(skb));
466         else
467                 eddp = qeth_eddp_create_eddp_data(qhdr,
468                                                   skb_network_header(skb),
469                                                   sizeof(struct ipv6hdr),
470                                                   skb_transport_header(skb),
471                                                   tcp_hdrlen(skb));
472
473         if (eddp == NULL) {
474                 QETH_DBF_TEXT(TRACE, 2, "eddpfcnm");
475                 return -ENOMEM;
476         }
477         if (qhdr->hdr.l2.id == QETH_HEADER_TYPE_LAYER2) {
478                 skb_set_mac_header(skb, sizeof(struct qeth_hdr));
479                 memcpy(&eddp->mac, eth_hdr(skb), ETH_HLEN);
480                 if (eddp->mac.h_proto == __constant_htons(ETH_P_8021Q)) {
481                         eddp->vlan[0] = skb->protocol;
482                         eddp->vlan[1] = htons(vlan_tx_tag_get(skb));
483                 }
484         }
485         /* the next flags will only be set on the last segment */
486         eddp->th.tcp.h.fin = 0;
487         eddp->th.tcp.h.psh = 0;
488         eddp->skb = skb;
489         /* begin segmentation and fill context */
490         __qeth_eddp_fill_context_tcp(ctx, eddp);
491         kfree(eddp);
492         return 0;
493 }
494
495 static void qeth_eddp_calc_num_pages(struct qeth_eddp_context *ctx,
496                 struct sk_buff *skb, int hdr_len)
497 {
498         int skbs_per_page;
499
500         QETH_DBF_TEXT(TRACE, 5, "eddpcanp");
501         /* can we put multiple skbs in one page? */
502         skbs_per_page = PAGE_SIZE / (skb_shinfo(skb)->gso_size + hdr_len);
503         if (skbs_per_page > 1) {
504                 ctx->num_pages = (skb_shinfo(skb)->gso_segs + 1) /
505                                  skbs_per_page + 1;
506                 ctx->elements_per_skb = 1;
507         } else {
508                 /* no -> how many elements per skb? */
509                 ctx->elements_per_skb = (skb_shinfo(skb)->gso_size + hdr_len +
510                                      PAGE_SIZE) >> PAGE_SHIFT;
511                 ctx->num_pages = ctx->elements_per_skb *
512                                  (skb_shinfo(skb)->gso_segs + 1);
513         }
514         ctx->num_elements = ctx->elements_per_skb *
515                             (skb_shinfo(skb)->gso_segs + 1);
516 }
517
518 static struct qeth_eddp_context *qeth_eddp_create_context_generic(
519                 struct qeth_card *card, struct sk_buff *skb, int hdr_len)
520 {
521         struct qeth_eddp_context *ctx = NULL;
522         u8 *addr;
523         int i;
524
525         QETH_DBF_TEXT(TRACE, 5, "creddpcg");
526         /* create the context and allocate pages */
527         ctx = kzalloc(sizeof(struct qeth_eddp_context), GFP_ATOMIC);
528         if (ctx == NULL) {
529                 QETH_DBF_TEXT(TRACE, 2, "ceddpcn1");
530                 return NULL;
531         }
532         ctx->type = QETH_LARGE_SEND_EDDP;
533         qeth_eddp_calc_num_pages(ctx, skb, hdr_len);
534         if (ctx->elements_per_skb > QETH_MAX_BUFFER_ELEMENTS(card)) {
535                 QETH_DBF_TEXT(TRACE, 2, "ceddpcis");
536                 kfree(ctx);
537                 return NULL;
538         }
539         ctx->pages = kcalloc(ctx->num_pages, sizeof(u8 *), GFP_ATOMIC);
540         if (ctx->pages == NULL) {
541                 QETH_DBF_TEXT(TRACE, 2, "ceddpcn2");
542                 kfree(ctx);
543                 return NULL;
544         }
545         for (i = 0; i < ctx->num_pages; ++i) {
546                 addr = (u8 *)get_zeroed_page(GFP_ATOMIC);
547                 if (addr == NULL) {
548                         QETH_DBF_TEXT(TRACE, 2, "ceddpcn3");
549                         ctx->num_pages = i;
550                         qeth_eddp_free_context(ctx);
551                         return NULL;
552                 }
553                 ctx->pages[i] = addr;
554         }
555         ctx->elements = kcalloc(ctx->num_elements,
556                                 sizeof(struct qeth_eddp_element), GFP_ATOMIC);
557         if (ctx->elements == NULL) {
558                 QETH_DBF_TEXT(TRACE, 2, "ceddpcn4");
559                 qeth_eddp_free_context(ctx);
560                 return NULL;
561         }
562         /* reset num_elements; will be incremented again in fill_buffer to
563          * reflect number of actually used elements */
564         ctx->num_elements = 0;
565         return ctx;
566 }
567
568 static struct qeth_eddp_context *qeth_eddp_create_context_tcp(
569                 struct qeth_card *card, struct sk_buff *skb,
570                 struct qeth_hdr *qhdr)
571 {
572         struct qeth_eddp_context *ctx = NULL;
573
574         QETH_DBF_TEXT(TRACE, 5, "creddpct");
575         if (skb->protocol == htons(ETH_P_IP))
576                 ctx = qeth_eddp_create_context_generic(card, skb,
577                                                 (sizeof(struct qeth_hdr) +
578                                                 ip_hdrlen(skb) +
579                                                 tcp_hdrlen(skb)));
580         else if (skb->protocol == htons(ETH_P_IPV6))
581                 ctx = qeth_eddp_create_context_generic(card, skb,
582                         sizeof(struct qeth_hdr) + sizeof(struct ipv6hdr) +
583                         tcp_hdrlen(skb));
584         else
585                 QETH_DBF_TEXT(TRACE, 2, "cetcpinv");
586
587         if (ctx == NULL) {
588                 QETH_DBF_TEXT(TRACE, 2, "creddpnl");
589                 return NULL;
590         }
591         if (qeth_eddp_fill_context_tcp(ctx, skb, qhdr)) {
592                 QETH_DBF_TEXT(TRACE, 2, "ceddptfe");
593                 qeth_eddp_free_context(ctx);
594                 return NULL;
595         }
596         atomic_set(&ctx->refcnt, 1);
597         return ctx;
598 }
599
600 struct qeth_eddp_context *qeth_eddp_create_context(struct qeth_card *card,
601                 struct sk_buff *skb, struct qeth_hdr *qhdr,
602                 unsigned char sk_protocol)
603 {
604         QETH_DBF_TEXT(TRACE, 5, "creddpc");
605         switch (sk_protocol) {
606         case IPPROTO_TCP:
607                 return qeth_eddp_create_context_tcp(card, skb, qhdr);
608         default:
609                 QETH_DBF_TEXT(TRACE, 2, "eddpinvp");
610         }
611         return NULL;
612 }
613 EXPORT_SYMBOL_GPL(qeth_eddp_create_context);
614
615 void qeth_tso_fill_header(struct qeth_card *card, struct qeth_hdr *qhdr,
616                 struct sk_buff *skb)
617 {
618         struct qeth_hdr_tso *hdr = (struct qeth_hdr_tso *)qhdr;
619         struct tcphdr *tcph = tcp_hdr(skb);
620         struct iphdr *iph = ip_hdr(skb);
621         struct ipv6hdr *ip6h = ipv6_hdr(skb);
622
623         QETH_DBF_TEXT(TRACE, 5, "tsofhdr");
624
625         /*fix header to TSO values ...*/
626         hdr->hdr.hdr.l3.id = QETH_HEADER_TYPE_TSO;
627         /*set values which are fix for the first approach ...*/
628         hdr->ext.hdr_tot_len = (__u16) sizeof(struct qeth_hdr_ext_tso);
629         hdr->ext.imb_hdr_no  = 1;
630         hdr->ext.hdr_type    = 1;
631         hdr->ext.hdr_version = 1;
632         hdr->ext.hdr_len     = 28;
633         /*insert non-fix values */
634         hdr->ext.mss = skb_shinfo(skb)->gso_size;
635         hdr->ext.dg_hdr_len = (__u16)(iph->ihl*4 + tcph->doff*4);
636         hdr->ext.payload_len = (__u16)(skb->len - hdr->ext.dg_hdr_len -
637                                        sizeof(struct qeth_hdr_tso));
638         tcph->check = 0;
639         if (skb->protocol == ETH_P_IPV6) {
640                 ip6h->payload_len = 0;
641                 tcph->check = ~csum_ipv6_magic(&ip6h->saddr, &ip6h->daddr,
642                                                0, IPPROTO_TCP, 0);
643         } else {
644                 /*OSA want us to set these values ...*/
645                 tcph->check = ~csum_tcpudp_magic(iph->saddr, iph->daddr,
646                                          0, IPPROTO_TCP, 0);
647                 iph->tot_len = 0;
648                 iph->check = 0;
649         }
650 }
651 EXPORT_SYMBOL_GPL(qeth_tso_fill_header);
652
653 void qeth_tx_csum(struct sk_buff *skb)
654 {
655         int tlen;
656         if (skb->protocol == htons(ETH_P_IP)) {
657                 tlen = ntohs(ip_hdr(skb)->tot_len) - (ip_hdr(skb)->ihl << 2);
658                 switch (ip_hdr(skb)->protocol) {
659                 case IPPROTO_TCP:
660                         tcp_hdr(skb)->check = 0;
661                         tcp_hdr(skb)->check = csum_tcpudp_magic(
662                                 ip_hdr(skb)->saddr, ip_hdr(skb)->daddr,
663                                 tlen, ip_hdr(skb)->protocol,
664                                 skb_checksum(skb, skb_transport_offset(skb),
665                                         tlen, 0));
666                         break;
667                 case IPPROTO_UDP:
668                         udp_hdr(skb)->check = 0;
669                         udp_hdr(skb)->check = csum_tcpudp_magic(
670                                 ip_hdr(skb)->saddr, ip_hdr(skb)->daddr,
671                                 tlen, ip_hdr(skb)->protocol,
672                                 skb_checksum(skb, skb_transport_offset(skb),
673                                         tlen, 0));
674                         break;
675                 }
676         } else if (skb->protocol == htons(ETH_P_IPV6)) {
677                 switch (ipv6_hdr(skb)->nexthdr) {
678                 case IPPROTO_TCP:
679                         tcp_hdr(skb)->check = 0;
680                         tcp_hdr(skb)->check = csum_ipv6_magic(
681                                 &ipv6_hdr(skb)->saddr, &ipv6_hdr(skb)->daddr,
682                                 ipv6_hdr(skb)->payload_len,
683                                 ipv6_hdr(skb)->nexthdr,
684                                 skb_checksum(skb, skb_transport_offset(skb),
685                                         ipv6_hdr(skb)->payload_len, 0));
686                         break;
687                 case IPPROTO_UDP:
688                         udp_hdr(skb)->check = 0;
689                         udp_hdr(skb)->check = csum_ipv6_magic(
690                                 &ipv6_hdr(skb)->saddr, &ipv6_hdr(skb)->daddr,
691                                 ipv6_hdr(skb)->payload_len,
692                                 ipv6_hdr(skb)->nexthdr,
693                                 skb_checksum(skb, skb_transport_offset(skb),
694                                         ipv6_hdr(skb)->payload_len, 0));
695                         break;
696                 }
697         }
698 }
699 EXPORT_SYMBOL_GPL(qeth_tx_csum);