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