SAFE public projects git trees. - safe/jmp/linux-2.6/blob - drivers/net/ehea/ehea_main.c

   1 /*
   2  *  linux/drivers/net/ehea/ehea_main.c
   3  *
   4  *  eHEA ethernet device driver for IBM eServer System p
   5  *
   6  *  (C) Copyright IBM Corp. 2006
   7  *
   8  *  Authors:
   9  *       Christoph Raisch <raisch@de.ibm.com>
  10  *       Jan-Bernd Themann <themann@de.ibm.com>
  11  *       Thomas Klein <tklein@de.ibm.com>
  12  *
  13  *
  14  * This program is free software; you can redistribute it and/or modify
  15  * it under the terms of the GNU General Public License as published by
  16  * the Free Software Foundation; either version 2, or (at your option)
  17  * any later version.
  18  *
  19  * This program is distributed in the hope that it will be useful,
  20  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  21  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  22  * GNU General Public License for more details.
  23  *
  24  * You should have received a copy of the GNU General Public License
  25  * along with this program; if not, write to the Free Software
  26  * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  27  */
  28
  29 #include <linux/in.h>
  30 #include <linux/ip.h>
  31 #include <linux/tcp.h>
  32 #include <linux/udp.h>
  33 #include <linux/if.h>
  34 #include <linux/list.h>
  35 #include <linux/if_ether.h>
  36 #include <net/ip.h>
  37
  38 #include "ehea.h"
  39 #include "ehea_qmr.h"
  40 #include "ehea_phyp.h"
  41
  42
  43 MODULE_LICENSE("GPL");
  44 MODULE_AUTHOR("Christoph Raisch <raisch@de.ibm.com>");
  45 MODULE_DESCRIPTION("IBM eServer HEA Driver");
  46 MODULE_VERSION(DRV_VERSION);
  47
  48
  49 static int msg_level = -1;
  50 static int rq1_entries = EHEA_DEF_ENTRIES_RQ1;
  51 static int rq2_entries = EHEA_DEF_ENTRIES_RQ2;
  52 static int rq3_entries = EHEA_DEF_ENTRIES_RQ3;
  53 static int sq_entries = EHEA_DEF_ENTRIES_SQ;
  54 static int use_mcs = 0;
  55 static int num_tx_qps = EHEA_NUM_TX_QP;
  56
  57 module_param(msg_level, int, 0);
  58 module_param(rq1_entries, int, 0);
  59 module_param(rq2_entries, int, 0);
  60 module_param(rq3_entries, int, 0);
  61 module_param(sq_entries, int, 0);
  62 module_param(use_mcs, int, 0);
  63 module_param(num_tx_qps, int, 0);
  64
  65 MODULE_PARM_DESC(num_tx_qps, "Number of TX-QPS");
  66 MODULE_PARM_DESC(msg_level, "msg_level");
  67 MODULE_PARM_DESC(rq3_entries, "Number of entries for Receive Queue 3 "
  68                  "[2^x - 1], x = [6..14]. Default = "
  69                  __MODULE_STRING(EHEA_DEF_ENTRIES_RQ3) ")");
  70 MODULE_PARM_DESC(rq2_entries, "Number of entries for Receive Queue 2 "
  71                  "[2^x - 1], x = [6..14]. Default = "
  72                  __MODULE_STRING(EHEA_DEF_ENTRIES_RQ2) ")");
  73 MODULE_PARM_DESC(rq1_entries, "Number of entries for Receive Queue 1 "
  74                  "[2^x - 1], x = [6..14]. Default = "
  75                  __MODULE_STRING(EHEA_DEF_ENTRIES_RQ1) ")");
  76 MODULE_PARM_DESC(sq_entries, " Number of entries for the Send Queue  "
  77                  "[2^x - 1], x = [6..14]. Default = "
  78                  __MODULE_STRING(EHEA_DEF_ENTRIES_SQ) ")");
  79 MODULE_PARM_DESC(use_mcs, " 0:NAPI, 1:Multiple receive queues, Default = 1 ");
  80
  81 void ehea_dump(void *adr, int len, char *msg) {
  82         int x;
  83         unsigned char *deb = adr;
  84         for (x = 0; x < len; x += 16) {
  85                 printk(DRV_NAME " %s adr=%p ofs=%04x %016lx %016lx\n", msg,
  86                           deb, x, *((u64*)&deb[0]), *((u64*)&deb[8]));
  87                 deb += 16;
  88         }
  89 }
  90
  91 static struct net_device_stats *ehea_get_stats(struct net_device *dev)
  92 {
  93         struct ehea_port *port = netdev_priv(dev);
  94         struct net_device_stats *stats = &port->stats;
  95         struct hcp_ehea_port_cb2 *cb2;
  96         u64 hret, rx_packets;
  97         int i;
  98
  99         memset(stats, 0, sizeof(*stats));
 100
 101         cb2 = kzalloc(PAGE_SIZE, GFP_KERNEL);
 102         if (!cb2) {
 103                 ehea_error("no mem for cb2");
 104                 goto out;
 105         }
 106
 107         hret = ehea_h_query_ehea_port(port->adapter->handle,
 108                                       port->logical_port_id,
 109                                       H_PORT_CB2, H_PORT_CB2_ALL, cb2);
 110         if (hret != H_SUCCESS) {
 111                 ehea_error("query_ehea_port failed");
 112                 goto out_herr;
 113         }
 114
 115         if (netif_msg_hw(port))
 116                 ehea_dump(cb2, sizeof(*cb2), "net_device_stats");
 117
 118         rx_packets = 0;
 119         for (i = 0; i < port->num_def_qps; i++)
 120                 rx_packets += port->port_res[i].rx_packets;
 121
 122         stats->tx_packets = cb2->txucp + cb2->txmcp + cb2->txbcp;
 123         stats->multicast = cb2->rxmcp;
 124         stats->rx_errors = cb2->rxuerr;
 125         stats->rx_bytes = cb2->rxo;
 126         stats->tx_bytes = cb2->txo;
 127         stats->rx_packets = rx_packets;
 128
 129 out_herr:
 130         kfree(cb2);
 131 out:
 132         return stats;
 133 }
 134
 135 static void ehea_refill_rq1(struct ehea_port_res *pr, int index, int nr_of_wqes)
 136 {
 137         struct sk_buff **skb_arr_rq1 = pr->rq1_skba.arr;
 138         struct net_device *dev = pr->port->netdev;
 139         int max_index_mask = pr->rq1_skba.len - 1;
 140         int i;
 141
 142         if (!nr_of_wqes)
 143                 return;
 144
 145         for (i = 0; i < nr_of_wqes; i++) {
 146                 if (!skb_arr_rq1[index]) {
 147                         skb_arr_rq1[index] = netdev_alloc_skb(dev,
 148                                                               EHEA_L_PKT_SIZE);
 149                         if (!skb_arr_rq1[index]) {
 150                                 ehea_error("%s: no mem for skb/%d wqes filled",
 151                                            dev->name, i);
 152                                 break;
 153                         }
 154                 }
 155                 index--;
 156                 index &= max_index_mask;
 157         }
 158         /* Ring doorbell */
 159         ehea_update_rq1a(pr->qp, i);
 160 }
 161
 162 static int ehea_init_fill_rq1(struct ehea_port_res *pr, int nr_rq1a)
 163 {
 164         int ret = 0;
 165         struct sk_buff **skb_arr_rq1 = pr->rq1_skba.arr;
 166         struct net_device *dev = pr->port->netdev;
 167         int i;
 168
 169         for (i = 0; i < pr->rq1_skba.len; i++) {
 170                 skb_arr_rq1[i] = netdev_alloc_skb(dev, EHEA_L_PKT_SIZE);
 171                 if (!skb_arr_rq1[i]) {
 172                         ehea_error("%s: no mem for skb/%d wqes filled",
 173                                    dev->name, i);
 174                         ret = -ENOMEM;
 175                         goto out;
 176                 }
 177         }
 178         /* Ring doorbell */
 179         ehea_update_rq1a(pr->qp, nr_rq1a);
 180 out:
 181         return ret;
 182 }
 183
 184 static int ehea_refill_rq_def(struct ehea_port_res *pr,
 185                               struct ehea_q_skb_arr *q_skba, int rq_nr,
 186                               int num_wqes, int wqe_type, int packet_size)
 187 {
 188         struct net_device *dev = pr->port->netdev;
 189         struct ehea_qp *qp = pr->qp;
 190         struct sk_buff **skb_arr = q_skba->arr;
 191         struct ehea_rwqe *rwqe;
 192         int i, index, max_index_mask, fill_wqes;
 193         int ret = 0;
 194
 195         fill_wqes = q_skba->os_skbs + num_wqes;
 196
 197         if (!fill_wqes)
 198                 return ret;
 199
 200         index = q_skba->index;
 201         max_index_mask = q_skba->len - 1;
 202         for (i = 0; i < fill_wqes; i++) {
 203                 struct sk_buff *skb = netdev_alloc_skb(dev, packet_size);
 204                 if (!skb) {
 205                         ehea_error("%s: no mem for skb/%d wqes filled",
 206                                    pr->port->netdev->name, i);
 207                         q_skba->os_skbs = fill_wqes - i;
 208                         ret = -ENOMEM;
 209                         break;
 210                 }
 211                 skb_reserve(skb, NET_IP_ALIGN);
 212
 213                 skb_arr[index] = skb;
 214
 215                 rwqe = ehea_get_next_rwqe(qp, rq_nr);
 216                 rwqe->wr_id = EHEA_BMASK_SET(EHEA_WR_ID_TYPE, wqe_type)
 217                             | EHEA_BMASK_SET(EHEA_WR_ID_INDEX, index);
 218                 rwqe->sg_list[0].l_key = pr->recv_mr.lkey;
 219                 rwqe->sg_list[0].vaddr = (u64)skb->data;
 220                 rwqe->sg_list[0].len = packet_size;
 221                 rwqe->data_segments = 1;
 222
 223                 index++;
 224                 index &= max_index_mask;
 225         }
 226         q_skba->index = index;
 227
 228         /* Ring doorbell */
 229         iosync();
 230         if (rq_nr == 2)
 231                 ehea_update_rq2a(pr->qp, i);
 232         else
 233                 ehea_update_rq3a(pr->qp, i);
 234
 235         return ret;
 236 }
 237
 238
 239 static int ehea_refill_rq2(struct ehea_port_res *pr, int nr_of_wqes)
 240 {
 241         return ehea_refill_rq_def(pr, &pr->rq2_skba, 2,
 242                                   nr_of_wqes, EHEA_RWQE2_TYPE,
 243                                   EHEA_RQ2_PKT_SIZE + NET_IP_ALIGN);
 244 }
 245
 246
 247 static int ehea_refill_rq3(struct ehea_port_res *pr, int nr_of_wqes)
 248 {
 249         return ehea_refill_rq_def(pr, &pr->rq3_skba, 3,
 250                                   nr_of_wqes, EHEA_RWQE3_TYPE,
 251                                   EHEA_MAX_PACKET_SIZE + NET_IP_ALIGN);
 252 }
 253
 254 static inline int ehea_check_cqe(struct ehea_cqe *cqe, int *rq_num)
 255 {
 256         *rq_num = (cqe->type & EHEA_CQE_TYPE_RQ) >> 5;
 257         if ((cqe->status & EHEA_CQE_STAT_ERR_MASK) == 0)
 258                 return 0;
 259         if (((cqe->status & EHEA_CQE_STAT_ERR_TCP) != 0) &&
 260             (cqe->header_length == 0))
 261                 return 0;
 262         return -EINVAL;
 263 }
 264
 265 static inline void ehea_fill_skb(struct net_device *dev,
 266                                  struct sk_buff *skb, struct ehea_cqe *cqe)
 267 {
 268         int length = cqe->num_bytes_transfered - 4;     /*remove CRC */
 269
 270         skb_put(skb, length);
 271         skb->ip_summed = CHECKSUM_UNNECESSARY;
 272         skb->protocol = eth_type_trans(skb, dev);
 273 }
 274
 275 static inline struct sk_buff *get_skb_by_index(struct sk_buff **skb_array,
 276                                                int arr_len,
 277                                                struct ehea_cqe *cqe)
 278 {
 279         int skb_index = EHEA_BMASK_GET(EHEA_WR_ID_INDEX, cqe->wr_id);
 280         struct sk_buff *skb;
 281         void *pref;
 282         int x;
 283
 284         x = skb_index + 1;
 285         x &= (arr_len - 1);
 286
 287         pref = skb_array[x];
 288         prefetchw(pref);
 289         prefetchw(pref + EHEA_CACHE_LINE);
 290
 291         pref = (skb_array[x]->data);
 292         prefetch(pref);
 293         prefetch(pref + EHEA_CACHE_LINE);
 294         prefetch(pref + EHEA_CACHE_LINE * 2);
 295         prefetch(pref + EHEA_CACHE_LINE * 3);
 296         skb = skb_array[skb_index];
 297         skb_array[skb_index] = NULL;
 298         return skb;
 299 }
 300
 301 static inline struct sk_buff *get_skb_by_index_ll(struct sk_buff **skb_array,
 302                                                   int arr_len, int wqe_index)
 303 {
 304         struct sk_buff *skb;
 305         void *pref;
 306         int x;
 307
 308         x = wqe_index + 1;
 309         x &= (arr_len - 1);
 310
 311         pref = skb_array[x];
 312         prefetchw(pref);
 313         prefetchw(pref + EHEA_CACHE_LINE);
 314
 315         pref = (skb_array[x]->data);
 316         prefetchw(pref);
 317         prefetchw(pref + EHEA_CACHE_LINE);
 318
 319         skb = skb_array[wqe_index];
 320         skb_array[wqe_index] = NULL;
 321         return skb;
 322 }
 323
 324 static int ehea_treat_poll_error(struct ehea_port_res *pr, int rq,
 325                                  struct ehea_cqe *cqe, int *processed_rq2,
 326                                  int *processed_rq3)
 327 {
 328         struct sk_buff *skb;
 329
 330         if (netif_msg_rx_err(pr->port)) {
 331                 ehea_error("CQE Error for QP %d", pr->qp->init_attr.qp_nr);
 332                 ehea_dump(cqe, sizeof(*cqe), "CQE");
 333         }
 334
 335         if (rq == 2) {
 336                 *processed_rq2 += 1;
 337                 skb = get_skb_by_index(pr->rq2_skba.arr, pr->rq2_skba.len, cqe);
 338                 dev_kfree_skb(skb);
 339         } else if (rq == 3) {
 340                 *processed_rq3 += 1;
 341                 skb = get_skb_by_index(pr->rq3_skba.arr, pr->rq3_skba.len, cqe);
 342                 dev_kfree_skb(skb);
 343         }
 344
 345         if (cqe->status & EHEA_CQE_STAT_FAT_ERR_MASK) {
 346                 ehea_error("Critical receive error. Resetting port.");
 347                 queue_work(pr->port->adapter->ehea_wq, &pr->port->reset_task);
 348                 return 1;
 349         }
 350
 351         return 0;
 352 }
 353
 354 static struct ehea_cqe *ehea_proc_rwqes(struct net_device *dev,
 355                                         struct ehea_port_res *pr,
 356                                         int *budget)
 357 {
 358         struct ehea_port *port = pr->port;
 359         struct ehea_qp *qp = pr->qp;
 360         struct ehea_cqe *cqe;
 361         struct sk_buff *skb;
 362         struct sk_buff **skb_arr_rq1 = pr->rq1_skba.arr;
 363         struct sk_buff **skb_arr_rq2 = pr->rq2_skba.arr;
 364         struct sk_buff **skb_arr_rq3 = pr->rq3_skba.arr;
 365         int skb_arr_rq1_len = pr->rq1_skba.len;
 366         int skb_arr_rq2_len = pr->rq2_skba.len;
 367         int skb_arr_rq3_len = pr->rq3_skba.len;
 368         int processed, processed_rq1, processed_rq2, processed_rq3;
 369         int wqe_index, last_wqe_index, rq, my_quota, port_reset;
 370
 371         processed = processed_rq1 = processed_rq2 = processed_rq3 = 0;
 372         last_wqe_index = 0;
 373         my_quota = min(*budget, dev->quota);
 374
 375         cqe = ehea_poll_rq1(qp, &wqe_index);
 376         while ((my_quota > 0) && cqe) {
 377                 ehea_inc_rq1(qp);
 378                 processed_rq1++;
 379                 processed++;
 380                 my_quota--;
 381                 if (netif_msg_rx_status(port))
 382                         ehea_dump(cqe, sizeof(*cqe), "CQE");
 383
 384                 last_wqe_index = wqe_index;
 385                 rmb();
 386                 if (!ehea_check_cqe(cqe, &rq)) {
 387                         if (rq == 1) {  /* LL RQ1 */
 388                                 skb = get_skb_by_index_ll(skb_arr_rq1,
 389                                                           skb_arr_rq1_len,
 390                                                           wqe_index);
 391                                 if (unlikely(!skb)) {
 392                                         if (netif_msg_rx_err(port))
 393                                                 ehea_error("LL rq1: skb=NULL");
 394
 395                                         skb = netdev_alloc_skb(port->netdev,
 396                                                                EHEA_L_PKT_SIZE);
 397                                         if (!skb)
 398                                                 break;
 399                                 }
 400                                 skb_copy_to_linear_data(skb, ((char*)cqe) + 64,
 401                                                cqe->num_bytes_transfered - 4);
 402                                 ehea_fill_skb(dev, skb, cqe);
 403                         } else if (rq == 2) {  /* RQ2 */
 404                                 skb = get_skb_by_index(skb_arr_rq2,
 405                                                        skb_arr_rq2_len, cqe);
 406                                 if (unlikely(!skb)) {
 407                                         if (netif_msg_rx_err(port))
 408                                                 ehea_error("rq2: skb=NULL");
 409                                         break;
 410                                 }
 411                                 ehea_fill_skb(port->netdev, skb, cqe);
 412                                 processed_rq2++;
 413                         } else {  /* RQ3 */
 414                                 skb = get_skb_by_index(skb_arr_rq3,
 415                                                        skb_arr_rq3_len, cqe);
 416                                 if (unlikely(!skb)) {
 417                                         if (netif_msg_rx_err(port))
 418                                                 ehea_error("rq3: skb=NULL");
 419                                         break;
 420                                 }
 421                                 ehea_fill_skb(port->netdev, skb, cqe);
 422                                 processed_rq3++;
 423                         }
 424
 425                         if (cqe->status & EHEA_CQE_VLAN_TAG_XTRACT)
 426                                 vlan_hwaccel_receive_skb(skb, port->vgrp,
 427                                                          cqe->vlan_tag);
 428                         else
 429                                 netif_receive_skb(skb);
 430                 } else {
 431                         pr->p_state.poll_receive_errors++;
 432                         port_reset = ehea_treat_poll_error(pr, rq, cqe,
 433                                                            &processed_rq2,
 434                                                            &processed_rq3);
 435                         if (port_reset)
 436                                 break;
 437                 }
 438                 cqe = ehea_poll_rq1(qp, &wqe_index);
 439         }
 440
 441         pr->rx_packets += processed;
 442         *budget -= processed;
 443
 444         ehea_refill_rq1(pr, last_wqe_index, processed_rq1);
 445         ehea_refill_rq2(pr, processed_rq2);
 446         ehea_refill_rq3(pr, processed_rq3);
 447
 448         cqe = ehea_poll_rq1(qp, &wqe_index);
 449         return cqe;
 450 }
 451
 452 static void ehea_free_sent_skbs(struct ehea_cqe *cqe, struct ehea_port_res *pr)
 453 {
 454         struct sk_buff *skb;
 455         int index, max_index_mask, i;
 456
 457         index = EHEA_BMASK_GET(EHEA_WR_ID_INDEX, cqe->wr_id);
 458         max_index_mask = pr->sq_skba.len - 1;
 459         for (i = 0; i < EHEA_BMASK_GET(EHEA_WR_ID_REFILL, cqe->wr_id); i++) {
 460                 skb = pr->sq_skba.arr[index];
 461                 if (likely(skb)) {
 462                         dev_kfree_skb(skb);
 463                         pr->sq_skba.arr[index] = NULL;
 464                 } else {
 465                         ehea_error("skb=NULL, wr_id=%lX, loop=%d, index=%d",
 466                                    cqe->wr_id, i, index);
 467                 }
 468                 index--;
 469                 index &= max_index_mask;
 470         }
 471 }
 472
 473 static struct ehea_cqe *ehea_proc_cqes(struct ehea_port_res *pr, int my_quota)
 474 {
 475         struct ehea_cq *send_cq = pr->send_cq;
 476         struct ehea_cqe *cqe;
 477         int quota = my_quota;
 478         int cqe_counter = 0;
 479         int swqe_av = 0;
 480         unsigned long flags;
 481
 482         cqe = ehea_poll_cq(send_cq);
 483         while(cqe && (quota > 0)) {
 484                 ehea_inc_cq(send_cq);
 485
 486                 cqe_counter++;
 487                 rmb();
 488                 if (cqe->status & EHEA_CQE_STAT_ERR_MASK) {
 489                         ehea_error("Send Completion Error: Resetting port");
 490                         if (netif_msg_tx_err(pr->port))
 491                                 ehea_dump(cqe, sizeof(*cqe), "Send CQE");
 492                         queue_work(pr->port->adapter->ehea_wq,
 493                                    &pr->port->reset_task);
 494                         break;
 495                 }
 496
 497                 if (netif_msg_tx_done(pr->port))
 498                         ehea_dump(cqe, sizeof(*cqe), "CQE");
 499
 500                 if (likely(EHEA_BMASK_GET(EHEA_WR_ID_TYPE, cqe->wr_id)
 501                            == EHEA_SWQE2_TYPE))
 502                         ehea_free_sent_skbs(cqe, pr);
 503
 504                 swqe_av += EHEA_BMASK_GET(EHEA_WR_ID_REFILL, cqe->wr_id);
 505                 quota--;
 506
 507                 cqe = ehea_poll_cq(send_cq);
 508         };
 509
 510         ehea_update_feca(send_cq, cqe_counter);
 511         atomic_add(swqe_av, &pr->swqe_avail);
 512
 513         spin_lock_irqsave(&pr->netif_queue, flags);
 514
 515         if (pr->queue_stopped && (atomic_read(&pr->swqe_avail)
 516                                   >= pr->swqe_refill_th)) {
 517                 netif_wake_queue(pr->port->netdev);
 518                 pr->queue_stopped = 0;
 519         }
 520         spin_unlock_irqrestore(&pr->netif_queue, flags);
 521
 522         return cqe;
 523 }
 524
 525 #define EHEA_NAPI_POLL_NUM_BEFORE_IRQ 16
 526
 527 static int ehea_poll(struct net_device *dev, int *budget)
 528 {
 529         struct ehea_port_res *pr = dev->priv;
 530         struct ehea_cqe *cqe;
 531         struct ehea_cqe *cqe_skb = NULL;
 532         int force_irq, wqe_index;
 533
 534         cqe = ehea_poll_rq1(pr->qp, &wqe_index);
 535         cqe_skb = ehea_poll_cq(pr->send_cq);
 536
 537         force_irq = (pr->poll_counter > EHEA_NAPI_POLL_NUM_BEFORE_IRQ);
 538
 539         if ((!cqe && !cqe_skb) || force_irq) {
 540                 pr->poll_counter = 0;
 541                 netif_rx_complete(dev);
 542                 ehea_reset_cq_ep(pr->recv_cq);
 543                 ehea_reset_cq_ep(pr->send_cq);
 544                 ehea_reset_cq_n1(pr->recv_cq);
 545                 ehea_reset_cq_n1(pr->send_cq);
 546                 cqe = ehea_poll_rq1(pr->qp, &wqe_index);
 547                 cqe_skb = ehea_poll_cq(pr->send_cq);
 548
 549                 if (!cqe && !cqe_skb)
 550                         return 0;
 551
 552                 if (!netif_rx_reschedule(dev, dev->quota))
 553                         return 0;
 554         }
 555
 556         cqe = ehea_proc_rwqes(dev, pr, budget);
 557         cqe_skb = ehea_proc_cqes(pr, 300);
 558
 559         if (cqe || cqe_skb)
 560                 pr->poll_counter++;
 561
 562         return 1;
 563 }
 564
 565 static irqreturn_t ehea_recv_irq_handler(int irq, void *param)
 566 {
 567         struct ehea_port_res *pr = param;
 568
 569         netif_rx_schedule(pr->d_netdev);
 570
 571         return IRQ_HANDLED;
 572 }
 573
 574 static irqreturn_t ehea_qp_aff_irq_handler(int irq, void *param)
 575 {
 576         struct ehea_port *port = param;
 577         struct ehea_eqe *eqe;
 578         struct ehea_qp *qp;
 579         u32 qp_token;
 580
 581         eqe = ehea_poll_eq(port->qp_eq);
 582
 583         while (eqe) {
 584                 qp_token = EHEA_BMASK_GET(EHEA_EQE_QP_TOKEN, eqe->entry);
 585                 ehea_error("QP aff_err: entry=0x%lx, token=0x%x",
 586                            eqe->entry, qp_token);
 587
 588                 qp = port->port_res[qp_token].qp;
 589                 ehea_error_data(port->adapter, qp->fw_handle);
 590                 eqe = ehea_poll_eq(port->qp_eq);
 591         }
 592
 593         queue_work(port->adapter->ehea_wq, &port->reset_task);
 594
 595         return IRQ_HANDLED;
 596 }
 597
 598 static struct ehea_port *ehea_get_port(struct ehea_adapter *adapter,
 599                                        int logical_port)
 600 {
 601         int i;
 602
 603         for (i = 0; i < EHEA_MAX_PORTS; i++)
 604                 if (adapter->port[i])
 605                         if (adapter->port[i]->logical_port_id == logical_port)
 606                                 return adapter->port[i];
 607         return NULL;
 608 }
 609
 610 int ehea_sense_port_attr(struct ehea_port *port)
 611 {
 612         int ret;
 613         u64 hret;
 614         struct hcp_ehea_port_cb0 *cb0;
 615
 616         cb0 = kzalloc(PAGE_SIZE, GFP_ATOMIC);   /* May be called via */
 617         if (!cb0) {                             /* ehea_neq_tasklet() */
 618                 ehea_error("no mem for cb0");
 619                 ret = -ENOMEM;
 620                 goto out;
 621         }
 622
 623         hret = ehea_h_query_ehea_port(port->adapter->handle,
 624                                       port->logical_port_id, H_PORT_CB0,
 625                                       EHEA_BMASK_SET(H_PORT_CB0_ALL, 0xFFFF),
 626                                       cb0);
 627         if (hret != H_SUCCESS) {
 628                 ret = -EIO;
 629                 goto out_free;
 630         }
 631
 632         /* MAC address */
 633         port->mac_addr = cb0->port_mac_addr << 16;
 634
 635         if (!is_valid_ether_addr((u8*)&port->mac_addr)) {
 636                 ret = -EADDRNOTAVAIL;
 637                 goto out_free;
 638         }
 639
 640         /* Port speed */
 641         switch (cb0->port_speed) {
 642         case H_SPEED_10M_H:
 643                 port->port_speed = EHEA_SPEED_10M;
 644                 port->full_duplex = 0;
 645                 break;
 646         case H_SPEED_10M_F:
 647                 port->port_speed = EHEA_SPEED_10M;
 648                 port->full_duplex = 1;
 649                 break;
 650         case H_SPEED_100M_H:
 651                 port->port_speed = EHEA_SPEED_100M;
 652                 port->full_duplex = 0;
 653                 break;
 654         case H_SPEED_100M_F:
 655                 port->port_speed = EHEA_SPEED_100M;
 656                 port->full_duplex = 1;
 657                 break;
 658         case H_SPEED_1G_F:
 659                 port->port_speed = EHEA_SPEED_1G;
 660                 port->full_duplex = 1;
 661                 break;
 662         case H_SPEED_10G_F:
 663                 port->port_speed = EHEA_SPEED_10G;
 664                 port->full_duplex = 1;
 665                 break;
 666         default:
 667                 port->port_speed = 0;
 668                 port->full_duplex = 0;
 669                 break;
 670         }
 671
 672         port->autoneg = 1;
 673         port->num_mcs = cb0->num_default_qps;
 674
 675         /* Number of default QPs */
 676         if (use_mcs)
 677                 port->num_def_qps = cb0->num_default_qps;
 678         else
 679                 port->num_def_qps = 1;
 680
 681         if (!port->num_def_qps) {
 682                 ret = -EINVAL;
 683                 goto out_free;
 684         }
 685
 686         port->num_tx_qps = num_tx_qps;
 687
 688         if (port->num_def_qps >= port->num_tx_qps)
 689                 port->num_add_tx_qps = 0;
 690         else
 691                 port->num_add_tx_qps = port->num_tx_qps - port->num_def_qps;
 692
 693         ret = 0;
 694 out_free:
 695         if (ret || netif_msg_probe(port))
 696                 ehea_dump(cb0, sizeof(*cb0), "ehea_sense_port_attr");
 697         kfree(cb0);
 698 out:
 699         return ret;
 700 }
 701
 702 int ehea_set_portspeed(struct ehea_port *port, u32 port_speed)
 703 {
 704         struct hcp_ehea_port_cb4 *cb4;
 705         u64 hret;
 706         int ret = 0;
 707
 708         cb4 = kzalloc(PAGE_SIZE, GFP_KERNEL);
 709         if (!cb4) {
 710                 ehea_error("no mem for cb4");
 711                 ret = -ENOMEM;
 712                 goto out;
 713         }
 714
 715         cb4->port_speed = port_speed;
 716
 717         netif_carrier_off(port->netdev);
 718
 719         hret = ehea_h_modify_ehea_port(port->adapter->handle,
 720                                        port->logical_port_id,
 721                                        H_PORT_CB4, H_PORT_CB4_SPEED, cb4);
 722         if (hret == H_SUCCESS) {
 723                 port->autoneg = port_speed == EHEA_SPEED_AUTONEG ? 1 : 0;
 724
 725                 hret = ehea_h_query_ehea_port(port->adapter->handle,
 726                                               port->logical_port_id,
 727                                               H_PORT_CB4, H_PORT_CB4_SPEED,
 728                                               cb4);
 729                 if (hret == H_SUCCESS) {
 730                         switch (cb4->port_speed) {
 731                         case H_SPEED_10M_H:
 732                                 port->port_speed = EHEA_SPEED_10M;
 733                                 port->full_duplex = 0;
 734                                 break;
 735                         case H_SPEED_10M_F:
 736                                 port->port_speed = EHEA_SPEED_10M;
 737                                 port->full_duplex = 1;
 738                                 break;
 739                         case H_SPEED_100M_H:
 740                                 port->port_speed = EHEA_SPEED_100M;
 741                                 port->full_duplex = 0;
 742                                 break;
 743                         case H_SPEED_100M_F:
 744                                 port->port_speed = EHEA_SPEED_100M;
 745                                 port->full_duplex = 1;
 746                                 break;
 747                         case H_SPEED_1G_F:
 748                                 port->port_speed = EHEA_SPEED_1G;
 749                                 port->full_duplex = 1;
 750                                 break;
 751                         case H_SPEED_10G_F:
 752                                 port->port_speed = EHEA_SPEED_10G;
 753                                 port->full_duplex = 1;
 754                                 break;
 755                         default:
 756                                 port->port_speed = 0;
 757                                 port->full_duplex = 0;
 758                                 break;
 759                         }
 760                 } else {
 761                         ehea_error("Failed sensing port speed");
 762                         ret = -EIO;
 763                 }
 764         } else {
 765                 if (hret == H_AUTHORITY) {
 766                         ehea_info("Hypervisor denied setting port speed");
 767                         ret = -EPERM;
 768                 } else {
 769                         ret = -EIO;
 770                         ehea_error("Failed setting port speed");
 771                 }
 772         }
 773         netif_carrier_on(port->netdev);
 774         kfree(cb4);
 775 out:
 776         return ret;
 777 }
 778
 779 static void ehea_parse_eqe(struct ehea_adapter *adapter, u64 eqe)
 780 {
 781         int ret;
 782         u8 ec;
 783         u8 portnum;
 784         struct ehea_port *port;
 785
 786         ec = EHEA_BMASK_GET(NEQE_EVENT_CODE, eqe);
 787         portnum = EHEA_BMASK_GET(NEQE_PORTNUM, eqe);
 788         port = ehea_get_port(adapter, portnum);
 789
 790         switch (ec) {
 791         case EHEA_EC_PORTSTATE_CHG:     /* port state change */
 792
 793                 if (!port) {
 794                         ehea_error("unknown portnum %x", portnum);
 795                         break;
 796                 }
 797
 798                 if (EHEA_BMASK_GET(NEQE_PORT_UP, eqe)) {
 799                         if (!netif_carrier_ok(port->netdev)) {
 800                                 ret = ehea_sense_port_attr(port);
 801                                 if (ret) {
 802                                         ehea_error("failed resensing port "
 803                                                    "attributes");
 804                                         break;
 805                                 }
 806
 807                                 if (netif_msg_link(port))
 808                                         ehea_info("%s: Logical port up: %dMbps "
 809                                                   "%s Duplex",
 810                                                   port->netdev->name,
 811                                                   port->port_speed,
 812                                                   port->full_duplex ==
 813                                                   1 ? "Full" : "Half");
 814
 815                                 netif_carrier_on(port->netdev);
 816                                 netif_wake_queue(port->netdev);
 817                         }
 818                 } else
 819                         if (netif_carrier_ok(port->netdev)) {
 820                                 if (netif_msg_link(port))
 821                                         ehea_info("%s: Logical port down",
 822                                                   port->netdev->name);
 823                                 netif_carrier_off(port->netdev);
 824                                 netif_stop_queue(port->netdev);
 825                         }
 826
 827                 if (EHEA_BMASK_GET(NEQE_EXTSWITCH_PORT_UP, eqe)) {
 828                         if (netif_msg_link(port))
 829                                 ehea_info("%s: Physical port up",
 830                                           port->netdev->name);
 831                 } else {
 832                         if (netif_msg_link(port))
 833                                 ehea_info("%s: Physical port down",
 834                                           port->netdev->name);
 835                 }
 836
 837                 if (EHEA_BMASK_GET(NEQE_EXTSWITCH_PRIMARY, eqe))
 838                         ehea_info("External switch port is primary port");
 839                 else
 840                         ehea_info("External switch port is backup port");
 841
 842                 break;
 843         case EHEA_EC_ADAPTER_MALFUNC:
 844                 ehea_error("Adapter malfunction");
 845                 break;
 846         case EHEA_EC_PORT_MALFUNC:
 847                 ehea_info("Port malfunction: Device: %s", port->netdev->name);
 848                 netif_carrier_off(port->netdev);
 849                 netif_stop_queue(port->netdev);
 850                 break;
 851         default:
 852                 ehea_error("unknown event code %x, eqe=0x%lX", ec, eqe);
 853                 break;
 854         }
 855 }
 856
 857 static void ehea_neq_tasklet(unsigned long data)
 858 {
 859         struct ehea_adapter *adapter = (struct ehea_adapter*)data;
 860         struct ehea_eqe *eqe;
 861         u64 event_mask;
 862
 863         eqe = ehea_poll_eq(adapter->neq);
 864         ehea_debug("eqe=%p", eqe);
 865
 866         while (eqe) {
 867                 ehea_debug("*eqe=%lx", eqe->entry);
 868                 ehea_parse_eqe(adapter, eqe->entry);
 869                 eqe = ehea_poll_eq(adapter->neq);
 870                 ehea_debug("next eqe=%p", eqe);
 871         }
 872
 873         event_mask = EHEA_BMASK_SET(NELR_PORTSTATE_CHG, 1)
 874                    | EHEA_BMASK_SET(NELR_ADAPTER_MALFUNC, 1)
 875                    | EHEA_BMASK_SET(NELR_PORT_MALFUNC, 1);
 876
 877         ehea_h_reset_events(adapter->handle,
 878                             adapter->neq->fw_handle, event_mask);
 879 }
 880
 881 static irqreturn_t ehea_interrupt_neq(int irq, void *param)
 882 {
 883         struct ehea_adapter *adapter = param;
 884         tasklet_hi_schedule(&adapter->neq_tasklet);
 885         return IRQ_HANDLED;
 886 }
 887
 888
 889 static int ehea_fill_port_res(struct ehea_port_res *pr)
 890 {
 891         int ret;
 892         struct ehea_qp_init_attr *init_attr = &pr->qp->init_attr;
 893
 894         ret = ehea_init_fill_rq1(pr, init_attr->act_nr_rwqes_rq1
 895                                      - init_attr->act_nr_rwqes_rq2
 896                                      - init_attr->act_nr_rwqes_rq3 - 1);
 897
 898         ret |= ehea_refill_rq2(pr, init_attr->act_nr_rwqes_rq2 - 1);
 899
 900         ret |= ehea_refill_rq3(pr, init_attr->act_nr_rwqes_rq3 - 1);
 901
 902         return ret;
 903 }
 904
 905 static int ehea_reg_interrupts(struct net_device *dev)
 906 {
 907         struct ehea_port *port = netdev_priv(dev);
 908         struct ehea_port_res *pr;
 909         int i, ret;
 910
 911
 912         snprintf(port->int_aff_name, EHEA_IRQ_NAME_SIZE - 1, "%s-aff",
 913                  dev->name);
 914
 915         ret = ibmebus_request_irq(NULL, port->qp_eq->attr.ist1,
 916                                   ehea_qp_aff_irq_handler,
 917                                   IRQF_DISABLED, port->int_aff_name, port);
 918         if (ret) {
 919                 ehea_error("failed registering irq for qp_aff_irq_handler:"
 920                            "ist=%X", port->qp_eq->attr.ist1);
 921                 goto out_free_qpeq;
 922         }
 923
 924         if (netif_msg_ifup(port))
 925                 ehea_info("irq_handle 0x%X for function qp_aff_irq_handler "
 926                           "registered", port->qp_eq->attr.ist1);
 927
 928
 929         for (i = 0; i < port->num_def_qps + port->num_add_tx_qps; i++) {
 930                 pr = &port->port_res[i];
 931                 snprintf(pr->int_send_name, EHEA_IRQ_NAME_SIZE - 1,
 932                          "%s-queue%d", dev->name, i);
 933                 ret = ibmebus_request_irq(NULL, pr->eq->attr.ist1,
 934                                           ehea_recv_irq_handler,
 935                                           IRQF_DISABLED, pr->int_send_name,
 936                                           pr);
 937                 if (ret) {
 938                         ehea_error("failed registering irq for ehea_queue "
 939                                    "port_res_nr:%d, ist=%X", i,
 940                                    pr->eq->attr.ist1);
 941                         goto out_free_req;
 942                 }
 943                 if (netif_msg_ifup(port))
 944                         ehea_info("irq_handle 0x%X for function ehea_queue_int "
 945                                   "%d registered", pr->eq->attr.ist1, i);
 946         }
 947 out:
 948         return ret;
 949
 950
 951 out_free_req:
 952         while (--i >= 0) {
 953                 u32 ist = port->port_res[i].eq->attr.ist1;
 954                 ibmebus_free_irq(NULL, ist, &port->port_res[i]);
 955         }
 956
 957 out_free_qpeq:
 958         ibmebus_free_irq(NULL, port->qp_eq->attr.ist1, port);
 959         i = port->num_def_qps;
 960
 961         goto out;
 962
 963 }
 964
 965 static void ehea_free_interrupts(struct net_device *dev)
 966 {
 967         struct ehea_port *port = netdev_priv(dev);
 968         struct ehea_port_res *pr;
 969         int i;
 970
 971         /* send */
 972
 973         for (i = 0; i < port->num_def_qps + port->num_add_tx_qps; i++) {
 974                 pr = &port->port_res[i];
 975                 ibmebus_free_irq(NULL, pr->eq->attr.ist1, pr);
 976                 if (netif_msg_intr(port))
 977                         ehea_info("free send irq for res %d with handle 0x%X",
 978                                   i, pr->eq->attr.ist1);
 979         }
 980
 981         /* associated events */
 982         ibmebus_free_irq(NULL, port->qp_eq->attr.ist1, port);
 983         if (netif_msg_intr(port))
 984                 ehea_info("associated event interrupt for handle 0x%X freed",
 985                           port->qp_eq->attr.ist1);
 986 }
 987
 988 static int ehea_configure_port(struct ehea_port *port)
 989 {
 990         int ret, i;
 991         u64 hret, mask;
 992         struct hcp_ehea_port_cb0 *cb0;
 993
 994         ret = -ENOMEM;
 995         cb0 = kzalloc(PAGE_SIZE, GFP_KERNEL);
 996         if (!cb0)
 997                 goto out;
 998
 999         cb0->port_rc = EHEA_BMASK_SET(PXLY_RC_VALID, 1)
1000                      | EHEA_BMASK_SET(PXLY_RC_IP_CHKSUM, 1)
1001                      | EHEA_BMASK_SET(PXLY_RC_TCP_UDP_CHKSUM, 1)
1002                      | EHEA_BMASK_SET(PXLY_RC_VLAN_XTRACT, 1)
1003                      | EHEA_BMASK_SET(PXLY_RC_VLAN_TAG_FILTER,
1004                                       PXLY_RC_VLAN_FILTER)
1005                      | EHEA_BMASK_SET(PXLY_RC_JUMBO_FRAME, 1);
1006
1007         for (i = 0; i < port->num_mcs; i++)
1008                 if (use_mcs)
1009                         cb0->default_qpn_arr[i] =
1010                                 port->port_res[i].qp->init_attr.qp_nr;
1011                 else
1012                         cb0->default_qpn_arr[i] =
1013                                 port->port_res[0].qp->init_attr.qp_nr;
1014
1015         if (netif_msg_ifup(port))
1016                 ehea_dump(cb0, sizeof(*cb0), "ehea_configure_port");
1017
1018         mask = EHEA_BMASK_SET(H_PORT_CB0_PRC, 1)
1019              | EHEA_BMASK_SET(H_PORT_CB0_DEFQPNARRAY, 1);
1020
1021         hret = ehea_h_modify_ehea_port(port->adapter->handle,
1022                                        port->logical_port_id,
1023                                        H_PORT_CB0, mask, cb0);
1024         ret = -EIO;
1025         if (hret != H_SUCCESS)
1026                 goto out_free;
1027
1028         ret = 0;
1029
1030 out_free:
1031         kfree(cb0);
1032 out:
1033         return ret;
1034 }
1035
1036 int ehea_gen_smrs(struct ehea_port_res *pr)
1037 {
1038         int ret;
1039         struct ehea_adapter *adapter = pr->port->adapter;
1040
1041         ret = ehea_gen_smr(adapter, &adapter->mr, &pr->send_mr);
1042         if (ret)
1043                 goto out;
1044
1045         ret = ehea_gen_smr(adapter, &adapter->mr, &pr->recv_mr);
1046         if (ret)
1047                 goto out_free;
1048
1049         return 0;
1050
1051 out_free:
1052         ehea_rem_mr(&pr->send_mr);
1053 out:
1054         ehea_error("Generating SMRS failed\n");
1055         return -EIO;
1056 }
1057
1058 int ehea_rem_smrs(struct ehea_port_res *pr)
1059 {
1060         if ((ehea_rem_mr(&pr->send_mr))
1061             || (ehea_rem_mr(&pr->recv_mr)))
1062                 return -EIO;
1063         else
1064                 return 0;
1065 }
1066
1067 static int ehea_init_q_skba(struct ehea_q_skb_arr *q_skba, int max_q_entries)
1068 {
1069         int arr_size = sizeof(void*) * max_q_entries;
1070
1071         q_skba->arr = vmalloc(arr_size);
1072         if (!q_skba->arr)
1073                 return -ENOMEM;
1074
1075         memset(q_skba->arr, 0, arr_size);
1076
1077         q_skba->len = max_q_entries;
1078         q_skba->index = 0;
1079         q_skba->os_skbs = 0;
1080
1081         return 0;
1082 }
1083
1084 static int ehea_init_port_res(struct ehea_port *port, struct ehea_port_res *pr,
1085                               struct port_res_cfg *pr_cfg, int queue_token)
1086 {
1087         struct ehea_adapter *adapter = port->adapter;
1088         enum ehea_eq_type eq_type = EHEA_EQ;
1089         struct ehea_qp_init_attr *init_attr = NULL;
1090         int ret = -EIO;
1091
1092         memset(pr, 0, sizeof(struct ehea_port_res));
1093
1094         pr->port = port;
1095         spin_lock_init(&pr->send_lock);
1096         spin_lock_init(&pr->recv_lock);
1097         spin_lock_init(&pr->xmit_lock);
1098         spin_lock_init(&pr->netif_queue);
1099
1100         pr->eq = ehea_create_eq(adapter, eq_type, EHEA_MAX_ENTRIES_EQ, 0);
1101         if (!pr->eq) {
1102                 ehea_error("create_eq failed (eq)");
1103                 goto out_free;
1104         }
1105
1106         pr->recv_cq = ehea_create_cq(adapter, pr_cfg->max_entries_rcq,
1107                                      pr->eq->fw_handle,
1108                                      port->logical_port_id);
1109         if (!pr->recv_cq) {
1110                 ehea_error("create_cq failed (cq_recv)");
1111                 goto out_free;
1112         }
1113
1114         pr->send_cq = ehea_create_cq(adapter, pr_cfg->max_entries_scq,
1115                                      pr->eq->fw_handle,
1116                                      port->logical_port_id);
1117         if (!pr->send_cq) {
1118                 ehea_error("create_cq failed (cq_send)");
1119                 goto out_free;
1120         }
1121
1122         if (netif_msg_ifup(port))
1123                 ehea_info("Send CQ: act_nr_cqes=%d, Recv CQ: act_nr_cqes=%d",
1124                           pr->send_cq->attr.act_nr_of_cqes,
1125                           pr->recv_cq->attr.act_nr_of_cqes);
1126
1127         init_attr = kzalloc(sizeof(*init_attr), GFP_KERNEL);
1128         if (!init_attr) {
1129                 ret = -ENOMEM;
1130                 ehea_error("no mem for ehea_qp_init_attr");
1131                 goto out_free;
1132         }
1133
1134         init_attr->low_lat_rq1 = 1;
1135         init_attr->signalingtype = 1;   /* generate CQE if specified in WQE */
1136         init_attr->rq_count = 3;
1137         init_attr->qp_token = queue_token;
1138         init_attr->max_nr_send_wqes = pr_cfg->max_entries_sq;
1139         init_attr->max_nr_rwqes_rq1 = pr_cfg->max_entries_rq1;
1140         init_attr->max_nr_rwqes_rq2 = pr_cfg->max_entries_rq2;
1141         init_attr->max_nr_rwqes_rq3 = pr_cfg->max_entries_rq3;
1142         init_attr->wqe_size_enc_sq = EHEA_SG_SQ;
1143         init_attr->wqe_size_enc_rq1 = EHEA_SG_RQ1;
1144         init_attr->wqe_size_enc_rq2 = EHEA_SG_RQ2;
1145         init_attr->wqe_size_enc_rq3 = EHEA_SG_RQ3;
1146         init_attr->rq2_threshold = EHEA_RQ2_THRESHOLD;
1147         init_attr->rq3_threshold = EHEA_RQ3_THRESHOLD;
1148         init_attr->port_nr = port->logical_port_id;
1149         init_attr->send_cq_handle = pr->send_cq->fw_handle;
1150         init_attr->recv_cq_handle = pr->recv_cq->fw_handle;
1151         init_attr->aff_eq_handle = port->qp_eq->fw_handle;
1152
1153         pr->qp = ehea_create_qp(adapter, adapter->pd, init_attr);
1154         if (!pr->qp) {
1155                 ehea_error("create_qp failed");
1156                 ret = -EIO;
1157                 goto out_free;
1158         }
1159
1160         if (netif_msg_ifup(port))
1161                 ehea_info("QP: qp_nr=%d\n act_nr_snd_wqe=%d\n nr_rwqe_rq1=%d\n "
1162                           "nr_rwqe_rq2=%d\n nr_rwqe_rq3=%d", init_attr->qp_nr,
1163                           init_attr->act_nr_send_wqes,
1164                           init_attr->act_nr_rwqes_rq1,
1165                           init_attr->act_nr_rwqes_rq2,
1166                           init_attr->act_nr_rwqes_rq3);
1167
1168         ret = ehea_init_q_skba(&pr->sq_skba, init_attr->act_nr_send_wqes + 1);
1169         ret |= ehea_init_q_skba(&pr->rq1_skba, init_attr->act_nr_rwqes_rq1 + 1);
1170         ret |= ehea_init_q_skba(&pr->rq2_skba, init_attr->act_nr_rwqes_rq2 + 1);
1171         ret |= ehea_init_q_skba(&pr->rq3_skba, init_attr->act_nr_rwqes_rq3 + 1);
1172         if (ret)
1173                 goto out_free;
1174
1175         pr->swqe_refill_th = init_attr->act_nr_send_wqes / 10;
1176         if (ehea_gen_smrs(pr) != 0) {
1177                 ret = -EIO;
1178                 goto out_free;
1179         }
1180
1181         atomic_set(&pr->swqe_avail, init_attr->act_nr_send_wqes - 1);
1182
1183         kfree(init_attr);
1184
1185         pr->d_netdev = alloc_netdev(0, "", ether_setup);
1186         if (!pr->d_netdev)
1187                 goto out_free;
1188         pr->d_netdev->priv = pr;
1189         pr->d_netdev->weight = 64;
1190         pr->d_netdev->poll = ehea_poll;
1191         set_bit(__LINK_STATE_START, &pr->d_netdev->state);
1192         strcpy(pr->d_netdev->name, port->netdev->name);
1193
1194         ret = 0;
1195         goto out;
1196
1197 out_free:
1198         kfree(init_attr);
1199         vfree(pr->sq_skba.arr);
1200         vfree(pr->rq1_skba.arr);
1201         vfree(pr->rq2_skba.arr);
1202         vfree(pr->rq3_skba.arr);
1203         ehea_destroy_qp(pr->qp);
1204         ehea_destroy_cq(pr->send_cq);
1205         ehea_destroy_cq(pr->recv_cq);
1206         ehea_destroy_eq(pr->eq);
1207 out:
1208         return ret;
1209 }
1210
1211 static int ehea_clean_portres(struct ehea_port *port, struct ehea_port_res *pr)
1212 {
1213         int ret, i;
1214
1215         free_netdev(pr->d_netdev);
1216
1217         ret = ehea_destroy_qp(pr->qp);
1218
1219         if (!ret) {
1220                 ehea_destroy_cq(pr->send_cq);
1221                 ehea_destroy_cq(pr->recv_cq);
1222                 ehea_destroy_eq(pr->eq);
1223
1224                 for (i = 0; i < pr->rq1_skba.len; i++)
1225                         if (pr->rq1_skba.arr[i])
1226                                 dev_kfree_skb(pr->rq1_skba.arr[i]);
1227
1228                 for (i = 0; i < pr->rq2_skba.len; i++)
1229                         if (pr->rq2_skba.arr[i])
1230                                 dev_kfree_skb(pr->rq2_skba.arr[i]);
1231
1232                 for (i = 0; i < pr->rq3_skba.len; i++)
1233                         if (pr->rq3_skba.arr[i])
1234                                 dev_kfree_skb(pr->rq3_skba.arr[i]);
1235
1236                 for (i = 0; i < pr->sq_skba.len; i++)
1237                         if (pr->sq_skba.arr[i])
1238                                 dev_kfree_skb(pr->sq_skba.arr[i]);
1239
1240                 vfree(pr->rq1_skba.arr);
1241                 vfree(pr->rq2_skba.arr);
1242                 vfree(pr->rq3_skba.arr);
1243                 vfree(pr->sq_skba.arr);
1244                 ret = ehea_rem_smrs(pr);
1245         }
1246         return ret;
1247 }
1248
1249 /*
1250  * The write_* functions store information in swqe which is used by
1251  * the hardware to calculate the ip/tcp/udp checksum
1252  */
1253
1254 static inline void write_ip_start_end(struct ehea_swqe *swqe,
1255                                       const struct sk_buff *skb)
1256 {
1257         swqe->ip_start = skb_network_offset(skb);
1258         swqe->ip_end = (u8)(swqe->ip_start + ip_hdrlen(skb) - 1);
1259 }
1260
1261 static inline void write_tcp_offset_end(struct ehea_swqe *swqe,
1262                                         const struct sk_buff *skb)
1263 {
1264         swqe->tcp_offset =
1265                 (u8)(swqe->ip_end + 1 + offsetof(struct tcphdr, check));
1266
1267         swqe->tcp_end = (u16)skb->len - 1;
1268 }
1269
1270 static inline void write_udp_offset_end(struct ehea_swqe *swqe,
1271                                         const struct sk_buff *skb)
1272 {
1273         swqe->tcp_offset =
1274                 (u8)(swqe->ip_end + 1 + offsetof(struct udphdr, check));
1275
1276         swqe->tcp_end = (u16)skb->len - 1;
1277 }
1278
1279
1280 static void write_swqe2_TSO(struct sk_buff *skb,
1281                             struct ehea_swqe *swqe, u32 lkey)
1282 {
1283         struct ehea_vsgentry *sg1entry = &swqe->u.immdata_desc.sg_entry;
1284         u8 *imm_data = &swqe->u.immdata_desc.immediate_data[0];
1285         int skb_data_size = skb->len - skb->data_len;
1286         int headersize;
1287         u64 tmp_addr;
1288
1289         /* Packet is TCP with TSO enabled */
1290         swqe->tx_control |= EHEA_SWQE_TSO;
1291         swqe->mss = skb_shinfo(skb)->gso_size;
1292         /* copy only eth/ip/tcp headers to immediate data and
1293          * the rest of skb->data to sg1entry
1294          */
1295         headersize = ETH_HLEN + ip_hdrlen(skb) + tcp_hdrlen(skb);
1296
1297         skb_data_size = skb->len - skb->data_len;
1298
1299         if (skb_data_size >= headersize) {
1300                 /* copy immediate data */
1301                 skb_copy_from_linear_data(skb, imm_data, headersize);
1302                 swqe->immediate_data_length = headersize;
1303
1304                 if (skb_data_size > headersize) {
1305                         /* set sg1entry data */
1306                         sg1entry->l_key = lkey;
1307                         sg1entry->len = skb_data_size - headersize;
1308
1309                         tmp_addr = (u64)(skb->data + headersize);
1310                         sg1entry->vaddr = tmp_addr;
1311                         swqe->descriptors++;
1312                 }
1313         } else
1314                 ehea_error("cannot handle fragmented headers");
1315 }
1316
1317 static void write_swqe2_nonTSO(struct sk_buff *skb,
1318                                struct ehea_swqe *swqe, u32 lkey)
1319 {
1320         int skb_data_size = skb->len - skb->data_len;
1321         u8 *imm_data = &swqe->u.immdata_desc.immediate_data[0];
1322         struct ehea_vsgentry *sg1entry = &swqe->u.immdata_desc.sg_entry;
1323         u64 tmp_addr;
1324
1325         /* Packet is any nonTSO type
1326          *
1327          * Copy as much as possible skb->data to immediate data and
1328          * the rest to sg1entry
1329          */
1330         if (skb_data_size >= SWQE2_MAX_IMM) {
1331                 /* copy immediate data */
1332                 skb_copy_from_linear_data(skb, imm_data, SWQE2_MAX_IMM);
1333
1334                 swqe->immediate_data_length = SWQE2_MAX_IMM;
1335
1336                 if (skb_data_size > SWQE2_MAX_IMM) {
1337                         /* copy sg1entry data */
1338                         sg1entry->l_key = lkey;
1339                         sg1entry->len = skb_data_size - SWQE2_MAX_IMM;
1340                         tmp_addr = (u64)(skb->data + SWQE2_MAX_IMM);
1341                         sg1entry->vaddr = tmp_addr;
1342                         swqe->descriptors++;
1343                 }
1344         } else {
1345                 skb_copy_from_linear_data(skb, imm_data, skb_data_size);
1346                 swqe->immediate_data_length = skb_data_size;
1347         }
1348 }
1349
1350 static inline void write_swqe2_data(struct sk_buff *skb, struct net_device *dev,
1351                                     struct ehea_swqe *swqe, u32 lkey)
1352 {
1353         struct ehea_vsgentry *sg_list, *sg1entry, *sgentry;
1354         skb_frag_t *frag;
1355         int nfrags, sg1entry_contains_frag_data, i;
1356         u64 tmp_addr;
1357
1358         nfrags = skb_shinfo(skb)->nr_frags;
1359         sg1entry = &swqe->u.immdata_desc.sg_entry;
1360         sg_list = (struct ehea_vsgentry*)&swqe->u.immdata_desc.sg_list;
1361         swqe->descriptors = 0;
1362         sg1entry_contains_frag_data = 0;
1363
1364         if ((dev->features & NETIF_F_TSO) && skb_shinfo(skb)->gso_size)
1365                 write_swqe2_TSO(skb, swqe, lkey);
1366         else
1367                 write_swqe2_nonTSO(skb, swqe, lkey);
1368
1369         /* write descriptors */
1370         if (nfrags > 0) {
1371                 if (swqe->descriptors == 0) {
1372                         /* sg1entry not yet used */
1373                         frag = &skb_shinfo(skb)->frags[0];
1374
1375                         /* copy sg1entry data */
1376                         sg1entry->l_key = lkey;
1377                         sg1entry->len = frag->size;
1378                         tmp_addr =  (u64)(page_address(frag->page)
1379                                           + frag->page_offset);
1380                         sg1entry->vaddr = tmp_addr;
1381                         swqe->descriptors++;
1382                         sg1entry_contains_frag_data = 1;
1383                 }
1384
1385                 for (i = sg1entry_contains_frag_data; i < nfrags; i++) {
1386
1387                         frag = &skb_shinfo(skb)->frags[i];
1388                         sgentry = &sg_list[i - sg1entry_contains_frag_data];
1389
1390                         sgentry->l_key = lkey;
1391                         sgentry->len = frag->size;
1392
1393                         tmp_addr = (u64)(page_address(frag->page)
1394                                          + frag->page_offset);
1395                         sgentry->vaddr = tmp_addr;
1396                         swqe->descriptors++;
1397                 }
1398         }
1399 }
1400
1401 static int ehea_broadcast_reg_helper(struct ehea_port *port, u32 hcallid)
1402 {
1403         int ret = 0;
1404         u64 hret;
1405         u8 reg_type;
1406
1407         /* De/Register untagged packets */
1408         reg_type = EHEA_BCMC_BROADCAST | EHEA_BCMC_UNTAGGED;
1409         hret = ehea_h_reg_dereg_bcmc(port->adapter->handle,
1410                                      port->logical_port_id,
1411                                      reg_type, port->mac_addr, 0, hcallid);
1412         if (hret != H_SUCCESS) {
1413                 ehea_error("reg_dereg_bcmc failed (tagged)");
1414                 ret = -EIO;
1415                 goto out_herr;
1416         }
1417
1418         /* De/Register VLAN packets */
1419         reg_type = EHEA_BCMC_BROADCAST | EHEA_BCMC_VLANID_ALL;
1420         hret = ehea_h_reg_dereg_bcmc(port->adapter->handle,
1421                                      port->logical_port_id,
1422                                      reg_type, port->mac_addr, 0, hcallid);
1423         if (hret != H_SUCCESS) {
1424                 ehea_error("reg_dereg_bcmc failed (vlan)");
1425                 ret = -EIO;
1426         }
1427 out_herr:
1428         return ret;
1429 }
1430
1431 static int ehea_set_mac_addr(struct net_device *dev, void *sa)
1432 {
1433         struct ehea_port *port = netdev_priv(dev);
1434         struct sockaddr *mac_addr = sa;
1435         struct hcp_ehea_port_cb0 *cb0;
1436         int ret;
1437         u64 hret;
1438
1439         if (!is_valid_ether_addr(mac_addr->sa_data)) {
1440                 ret = -EADDRNOTAVAIL;
1441                 goto out;
1442         }
1443
1444         cb0 = kzalloc(PAGE_SIZE, GFP_KERNEL);
1445         if (!cb0) {
1446                 ehea_error("no mem for cb0");
1447                 ret = -ENOMEM;
1448                 goto out;
1449         }
1450
1451         memcpy(&(cb0->port_mac_addr), &(mac_addr->sa_data[0]), ETH_ALEN);
1452
1453         cb0->port_mac_addr = cb0->port_mac_addr >> 16;
1454
1455         hret = ehea_h_modify_ehea_port(port->adapter->handle,
1456                                        port->logical_port_id, H_PORT_CB0,
1457                                        EHEA_BMASK_SET(H_PORT_CB0_MAC, 1), cb0);
1458         if (hret != H_SUCCESS) {
1459                 ret = -EIO;
1460                 goto out_free;
1461         }
1462
1463         memcpy(dev->dev_addr, mac_addr->sa_data, dev->addr_len);
1464
1465         /* Deregister old MAC in pHYP */
1466         ret = ehea_broadcast_reg_helper(port, H_DEREG_BCMC);
1467         if (ret)
1468                 goto out_free;
1469
1470         port->mac_addr = cb0->port_mac_addr << 16;
1471
1472         /* Register new MAC in pHYP */
1473         ret = ehea_broadcast_reg_helper(port, H_REG_BCMC);
1474         if (ret)
1475                 goto out_free;
1476
1477         ret = 0;
1478 out_free:
1479         kfree(cb0);
1480 out:
1481         return ret;
1482 }
1483
1484 static void ehea_promiscuous_error(u64 hret, int enable)
1485 {
1486         if (hret == H_AUTHORITY)
1487                 ehea_info("Hypervisor denied %sabling promiscuous mode",
1488                           enable == 1 ? "en" : "dis");
1489         else
1490                 ehea_error("failed %sabling promiscuous mode",
1491                            enable == 1 ? "en" : "dis");
1492 }
1493
1494 static void ehea_promiscuous(struct net_device *dev, int enable)
1495 {
1496         struct ehea_port *port = netdev_priv(dev);
1497         struct hcp_ehea_port_cb7 *cb7;
1498         u64 hret;
1499
1500         if ((enable && port->promisc) || (!enable && !port->promisc))
1501                 return;
1502
1503         cb7 = kzalloc(PAGE_SIZE, GFP_ATOMIC);
1504         if (!cb7) {
1505                 ehea_error("no mem for cb7");
1506                 goto out;
1507         }
1508
1509         /* Modify Pxs_DUCQPN in CB7 */
1510         cb7->def_uc_qpn = enable == 1 ? port->port_res[0].qp->fw_handle : 0;
1511
1512         hret = ehea_h_modify_ehea_port(port->adapter->handle,
1513                                        port->logical_port_id,
1514                                        H_PORT_CB7, H_PORT_CB7_DUCQPN, cb7);
1515         if (hret) {
1516                 ehea_promiscuous_error(hret, enable);
1517                 goto out;
1518         }
1519
1520         port->promisc = enable;
1521 out:
1522         kfree(cb7);
1523         return;
1524 }
1525
1526 static u64 ehea_multicast_reg_helper(struct ehea_port *port, u64 mc_mac_addr,
1527                                      u32 hcallid)
1528 {
1529         u64 hret;
1530         u8 reg_type;
1531
1532         reg_type = EHEA_BCMC_SCOPE_ALL | EHEA_BCMC_MULTICAST
1533                  | EHEA_BCMC_UNTAGGED;
1534
1535         hret = ehea_h_reg_dereg_bcmc(port->adapter->handle,
1536                                      port->logical_port_id,
1537                                      reg_type, mc_mac_addr, 0, hcallid);
1538         if (hret)
1539                 goto out;
1540
1541         reg_type = EHEA_BCMC_SCOPE_ALL | EHEA_BCMC_MULTICAST
1542                  | EHEA_BCMC_VLANID_ALL;
1543
1544         hret = ehea_h_reg_dereg_bcmc(port->adapter->handle,
1545                                      port->logical_port_id,
1546                                      reg_type, mc_mac_addr, 0, hcallid);
1547 out:
1548         return hret;
1549 }
1550
1551 static int ehea_drop_multicast_list(struct net_device *dev)
1552 {
1553         struct ehea_port *port = netdev_priv(dev);
1554         struct ehea_mc_list *mc_entry = port->mc_list;
1555         struct list_head *pos;
1556         struct list_head *temp;
1557         int ret = 0;
1558         u64 hret;
1559
1560         list_for_each_safe(pos, temp, &(port->mc_list->list)) {
1561                 mc_entry = list_entry(pos, struct ehea_mc_list, list);
1562
1563                 hret = ehea_multicast_reg_helper(port, mc_entry->macaddr,
1564                                                  H_DEREG_BCMC);
1565                 if (hret) {
1566                         ehea_error("failed deregistering mcast MAC");
1567                         ret = -EIO;
1568                 }
1569
1570                 list_del(pos);
1571                 kfree(mc_entry);
1572         }
1573         return ret;
1574 }
1575
1576 static void ehea_allmulti(struct net_device *dev, int enable)
1577 {
1578         struct ehea_port *port = netdev_priv(dev);
1579         u64 hret;
1580
1581         if (!port->allmulti) {
1582                 if (enable) {
1583                         /* Enable ALLMULTI */
1584                         ehea_drop_multicast_list(dev);
1585                         hret = ehea_multicast_reg_helper(port, 0, H_REG_BCMC);
1586                         if (!hret)
1587                                 port->allmulti = 1;
1588                         else
1589                                 ehea_error("failed enabling IFF_ALLMULTI");
1590                 }
1591         } else
1592                 if (!enable) {
1593                         /* Disable ALLMULTI */
1594                         hret = ehea_multicast_reg_helper(port, 0, H_DEREG_BCMC);
1595                         if (!hret)
1596                                 port->allmulti = 0;
1597                         else
1598                                 ehea_error("failed disabling IFF_ALLMULTI");
1599                 }
1600 }
1601
1602 static void ehea_add_multicast_entry(struct ehea_port* port, u8* mc_mac_addr)
1603 {
1604         struct ehea_mc_list *ehea_mcl_entry;
1605         u64 hret;
1606
1607         ehea_mcl_entry = kzalloc(sizeof(*ehea_mcl_entry), GFP_ATOMIC);
1608         if (!ehea_mcl_entry) {
1609                 ehea_error("no mem for mcl_entry");
1610                 return;
1611         }
1612
1613         INIT_LIST_HEAD(&ehea_mcl_entry->list);
1614
1615         memcpy(&ehea_mcl_entry->macaddr, mc_mac_addr, ETH_ALEN);
1616
1617         hret = ehea_multicast_reg_helper(port, ehea_mcl_entry->macaddr,
1618                                          H_REG_BCMC);
1619         if (!hret)
1620                 list_add(&ehea_mcl_entry->list, &port->mc_list->list);
1621         else {
1622                 ehea_error("failed registering mcast MAC");
1623                 kfree(ehea_mcl_entry);
1624         }
1625 }
1626
1627 static void ehea_set_multicast_list(struct net_device *dev)
1628 {
1629         struct ehea_port *port = netdev_priv(dev);
1630         struct dev_mc_list *k_mcl_entry;
1631         int ret, i;
1632
1633         if (dev->flags & IFF_PROMISC) {
1634                 ehea_promiscuous(dev, 1);
1635                 return;
1636         }
1637         ehea_promiscuous(dev, 0);
1638
1639         if (dev->flags & IFF_ALLMULTI) {
1640                 ehea_allmulti(dev, 1);
1641                 return;
1642         }
1643         ehea_allmulti(dev, 0);
1644
1645         if (dev->mc_count) {
1646                 ret = ehea_drop_multicast_list(dev);
1647                 if (ret) {
1648                         /* Dropping the current multicast list failed.
1649                          * Enabling ALL_MULTI is the best we can do.
1650                          */
1651                         ehea_allmulti(dev, 1);
1652                 }
1653
1654                 if (dev->mc_count > port->adapter->max_mc_mac) {
1655                         ehea_info("Mcast registration limit reached (0x%lx). "
1656                                   "Use ALLMULTI!",
1657                                   port->adapter->max_mc_mac);
1658                         goto out;
1659                 }
1660
1661                 for (i = 0, k_mcl_entry = dev->mc_list;
1662                      i < dev->mc_count;
1663                      i++, k_mcl_entry = k_mcl_entry->next) {
1664                         ehea_add_multicast_entry(port, k_mcl_entry->dmi_addr);
1665                 }
1666         }
1667 out:
1668         return;
1669 }
1670
1671 static int ehea_change_mtu(struct net_device *dev, int new_mtu)
1672 {
1673         if ((new_mtu < 68) || (new_mtu > EHEA_MAX_PACKET_SIZE))
1674                 return -EINVAL;
1675         dev->mtu = new_mtu;
1676         return 0;
1677 }
1678
1679 static void ehea_xmit2(struct sk_buff *skb, struct net_device *dev,
1680                        struct ehea_swqe *swqe, u32 lkey)
1681 {
1682         if (skb->protocol == htons(ETH_P_IP)) {
1683                 const struct iphdr *iph = ip_hdr(skb);
1684                 /* IPv4 */
1685                 swqe->tx_control |= EHEA_SWQE_CRC
1686                                  | EHEA_SWQE_IP_CHECKSUM
1687                                  | EHEA_SWQE_TCP_CHECKSUM
1688                                  | EHEA_SWQE_IMM_DATA_PRESENT
1689                                  | EHEA_SWQE_DESCRIPTORS_PRESENT;
1690
1691                 write_ip_start_end(swqe, skb);
1692
1693                 if (iph->protocol == IPPROTO_UDP) {
1694                         if ((iph->frag_off & IP_MF) ||
1695                             (iph->frag_off & IP_OFFSET))
1696                                 /* IP fragment, so don't change cs */
1697                                 swqe->tx_control &= ~EHEA_SWQE_TCP_CHECKSUM;
1698                         else
1699                                 write_udp_offset_end(swqe, skb);
1700
1701                 } else if (iph->protocol == IPPROTO_TCP) {
1702                         write_tcp_offset_end(swqe, skb);
1703                 }
1704
1705                 /* icmp (big data) and ip segmentation packets (all other ip
1706                    packets) do not require any special handling */
1707
1708         } else {
1709                 /* Other Ethernet Protocol */
1710                 swqe->tx_control |= EHEA_SWQE_CRC
1711                                  | EHEA_SWQE_IMM_DATA_PRESENT
1712                                  | EHEA_SWQE_DESCRIPTORS_PRESENT;
1713         }
1714
1715         write_swqe2_data(skb, dev, swqe, lkey);
1716 }
1717
1718 static void ehea_xmit3(struct sk_buff *skb, struct net_device *dev,
1719                        struct ehea_swqe *swqe)
1720 {
1721         int nfrags = skb_shinfo(skb)->nr_frags;
1722         u8 *imm_data = &swqe->u.immdata_nodesc.immediate_data[0];
1723         skb_frag_t *frag;
1724         int i;
1725
1726         if (skb->protocol == htons(ETH_P_IP)) {
1727                 const struct iphdr *iph = ip_hdr(skb);
1728                 /* IPv4 */
1729                 write_ip_start_end(swqe, skb);
1730
1731                 if (iph->protocol == IPPROTO_TCP) {
1732                         swqe->tx_control |= EHEA_SWQE_CRC
1733                                          | EHEA_SWQE_IP_CHECKSUM
1734                                          | EHEA_SWQE_TCP_CHECKSUM
1735                                          | EHEA_SWQE_IMM_DATA_PRESENT;
1736
1737                         write_tcp_offset_end(swqe, skb);
1738
1739                 } else if (iph->protocol == IPPROTO_UDP) {
1740                         if ((iph->frag_off & IP_MF) ||
1741                             (iph->frag_off & IP_OFFSET))
1742                                 /* IP fragment, so don't change cs */
1743                                 swqe->tx_control |= EHEA_SWQE_CRC
1744                                                  | EHEA_SWQE_IMM_DATA_PRESENT;
1745                         else {
1746                                 swqe->tx_control |= EHEA_SWQE_CRC
1747                                                  | EHEA_SWQE_IP_CHECKSUM
1748                                                  | EHEA_SWQE_TCP_CHECKSUM
1749                                                  | EHEA_SWQE_IMM_DATA_PRESENT;
1750
1751                                 write_udp_offset_end(swqe, skb);
1752                         }
1753                 } else {
1754                         /* icmp (big data) and
1755                            ip segmentation packets (all other ip packets) */
1756                         swqe->tx_control |= EHEA_SWQE_CRC
1757                                          | EHEA_SWQE_IP_CHECKSUM
1758                                          | EHEA_SWQE_IMM_DATA_PRESENT;
1759                 }
1760         } else {
1761                 /* Other Ethernet Protocol */
1762                 swqe->tx_control |= EHEA_SWQE_CRC | EHEA_SWQE_IMM_DATA_PRESENT;
1763         }
1764         /* copy (immediate) data */
1765         if (nfrags == 0) {
1766                 /* data is in a single piece */
1767                 skb_copy_from_linear_data(skb, imm_data, skb->len);
1768         } else {
1769                 /* first copy data from the skb->data buffer ... */
1770                 skb_copy_from_linear_data(skb, imm_data,
1771                                           skb->len - skb->data_len);
1772                 imm_data += skb->len - skb->data_len;
1773
1774                 /* ... then copy data from the fragments */
1775                 for (i = 0; i < nfrags; i++) {
1776                         frag = &skb_shinfo(skb)->frags[i];
1777                         memcpy(imm_data,
1778                                page_address(frag->page) + frag->page_offset,
1779                                frag->size);
1780                         imm_data += frag->size;
1781                 }
1782         }
1783         swqe->immediate_data_length = skb->len;
1784         dev_kfree_skb(skb);
1785 }
1786
1787 static inline int ehea_hash_skb(struct sk_buff *skb, int num_qps)
1788 {
1789         struct tcphdr *tcp;
1790         u32 tmp;
1791
1792         if ((skb->protocol == htons(ETH_P_IP)) &&
1793             (skb->nh.iph->protocol == IPPROTO_TCP)) {
1794                 tcp = (struct tcphdr*)(skb->nh.raw + (skb->nh.iph->ihl * 4));
1795                 tmp = (tcp->source + (tcp->dest << 16)) % 31;
1796                 tmp += skb->nh.iph->daddr % 31;
1797                 return tmp % num_qps;
1798         }
1799         else
1800                 return 0;
1801 }
1802
1803 static int ehea_start_xmit(struct sk_buff *skb, struct net_device *dev)
1804 {
1805         struct ehea_port *port = netdev_priv(dev);
1806         struct ehea_swqe *swqe;
1807         unsigned long flags;
1808         u32 lkey;
1809         int swqe_index;
1810         struct ehea_port_res *pr;
1811
1812         pr = &port->port_res[ehea_hash_skb(skb, port->num_tx_qps)];
1813
1814
1815         if (!spin_trylock(&pr->xmit_lock))
1816                 return NETDEV_TX_BUSY;
1817
1818         if (pr->queue_stopped) {
1819                 spin_unlock(&pr->xmit_lock);
1820                 return NETDEV_TX_BUSY;
1821         }
1822
1823         swqe = ehea_get_swqe(pr->qp, &swqe_index);
1824         memset(swqe, 0, SWQE_HEADER_SIZE);
1825         atomic_dec(&pr->swqe_avail);
1826
1827         if (skb->len <= SWQE3_MAX_IMM) {
1828                 u32 sig_iv = port->sig_comp_iv;
1829                 u32 swqe_num = pr->swqe_id_counter;
1830                 ehea_xmit3(skb, dev, swqe);
1831                 swqe->wr_id = EHEA_BMASK_SET(EHEA_WR_ID_TYPE, EHEA_SWQE3_TYPE)
1832                         | EHEA_BMASK_SET(EHEA_WR_ID_COUNT, swqe_num);
1833                 if (pr->swqe_ll_count >= (sig_iv - 1)) {
1834                         swqe->wr_id |= EHEA_BMASK_SET(EHEA_WR_ID_REFILL,
1835                                                       sig_iv);
1836                         swqe->tx_control |= EHEA_SWQE_SIGNALLED_COMPLETION;
1837                         pr->swqe_ll_count = 0;
1838                 } else
1839                         pr->swqe_ll_count += 1;
1840         } else {
1841                 swqe->wr_id =
1842                         EHEA_BMASK_SET(EHEA_WR_ID_TYPE, EHEA_SWQE2_TYPE)
1843                       | EHEA_BMASK_SET(EHEA_WR_ID_COUNT, pr->swqe_id_counter)
1844                       | EHEA_BMASK_SET(EHEA_WR_ID_INDEX, pr->sq_skba.index);
1845                 pr->sq_skba.arr[pr->sq_skba.index] = skb;
1846
1847                 pr->sq_skba.index++;
1848                 pr->sq_skba.index &= (pr->sq_skba.len - 1);
1849
1850                 lkey = pr->send_mr.lkey;
1851                 ehea_xmit2(skb, dev, swqe, lkey);
1852
1853                 if (pr->swqe_count >= (EHEA_SIG_IV_LONG - 1)) {
1854                         swqe->wr_id |= EHEA_BMASK_SET(EHEA_WR_ID_REFILL,
1855                                                       EHEA_SIG_IV_LONG);
1856                         swqe->tx_control |= EHEA_SWQE_SIGNALLED_COMPLETION;
1857                         pr->swqe_count = 0;
1858                 } else
1859                         pr->swqe_count += 1;
1860         }
1861         pr->swqe_id_counter += 1;
1862
1863         if (port->vgrp && vlan_tx_tag_present(skb)) {
1864                 swqe->tx_control |= EHEA_SWQE_VLAN_INSERT;
1865                 swqe->vlan_tag = vlan_tx_tag_get(skb);
1866         }
1867
1868         if (netif_msg_tx_queued(port)) {
1869                 ehea_info("post swqe on QP %d", pr->qp->init_attr.qp_nr);
1870                 ehea_dump(swqe, 512, "swqe");
1871         }
1872
1873         ehea_post_swqe(pr->qp, swqe);
1874         pr->tx_packets++;
1875
1876         if (unlikely(atomic_read(&pr->swqe_avail) <= 1)) {
1877                 spin_lock_irqsave(&pr->netif_queue, flags);
1878                 if (unlikely(atomic_read(&pr->swqe_avail) <= 1)) {
1879                         netif_stop_queue(dev);
1880                         pr->queue_stopped = 1;
1881                 }
1882                 spin_unlock_irqrestore(&pr->netif_queue, flags);
1883         }
1884         dev->trans_start = jiffies;
1885         spin_unlock(&pr->xmit_lock);
1886
1887         return NETDEV_TX_OK;
1888 }
1889
1890 static void ehea_vlan_rx_register(struct net_device *dev,
1891                                   struct vlan_group *grp)
1892 {
1893         struct ehea_port *port = netdev_priv(dev);
1894         struct ehea_adapter *adapter = port->adapter;
1895         struct hcp_ehea_port_cb1 *cb1;
1896         u64 hret;
1897
1898         port->vgrp = grp;
1899
1900         cb1 = kzalloc(PAGE_SIZE, GFP_KERNEL);
1901         if (!cb1) {
1902                 ehea_error("no mem for cb1");
1903                 goto out;
1904         }
1905
1906         if (grp)
1907                 memset(cb1->vlan_filter, 0, sizeof(cb1->vlan_filter));
1908         else
1909                 memset(cb1->vlan_filter, 0xFF, sizeof(cb1->vlan_filter));
1910
1911         hret = ehea_h_modify_ehea_port(adapter->handle, port->logical_port_id,
1912                                        H_PORT_CB1, H_PORT_CB1_ALL, cb1);
1913         if (hret != H_SUCCESS)
1914                 ehea_error("modify_ehea_port failed");
1915
1916         kfree(cb1);
1917 out:
1918         return;
1919 }
1920
1921 static void ehea_vlan_rx_add_vid(struct net_device *dev, unsigned short vid)
1922 {
1923         struct ehea_port *port = netdev_priv(dev);
1924         struct ehea_adapter *adapter = port->adapter;
1925         struct hcp_ehea_port_cb1 *cb1;
1926         int index;
1927         u64 hret;
1928
1929         cb1 = kzalloc(PAGE_SIZE, GFP_KERNEL);
1930         if (!cb1) {
1931                 ehea_error("no mem for cb1");
1932                 goto out;
1933         }
1934
1935         hret = ehea_h_query_ehea_port(adapter->handle, port->logical_port_id,
1936                                       H_PORT_CB1, H_PORT_CB1_ALL, cb1);
1937         if (hret != H_SUCCESS) {
1938                 ehea_error("query_ehea_port failed");
1939                 goto out;
1940         }
1941
1942         index = (vid / 64);
1943         cb1->vlan_filter[index] |= ((u64)(1 << (vid & 0x3F)));
1944
1945         hret = ehea_h_modify_ehea_port(adapter->handle, port->logical_port_id,
1946                                        H_PORT_CB1, H_PORT_CB1_ALL, cb1);
1947         if (hret != H_SUCCESS)
1948                 ehea_error("modify_ehea_port failed");
1949 out:
1950         kfree(cb1);
1951         return;
1952 }
1953
1954 static void ehea_vlan_rx_kill_vid(struct net_device *dev, unsigned short vid)
1955 {
1956         struct ehea_port *port = netdev_priv(dev);
1957         struct ehea_adapter *adapter = port->adapter;
1958         struct hcp_ehea_port_cb1 *cb1;
1959         int index;
1960         u64 hret;
1961
1962         vlan_group_set_device(port->vgrp, vid, NULL);
1963
1964         cb1 = kzalloc(PAGE_SIZE, GFP_KERNEL);
1965         if (!cb1) {
1966                 ehea_error("no mem for cb1");
1967                 goto out;
1968         }
1969
1970         hret = ehea_h_query_ehea_port(adapter->handle, port->logical_port_id,
1971                                       H_PORT_CB1, H_PORT_CB1_ALL, cb1);
1972         if (hret != H_SUCCESS) {
1973                 ehea_error("query_ehea_port failed");
1974                 goto out;
1975         }
1976
1977         index = (vid / 64);
1978         cb1->vlan_filter[index] &= ~((u64)(1 << (vid & 0x3F)));
1979
1980         hret = ehea_h_modify_ehea_port(adapter->handle, port->logical_port_id,
1981                                        H_PORT_CB1, H_PORT_CB1_ALL, cb1);
1982         if (hret != H_SUCCESS)
1983                 ehea_error("modify_ehea_port failed");
1984 out:
1985         kfree(cb1);
1986         return;
1987 }
1988
1989 int ehea_activate_qp(struct ehea_adapter *adapter, struct ehea_qp *qp)
1990 {
1991         int ret = -EIO;
1992         u64 hret;
1993         u16 dummy16 = 0;
1994         u64 dummy64 = 0;
1995         struct hcp_modify_qp_cb0* cb0;
1996
1997         cb0 = kzalloc(PAGE_SIZE, GFP_KERNEL);
1998         if (!cb0) {
1999                 ret = -ENOMEM;
2000                 goto out;
2001         }
2002
2003         hret = ehea_h_query_ehea_qp(adapter->handle, 0, qp->fw_handle,
2004                                     EHEA_BMASK_SET(H_QPCB0_ALL, 0xFFFF), cb0);
2005         if (hret != H_SUCCESS) {
2006                 ehea_error("query_ehea_qp failed (1)");
2007                 goto out;
2008         }
2009
2010         cb0->qp_ctl_reg = H_QP_CR_STATE_INITIALIZED;
2011         hret = ehea_h_modify_ehea_qp(adapter->handle, 0, qp->fw_handle,
2012                                      EHEA_BMASK_SET(H_QPCB0_QP_CTL_REG, 1), cb0,
2013                                      &dummy64, &dummy64, &dummy16, &dummy16);
2014         if (hret != H_SUCCESS) {
2015                 ehea_error("modify_ehea_qp failed (1)");
2016                 goto out;
2017         }
2018
2019         hret = ehea_h_query_ehea_qp(adapter->handle, 0, qp->fw_handle,
2020                                     EHEA_BMASK_SET(H_QPCB0_ALL, 0xFFFF), cb0);
2021         if (hret != H_SUCCESS) {
2022                 ehea_error("query_ehea_qp failed (2)");
2023                 goto out;
2024         }
2025
2026         cb0->qp_ctl_reg = H_QP_CR_ENABLED | H_QP_CR_STATE_INITIALIZED;
2027         hret = ehea_h_modify_ehea_qp(adapter->handle, 0, qp->fw_handle,
2028                                      EHEA_BMASK_SET(H_QPCB0_QP_CTL_REG, 1), cb0,
2029                                      &dummy64, &dummy64, &dummy16, &dummy16);
2030         if (hret != H_SUCCESS) {
2031                 ehea_error("modify_ehea_qp failed (2)");
2032                 goto out;
2033         }
2034
2035         hret = ehea_h_query_ehea_qp(adapter->handle, 0, qp->fw_handle,
2036                                     EHEA_BMASK_SET(H_QPCB0_ALL, 0xFFFF), cb0);
2037         if (hret != H_SUCCESS) {
2038                 ehea_error("query_ehea_qp failed (3)");
2039                 goto out;
2040         }
2041
2042         cb0->qp_ctl_reg = H_QP_CR_ENABLED | H_QP_CR_STATE_RDY2SND;
2043         hret = ehea_h_modify_ehea_qp(adapter->handle, 0, qp->fw_handle,
2044                                      EHEA_BMASK_SET(H_QPCB0_QP_CTL_REG, 1), cb0,
2045                                      &dummy64, &dummy64, &dummy16, &dummy16);
2046         if (hret != H_SUCCESS) {
2047                 ehea_error("modify_ehea_qp failed (3)");
2048                 goto out;
2049         }
2050
2051         hret = ehea_h_query_ehea_qp(adapter->handle, 0, qp->fw_handle,
2052                                     EHEA_BMASK_SET(H_QPCB0_ALL, 0xFFFF), cb0);
2053         if (hret != H_SUCCESS) {
2054                 ehea_error("query_ehea_qp failed (4)");
2055                 goto out;
2056         }
2057
2058         ret = 0;
2059 out:
2060         kfree(cb0);
2061         return ret;
2062 }
2063
2064 static int ehea_port_res_setup(struct ehea_port *port, int def_qps,
2065                                int add_tx_qps)
2066 {
2067         int ret, i;
2068         struct port_res_cfg pr_cfg, pr_cfg_small_rx;
2069         enum ehea_eq_type eq_type = EHEA_EQ;
2070
2071         port->qp_eq = ehea_create_eq(port->adapter, eq_type,
2072                                    EHEA_MAX_ENTRIES_EQ, 1);
2073         if (!port->qp_eq) {
2074                 ret = -EINVAL;
2075                 ehea_error("ehea_create_eq failed (qp_eq)");
2076                 goto out_kill_eq;
2077         }
2078
2079         pr_cfg.max_entries_rcq = rq1_entries + rq2_entries + rq3_entries;
2080         pr_cfg.max_entries_scq = sq_entries * 2;
2081         pr_cfg.max_entries_sq = sq_entries;
2082         pr_cfg.max_entries_rq1 = rq1_entries;
2083         pr_cfg.max_entries_rq2 = rq2_entries;
2084         pr_cfg.max_entries_rq3 = rq3_entries;
2085
2086         pr_cfg_small_rx.max_entries_rcq = 1;
2087         pr_cfg_small_rx.max_entries_scq = sq_entries;
2088         pr_cfg_small_rx.max_entries_sq = sq_entries;
2089         pr_cfg_small_rx.max_entries_rq1 = 1;
2090         pr_cfg_small_rx.max_entries_rq2 = 1;
2091         pr_cfg_small_rx.max_entries_rq3 = 1;
2092
2093         for (i = 0; i < def_qps; i++) {
2094                 ret = ehea_init_port_res(port, &port->port_res[i], &pr_cfg, i);
2095                 if (ret)
2096                         goto out_clean_pr;
2097         }
2098         for (i = def_qps; i < def_qps + add_tx_qps; i++) {
2099                 ret = ehea_init_port_res(port, &port->port_res[i],
2100                                          &pr_cfg_small_rx, i);
2101                 if (ret)
2102                         goto out_clean_pr;
2103         }
2104
2105         return 0;
2106
2107 out_clean_pr:
2108         while (--i >= 0)
2109                 ehea_clean_portres(port, &port->port_res[i]);
2110
2111 out_kill_eq:
2112         ehea_destroy_eq(port->qp_eq);
2113         return ret;
2114 }
2115
2116 static int ehea_clean_all_portres(struct ehea_port *port)
2117 {
2118         int ret = 0;
2119         int i;
2120
2121         for(i = 0; i < port->num_def_qps + port->num_add_tx_qps; i++)
2122                 ret |= ehea_clean_portres(port, &port->port_res[i]);
2123
2124         ret |= ehea_destroy_eq(port->qp_eq);
2125
2126         return ret;
2127 }
2128
2129 static int ehea_up(struct net_device *dev)
2130 {
2131         int ret, i;
2132         struct ehea_port *port = netdev_priv(dev);
2133         u64 mac_addr = 0;
2134
2135         if (port->state == EHEA_PORT_UP)
2136                 return 0;
2137
2138         ret = ehea_port_res_setup(port, port->num_def_qps,
2139                                   port->num_add_tx_qps);
2140         if (ret) {
2141                 ehea_error("port_res_failed");
2142                 goto out;
2143         }
2144
2145         /* Set default QP for this port */
2146         ret = ehea_configure_port(port);
2147         if (ret) {
2148                 ehea_error("ehea_configure_port failed. ret:%d", ret);
2149                 goto out_clean_pr;
2150         }
2151
2152         ret = ehea_broadcast_reg_helper(port, H_REG_BCMC);
2153         if (ret) {
2154                 ret = -EIO;
2155                 ehea_error("out_clean_pr");
2156                 goto out_clean_pr;
2157         }
2158         mac_addr = (*(u64*)dev->dev_addr) >> 16;
2159
2160         ret = ehea_reg_interrupts(dev);
2161         if (ret) {
2162                 ehea_error("out_dereg_bc");
2163                 goto out_dereg_bc;
2164         }
2165
2166         for(i = 0; i < port->num_def_qps + port->num_add_tx_qps; i++) {
2167                 ret = ehea_activate_qp(port->adapter, port->port_res[i].qp);
2168                 if (ret) {
2169                         ehea_error("activate_qp failed");
2170                         goto out_free_irqs;
2171                 }
2172         }
2173
2174         for(i = 0; i < port->num_def_qps; i++) {
2175                 ret = ehea_fill_port_res(&port->port_res[i]);
2176                 if (ret) {
2177                         ehea_error("out_free_irqs");
2178                         goto out_free_irqs;
2179                 }
2180         }
2181
2182         ret = 0;
2183         port->state = EHEA_PORT_UP;
2184         goto out;
2185
2186 out_free_irqs:
2187         ehea_free_interrupts(dev);
2188
2189 out_dereg_bc:
2190         ehea_broadcast_reg_helper(port, H_DEREG_BCMC);
2191
2192 out_clean_pr:
2193         ehea_clean_all_portres(port);
2194 out:
2195         return ret;
2196 }
2197
2198 static int ehea_open(struct net_device *dev)
2199 {
2200         int ret;
2201         struct ehea_port *port = netdev_priv(dev);
2202
2203         down(&port->port_lock);
2204
2205         if (netif_msg_ifup(port))
2206                 ehea_info("enabling port %s", dev->name);
2207
2208         ret = ehea_up(dev);
2209         if (!ret)
2210                 netif_start_queue(dev);
2211
2212         up(&port->port_lock);
2213
2214         return ret;
2215 }
2216
2217 static int ehea_down(struct net_device *dev)
2218 {
2219         int ret, i;
2220         struct ehea_port *port = netdev_priv(dev);
2221
2222         if (port->state == EHEA_PORT_DOWN)
2223                 return 0;
2224
2225         ehea_drop_multicast_list(dev);
2226         ehea_free_interrupts(dev);
2227
2228         for (i = 0; i < port->num_def_qps; i++)
2229                 while (test_bit(__LINK_STATE_RX_SCHED,
2230                                 &port->port_res[i].d_netdev->state))
2231                         msleep(1);
2232
2233         ehea_broadcast_reg_helper(port, H_DEREG_BCMC);
2234         ret = ehea_clean_all_portres(port);
2235         port->state = EHEA_PORT_DOWN;
2236         return ret;
2237 }
2238
2239 static int ehea_stop(struct net_device *dev)
2240 {
2241         int ret;
2242         struct ehea_port *port = netdev_priv(dev);
2243
2244         if (netif_msg_ifdown(port))
2245                 ehea_info("disabling port %s", dev->name);
2246
2247         flush_workqueue(port->adapter->ehea_wq);
2248         down(&port->port_lock);
2249         netif_stop_queue(dev);
2250         ret = ehea_down(dev);
2251         up(&port->port_lock);
2252         return ret;
2253 }
2254
2255 static void ehea_reset_port(struct work_struct *work)
2256 {
2257         int ret;
2258         struct ehea_port *port =
2259                 container_of(work, struct ehea_port, reset_task);
2260         struct net_device *dev = port->netdev;
2261
2262         port->resets++;
2263         down(&port->port_lock);
2264         netif_stop_queue(dev);
2265         netif_poll_disable(dev);
2266
2267         ret = ehea_down(dev);
2268         if (ret)
2269                 ehea_error("ehea_down failed. not all resources are freed");
2270
2271         ret = ehea_up(dev);
2272         if (ret) {
2273                 ehea_error("Reset device %s failed: ret=%d", dev->name, ret);
2274                 goto out;
2275         }
2276
2277         if (netif_msg_timer(port))
2278                 ehea_info("Device %s resetted successfully", dev->name);
2279
2280         netif_poll_enable(dev);
2281         netif_wake_queue(dev);
2282 out:
2283         up(&port->port_lock);
2284         return;
2285 }
2286
2287 static void ehea_tx_watchdog(struct net_device *dev)
2288 {
2289         struct ehea_port *port = netdev_priv(dev);
2290
2291         if (netif_carrier_ok(dev))
2292                 queue_work(port->adapter->ehea_wq, &port->reset_task);
2293 }
2294
2295 int ehea_sense_adapter_attr(struct ehea_adapter *adapter)
2296 {
2297         struct hcp_query_ehea *cb;
2298         u64 hret;
2299         int ret;
2300
2301         cb = kzalloc(PAGE_SIZE, GFP_KERNEL);
2302         if (!cb) {
2303                 ret = -ENOMEM;
2304                 goto out;
2305         }
2306
2307         hret = ehea_h_query_ehea(adapter->handle, cb);
2308
2309         if (hret != H_SUCCESS) {
2310                 ret = -EIO;
2311                 goto out_herr;
2312         }
2313
2314         adapter->max_mc_mac = cb->max_mc_mac - 1;
2315         ret = 0;
2316
2317 out_herr:
2318         kfree(cb);
2319 out:
2320         return ret;
2321 }
2322
2323 int ehea_get_jumboframe_status(struct ehea_port *port, int *jumbo)
2324 {
2325         struct hcp_ehea_port_cb4 *cb4;
2326         u64 hret;
2327         int ret = 0;
2328
2329         *jumbo = 0;
2330
2331         /* (Try to) enable *jumbo frames */
2332         cb4 = kzalloc(PAGE_SIZE, GFP_KERNEL);
2333         if (!cb4) {
2334                 ehea_error("no mem for cb4");
2335                 ret = -ENOMEM;
2336                 goto out;
2337         } else {
2338                 hret = ehea_h_query_ehea_port(port->adapter->handle,
2339                                               port->logical_port_id,
2340                                               H_PORT_CB4,
2341                                               H_PORT_CB4_JUMBO, cb4);
2342                 if (hret == H_SUCCESS) {
2343                         if (cb4->jumbo_frame)
2344                                 *jumbo = 1;
2345                         else {
2346                                 cb4->jumbo_frame = 1;
2347                                 hret = ehea_h_modify_ehea_port(port->adapter->
2348                                                                handle,
2349                                                                port->
2350                                                                logical_port_id,
2351                                                                H_PORT_CB4,
2352                                                                H_PORT_CB4_JUMBO,
2353                                                                cb4);
2354                                 if (hret == H_SUCCESS)
2355                                         *jumbo = 1;
2356                         }
2357                 } else
2358                         ret = -EINVAL;
2359
2360                 kfree(cb4);
2361         }
2362 out:
2363         return ret;
2364 }
2365
2366 static ssize_t ehea_show_port_id(struct device *dev,
2367                                  struct device_attribute *attr, char *buf)
2368 {
2369         struct ehea_port *port = container_of(dev, struct ehea_port, ofdev.dev);
2370         return sprintf(buf, "0x%X", port->logical_port_id);
2371 }
2372
2373 static DEVICE_ATTR(log_port_id, S_IRUSR | S_IRGRP | S_IROTH, ehea_show_port_id,
2374                    NULL);
2375
2376 static void __devinit logical_port_release(struct device *dev)
2377 {
2378         struct ehea_port *port = container_of(dev, struct ehea_port, ofdev.dev);
2379         of_node_put(port->ofdev.node);
2380 }
2381
2382 static struct device *ehea_register_port(struct ehea_port *port,
2383                                          struct device_node *dn)
2384 {
2385         int ret;
2386
2387         port->ofdev.node = of_node_get(dn);
2388         port->ofdev.dev.parent = &port->adapter->ebus_dev->ofdev.dev;
2389
2390         sprintf(port->ofdev.dev.bus_id, "port%d", port->logical_port_id);
2391         port->ofdev.dev.release = logical_port_release;
2392
2393         ret = of_device_register(&port->ofdev);
2394         if (ret) {
2395                 ehea_error("failed to register device. ret=%d", ret);
2396                 goto out;
2397         }
2398
2399         ret = device_create_file(&port->ofdev.dev, &dev_attr_log_port_id);
2400         if (ret) {
2401                 ehea_error("failed to register attributes, ret=%d", ret);
2402                 goto out_unreg_of_dev;
2403         }
2404
2405         return &port->ofdev.dev;
2406
2407 out_unreg_of_dev:
2408         of_device_unregister(&port->ofdev);
2409 out:
2410         return NULL;
2411 }
2412
2413 static void ehea_unregister_port(struct ehea_port *port)
2414 {
2415         device_remove_file(&port->ofdev.dev, &dev_attr_log_port_id);
2416         of_device_unregister(&port->ofdev);
2417 }
2418
2419 struct ehea_port *ehea_setup_single_port(struct ehea_adapter *adapter,
2420                                          u32 logical_port_id,
2421                                          struct device_node *dn)
2422 {
2423         int ret;
2424         struct net_device *dev;
2425         struct ehea_port *port;
2426         struct device *port_dev;
2427         int jumbo;
2428
2429         /* allocate memory for the port structures */
2430         dev = alloc_etherdev(sizeof(struct ehea_port));
2431
2432         if (!dev) {
2433                 ehea_error("no mem for net_device");
2434                 ret = -ENOMEM;
2435                 goto out_err;
2436         }
2437
2438         port = netdev_priv(dev);
2439
2440         sema_init(&port->port_lock, 1);
2441         port->state = EHEA_PORT_DOWN;
2442         port->sig_comp_iv = sq_entries / 10;
2443
2444         port->adapter = adapter;
2445         port->netdev = dev;
2446         port->logical_port_id = logical_port_id;
2447
2448         port->msg_enable = netif_msg_init(msg_level, EHEA_MSG_DEFAULT);
2449
2450         port->mc_list = kzalloc(sizeof(struct ehea_mc_list), GFP_KERNEL);
2451         if (!port->mc_list) {
2452                 ret = -ENOMEM;
2453                 goto out_free_ethdev;
2454         }
2455
2456         INIT_LIST_HEAD(&port->mc_list->list);
2457
2458         ret = ehea_sense_port_attr(port);
2459         if (ret)
2460                 goto out_free_mc_list;
2461
2462         port_dev = ehea_register_port(port, dn);
2463         if (!port_dev)
2464                 goto out_free_mc_list;
2465
2466         SET_NETDEV_DEV(dev, port_dev);
2467
2468         /* initialize net_device structure */
2469         SET_MODULE_OWNER(dev);
2470
2471         memcpy(dev->dev_addr, &port->mac_addr, ETH_ALEN);
2472
2473         dev->open = ehea_open;
2474         dev->poll = ehea_poll;
2475         dev->weight = 64;
2476         dev->stop = ehea_stop;
2477         dev->hard_start_xmit = ehea_start_xmit;
2478         dev->get_stats = ehea_get_stats;
2479         dev->set_multicast_list = ehea_set_multicast_list;
2480         dev->set_mac_address = ehea_set_mac_addr;
2481         dev->change_mtu = ehea_change_mtu;
2482         dev->vlan_rx_register = ehea_vlan_rx_register;
2483         dev->vlan_rx_add_vid = ehea_vlan_rx_add_vid;
2484         dev->vlan_rx_kill_vid = ehea_vlan_rx_kill_vid;
2485         dev->features = NETIF_F_SG | NETIF_F_FRAGLIST | NETIF_F_TSO
2486                       | NETIF_F_HIGHDMA | NETIF_F_HW_CSUM | NETIF_F_HW_VLAN_TX
2487                       | NETIF_F_HW_VLAN_RX | NETIF_F_HW_VLAN_FILTER
2488                       | NETIF_F_LLTX;
2489         dev->tx_timeout = &ehea_tx_watchdog;
2490         dev->watchdog_timeo = EHEA_WATCH_DOG_TIMEOUT;
2491
2492         INIT_WORK(&port->reset_task, ehea_reset_port);
2493
2494         ehea_set_ethtool_ops(dev);
2495
2496         ret = register_netdev(dev);
2497         if (ret) {
2498                 ehea_error("register_netdev failed. ret=%d", ret);
2499                 goto out_unreg_port;
2500         }
2501
2502         ret = ehea_get_jumboframe_status(port, &jumbo);
2503         if (ret)
2504                 ehea_error("failed determining jumbo frame status for %s",
2505                            port->netdev->name);
2506
2507         ehea_info("%s: Jumbo frames are %sabled", dev->name,
2508                   jumbo == 1 ? "en" : "dis");
2509
2510         return port;
2511
2512 out_unreg_port:
2513         ehea_unregister_port(port);
2514
2515 out_free_mc_list:
2516         kfree(port->mc_list);
2517
2518 out_free_ethdev:
2519         free_netdev(dev);
2520
2521 out_err:
2522         ehea_error("setting up logical port with id=%d failed, ret=%d",
2523                    logical_port_id, ret);
2524         return NULL;
2525 }
2526
2527 static void ehea_shutdown_single_port(struct ehea_port *port)
2528 {
2529         unregister_netdev(port->netdev);
2530         ehea_unregister_port(port);
2531         kfree(port->mc_list);
2532         free_netdev(port->netdev);
2533 }
2534
2535 static int ehea_setup_ports(struct ehea_adapter *adapter)
2536 {
2537         struct device_node *lhea_dn;
2538         struct device_node *eth_dn = NULL;
2539
2540         u32 *dn_log_port_id;
2541         int port_setup_ok = 0;
2542         int i = 0;
2543
2544         lhea_dn = adapter->ebus_dev->ofdev.node;
2545         while ((eth_dn = of_get_next_child(lhea_dn, eth_dn))) {
2546
2547                 dn_log_port_id = (u32*)get_property(eth_dn, "ibm,hea-port-no",
2548                                                     NULL);
2549                 if (!dn_log_port_id) {
2550                         ehea_error("bad device node: eth_dn name=%s",
2551                                    eth_dn->full_name);
2552                         continue;
2553                 }
2554
2555                 adapter->port[i] = ehea_setup_single_port(adapter,
2556                                                           *dn_log_port_id,
2557                                                           eth_dn);
2558                 if (adapter->port[i])
2559                         ehea_info("%s -> logical port id #%d",
2560                                   adapter->port[i]->netdev->name,
2561                                   *dn_log_port_id);
2562                 i++;
2563         };
2564
2565         /* Check for succesfully set up ports */
2566         for (i = 0; i < EHEA_MAX_PORTS; i++)
2567                 if (adapter->port[i])
2568                         port_setup_ok++;
2569
2570         if (port_setup_ok)
2571                 return 0;       /* At least some ports are setup correctly */
2572
2573         return -EINVAL;
2574 }
2575
2576 static struct device_node *ehea_get_eth_dn(struct ehea_adapter *adapter,
2577                                            u32 logical_port_id)
2578 {
2579         struct device_node *lhea_dn;
2580         struct device_node *eth_dn = NULL;
2581         u32 *dn_log_port_id;
2582
2583         lhea_dn = adapter->ebus_dev->ofdev.node;
2584         while ((eth_dn = of_get_next_child(lhea_dn, eth_dn))) {
2585
2586                 dn_log_port_id = (u32*)get_property(eth_dn, "ibm,hea-port-no",
2587                                                     NULL);
2588                 if (dn_log_port_id)
2589                         if (*dn_log_port_id == logical_port_id)
2590                                 return eth_dn;
2591         };
2592
2593         return NULL;
2594 }
2595
2596 static ssize_t ehea_probe_port(struct device *dev,
2597                                struct device_attribute *attr,
2598                                const char *buf, size_t count)
2599 {
2600         struct ehea_adapter *adapter = dev->driver_data;
2601         struct ehea_port *port;
2602         struct device_node *eth_dn = NULL;
2603         int i;
2604
2605         u32 logical_port_id;
2606
2607         sscanf(buf, "%X", &logical_port_id);
2608
2609         port = ehea_get_port(adapter, logical_port_id);
2610
2611         if (port) {
2612                 ehea_info("adding port with logical port id=%d failed. port "
2613                           "already configured as %s.", logical_port_id,
2614                           port->netdev->name);
2615                 return -EINVAL;
2616         }
2617
2618         eth_dn = ehea_get_eth_dn(adapter, logical_port_id);
2619
2620         if (!eth_dn) {
2621                 ehea_info("no logical port with id %d found", logical_port_id);
2622                 return -EINVAL;
2623         }
2624
2625         port = ehea_setup_single_port(adapter, logical_port_id, eth_dn);
2626
2627         of_node_put(eth_dn);
2628
2629         if (port) {
2630                 for (i=0; i < EHEA_MAX_PORTS; i++)
2631                         if (!adapter->port[i]) {
2632                                 adapter->port[i] = port;
2633                                 break;
2634                         }
2635
2636                 ehea_info("added %s (logical port id=%d)", port->netdev->name,
2637                           logical_port_id);
2638         } else
2639                 return -EIO;
2640
2641         return (ssize_t) count;
2642 }
2643
2644 static ssize_t ehea_remove_port(struct device *dev,
2645                                 struct device_attribute *attr,
2646                                 const char *buf, size_t count)
2647 {
2648         struct ehea_adapter *adapter = dev->driver_data;
2649         struct ehea_port *port;
2650         int i;
2651         u32 logical_port_id;
2652
2653         sscanf(buf, "%X", &logical_port_id);
2654
2655         port = ehea_get_port(adapter, logical_port_id);
2656
2657         if (port) {
2658                 ehea_info("removed %s (logical port id=%d)", port->netdev->name,
2659                           logical_port_id);
2660
2661                 ehea_shutdown_single_port(port);
2662
2663                 for (i=0; i < EHEA_MAX_PORTS; i++)
2664                         if (adapter->port[i] == port) {
2665                                 adapter->port[i] = NULL;
2666                                 break;
2667                         }
2668         } else {
2669                 ehea_error("removing port with logical port id=%d failed. port "
2670                            "not configured.", logical_port_id);
2671                 return -EINVAL;
2672         }
2673
2674         return (ssize_t) count;
2675 }
2676
2677 static DEVICE_ATTR(probe_port, S_IWUSR, NULL, ehea_probe_port);
2678 static DEVICE_ATTR(remove_port, S_IWUSR, NULL, ehea_remove_port);
2679
2680 int ehea_create_device_sysfs(struct ibmebus_dev *dev)
2681 {
2682         int ret = device_create_file(&dev->ofdev.dev, &dev_attr_probe_port);
2683         if (ret)
2684                 goto out;
2685
2686         ret = device_create_file(&dev->ofdev.dev, &dev_attr_remove_port);
2687 out:
2688         return ret;
2689 }
2690
2691 void ehea_remove_device_sysfs(struct ibmebus_dev *dev)
2692 {
2693         device_remove_file(&dev->ofdev.dev, &dev_attr_probe_port);
2694         device_remove_file(&dev->ofdev.dev, &dev_attr_remove_port);
2695 }
2696
2697 static int __devinit ehea_probe_adapter(struct ibmebus_dev *dev,
2698                                         const struct of_device_id *id)
2699 {
2700         struct ehea_adapter *adapter;
2701         u64 *adapter_handle;
2702         int ret;
2703
2704         if (!dev || !dev->ofdev.node) {
2705                 ehea_error("Invalid ibmebus device probed");
2706                 return -EINVAL;
2707         }
2708
2709         adapter = kzalloc(sizeof(*adapter), GFP_KERNEL);
2710         if (!adapter) {
2711                 ret = -ENOMEM;
2712                 dev_err(&dev->ofdev.dev, "no mem for ehea_adapter\n");
2713                 goto out;
2714         }
2715
2716         adapter->ebus_dev = dev;
2717
2718         adapter_handle = (u64*)get_property(dev->ofdev.node, "ibm,hea-handle",
2719                                             NULL);
2720         if (adapter_handle)
2721                 adapter->handle = *adapter_handle;
2722
2723         if (!adapter->handle) {
2724                 dev_err(&dev->ofdev.dev, "failed getting handle for adapter"
2725                         " '%s'\n", dev->ofdev.node->full_name);
2726                 ret = -ENODEV;
2727                 goto out_free_ad;
2728         }
2729
2730         adapter->pd = EHEA_PD_ID;
2731
2732         dev->ofdev.dev.driver_data = adapter;
2733
2734         ret = ehea_reg_kernel_mr(adapter, &adapter->mr);
2735         if (ret) {
2736                 dev_err(&dev->ofdev.dev, "reg_mr_adapter failed\n");
2737                 goto out_free_ad;
2738         }
2739
2740         /* initialize adapter and ports */
2741         /* get adapter properties */
2742         ret = ehea_sense_adapter_attr(adapter);
2743         if (ret) {
2744                 dev_err(&dev->ofdev.dev, "sense_adapter_attr failed: %d", ret);
2745                 goto out_free_res;
2746         }
2747
2748         adapter->neq = ehea_create_eq(adapter,
2749                                       EHEA_NEQ, EHEA_MAX_ENTRIES_EQ, 1);
2750         if (!adapter->neq) {
2751                 ret = -EIO;
2752                 dev_err(&dev->ofdev.dev, "NEQ creation failed");
2753                 goto out_free_res;
2754         }
2755
2756         tasklet_init(&adapter->neq_tasklet, ehea_neq_tasklet,
2757                      (unsigned long)adapter);
2758
2759         ret = ibmebus_request_irq(NULL, adapter->neq->attr.ist1,
2760                                   ehea_interrupt_neq, IRQF_DISABLED,
2761                                   "ehea_neq", adapter);
2762         if (ret) {
2763                 dev_err(&dev->ofdev.dev, "requesting NEQ IRQ failed");
2764                 goto out_kill_eq;
2765         }
2766
2767         adapter->ehea_wq = create_workqueue("ehea_wq");
2768         if (!adapter->ehea_wq) {
2769                 ret = -EIO;
2770                 goto out_free_irq;
2771         }
2772
2773         ret = ehea_create_device_sysfs(dev);
2774         if (ret)
2775                 goto out_kill_wq;
2776
2777         ret = ehea_setup_ports(adapter);
2778         if (ret) {
2779                 dev_err(&dev->ofdev.dev, "setup_ports failed");
2780                 goto out_rem_dev_sysfs;
2781         }
2782
2783         ret = 0;
2784         goto out;
2785
2786 out_rem_dev_sysfs:
2787         ehea_remove_device_sysfs(dev);
2788
2789 out_kill_wq:
2790         destroy_workqueue(adapter->ehea_wq);
2791
2792 out_free_irq:
2793         ibmebus_free_irq(NULL, adapter->neq->attr.ist1, adapter);
2794
2795 out_kill_eq:
2796         ehea_destroy_eq(adapter->neq);
2797
2798 out_free_res:
2799         ehea_rem_mr(&adapter->mr);
2800
2801 out_free_ad:
2802         kfree(adapter);
2803 out:
2804         return ret;
2805 }
2806
2807 static int __devexit ehea_remove(struct ibmebus_dev *dev)
2808 {
2809         struct ehea_adapter *adapter = dev->ofdev.dev.driver_data;
2810         int i;
2811
2812         for (i = 0; i < EHEA_MAX_PORTS; i++)
2813                 if (adapter->port[i]) {
2814                         ehea_shutdown_single_port(adapter->port[i]);
2815                         adapter->port[i] = NULL;
2816                 }
2817
2818         ehea_remove_device_sysfs(dev);
2819
2820         destroy_workqueue(adapter->ehea_wq);
2821
2822         ibmebus_free_irq(NULL, adapter->neq->attr.ist1, adapter);
2823         tasklet_kill(&adapter->neq_tasklet);
2824
2825         ehea_destroy_eq(adapter->neq);
2826         ehea_rem_mr(&adapter->mr);
2827         kfree(adapter);
2828         return 0;
2829 }
2830
2831 static int check_module_parm(void)
2832 {
2833         int ret = 0;
2834
2835         if ((rq1_entries < EHEA_MIN_ENTRIES_QP) ||
2836             (rq1_entries > EHEA_MAX_ENTRIES_RQ1)) {
2837                 ehea_info("Bad parameter: rq1_entries");
2838                 ret = -EINVAL;
2839         }
2840         if ((rq2_entries < EHEA_MIN_ENTRIES_QP) ||
2841             (rq2_entries > EHEA_MAX_ENTRIES_RQ2)) {
2842                 ehea_info("Bad parameter: rq2_entries");
2843                 ret = -EINVAL;
2844         }
2845         if ((rq3_entries < EHEA_MIN_ENTRIES_QP) ||
2846             (rq3_entries > EHEA_MAX_ENTRIES_RQ3)) {
2847                 ehea_info("Bad parameter: rq3_entries");
2848                 ret = -EINVAL;
2849         }
2850         if ((sq_entries < EHEA_MIN_ENTRIES_QP) ||
2851             (sq_entries > EHEA_MAX_ENTRIES_SQ)) {
2852                 ehea_info("Bad parameter: sq_entries");
2853                 ret = -EINVAL;
2854         }
2855
2856         return ret;
2857 }
2858
2859 static struct of_device_id ehea_device_table[] = {
2860         {
2861                 .name = "lhea",
2862                 .compatible = "IBM,lhea",
2863         },
2864         {},
2865 };
2866
2867 static struct ibmebus_driver ehea_driver = {
2868         .name = "ehea",
2869         .id_table = ehea_device_table,
2870         .probe = ehea_probe_adapter,
2871         .remove = ehea_remove,
2872 };
2873
2874 int __init ehea_module_init(void)
2875 {
2876         int ret;
2877
2878         printk(KERN_INFO "IBM eHEA ethernet device driver (Release %s)\n",
2879                DRV_VERSION);
2880
2881         ret = check_module_parm();
2882         if (ret)
2883                 goto out;
2884         ret = ibmebus_register_driver(&ehea_driver);
2885         if (ret)
2886                 ehea_error("failed registering eHEA device driver on ebus");
2887
2888 out:
2889         return ret;
2890 }
2891
2892 static void __exit ehea_module_exit(void)
2893 {
2894         ibmebus_unregister_driver(&ehea_driver);
2895 }
2896
2897 module_init(ehea_module_init);
2898 module_exit(ehea_module_exit);