1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543 |
- /*
- * linux/drivers/message/fusion/mptlan.c
- * IP Over Fibre Channel device driver.
- * For use with LSI Fibre Channel PCI chip/adapters
- * running LSI Fusion MPT (Message Passing Technology) firmware.
- *
- * Copyright (c) 2000-2008 LSI Corporation
- * (mailto:[email protected])
- *
- */
- /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
- /*
- This program is free software; you can redistribute it and/or modify
- it under the terms of the GNU General Public License as published by
- the Free Software Foundation; version 2 of the License.
- This program is distributed in the hope that it will be useful,
- but WITHOUT ANY WARRANTY; without even the implied warranty of
- MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- GNU General Public License for more details.
- NO WARRANTY
- THE PROGRAM IS PROVIDED ON AN "AS IS" BASIS, WITHOUT WARRANTIES OR
- CONDITIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED INCLUDING, WITHOUT
- LIMITATION, ANY WARRANTIES OR CONDITIONS OF TITLE, NON-INFRINGEMENT,
- MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE. Each Recipient is
- solely responsible for determining the appropriateness of using and
- distributing the Program and assumes all risks associated with its
- exercise of rights under this Agreement, including but not limited to
- the risks and costs of program errors, damage to or loss of data,
- programs or equipment, and unavailability or interruption of operations.
- DISCLAIMER OF LIABILITY
- NEITHER RECIPIENT NOR ANY CONTRIBUTORS SHALL HAVE ANY LIABILITY FOR ANY
- DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
- DAMAGES (INCLUDING WITHOUT LIMITATION LOST PROFITS), HOWEVER CAUSED AND
- ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR
- TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE
- USE OR DISTRIBUTION OF THE PROGRAM OR THE EXERCISE OF ANY RIGHTS GRANTED
- HEREUNDER, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGES
- You should have received a copy of the GNU General Public License
- along with this program; if not, write to the Free Software
- Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
- */
- /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
- /*
- * Define statements used for debugging
- */
- //#define MPT_LAN_IO_DEBUG
- /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
- #include "mptlan.h"
- #include <linux/init.h>
- #include <linux/module.h>
- #include <linux/fs.h>
- #include <linux/sched.h>
- #include <linux/slab.h>
- #define my_VERSION MPT_LINUX_VERSION_COMMON
- #define MYNAM "mptlan"
- MODULE_LICENSE("GPL");
- MODULE_VERSION(my_VERSION);
- /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
- /*
- * MPT LAN message sizes without variable part.
- */
- #define MPT_LAN_RECEIVE_POST_REQUEST_SIZE \
- (sizeof(LANReceivePostRequest_t) - sizeof(SGE_MPI_UNION))
- /*
- * Fusion MPT LAN private structures
- */
- struct BufferControl {
- struct sk_buff *skb;
- dma_addr_t dma;
- unsigned int len;
- };
- struct mpt_lan_priv {
- MPT_ADAPTER *mpt_dev;
- u8 pnum; /* Port number in the IOC. This is not a Unix network port! */
- atomic_t buckets_out; /* number of unused buckets on IOC */
- int bucketthresh; /* Send more when this many left */
- int *mpt_txfidx; /* Free Tx Context list */
- int mpt_txfidx_tail;
- spinlock_t txfidx_lock;
- int *mpt_rxfidx; /* Free Rx Context list */
- int mpt_rxfidx_tail;
- spinlock_t rxfidx_lock;
- struct BufferControl *RcvCtl; /* Receive BufferControl structs */
- struct BufferControl *SendCtl; /* Send BufferControl structs */
- int max_buckets_out; /* Max buckets to send to IOC */
- int tx_max_out; /* IOC's Tx queue len */
- u32 total_posted;
- u32 total_received;
- struct delayed_work post_buckets_task;
- struct net_device *dev;
- unsigned long post_buckets_active;
- };
- struct mpt_lan_ohdr {
- u16 dtype;
- u8 daddr[FC_ALEN];
- u16 stype;
- u8 saddr[FC_ALEN];
- };
- /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
- /*
- * Forward protos...
- */
- static int lan_reply (MPT_ADAPTER *ioc, MPT_FRAME_HDR *mf,
- MPT_FRAME_HDR *reply);
- static int mpt_lan_open(struct net_device *dev);
- static int mpt_lan_reset(struct net_device *dev);
- static int mpt_lan_close(struct net_device *dev);
- static void mpt_lan_post_receive_buckets(struct mpt_lan_priv *priv);
- static void mpt_lan_wake_post_buckets_task(struct net_device *dev,
- int priority);
- static int mpt_lan_receive_post_turbo(struct net_device *dev, u32 tmsg);
- static int mpt_lan_receive_post_reply(struct net_device *dev,
- LANReceivePostReply_t *pRecvRep);
- static int mpt_lan_send_turbo(struct net_device *dev, u32 tmsg);
- static int mpt_lan_send_reply(struct net_device *dev,
- LANSendReply_t *pSendRep);
- static int mpt_lan_ioc_reset(MPT_ADAPTER *ioc, int reset_phase);
- static int mpt_lan_event_process(MPT_ADAPTER *ioc, EventNotificationReply_t *pEvReply);
- static unsigned short mpt_lan_type_trans(struct sk_buff *skb,
- struct net_device *dev);
- /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
- /*
- * Fusion MPT LAN private data
- */
- static u8 LanCtx = MPT_MAX_PROTOCOL_DRIVERS;
- static u32 max_buckets_out = 127;
- static u32 tx_max_out_p = 127 - 16;
- /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
- /**
- * lan_reply - Handle all data sent from the hardware.
- * @ioc: Pointer to MPT_ADAPTER structure
- * @mf: Pointer to original MPT request frame (NULL if TurboReply)
- * @reply: Pointer to MPT reply frame
- *
- * Returns 1 indicating original alloc'd request frame ptr
- * should be freed, or 0 if it shouldn't.
- */
- static int
- lan_reply (MPT_ADAPTER *ioc, MPT_FRAME_HDR *mf, MPT_FRAME_HDR *reply)
- {
- struct net_device *dev = ioc->netdev;
- int FreeReqFrame = 0;
- dioprintk((KERN_INFO MYNAM ": %s/%s: Got reply.\n",
- IOC_AND_NETDEV_NAMES_s_s(dev)));
- // dioprintk((KERN_INFO MYNAM "@lan_reply: mf = %p, reply = %p\n",
- // mf, reply));
- if (mf == NULL) {
- u32 tmsg = CAST_PTR_TO_U32(reply);
- dioprintk((KERN_INFO MYNAM ": %s/%s: @lan_reply, tmsg %08x\n",
- IOC_AND_NETDEV_NAMES_s_s(dev),
- tmsg));
- switch (GET_LAN_FORM(tmsg)) {
- // NOTE! (Optimization) First case here is now caught in
- // mptbase.c::mpt_interrupt() routine and callcack here
- // is now skipped for this case!
- #if 0
- case LAN_REPLY_FORM_MESSAGE_CONTEXT:
- // dioprintk((KERN_INFO MYNAM "/lan_reply: "
- // "MessageContext turbo reply received\n"));
- FreeReqFrame = 1;
- break;
- #endif
- case LAN_REPLY_FORM_SEND_SINGLE:
- // dioprintk((MYNAM "/lan_reply: "
- // "calling mpt_lan_send_reply (turbo)\n"));
- // Potential BUG here?
- // FreeReqFrame = mpt_lan_send_turbo(dev, tmsg);
- // If/when mpt_lan_send_turbo would return 1 here,
- // calling routine (mptbase.c|mpt_interrupt)
- // would Oops because mf has already been set
- // to NULL. So after return from this func,
- // mpt_interrupt() will attempt to put (NULL) mf ptr
- // item back onto its adapter FreeQ - Oops!:-(
- // It's Ok, since mpt_lan_send_turbo() *currently*
- // always returns 0, but..., just in case:
- (void) mpt_lan_send_turbo(dev, tmsg);
- FreeReqFrame = 0;
- break;
- case LAN_REPLY_FORM_RECEIVE_SINGLE:
- // dioprintk((KERN_INFO MYNAM "@lan_reply: "
- // "rcv-Turbo = %08x\n", tmsg));
- mpt_lan_receive_post_turbo(dev, tmsg);
- break;
- default:
- printk (KERN_ERR MYNAM "/lan_reply: Got a turbo reply "
- "that I don't know what to do with\n");
- /* CHECKME! Hmmm... FreeReqFrame is 0 here; is that right? */
- break;
- }
- return FreeReqFrame;
- }
- // msg = (u32 *) reply;
- // dioprintk((KERN_INFO MYNAM "@lan_reply: msg = %08x %08x %08x %08x\n",
- // le32_to_cpu(msg[0]), le32_to_cpu(msg[1]),
- // le32_to_cpu(msg[2]), le32_to_cpu(msg[3])));
- // dioprintk((KERN_INFO MYNAM "@lan_reply: Function = %02xh\n",
- // reply->u.hdr.Function));
- switch (reply->u.hdr.Function) {
- case MPI_FUNCTION_LAN_SEND:
- {
- LANSendReply_t *pSendRep;
- pSendRep = (LANSendReply_t *) reply;
- FreeReqFrame = mpt_lan_send_reply(dev, pSendRep);
- break;
- }
- case MPI_FUNCTION_LAN_RECEIVE:
- {
- LANReceivePostReply_t *pRecvRep;
- pRecvRep = (LANReceivePostReply_t *) reply;
- if (pRecvRep->NumberOfContexts) {
- mpt_lan_receive_post_reply(dev, pRecvRep);
- if (!(pRecvRep->MsgFlags & MPI_MSGFLAGS_CONTINUATION_REPLY))
- FreeReqFrame = 1;
- } else
- dioprintk((KERN_INFO MYNAM "@lan_reply: zero context "
- "ReceivePostReply received.\n"));
- break;
- }
- case MPI_FUNCTION_LAN_RESET:
- /* Just a default reply. Might want to check it to
- * make sure that everything went ok.
- */
- FreeReqFrame = 1;
- break;
- case MPI_FUNCTION_EVENT_NOTIFICATION:
- case MPI_FUNCTION_EVENT_ACK:
- /* _EVENT_NOTIFICATION should NOT come down this path any more.
- * Should be routed to mpt_lan_event_process(), but just in case...
- */
- FreeReqFrame = 1;
- break;
- default:
- printk (KERN_ERR MYNAM "/lan_reply: Got a non-turbo "
- "reply that I don't know what to do with\n");
- /* CHECKME! Hmmm... FreeReqFrame is 0 here; is that right? */
- FreeReqFrame = 1;
- break;
- }
- return FreeReqFrame;
- }
- /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
- static int
- mpt_lan_ioc_reset(MPT_ADAPTER *ioc, int reset_phase)
- {
- struct net_device *dev = ioc->netdev;
- struct mpt_lan_priv *priv;
- if (dev == NULL)
- return(1);
- else
- priv = netdev_priv(dev);
- dlprintk((KERN_INFO MYNAM ": IOC %s_reset routed to LAN driver!\n",
- reset_phase==MPT_IOC_SETUP_RESET ? "setup" : (
- reset_phase==MPT_IOC_PRE_RESET ? "pre" : "post")));
- if (priv->mpt_rxfidx == NULL)
- return (1);
- if (reset_phase == MPT_IOC_SETUP_RESET) {
- ;
- } else if (reset_phase == MPT_IOC_PRE_RESET) {
- int i;
- unsigned long flags;
- netif_stop_queue(dev);
- dlprintk ((KERN_INFO "mptlan/ioc_reset: called netif_stop_queue for %s.\n", dev->name));
- atomic_set(&priv->buckets_out, 0);
- /* Reset Rx Free Tail index and re-populate the queue. */
- spin_lock_irqsave(&priv->rxfidx_lock, flags);
- priv->mpt_rxfidx_tail = -1;
- for (i = 0; i < priv->max_buckets_out; i++)
- priv->mpt_rxfidx[++priv->mpt_rxfidx_tail] = i;
- spin_unlock_irqrestore(&priv->rxfidx_lock, flags);
- } else {
- mpt_lan_post_receive_buckets(priv);
- netif_wake_queue(dev);
- }
- return 1;
- }
- /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
- static int
- mpt_lan_event_process(MPT_ADAPTER *ioc, EventNotificationReply_t *pEvReply)
- {
- dlprintk((KERN_INFO MYNAM ": MPT event routed to LAN driver!\n"));
- switch (le32_to_cpu(pEvReply->Event)) {
- case MPI_EVENT_NONE: /* 00 */
- case MPI_EVENT_LOG_DATA: /* 01 */
- case MPI_EVENT_STATE_CHANGE: /* 02 */
- case MPI_EVENT_UNIT_ATTENTION: /* 03 */
- case MPI_EVENT_IOC_BUS_RESET: /* 04 */
- case MPI_EVENT_EXT_BUS_RESET: /* 05 */
- case MPI_EVENT_RESCAN: /* 06 */
- /* Ok, do we need to do anything here? As far as
- I can tell, this is when a new device gets added
- to the loop. */
- case MPI_EVENT_LINK_STATUS_CHANGE: /* 07 */
- case MPI_EVENT_LOOP_STATE_CHANGE: /* 08 */
- case MPI_EVENT_LOGOUT: /* 09 */
- case MPI_EVENT_EVENT_CHANGE: /* 0A */
- default:
- break;
- }
- /*
- * NOTE: pEvent->AckRequired handling now done in mptbase.c;
- * Do NOT do it here now!
- */
- return 1;
- }
- /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
- static int
- mpt_lan_open(struct net_device *dev)
- {
- struct mpt_lan_priv *priv = netdev_priv(dev);
- int i;
- if (mpt_lan_reset(dev) != 0) {
- MPT_ADAPTER *mpt_dev = priv->mpt_dev;
- printk (KERN_WARNING MYNAM "/lan_open: lan_reset failed.");
- if (mpt_dev->active)
- printk ("The ioc is active. Perhaps it needs to be"
- " reset?\n");
- else
- printk ("The ioc in inactive, most likely in the "
- "process of being reset. Please try again in "
- "a moment.\n");
- }
- priv->mpt_txfidx = kmalloc_array(priv->tx_max_out, sizeof(int),
- GFP_KERNEL);
- if (priv->mpt_txfidx == NULL)
- goto out;
- priv->mpt_txfidx_tail = -1;
- priv->SendCtl = kcalloc(priv->tx_max_out, sizeof(struct BufferControl),
- GFP_KERNEL);
- if (priv->SendCtl == NULL)
- goto out_mpt_txfidx;
- for (i = 0; i < priv->tx_max_out; i++)
- priv->mpt_txfidx[++priv->mpt_txfidx_tail] = i;
- dlprintk((KERN_INFO MYNAM "@lo: Finished initializing SendCtl\n"));
- priv->mpt_rxfidx = kmalloc_array(priv->max_buckets_out, sizeof(int),
- GFP_KERNEL);
- if (priv->mpt_rxfidx == NULL)
- goto out_SendCtl;
- priv->mpt_rxfidx_tail = -1;
- priv->RcvCtl = kcalloc(priv->max_buckets_out,
- sizeof(struct BufferControl),
- GFP_KERNEL);
- if (priv->RcvCtl == NULL)
- goto out_mpt_rxfidx;
- for (i = 0; i < priv->max_buckets_out; i++)
- priv->mpt_rxfidx[++priv->mpt_rxfidx_tail] = i;
- /**/ dlprintk((KERN_INFO MYNAM "/lo: txfidx contains - "));
- /**/ for (i = 0; i < priv->tx_max_out; i++)
- /**/ dlprintk((" %xh", priv->mpt_txfidx[i]));
- /**/ dlprintk(("\n"));
- dlprintk((KERN_INFO MYNAM "/lo: Finished initializing RcvCtl\n"));
- mpt_lan_post_receive_buckets(priv);
- printk(KERN_INFO MYNAM ": %s/%s: interface up & active\n",
- IOC_AND_NETDEV_NAMES_s_s(dev));
- if (mpt_event_register(LanCtx, mpt_lan_event_process) != 0) {
- printk (KERN_WARNING MYNAM "/lo: Unable to register for Event"
- " Notifications. This is a bad thing! We're not going "
- "to go ahead, but I'd be leery of system stability at "
- "this point.\n");
- }
- netif_start_queue(dev);
- dlprintk((KERN_INFO MYNAM "/lo: Done.\n"));
- return 0;
- out_mpt_rxfidx:
- kfree(priv->mpt_rxfidx);
- priv->mpt_rxfidx = NULL;
- out_SendCtl:
- kfree(priv->SendCtl);
- priv->SendCtl = NULL;
- out_mpt_txfidx:
- kfree(priv->mpt_txfidx);
- priv->mpt_txfidx = NULL;
- out: return -ENOMEM;
- }
- /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
- /* Send a LanReset message to the FW. This should result in the FW returning
- any buckets it still has. */
- static int
- mpt_lan_reset(struct net_device *dev)
- {
- MPT_FRAME_HDR *mf;
- LANResetRequest_t *pResetReq;
- struct mpt_lan_priv *priv = netdev_priv(dev);
- mf = mpt_get_msg_frame(LanCtx, priv->mpt_dev);
- if (mf == NULL) {
- /* dlprintk((KERN_ERR MYNAM "/reset: Evil funkiness abounds! "
- "Unable to allocate a request frame.\n"));
- */
- return -1;
- }
- pResetReq = (LANResetRequest_t *) mf;
- pResetReq->Function = MPI_FUNCTION_LAN_RESET;
- pResetReq->ChainOffset = 0;
- pResetReq->Reserved = 0;
- pResetReq->PortNumber = priv->pnum;
- pResetReq->MsgFlags = 0;
- pResetReq->Reserved2 = 0;
- mpt_put_msg_frame(LanCtx, priv->mpt_dev, mf);
- return 0;
- }
- /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
- static int
- mpt_lan_close(struct net_device *dev)
- {
- struct mpt_lan_priv *priv = netdev_priv(dev);
- MPT_ADAPTER *mpt_dev = priv->mpt_dev;
- unsigned long timeout;
- int i;
- dlprintk((KERN_INFO MYNAM ": mpt_lan_close called\n"));
- mpt_event_deregister(LanCtx);
- dlprintk((KERN_INFO MYNAM ":lan_close: Posted %d buckets "
- "since driver was loaded, %d still out\n",
- priv->total_posted,atomic_read(&priv->buckets_out)));
- netif_stop_queue(dev);
- mpt_lan_reset(dev);
- timeout = jiffies + 2 * HZ;
- while (atomic_read(&priv->buckets_out) && time_before(jiffies, timeout))
- schedule_timeout_interruptible(1);
- for (i = 0; i < priv->max_buckets_out; i++) {
- if (priv->RcvCtl[i].skb != NULL) {
- /**/ dlprintk((KERN_INFO MYNAM "/lan_close: bucket %05x "
- /**/ "is still out\n", i));
- dma_unmap_single(&mpt_dev->pcidev->dev,
- priv->RcvCtl[i].dma,
- priv->RcvCtl[i].len, DMA_FROM_DEVICE);
- dev_kfree_skb(priv->RcvCtl[i].skb);
- }
- }
- kfree(priv->RcvCtl);
- kfree(priv->mpt_rxfidx);
- for (i = 0; i < priv->tx_max_out; i++) {
- if (priv->SendCtl[i].skb != NULL) {
- dma_unmap_single(&mpt_dev->pcidev->dev,
- priv->SendCtl[i].dma,
- priv->SendCtl[i].len, DMA_TO_DEVICE);
- dev_kfree_skb(priv->SendCtl[i].skb);
- }
- }
- kfree(priv->SendCtl);
- kfree(priv->mpt_txfidx);
- atomic_set(&priv->buckets_out, 0);
- printk(KERN_INFO MYNAM ": %s/%s: interface down & inactive\n",
- IOC_AND_NETDEV_NAMES_s_s(dev));
- return 0;
- }
- /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
- /* Tx timeout handler. */
- static void
- mpt_lan_tx_timeout(struct net_device *dev, unsigned int txqueue)
- {
- struct mpt_lan_priv *priv = netdev_priv(dev);
- MPT_ADAPTER *mpt_dev = priv->mpt_dev;
- if (mpt_dev->active) {
- dlprintk (("mptlan/tx_timeout: calling netif_wake_queue for %s.\n", dev->name));
- netif_wake_queue(dev);
- }
- }
- /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
- //static inline int
- static int
- mpt_lan_send_turbo(struct net_device *dev, u32 tmsg)
- {
- struct mpt_lan_priv *priv = netdev_priv(dev);
- MPT_ADAPTER *mpt_dev = priv->mpt_dev;
- struct sk_buff *sent;
- unsigned long flags;
- u32 ctx;
- ctx = GET_LAN_BUFFER_CONTEXT(tmsg);
- sent = priv->SendCtl[ctx].skb;
- dev->stats.tx_packets++;
- dev->stats.tx_bytes += sent->len;
- dioprintk((KERN_INFO MYNAM ": %s/%s: @%s, skb %p sent.\n",
- IOC_AND_NETDEV_NAMES_s_s(dev),
- __func__, sent));
- priv->SendCtl[ctx].skb = NULL;
- dma_unmap_single(&mpt_dev->pcidev->dev, priv->SendCtl[ctx].dma,
- priv->SendCtl[ctx].len, DMA_TO_DEVICE);
- dev_kfree_skb_irq(sent);
- spin_lock_irqsave(&priv->txfidx_lock, flags);
- priv->mpt_txfidx[++priv->mpt_txfidx_tail] = ctx;
- spin_unlock_irqrestore(&priv->txfidx_lock, flags);
- netif_wake_queue(dev);
- return 0;
- }
- /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
- static int
- mpt_lan_send_reply(struct net_device *dev, LANSendReply_t *pSendRep)
- {
- struct mpt_lan_priv *priv = netdev_priv(dev);
- MPT_ADAPTER *mpt_dev = priv->mpt_dev;
- struct sk_buff *sent;
- unsigned long flags;
- int FreeReqFrame = 0;
- u32 *pContext;
- u32 ctx;
- u8 count;
- count = pSendRep->NumberOfContexts;
- dioprintk((KERN_INFO MYNAM ": send_reply: IOCStatus: %04x\n",
- le16_to_cpu(pSendRep->IOCStatus)));
- /* Add check for Loginfo Flag in IOCStatus */
- switch (le16_to_cpu(pSendRep->IOCStatus) & MPI_IOCSTATUS_MASK) {
- case MPI_IOCSTATUS_SUCCESS:
- dev->stats.tx_packets += count;
- break;
- case MPI_IOCSTATUS_LAN_CANCELED:
- case MPI_IOCSTATUS_LAN_TRANSMIT_ABORTED:
- break;
- case MPI_IOCSTATUS_INVALID_SGL:
- dev->stats.tx_errors += count;
- printk (KERN_ERR MYNAM ": %s/%s: ERROR - Invalid SGL sent to IOC!\n",
- IOC_AND_NETDEV_NAMES_s_s(dev));
- goto out;
- default:
- dev->stats.tx_errors += count;
- break;
- }
- pContext = &pSendRep->BufferContext;
- spin_lock_irqsave(&priv->txfidx_lock, flags);
- while (count > 0) {
- ctx = GET_LAN_BUFFER_CONTEXT(le32_to_cpu(*pContext));
- sent = priv->SendCtl[ctx].skb;
- dev->stats.tx_bytes += sent->len;
- dioprintk((KERN_INFO MYNAM ": %s/%s: @%s, skb %p sent.\n",
- IOC_AND_NETDEV_NAMES_s_s(dev),
- __func__, sent));
- priv->SendCtl[ctx].skb = NULL;
- dma_unmap_single(&mpt_dev->pcidev->dev,
- priv->SendCtl[ctx].dma,
- priv->SendCtl[ctx].len, DMA_TO_DEVICE);
- dev_kfree_skb_irq(sent);
- priv->mpt_txfidx[++priv->mpt_txfidx_tail] = ctx;
- pContext++;
- count--;
- }
- spin_unlock_irqrestore(&priv->txfidx_lock, flags);
- out:
- if (!(pSendRep->MsgFlags & MPI_MSGFLAGS_CONTINUATION_REPLY))
- FreeReqFrame = 1;
- netif_wake_queue(dev);
- return FreeReqFrame;
- }
- /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
- static netdev_tx_t
- mpt_lan_sdu_send (struct sk_buff *skb, struct net_device *dev)
- {
- struct mpt_lan_priv *priv = netdev_priv(dev);
- MPT_ADAPTER *mpt_dev = priv->mpt_dev;
- MPT_FRAME_HDR *mf;
- LANSendRequest_t *pSendReq;
- SGETransaction32_t *pTrans;
- SGESimple64_t *pSimple;
- const unsigned char *mac;
- dma_addr_t dma;
- unsigned long flags;
- int ctx;
- u16 cur_naa = 0x1000;
- dioprintk((KERN_INFO MYNAM ": %s called, skb_addr = %p\n",
- __func__, skb));
- spin_lock_irqsave(&priv->txfidx_lock, flags);
- if (priv->mpt_txfidx_tail < 0) {
- netif_stop_queue(dev);
- spin_unlock_irqrestore(&priv->txfidx_lock, flags);
- printk (KERN_ERR "%s: no tx context available: %u\n",
- __func__, priv->mpt_txfidx_tail);
- return NETDEV_TX_BUSY;
- }
- mf = mpt_get_msg_frame(LanCtx, mpt_dev);
- if (mf == NULL) {
- netif_stop_queue(dev);
- spin_unlock_irqrestore(&priv->txfidx_lock, flags);
- printk (KERN_ERR "%s: Unable to alloc request frame\n",
- __func__);
- return NETDEV_TX_BUSY;
- }
- ctx = priv->mpt_txfidx[priv->mpt_txfidx_tail--];
- spin_unlock_irqrestore(&priv->txfidx_lock, flags);
- // dioprintk((KERN_INFO MYNAM ": %s/%s: Creating new msg frame (send).\n",
- // IOC_AND_NETDEV_NAMES_s_s(dev)));
- pSendReq = (LANSendRequest_t *) mf;
- /* Set the mac.raw pointer, since this apparently isn't getting
- * done before we get the skb. Pull the data pointer past the mac data.
- */
- skb_reset_mac_header(skb);
- skb_pull(skb, 12);
- dma = dma_map_single(&mpt_dev->pcidev->dev, skb->data, skb->len,
- DMA_TO_DEVICE);
- priv->SendCtl[ctx].skb = skb;
- priv->SendCtl[ctx].dma = dma;
- priv->SendCtl[ctx].len = skb->len;
- /* Message Header */
- pSendReq->Reserved = 0;
- pSendReq->Function = MPI_FUNCTION_LAN_SEND;
- pSendReq->ChainOffset = 0;
- pSendReq->Reserved2 = 0;
- pSendReq->MsgFlags = 0;
- pSendReq->PortNumber = priv->pnum;
- /* Transaction Context Element */
- pTrans = (SGETransaction32_t *) pSendReq->SG_List;
- /* No Flags, 8 bytes of Details, 32bit Context (bloody turbo replies) */
- pTrans->ContextSize = sizeof(u32);
- pTrans->DetailsLength = 2 * sizeof(u32);
- pTrans->Flags = 0;
- pTrans->TransactionContext = cpu_to_le32(ctx);
- // dioprintk((KERN_INFO MYNAM ": %s/%s: BC = %08x, skb = %p, buff = %p\n",
- // IOC_AND_NETDEV_NAMES_s_s(dev),
- // ctx, skb, skb->data));
- mac = skb_mac_header(skb);
- pTrans->TransactionDetails[0] = cpu_to_le32((cur_naa << 16) |
- (mac[0] << 8) |
- (mac[1] << 0));
- pTrans->TransactionDetails[1] = cpu_to_le32((mac[2] << 24) |
- (mac[3] << 16) |
- (mac[4] << 8) |
- (mac[5] << 0));
- pSimple = (SGESimple64_t *) &pTrans->TransactionDetails[2];
- /* If we ever decide to send more than one Simple SGE per LANSend, then
- we will need to make sure that LAST_ELEMENT only gets set on the
- last one. Otherwise, bad voodoo and evil funkiness will commence. */
- pSimple->FlagsLength = cpu_to_le32(
- ((MPI_SGE_FLAGS_LAST_ELEMENT |
- MPI_SGE_FLAGS_END_OF_BUFFER |
- MPI_SGE_FLAGS_SIMPLE_ELEMENT |
- MPI_SGE_FLAGS_SYSTEM_ADDRESS |
- MPI_SGE_FLAGS_HOST_TO_IOC |
- MPI_SGE_FLAGS_64_BIT_ADDRESSING |
- MPI_SGE_FLAGS_END_OF_LIST) << MPI_SGE_FLAGS_SHIFT) |
- skb->len);
- pSimple->Address.Low = cpu_to_le32((u32) dma);
- if (sizeof(dma_addr_t) > sizeof(u32))
- pSimple->Address.High = cpu_to_le32((u32) ((u64) dma >> 32));
- else
- pSimple->Address.High = 0;
- mpt_put_msg_frame (LanCtx, mpt_dev, mf);
- netif_trans_update(dev);
- dioprintk((KERN_INFO MYNAM ": %s/%s: Sending packet. FlagsLength = %08x.\n",
- IOC_AND_NETDEV_NAMES_s_s(dev),
- le32_to_cpu(pSimple->FlagsLength)));
- return NETDEV_TX_OK;
- }
- /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
- static void
- mpt_lan_wake_post_buckets_task(struct net_device *dev, int priority)
- /*
- * @priority: 0 = put it on the timer queue, 1 = put it on the immediate queue
- */
- {
- struct mpt_lan_priv *priv = netdev_priv(dev);
-
- if (test_and_set_bit(0, &priv->post_buckets_active) == 0) {
- if (priority) {
- schedule_delayed_work(&priv->post_buckets_task, 0);
- } else {
- schedule_delayed_work(&priv->post_buckets_task, 1);
- dioprintk((KERN_INFO MYNAM ": post_buckets queued on "
- "timer.\n"));
- }
- dioprintk((KERN_INFO MYNAM ": %s/%s: Queued post_buckets task.\n",
- IOC_AND_NETDEV_NAMES_s_s(dev) ));
- }
- }
- /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
- static int
- mpt_lan_receive_skb(struct net_device *dev, struct sk_buff *skb)
- {
- struct mpt_lan_priv *priv = netdev_priv(dev);
- skb->protocol = mpt_lan_type_trans(skb, dev);
- dioprintk((KERN_INFO MYNAM ": %s/%s: Incoming packet (%d bytes) "
- "delivered to upper level.\n",
- IOC_AND_NETDEV_NAMES_s_s(dev), skb->len));
- dev->stats.rx_bytes += skb->len;
- dev->stats.rx_packets++;
- skb->dev = dev;
- netif_rx(skb);
- dioprintk((MYNAM "/receive_skb: %d buckets remaining\n",
- atomic_read(&priv->buckets_out)));
- if (atomic_read(&priv->buckets_out) < priv->bucketthresh)
- mpt_lan_wake_post_buckets_task(dev, 1);
- dioprintk((KERN_INFO MYNAM "/receive_post_reply: %d buckets "
- "remaining, %d received back since sod\n",
- atomic_read(&priv->buckets_out), priv->total_received));
- return 0;
- }
- /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
- //static inline int
- static int
- mpt_lan_receive_post_turbo(struct net_device *dev, u32 tmsg)
- {
- struct mpt_lan_priv *priv = netdev_priv(dev);
- MPT_ADAPTER *mpt_dev = priv->mpt_dev;
- struct sk_buff *skb, *old_skb;
- unsigned long flags;
- u32 ctx, len;
- ctx = GET_LAN_BUCKET_CONTEXT(tmsg);
- skb = priv->RcvCtl[ctx].skb;
- len = GET_LAN_PACKET_LENGTH(tmsg);
- if (len < MPT_LAN_RX_COPYBREAK) {
- old_skb = skb;
- skb = (struct sk_buff *)dev_alloc_skb(len);
- if (!skb) {
- printk (KERN_ERR MYNAM ": %s/%s: ERROR - Can't allocate skb! (%s@%d)\n",
- IOC_AND_NETDEV_NAMES_s_s(dev),
- __FILE__, __LINE__);
- return -ENOMEM;
- }
- dma_sync_single_for_cpu(&mpt_dev->pcidev->dev,
- priv->RcvCtl[ctx].dma,
- priv->RcvCtl[ctx].len,
- DMA_FROM_DEVICE);
- skb_copy_from_linear_data(old_skb, skb_put(skb, len), len);
- dma_sync_single_for_device(&mpt_dev->pcidev->dev,
- priv->RcvCtl[ctx].dma,
- priv->RcvCtl[ctx].len,
- DMA_FROM_DEVICE);
- goto out;
- }
- skb_put(skb, len);
- priv->RcvCtl[ctx].skb = NULL;
- dma_unmap_single(&mpt_dev->pcidev->dev, priv->RcvCtl[ctx].dma,
- priv->RcvCtl[ctx].len, DMA_FROM_DEVICE);
- out:
- spin_lock_irqsave(&priv->rxfidx_lock, flags);
- priv->mpt_rxfidx[++priv->mpt_rxfidx_tail] = ctx;
- spin_unlock_irqrestore(&priv->rxfidx_lock, flags);
- atomic_dec(&priv->buckets_out);
- priv->total_received++;
- return mpt_lan_receive_skb(dev, skb);
- }
- /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
- static int
- mpt_lan_receive_post_free(struct net_device *dev,
- LANReceivePostReply_t *pRecvRep)
- {
- struct mpt_lan_priv *priv = netdev_priv(dev);
- MPT_ADAPTER *mpt_dev = priv->mpt_dev;
- unsigned long flags;
- struct sk_buff *skb;
- u32 ctx;
- int count;
- int i;
- count = pRecvRep->NumberOfContexts;
- /**/ dlprintk((KERN_INFO MYNAM "/receive_post_reply: "
- "IOC returned %d buckets, freeing them...\n", count));
- spin_lock_irqsave(&priv->rxfidx_lock, flags);
- for (i = 0; i < count; i++) {
- ctx = le32_to_cpu(pRecvRep->BucketContext[i]);
- skb = priv->RcvCtl[ctx].skb;
- // dlprintk((KERN_INFO MYNAM ": %s: dev_name = %s\n",
- // IOC_AND_NETDEV_NAMES_s_s(dev)));
- // dlprintk((KERN_INFO MYNAM "@rpr[2], priv = %p, buckets_out addr = %p",
- // priv, &(priv->buckets_out)));
- // dlprintk((KERN_INFO MYNAM "@rpr[2] TC + 3\n"));
- priv->RcvCtl[ctx].skb = NULL;
- dma_unmap_single(&mpt_dev->pcidev->dev, priv->RcvCtl[ctx].dma,
- priv->RcvCtl[ctx].len, DMA_FROM_DEVICE);
- dev_kfree_skb_any(skb);
- priv->mpt_rxfidx[++priv->mpt_rxfidx_tail] = ctx;
- }
- spin_unlock_irqrestore(&priv->rxfidx_lock, flags);
- atomic_sub(count, &priv->buckets_out);
- // for (i = 0; i < priv->max_buckets_out; i++)
- // if (priv->RcvCtl[i].skb != NULL)
- // dlprintk((KERN_INFO MYNAM "@rpr: bucket %03x "
- // "is still out\n", i));
- /* dlprintk((KERN_INFO MYNAM "/receive_post_reply: freed %d buckets\n",
- count));
- */
- /**/ dlprintk((KERN_INFO MYNAM "@receive_post_reply: %d buckets "
- /**/ "remaining, %d received back since sod.\n",
- /**/ atomic_read(&priv->buckets_out), priv->total_received));
- return 0;
- }
- /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
- static int
- mpt_lan_receive_post_reply(struct net_device *dev,
- LANReceivePostReply_t *pRecvRep)
- {
- struct mpt_lan_priv *priv = netdev_priv(dev);
- MPT_ADAPTER *mpt_dev = priv->mpt_dev;
- struct sk_buff *skb, *old_skb;
- unsigned long flags;
- u32 len, ctx, offset;
- u32 remaining = le32_to_cpu(pRecvRep->BucketsRemaining);
- int count;
- int i, l;
- dioprintk((KERN_INFO MYNAM ": mpt_lan_receive_post_reply called\n"));
- dioprintk((KERN_INFO MYNAM ": receive_post_reply: IOCStatus: %04x\n",
- le16_to_cpu(pRecvRep->IOCStatus)));
- if ((le16_to_cpu(pRecvRep->IOCStatus) & MPI_IOCSTATUS_MASK) ==
- MPI_IOCSTATUS_LAN_CANCELED)
- return mpt_lan_receive_post_free(dev, pRecvRep);
- len = le32_to_cpu(pRecvRep->PacketLength);
- if (len == 0) {
- printk (KERN_ERR MYNAM ": %s/%s: ERROR - Got a non-TURBO "
- "ReceivePostReply w/ PacketLength zero!\n",
- IOC_AND_NETDEV_NAMES_s_s(dev));
- printk (KERN_ERR MYNAM ": MsgFlags = %02x, IOCStatus = %04x\n",
- pRecvRep->MsgFlags, le16_to_cpu(pRecvRep->IOCStatus));
- return -1;
- }
- ctx = le32_to_cpu(pRecvRep->BucketContext[0]);
- count = pRecvRep->NumberOfContexts;
- skb = priv->RcvCtl[ctx].skb;
- offset = le32_to_cpu(pRecvRep->PacketOffset);
- // if (offset != 0) {
- // printk (KERN_INFO MYNAM ": %s/%s: Got a ReceivePostReply "
- // "w/ PacketOffset %u\n",
- // IOC_AND_NETDEV_NAMES_s_s(dev),
- // offset);
- // }
- dioprintk((KERN_INFO MYNAM ": %s/%s: @rpr, offset = %d, len = %d\n",
- IOC_AND_NETDEV_NAMES_s_s(dev),
- offset, len));
- if (count > 1) {
- int szrem = len;
- // dioprintk((KERN_INFO MYNAM ": %s/%s: Multiple buckets returned "
- // "for single packet, concatenating...\n",
- // IOC_AND_NETDEV_NAMES_s_s(dev)));
- skb = (struct sk_buff *)dev_alloc_skb(len);
- if (!skb) {
- printk (KERN_ERR MYNAM ": %s/%s: ERROR - Can't allocate skb! (%s@%d)\n",
- IOC_AND_NETDEV_NAMES_s_s(dev),
- __FILE__, __LINE__);
- return -ENOMEM;
- }
- spin_lock_irqsave(&priv->rxfidx_lock, flags);
- for (i = 0; i < count; i++) {
- ctx = le32_to_cpu(pRecvRep->BucketContext[i]);
- old_skb = priv->RcvCtl[ctx].skb;
- l = priv->RcvCtl[ctx].len;
- if (szrem < l)
- l = szrem;
- // dioprintk((KERN_INFO MYNAM ": %s/%s: Buckets = %d, len = %u\n",
- // IOC_AND_NETDEV_NAMES_s_s(dev),
- // i, l));
- dma_sync_single_for_cpu(&mpt_dev->pcidev->dev,
- priv->RcvCtl[ctx].dma,
- priv->RcvCtl[ctx].len,
- DMA_FROM_DEVICE);
- skb_copy_from_linear_data(old_skb, skb_put(skb, l), l);
- dma_sync_single_for_device(&mpt_dev->pcidev->dev,
- priv->RcvCtl[ctx].dma,
- priv->RcvCtl[ctx].len,
- DMA_FROM_DEVICE);
- priv->mpt_rxfidx[++priv->mpt_rxfidx_tail] = ctx;
- szrem -= l;
- }
- spin_unlock_irqrestore(&priv->rxfidx_lock, flags);
- } else if (len < MPT_LAN_RX_COPYBREAK) {
- old_skb = skb;
- skb = (struct sk_buff *)dev_alloc_skb(len);
- if (!skb) {
- printk (KERN_ERR MYNAM ": %s/%s: ERROR - Can't allocate skb! (%s@%d)\n",
- IOC_AND_NETDEV_NAMES_s_s(dev),
- __FILE__, __LINE__);
- return -ENOMEM;
- }
- dma_sync_single_for_cpu(&mpt_dev->pcidev->dev,
- priv->RcvCtl[ctx].dma,
- priv->RcvCtl[ctx].len,
- DMA_FROM_DEVICE);
- skb_copy_from_linear_data(old_skb, skb_put(skb, len), len);
- dma_sync_single_for_device(&mpt_dev->pcidev->dev,
- priv->RcvCtl[ctx].dma,
- priv->RcvCtl[ctx].len,
- DMA_FROM_DEVICE);
- spin_lock_irqsave(&priv->rxfidx_lock, flags);
- priv->mpt_rxfidx[++priv->mpt_rxfidx_tail] = ctx;
- spin_unlock_irqrestore(&priv->rxfidx_lock, flags);
- } else {
- spin_lock_irqsave(&priv->rxfidx_lock, flags);
- priv->RcvCtl[ctx].skb = NULL;
- dma_unmap_single(&mpt_dev->pcidev->dev, priv->RcvCtl[ctx].dma,
- priv->RcvCtl[ctx].len, DMA_FROM_DEVICE);
- priv->RcvCtl[ctx].dma = 0;
- priv->mpt_rxfidx[++priv->mpt_rxfidx_tail] = ctx;
- spin_unlock_irqrestore(&priv->rxfidx_lock, flags);
- skb_put(skb,len);
- }
- atomic_sub(count, &priv->buckets_out);
- priv->total_received += count;
- if (priv->mpt_rxfidx_tail >= MPT_LAN_MAX_BUCKETS_OUT) {
- printk (KERN_ERR MYNAM ": %s/%s: Yoohoo! mpt_rxfidx_tail = %d, "
- "MPT_LAN_MAX_BUCKETS_OUT = %d\n",
- IOC_AND_NETDEV_NAMES_s_s(dev),
- priv->mpt_rxfidx_tail,
- MPT_LAN_MAX_BUCKETS_OUT);
- return -1;
- }
- if (remaining == 0)
- printk (KERN_WARNING MYNAM ": %s/%s: WARNING - IOC out of buckets! "
- "(priv->buckets_out = %d)\n",
- IOC_AND_NETDEV_NAMES_s_s(dev),
- atomic_read(&priv->buckets_out));
- else if (remaining < 10)
- printk (KERN_INFO MYNAM ": %s/%s: IOC says %d buckets left. "
- "(priv->buckets_out = %d)\n",
- IOC_AND_NETDEV_NAMES_s_s(dev),
- remaining, atomic_read(&priv->buckets_out));
-
- if ((remaining < priv->bucketthresh) &&
- ((atomic_read(&priv->buckets_out) - remaining) >
- MPT_LAN_BUCKETS_REMAIN_MISMATCH_THRESH)) {
-
- printk (KERN_WARNING MYNAM " Mismatch between driver's "
- "buckets_out count and fw's BucketsRemaining "
- "count has crossed the threshold, issuing a "
- "LanReset to clear the fw's hashtable. You may "
- "want to check your /var/log/messages for \"CRC "
- "error\" event notifications.\n");
-
- mpt_lan_reset(dev);
- mpt_lan_wake_post_buckets_task(dev, 0);
- }
-
- return mpt_lan_receive_skb(dev, skb);
- }
- /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
- /* Simple SGE's only at the moment */
- static void
- mpt_lan_post_receive_buckets(struct mpt_lan_priv *priv)
- {
- struct net_device *dev = priv->dev;
- MPT_ADAPTER *mpt_dev = priv->mpt_dev;
- MPT_FRAME_HDR *mf;
- LANReceivePostRequest_t *pRecvReq;
- SGETransaction32_t *pTrans;
- SGESimple64_t *pSimple;
- struct sk_buff *skb;
- dma_addr_t dma;
- u32 curr, buckets, count, max;
- u32 len = (dev->mtu + dev->hard_header_len + 4);
- unsigned long flags;
- int i;
- curr = atomic_read(&priv->buckets_out);
- buckets = (priv->max_buckets_out - curr);
- dioprintk((KERN_INFO MYNAM ": %s/%s: @%s, Start_buckets = %u, buckets_out = %u\n",
- IOC_AND_NETDEV_NAMES_s_s(dev),
- __func__, buckets, curr));
- max = (mpt_dev->req_sz - MPT_LAN_RECEIVE_POST_REQUEST_SIZE) /
- (sizeof(SGETransaction32_t) + sizeof(SGESimple64_t));
- while (buckets) {
- mf = mpt_get_msg_frame(LanCtx, mpt_dev);
- if (mf == NULL) {
- printk (KERN_ERR "%s: Unable to alloc request frame\n",
- __func__);
- dioprintk((KERN_ERR "%s: %u buckets remaining\n",
- __func__, buckets));
- goto out;
- }
- pRecvReq = (LANReceivePostRequest_t *) mf;
- i = le16_to_cpu(mf->u.frame.hwhdr.msgctxu.fld.req_idx);
- mpt_dev->RequestNB[i] = 0;
- count = buckets;
- if (count > max)
- count = max;
- pRecvReq->Function = MPI_FUNCTION_LAN_RECEIVE;
- pRecvReq->ChainOffset = 0;
- pRecvReq->MsgFlags = 0;
- pRecvReq->PortNumber = priv->pnum;
- pTrans = (SGETransaction32_t *) pRecvReq->SG_List;
- pSimple = NULL;
- for (i = 0; i < count; i++) {
- int ctx;
- spin_lock_irqsave(&priv->rxfidx_lock, flags);
- if (priv->mpt_rxfidx_tail < 0) {
- printk (KERN_ERR "%s: Can't alloc context\n",
- __func__);
- spin_unlock_irqrestore(&priv->rxfidx_lock,
- flags);
- break;
- }
- ctx = priv->mpt_rxfidx[priv->mpt_rxfidx_tail--];
- skb = priv->RcvCtl[ctx].skb;
- if (skb && (priv->RcvCtl[ctx].len != len)) {
- dma_unmap_single(&mpt_dev->pcidev->dev,
- priv->RcvCtl[ctx].dma,
- priv->RcvCtl[ctx].len,
- DMA_FROM_DEVICE);
- dev_kfree_skb(priv->RcvCtl[ctx].skb);
- skb = priv->RcvCtl[ctx].skb = NULL;
- }
- if (skb == NULL) {
- skb = dev_alloc_skb(len);
- if (skb == NULL) {
- printk (KERN_WARNING
- MYNAM "/%s: Can't alloc skb\n",
- __func__);
- priv->mpt_rxfidx[++priv->mpt_rxfidx_tail] = ctx;
- spin_unlock_irqrestore(&priv->rxfidx_lock, flags);
- break;
- }
- dma = dma_map_single(&mpt_dev->pcidev->dev,
- skb->data, len,
- DMA_FROM_DEVICE);
- priv->RcvCtl[ctx].skb = skb;
- priv->RcvCtl[ctx].dma = dma;
- priv->RcvCtl[ctx].len = len;
- }
- spin_unlock_irqrestore(&priv->rxfidx_lock, flags);
- pTrans->ContextSize = sizeof(u32);
- pTrans->DetailsLength = 0;
- pTrans->Flags = 0;
- pTrans->TransactionContext = cpu_to_le32(ctx);
- pSimple = (SGESimple64_t *) pTrans->TransactionDetails;
- pSimple->FlagsLength = cpu_to_le32(
- ((MPI_SGE_FLAGS_END_OF_BUFFER |
- MPI_SGE_FLAGS_SIMPLE_ELEMENT |
- MPI_SGE_FLAGS_64_BIT_ADDRESSING) << MPI_SGE_FLAGS_SHIFT) | len);
- pSimple->Address.Low = cpu_to_le32((u32) priv->RcvCtl[ctx].dma);
- if (sizeof(dma_addr_t) > sizeof(u32))
- pSimple->Address.High = cpu_to_le32((u32) ((u64) priv->RcvCtl[ctx].dma >> 32));
- else
- pSimple->Address.High = 0;
- pTrans = (SGETransaction32_t *) (pSimple + 1);
- }
- if (pSimple == NULL) {
- /**/ printk (KERN_WARNING MYNAM "/%s: No buckets posted\n",
- /**/ __func__);
- mpt_free_msg_frame(mpt_dev, mf);
- goto out;
- }
- pSimple->FlagsLength |= cpu_to_le32(MPI_SGE_FLAGS_END_OF_LIST << MPI_SGE_FLAGS_SHIFT);
- pRecvReq->BucketCount = cpu_to_le32(i);
- /* printk(KERN_INFO MYNAM ": posting buckets\n ");
- * for (i = 0; i < j + 2; i ++)
- * printk (" %08x", le32_to_cpu(msg[i]));
- * printk ("\n");
- */
- mpt_put_msg_frame(LanCtx, mpt_dev, mf);
- priv->total_posted += i;
- buckets -= i;
- atomic_add(i, &priv->buckets_out);
- }
- out:
- dioprintk((KERN_INFO MYNAM "/%s: End_buckets = %u, priv->buckets_out = %u\n",
- __func__, buckets, atomic_read(&priv->buckets_out)));
- dioprintk((KERN_INFO MYNAM "/%s: Posted %u buckets and received %u back\n",
- __func__, priv->total_posted, priv->total_received));
- clear_bit(0, &priv->post_buckets_active);
- }
- static void
- mpt_lan_post_receive_buckets_work(struct work_struct *work)
- {
- mpt_lan_post_receive_buckets(container_of(work, struct mpt_lan_priv,
- post_buckets_task.work));
- }
- static const struct net_device_ops mpt_netdev_ops = {
- .ndo_open = mpt_lan_open,
- .ndo_stop = mpt_lan_close,
- .ndo_start_xmit = mpt_lan_sdu_send,
- .ndo_tx_timeout = mpt_lan_tx_timeout,
- };
- /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
- static struct net_device *
- mpt_register_lan_device (MPT_ADAPTER *mpt_dev, int pnum)
- {
- struct net_device *dev;
- struct mpt_lan_priv *priv;
- u8 HWaddr[FC_ALEN], *a;
- dev = alloc_fcdev(sizeof(struct mpt_lan_priv));
- if (!dev)
- return NULL;
- dev->mtu = MPT_LAN_MTU;
- priv = netdev_priv(dev);
- priv->dev = dev;
- priv->mpt_dev = mpt_dev;
- priv->pnum = pnum;
- INIT_DELAYED_WORK(&priv->post_buckets_task,
- mpt_lan_post_receive_buckets_work);
- priv->post_buckets_active = 0;
- dlprintk((KERN_INFO MYNAM "@%d: bucketlen = %d\n",
- __LINE__, dev->mtu + dev->hard_header_len + 4));
- atomic_set(&priv->buckets_out, 0);
- priv->total_posted = 0;
- priv->total_received = 0;
- priv->max_buckets_out = max_buckets_out;
- if (mpt_dev->pfacts[0].MaxLanBuckets < max_buckets_out)
- priv->max_buckets_out = mpt_dev->pfacts[0].MaxLanBuckets;
- dlprintk((KERN_INFO MYNAM "@%d: MaxLanBuckets=%d, max_buckets_out/priv=%d/%d\n",
- __LINE__,
- mpt_dev->pfacts[0].MaxLanBuckets,
- max_buckets_out,
- priv->max_buckets_out));
- priv->bucketthresh = priv->max_buckets_out * 2 / 3;
- spin_lock_init(&priv->txfidx_lock);
- spin_lock_init(&priv->rxfidx_lock);
- /* Grab pre-fetched LANPage1 stuff. :-) */
- a = (u8 *) &mpt_dev->lan_cnfg_page1.HardwareAddressLow;
- HWaddr[0] = a[5];
- HWaddr[1] = a[4];
- HWaddr[2] = a[3];
- HWaddr[3] = a[2];
- HWaddr[4] = a[1];
- HWaddr[5] = a[0];
- dev->addr_len = FC_ALEN;
- dev_addr_set(dev, HWaddr);
- memset(dev->broadcast, 0xff, FC_ALEN);
- /* The Tx queue is 127 deep on the 909.
- * Give ourselves some breathing room.
- */
- priv->tx_max_out = (tx_max_out_p <= MPT_TX_MAX_OUT_LIM) ?
- tx_max_out_p : MPT_TX_MAX_OUT_LIM;
- dev->netdev_ops = &mpt_netdev_ops;
- dev->watchdog_timeo = MPT_LAN_TX_TIMEOUT;
- /* MTU range: 96 - 65280 */
- dev->min_mtu = MPT_LAN_MIN_MTU;
- dev->max_mtu = MPT_LAN_MAX_MTU;
- dlprintk((KERN_INFO MYNAM ": Finished registering dev "
- "and setting initial values\n"));
- if (register_netdev(dev) != 0) {
- free_netdev(dev);
- dev = NULL;
- }
- return dev;
- }
- static int
- mptlan_probe(struct pci_dev *pdev)
- {
- MPT_ADAPTER *ioc = pci_get_drvdata(pdev);
- struct net_device *dev;
- int i;
- for (i = 0; i < ioc->facts.NumberOfPorts; i++) {
- printk(KERN_INFO MYNAM ": %s: PortNum=%x, "
- "ProtocolFlags=%02Xh (%c%c%c%c)\n",
- ioc->name, ioc->pfacts[i].PortNumber,
- ioc->pfacts[i].ProtocolFlags,
- MPT_PROTOCOL_FLAGS_c_c_c_c(
- ioc->pfacts[i].ProtocolFlags));
- if (!(ioc->pfacts[i].ProtocolFlags &
- MPI_PORTFACTS_PROTOCOL_LAN)) {
- printk(KERN_INFO MYNAM ": %s: Hmmm... LAN protocol "
- "seems to be disabled on this adapter port!\n",
- ioc->name);
- continue;
- }
- dev = mpt_register_lan_device(ioc, i);
- if (!dev) {
- printk(KERN_ERR MYNAM ": %s: Unable to register "
- "port%d as a LAN device\n", ioc->name,
- ioc->pfacts[i].PortNumber);
- continue;
- }
-
- printk(KERN_INFO MYNAM ": %s: Fusion MPT LAN device "
- "registered as '%s'\n", ioc->name, dev->name);
- printk(KERN_INFO MYNAM ": %s/%s: "
- "LanAddr = %pM\n",
- IOC_AND_NETDEV_NAMES_s_s(dev),
- dev->dev_addr);
-
- ioc->netdev = dev;
- return 0;
- }
- return -ENODEV;
- }
- static void
- mptlan_remove(struct pci_dev *pdev)
- {
- MPT_ADAPTER *ioc = pci_get_drvdata(pdev);
- struct net_device *dev = ioc->netdev;
- struct mpt_lan_priv *priv = netdev_priv(dev);
- cancel_delayed_work_sync(&priv->post_buckets_task);
- if(dev != NULL) {
- unregister_netdev(dev);
- free_netdev(dev);
- }
- }
- static struct mpt_pci_driver mptlan_driver = {
- .probe = mptlan_probe,
- .remove = mptlan_remove,
- };
- static int __init mpt_lan_init (void)
- {
- show_mptmod_ver(LANAME, LANVER);
- LanCtx = mpt_register(lan_reply, MPTLAN_DRIVER,
- "lan_reply");
- if (LanCtx <= 0) {
- printk (KERN_ERR MYNAM ": Failed to register with MPT base driver\n");
- return -EBUSY;
- }
- dlprintk((KERN_INFO MYNAM ": assigned context of %d\n", LanCtx));
- if (mpt_reset_register(LanCtx, mpt_lan_ioc_reset)) {
- printk(KERN_ERR MYNAM ": Eieee! unable to register a reset "
- "handler with mptbase! The world is at an end! "
- "Everything is fading to black! Goodbye.\n");
- return -EBUSY;
- }
- dlprintk((KERN_INFO MYNAM ": Registered for IOC reset notifications\n"));
-
- mpt_device_driver_register(&mptlan_driver, MPTLAN_DRIVER);
- return 0;
- }
- static void __exit mpt_lan_exit(void)
- {
- mpt_device_driver_deregister(MPTLAN_DRIVER);
- mpt_reset_deregister(LanCtx);
- if (LanCtx) {
- mpt_deregister(LanCtx);
- LanCtx = MPT_MAX_PROTOCOL_DRIVERS;
- }
- }
- module_init(mpt_lan_init);
- module_exit(mpt_lan_exit);
- /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
- static unsigned short
- mpt_lan_type_trans(struct sk_buff *skb, struct net_device *dev)
- {
- struct mpt_lan_ohdr *fch = (struct mpt_lan_ohdr *)skb->data;
- struct fcllc *fcllc;
- skb_reset_mac_header(skb);
- skb_pull(skb, sizeof(struct mpt_lan_ohdr));
- if (fch->dtype == htons(0xffff)) {
- u32 *p = (u32 *) fch;
- swab32s(p + 0);
- swab32s(p + 1);
- swab32s(p + 2);
- swab32s(p + 3);
- printk (KERN_WARNING MYNAM ": %s: WARNING - Broadcast swap F/W bug detected!\n",
- NETDEV_PTR_TO_IOC_NAME_s(dev));
- printk (KERN_WARNING MYNAM ": Please update sender @ MAC_addr = %pM\n",
- fch->saddr);
- }
- if (*fch->daddr & 1) {
- if (!memcmp(fch->daddr, dev->broadcast, FC_ALEN)) {
- skb->pkt_type = PACKET_BROADCAST;
- } else {
- skb->pkt_type = PACKET_MULTICAST;
- }
- } else {
- if (memcmp(fch->daddr, dev->dev_addr, FC_ALEN)) {
- skb->pkt_type = PACKET_OTHERHOST;
- } else {
- skb->pkt_type = PACKET_HOST;
- }
- }
- fcllc = (struct fcllc *)skb->data;
- /* Strip the SNAP header from ARP packets since we don't
- * pass them through to the 802.2/SNAP layers.
- */
- if (fcllc->dsap == EXTENDED_SAP &&
- (fcllc->ethertype == htons(ETH_P_IP) ||
- fcllc->ethertype == htons(ETH_P_ARP))) {
- skb_pull(skb, sizeof(struct fcllc));
- return fcllc->ethertype;
- }
- return htons(ETH_P_802_2);
- }
- /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
|