1 files changed, 260 insertions, 0 deletions

diff --git a/drivers/net/wireless/prism54/isl_38xx.c b/drivers/net/wireless/prism54/isl_38xx.c
new file mode 100644
index 000000000000..4481ec18c5a0
--- /dev/null
+++ b/drivers/net/wireless/prism54/isl_38xx.c
@@ -0,0 +1,260 @@
+/*
+ *  
+ *  Copyright (C) 2002 Intersil Americas Inc.
+ *  Copyright (C) 2003-2004 Luis R. Rodriguez <mcgrof@ruslug.rutgers.edu>_
+ *
+ *  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; either 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.
+ *
+ *  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
+ *
+ */
+
+#include <linux/version.h>
+#include <linux/module.h>
+#include <linux/types.h>
+#include <linux/delay.h>
+
+#include <asm/uaccess.h>
+#include <asm/io.h>
+
+#include "prismcompat.h"
+#include "isl_38xx.h"
+#include "islpci_dev.h"
+#include "islpci_mgt.h"
+
+/******************************************************************************
+    Device Interface & Control functions
+******************************************************************************/
+
+/**
+ * isl38xx_disable_interrupts - disable all interrupts
+ * @device: pci memory base address
+ *
+ *  Instructs the device to disable all interrupt reporting by asserting 
+ *  the IRQ line. New events may still show up in the interrupt identification
+ *  register located at offset %ISL38XX_INT_IDENT_REG.
+ */
+void
+isl38xx_disable_interrupts(void __iomem *device)
+{
+        isl38xx_w32_flush(device, 0x00000000, ISL38XX_INT_EN_REG);
+        udelay(ISL38XX_WRITEIO_DELAY);
+}
+
+void
+isl38xx_handle_sleep_request(isl38xx_control_block *control_block,
+                             int *powerstate, void __iomem *device_base)
+{
+        /* device requests to go into sleep mode
+         * check whether the transmit queues for data and management are empty */
+        if (isl38xx_in_queue(control_block, ISL38XX_CB_TX_DATA_LQ))
+                /* data tx queue not empty */
+                return;
+
+        if (isl38xx_in_queue(control_block, ISL38XX_CB_TX_MGMTQ))
+                /* management tx queue not empty */
+                return;
+
+        /* check also whether received frames are pending */
+        if (isl38xx_in_queue(control_block, ISL38XX_CB_RX_DATA_LQ))
+                /* data rx queue not empty */
+                return;
+
+        if (isl38xx_in_queue(control_block, ISL38XX_CB_RX_MGMTQ))
+                /* management rx queue not empty */
+                return;
+
+#if VERBOSE > SHOW_ERROR_MESSAGES
+        DEBUG(SHOW_TRACING, "Device going to sleep mode\n");
+#endif
+
+        /* all queues are empty, allow the device to go into sleep mode */
+        *powerstate = ISL38XX_PSM_POWERSAVE_STATE;
+
+        /* assert the Sleep interrupt in the Device Interrupt Register */
+        isl38xx_w32_flush(device_base, ISL38XX_DEV_INT_SLEEP,
+                          ISL38XX_DEV_INT_REG);
+        udelay(ISL38XX_WRITEIO_DELAY);
+}
+
+void
+isl38xx_handle_wakeup(isl38xx_control_block *control_block,
+                      int *powerstate, void __iomem *device_base)
+{
+        /* device is in active state, update the powerstate flag */
+        *powerstate = ISL38XX_PSM_ACTIVE_STATE;
+
+        /* now check whether there are frames pending for the card */
+        if (!isl38xx_in_queue(control_block, ISL38XX_CB_TX_DATA_LQ)
+            && !isl38xx_in_queue(control_block, ISL38XX_CB_TX_MGMTQ))
+                return;
+
+#if VERBOSE > SHOW_ERROR_MESSAGES
+        DEBUG(SHOW_ANYTHING, "Wake up handler trigger the device\n");
+#endif
+
+        /* either data or management transmit queue has a frame pending
+         * trigger the device by setting the Update bit in the Device Int reg */
+        isl38xx_w32_flush(device_base, ISL38XX_DEV_INT_UPDATE,
+                          ISL38XX_DEV_INT_REG);
+        udelay(ISL38XX_WRITEIO_DELAY);
+}
+
+void
+isl38xx_trigger_device(int asleep, void __iomem *device_base)
+{
+        struct timeval current_time;
+        u32 reg, counter = 0;
+
+#if VERBOSE > SHOW_ERROR_MESSAGES
+        DEBUG(SHOW_FUNCTION_CALLS, "isl38xx trigger device\n");
+#endif
+
+        /* check whether the device is in power save mode */
+        if (asleep) {
+                /* device is in powersave, trigger the device for wakeup */
+#if VERBOSE > SHOW_ERROR_MESSAGES
+                do_gettimeofday(&current_time);
+                DEBUG(SHOW_TRACING, "%08li.%08li Device wakeup triggered\n",
+                      current_time.tv_sec, (long)current_time.tv_usec);
+#endif
+
+                DEBUG(SHOW_TRACING, "%08li.%08li Device register read %08x\n",
+                      current_time.tv_sec, (long)current_time.tv_usec,
+                      readl(device_base + ISL38XX_CTRL_STAT_REG));
+                udelay(ISL38XX_WRITEIO_DELAY);
+
+                reg = readl(device_base + ISL38XX_INT_IDENT_REG);
+                if (reg == 0xabadface) {
+#if VERBOSE > SHOW_ERROR_MESSAGES
+                        do_gettimeofday(&current_time);
+                        DEBUG(SHOW_TRACING,
+                              "%08li.%08li Device register abadface\n",
+                              current_time.tv_sec, (long)current_time.tv_usec);
+#endif
+                        /* read the Device Status Register until Sleepmode bit is set */
+                        while (reg = readl(device_base + ISL38XX_CTRL_STAT_REG),
+                               (reg & ISL38XX_CTRL_STAT_SLEEPMODE) == 0) {
+                                udelay(ISL38XX_WRITEIO_DELAY);
+                                counter++;
+                        }
+
+                        DEBUG(SHOW_TRACING,
+                              "%08li.%08li Device register read %08x\n",
+                              current_time.tv_sec, (long)current_time.tv_usec,
+                              readl(device_base + ISL38XX_CTRL_STAT_REG));
+                        udelay(ISL38XX_WRITEIO_DELAY);
+
+#if VERBOSE > SHOW_ERROR_MESSAGES
+                        do_gettimeofday(&current_time);
+                        DEBUG(SHOW_TRACING,
+                              "%08li.%08li Device asleep counter %i\n",
+                              current_time.tv_sec, (long)current_time.tv_usec,
+                              counter);
+#endif
+                }
+                /* assert the Wakeup interrupt in the Device Interrupt Register */
+                isl38xx_w32_flush(device_base, ISL38XX_DEV_INT_WAKEUP,
+                                  ISL38XX_DEV_INT_REG);
+                udelay(ISL38XX_WRITEIO_DELAY);
+
+                /* perform another read on the Device Status Register */
+                reg = readl(device_base + ISL38XX_CTRL_STAT_REG);
+                udelay(ISL38XX_WRITEIO_DELAY);
+
+#if VERBOSE > SHOW_ERROR_MESSAGES
+                do_gettimeofday(&current_time);
+                DEBUG(SHOW_TRACING, "%08li.%08li Device register read %08x\n",
+                      current_time.tv_sec, (long)current_time.tv_usec, reg);
+#endif
+        } else {
+                /* device is (still) awake  */
+#if VERBOSE > SHOW_ERROR_MESSAGES
+                DEBUG(SHOW_TRACING, "Device is in active state\n");
+#endif
+                /* trigger the device by setting the Update bit in the Device Int reg */
+
+                isl38xx_w32_flush(device_base, ISL38XX_DEV_INT_UPDATE,
+                                  ISL38XX_DEV_INT_REG);
+                udelay(ISL38XX_WRITEIO_DELAY);
+        }
+}
+
+void
+isl38xx_interface_reset(void __iomem *device_base, dma_addr_t host_address)
+{
+#if VERBOSE > SHOW_ERROR_MESSAGES
+        DEBUG(SHOW_FUNCTION_CALLS, "isl38xx_interface_reset\n");
+#endif
+
+        /* load the address of the control block in the device */
+        isl38xx_w32_flush(device_base, host_address, ISL38XX_CTRL_BLK_BASE_REG);
+        udelay(ISL38XX_WRITEIO_DELAY);
+
+        /* set the reset bit in the Device Interrupt Register */
+        isl38xx_w32_flush(device_base, ISL38XX_DEV_INT_RESET, ISL38XX_DEV_INT_REG);
+        udelay(ISL38XX_WRITEIO_DELAY);
+
+        /* enable the interrupt for detecting initialization */
+
+        /* Note: Do not enable other interrupts here. We want the
+         * device to have come up first 100% before allowing any other 
+         * interrupts. */
+        isl38xx_w32_flush(device_base, ISL38XX_INT_IDENT_INIT, ISL38XX_INT_EN_REG);
+        udelay(ISL38XX_WRITEIO_DELAY);  /* allow complete full reset */
+}
+
+void
+isl38xx_enable_common_interrupts(void __iomem *device_base) {
+        u32 reg;
+        reg = ( ISL38XX_INT_IDENT_UPDATE | 
+                        ISL38XX_INT_IDENT_SLEEP | ISL38XX_INT_IDENT_WAKEUP);
+        isl38xx_w32_flush(device_base, reg, ISL38XX_INT_EN_REG);
+        udelay(ISL38XX_WRITEIO_DELAY);
+}
+
+int
+isl38xx_in_queue(isl38xx_control_block *cb, int queue)
+{
+        const s32 delta = (le32_to_cpu(cb->driver_curr_frag[queue]) -
+                           le32_to_cpu(cb->device_curr_frag[queue]));
+
+        /* determine the amount of fragments in the queue depending on the type
+         * of the queue, either transmit or receive */
+
+        BUG_ON(delta < 0);      /* driver ptr must be ahead of device ptr */
+
+        switch (queue) {
+                /* send queues */
+        case ISL38XX_CB_TX_MGMTQ:
+                BUG_ON(delta > ISL38XX_CB_MGMT_QSIZE);
+        case ISL38XX_CB_TX_DATA_LQ:
+        case ISL38XX_CB_TX_DATA_HQ:
+                BUG_ON(delta > ISL38XX_CB_TX_QSIZE);
+                return delta;
+                break;
+
+                /* receive queues */
+        case ISL38XX_CB_RX_MGMTQ:
+                BUG_ON(delta > ISL38XX_CB_MGMT_QSIZE);
+                return ISL38XX_CB_MGMT_QSIZE - delta;
+                break;
+
+        case ISL38XX_CB_RX_DATA_LQ:
+        case ISL38XX_CB_RX_DATA_HQ:
+                BUG_ON(delta > ISL38XX_CB_RX_QSIZE);
+                return ISL38XX_CB_RX_QSIZE - delta;
+                break;
+        }
+        BUG();
+        return 0;
+}