path: root/drivers/staging/wlags49_h2/wl_netdev.c

/*******************************************************************************
 * Agere Systems Inc.
 * Wireless device driver for Linux (wlags49).
 *
 * Copyright (c) 1998-2003 Agere Systems Inc.
 * All rights reserved.
 *   http://www.agere.com
 *
 * Initially developed by TriplePoint, Inc.
 *   http://www.triplepoint.com
 *
 *------------------------------------------------------------------------------
 *
 *   This file contains handler functions registered with the net_device
 *   structure.
 *
 *------------------------------------------------------------------------------
 *
 * SOFTWARE LICENSE
 *
 * This software is provided subject to the following terms and conditions,
 * which you should read carefully before using the software.  Using this
 * software indicates your acceptance of these terms and conditions.  If you do
 * not agree with these terms and conditions, do not use the software.
 *
 * Copyright © 2003 Agere Systems Inc.
 * All rights reserved.
 *
 * Redistribution and use in source or binary forms, with or without
 * modifications, are permitted provided that the following conditions are met:
 *
 * . Redistributions of source code must retain the above copyright notice, this
 *    list of conditions and the following Disclaimer as comments in the code as
 *    well as in the documentation and/or other materials provided with the
 *    distribution.
 *
 * . Redistributions in binary form must reproduce the above copyright notice,
 *    this list of conditions and the following Disclaimer in the documentation
 *    and/or other materials provided with the distribution.
 *
 * . Neither the name of Agere Systems Inc. nor the names of the contributors
 *    may be used to endorse or promote products derived from this software
 *    without specific prior written permission.
 *
 * Disclaimer
 *
 * THIS SOFTWARE IS PROVIDED “AS IS” AND ANY EXPRESS OR IMPLIED WARRANTIES,
 * INCLUDING, BUT NOT LIMITED TO, INFRINGEMENT AND THE IMPLIED WARRANTIES OF
 * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.  ANY
 * USE, MODIFICATION OR DISTRIBUTION OF THIS SOFTWARE IS SOLELY AT THE USERS OWN
 * RISK. IN NO EVENT SHALL AGERE SYSTEMS INC. OR CONTRIBUTORS BE LIABLE FOR ANY
 * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
 * ON ANY THEORY OF LIABILITY, INCLUDING, BUT NOT LIMITED TO, CONTRACT, STRICT
 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT
 * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH
 * DAMAGE.
 *
 ******************************************************************************/

/*******************************************************************************
 * include files
 ******************************************************************************/
#include <wl_version.h>

#include <linux/module.h>
#include <linux/slab.h>
#include <linux/types.h>
#include <linux/kernel.h>
#include <linux/netdevice.h>
#include <linux/ethtool.h>
#include <linux/etherdevice.h>

#include <debug.h>

#include <hcf.h>
#include <dhf.h>

#include <wl_if.h>
#include <wl_internal.h>
#include <wl_util.h>
#include <wl_priv.h>
#include <wl_main.h>
#include <wl_netdev.h>
#include <wl_wext.h>

#ifdef USE_PROFILE
#include <wl_profile.h>
#endif /* USE_PROFILE */

#ifdef BUS_PCMCIA
#include <wl_cs.h>
#endif /* BUS_PCMCIA */

#ifdef BUS_PCI
#include <wl_pci.h>
#endif /* BUS_PCI */

#if HCF_ENCAP
#define MTU_MAX (HCF_MAX_MSG - ETH_HLEN - 8)
#else
#define MTU_MAX (HCF_MAX_MSG - ETH_HLEN)
#endif

/*******************************************************************************
 * macros
 ******************************************************************************/
#define BLOCK_INPUT(buf, len) \
	do { \
		desc->buf_addr = buf; \
		desc->BUF_SIZE = len; \
		status = hcf_rcv_msg(&(lp->hcfCtx), desc, 0); \
	} while (0)

#define BLOCK_INPUT_DMA(buf, len) memcpy( buf, desc_next->buf_addr, pktlen )

/*******************************************************************************
 * function prototypes
 ******************************************************************************/

/*******************************************************************************
 *	wl_init()
 *******************************************************************************
 *
 *  DESCRIPTION:
 *
 *      We never need to do anything when a "Wireless" device is "initialized"
 *  by the net software, because we only register already-found cards.
 *
 *  PARAMETERS:
 *
 *      dev - a pointer to the device's net_device structure
 *
 *  RETURNS:
 *
 *      0 on success
 *      errno value otherwise
 *
 ******************************************************************************/
int wl_init(struct net_device *dev)
{
	DBG_PARAM(DbgInfo, "dev", "%s (0x%p)", dev->name, dev);
	return 0;
}				/* wl_init */

/*============================================================================*/

/*******************************************************************************
 *	wl_config()
 *******************************************************************************
 *
 *  DESCRIPTION:
 *
 *      Implement the SIOCSIFMAP interface.
 *
 *  PARAMETERS:
 *
 *      dev - a pointer to the device's net_device structure
 *      map - a pointer to the device's ifmap structure
 *
 *  RETURNS:
 *
 *      0 on success
 *      errno otherwise
 *
 ******************************************************************************/
int wl_config(struct net_device *dev, struct ifmap *map)
{
	DBG_PARAM(DbgInfo, "dev", "%s (0x%p)", dev->name, dev);
	DBG_PARAM(DbgInfo, "map", "0x%p", map);

	/*
	 * The only thing we care about here is a port change.
	 * Since this not needed, ignore the request. 
	 */
	DBG_TRACE(DbgInfo, "%s: %s called.\n", dev->name, __func__);

	return 0;
}				/* wl_config */

/*============================================================================*/

/*******************************************************************************
 *	wl_stats()
 *******************************************************************************
 *
 *  DESCRIPTION:
 *
 *      Return the current device statistics.
 *
 *  PARAMETERS:
 *
 *      dev - a pointer to the device's net_device structure
 *
 *  RETURNS:
 *
 *      a pointer to a net_device_stats structure containing the network
 *      statistics.
 *
 ******************************************************************************/
struct net_device_stats *wl_stats(struct net_device *dev)
{
#ifdef USE_WDS
	int count;
#endif /* USE_WDS */
	unsigned long flags;
	struct net_device_stats *pStats;
	struct wl_private *lp = wl_priv(dev);

	/*DBG_PARAM( DbgInfo, "dev", "%s (0x%p)", dev->name, dev ); */

	pStats = NULL;

	wl_lock(lp, &flags);

#ifdef USE_RTS
	if (lp->useRTS == 1) {
		wl_unlock(lp, &flags);
		return NULL;
	}
#endif /* USE_RTS */

	/* Return the statistics for the appropriate device */
#ifdef USE_WDS

	for (count = 0; count < NUM_WDS_PORTS; count++) {
		if (dev == lp->wds_port[count].dev)
			pStats = &(lp->wds_port[count].stats);
	}

#endif /* USE_WDS */

	/* If pStats is still NULL, then the device is not a WDS port */
	if (pStats == NULL)
		pStats = &(lp->stats);

	wl_unlock(lp, &flags);

	return pStats;
}				/* wl_stats */

/*============================================================================*/

/*******************************************************************************
 *	wl_open()
 *******************************************************************************
 *
 *  DESCRIPTION:
 *
 *      Open the device.
 *
 *  PARAMETERS:
 *
 *      dev - a pointer to the device's net_device structure
 *
 *  RETURNS:
 *
 *      0 on success
 *      errno otherwise
 *
 ******************************************************************************/
int wl_open(struct net_device *dev)
{
	int status = HCF_SUCCESS;
	struct wl_private *lp = wl_priv(dev);
	unsigned long flags;

	wl_lock(lp, &flags);

#ifdef USE_RTS
	if (lp->useRTS == 1) {
		DBG_TRACE(DbgInfo, "Skipping device open, in RTS mode\n");
		wl_unlock(lp, &flags);
		return -EIO;
	}
#endif /* USE_RTS */

#ifdef USE_PROFILE
	parse_config(dev);
#endif

	if (lp->portState == WVLAN_PORT_STATE_DISABLED) {
		DBG_TRACE(DbgInfo, "Enabling Port 0\n");
		status = wl_enable(lp);

		if (status != HCF_SUCCESS) {
			DBG_TRACE(DbgInfo, "Enable port 0 failed: 0x%x\n",
				  status);
		}
	}

	/* Holding the lock too long, make a gap to allow other processes */
	wl_unlock(lp, &flags);
	wl_lock(lp, &flags);

	if (strlen(lp->fw_image_filename)) {
		DBG_TRACE(DbgInfo, ";???? Kludgy way to force a download\n");
		status = wl_go(lp);
	} else {
		status = wl_apply(lp);
	}

	/* Holding the lock too long, make a gap to allow other processes */
	wl_unlock(lp, &flags);
	wl_lock(lp, &flags);

	/* Unsuccessful, try reset of the card to recover */
	if (status != HCF_SUCCESS)
		status = wl_reset(dev);

	/* Holding the lock too long, make a gap to allow other processes */
	wl_unlock(lp, &flags);
	wl_lock(lp, &flags);

	if (status == HCF_SUCCESS) {
		netif_carrier_on(dev);
		WL_WDS_NETIF_CARRIER_ON(lp);

		/* Start handling interrupts */
		lp->is_handling_int = WL_HANDLING_INT;
		wl_act_int_on(lp);

		netif_start_queue(dev);
		WL_WDS_NETIF_START_QUEUE(lp);
	} else {
		wl_hcf_error(dev, status);	/* Report the error */
		netif_device_detach(dev);	/* Stop the device and queue */
	}

	wl_unlock(lp, &flags);

	return status;
}				/* wl_open */

/*============================================================================*/

/*******************************************************************************
 *	wl_close()
 *******************************************************************************
 *
 *  DESCRIPTION:
 *
 *      Close the device.
 *
 *  PARAMETERS:
 *
 *      dev - a pointer to the device's net_device structure
 *
 *  RETURNS:
 *
 *      0 on success
 *      errno otherwise
 *
 ******************************************************************************/
int wl_close(struct net_device *dev)
{
	struct wl_private *lp = wl_priv(dev);
	unsigned long flags;

	DBG_PARAM(DbgInfo, "dev", "%s (0x%p)", dev->name, dev);

	/* Mark the adapter as busy */
	netif_stop_queue(dev);
	WL_WDS_NETIF_STOP_QUEUE(lp);

	netif_carrier_off(dev);
	WL_WDS_NETIF_CARRIER_OFF(lp);

	/*
	 * Shutdown the adapter:
	 * Disable adapter interrupts
	 * Stop Tx/Rx
	 * Update statistics
	 * Set low power mode
	 */

	wl_lock(lp, &flags);

	wl_act_int_off(lp);
	/* Stop handling interrupts */
	lp->is_handling_int = WL_NOT_HANDLING_INT;

#ifdef USE_RTS
	if (lp->useRTS == 1) {
		DBG_TRACE(DbgInfo, "Skipping device close, in RTS mode\n");
		wl_unlock(lp, &flags);
		return -EIO;
	}
#endif /* USE_RTS */

	/* Disable the ports */
	wl_disable(lp);

	wl_unlock(lp, &flags);

	return 0;
}				/* wl_close */

/*============================================================================*/

static void wl_get_drvinfo(struct net_device *dev, struct ethtool_drvinfo *info)
{
	strlcpy(info->driver, DRIVER_NAME, sizeof(info->driver));
	strlcpy(info->version, DRV_VERSION_STR, sizeof(info->version));

	if (dev->dev.parent) {
		dev_set_name(dev->dev.parent, "%s", info->bus_info);
	} else {
		snprintf(info->bus_info, sizeof(info->bus_info),
			 "PCMCIA FIXME");
	}
}				/* wl_get_drvinfo */

static struct ethtool_ops wl_ethtool_ops = {
	.get_drvinfo = wl_get_drvinfo,
	.get_link = ethtool_op_get_link,
};

/*******************************************************************************
 *	wl_ioctl()
 *******************************************************************************
 *
 *  DESCRIPTION:
 *
 *      The IOCTL handler for the device.
 *
 *  PARAMETERS:
 *
 *      dev - a pointer to the device's net_device struct.
 *      rq  - a pointer to the IOCTL request buffer.
 *      cmd - the IOCTL command code.
 *
 *  RETURNS:
 *
 *      0 on success
 *      errno value otherwise
 *
 ******************************************************************************/
int wl_ioctl(struct net_device *dev, struct ifreq *rq, int cmd)
{
	struct wl_private *lp = wl_priv(dev);
	unsigned long flags;
	int ret = 0;

	DBG_PARAM(DbgInfo, "dev", "%s (0x%p)", dev->name, dev);
	DBG_PARAM(DbgInfo, "rq", "0x%p", rq);
	DBG_PARAM(DbgInfo, "cmd", "0x%04x", cmd);

	wl_lock(lp, &flags);

	wl_act_int_off(lp);

#ifdef USE_RTS
	if (lp->useRTS == 1) {
		/* Handle any RTS IOCTL here */
		if (cmd == WL_IOCTL_RTS) {
			DBG_TRACE(DbgInfo, "IOCTL: WL_IOCTL_RTS\n");
			ret = wvlan_rts((struct rtsreq *)rq, dev->base_addr);
		} else {
			DBG_TRACE(DbgInfo,
				  "IOCTL not supported in RTS mode: 0x%X\n",
				  cmd);
			ret = -EOPNOTSUPP;
		}

		goto out_act_int_on_unlock;
	}
#endif /* USE_RTS */

	/* Only handle UIL IOCTL requests when the UIL has the system blocked. */
	if (!((lp->flags & WVLAN2_UIL_BUSY) && (cmd != WVLAN2_IOCTL_UIL))) {
#ifdef USE_UIL
		struct uilreq *urq = (struct uilreq *)rq;
#endif /* USE_UIL */

		switch (cmd) {
			/* ================== Private IOCTLs (up to 16) ================== */
#ifdef USE_UIL
		case WVLAN2_IOCTL_UIL:
			DBG_TRACE(DbgInfo, "IOCTL: WVLAN2_IOCTL_UIL\n");
			ret = wvlan_uil(urq, lp);
			break;
#endif /* USE_UIL */

		default:
			DBG_TRACE(DbgInfo, "IOCTL CODE NOT SUPPORTED: 0x%X\n",
				  cmd);
			ret = -EOPNOTSUPP;
			break;
		}
	} else {
		DBG_WARNING(DbgInfo,
			    "DEVICE IS BUSY, CANNOT PROCESS REQUEST\n");
		ret = -EBUSY;
	}

#ifdef USE_RTS
out_act_int_on_unlock:
#endif /* USE_RTS */
	wl_act_int_on(lp);

	wl_unlock(lp, &flags);

	return ret;
}				/* wl_ioctl */

/*============================================================================*/

#ifdef CONFIG_NET_POLL_CONTROLLER
static void wl_poll(struct net_device *dev)
{
	struct wl_private *lp = wl_priv(dev);
	unsigned long flags;
	struct pt_regs regs;

	wl_lock(lp, &flags);
	wl_isr(dev->irq, dev, &regs);
	wl_unlock(lp, &flags);
}
#endif

/*******************************************************************************
 *	wl_tx_timeout()
 *******************************************************************************
 *
 *  DESCRIPTION:
 *
 *      The handler called when, for some reason, a Tx request is not completed.
 *
 *  PARAMETERS:
 *
 *      dev - a pointer to the device's net_device struct.
 *
 *  RETURNS:
 *
 *      N/A
 *
 ******************************************************************************/
void wl_tx_timeout(struct net_device *dev)
{
#ifdef USE_WDS
	int count;
#endif /* USE_WDS */
	unsigned long flags;
	struct wl_private *lp = wl_priv(dev);
	struct net_device_stats *pStats = NULL;

	DBG_WARNING(DbgInfo, "%s: Transmit timeout.\n", dev->name);

	wl_lock(lp, &flags);

#ifdef USE_RTS
	if (lp->useRTS == 1) {
		DBG_TRACE(DbgInfo,
			  "Skipping tx_timeout handler, in RTS mode\n");
		wl_unlock(lp, &flags);
		return;
	}
#endif /* USE_RTS */

	/* Figure out which device (the "root" device or WDS port) this timeout
	   is for */
#ifdef USE_WDS

	for (count = 0; count < NUM_WDS_PORTS; count++) {
		if (dev == lp->wds_port[count].dev) {
			pStats = &(lp->wds_port[count].stats);

			/* Break the loop so that we can use the counter to access WDS
			   information in the private structure */
			break;
		}
	}

#endif /* USE_WDS */

	/* If pStats is still NULL, then the device is not a WDS port */
	if (pStats == NULL)
		pStats = &(lp->stats);

	/* Accumulate the timeout error */
	pStats->tx_errors++;

	wl_unlock(lp, &flags);
}				/* wl_tx_timeout */

/*============================================================================*/

/*******************************************************************************
 *	wl_send()
 *******************************************************************************
 *
 *  DESCRIPTION:
 *
 *      The routine which performs data transmits.
 *
 *  PARAMETERS:
 *
 *      lp  - a pointer to the device's wl_private struct.
 *
 *  RETURNS:
 *
 *      0 on success
 *      1 on error
 *
 ******************************************************************************/
int wl_send(struct wl_private *lp)
{

	int status;
	DESC_STRCT *desc;
	WVLAN_LFRAME *txF = NULL;
	struct list_head *element;
	int len;
    /*------------------------------------------------------------------------*/

	if (lp == NULL) {
		DBG_ERROR(DbgInfo, "Private adapter struct is NULL\n");
		return FALSE;
	}
	if (lp->dev == NULL) {
		DBG_ERROR(DbgInfo, "net_device struct in wl_private is NULL\n");
		return FALSE;
	}

	/*
	 * Check for the availability of FIDs; if none are available,
	 * don't take any frames off the txQ
	 */
	if (lp->hcfCtx.IFB_RscInd == 0)
		return FALSE;

	/* Reclaim the TxQ Elements and place them back on the free queue */
	if (!list_empty(&(lp->txQ[0]))) {
		element = lp->txQ[0].next;

		txF = (WVLAN_LFRAME *) list_entry(element, WVLAN_LFRAME, node);
		if (txF != NULL) {
			lp->txF.skb = txF->frame.skb;
			lp->txF.port = txF->frame.port;

			txF->frame.skb = NULL;
			txF->frame.port = 0;

			list_del(&(txF->node));
			list_add(element, &(lp->txFree));

			lp->txQ_count--;

			if (lp->txQ_count < TX_Q_LOW_WATER_MARK) {
				if (lp->netif_queue_on == FALSE) {
					DBG_TX(DbgInfo, "Kickstarting Q: %d\n",
					       lp->txQ_count);
					netif_wake_queue(lp->dev);
					WL_WDS_NETIF_WAKE_QUEUE(lp);
					lp->netif_queue_on = TRUE;
				}
			}
		}
	}

	if (lp->txF.skb == NULL)
		return FALSE;

	/* If the device has resources (FIDs) available, then Tx the packet */
	/* Format the TxRequest and send it to the adapter */
	len = lp->txF.skb->len < ETH_ZLEN ? ETH_ZLEN : lp->txF.skb->len;

	desc = &(lp->desc_tx);
	desc->buf_addr = lp->txF.skb->data;
	desc->BUF_CNT = len;
	desc->next_desc_addr = NULL;

	status = hcf_send_msg(&(lp->hcfCtx), desc, lp->txF.port);

	if (status == HCF_SUCCESS) {
		lp->dev->trans_start = jiffies;

		DBG_TX(DbgInfo, "Transmit...\n");

		if (lp->txF.port == HCF_PORT_0) {
			lp->stats.tx_packets++;
			lp->stats.tx_bytes += lp->txF.skb->len;
		}
#ifdef USE_WDS
		else {
			lp->wds_port[((lp->txF.port >> 8) -
				      1)].stats.tx_packets++;
			lp->wds_port[((lp->txF.port >> 8) -
				      1)].stats.tx_bytes += lp->txF.skb->len;
		}

#endif /* USE_WDS */

		/* Free the skb and perform queue cleanup, as the buffer was
		   transmitted successfully */
		dev_consume_skb_any( lp->txF.skb );

		lp->txF.skb = NULL;
		lp->txF.port = 0;
	}

	return TRUE;
}				/* wl_send */

/*============================================================================*/

/*******************************************************************************
 *	wl_tx()
 *******************************************************************************
 *
 *  DESCRIPTION:
 *
 *      The Tx handler function for the network layer.
 *
 *  PARAMETERS:
 *
 *      skb - a pointer to the sk_buff structure containing the data to transfer.
 *      dev - a pointer to the device's net_device structure.
 *
 *  RETURNS:
 *
 *      0 on success
 *      1 on error
 *
 ******************************************************************************/
int wl_tx(struct sk_buff *skb, struct net_device *dev, int port)
{
	unsigned long flags;
	struct wl_private *lp = wl_priv(dev);
	WVLAN_LFRAME *txF = NULL;
	struct list_head *element;
    /*------------------------------------------------------------------------*/

	/* Grab the spinlock */
	wl_lock(lp, &flags);

	if (lp->flags & WVLAN2_UIL_BUSY) {
		DBG_WARNING(DbgInfo, "UIL has device blocked\n");
		/* Start dropping packets here??? */
		wl_unlock(lp, &flags);
		return 1;
	}
#ifdef USE_RTS
	if (lp->useRTS == 1) {
		DBG_PRINT("RTS: we're getting a Tx...\n");
		wl_unlock(lp, &flags);
		return 1;
	}
#endif /* USE_RTS */

	if (!lp->use_dma) {
		/* Get an element from the queue */
		element = lp->txFree.next;
		txF = (WVLAN_LFRAME *) list_entry(element, WVLAN_LFRAME, node);
		if (txF == NULL) {
			DBG_ERROR(DbgInfo, "Problem with list_entry\n");
			wl_unlock(lp, &flags);
			return 1;
		}
		/* Fill out the frame */
		txF->frame.skb = skb;
		txF->frame.port = port;
		/* Move the frame to the txQ */
		/* NOTE: Here's where we would do priority queueing */
		list_move(&(txF->node), &(lp->txQ[0]));

		lp->txQ_count++;
		if (lp->txQ_count >= DEFAULT_NUM_TX_FRAMES) {
			DBG_TX(DbgInfo, "Q Full: %d\n", lp->txQ_count);
			if (lp->netif_queue_on == TRUE) {
				netif_stop_queue(lp->dev);
				WL_WDS_NETIF_STOP_QUEUE(lp);
				lp->netif_queue_on = FALSE;
			}
		}
	}
	wl_act_int_off(lp);	/* Disable Interrupts */

	/* Send the data to the hardware using the appropriate method */
#ifdef ENABLE_DMA
	if (lp->use_dma) {
		wl_send_dma(lp, skb, port);
	} else
#endif
	{
		wl_send(lp);
	}
	/* Re-enable Interrupts, release the spinlock and return */
	wl_act_int_on(lp);
	wl_unlock(lp, &flags);
	return 0;
}				/* wl_tx */

/*============================================================================*/

/*******************************************************************************
 *	wl_rx()
 *******************************************************************************
 *
 *  DESCRIPTION:
 *
 *      The routine which performs data reception.
 *
 *  PARAMETERS:
 *
 *      dev - a pointer to the device's net_device structure.
 *
 *  RETURNS:
 *
 *      0 on success
 *      1 on error
 *
 ******************************************************************************/
int wl_rx(struct net_device *dev)
{
	int port;
	struct sk_buff *skb;
	struct wl_private *lp = wl_priv(dev);
	int status;
	hcf_16 pktlen;
	hcf_16 hfs_stat;
	DESC_STRCT *desc;
    /*------------------------------------------------------------------------*/

	DBG_PARAM(DbgInfo, "dev", "%s (0x%p)", dev->name, dev);

	if (!(lp->flags & WVLAN2_UIL_BUSY)) {

#ifdef USE_RTS
		if (lp->useRTS == 1) {
			DBG_PRINT("RTS: We're getting an Rx...\n");
			return -EIO;
		}
#endif /* USE_RTS */

		/* Read the HFS_STAT register from the lookahead buffer */
		hfs_stat = (hcf_16) ((lp->lookAheadBuf[HFS_STAT]) |
				     (lp->lookAheadBuf[HFS_STAT + 1] << 8));

		/* Make sure the frame isn't bad */
		if ((hfs_stat & HFS_STAT_ERR) != HCF_SUCCESS) {
			DBG_WARNING(DbgInfo,
				    "HFS_STAT_ERROR (0x%x) in Rx Packet\n",
				    lp->lookAheadBuf[HFS_STAT]);
			return -EIO;
		}

		/* Determine what port this packet is for */
		port = (hfs_stat >> 8) & 0x0007;
		DBG_RX(DbgInfo, "Rx frame for port %d\n", port);

		pktlen = lp->hcfCtx.IFB_RxLen;
		if (pktlen != 0) {
			skb = ALLOC_SKB(pktlen);
			if (skb != NULL) {
				/* Set the netdev based on the port */
				switch (port) {
#ifdef USE_WDS
				case 1:
				case 2:
				case 3:
				case 4:
				case 5:
				case 6:
					skb->dev = lp->wds_port[port - 1].dev;
					break;
#endif /* USE_WDS */

				case 0:
				default:
					skb->dev = dev;
					break;
				}

				desc = &(lp->desc_rx);

				desc->next_desc_addr = NULL;

/*
#define BLOCK_INPUT(buf, len) \
    desc->buf_addr = buf; \
    desc->BUF_SIZE = len; \
    status = hcf_rcv_msg(&(lp->hcfCtx), desc, 0)
*/

				GET_PACKET(skb->dev, skb, pktlen);

				if (status == HCF_SUCCESS) {
					netif_rx(skb);

					if (port == 0) {
						lp->stats.rx_packets++;
						lp->stats.rx_bytes += pktlen;
					}
#ifdef USE_WDS
					else {
						lp->wds_port[port -
							     1].stats.
						    rx_packets++;
						lp->wds_port[port -
							     1].stats.
						    rx_bytes += pktlen;
					}
#endif /* USE_WDS */

					dev->last_rx = jiffies;

#ifdef WIRELESS_EXT
#ifdef WIRELESS_SPY
					if (lp->spydata.spy_number > 0) {
						char *srcaddr =
						    skb->mac.raw +
						    MAC_ADDR_SIZE;

						wl_spy_gather(dev, srcaddr);
					}
#endif /* WIRELESS_SPY */
#endif /* WIRELESS_EXT */
				} else {
					DBG_ERROR(DbgInfo,
						  "Rx request to card FAILED\n");

					if (port == 0)
						lp->stats.rx_dropped++;
#ifdef USE_WDS
					else {
						lp->wds_port[port -
							     1].stats.
						    rx_dropped++;
					}
#endif /* USE_WDS */

					dev_kfree_skb(skb);
				}
			} else {
				DBG_ERROR(DbgInfo, "Could not alloc skb\n");

				if (port == 0)
					lp->stats.rx_dropped++;
#ifdef USE_WDS
				else {
					lp->wds_port[port -
						     1].stats.rx_dropped++;
				}
#endif /* USE_WDS */
			}
		}
	}

	return 0;
}				/* wl_rx */

/*============================================================================*/

/*******************************************************************************
 *	wl_multicast()
 *******************************************************************************
 *
 *  DESCRIPTION:
 *
 *      Function to handle multicast packets
 *
 *  PARAMETERS:
 *
 *      dev - a pointer to the device's net_device structure.
 *
 *  RETURNS:
 *
 *      N/A
 *
 ******************************************************************************/
#ifdef NEW_MULTICAST

void wl_multicast(struct net_device *dev)
{
#if 1				/* (HCF_TYPE) & HCF_TYPE_STA */
	/*
	 * should we return an error status in AP mode ?
	 * seems reasonable that even an AP-only driver
	 * could afford this small additional footprint
	 */

	int x;
	struct netdev_hw_addr *ha;
	struct wl_private *lp = wl_priv(dev);
	unsigned long flags;

	DBG_PARAM(DbgInfo, "dev", "%s (0x%p)", dev->name, dev);

	if (!wl_adapter_is_open(dev))
		return;

#if DBG
	if (DBG_FLAGS(DbgInfo) & DBG_PARAM_ON) {
		DBG_PRINT("  flags: %s%s%s\n",
			  (dev->flags & IFF_PROMISC) ? "Promiscuous " : "",
			  (dev->flags & IFF_MULTICAST) ? "Multicast " : "",
			  (dev->flags & IFF_ALLMULTI) ? "All-Multicast" : "");

		DBG_PRINT("  mc_count: %d\n", netdev_mc_count(dev));

		netdev_for_each_mc_addr(ha, dev)
		    DBG_PRINT("    %pM (%d)\n", ha->addr, dev->addr_len);
	}
#endif /* DBG */

	if (!(lp->flags & WVLAN2_UIL_BUSY)) {

#ifdef USE_RTS
		if (lp->useRTS == 1) {
			DBG_TRACE(DbgInfo, "Skipping multicast, in RTS mode\n");
			return;
		}
#endif /* USE_RTS */

		wl_lock(lp, &flags);
		wl_act_int_off(lp);

		if (CNV_INT_TO_LITTLE(lp->hcfCtx.IFB_FWIdentity.comp_id) ==
		    COMP_ID_FW_STA) {
			if (dev->flags & IFF_PROMISC) {
				/* Enable promiscuous mode */
				lp->ltvRecord.len = 2;
				lp->ltvRecord.typ = CFG_PROMISCUOUS_MODE;
				lp->ltvRecord.u.u16[0] = CNV_INT_TO_LITTLE(1);
				DBG_PRINT
				    ("Enabling Promiscuous mode (IFF_PROMISC)\n");
				hcf_put_info(&(lp->hcfCtx),
					     (LTVP) & (lp->ltvRecord));
			} else if ((netdev_mc_count(dev) > HCF_MAX_MULTICAST)
				   || (dev->flags & IFF_ALLMULTI)) {
				/* Shutting off this filter will enable all multicast frames to
				   be sent up from the device; however, this is a static RID, so
				   a call to wl_apply() is needed */
				lp->ltvRecord.len = 2;
				lp->ltvRecord.typ = CFG_CNF_RX_ALL_GROUP_ADDR;
				lp->ltvRecord.u.u16[0] = CNV_INT_TO_LITTLE(0);
				DBG_PRINT
				    ("Enabling all multicast mode (IFF_ALLMULTI)\n");
				hcf_put_info(&(lp->hcfCtx),
					     (LTVP) & (lp->ltvRecord));
				wl_apply(lp);
			} else if (!netdev_mc_empty(dev)) {
				/* Set the multicast addresses */
				lp->ltvRecord.len =
				    (netdev_mc_count(dev) * 3) + 1;
				lp->ltvRecord.typ = CFG_GROUP_ADDR;

				x = 0;
				netdev_for_each_mc_addr(ha, dev)
				    memcpy(&
					   (lp->ltvRecord.u.u8[x++ * ETH_ALEN]),
					   ha->addr, ETH_ALEN);
				DBG_PRINT("Setting multicast list\n");
				hcf_put_info(&(lp->hcfCtx),
					     (LTVP) & (lp->ltvRecord));
			} else {
				/* Disable promiscuous mode */
				lp->ltvRecord.len = 2;
				lp->ltvRecord.typ = CFG_PROMISCUOUS_MODE;
				lp->ltvRecord.u.u16[0] = CNV_INT_TO_LITTLE(0);
				DBG_PRINT("Disabling Promiscuous mode\n");
				hcf_put_info(&(lp->hcfCtx),
					     (LTVP) & (lp->ltvRecord));

				/* Disable multicast mode */
				lp->ltvRecord.len = 2;
				lp->ltvRecord.typ = CFG_GROUP_ADDR;
				DBG_PRINT("Disabling Multicast mode\n");
				hcf_put_info(&(lp->hcfCtx),
					     (LTVP) & (lp->ltvRecord));

				/*
				 * Turning on this filter will prevent all multicast frames from
				 * being sent up from the device; however, this is a static RID,
				 * so a call to wl_apply() is needed
				 */
				lp->ltvRecord.len = 2;
				lp->ltvRecord.typ = CFG_CNF_RX_ALL_GROUP_ADDR;
				lp->ltvRecord.u.u16[0] = CNV_INT_TO_LITTLE(1);
				DBG_PRINT
				    ("Disabling all multicast mode (IFF_ALLMULTI)\n");
				hcf_put_info(&(lp->hcfCtx),
					     (LTVP) & (lp->ltvRecord));
				wl_apply(lp);
			}
		}
		wl_act_int_on(lp);
		wl_unlock(lp, &flags);
	}
#endif /* HCF_STA */
}				/* wl_multicast */

/*============================================================================*/

#else /* NEW_MULTICAST */

void wl_multicast(struct net_device *dev, int num_addrs, void *addrs)
{
	DBG_PARAM(DbgInfo, "dev", "%s (0x%p)", dev->name, dev);
	DBG_PARAM(DbgInfo, "num_addrs", "%d", num_addrs);
	DBG_PARAM(DbgInfo, "addrs", "0x%p", addrs);

#error Obsolete set multicast interface!
}				/* wl_multicast */

/*============================================================================*/

#endif /* NEW_MULTICAST */

static const struct net_device_ops wl_netdev_ops = {
	.ndo_start_xmit = &wl_tx_port0,

	.ndo_set_config = &wl_config,
	.ndo_get_stats = &wl_stats,
	.ndo_set_rx_mode = &wl_multicast,

	.ndo_init = &wl_insert,
	.ndo_open = &wl_adapter_open,
	.ndo_stop = &wl_adapter_close,
	.ndo_do_ioctl = &wl_ioctl,

	.ndo_tx_timeout = &wl_tx_timeout,

#ifdef CONFIG_NET_POLL_CONTROLLER
	.ndo_poll_controller = wl_poll,
#endif
};

/*******************************************************************************
 *	wl_device_alloc()
 *******************************************************************************
 *
 *  DESCRIPTION:
 *
 *      Create instances of net_device and wl_private for the new adapter
 *  and register the device's entry points in the net_device structure.
 *
 *  PARAMETERS:
 *
 *      N/A
 *
 *  RETURNS:
 *
 *      a pointer to an allocated and initialized net_device struct for this
 *      device.
 *
 ******************************************************************************/
struct net_device *wl_device_alloc(void)
{
	struct net_device *dev = NULL;
	struct wl_private *lp = NULL;

	/* Alloc a net_device struct */
	dev = alloc_etherdev(sizeof(struct wl_private));
	if (!dev)
		return NULL;

	/*
	 * Initialize the 'next' pointer in the struct.
	 * Currently only used for PCI,
	 * but do it here just in case it's used
	 * for other buses in the future
	 */
	lp = wl_priv(dev);

	/* Check MTU */
	if (dev->mtu > MTU_MAX) {
		DBG_WARNING(DbgInfo, "%s: MTU set too high, limiting to %d.\n",
			    dev->name, MTU_MAX);
		dev->mtu = MTU_MAX;
	}

	/* Setup the function table in the device structure. */

	dev->wireless_handlers = (struct iw_handler_def *)&wl_iw_handler_def;
	lp->wireless_data.spy_data = &lp->spy_data;
	dev->wireless_data = &lp->wireless_data;

	dev->netdev_ops = &wl_netdev_ops;

	dev->watchdog_timeo = TX_TIMEOUT;

	dev->ethtool_ops = &wl_ethtool_ops;

	netif_stop_queue(dev);

	/* Allocate virtual devices for WDS support if needed */
	WL_WDS_DEVICE_ALLOC(lp);

	return dev;
}				/* wl_device_alloc */

/*============================================================================*/

/*******************************************************************************
 *	wl_device_dealloc()
 *******************************************************************************
 *
 *  DESCRIPTION:
 *
 *      Free instances of net_device and wl_private strcutres for an adapter
 *  and perform basic cleanup.
 *
 *  PARAMETERS:
 *
 *      dev - a pointer to the device's net_device structure.
 *
 *  RETURNS:
 *
 *      N/A
 *
 ******************************************************************************/
