Commit b884c872 authored by Pavel Roskin's avatar Pavel Roskin Committed by John W. Linville

[PATCH] orinoco: reduce differences between PCI drivers, create orinoco_pci.h

Make all Orinoco PCI drivers (orinoco_pci, orinoco_plx, orinoco_tmd and
orinoco_nortel) as similar as possible.  Use the best implementation of
error handling, the best error messages, the best comments.

Put common code to orinoco_pci.h.  For now, it's suspend and resume
functions and function for registering the network device.
Signed-off-by: default avatarPavel Roskin <proski@gnu.org>
Signed-off-by: default avatarJohn W. Linville <linville@tuxdriver.com>
parent c6fb2e9a
This diff is collapsed.
...@@ -100,6 +100,7 @@ ...@@ -100,6 +100,7 @@
#include <linux/pci.h> #include <linux/pci.h>
#include "orinoco.h" #include "orinoco.h"
#include "orinoco_pci.h"
/* All the magic there is from wlan-ng */ /* All the magic there is from wlan-ng */
/* Magic offset of the reset register of the PCI card */ /* Magic offset of the reset register of the PCI card */
...@@ -113,11 +114,6 @@ ...@@ -113,11 +114,6 @@
#define HERMES_PCI_COR_OFFT (500) /* ms */ #define HERMES_PCI_COR_OFFT (500) /* ms */
#define HERMES_PCI_COR_BUSYT (500) /* ms */ #define HERMES_PCI_COR_BUSYT (500) /* ms */
/* Orinoco PCI specific data */
struct orinoco_pci_card {
void __iomem *pci_ioaddr;
};
/* /*
* Do a soft reset of the PCI card using the Configuration Option Register * Do a soft reset of the PCI card using the Configuration Option Register
* We need this to get going... * We need this to get going...
...@@ -131,12 +127,11 @@ struct orinoco_pci_card { ...@@ -131,12 +127,11 @@ struct orinoco_pci_card {
* Note bis : Don't try to access HERMES_CMD during the reset phase. * Note bis : Don't try to access HERMES_CMD during the reset phase.
* It just won't work ! * It just won't work !
*/ */
static int static int orinoco_pci_cor_reset(struct orinoco_private *priv)
orinoco_pci_cor_reset(struct orinoco_private *priv)
{ {
hermes_t *hw = &priv->hw; hermes_t *hw = &priv->hw;
unsigned long timeout; unsigned long timeout;
u16 reg; u16 reg;
/* Assert the reset until the card notice */ /* Assert the reset until the card notice */
hermes_write_regn(hw, PCI_COR, HERMES_PCI_COR_MASK); hermes_write_regn(hw, PCI_COR, HERMES_PCI_COR_MASK);
...@@ -163,17 +158,14 @@ orinoco_pci_cor_reset(struct orinoco_private *priv) ...@@ -163,17 +158,14 @@ orinoco_pci_cor_reset(struct orinoco_private *priv)
return 0; return 0;
} }
/*
* Initialise a card. Mostly similar to PLX code.
*/
static int orinoco_pci_init_one(struct pci_dev *pdev, static int orinoco_pci_init_one(struct pci_dev *pdev,
const struct pci_device_id *ent) const struct pci_device_id *ent)
{ {
int err = 0; int err;
void __iomem *pci_ioaddr = NULL; struct orinoco_private *priv;
struct orinoco_private *priv = NULL;
struct orinoco_pci_card *card; struct orinoco_pci_card *card;
struct net_device *dev = NULL; struct net_device *dev;
void __iomem *hermes_io;
err = pci_enable_device(pdev); err = pci_enable_device(pdev);
if (err) { if (err) {
...@@ -182,38 +174,32 @@ static int orinoco_pci_init_one(struct pci_dev *pdev, ...@@ -182,38 +174,32 @@ static int orinoco_pci_init_one(struct pci_dev *pdev,
} }
err = pci_request_regions(pdev, DRIVER_NAME); err = pci_request_regions(pdev, DRIVER_NAME);
if (err != 0) { if (err) {
printk(KERN_ERR PFX "Cannot obtain PCI resources\n"); printk(KERN_ERR PFX "Cannot obtain PCI resources\n");
goto fail_resources; goto fail_resources;
} }
/* Resource 0 is mapped to the hermes registers */ hermes_io = pci_iomap(pdev, 0, 0);
pci_ioaddr = pci_iomap(pdev, 0, 0); if (!hermes_io) {
if (!pci_ioaddr) { printk(KERN_ERR PFX "Cannot remap chipset registers\n");
err = -EIO; err = -EIO;
printk(KERN_ERR PFX "Cannot remap hardware registers\n"); goto fail_map_hermes;
goto fail_map;
} }
/* Allocate network device */ /* Allocate network device */
dev = alloc_orinocodev(sizeof(*card), orinoco_pci_cor_reset); dev = alloc_orinocodev(sizeof(*card), orinoco_pci_cor_reset);
if (! dev) { if (!dev) {
printk(KERN_ERR PFX "Cannot allocate network device\n");
err = -ENOMEM; err = -ENOMEM;
goto fail_alloc; goto fail_alloc;
} }
priv = netdev_priv(dev); priv = netdev_priv(dev);
card = priv->card; card = priv->card;
card->pci_ioaddr = pci_ioaddr;
dev->mem_start = pci_resource_start(pdev, 0);
dev->mem_end = dev->mem_start + pci_resource_len(pdev, 0) - 1;
SET_MODULE_OWNER(dev); SET_MODULE_OWNER(dev);
SET_NETDEV_DEV(dev, &pdev->dev); SET_NETDEV_DEV(dev, &pdev->dev);
hermes_struct_init(&priv->hw, pci_ioaddr, HERMES_32BIT_REGSPACING); hermes_struct_init(&priv->hw, hermes_io, HERMES_32BIT_REGSPACING);
printk(KERN_DEBUG PFX "Detected device %s, mem:0x%lx-0x%lx, irq %d\n",
pci_name(pdev), dev->mem_start, dev->mem_end, pdev->irq);
err = request_irq(pdev->irq, orinoco_interrupt, SA_SHIRQ, err = request_irq(pdev->irq, orinoco_interrupt, SA_SHIRQ,
dev->name, dev); dev->name, dev);
...@@ -222,9 +208,8 @@ static int orinoco_pci_init_one(struct pci_dev *pdev, ...@@ -222,9 +208,8 @@ static int orinoco_pci_init_one(struct pci_dev *pdev,
err = -EBUSY; err = -EBUSY;
goto fail_irq; goto fail_irq;
} }
dev->irq = pdev->irq; orinoco_pci_setup_netdev(dev, pdev, 0);
/* Perform a COR reset to start the card */
err = orinoco_pci_cor_reset(priv); err = orinoco_pci_cor_reset(priv);
if (err) { if (err) {
printk(KERN_ERR PFX "Initial reset failed\n"); printk(KERN_ERR PFX "Initial reset failed\n");
...@@ -233,7 +218,7 @@ static int orinoco_pci_init_one(struct pci_dev *pdev, ...@@ -233,7 +218,7 @@ static int orinoco_pci_init_one(struct pci_dev *pdev,
err = register_netdev(dev); err = register_netdev(dev);
if (err) { if (err) {
printk(KERN_ERR PFX "Failed to register net device\n"); printk(KERN_ERR PFX "Cannot register network device\n");
goto fail; goto fail;
} }
...@@ -249,9 +234,9 @@ static int orinoco_pci_init_one(struct pci_dev *pdev, ...@@ -249,9 +234,9 @@ static int orinoco_pci_init_one(struct pci_dev *pdev,
free_orinocodev(dev); free_orinocodev(dev);
fail_alloc: fail_alloc:
iounmap(pci_ioaddr); pci_iounmap(pdev, hermes_io);
fail_map: fail_map_hermes:
pci_release_regions(pdev); pci_release_regions(pdev);
fail_resources: fail_resources:
...@@ -264,98 +249,17 @@ static void __devexit orinoco_pci_remove_one(struct pci_dev *pdev) ...@@ -264,98 +249,17 @@ static void __devexit orinoco_pci_remove_one(struct pci_dev *pdev)
{ {
struct net_device *dev = pci_get_drvdata(pdev); struct net_device *dev = pci_get_drvdata(pdev);
struct orinoco_private *priv = netdev_priv(dev); struct orinoco_private *priv = netdev_priv(dev);
struct orinoco_pci_card *card = priv->card;
unregister_netdev(dev); unregister_netdev(dev);
free_irq(dev->irq, dev); free_irq(dev->irq, dev);
pci_set_drvdata(pdev, NULL); pci_set_drvdata(pdev, NULL);
free_orinocodev(dev); free_orinocodev(dev);
iounmap(card->pci_ioaddr); pci_iounmap(pdev, priv->hw.iobase);
pci_release_regions(pdev); pci_release_regions(pdev);
pci_disable_device(pdev); pci_disable_device(pdev);
} }
static int orinoco_pci_suspend(struct pci_dev *pdev, pm_message_t state) static struct pci_device_id orinoco_pci_id_table[] = {
{
struct net_device *dev = pci_get_drvdata(pdev);
struct orinoco_private *priv = netdev_priv(dev);
unsigned long flags;
int err;
err = orinoco_lock(priv, &flags);
if (err) {
printk(KERN_ERR "%s: hw_unavailable on orinoco_pci_suspend\n",
dev->name);
return err;
}
err = __orinoco_down(dev);
if (err)
printk(KERN_WARNING "%s: orinoco_pci_suspend(): Error %d downing interface\n",
dev->name, err);
netif_device_detach(dev);
priv->hw_unavailable++;
orinoco_unlock(priv, &flags);
free_irq(pdev->irq, dev);
pci_save_state(pdev);
pci_disable_device(pdev);
pci_set_power_state(pdev, PCI_D3hot);
return 0;
}
static int orinoco_pci_resume(struct pci_dev *pdev)
{
struct net_device *dev = pci_get_drvdata(pdev);
struct orinoco_private *priv = netdev_priv(dev);
unsigned long flags;
int err;
printk(KERN_DEBUG "%s: Orinoco-PCI waking up\n", dev->name);
pci_set_power_state(pdev, 0);
pci_enable_device(pdev);
pci_restore_state(pdev);
err = request_irq(pdev->irq, orinoco_interrupt, SA_SHIRQ,
dev->name, dev);
if (err) {
printk(KERN_ERR "%s: Cannot re-allocate IRQ\n", dev->name);
pci_disable_device(pdev);
return -EBUSY;
}
err = orinoco_reinit_firmware(dev);
if (err) {
printk(KERN_ERR "%s: Error %d re-initializing firmware on orinoco_pci_resume()\n",
dev->name, err);
return err;
}
spin_lock_irqsave(&priv->lock, flags);
netif_device_attach(dev);
priv->hw_unavailable--;
if (priv->open && (! priv->hw_unavailable)) {
err = __orinoco_up(dev);
if (err)
printk(KERN_ERR "%s: Error %d restarting card on orinoco_pci_resume()\n",
dev->name, err);
}
spin_unlock_irqrestore(&priv->lock, flags);
return 0;
}
static struct pci_device_id orinoco_pci_pci_id_table[] = {
/* Intersil Prism 3 */ /* Intersil Prism 3 */
{0x1260, 0x3872, PCI_ANY_ID, PCI_ANY_ID,}, {0x1260, 0x3872, PCI_ANY_ID, PCI_ANY_ID,},
/* Intersil Prism 2.5 */ /* Intersil Prism 2.5 */
...@@ -365,11 +269,11 @@ static struct pci_device_id orinoco_pci_pci_id_table[] = { ...@@ -365,11 +269,11 @@ static struct pci_device_id orinoco_pci_pci_id_table[] = {
{0,}, {0,},
}; };
MODULE_DEVICE_TABLE(pci, orinoco_pci_pci_id_table); MODULE_DEVICE_TABLE(pci, orinoco_pci_id_table);
static struct pci_driver orinoco_pci_driver = { static struct pci_driver orinoco_pci_driver = {
.name = DRIVER_NAME, .name = DRIVER_NAME,
.id_table = orinoco_pci_pci_id_table, .id_table = orinoco_pci_id_table,
.probe = orinoco_pci_init_one, .probe = orinoco_pci_init_one,
.remove = __devexit_p(orinoco_pci_remove_one), .remove = __devexit_p(orinoco_pci_remove_one),
.suspend = orinoco_pci_suspend, .suspend = orinoco_pci_suspend,
......
/* orinoco_pci.h
*
* Common code for all Orinoco drivers for PCI devices, including
* both native PCI and PCMCIA-to-PCI bridges.
*
* Copyright (C) 2005, Pavel Roskin.
* See orinoco.c for license.
*/
#ifndef _ORINOCO_PCI_H
#define _ORINOCO_PCI_H
#include <linux/netdevice.h>
/* Driver specific data */
struct orinoco_pci_card {
void __iomem *bridge_io;
void __iomem *attr_io;
};
/* Set base address or memory range of the network device based on
* the PCI device it's using. Specify BAR of the "main" resource.
* To be used after request_irq(). */
static inline void orinoco_pci_setup_netdev(struct net_device *dev,
struct pci_dev *pdev, int bar)
{
char *range_type;
unsigned long start = pci_resource_start(pdev, bar);
unsigned long len = pci_resource_len(pdev, bar);
unsigned long flags = pci_resource_flags(pdev, bar);
unsigned long end = start + len - 1;
dev->irq = pdev->irq;
if (flags & IORESOURCE_IO) {
dev->base_addr = start;
range_type = "ports";
} else {
dev->mem_start = start;
dev->mem_end = end;
range_type = "memory";
}
printk(KERN_DEBUG PFX "%s: irq %d, %s 0x%lx-0x%lx\n",
pci_name(pdev), pdev->irq, range_type, start, end);
}
static int orinoco_pci_suspend(struct pci_dev *pdev, pm_message_t state)
{
struct net_device *dev = pci_get_drvdata(pdev);
struct orinoco_private *priv = netdev_priv(dev);
unsigned long flags;
int err;
err = orinoco_lock(priv, &flags);
if (err) {
printk(KERN_ERR "%s: cannot lock hardware for suspend\n",
dev->name);
return err;
}
err = __orinoco_down(dev);
if (err)
printk(KERN_WARNING "%s: error %d bringing interface down "
"for suspend\n", dev->name, err);
netif_device_detach(dev);
priv->hw_unavailable++;
orinoco_unlock(priv, &flags);
free_irq(pdev->irq, dev);
pci_save_state(pdev);
pci_disable_device(pdev);
pci_set_power_state(pdev, PCI_D3hot);
return 0;
}
static int orinoco_pci_resume(struct pci_dev *pdev)
{
struct net_device *dev = pci_get_drvdata(pdev);
struct orinoco_private *priv = netdev_priv(dev);
unsigned long flags;
int err;
pci_set_power_state(pdev, 0);
pci_enable_device(pdev);
pci_restore_state(pdev);
err = request_irq(pdev->irq, orinoco_interrupt, SA_SHIRQ,
dev->name, dev);
if (err) {
printk(KERN_ERR "%s: cannot re-allocate IRQ on resume\n",
dev->name);
pci_disable_device(pdev);
return -EBUSY;
}
err = orinoco_reinit_firmware(dev);
if (err) {
printk(KERN_ERR "%s: error %d re-initializing firmware "
"on resume\n", dev->name, err);
return err;
}
spin_lock_irqsave(&priv->lock, flags);
netif_device_attach(dev);
priv->hw_unavailable--;
if (priv->open && (! priv->hw_unavailable)) {
err = __orinoco_up(dev);
if (err)
printk(KERN_ERR "%s: Error %d restarting card on resume\n",
dev->name, err);
}
spin_unlock_irqrestore(&priv->lock, flags);
return 0;
}
#endif /* _ORINOCO_PCI_H */
This diff is collapsed.
/* orinoco_tmd.c /* orinoco_tmd.c
* *
* Driver for Prism II devices which would usually be driven by orinoco_cs, * Driver for Prism II devices which would usually be driven by orinoco_cs,
* but are connected to the PCI bus by a TMD7160. * but are connected to the PCI bus by a TMD7160.
* *
...@@ -29,14 +29,14 @@ ...@@ -29,14 +29,14 @@
* Caution: this is experimental and probably buggy. For success and * Caution: this is experimental and probably buggy. For success and
* failure reports for different cards and adaptors, see * failure reports for different cards and adaptors, see
* orinoco_tmd_pci_id_table near the end of the file. If you have a * orinoco_tmd_id_table near the end of the file. If you have a
* card we don't have the PCI id for, and looks like it should work, * card we don't have the PCI id for, and looks like it should work,
* drop me mail with the id and "it works"/"it doesn't work". * drop me mail with the id and "it works"/"it doesn't work".
* *
* Note: if everything gets detected fine but it doesn't actually send * Note: if everything gets detected fine but it doesn't actually send
* or receive packets, your first port of call should probably be to * or receive packets, your first port of call should probably be to
* try newer firmware in the card. Especially if you're doing Ad-Hoc * try newer firmware in the card. Especially if you're doing Ad-Hoc
* modes * modes.
* *
* The actual driving is done by orinoco.c, this is just resource * The actual driving is done by orinoco.c, this is just resource
* allocation stuff. * allocation stuff.
...@@ -61,32 +61,26 @@ ...@@ -61,32 +61,26 @@
#include <pcmcia/cisreg.h> #include <pcmcia/cisreg.h>
#include "orinoco.h" #include "orinoco.h"
#include "orinoco_pci.h"
#define COR_VALUE (COR_LEVEL_REQ | COR_FUNC_ENA) /* Enable PC card with interrupt in level trigger */ #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 COR_RESET (0x80) /* reset bit in the COR register */
#define TMD_RESET_TIME (500) /* milliseconds */ #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 * Do a soft reset of the card using the Configuration Option Register
*/ */
static int orinoco_tmd_cor_reset(struct orinoco_private *priv) static int orinoco_tmd_cor_reset(struct orinoco_private *priv)
{ {
hermes_t *hw = &priv->hw; hermes_t *hw = &priv->hw;
struct orinoco_tmd_card *card = priv->card; struct orinoco_pci_card *card = priv->card;
u32 addr = card->tmd_io;
unsigned long timeout; unsigned long timeout;
u16 reg; u16 reg;
outb(COR_VALUE | COR_RESET, addr); iowrite8(COR_VALUE | COR_RESET, card->bridge_io);
mdelay(1); mdelay(1);
outb(COR_VALUE, addr); iowrite8(COR_VALUE, card->bridge_io);
mdelay(1); mdelay(1);
/* Just in case, wait more until the card is no longer busy */ /* Just in case, wait more until the card is no longer busy */
...@@ -97,7 +91,7 @@ static int orinoco_tmd_cor_reset(struct orinoco_private *priv) ...@@ -97,7 +91,7 @@ static int orinoco_tmd_cor_reset(struct orinoco_private *priv)
reg = hermes_read_regn(hw, CMD); reg = hermes_read_regn(hw, CMD);
} }
/* Did we timeout ? */ /* Still busy? */
if (reg & HERMES_CMD_BUSY) { if (reg & HERMES_CMD_BUSY) {
printk(KERN_ERR PFX "Busy timeout\n"); printk(KERN_ERR PFX "Busy timeout\n");
return -ETIMEDOUT; return -ETIMEDOUT;
...@@ -110,11 +104,11 @@ static int orinoco_tmd_cor_reset(struct orinoco_private *priv) ...@@ -110,11 +104,11 @@ static int orinoco_tmd_cor_reset(struct orinoco_private *priv)
static int orinoco_tmd_init_one(struct pci_dev *pdev, static int orinoco_tmd_init_one(struct pci_dev *pdev,
const struct pci_device_id *ent) const struct pci_device_id *ent)
{ {
int err = 0; int err;
struct orinoco_private *priv = NULL; struct orinoco_private *priv;
struct orinoco_tmd_card *card; struct orinoco_pci_card *card;
struct net_device *dev = NULL; struct net_device *dev;
void __iomem *mem; void __iomem *hermes_io, *bridge_io;
err = pci_enable_device(pdev); err = pci_enable_device(pdev);
if (err) { if (err) {
...@@ -123,20 +117,28 @@ static int orinoco_tmd_init_one(struct pci_dev *pdev, ...@@ -123,20 +117,28 @@ static int orinoco_tmd_init_one(struct pci_dev *pdev,
} }
err = pci_request_regions(pdev, DRIVER_NAME); err = pci_request_regions(pdev, DRIVER_NAME);
if (err != 0) { if (err) {
printk(KERN_ERR PFX "Cannot obtain PCI resources\n"); printk(KERN_ERR PFX "Cannot obtain PCI resources\n");
goto fail_resources; goto fail_resources;
} }
mem = pci_iomap(pdev, 2, 0); bridge_io = pci_iomap(pdev, 1, 0);
if (! mem) { if (!bridge_io) {
err = -ENOMEM; printk(KERN_ERR PFX "Cannot map bridge registers\n");
goto fail_iomap; err = -EIO;
goto fail_map_bridge;
}
hermes_io = pci_iomap(pdev, 2, 0);
if (!hermes_io) {
printk(KERN_ERR PFX "Cannot map chipset registers\n");
err = -EIO;
goto fail_map_hermes;
} }
/* Allocate network device */ /* Allocate network device */
dev = alloc_orinocodev(sizeof(*card), orinoco_tmd_cor_reset); dev = alloc_orinocodev(sizeof(*card), orinoco_tmd_cor_reset);
if (! dev) { if (!dev) {
printk(KERN_ERR PFX "Cannot allocate network device\n"); printk(KERN_ERR PFX "Cannot allocate network device\n");
err = -ENOMEM; err = -ENOMEM;
goto fail_alloc; goto fail_alloc;
...@@ -144,16 +146,11 @@ static int orinoco_tmd_init_one(struct pci_dev *pdev, ...@@ -144,16 +146,11 @@ static int orinoco_tmd_init_one(struct pci_dev *pdev,
priv = netdev_priv(dev); priv = netdev_priv(dev);
card = priv->card; card = priv->card;
card->tmd_io = pci_resource_start(pdev, 1); card->bridge_io = bridge_io;
dev->base_addr = pci_resource_start(pdev, 2);
SET_MODULE_OWNER(dev); SET_MODULE_OWNER(dev);
SET_NETDEV_DEV(dev, &pdev->dev); SET_NETDEV_DEV(dev, &pdev->dev);
hermes_struct_init(&priv->hw, mem, HERMES_16BIT_REGSPACING); hermes_struct_init(&priv->hw, hermes_io, HERMES_16BIT_REGSPACING);
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, err = request_irq(pdev->irq, orinoco_interrupt, SA_SHIRQ,
dev->name, dev); dev->name, dev);
...@@ -162,7 +159,7 @@ static int orinoco_tmd_init_one(struct pci_dev *pdev, ...@@ -162,7 +159,7 @@ static int orinoco_tmd_init_one(struct pci_dev *pdev,
err = -EBUSY; err = -EBUSY;
goto fail_irq; goto fail_irq;
} }
dev->irq = pdev->irq; orinoco_pci_setup_netdev(dev, pdev, 2);
err = orinoco_tmd_cor_reset(priv); err = orinoco_tmd_cor_reset(priv);
if (err) { if (err) {
...@@ -188,9 +185,12 @@ static int orinoco_tmd_init_one(struct pci_dev *pdev, ...@@ -188,9 +185,12 @@ static int orinoco_tmd_init_one(struct pci_dev *pdev,
free_orinocodev(dev); free_orinocodev(dev);
fail_alloc: fail_alloc:
pci_iounmap(pdev, mem); pci_iounmap(pdev, hermes_io);
fail_iomap: fail_map_hermes:
pci_iounmap(pdev, bridge_io);
fail_map_bridge:
pci_release_regions(pdev); pci_release_regions(pdev);
fail_resources: fail_resources:
...@@ -203,110 +203,32 @@ static void __devexit orinoco_tmd_remove_one(struct pci_dev *pdev) ...@@ -203,110 +203,32 @@ static void __devexit orinoco_tmd_remove_one(struct pci_dev *pdev)
{ {
struct net_device *dev = pci_get_drvdata(pdev); struct net_device *dev = pci_get_drvdata(pdev);
struct orinoco_private *priv = dev->priv; struct orinoco_private *priv = dev->priv;
struct orinoco_pci_card *card = priv->card;
BUG_ON(! dev);
unregister_netdev(dev); unregister_netdev(dev);
free_irq(dev->irq, dev); free_irq(dev->irq, dev);
pci_set_drvdata(pdev, NULL); pci_set_drvdata(pdev, NULL);
free_orinocodev(dev); free_orinocodev(dev);
pci_iounmap(pdev, priv->hw.iobase); pci_iounmap(pdev, priv->hw.iobase);
pci_iounmap(pdev, card->bridge_io);
pci_release_regions(pdev); pci_release_regions(pdev);
pci_disable_device(pdev); pci_disable_device(pdev);
} }
static int orinoco_tmd_suspend(struct pci_dev *pdev, pm_message_t state) static struct pci_device_id orinoco_tmd_id_table[] = {
{
struct net_device *dev = pci_get_drvdata(pdev);
struct orinoco_private *priv = netdev_priv(dev);
unsigned long flags;
int err;
err = orinoco_lock(priv, &flags);
if (err) {
printk(KERN_ERR "%s: cannot lock hardware for suspend\n",
dev->name);
return err;
}
err = __orinoco_down(dev);
if (err)
printk(KERN_WARNING "%s: error %d bringing interface down "
"for suspend\n", dev->name, err);
netif_device_detach(dev);
priv->hw_unavailable++;
orinoco_unlock(priv, &flags);
free_irq(pdev->irq, dev);
pci_save_state(pdev);
pci_disable_device(pdev);
pci_set_power_state(pdev, PCI_D3hot);
return 0;
}
static int orinoco_tmd_resume(struct pci_dev *pdev)
{
struct net_device *dev = pci_get_drvdata(pdev);
struct orinoco_private *priv = netdev_priv(dev);
unsigned long flags;
int err;
pci_set_power_state(pdev, 0);
pci_enable_device(pdev);
pci_restore_state(pdev);
err = request_irq(pdev->irq, orinoco_interrupt, SA_SHIRQ,
dev->name, dev);
if (err) {
printk(KERN_ERR "%s: cannot re-allocate IRQ on resume\n",
dev->name);
pci_disable_device(pdev);
return -EBUSY;
}
err = orinoco_reinit_firmware(dev);
if (err) {
printk(KERN_ERR "%s: error %d re-initializing firmware "
"on resume\n", dev->name, err);
return err;
}
spin_lock_irqsave(&priv->lock, flags);
netif_device_attach(dev);
priv->hw_unavailable--;
if (priv->open && (! priv->hw_unavailable)) {
err = __orinoco_up(dev);
if (err)
printk(KERN_ERR "%s: Error %d restarting card on resume\n",
dev->name, err);
}
spin_unlock_irqrestore(&priv->lock, flags);
return 0;
}
static struct pci_device_id orinoco_tmd_pci_id_table[] = {
{0x15e8, 0x0131, PCI_ANY_ID, PCI_ANY_ID,}, /* NDC and OEMs, e.g. pheecom */ {0x15e8, 0x0131, PCI_ANY_ID, PCI_ANY_ID,}, /* NDC and OEMs, e.g. pheecom */
{0,}, {0,},
}; };
MODULE_DEVICE_TABLE(pci, orinoco_tmd_pci_id_table); MODULE_DEVICE_TABLE(pci, orinoco_tmd_id_table);
static struct pci_driver orinoco_tmd_driver = { static struct pci_driver orinoco_tmd_driver = {
.name = DRIVER_NAME, .name = DRIVER_NAME,
.id_table = orinoco_tmd_pci_id_table, .id_table = orinoco_tmd_id_table,
.probe = orinoco_tmd_init_one, .probe = orinoco_tmd_init_one,
.remove = __devexit_p(orinoco_tmd_remove_one), .remove = __devexit_p(orinoco_tmd_remove_one),
.suspend = orinoco_tmd_suspend, .suspend = orinoco_pci_suspend,
.resume = orinoco_tmd_resume, .resume = orinoco_pci_resume,
}; };
static char version[] __initdata = DRIVER_NAME " " DRIVER_VERSION static char version[] __initdata = DRIVER_NAME " " DRIVER_VERSION
...@@ -324,7 +246,6 @@ static int __init orinoco_tmd_init(void) ...@@ -324,7 +246,6 @@ static int __init orinoco_tmd_init(void)
static void __exit orinoco_tmd_exit(void) static void __exit orinoco_tmd_exit(void)
{ {
pci_unregister_driver(&orinoco_tmd_driver); pci_unregister_driver(&orinoco_tmd_driver);
ssleep(1);
} }
module_init(orinoco_tmd_init); module_init(orinoco_tmd_init);
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment