git.oblomov.eu Git - linux-2.6/blob - drivers/message/fusion/mptlan.c

   1 /*
   2  *  linux/drivers/message/fusion/mptlan.c
   3  *      IP Over Fibre Channel device driver.
   4  *      For use with LSI Logic Fibre Channel PCI chip/adapters
   5  *      running LSI Logic Fusion MPT (Message Passing Technology) firmware.
   6  *
   7  *  Copyright (c) 2000-2005 LSI Logic Corporation
   8  *
   9  */
  10 /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
  11 /*
  12     This program is free software; you can redistribute it and/or modify
  13     it under the terms of the GNU General Public License as published by
  14     the Free Software Foundation; version 2 of the License.
  15
  16     This program is distributed in the hope that it will be useful,
  17     but WITHOUT ANY WARRANTY; without even the implied warranty of
  18     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  19     GNU General Public License for more details.
  20
  21     NO WARRANTY
  22     THE PROGRAM IS PROVIDED ON AN "AS IS" BASIS, WITHOUT WARRANTIES OR
  23     CONDITIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED INCLUDING, WITHOUT
  24     LIMITATION, ANY WARRANTIES OR CONDITIONS OF TITLE, NON-INFRINGEMENT,
  25     MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE. Each Recipient is
  26     solely responsible for determining the appropriateness of using and
  27     distributing the Program and assumes all risks associated with its
  28     exercise of rights under this Agreement, including but not limited to
  29     the risks and costs of program errors, damage to or loss of data,
  30     programs or equipment, and unavailability or interruption of operations.
  31
  32     DISCLAIMER OF LIABILITY
  33     NEITHER RECIPIENT NOR ANY CONTRIBUTORS SHALL HAVE ANY LIABILITY FOR ANY
  34     DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  35     DAMAGES (INCLUDING WITHOUT LIMITATION LOST PROFITS), HOWEVER CAUSED AND
  36     ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR
  37     TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE
  38     USE OR DISTRIBUTION OF THE PROGRAM OR THE EXERCISE OF ANY RIGHTS GRANTED
  39     HEREUNDER, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGES
  40
  41     You should have received a copy of the GNU General Public License
  42     along with this program; if not, write to the Free Software
  43     Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
  44 */
  45
  46 /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
  47 /*
  48  * Define statements used for debugging
  49  */
  50 //#define MPT_LAN_IO_DEBUG
  51
  52 /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
  53
  54 #include "mptlan.h"
  55 #include <linux/init.h>
  56 #include <linux/module.h>
  57 #include <linux/fs.h>
  58
  59 #define MYNAM           "mptlan"
  60
  61 MODULE_LICENSE("GPL");
  62
  63 /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
  64 /*
  65  * MPT LAN message sizes without variable part.
  66  */
  67 #define MPT_LAN_RECEIVE_POST_REQUEST_SIZE \
  68         (sizeof(LANReceivePostRequest_t) - sizeof(SGE_MPI_UNION))
  69
  70 #define MPT_LAN_TRANSACTION32_SIZE \
  71         (sizeof(SGETransaction32_t) - sizeof(u32))
  72
  73 /*
  74  *  Fusion MPT LAN private structures
  75  */
  76
  77 struct NAA_Hosed {
  78         u16 NAA;
  79         u8 ieee[FC_ALEN];
  80         struct NAA_Hosed *next;
  81 };
  82
  83 struct BufferControl {
  84         struct sk_buff  *skb;
  85         dma_addr_t      dma;
  86         unsigned int    len;
  87 };
  88
  89 struct mpt_lan_priv {
  90         MPT_ADAPTER *mpt_dev;
  91         u8 pnum; /* Port number in the IOC. This is not a Unix network port! */
  92
  93         atomic_t buckets_out;           /* number of unused buckets on IOC */
  94         int bucketthresh;               /* Send more when this many left */
  95
  96         int *mpt_txfidx; /* Free Tx Context list */
  97         int mpt_txfidx_tail;
  98         spinlock_t txfidx_lock;
  99
 100         int *mpt_rxfidx; /* Free Rx Context list */
 101         int mpt_rxfidx_tail;
 102         spinlock_t rxfidx_lock;
 103
 104         struct BufferControl *RcvCtl;   /* Receive BufferControl structs */
 105         struct BufferControl *SendCtl;  /* Send BufferControl structs */
 106
 107         int max_buckets_out;            /* Max buckets to send to IOC */
 108         int tx_max_out;                 /* IOC's Tx queue len */
 109
 110         u32 total_posted;
 111         u32 total_received;
 112         struct net_device_stats stats;  /* Per device statistics */
 113
 114         struct work_struct post_buckets_task;
 115         unsigned long post_buckets_active;
 116 };
 117
 118 struct mpt_lan_ohdr {
 119         u16     dtype;
 120         u8      daddr[FC_ALEN];
 121         u16     stype;
 122         u8      saddr[FC_ALEN];
 123 };
 124
 125 /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
 126
 127 /*
 128  *  Forward protos...
 129  */
 130 static int  lan_reply (MPT_ADAPTER *ioc, MPT_FRAME_HDR *mf,
 131                        MPT_FRAME_HDR *reply);
 132 static int  mpt_lan_open(struct net_device *dev);
 133 static int  mpt_lan_reset(struct net_device *dev);
 134 static int  mpt_lan_close(struct net_device *dev);
 135 static void mpt_lan_post_receive_buckets(void *dev_id);
 136 static void mpt_lan_wake_post_buckets_task(struct net_device *dev,
 137                                            int priority);
 138 static int  mpt_lan_receive_post_turbo(struct net_device *dev, u32 tmsg);
 139 static int  mpt_lan_receive_post_reply(struct net_device *dev,
 140                                        LANReceivePostReply_t *pRecvRep);
 141 static int  mpt_lan_send_turbo(struct net_device *dev, u32 tmsg);
 142 static int  mpt_lan_send_reply(struct net_device *dev,
 143                                LANSendReply_t *pSendRep);
 144 static int  mpt_lan_ioc_reset(MPT_ADAPTER *ioc, int reset_phase);
 145 static int  mpt_lan_event_process(MPT_ADAPTER *ioc, EventNotificationReply_t *pEvReply);
 146 static unsigned short mpt_lan_type_trans(struct sk_buff *skb,
 147                                          struct net_device *dev);
 148
 149 /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
 150 /*
 151  *  Fusion MPT LAN private data
 152  */
 153 static int LanCtx = -1;
 154
 155 static u32 max_buckets_out = 127;
 156 static u32 tx_max_out_p = 127 - 16;
 157
 158 #ifdef QLOGIC_NAA_WORKAROUND
 159 static struct NAA_Hosed *mpt_bad_naa = NULL;
 160 DEFINE_RWLOCK(bad_naa_lock);
 161 #endif
 162
 163 /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
 164 /*
 165  * Fusion MPT LAN external data
 166  */
 167 extern int mpt_lan_index;
 168
 169 /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
 170 /**
 171  *      lan_reply - Handle all data sent from the hardware.
 172  *      @ioc: Pointer to MPT_ADAPTER structure
 173  *      @mf: Pointer to original MPT request frame (NULL if TurboReply)
 174  *      @reply: Pointer to MPT reply frame
 175  *
 176  *      Returns 1 indicating original alloc'd request frame ptr
 177  *      should be freed, or 0 if it shouldn't.
 178  */
 179 static int
 180 lan_reply (MPT_ADAPTER *ioc, MPT_FRAME_HDR *mf, MPT_FRAME_HDR *reply)
 181 {
 182         struct net_device *dev = ioc->netdev;
 183         int FreeReqFrame = 0;
 184
 185         dioprintk((KERN_INFO MYNAM ": %s/%s: Got reply.\n",
 186                   IOC_AND_NETDEV_NAMES_s_s(dev)));
 187
 188 //      dioprintk((KERN_INFO MYNAM "@lan_reply: mf = %p, reply = %p\n",
 189 //                      mf, reply));
 190
 191         if (mf == NULL) {
 192                 u32 tmsg = CAST_PTR_TO_U32(reply);
 193
 194                 dioprintk((KERN_INFO MYNAM ": %s/%s: @lan_reply, tmsg %08x\n",
 195                                 IOC_AND_NETDEV_NAMES_s_s(dev),
 196                                 tmsg));
 197
 198                 switch (GET_LAN_FORM(tmsg)) {
 199
 200                 // NOTE!  (Optimization) First case here is now caught in
 201                 //  mptbase.c::mpt_interrupt() routine and callcack here
 202                 //  is now skipped for this case!
 203 #if 0
 204                 case LAN_REPLY_FORM_MESSAGE_CONTEXT:
 205 //                      dioprintk((KERN_INFO MYNAM "/lan_reply: "
 206 //                                "MessageContext turbo reply received\n"));
 207                         FreeReqFrame = 1;
 208                         break;
 209 #endif
 210
 211                 case LAN_REPLY_FORM_SEND_SINGLE:
 212 //                      dioprintk((MYNAM "/lan_reply: "
 213 //                                "calling mpt_lan_send_reply (turbo)\n"));
 214
 215                         // Potential BUG here?
 216                         //      FreeReqFrame = mpt_lan_send_turbo(dev, tmsg);
 217                         //  If/when mpt_lan_send_turbo would return 1 here,
 218                         //  calling routine (mptbase.c|mpt_interrupt)
 219                         //  would Oops because mf has already been set
 220                         //  to NULL.  So after return from this func,
 221                         //  mpt_interrupt() will attempt to put (NULL) mf ptr
 222                         //  item back onto its adapter FreeQ - Oops!:-(
 223                         //  It's Ok, since mpt_lan_send_turbo() *currently*
 224                         //  always returns 0, but..., just in case:
 225
 226                         (void) mpt_lan_send_turbo(dev, tmsg);
 227                         FreeReqFrame = 0;
 228
 229                         break;
 230
 231                 case LAN_REPLY_FORM_RECEIVE_SINGLE:
 232 //                      dioprintk((KERN_INFO MYNAM "@lan_reply: "
 233 //                                "rcv-Turbo = %08x\n", tmsg));
 234                         mpt_lan_receive_post_turbo(dev, tmsg);
 235                         break;
 236
 237                 default:
 238                         printk (KERN_ERR MYNAM "/lan_reply: Got a turbo reply "
 239                                 "that I don't know what to do with\n");
 240
 241                         /* CHECKME!  Hmmm...  FreeReqFrame is 0 here; is that right? */
 242
 243                         break;
 244                 }
 245
 246                 return FreeReqFrame;
 247         }
 248
 249 //      msg = (u32 *) reply;
 250 //      dioprintk((KERN_INFO MYNAM "@lan_reply: msg = %08x %08x %08x %08x\n",
 251 //                le32_to_cpu(msg[0]), le32_to_cpu(msg[1]),
 252 //                le32_to_cpu(msg[2]), le32_to_cpu(msg[3])));
 253 //      dioprintk((KERN_INFO MYNAM "@lan_reply: Function = %02xh\n",
 254 //                reply->u.hdr.Function));
 255
 256         switch (reply->u.hdr.Function) {
 257
 258         case MPI_FUNCTION_LAN_SEND:
 259         {
 260                 LANSendReply_t *pSendRep;
 261
 262                 pSendRep = (LANSendReply_t *) reply;
 263                 FreeReqFrame = mpt_lan_send_reply(dev, pSendRep);
 264                 break;
 265         }
 266
 267         case MPI_FUNCTION_LAN_RECEIVE:
 268         {
 269                 LANReceivePostReply_t *pRecvRep;
 270
 271                 pRecvRep = (LANReceivePostReply_t *) reply;
 272                 if (pRecvRep->NumberOfContexts) {
 273                         mpt_lan_receive_post_reply(dev, pRecvRep);
 274                         if (!(pRecvRep->MsgFlags & MPI_MSGFLAGS_CONTINUATION_REPLY))
 275                                 FreeReqFrame = 1;
 276                 } else
 277                         dioprintk((KERN_INFO MYNAM "@lan_reply: zero context "
 278                                   "ReceivePostReply received.\n"));
 279                 break;
 280         }
 281
 282         case MPI_FUNCTION_LAN_RESET:
 283                 /* Just a default reply. Might want to check it to
 284                  * make sure that everything went ok.
 285                  */
 286                 FreeReqFrame = 1;
 287                 break;
 288
 289         case MPI_FUNCTION_EVENT_NOTIFICATION:
 290         case MPI_FUNCTION_EVENT_ACK:
 291                 /*  _EVENT_NOTIFICATION should NOT come down this path any more.
 292                  *  Should be routed to mpt_lan_event_process(), but just in case...
 293                  */
 294                 FreeReqFrame = 1;
 295                 break;
 296
 297         default:
 298                 printk (KERN_ERR MYNAM "/lan_reply: Got a non-turbo "
 299                         "reply that I don't know what to do with\n");
 300
 301                 /* CHECKME!  Hmmm...  FreeReqFrame is 0 here; is that right? */
 302                 FreeReqFrame = 1;
 303
 304                 break;
 305         }
 306
 307         return FreeReqFrame;
 308 }
 309
 310 /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
 311 static int
 312 mpt_lan_ioc_reset(MPT_ADAPTER *ioc, int reset_phase)
 313 {
 314         struct net_device *dev = ioc->netdev;
 315         struct mpt_lan_priv *priv;
 316
 317         if (dev == NULL)
 318                 return(1);
 319         else
 320                 priv = netdev_priv(dev);
 321
 322         dlprintk((KERN_INFO MYNAM ": IOC %s_reset routed to LAN driver!\n",
 323                         reset_phase==MPT_IOC_SETUP_RESET ? "setup" : (
 324                         reset_phase==MPT_IOC_PRE_RESET ? "pre" : "post")));
 325
 326         if (priv->mpt_rxfidx == NULL)
 327                 return (1);
 328
 329         if (reset_phase == MPT_IOC_SETUP_RESET) {
 330                 ;
 331         } else if (reset_phase == MPT_IOC_PRE_RESET) {
 332                 int i;
 333                 unsigned long flags;
 334
 335                 netif_stop_queue(dev);
 336
 337                 dlprintk ((KERN_INFO "mptlan/ioc_reset: called netif_stop_queue for %s.\n", dev->name));
 338
 339                 atomic_set(&priv->buckets_out, 0);
 340
 341                 /* Reset Rx Free Tail index and re-populate the queue. */
 342                 spin_lock_irqsave(&priv->rxfidx_lock, flags);
 343                 priv->mpt_rxfidx_tail = -1;
 344                 for (i = 0; i < priv->max_buckets_out; i++)
 345                         priv->mpt_rxfidx[++priv->mpt_rxfidx_tail] = i;
 346                 spin_unlock_irqrestore(&priv->rxfidx_lock, flags);
 347         } else {
 348                 mpt_lan_post_receive_buckets(dev);
 349                 netif_wake_queue(dev);
 350         }
 351
 352         return 1;
 353 }
 354
 355 /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
 356 static int
 357 mpt_lan_event_process(MPT_ADAPTER *ioc, EventNotificationReply_t *pEvReply)
 358 {
 359         dlprintk((KERN_INFO MYNAM ": MPT event routed to LAN driver!\n"));
 360
 361         switch (le32_to_cpu(pEvReply->Event)) {
 362         case MPI_EVENT_NONE:                            /* 00 */
 363         case MPI_EVENT_LOG_DATA:                        /* 01 */
 364         case MPI_EVENT_STATE_CHANGE:                    /* 02 */
 365         case MPI_EVENT_UNIT_ATTENTION:                  /* 03 */
 366         case MPI_EVENT_IOC_BUS_RESET:                   /* 04 */
 367         case MPI_EVENT_EXT_BUS_RESET:                   /* 05 */
 368         case MPI_EVENT_RESCAN:                          /* 06 */
 369                 /* Ok, do we need to do anything here? As far as
 370                    I can tell, this is when a new device gets added
 371                    to the loop. */
 372         case MPI_EVENT_LINK_STATUS_CHANGE:              /* 07 */
 373         case MPI_EVENT_LOOP_STATE_CHANGE:               /* 08 */
 374         case MPI_EVENT_LOGOUT:                          /* 09 */
 375         case MPI_EVENT_EVENT_CHANGE:                    /* 0A */
 376         default:
 377                 break;
 378         }
 379
 380         /*
 381          *  NOTE: pEvent->AckRequired handling now done in mptbase.c;
 382          *  Do NOT do it here now!
 383          */
 384
 385         return 1;
 386 }
 387
 388 /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
 389 static int
 390 mpt_lan_open(struct net_device *dev)
 391 {
 392         struct mpt_lan_priv *priv = netdev_priv(dev);
 393         int i;
 394
 395         if (mpt_lan_reset(dev) != 0) {
 396                 MPT_ADAPTER *mpt_dev = priv->mpt_dev;
 397
 398                 printk (KERN_WARNING MYNAM "/lan_open: lan_reset failed.");
 399
 400                 if (mpt_dev->active)
 401                         printk ("The ioc is active. Perhaps it needs to be"
 402                                 " reset?\n");
 403                 else
 404                         printk ("The ioc in inactive, most likely in the "
 405                                 "process of being reset. Please try again in "
 406                                 "a moment.\n");
 407         }
 408
 409         priv->mpt_txfidx = kmalloc(priv->tx_max_out * sizeof(int), GFP_KERNEL);
 410         if (priv->mpt_txfidx == NULL)
 411                 goto out;
 412         priv->mpt_txfidx_tail = -1;
 413
 414         priv->SendCtl = kcalloc(priv->tx_max_out, sizeof(struct BufferControl),
 415                                 GFP_KERNEL);
 416         if (priv->SendCtl == NULL)
 417                 goto out_mpt_txfidx;
 418         for (i = 0; i < priv->tx_max_out; i++)
 419                 priv->mpt_txfidx[++priv->mpt_txfidx_tail] = i;
 420
 421         dlprintk((KERN_INFO MYNAM "@lo: Finished initializing SendCtl\n"));
 422
 423         priv->mpt_rxfidx = kmalloc(priv->max_buckets_out * sizeof(int),
 424                                    GFP_KERNEL);
 425         if (priv->mpt_rxfidx == NULL)
 426                 goto out_SendCtl;
 427         priv->mpt_rxfidx_tail = -1;
 428
 429         priv->RcvCtl = kcalloc(priv->max_buckets_out,
 430                                sizeof(struct BufferControl),
 431                                GFP_KERNEL);
 432         if (priv->RcvCtl == NULL)
 433                 goto out_mpt_rxfidx;
 434         for (i = 0; i < priv->max_buckets_out; i++)
 435                 priv->mpt_rxfidx[++priv->mpt_rxfidx_tail] = i;
 436
 437 /**/    dlprintk((KERN_INFO MYNAM "/lo: txfidx contains - "));
 438 /**/    for (i = 0; i < priv->tx_max_out; i++)
 439 /**/            dlprintk((" %xh", priv->mpt_txfidx[i]));
 440 /**/    dlprintk(("\n"));
 441
 442         dlprintk((KERN_INFO MYNAM "/lo: Finished initializing RcvCtl\n"));
 443
 444         mpt_lan_post_receive_buckets(dev);
 445         printk(KERN_INFO MYNAM ": %s/%s: interface up & active\n",
 446                         IOC_AND_NETDEV_NAMES_s_s(dev));
 447
 448         if (mpt_event_register(LanCtx, mpt_lan_event_process) != 0) {
 449                 printk (KERN_WARNING MYNAM "/lo: Unable to register for Event"
 450                         " Notifications. This is a bad thing! We're not going "
 451                         "to go ahead, but I'd be leery of system stability at "
 452                         "this point.\n");
 453         }
 454
 455         netif_start_queue(dev);
 456         dlprintk((KERN_INFO MYNAM "/lo: Done.\n"));
 457
 458         return 0;
 459 out_mpt_rxfidx:
 460         kfree(priv->mpt_rxfidx);
 461         priv->mpt_rxfidx = NULL;
 462 out_SendCtl:
 463         kfree(priv->SendCtl);
 464         priv->SendCtl = NULL;
 465 out_mpt_txfidx:
 466         kfree(priv->mpt_txfidx);
 467         priv->mpt_txfidx = NULL;
 468 out:    return -ENOMEM;
 469 }
 470
 471 /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
 472 /* Send a LanReset message to the FW. This should result in the FW returning
 473    any buckets it still has. */
 474 static int
 475 mpt_lan_reset(struct net_device *dev)
 476 {
 477         MPT_FRAME_HDR *mf;
 478         LANResetRequest_t *pResetReq;
 479         struct mpt_lan_priv *priv = netdev_priv(dev);
 480
 481         mf = mpt_get_msg_frame(LanCtx, priv->mpt_dev);
 482
 483         if (mf == NULL) {
 484 /*              dlprintk((KERN_ERR MYNAM "/reset: Evil funkiness abounds! "
 485                 "Unable to allocate a request frame.\n"));
 486 */
 487                 return -1;
 488         }
 489
 490         pResetReq = (LANResetRequest_t *) mf;
 491
 492         pResetReq->Function     = MPI_FUNCTION_LAN_RESET;
 493         pResetReq->ChainOffset  = 0;
 494         pResetReq->Reserved     = 0;
 495         pResetReq->PortNumber   = priv->pnum;
 496         pResetReq->MsgFlags     = 0;
 497         pResetReq->Reserved2    = 0;
 498
 499         mpt_put_msg_frame(LanCtx, priv->mpt_dev, mf);
 500
 501         return 0;
 502 }
 503
 504 /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
 505 static int
 506 mpt_lan_close(struct net_device *dev)
 507 {
 508         struct mpt_lan_priv *priv = netdev_priv(dev);
 509         MPT_ADAPTER *mpt_dev = priv->mpt_dev;
 510         unsigned long timeout;
 511         int i;
 512
 513         dlprintk((KERN_INFO MYNAM ": mpt_lan_close called\n"));
 514
 515         mpt_event_deregister(LanCtx);
 516
 517         dlprintk((KERN_INFO MYNAM ":lan_close: Posted %d buckets "
 518                   "since driver was loaded, %d still out\n",
 519                   priv->total_posted,atomic_read(&priv->buckets_out)));
 520
 521         netif_stop_queue(dev);
 522
 523         mpt_lan_reset(dev);
 524
 525         timeout = jiffies + 2 * HZ;
 526         while (atomic_read(&priv->buckets_out) && time_before(jiffies, timeout))
 527                 schedule_timeout_interruptible(1);
 528
 529         for (i = 0; i < priv->max_buckets_out; i++) {
 530                 if (priv->RcvCtl[i].skb != NULL) {
 531 /**/                    dlprintk((KERN_INFO MYNAM "/lan_close: bucket %05x "
 532 /**/                              "is still out\n", i));
 533                         pci_unmap_single(mpt_dev->pcidev, priv->RcvCtl[i].dma,
 534                                          priv->RcvCtl[i].len,
 535                                          PCI_DMA_FROMDEVICE);
 536                         dev_kfree_skb(priv->RcvCtl[i].skb);
 537                 }
 538         }
 539
 540         kfree(priv->RcvCtl);
 541         kfree(priv->mpt_rxfidx);
 542
 543         for (i = 0; i < priv->tx_max_out; i++) {
 544                 if (priv->SendCtl[i].skb != NULL) {
 545                         pci_unmap_single(mpt_dev->pcidev, priv->SendCtl[i].dma,
 546                                          priv->SendCtl[i].len,
 547                                          PCI_DMA_TODEVICE);
 548                         dev_kfree_skb(priv->SendCtl[i].skb);
 549                 }
 550         }
 551
 552         kfree(priv->SendCtl);
 553         kfree(priv->mpt_txfidx);
 554
 555         atomic_set(&priv->buckets_out, 0);
 556
 557         printk(KERN_INFO MYNAM ": %s/%s: interface down & inactive\n",
 558                         IOC_AND_NETDEV_NAMES_s_s(dev));
 559
 560         return 0;
 561 }
 562
 563 /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
 564 static struct net_device_stats *
 565 mpt_lan_get_stats(struct net_device *dev)
 566 {
 567         struct mpt_lan_priv *priv = netdev_priv(dev);
 568
 569         return (struct net_device_stats *) &priv->stats;
 570 }
 571
 572 /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
 573 static int
 574 mpt_lan_change_mtu(struct net_device *dev, int new_mtu)
 575 {
 576         if ((new_mtu < MPT_LAN_MIN_MTU) || (new_mtu > MPT_LAN_MAX_MTU))
 577                 return -EINVAL;
 578         dev->mtu = new_mtu;
 579         return 0;
 580 }
 581
 582 /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
 583 /* Tx timeout handler. */
 584 static void
 585 mpt_lan_tx_timeout(struct net_device *dev)
 586 {
 587         struct mpt_lan_priv *priv = netdev_priv(dev);
 588         MPT_ADAPTER *mpt_dev = priv->mpt_dev;
 589
 590         if (mpt_dev->active) {
 591                 dlprintk (("mptlan/tx_timeout: calling netif_wake_queue for %s.\n", dev->name));
 592                 netif_wake_queue(dev);
 593         }
 594 }
 595
 596 /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
 597 //static inline int
 598 static int
 599 mpt_lan_send_turbo(struct net_device *dev, u32 tmsg)
 600 {
 601         struct mpt_lan_priv *priv = netdev_priv(dev);
 602         MPT_ADAPTER *mpt_dev = priv->mpt_dev;
 603         struct sk_buff *sent;
 604         unsigned long flags;
 605         u32 ctx;
 606
 607         ctx = GET_LAN_BUFFER_CONTEXT(tmsg);
 608         sent = priv->SendCtl[ctx].skb;
 609
 610         priv->stats.tx_packets++;
 611         priv->stats.tx_bytes += sent->len;
 612
 613         dioprintk((KERN_INFO MYNAM ": %s/%s: @%s, skb %p sent.\n",
 614                         IOC_AND_NETDEV_NAMES_s_s(dev),
 615                         __FUNCTION__, sent));
 616
 617         priv->SendCtl[ctx].skb = NULL;
 618         pci_unmap_single(mpt_dev->pcidev, priv->SendCtl[ctx].dma,
 619                          priv->SendCtl[ctx].len, PCI_DMA_TODEVICE);
 620         dev_kfree_skb_irq(sent);
 621
 622         spin_lock_irqsave(&priv->txfidx_lock, flags);
 623         priv->mpt_txfidx[++priv->mpt_txfidx_tail] = ctx;
 624         spin_unlock_irqrestore(&priv->txfidx_lock, flags);
 625
 626         netif_wake_queue(dev);
 627         return 0;
 628 }
 629
 630 /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
 631 static int
 632 mpt_lan_send_reply(struct net_device *dev, LANSendReply_t *pSendRep)
 633 {
 634         struct mpt_lan_priv *priv = netdev_priv(dev);
 635         MPT_ADAPTER *mpt_dev = priv->mpt_dev;
 636         struct sk_buff *sent;
 637         unsigned long flags;
 638         int FreeReqFrame = 0;
 639         u32 *pContext;
 640         u32 ctx;
 641         u8 count;
 642
 643         count = pSendRep->NumberOfContexts;
 644
 645         dioprintk((KERN_INFO MYNAM ": send_reply: IOCStatus: %04x\n",
 646                  le16_to_cpu(pSendRep->IOCStatus)));
 647
 648         /* Add check for Loginfo Flag in IOCStatus */
 649
 650         switch (le16_to_cpu(pSendRep->IOCStatus) & MPI_IOCSTATUS_MASK) {
 651         case MPI_IOCSTATUS_SUCCESS:
 652                 priv->stats.tx_packets += count;
 653                 break;
 654
 655         case MPI_IOCSTATUS_LAN_CANCELED:
 656         case MPI_IOCSTATUS_LAN_TRANSMIT_ABORTED:
 657                 break;
 658
 659         case MPI_IOCSTATUS_INVALID_SGL:
 660                 priv->stats.tx_errors += count;
 661                 printk (KERN_ERR MYNAM ": %s/%s: ERROR - Invalid SGL sent to IOC!\n",
 662                                 IOC_AND_NETDEV_NAMES_s_s(dev));
 663                 goto out;
 664
 665         default:
 666                 priv->stats.tx_errors += count;
 667                 break;
 668         }
 669
 670         pContext = &pSendRep->BufferContext;
 671
 672         spin_lock_irqsave(&priv->txfidx_lock, flags);
 673         while (count > 0) {
 674                 ctx = GET_LAN_BUFFER_CONTEXT(le32_to_cpu(*pContext));
 675
 676                 sent = priv->SendCtl[ctx].skb;
 677                 priv->stats.tx_bytes += sent->len;
 678
 679                 dioprintk((KERN_INFO MYNAM ": %s/%s: @%s, skb %p sent.\n",
 680                                 IOC_AND_NETDEV_NAMES_s_s(dev),
 681                                 __FUNCTION__, sent));
 682
 683                 priv->SendCtl[ctx].skb = NULL;
 684                 pci_unmap_single(mpt_dev->pcidev, priv->SendCtl[ctx].dma,
 685                                  priv->SendCtl[ctx].len, PCI_DMA_TODEVICE);
 686                 dev_kfree_skb_irq(sent);
 687
 688                 priv->mpt_txfidx[++priv->mpt_txfidx_tail] = ctx;
 689
 690                 pContext++;
 691                 count--;
 692         }
 693         spin_unlock_irqrestore(&priv->txfidx_lock, flags);
 694
 695 out:
 696         if (!(pSendRep->MsgFlags & MPI_MSGFLAGS_CONTINUATION_REPLY))
 697                 FreeReqFrame = 1;
 698
 699         netif_wake_queue(dev);
 700         return FreeReqFrame;
 701 }
 702
 703 /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
 704 static int
 705 mpt_lan_sdu_send (struct sk_buff *skb, struct net_device *dev)
 706 {
 707         struct mpt_lan_priv *priv = netdev_priv(dev);
 708         MPT_ADAPTER *mpt_dev = priv->mpt_dev;
 709         MPT_FRAME_HDR *mf;
 710         LANSendRequest_t *pSendReq;
 711         SGETransaction32_t *pTrans;
 712         SGESimple64_t *pSimple;
 713         dma_addr_t dma;
 714         unsigned long flags;
 715         int ctx;
 716         u16 cur_naa = 0x1000;
 717
 718         dioprintk((KERN_INFO MYNAM ": %s called, skb_addr = %p\n",
 719                         __FUNCTION__, skb));
 720
 721         spin_lock_irqsave(&priv->txfidx_lock, flags);
 722         if (priv->mpt_txfidx_tail < 0) {
 723                 netif_stop_queue(dev);
 724                 spin_unlock_irqrestore(&priv->txfidx_lock, flags);
 725
 726                 printk (KERN_ERR "%s: no tx context available: %u\n",
 727                         __FUNCTION__, priv->mpt_txfidx_tail);
 728                 return 1;
 729         }
 730
 731         mf = mpt_get_msg_frame(LanCtx, mpt_dev);
 732         if (mf == NULL) {
 733                 netif_stop_queue(dev);
 734                 spin_unlock_irqrestore(&priv->txfidx_lock, flags);
 735
 736                 printk (KERN_ERR "%s: Unable to alloc request frame\n",
 737                         __FUNCTION__);
 738                 return 1;
 739         }
 740
 741         ctx = priv->mpt_txfidx[priv->mpt_txfidx_tail--];
 742         spin_unlock_irqrestore(&priv->txfidx_lock, flags);
 743
 744 //      dioprintk((KERN_INFO MYNAM ": %s/%s: Creating new msg frame (send).\n",
 745 //                      IOC_AND_NETDEV_NAMES_s_s(dev)));
 746
 747         pSendReq = (LANSendRequest_t *) mf;
 748
 749         /* Set the mac.raw pointer, since this apparently isn't getting
 750          * done before we get the skb. Pull the data pointer past the mac data.
 751          */
 752         skb->mac.raw = skb->data;
 753         skb_pull(skb, 12);
 754
 755         dma = pci_map_single(mpt_dev->pcidev, skb->data, skb->len,
 756                              PCI_DMA_TODEVICE);
 757
 758         priv->SendCtl[ctx].skb = skb;
 759         priv->SendCtl[ctx].dma = dma;
 760         priv->SendCtl[ctx].len = skb->len;
 761
 762         /* Message Header */
 763         pSendReq->Reserved    = 0;
 764         pSendReq->Function    = MPI_FUNCTION_LAN_SEND;
 765         pSendReq->ChainOffset = 0;
 766         pSendReq->Reserved2   = 0;
 767         pSendReq->MsgFlags    = 0;
 768         pSendReq->PortNumber  = priv->pnum;
 769
 770         /* Transaction Context Element */
 771         pTrans = (SGETransaction32_t *) pSendReq->SG_List;
 772
 773         /* No Flags, 8 bytes of Details, 32bit Context (bloody turbo replies) */
 774         pTrans->ContextSize   = sizeof(u32);
 775         pTrans->DetailsLength = 2 * sizeof(u32);
 776         pTrans->Flags         = 0;
 777         pTrans->TransactionContext[0] = cpu_to_le32(ctx);
 778
 779 //      dioprintk((KERN_INFO MYNAM ": %s/%s: BC = %08x, skb = %p, buff = %p\n",
 780 //                      IOC_AND_NETDEV_NAMES_s_s(dev),
 781 //                      ctx, skb, skb->data));
 782
 783 #ifdef QLOGIC_NAA_WORKAROUND
 784 {
 785         struct NAA_Hosed *nh;
 786
 787         /* Munge the NAA for Tx packets to QLogic boards, which don't follow
 788            RFC 2625. The longer I look at this, the more my opinion of Qlogic
 789            drops. */
 790         read_lock_irq(&bad_naa_lock);
 791         for (nh = mpt_bad_naa; nh != NULL; nh=nh->next) {
 792                 if ((nh->ieee[0] == skb->mac.raw[0]) &&
 793                     (nh->ieee[1] == skb->mac.raw[1]) &&
 794                     (nh->ieee[2] == skb->mac.raw[2]) &&
 795                     (nh->ieee[3] == skb->mac.raw[3]) &&
 796                     (nh->ieee[4] == skb->mac.raw[4]) &&
 797                     (nh->ieee[5] == skb->mac.raw[5])) {
 798                         cur_naa = nh->NAA;
 799                         dlprintk ((KERN_INFO "mptlan/sdu_send: using NAA value "
 800                                   "= %04x.\n", cur_naa));
 801                         break;
 802                 }
 803         }
 804         read_unlock_irq(&bad_naa_lock);
 805 }
 806 #endif
 807
 808         pTrans->TransactionDetails[0] = cpu_to_le32((cur_naa         << 16) |
 809                                                     (skb->mac.raw[0] <<  8) |
 810                                                     (skb->mac.raw[1] <<  0));
 811         pTrans->TransactionDetails[1] = cpu_to_le32((skb->mac.raw[2] << 24) |
 812                                                     (skb->mac.raw[3] << 16) |
 813                                                     (skb->mac.raw[4] <<  8) |
 814                                                     (skb->mac.raw[5] <<  0));
 815
 816         pSimple = (SGESimple64_t *) &pTrans->TransactionDetails[2];
 817
 818         /* If we ever decide to send more than one Simple SGE per LANSend, then
 819            we will need to make sure that LAST_ELEMENT only gets set on the
 820            last one. Otherwise, bad voodoo and evil funkiness will commence. */
 821         pSimple->FlagsLength = cpu_to_le32(
 822                         ((MPI_SGE_FLAGS_LAST_ELEMENT |
 823                           MPI_SGE_FLAGS_END_OF_BUFFER |
 824                           MPI_SGE_FLAGS_SIMPLE_ELEMENT |
 825                           MPI_SGE_FLAGS_SYSTEM_ADDRESS |
 826                           MPI_SGE_FLAGS_HOST_TO_IOC |
 827                           MPI_SGE_FLAGS_64_BIT_ADDRESSING |
 828                           MPI_SGE_FLAGS_END_OF_LIST) << MPI_SGE_FLAGS_SHIFT) |
 829                         skb->len);
 830         pSimple->Address.Low = cpu_to_le32((u32) dma);
 831         if (sizeof(dma_addr_t) > sizeof(u32))
 832                 pSimple->Address.High = cpu_to_le32((u32) ((u64) dma >> 32));
 833         else
 834                 pSimple->Address.High = 0;
 835
 836         mpt_put_msg_frame (LanCtx, mpt_dev, mf);
 837         dev->trans_start = jiffies;
 838
 839         dioprintk((KERN_INFO MYNAM ": %s/%s: Sending packet. FlagsLength = %08x.\n",
 840                         IOC_AND_NETDEV_NAMES_s_s(dev),
 841                         le32_to_cpu(pSimple->FlagsLength)));
 842
 843         return 0;
 844 }
 845
 846 /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
 847 static void
 848 mpt_lan_wake_post_buckets_task(struct net_device *dev, int priority)
 849 /*
 850  * @priority: 0 = put it on the timer queue, 1 = put it on the immediate queue
 851  */
 852 {
 853         struct mpt_lan_priv *priv = dev->priv;
 854
 855         if (test_and_set_bit(0, &priv->post_buckets_active) == 0) {
 856                 if (priority) {
 857                         schedule_work(&priv->post_buckets_task);
 858                 } else {
 859                         schedule_delayed_work(&priv->post_buckets_task, 1);
 860                         dioprintk((KERN_INFO MYNAM ": post_buckets queued on "
 861                                    "timer.\n"));
 862                 }
 863                 dioprintk((KERN_INFO MYNAM ": %s/%s: Queued post_buckets task.\n",
 864                            IOC_AND_NETDEV_NAMES_s_s(dev) ));
 865         }
 866 }
 867
 868 /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
 869 static int
 870 mpt_lan_receive_skb(struct net_device *dev, struct sk_buff *skb)
 871 {
 872         struct mpt_lan_priv *priv = dev->priv;
 873
 874         skb->protocol = mpt_lan_type_trans(skb, dev);
 875
 876         dioprintk((KERN_INFO MYNAM ": %s/%s: Incoming packet (%d bytes) "
 877                  "delivered to upper level.\n",
 878                         IOC_AND_NETDEV_NAMES_s_s(dev), skb->len));
 879
 880         priv->stats.rx_bytes += skb->len;
 881         priv->stats.rx_packets++;
 882
 883         skb->dev = dev;
 884         netif_rx(skb);
 885
 886         dioprintk((MYNAM "/receive_skb: %d buckets remaining\n",
 887                  atomic_read(&priv->buckets_out)));
 888
 889         if (atomic_read(&priv->buckets_out) < priv->bucketthresh)
 890                 mpt_lan_wake_post_buckets_task(dev, 1);
 891
 892         dioprintk((KERN_INFO MYNAM "/receive_post_reply: %d buckets "
 893                   "remaining, %d received back since sod\n",
 894                   atomic_read(&priv->buckets_out), priv->total_received));
 895
 896         return 0;
 897 }
 898
 899 /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
 900 //static inline int
 901 static int
 902 mpt_lan_receive_post_turbo(struct net_device *dev, u32 tmsg)
 903 {
 904         struct mpt_lan_priv *priv = dev->priv;
 905         MPT_ADAPTER *mpt_dev = priv->mpt_dev;
 906         struct sk_buff *skb, *old_skb;
 907         unsigned long flags;
 908         u32 ctx, len;
 909
 910         ctx = GET_LAN_BUCKET_CONTEXT(tmsg);
 911         skb = priv->RcvCtl[ctx].skb;
 912
 913         len = GET_LAN_PACKET_LENGTH(tmsg);
 914
 915         if (len < MPT_LAN_RX_COPYBREAK) {
 916                 old_skb = skb;
 917
 918                 skb = (struct sk_buff *)dev_alloc_skb(len);
 919                 if (!skb) {
 920                         printk (KERN_ERR MYNAM ": %s/%s: ERROR - Can't allocate skb! (%s@%d)\n",
 921                                         IOC_AND_NETDEV_NAMES_s_s(dev),
 922                                         __FILE__, __LINE__);
 923                         return -ENOMEM;
 924                 }
 925
 926                 pci_dma_sync_single_for_cpu(mpt_dev->pcidev, priv->RcvCtl[ctx].dma,
 927                                             priv->RcvCtl[ctx].len, PCI_DMA_FROMDEVICE);
 928
 929                 memcpy(skb_put(skb, len), old_skb->data, len);
 930
 931                 pci_dma_sync_single_for_device(mpt_dev->pcidev, priv->RcvCtl[ctx].dma,
 932                                                priv->RcvCtl[ctx].len, PCI_DMA_FROMDEVICE);
 933                 goto out;
 934         }
 935
 936         skb_put(skb, len);
 937
 938         priv->RcvCtl[ctx].skb = NULL;
 939
 940         pci_unmap_single(mpt_dev->pcidev, priv->RcvCtl[ctx].dma,
 941                          priv->RcvCtl[ctx].len, PCI_DMA_FROMDEVICE);
 942
 943 out:
 944         spin_lock_irqsave(&priv->rxfidx_lock, flags);
 945         priv->mpt_rxfidx[++priv->mpt_rxfidx_tail] = ctx;
 946         spin_unlock_irqrestore(&priv->rxfidx_lock, flags);
 947
 948         atomic_dec(&priv->buckets_out);
 949         priv->total_received++;
 950
 951         return mpt_lan_receive_skb(dev, skb);
 952 }
 953
 954 /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
 955 static int
 956 mpt_lan_receive_post_free(struct net_device *dev,
 957                           LANReceivePostReply_t *pRecvRep)
 958 {
 959         struct mpt_lan_priv *priv = dev->priv;
 960         MPT_ADAPTER *mpt_dev = priv->mpt_dev;
 961         unsigned long flags;
 962         struct sk_buff *skb;
 963         u32 ctx;
 964         int count;
 965         int i;
 966
 967         count = pRecvRep->NumberOfContexts;
 968
 969 /**/    dlprintk((KERN_INFO MYNAM "/receive_post_reply: "
 970                   "IOC returned %d buckets, freeing them...\n", count));
 971
 972         spin_lock_irqsave(&priv->rxfidx_lock, flags);
 973         for (i = 0; i < count; i++) {
 974                 ctx = le32_to_cpu(pRecvRep->BucketContext[i]);
 975
 976                 skb = priv->RcvCtl[ctx].skb;
 977
 978 //              dlprintk((KERN_INFO MYNAM ": %s: dev_name = %s\n",
 979 //                              IOC_AND_NETDEV_NAMES_s_s(dev)));
 980 //              dlprintk((KERN_INFO MYNAM "@rpr[2], priv = %p, buckets_out addr = %p",
 981 //                              priv, &(priv->buckets_out)));
 982 //              dlprintk((KERN_INFO MYNAM "@rpr[2] TC + 3\n"));
 983
 984                 priv->RcvCtl[ctx].skb = NULL;
 985                 pci_unmap_single(mpt_dev->pcidev, priv->RcvCtl[ctx].dma,
 986                                  priv->RcvCtl[ctx].len, PCI_DMA_FROMDEVICE);
 987                 dev_kfree_skb_any(skb);
 988
 989                 priv->mpt_rxfidx[++priv->mpt_rxfidx_tail] = ctx;
 990         }
 991         spin_unlock_irqrestore(&priv->rxfidx_lock, flags);
 992
 993         atomic_sub(count, &priv->buckets_out);
 994
 995 //      for (i = 0; i < priv->max_buckets_out; i++)
 996 //              if (priv->RcvCtl[i].skb != NULL)
 997 //                      dlprintk((KERN_INFO MYNAM "@rpr: bucket %03x "
 998 //                                "is still out\n", i));
 999
1000 /*      dlprintk((KERN_INFO MYNAM "/receive_post_reply: freed %d buckets\n",
1001                   count));
1002 */
1003 /**/    dlprintk((KERN_INFO MYNAM "@receive_post_reply: %d buckets "
1004 /**/              "remaining, %d received back since sod.\n",
1005 /**/              atomic_read(&priv->buckets_out), priv->total_received));
1006         return 0;
1007 }
1008
1009 /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
1010 static int
1011 mpt_lan_receive_post_reply(struct net_device *dev,
1012                            LANReceivePostReply_t *pRecvRep)
1013 {
1014         struct mpt_lan_priv *priv = dev->priv;
1015         MPT_ADAPTER *mpt_dev = priv->mpt_dev;
1016         struct sk_buff *skb, *old_skb;
1017         unsigned long flags;
1018         u32 len, ctx, offset;
1019         u32 remaining = le32_to_cpu(pRecvRep->BucketsRemaining);
1020         int count;
1021         int i, l;
1022
1023         dioprintk((KERN_INFO MYNAM ": mpt_lan_receive_post_reply called\n"));
1024         dioprintk((KERN_INFO MYNAM ": receive_post_reply: IOCStatus: %04x\n",
1025                  le16_to_cpu(pRecvRep->IOCStatus)));
1026
1027         if ((le16_to_cpu(pRecvRep->IOCStatus) & MPI_IOCSTATUS_MASK) ==
1028                                                 MPI_IOCSTATUS_LAN_CANCELED)
1029                 return mpt_lan_receive_post_free(dev, pRecvRep);
1030
1031         len = le32_to_cpu(pRecvRep->PacketLength);
1032         if (len == 0) {
1033                 printk (KERN_ERR MYNAM ": %s/%s: ERROR - Got a non-TURBO "
1034                         "ReceivePostReply w/ PacketLength zero!\n",
1035                                 IOC_AND_NETDEV_NAMES_s_s(dev));
1036                 printk (KERN_ERR MYNAM ": MsgFlags = %02x, IOCStatus = %04x\n",
1037                                 pRecvRep->MsgFlags, le16_to_cpu(pRecvRep->IOCStatus));
1038                 return -1;
1039         }
1040
1041         ctx    = le32_to_cpu(pRecvRep->BucketContext[0]);
1042         count  = pRecvRep->NumberOfContexts;
1043         skb    = priv->RcvCtl[ctx].skb;
1044
1045         offset = le32_to_cpu(pRecvRep->PacketOffset);
1046 //      if (offset != 0) {
1047 //              printk (KERN_INFO MYNAM ": %s/%s: Got a ReceivePostReply "
1048 //                      "w/ PacketOffset %u\n",
1049 //                              IOC_AND_NETDEV_NAMES_s_s(dev),
1050 //                              offset);
1051 //      }
1052
1053         dioprintk((KERN_INFO MYNAM ": %s/%s: @rpr, offset = %d, len = %d\n",
1054                         IOC_AND_NETDEV_NAMES_s_s(dev),
1055                         offset, len));
1056
1057         if (count > 1) {
1058                 int szrem = len;
1059
1060 //              dioprintk((KERN_INFO MYNAM ": %s/%s: Multiple buckets returned "
1061 //                      "for single packet, concatenating...\n",
1062 //                              IOC_AND_NETDEV_NAMES_s_s(dev)));
1063
1064                 skb = (struct sk_buff *)dev_alloc_skb(len);
1065                 if (!skb) {
1066                         printk (KERN_ERR MYNAM ": %s/%s: ERROR - Can't allocate skb! (%s@%d)\n",
1067                                         IOC_AND_NETDEV_NAMES_s_s(dev),
1068                                         __FILE__, __LINE__);
1069                         return -ENOMEM;
1070                 }
1071
1072                 spin_lock_irqsave(&priv->rxfidx_lock, flags);
1073                 for (i = 0; i < count; i++) {
1074
1075                         ctx = le32_to_cpu(pRecvRep->BucketContext[i]);
1076                         old_skb = priv->RcvCtl[ctx].skb;
1077
1078                         l = priv->RcvCtl[ctx].len;
1079                         if (szrem < l)
1080                                 l = szrem;
1081
1082 //                      dioprintk((KERN_INFO MYNAM ": %s/%s: Buckets = %d, len = %u\n",
1083 //                                      IOC_AND_NETDEV_NAMES_s_s(dev),
1084 //                                      i, l));
1085
1086                         pci_dma_sync_single_for_cpu(mpt_dev->pcidev,
1087                                                     priv->RcvCtl[ctx].dma,
1088                                                     priv->RcvCtl[ctx].len,
1089                                                     PCI_DMA_FROMDEVICE);
1090                         memcpy(skb_put(skb, l), old_skb->data, l);
1091
1092                         pci_dma_sync_single_for_device(mpt_dev->pcidev,
1093                                                        priv->RcvCtl[ctx].dma,
1094                                                        priv->RcvCtl[ctx].len,
1095                                                        PCI_DMA_FROMDEVICE);
1096
1097                         priv->mpt_rxfidx[++priv->mpt_rxfidx_tail] = ctx;
1098                         szrem -= l;
1099                 }
1100                 spin_unlock_irqrestore(&priv->rxfidx_lock, flags);
1101
1102         } else if (len < MPT_LAN_RX_COPYBREAK) {
1103
1104                 old_skb = skb;
1105
1106                 skb = (struct sk_buff *)dev_alloc_skb(len);
1107                 if (!skb) {
1108                         printk (KERN_ERR MYNAM ": %s/%s: ERROR - Can't allocate skb! (%s@%d)\n",
1109                                         IOC_AND_NETDEV_NAMES_s_s(dev),
1110                                         __FILE__, __LINE__);
1111                         return -ENOMEM;
1112                 }
1113
1114                 pci_dma_sync_single_for_cpu(mpt_dev->pcidev,
1115                                             priv->RcvCtl[ctx].dma,
1116                                             priv->RcvCtl[ctx].len,
1117                                             PCI_DMA_FROMDEVICE);
1118
1119                 memcpy(skb_put(skb, len), old_skb->data, len);
1120
1121                 pci_dma_sync_single_for_device(mpt_dev->pcidev,
1122                                                priv->RcvCtl[ctx].dma,
1123                                                priv->RcvCtl[ctx].len,
1124                                                PCI_DMA_FROMDEVICE);
1125
1126                 spin_lock_irqsave(&priv->rxfidx_lock, flags);
1127                 priv->mpt_rxfidx[++priv->mpt_rxfidx_tail] = ctx;
1128                 spin_unlock_irqrestore(&priv->rxfidx_lock, flags);
1129
1130         } else {
1131                 spin_lock_irqsave(&priv->rxfidx_lock, flags);
1132
1133                 priv->RcvCtl[ctx].skb = NULL;
1134
1135                 pci_unmap_single(mpt_dev->pcidev, priv->RcvCtl[ctx].dma,
1136                                  priv->RcvCtl[ctx].len, PCI_DMA_FROMDEVICE);
1137                 priv->RcvCtl[ctx].dma = 0;
1138
1139                 priv->mpt_rxfidx[++priv->mpt_rxfidx_tail] = ctx;
1140                 spin_unlock_irqrestore(&priv->rxfidx_lock, flags);
1141
1142                 skb_put(skb,len);
1143         }
1144
1145         atomic_sub(count, &priv->buckets_out);
1146         priv->total_received += count;
1147
1148         if (priv->mpt_rxfidx_tail >= MPT_LAN_MAX_BUCKETS_OUT) {
1149                 printk (KERN_ERR MYNAM ": %s/%s: Yoohoo! mpt_rxfidx_tail = %d, "
1150                         "MPT_LAN_MAX_BUCKETS_OUT = %d\n",
1151                                 IOC_AND_NETDEV_NAMES_s_s(dev),
1152                                 priv->mpt_rxfidx_tail,
1153                                 MPT_LAN_MAX_BUCKETS_OUT);
1154
1155                 return -1;
1156         }
1157
1158         if (remaining == 0)
1159                 printk (KERN_WARNING MYNAM ": %s/%s: WARNING - IOC out of buckets! "
1160                         "(priv->buckets_out = %d)\n",
1161                         IOC_AND_NETDEV_NAMES_s_s(dev),
1162                         atomic_read(&priv->buckets_out));
1163         else if (remaining < 10)
1164                 printk (KERN_INFO MYNAM ": %s/%s: IOC says %d buckets left. "
1165                         "(priv->buckets_out = %d)\n",
1166                         IOC_AND_NETDEV_NAMES_s_s(dev),
1167                         remaining, atomic_read(&priv->buckets_out));
1168
1169         if ((remaining < priv->bucketthresh) &&
1170             ((atomic_read(&priv->buckets_out) - remaining) >
1171              MPT_LAN_BUCKETS_REMAIN_MISMATCH_THRESH)) {
1172
1173                 printk (KERN_WARNING MYNAM " Mismatch between driver's "
1174                         "buckets_out count and fw's BucketsRemaining "
1175                         "count has crossed the threshold, issuing a "
1176                         "LanReset to clear the fw's hashtable. You may "
1177                         "want to check your /var/log/messages for \"CRC "
1178                         "error\" event notifications.\n");
1179
1180                 mpt_lan_reset(dev);
1181                 mpt_lan_wake_post_buckets_task(dev, 0);
1182         }
1183
1184         return mpt_lan_receive_skb(dev, skb);
1185 }
1186
1187 /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
1188 /* Simple SGE's only at the moment */
1189
1190 static void
1191 mpt_lan_post_receive_buckets(void *dev_id)
1192 {
1193         struct net_device *dev = dev_id;
1194         struct mpt_lan_priv *priv = dev->priv;
1195         MPT_ADAPTER *mpt_dev = priv->mpt_dev;
1196         MPT_FRAME_HDR *mf;
1197         LANReceivePostRequest_t *pRecvReq;
1198         SGETransaction32_t *pTrans;
1199         SGESimple64_t *pSimple;
1200         struct sk_buff *skb;
1201         dma_addr_t dma;
1202         u32 curr, buckets, count, max;
1203         u32 len = (dev->mtu + dev->hard_header_len + 4);
1204         unsigned long flags;
1205         int i;
1206
1207         curr = atomic_read(&priv->buckets_out);
1208         buckets = (priv->max_buckets_out - curr);
1209
1210         dioprintk((KERN_INFO MYNAM ": %s/%s: @%s, Start_buckets = %u, buckets_out = %u\n",
1211                         IOC_AND_NETDEV_NAMES_s_s(dev),
1212                         __FUNCTION__, buckets, curr));
1213
1214         max = (mpt_dev->req_sz - MPT_LAN_RECEIVE_POST_REQUEST_SIZE) /
1215                         (MPT_LAN_TRANSACTION32_SIZE + sizeof(SGESimple64_t));
1216
1217         while (buckets) {
1218                 mf = mpt_get_msg_frame(LanCtx, mpt_dev);
1219                 if (mf == NULL) {
1220                         printk (KERN_ERR "%s: Unable to alloc request frame\n",
1221                                 __FUNCTION__);
1222                         dioprintk((KERN_ERR "%s: %u buckets remaining\n",
1223                                  __FUNCTION__, buckets));
1224                         goto out;
1225                 }
1226                 pRecvReq = (LANReceivePostRequest_t *) mf;
1227
1228                 count = buckets;
1229                 if (count > max)
1230                         count = max;
1231
1232                 pRecvReq->Function    = MPI_FUNCTION_LAN_RECEIVE;
1233                 pRecvReq->ChainOffset = 0;
1234                 pRecvReq->MsgFlags    = 0;
1235                 pRecvReq->PortNumber  = priv->pnum;
1236
1237                 pTrans = (SGETransaction32_t *) pRecvReq->SG_List;
1238                 pSimple = NULL;
1239
1240                 for (i = 0; i < count; i++) {
1241                         int ctx;
1242
1243                         spin_lock_irqsave(&priv->rxfidx_lock, flags);
1244                         if (priv->mpt_rxfidx_tail < 0) {
1245                                 printk (KERN_ERR "%s: Can't alloc context\n",
1246                                         __FUNCTION__);
1247                                 spin_unlock_irqrestore(&priv->rxfidx_lock,
1248                                                        flags);
1249                                 break;
1250                         }
1251
1252                         ctx = priv->mpt_rxfidx[priv->mpt_rxfidx_tail--];
1253
1254                         skb = priv->RcvCtl[ctx].skb;
1255                         if (skb && (priv->RcvCtl[ctx].len != len)) {
1256                                 pci_unmap_single(mpt_dev->pcidev,
1257                                                  priv->RcvCtl[ctx].dma,
1258                                                  priv->RcvCtl[ctx].len,
1259                                                  PCI_DMA_FROMDEVICE);
1260                                 dev_kfree_skb(priv->RcvCtl[ctx].skb);
1261                                 skb = priv->RcvCtl[ctx].skb = NULL;
1262                         }
1263
1264                         if (skb == NULL) {
1265                                 skb = dev_alloc_skb(len);
1266                                 if (skb == NULL) {
1267                                         printk (KERN_WARNING
1268                                                 MYNAM "/%s: Can't alloc skb\n",
1269                                                 __FUNCTION__);
1270                                         priv->mpt_rxfidx[++priv->mpt_rxfidx_tail] = ctx;
1271                                         spin_unlock_irqrestore(&priv->rxfidx_lock, flags);
1272                                         break;
1273                                 }
1274
1275                                 dma = pci_map_single(mpt_dev->pcidev, skb->data,
1276                                                      len, PCI_DMA_FROMDEVICE);
1277
1278                                 priv->RcvCtl[ctx].skb = skb;
1279                                 priv->RcvCtl[ctx].dma = dma;
1280                                 priv->RcvCtl[ctx].len = len;
1281                         }
1282
1283                         spin_unlock_irqrestore(&priv->rxfidx_lock, flags);
1284
1285                         pTrans->ContextSize   = sizeof(u32);
1286                         pTrans->DetailsLength = 0;
1287                         pTrans->Flags         = 0;
1288                         pTrans->TransactionContext[0] = cpu_to_le32(ctx);
1289
1290                         pSimple = (SGESimple64_t *) pTrans->TransactionDetails;
1291
1292                         pSimple->FlagsLength = cpu_to_le32(
1293                                 ((MPI_SGE_FLAGS_END_OF_BUFFER |
1294                                   MPI_SGE_FLAGS_SIMPLE_ELEMENT |
1295                                   MPI_SGE_FLAGS_64_BIT_ADDRESSING) << MPI_SGE_FLAGS_SHIFT) | len);
1296                         pSimple->Address.Low = cpu_to_le32((u32) priv->RcvCtl[ctx].dma);
1297                         if (sizeof(dma_addr_t) > sizeof(u32))
1298                                 pSimple->Address.High = cpu_to_le32((u32) ((u64) priv->RcvCtl[ctx].dma >> 32));
1299                         else
1300                                 pSimple->Address.High = 0;
1301
1302                         pTrans = (SGETransaction32_t *) (pSimple + 1);
1303                 }
1304
1305                 if (pSimple == NULL) {
1306 /**/                    printk (KERN_WARNING MYNAM "/%s: No buckets posted\n",
1307 /**/                            __FUNCTION__);
1308                         mpt_free_msg_frame(mpt_dev, mf);
1309                         goto out;
1310                 }
1311
1312                 pSimple->FlagsLength |= cpu_to_le32(MPI_SGE_FLAGS_END_OF_LIST << MPI_SGE_FLAGS_SHIFT);
1313
1314                 pRecvReq->BucketCount = cpu_to_le32(i);
1315
1316 /*      printk(KERN_INFO MYNAM ": posting buckets\n   ");
1317  *      for (i = 0; i < j + 2; i ++)
1318  *          printk (" %08x", le32_to_cpu(msg[i]));
1319  *      printk ("\n");
1320  */
1321
1322                 mpt_put_msg_frame(LanCtx, mpt_dev, mf);
1323
1324                 priv->total_posted += i;
1325                 buckets -= i;
1326                 atomic_add(i, &priv->buckets_out);
1327         }
1328
1329 out:
1330         dioprintk((KERN_INFO MYNAM "/%s: End_buckets = %u, priv->buckets_out = %u\n",
1331                   __FUNCTION__, buckets, atomic_read(&priv->buckets_out)));
1332         dioprintk((KERN_INFO MYNAM "/%s: Posted %u buckets and received %u back\n",
1333         __FUNCTION__, priv->total_posted, priv->total_received));
1334
1335         clear_bit(0, &priv->post_buckets_active);
1336 }
1337
1338 /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
1339 static struct net_device *
1340 mpt_register_lan_device (MPT_ADAPTER *mpt_dev, int pnum)
1341 {
1342         struct net_device *dev = alloc_fcdev(sizeof(struct mpt_lan_priv));
1343         struct mpt_lan_priv *priv = NULL;
1344         u8 HWaddr[FC_ALEN], *a;
1345
1346         if (!dev)
1347                 return NULL;
1348
1349         dev->mtu = MPT_LAN_MTU;
1350
1351         priv = netdev_priv(dev);
1352
1353         priv->mpt_dev = mpt_dev;
1354         priv->pnum = pnum;
1355
1356         memset(&priv->post_buckets_task, 0, sizeof(struct work_struct));
1357         INIT_WORK(&priv->post_buckets_task, mpt_lan_post_receive_buckets, dev);
1358         priv->post_buckets_active = 0;
1359
1360         dlprintk((KERN_INFO MYNAM "@%d: bucketlen = %d\n",
1361                         __LINE__, dev->mtu + dev->hard_header_len + 4));
1362
1363         atomic_set(&priv->buckets_out, 0);
1364         priv->total_posted = 0;
1365         priv->total_received = 0;
1366         priv->max_buckets_out = max_buckets_out;
1367         if (mpt_dev->pfacts[0].MaxLanBuckets < max_buckets_out)
1368                 priv->max_buckets_out = mpt_dev->pfacts[0].MaxLanBuckets;
1369
1370         dlprintk((KERN_INFO MYNAM "@%d: MaxLanBuckets=%d, max_buckets_out/priv=%d/%d\n",
1371                         __LINE__,
1372                         mpt_dev->pfacts[0].MaxLanBuckets,
1373                         max_buckets_out,
1374                         priv->max_buckets_out));
1375
1376         priv->bucketthresh = priv->max_buckets_out * 2 / 3;
1377         spin_lock_init(&priv->txfidx_lock);
1378         spin_lock_init(&priv->rxfidx_lock);
1379
1380         memset(&priv->stats, 0, sizeof(priv->stats));
1381
1382         /*  Grab pre-fetched LANPage1 stuff. :-) */
1383         a = (u8 *) &mpt_dev->lan_cnfg_page1.HardwareAddressLow;
1384
1385         HWaddr[0] = a[5];
1386         HWaddr[1] = a[4];
1387         HWaddr[2] = a[3];
1388         HWaddr[3] = a[2];
1389         HWaddr[4] = a[1];
1390         HWaddr[5] = a[0];
1391
1392         dev->addr_len = FC_ALEN;
1393         memcpy(dev->dev_addr, HWaddr, FC_ALEN);
1394         memset(dev->broadcast, 0xff, FC_ALEN);
1395
1396         /* The Tx queue is 127 deep on the 909.
1397          * Give ourselves some breathing room.
1398          */
1399         priv->tx_max_out = (tx_max_out_p <= MPT_TX_MAX_OUT_LIM) ?
1400                             tx_max_out_p : MPT_TX_MAX_OUT_LIM;
1401
1402         dev->open = mpt_lan_open;
1403         dev->stop = mpt_lan_close;
1404         dev->get_stats = mpt_lan_get_stats;
1405         dev->set_multicast_list = NULL;
1406         dev->change_mtu = mpt_lan_change_mtu;
1407         dev->hard_start_xmit = mpt_lan_sdu_send;
1408
1409 /* Not in 2.3.42. Need 2.3.45+ */
1410         dev->tx_timeout = mpt_lan_tx_timeout;
1411         dev->watchdog_timeo = MPT_LAN_TX_TIMEOUT;
1412
1413         dlprintk((KERN_INFO MYNAM ": Finished registering dev "
1414                 "and setting initial values\n"));
1415
1416         SET_MODULE_OWNER(dev);
1417
1418         if (register_netdev(dev) != 0) {
1419                 free_netdev(dev);
1420                 dev = NULL;
1421         }
1422         return dev;
1423 }
1424
1425 static int
1426 mptlan_probe(struct pci_dev *pdev, const struct pci_device_id *id)
1427 {
1428         MPT_ADAPTER             *ioc = pci_get_drvdata(pdev);
1429         struct net_device       *dev;
1430         int                     i;
1431
1432         for (i = 0; i < ioc->facts.NumberOfPorts; i++) {
1433                 printk(KERN_INFO MYNAM ": %s: PortNum=%x, "
1434                        "ProtocolFlags=%02Xh (%c%c%c%c)\n",
1435                        ioc->name, ioc->pfacts[i].PortNumber,
1436                        ioc->pfacts[i].ProtocolFlags,
1437                        MPT_PROTOCOL_FLAGS_c_c_c_c(
1438                                ioc->pfacts[i].ProtocolFlags));
1439
1440                 if (!(ioc->pfacts[i].ProtocolFlags &
1441                                         MPI_PORTFACTS_PROTOCOL_LAN)) {
1442                         printk(KERN_INFO MYNAM ": %s: Hmmm... LAN protocol "
1443                                "seems to be disabled on this adapter port!\n",
1444                                ioc->name);
1445                         continue;
1446                 }
1447
1448                 dev = mpt_register_lan_device(ioc, i);
1449                 if (!dev) {
1450                         printk(KERN_ERR MYNAM ": %s: Unable to register "
1451                                "port%d as a LAN device\n", ioc->name,
1452                                ioc->pfacts[i].PortNumber);
1453                         continue;
1454                 }
1455
1456                 printk(KERN_INFO MYNAM ": %s: Fusion MPT LAN device "
1457                        "registered as '%s'\n", ioc->name, dev->name);
1458                 printk(KERN_INFO MYNAM ": %s/%s: "
1459                        "LanAddr = %02X:%02X:%02X:%02X:%02X:%02X\n",
1460                        IOC_AND_NETDEV_NAMES_s_s(dev),
1461                        dev->dev_addr[0], dev->dev_addr[1],
1462                        dev->dev_addr[2], dev->dev_addr[3],
1463                        dev->dev_addr[4], dev->dev_addr[5]);
1464
1465                 ioc->netdev = dev;
1466
1467                 return 0;
1468         }
1469
1470         return -ENODEV;
1471 }
1472
1473 static void
1474 mptlan_remove(struct pci_dev *pdev)
1475 {
1476         MPT_ADAPTER             *ioc = pci_get_drvdata(pdev);
1477         struct net_device       *dev = ioc->netdev;
1478
1479         if(dev != NULL) {
1480                 unregister_netdev(dev);
1481                 free_netdev(dev);
1482         }
1483 }
1484
1485 static struct mpt_pci_driver mptlan_driver = {
1486         .probe          = mptlan_probe,
1487         .remove         = mptlan_remove,
1488 };
1489
1490 static int __init mpt_lan_init (void)
1491 {
1492         show_mptmod_ver(LANAME, LANVER);
1493
1494         if ((LanCtx = mpt_register(lan_reply, MPTLAN_DRIVER)) <= 0) {
1495                 printk (KERN_ERR MYNAM ": Failed to register with MPT base driver\n");
1496                 return -EBUSY;
1497         }
1498
1499         /* Set the callback index to be used by driver core for turbo replies */
1500         mpt_lan_index = LanCtx;
1501
1502         dlprintk((KERN_INFO MYNAM ": assigned context of %d\n", LanCtx));
1503
1504         if (mpt_reset_register(LanCtx, mpt_lan_ioc_reset)) {
1505                 printk(KERN_ERR MYNAM ": Eieee! unable to register a reset "
1506                        "handler with mptbase! The world is at an end! "
1507                        "Everything is fading to black! Goodbye.\n");
1508                 return -EBUSY;
1509         }
1510
1511         dlprintk((KERN_INFO MYNAM ": Registered for IOC reset notifications\n"));
1512
1513         if (mpt_device_driver_register(&mptlan_driver, MPTLAN_DRIVER))
1514                 dprintk((KERN_INFO MYNAM ": failed to register dd callbacks\n"));
1515         return 0;
1516 }
1517
1518 static void __exit mpt_lan_exit(void)
1519 {
1520         mpt_device_driver_deregister(MPTLAN_DRIVER);
1521         mpt_reset_deregister(LanCtx);
1522
1523         if (LanCtx >= 0) {
1524                 mpt_deregister(LanCtx);
1525                 LanCtx = -1;
1526                 mpt_lan_index = 0;
1527         }
1528 }
1529
1530 module_init(mpt_lan_init);
1531 module_exit(mpt_lan_exit);
1532
1533 /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
1534 static unsigned short
1535 mpt_lan_type_trans(struct sk_buff *skb, struct net_device *dev)
1536 {
1537         struct mpt_lan_ohdr *fch = (struct mpt_lan_ohdr *)skb->data;
1538         struct fcllc *fcllc;
1539
1540         skb->mac.raw = skb->data;
1541         skb_pull(skb, sizeof(struct mpt_lan_ohdr));
1542
1543         if (fch->dtype == htons(0xffff)) {
1544                 u32 *p = (u32 *) fch;
1545
1546                 swab32s(p + 0);
1547                 swab32s(p + 1);
1548                 swab32s(p + 2);
1549                 swab32s(p + 3);
1550
1551                 printk (KERN_WARNING MYNAM ": %s: WARNING - Broadcast swap F/W bug detected!\n",
1552                                 NETDEV_PTR_TO_IOC_NAME_s(dev));
1553                 printk (KERN_WARNING MYNAM ": Please update sender @ MAC_addr = %02x:%02x:%02x:%02x:%02x:%02x\n",
1554                                 fch->saddr[0], fch->saddr[1], fch->saddr[2],
1555                                 fch->saddr[3], fch->saddr[4], fch->saddr[5]);
1556         }
1557
1558         if (*fch->daddr & 1) {
1559                 if (!memcmp(fch->daddr, dev->broadcast, FC_ALEN)) {
1560                         skb->pkt_type = PACKET_BROADCAST;
1561                 } else {
1562                         skb->pkt_type = PACKET_MULTICAST;
1563                 }
1564         } else {
1565                 if (memcmp(fch->daddr, dev->dev_addr, FC_ALEN)) {
1566                         skb->pkt_type = PACKET_OTHERHOST;
1567                 } else {
1568                         skb->pkt_type = PACKET_HOST;
1569                 }
1570         }
1571
1572         fcllc = (struct fcllc *)skb->data;
1573
1574 #ifdef QLOGIC_NAA_WORKAROUND
1575 {
1576         u16 source_naa = fch->stype, found = 0;
1577
1578         /* Workaround for QLogic not following RFC 2625 in regards to the NAA
1579            value. */
1580
1581         if ((source_naa & 0xF000) == 0)
1582                 source_naa = swab16(source_naa);
1583
1584         if (fcllc->ethertype == htons(ETH_P_ARP))
1585             dlprintk ((KERN_INFO "mptlan/type_trans: got arp req/rep w/ naa of "
1586                       "%04x.\n", source_naa));
1587
1588         if ((fcllc->ethertype == htons(ETH_P_ARP)) &&
1589            ((source_naa >> 12) !=  MPT_LAN_NAA_RFC2625)){
1590                 struct NAA_Hosed *nh, *prevnh;
1591                 int i;
1592
1593                 dlprintk ((KERN_INFO "mptlan/type_trans: ARP Req/Rep from "
1594                           "system with non-RFC 2625 NAA value (%04x).\n",
1595                           source_naa));
1596
1597                 write_lock_irq(&bad_naa_lock);
1598                 for (prevnh = nh = mpt_bad_naa; nh != NULL;
1599                      prevnh=nh, nh=nh->next) {
1600                         if ((nh->ieee[0] == fch->saddr[0]) &&
1601                             (nh->ieee[1] == fch->saddr[1]) &&
1602                             (nh->ieee[2] == fch->saddr[2]) &&
1603                             (nh->ieee[3] == fch->saddr[3]) &&
1604                             (nh->ieee[4] == fch->saddr[4]) &&
1605                             (nh->ieee[5] == fch->saddr[5])) {
1606                                 found = 1;
1607                                 dlprintk ((KERN_INFO "mptlan/type_trans: ARP Re"
1608                                          "q/Rep w/ bad NAA from system already"
1609                                          " in DB.\n"));
1610                                 break;
1611                         }
1612                 }
1613
1614                 if ((!found) && (nh == NULL)) {
1615
1616                         nh = kmalloc(sizeof(struct NAA_Hosed), GFP_KERNEL);
1617                         dlprintk ((KERN_INFO "mptlan/type_trans: ARP Req/Rep w/"
1618                                  " bad NAA from system not yet in DB.\n"));
1619
1620                         if (nh != NULL) {
1621                                 nh->next = NULL;
1622                                 if (!mpt_bad_naa)
1623                                         mpt_bad_naa = nh;
1624                                 if (prevnh)
1625                                         prevnh->next = nh;
1626
1627                                 nh->NAA = source_naa; /* Set the S_NAA value. */
1628                                 for (i = 0; i < FC_ALEN; i++)
1629                                         nh->ieee[i] = fch->saddr[i];
1630                                 dlprintk ((KERN_INFO "Got ARP from %02x:%02x:%02x:%02x:"
1631                                           "%02x:%02x with non-compliant S_NAA value.\n",
1632                                           fch->saddr[0], fch->saddr[1], fch->saddr[2],
1633                                           fch->saddr[3], fch->saddr[4],fch->saddr[5]));
1634                         } else {
1635                                 printk (KERN_ERR "mptlan/type_trans: Unable to"
1636                                         " kmalloc a NAA_Hosed struct.\n");
1637                         }
1638                 } else if (!found) {
1639                         printk (KERN_ERR "mptlan/type_trans: found not"
1640                                 " set, but nh isn't null. Evil "
1641                                 "funkiness abounds.\n");
1642                 }
1643                 write_unlock_irq(&bad_naa_lock);
1644         }
1645 }
1646 #endif
1647
1648         /* Strip the SNAP header from ARP packets since we don't
1649          * pass them through to the 802.2/SNAP layers.
1650          */
1651         if (fcllc->dsap == EXTENDED_SAP &&
1652                 (fcllc->ethertype == htons(ETH_P_IP) ||
1653                  fcllc->ethertype == htons(ETH_P_ARP))) {
1654                 skb_pull(skb, sizeof(struct fcllc));
1655                 return fcllc->ethertype;
1656         }
1657
1658         return htons(ETH_P_802_2);
1659 }
1660
1661 /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/