void wl_device_dealloc(struct net_device *dev)
{
	/* Dealloc the WDS ports */
	WL_WDS_DEVICE_DEALLOC(lp);

	free_netdev(dev);
}				/* wl_device_dealloc */

/*============================================================================*/

/*******************************************************************************
 *	wl_tx_port0()
 *******************************************************************************
 *
 *  DESCRIPTION:
 *
 *      The handler routine for Tx over HCF_PORT_0.
 *
 *  PARAMETERS:
 *
 *      skb - a pointer to the sk_buff to transmit.
 *      dev - a pointer to a net_device structure representing HCF_PORT_0.
 *
 *  RETURNS:
 *
 *      N/A
 *
 ******************************************************************************/
int wl_tx_port0(struct sk_buff *skb, struct net_device *dev)
{
	DBG_TX(DbgInfo, "Tx on Port 0\n");

	return wl_tx(skb, dev, HCF_PORT_0);
#ifdef ENABLE_DMA
	return wl_tx_dma(skb, dev, HCF_PORT_0);
#endif
}				/* wl_tx_port0i */

/*============================================================================*/

#ifdef USE_WDS

/*******************************************************************************
 *	wl_tx_port1()
 *******************************************************************************
 *
 *  DESCRIPTION:
 *
 *      The handler routine for Tx over HCF_PORT_1.
 *
 *  PARAMETERS:
 *
 *      skb - a pointer to the sk_buff to transmit.
 *      dev - a pointer to a net_device structure representing HCF_PORT_1.
 *
 *  RETURNS:
 *
 *      N/A
 *
 ******************************************************************************/
int wl_tx_port1(struct sk_buff *skb, struct net_device *dev)
{
	DBG_TX(DbgInfo, "Tx on Port 1\n");
	return wl_tx(skb, dev, HCF_PORT_1);
}				/* wl_tx_port1 */

/*============================================================================*/

/*******************************************************************************
 *	wl_tx_port2()
 *******************************************************************************
 *
 *  DESCRIPTION:
 *
 *      The handler routine for Tx over HCF_PORT_2.
 *
 *  PARAMETERS:
 *
 *      skb - a pointer to the sk_buff to transmit.
 *      dev - a pointer to a net_device structure representing HCF_PORT_2.
 *
 *  RETURNS:
 *
 *      N/A
 *
 ******************************************************************************/
int wl_tx_port2(struct sk_buff *skb, struct net_device *dev)
{
	DBG_TX(DbgInfo, "Tx on Port 2\n");
	return wl_tx(skb, dev, HCF_PORT_2);
}				/* wl_tx_port2 */

/*============================================================================*/

/*******************************************************************************
 *	wl_tx_port3()
 *******************************************************************************
 *
 *  DESCRIPTION:
 *
 *      The handler routine for Tx over HCF_PORT_3.
 *
 *  PARAMETERS:
 *
 *      skb - a pointer to the sk_buff to transmit.
 *      dev - a pointer to a net_device structure representing HCF_PORT_3.
 *
 *  RETURNS:
 *
 *      N/A
 *
 ******************************************************************************/
int wl_tx_port3(struct sk_buff *skb, struct net_device *dev)
{
	DBG_TX(DbgInfo, "Tx on Port 3\n");
	return wl_tx(skb, dev, HCF_PORT_3);
}				/* wl_tx_port3 */

/*============================================================================*/

/*******************************************************************************
 *	wl_tx_port4()
 *******************************************************************************
 *
 *  DESCRIPTION:
 *
 *      The handler routine for Tx over HCF_PORT_4.
 *
 *  PARAMETERS:
 *
 *      skb - a pointer to the sk_buff to transmit.
 *      dev - a pointer to a net_device structure representing HCF_PORT_4.
 *
 *  RETURNS:
 *
 *      N/A
 *
 ******************************************************************************/
int wl_tx_port4(struct sk_buff *skb, struct net_device *dev)
{
	DBG_TX(DbgInfo, "Tx on Port 4\n");
	return wl_tx(skb, dev, HCF_PORT_4);
}				/* wl_tx_port4 */

/*============================================================================*/

/*******************************************************************************
 *	wl_tx_port5()
 *******************************************************************************
 *
 *  DESCRIPTION:
 *
 *      The handler routine for Tx over HCF_PORT_5.
 *
 *  PARAMETERS:
 *
 *      skb - a pointer to the sk_buff to transmit.
 *      dev - a pointer to a net_device structure representing HCF_PORT_5.
 *
 *  RETURNS:
 *
 *      N/A
 *
 ******************************************************************************/
int wl_tx_port5(struct sk_buff *skb, struct net_device *dev)
{
	DBG_TX(DbgInfo, "Tx on Port 5\n");
	return wl_tx(skb, dev, HCF_PORT_5);
}				/* wl_tx_port5 */

/*============================================================================*/

/*******************************************************************************
 *	wl_tx_port6()
 *******************************************************************************
 *
 *  DESCRIPTION:
 *
 *      The handler routine for Tx over HCF_PORT_6.
 *
 *  PARAMETERS:
 *
 *      skb - a pointer to the sk_buff to transmit.
 *      dev - a pointer to a net_device structure representing HCF_PORT_6.
 *
 *  RETURNS:
 *
 *      N/A
 *
 ******************************************************************************/
int wl_tx_port6(struct sk_buff *skb, struct net_device *dev)
{
	DBG_TX(DbgInfo, "Tx on Port 6\n");
	return wl_tx(skb, dev, HCF_PORT_6);
}				/* wl_tx_port6 */

/*============================================================================*/

/*******************************************************************************
 *	wl_wds_device_alloc()
 *******************************************************************************
 *
 *  DESCRIPTION:
 *
 *      Create instances of net_device to represent the WDS ports, and register
 *  the device's entry points in the net_device structure.
 *
 *  PARAMETERS:
 *
 *      lp  - a pointer to the device's private adapter structure
 *
 *  RETURNS:
 *
 *      N/A, but will place pointers to the allocated and initialized net_device
 *      structs in the private adapter structure.
 *
 ******************************************************************************/
void wl_wds_device_alloc(struct wl_private *lp)
{
	int count;

	/* WDS support requires additional net_device structs to be allocated,
	   so that user space apps can use these virtual devices to specify the
	   port on which to Tx/Rx */
	for (count = 0; count < NUM_WDS_PORTS; count++) {
		struct net_device *dev_wds = NULL;

		dev_wds = kzalloc(sizeof(struct net_device), GFP_KERNEL);
		if (!dev_wds)
			return;

		ether_setup(dev_wds);

		lp->wds_port[count].dev = dev_wds;

		/* Re-use wl_init for all the devices, as it currently does nothing, but
		 * is required. Re-use the stats/tx_timeout handler for all as well; the
		 * WDS port which is requesting these operations can be determined by
		 * the net_device pointer. Set the private member of all devices to point
		 * to the same net_device struct; that way, all information gets
		 * funnelled through the one "real" net_device. Name the WDS ports
		 * "wds<n>"
		 * */
		lp->wds_port[count].dev->init = &wl_init;
		lp->wds_port[count].dev->get_stats = &wl_stats;
		lp->wds_port[count].dev->tx_timeout = &wl_tx_timeout;
		lp->wds_port[count].dev->watchdog_timeo = TX_TIMEOUT;
		lp->wds_port[count].dev->priv = lp;

		sprintf(lp->wds_port[count].dev->name, "wds%d", count);
	}

	/* Register the Tx handlers */
	lp->wds_port[0].dev->hard_start_xmit = &wl_tx_port1;
	lp->wds_port[1].dev->hard_start_xmit = &wl_tx_port2;
	lp->wds_port[2].dev->hard_start_xmit = &wl_tx_port3;
	lp->wds_port[3].dev->hard_start_xmit = &wl_tx_port4;
	lp->wds_port[4].dev->hard_start_xmit = &wl_tx_port5;
	lp->wds_port[5].dev->hard_start_xmit = &wl_tx_port6;

	WL_WDS_NETIF_STOP_QUEUE(lp);
}				/* wl_wds_device_alloc */

