release/src-rt-6.x/linux/linux-2.6/drivers/s390/net/qeth_eddp.c

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