开通博客赚积分
发布资源赚积分
分类

源码开发语言/平台
当前位置：首页 > 源码/资料 > 嵌入式/单片机编程 > 嵌入式Linux > 查看源码
mptlan.c
资源名称：SBC-2410X_kernel.tar.gz　[点击查看]
上传用户：lgb322
上传日期：2013-02-24
资源大小：30529k
文件大小：47k
源码类别：

嵌入式Linux

开发平台：

Unix_Linux

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