/*============================================================================*/

/*******************************************************************************
 *	wl_wds_device_dealloc()
 *******************************************************************************
 *
 *  DESCRIPTION:
 *
 *      Free instances of net_device structures used to support WDS.
 *
 *  PARAMETERS:
 *
 *      lp  - a pointer to the device's private adapter structure
 *
 *  RETURNS:
 *
 *      N/A
 *
 ******************************************************************************/
void wl_wds_device_dealloc(struct wl_private *lp)
{
	int count;

	for (count = 0; count < NUM_WDS_PORTS; count++) {
		struct net_device *dev_wds = NULL;

		dev_wds = lp->wds_port[count].dev;

		if (dev_wds != NULL) {
			if (dev_wds->flags & IFF_UP) {
				dev_close(dev_wds);
				dev_wds->flags &= ~(IFF_UP | IFF_RUNNING);
			}

			free_netdev(dev_wds);
			lp->wds_port[count].dev = NULL;
		}
	}
}				/* wl_wds_device_dealloc */

/*============================================================================*/

/*******************************************************************************
 *	wl_wds_netif_start_queue()
 *******************************************************************************
 *
 *  DESCRIPTION:
 *
 *      Used to start the netif queues of all the "virtual" network devices
 *      which represent the WDS ports.
 *
 *  PARAMETERS:
 *
 *      lp  - a pointer to the device's private adapter structure
 *
 *  RETURNS:
 *
 *      N/A
 *
 ******************************************************************************/
void wl_wds_netif_start_queue(struct wl_private *lp)
{
	int count;
    /*------------------------------------------------------------------------*/

	if (lp != NULL) {
		for (count = 0; count < NUM_WDS_PORTS; count++) {
			if (lp->wds_port[count].is_registered &&
			    lp->wds_port[count].netif_queue_on == FALSE) {
				netif_start_queue(lp->wds_port[count].dev);
				lp->wds_port[count].netif_queue_on = TRUE;
			}
		}
	}
}				/* wl_wds_netif_start_queue */

/*============================================================================*/

/*******************************************************************************
 *	wl_wds_netif_stop_queue()
 *******************************************************************************
 *
 *  DESCRIPTION:
 *
 *      Used to stop the netif queues of all the "virtual" network devices
 *      which represent the WDS ports.
 *
 *  PARAMETERS:
 *
 *      lp  - a pointer to the device's private adapter structure
 *
 *  RETURNS:
 *
 *      N/A
 *
 ******************************************************************************/
void wl_wds_netif_stop_queue(struct wl_private *lp)
{
	int count;
    /*------------------------------------------------------------------------*/

	if (lp != NULL) {
		for (count = 0; count < NUM_WDS_PORTS; count++) {
			if (lp->wds_port[count].is_registered &&
			    lp->wds_port[count].netif_queue_on == TRUE) {
				netif_stop_queue(lp->wds_port[count].dev);
				lp->wds_port[count].netif_queue_on = FALSE;
			}
		}
	}
}				/* wl_wds_netif_stop_queue */

/*============================================================================*/

/*******************************************************************************
 *	wl_wds_netif_wake_queue()
 *******************************************************************************
 *
 *  DESCRIPTION:
 *
 *      Used to wake the netif queues of all the "virtual" network devices
 *      which represent the WDS ports.
 *
 *  PARAMETERS:
 *
 *      lp  - a pointer to the device's private adapter structure
 *
 *  RETURNS:
 *
 *      N/A
 *
 ******************************************************************************/
void wl_wds_netif_wake_queue(struct wl_private *lp)
{
	int count;
    /*------------------------------------------------------------------------*/

	if (lp != NULL) {
		for (count = 0; count < NUM_WDS_PORTS; count++) {
			if (lp->wds_port[count].is_registered &&
			    lp->wds_port[count].netif_queue_on == FALSE) {
				netif_wake_queue(lp->wds_port[count].dev);
				lp->wds_port[count].netif_queue_on = TRUE;
			}
		}
	}
}				/* wl_wds_netif_wake_queue */

/*============================================================================*/

/*******************************************************************************
 *	wl_wds_netif_carrier_on()
 *******************************************************************************
 *
 *  DESCRIPTION:
 *
 *      Used to signal the network layer that carrier is present on all of the
 *      "virtual" network devices which represent the WDS ports.
 *
 *  PARAMETERS:
 *
 *      lp  - a pointer to the device's private adapter structure
 *
 *  RETURNS:
 *
 *      N/A
 *
 ******************************************************************************/
void wl_wds_netif_carrier_on(struct wl_private *lp)
{
	int count;
    /*------------------------------------------------------------------------*/

	if (lp != NULL) {
		for (count = 0; count < NUM_WDS_PORTS; count++) {
			if (lp->wds_port[count].is_registered)
				netif_carrier_on(lp->wds_port[count].dev);
		}
	}
}				/* wl_wds_netif_carrier_on */

/*============================================================================*/

/*******************************************************************************
 *	wl_wds_netif_carrier_off()
 *******************************************************************************
 *
 *  DESCRIPTION:
 *
 *      Used to signal the network layer that carrier is NOT present on all of
 *      the "virtual" network devices which represent the WDS ports.
 *
 *  PARAMETERS:
 *
 *      lp  - a pointer to the device's private adapter structure
 *
 *  RETURNS:
 *
 *      N/A
 *
 ******************************************************************************/
void wl_wds_netif_carrier_off(struct wl_private *lp)
{
	int count;

	if (lp != NULL) {
		for (count = 0; count < NUM_WDS_PORTS; count++) {
			if (lp->wds_port[count].is_registered)
				netif_carrier_off(lp->wds_port[count].dev);
		}
	}

}				/* wl_wds_netif_carrier_off */

/*============================================================================*/

#endif /* USE_WDS */

#ifdef ENABLE_DMA
/*******************************************************************************
 *	wl_send_dma()
 *******************************************************************************
 *
 *  DESCRIPTION:
 *
 *      The routine which performs data transmits when using busmaster DMA.
 *
 *  PARAMETERS:
 *
 *      lp   - a pointer to the device's wl_private struct.
 *      skb  - a pointer to the network layer's data buffer.
 *      port - the Hermes port on which to transmit.
 *
 *  RETURNS:
 *
 *      0 on success
 *      1 on error
 *
 ******************************************************************************/
int wl_send_dma(struct wl_private *lp, struct sk_buff *skb, int port)
{
	int len;
	DESC_STRCT *desc = NULL;
	DESC_STRCT *desc_next = NULL;
    /*------------------------------------------------------------------------*/

	if (lp == NULL) {
		DBG_ERROR(DbgInfo, "Private adapter struct is NULL\n");
		return FALSE;
	}

	if (lp->dev == NULL) {
		DBG_ERROR(DbgInfo, "net_device struct in wl_private is NULL\n");
		return FALSE;
	}

	/* AGAIN, ALL THE QUEUEING DONE HERE IN I/O MODE IS NOT PERFORMED */

	if (skb == NULL) {
		DBG_WARNING(DbgInfo, "Nothing to send.\n");
		return FALSE;
	}

	len = skb->len;

	/* Get a free descriptor */
	desc = wl_pci_dma_get_tx_packet(lp);

	if (desc == NULL) {
		if (lp->netif_queue_on == TRUE) {
			netif_stop_queue(lp->dev);
			WL_WDS_NETIF_STOP_QUEUE(lp);
			lp->netif_queue_on = FALSE;

			dev_kfree_skb_any( skb );
			return 0;
		}
	}

	SET_BUF_CNT(desc, /*HCF_DMA_FD_CNT */ HFS_ADDR_DEST);
	SET_BUF_SIZE(desc, HCF_DMA_TX_BUF1_SIZE);

	desc_next = desc->next_desc_addr;

	if (desc_next->buf_addr == NULL) {
		DBG_ERROR(DbgInfo, "DMA descriptor buf_addr is NULL\n");
		return FALSE;
	}

	/* Copy the payload into the DMA packet */
	memcpy(desc_next->buf_addr, skb->data, len);

	SET_BUF_CNT(desc_next, len);
	SET_BUF_SIZE(desc_next, HCF_MAX_PACKET_SIZE);

	hcf_dma_tx_put(&(lp->hcfCtx), desc, 0);

	/* Free the skb and perform queue cleanup, as the buffer was
	   transmitted successfully */
	dev_consume_skb_any( skb );

	return TRUE;
}				/* wl_send_dma */

/*============================================================================*/

/*******************************************************************************
 *	wl_rx_dma()
 *******************************************************************************
 *
 *  DESCRIPTION:
 *
 *      The routine which performs data reception when using busmaster DMA.
 *
 *  PARAMETERS:
 *
 *      dev - a pointer to the device's net_device structure.
 *
 *  RETURNS:
 *
 *      0 on success
 *      1 on error
 *
 ******************************************************************************/
int wl_rx_dma(struct net_device *dev)
{
	int port;
	hcf_16 pktlen;
	hcf_16 hfs_stat;
	struct sk_buff *skb;
	struct wl_private *lp = NULL;
	DESC_STRCT *desc, *desc_next;
    /*------------------------------------------------------------------------*/

	DBG_PARAM(DbgInfo, "dev", "%s (0x%p)", dev->name, dev);

	lp = dev->priv;
	if ((lp != NULL) && !(lp->flags & WVLAN2_UIL_BUSY)) {

#ifdef USE_RTS
		if (lp->useRTS == 1) {
			DBG_PRINT("RTS: We're getting an Rx...\n");
			return -EIO;
		}
#endif /* USE_RTS */

		/*
		 *if( lp->dma.status == 0 )
		 *{
		 */
		desc = hcf_dma_rx_get(&(lp->hcfCtx));

		if (desc != NULL) {
			/* Check and see if we rcvd. a WMP frame */
			/*
			   if((( *(hcf_8 *)&desc->buf_addr[HFS_STAT] ) &
			   ( HFS_STAT_MSG_TYPE | HFS_STAT_ERR )) == HFS_STAT_WMP_MSG )
			   {
			   DBG_TRACE( DbgInfo, "Got a WMP frame\n" );

			   x.len = sizeof( CFG_MB_INFO_RANGE2_STRCT ) / sizeof( hcf_16 );
			   x.typ = CFG_MB_INFO;
			   x.base_typ = CFG_WMP;
			   x.frag_cnt = 2;
			   x.frag_buf[0].frag_len  = GET_BUF_CNT( descp ) / sizeof( hcf_16 );
			   x.frag_buf[0].frag_addr = (hcf_8 *) descp->buf_addr ;
			   x.frag_buf[1].frag_len  = ( GET_BUF_CNT( descp->next_desc_addr ) + 1 ) / sizeof( hcf_16 );
			   x.frag_buf[1].frag_addr = (hcf_8 *) descp->next_desc_addr->buf_addr ;

			   hcf_put_info( &( lp->hcfCtx ), (LTVP)&x );
			   }
			 */

			desc_next = desc->next_desc_addr;

			/* Make sure the buffer isn't empty */
			if (GET_BUF_CNT(desc) == 0) {
				DBG_WARNING(DbgInfo, "Buffer is empty!\n");

				/* Give the descriptor back to the HCF */
				hcf_dma_rx_put(&(lp->hcfCtx), desc);
				return -EIO;
			}

			/* Read the HFS_STAT register from the lookahead buffer */
			hfs_stat = (hcf_16) (desc->buf_addr[HFS_STAT / 2]);

			/* Make sure the frame isn't bad */
			if ((hfs_stat & HFS_STAT_ERR) != HCF_SUCCESS) {
				DBG_WARNING(DbgInfo,
					    "HFS_STAT_ERROR (0x%x) in Rx Packet\n",
					    desc->buf_addr[HFS_STAT / 2]);

				/* Give the descriptor back to the HCF */
				hcf_dma_rx_put(&(lp->hcfCtx), desc);
				return -EIO;
			}

			/* Determine what port this packet is for */
			port = (hfs_stat >> 8) & 0x0007;
			DBG_RX(DbgInfo, "Rx frame for port %d\n", port);

			pktlen = GET_BUF_CNT(desc_next);
			if (pktlen != 0) {
				skb = ALLOC_SKB(pktlen);
				if (skb != NULL) {
					switch (port) {
#ifdef USE_WDS
					case 1:
					case 2:
					case 3:
					case 4:
					case 5:
					case 6:
						skb->dev =
						    lp->wds_port[port - 1].dev;
						break;
#endif /* USE_WDS */

					case 0:
					default:
						skb->dev = dev;
						break;
					}

					GET_PACKET_DMA(skb->dev, skb, pktlen);

					/* Give the descriptor back to the HCF */
					hcf_dma_rx_put(&(lp->hcfCtx), desc);

					netif_rx(skb);

					if (port == 0) {
						lp->stats.rx_packets++;
						lp->stats.rx_bytes += pktlen;
					}
#ifdef USE_WDS
					else {
						lp->wds_port[port -
							     1].stats.
						    rx_packets++;
						lp->wds_port[port -
							     1].stats.
						    rx_bytes += pktlen;
					}
#endif /* USE_WDS */

					dev->last_rx = jiffies;

				} else {
					DBG_ERROR(DbgInfo,
						  "Could not alloc skb\n");

					if (port == 0)
						lp->stats.rx_dropped++;
#ifdef USE_WDS
					else {
						lp->wds_port[port -
							     1].stats.
						    rx_dropped++;
					}
#endif /* USE_WDS */
				}
			}
		}
		/*}*/
	}

	return 0;
}				/* wl_rx_dma */

/*============================================================================*/
#endif /* ENABLE_DMA */