Fedora kernel-2.6.17-1.2142_FC4 patched with stable patch-2.6.17.4-vs2.0.2-rc26.diff
[linux-2.6.git] / drivers / net / wireless / orinoco_tmd.c
index 6e5ca46..5e68b70 100644 (file)
@@ -1,10 +1,10 @@
-/* orinoco_tmd.c 0.01
+/* orinoco_tmd.c
  * 
  * Driver for Prism II devices which would usually be driven by orinoco_cs,
  * but are connected to the PCI bus by a TMD7160. 
  *
- * Copyright (C) 2003 Joerg Dorchain <joerg@dorchain.net>
- * based heavily upon orinoco_plx.c Copyright (C) 2001 Daniel Barlow <dan@telent.net>
+ * Copyright (C) 2003 Joerg Dorchain <joerg AT dorchain.net>
+ * based heavily upon orinoco_plx.c Copyright (C) 2001 Daniel Barlow
  *
  * The contents of this file are subject to the Mozilla Public License
  * Version 1.1 (the "License"); you may not use this file except in
  * Pheecom sells cards with the TMD chip as "ASIC version"
  */
 
-#include <linux/config.h>
+#define DRIVER_NAME "orinoco_tmd"
+#define PFX DRIVER_NAME ": "
 
+#include <linux/config.h>
 #include <linux/module.h>
 #include <linux/kernel.h>
 #include <linux/init.h>
-#include <linux/sched.h>
-#include <linux/ptrace.h>
-#include <linux/slab.h>
-#include <linux/string.h>
-#include <linux/timer.h>
-#include <linux/ioport.h>
-#include <asm/uaccess.h>
-#include <asm/io.h>
-#include <asm/system.h>
-#include <linux/netdevice.h>
-#include <linux/if_arp.h>
-#include <linux/etherdevice.h>
-#include <linux/wireless.h>
-#include <linux/list.h>
+#include <linux/delay.h>
 #include <linux/pci.h>
-#include <linux/fcntl.h>
-
 #include <pcmcia/cisreg.h>
 
-#include "hermes.h"
 #include "orinoco.h"
 
-static char dev_info[] = "orinoco_tmd";
+#define COR_VALUE      (COR_LEVEL_REQ | COR_FUNC_ENA) /* Enable PC card with interrupt in level trigger */
+#define COR_RESET     (0x80)   /* reset bit in the COR register */
+#define TMD_RESET_TIME (500)   /* milliseconds */
+
+/* Orinoco TMD specific data */
+struct orinoco_tmd_card {
+       u32 tmd_io;
+};
+
+
+/*
+ * Do a soft reset of the card using the Configuration Option Register
+ */
+static int orinoco_tmd_cor_reset(struct orinoco_private *priv)
+{
+       hermes_t *hw = &priv->hw;
+       struct orinoco_tmd_card *card = priv->card;
+       u32 addr = card->tmd_io;
+       unsigned long timeout;
+       u16 reg;
+
+       outb(COR_VALUE | COR_RESET, addr);
+       mdelay(1);
+
+       outb(COR_VALUE, addr);
+       mdelay(1);
+
+       /* Just in case, wait more until the card is no longer busy */
+       timeout = jiffies + (TMD_RESET_TIME * HZ / 1000);
+       reg = hermes_read_regn(hw, CMD);
+       while (time_before(jiffies, timeout) && (reg & HERMES_CMD_BUSY)) {
+               mdelay(1);
+               reg = hermes_read_regn(hw, CMD);
+       }
+
+       /* Did we timeout ? */
+       if (reg & HERMES_CMD_BUSY) {
+               printk(KERN_ERR PFX "Busy timeout\n");
+               return -ETIMEDOUT;
+       }
 
-#define COR_VALUE     (COR_LEVEL_REQ | COR_FUNC_ENA | COR_FUNC_ENA) /* Enable PC card with level triggered irqs and irq requests */
+       return 0;
+}
 
 
 static int orinoco_tmd_init_one(struct pci_dev *pdev,
                                const struct pci_device_id *ent)
 {
        int err = 0;
-       u32 reg, addr;
        struct orinoco_private *priv = NULL;
-       unsigned long pccard_ioaddr = 0;
-       unsigned long pccard_iolen = 0;
+       struct orinoco_tmd_card *card;
        struct net_device *dev = NULL;
+       void __iomem *mem;
 
        err = pci_enable_device(pdev);
-       if (err)
-               return -EIO;
-
-       printk(KERN_DEBUG "TMD setup\n");
-       pccard_ioaddr = pci_resource_start(pdev, 2);
-       pccard_iolen = pci_resource_len(pdev, 2);
-       if (! request_region(pccard_ioaddr, pccard_iolen, dev_info)) {
-               printk(KERN_ERR "orinoco_tmd: I/O resource at 0x%lx len 0x%lx busy\n",
-                       pccard_ioaddr, pccard_iolen);
-               pccard_ioaddr = 0;
-               err = -EBUSY;
-               goto fail;
+       if (err) {
+               printk(KERN_ERR PFX "Cannot enable PCI device\n");
+               return err;
        }
-       addr = pci_resource_start(pdev, 1);
-       outb(COR_VALUE, addr);
-       mdelay(1);
-       reg = inb(addr);
-       if (reg != COR_VALUE) {
-               printk(KERN_ERR "orinoco_tmd: Error setting TMD COR values %x should be %x\n", reg, COR_VALUE);
-               err = -EIO;
-               goto fail;
+
+       err = pci_request_regions(pdev, DRIVER_NAME);
+       if (err != 0) {
+               printk(KERN_ERR PFX "Cannot obtain PCI resources\n");
+               goto fail_resources;
+       }
+
+       mem = pci_iomap(pdev, 2, 0);
+       if (! mem) {
+               err = -ENOMEM;
+               goto fail_iomap;
        }
 
-       dev = alloc_orinocodev(0, NULL);
+       /* Allocate network device */
+       dev = alloc_orinocodev(sizeof(*card), orinoco_tmd_cor_reset);
        if (! dev) {
+               printk(KERN_ERR PFX "Cannot allocate network device\n");
                err = -ENOMEM;
-               goto fail;
+               goto fail_alloc;
        }
 
-       priv = dev->priv;
-       dev->base_addr = pccard_ioaddr;
+       priv = netdev_priv(dev);
+       card = priv->card;
+       card->tmd_io = pci_resource_start(pdev, 1);
+       dev->base_addr = pci_resource_start(pdev, 2);
        SET_MODULE_OWNER(dev);
        SET_NETDEV_DEV(dev, &pdev->dev);
 
-       printk(KERN_DEBUG
-              "Detected Orinoco/Prism2 TMD device at %s irq:%d, io addr:0x%lx\n",
-              pci_name(pdev), pdev->irq, pccard_ioaddr);
+       hermes_struct_init(&priv->hw, mem, HERMES_16BIT_REGSPACING);
 
-       hermes_struct_init(&(priv->hw), dev->base_addr,
-                       HERMES_IO, HERMES_16BIT_REGSPACING);
-       pci_set_drvdata(pdev, dev);
+       printk(KERN_DEBUG PFX "Detected Orinoco/Prism2 TMD device "
+              "at %s irq:%d, io addr:0x%lx\n", pci_name(pdev), pdev->irq,
+              dev->base_addr);
 
-       err = request_irq(pdev->irq, orinoco_interrupt, SA_SHIRQ, dev->name,
-                         dev);
+       err = request_irq(pdev->irq, orinoco_interrupt, SA_SHIRQ,
+                         dev->name, dev);
        if (err) {
-               printk(KERN_ERR "orinoco_tmd: Error allocating IRQ %d.\n",
-                      pdev->irq);
+               printk(KERN_ERR PFX "Cannot allocate IRQ %d\n", pdev->irq);
                err = -EBUSY;
-               goto fail;
+               goto fail_irq;
        }
        dev->irq = pdev->irq;
 
+       err = orinoco_tmd_cor_reset(priv);
+       if (err) {
+               printk(KERN_ERR PFX "Initial reset failed\n");
+               goto fail;
+       }
+
        err = register_netdev(dev);
-       if (err)
+       if (err) {
+               printk(KERN_ERR PFX "Cannot register network device\n");
                goto fail;
+       }
 
-       return 0;               /* succeeded */
+       pci_set_drvdata(pdev, dev);
 
- fail: 
-       printk(KERN_DEBUG "orinoco_tmd: init_one(), FAIL!\n");
+       return 0;
 
-       if (dev) {
-               if (dev->irq)
-                       free_irq(dev->irq, dev);
-               
-               free_netdev(dev);
-       }
+ fail:
+       free_irq(pdev->irq, dev);
 
-       if (pccard_ioaddr)
-               release_region(pccard_ioaddr, pccard_iolen);
+ fail_irq:
+       pci_set_drvdata(pdev, NULL);
+       free_orinocodev(dev);
 
+ fail_alloc:
+       pci_iounmap(pdev, mem);
+
+ fail_iomap:
+       pci_release_regions(pdev);
+
+ fail_resources:
        pci_disable_device(pdev);
 
        return err;
@@ -171,21 +202,16 @@ static int orinoco_tmd_init_one(struct pci_dev *pdev,
 static void __devexit orinoco_tmd_remove_one(struct pci_dev *pdev)
 {
        struct net_device *dev = pci_get_drvdata(pdev);
+       struct orinoco_private *priv = dev->priv;
 
-       if (! dev)
-               BUG();
+       BUG_ON(! dev);
 
        unregister_netdev(dev);
-               
-       if (dev->irq)
-               free_irq(dev->irq, dev);
-               
+       free_irq(dev->irq, dev);
        pci_set_drvdata(pdev, NULL);
-
-       free_netdev(dev);
-
-       release_region(pci_resource_start(pdev, 2), pci_resource_len(pdev, 2));
-
+       free_orinocodev(dev);
+       pci_iounmap(pdev, priv->hw.iobase);
+       pci_release_regions(pdev);
        pci_disable_device(pdev);
 }
 
@@ -198,20 +224,17 @@ static struct pci_device_id orinoco_tmd_pci_id_table[] = {
 MODULE_DEVICE_TABLE(pci, orinoco_tmd_pci_id_table);
 
 static struct pci_driver orinoco_tmd_driver = {
-       .name           = "orinoco_tmd",
+       .name           = DRIVER_NAME,
        .id_table       = orinoco_tmd_pci_id_table,
        .probe          = orinoco_tmd_init_one,
        .remove         = __devexit_p(orinoco_tmd_remove_one),
-       .suspend        = 0,
-       .resume         = 0,
 };
 
-static char version[] __initdata = "orinoco_tmd.c 0.01 (Joerg Dorchain <joerg@dorchain.net>)";
+static char version[] __initdata = DRIVER_NAME " " DRIVER_VERSION
+       " (Joerg Dorchain <joerg@dorchain.net>)";
 MODULE_AUTHOR("Joerg Dorchain <joerg@dorchain.net>");
 MODULE_DESCRIPTION("Driver for wireless LAN cards using the TMD7160 PCI bridge");
-#ifdef MODULE_LICENSE
 MODULE_LICENSE("Dual MPL/GPL");
-#endif
 
 static int __init orinoco_tmd_init(void)
 {
@@ -219,11 +242,10 @@ static int __init orinoco_tmd_init(void)
        return pci_module_init(&orinoco_tmd_driver);
 }
 
-extern void __exit orinoco_tmd_exit(void)
+static void __exit orinoco_tmd_exit(void)
 {
        pci_unregister_driver(&orinoco_tmd_driver);
-       current->state = TASK_UNINTERRUPTIBLE;
-       schedule_timeout(HZ);
+       ssleep(1);
 }
 
 module_init(orinoco_tmd_init);