Commit 05da44d9 authored by François Romieu's avatar François Romieu Committed by Jeff Garzik

[PATCH] dscc4: error status checking and pci janitoring

Error status checking and PCI janitoring
- propagation of the error code;
- pci_request_region use in dscc4_init_one;
- missing pci_disable_device() added to the error path;
Signed-off-by: default avatarFrancois Romieu <romieu@fr.zoreil.com>
Signed-off-by: default avatarJeff Garzik <jgarzik@pobox.com>
parent e2cbfc51
...@@ -708,31 +708,35 @@ static int __devinit dscc4_init_one(struct pci_dev *pdev, ...@@ -708,31 +708,35 @@ static int __devinit dscc4_init_one(struct pci_dev *pdev,
struct dscc4_dev_priv *dpriv; struct dscc4_dev_priv *dpriv;
static int cards_found = 0; static int cards_found = 0;
void __iomem *ioaddr; void __iomem *ioaddr;
int i; int i, rc;
printk(KERN_DEBUG "%s", version); printk(KERN_DEBUG "%s", version);
if (pci_enable_device(pdev)) rc = pci_enable_device(pdev);
goto err_out; if (rc < 0)
if (!request_mem_region(pci_resource_start(pdev, 0), goto out;
pci_resource_len(pdev, 0), "registers")) {
rc = pci_request_region(pdev, 0, "registers");
if (rc < 0) {
printk(KERN_ERR "%s: can't reserve MMIO region (regs)\n", printk(KERN_ERR "%s: can't reserve MMIO region (regs)\n",
DRV_NAME); DRV_NAME);
goto err_out; goto err_disable_0;
} }
if (!request_mem_region(pci_resource_start(pdev, 1), rc = pci_request_region(pdev, 1, "LBI interface");
pci_resource_len(pdev, 1), "LBI interface")) { if (rc < 0) {
printk(KERN_ERR "%s: can't reserve MMIO region (lbi)\n", printk(KERN_ERR "%s: can't reserve MMIO region (lbi)\n",
DRV_NAME); DRV_NAME);
goto err_out_free_mmio_region0; goto err_free_mmio_region_1;
} }
ioaddr = ioremap(pci_resource_start(pdev, 0), ioaddr = ioremap(pci_resource_start(pdev, 0),
pci_resource_len(pdev, 0)); pci_resource_len(pdev, 0));
if (!ioaddr) { if (!ioaddr) {
printk(KERN_ERR "%s: cannot remap MMIO region %lx @ %lx\n", printk(KERN_ERR "%s: cannot remap MMIO region %lx @ %lx\n",
DRV_NAME, pci_resource_len(pdev, 0), DRV_NAME, pci_resource_len(pdev, 0),
pci_resource_start(pdev, 0)); pci_resource_start(pdev, 0));
goto err_out_free_mmio_region; rc = -EIO;
goto err_free_mmio_regions_2;
} }
printk(KERN_DEBUG "Siemens DSCC4, MMIO at %#lx (regs), %#lx (lbi), IRQ %d\n", printk(KERN_DEBUG "Siemens DSCC4, MMIO at %#lx (regs), %#lx (lbi), IRQ %d\n",
pci_resource_start(pdev, 0), pci_resource_start(pdev, 0),
...@@ -742,14 +746,16 @@ static int __devinit dscc4_init_one(struct pci_dev *pdev, ...@@ -742,14 +746,16 @@ static int __devinit dscc4_init_one(struct pci_dev *pdev,
pci_write_config_byte(pdev, PCI_LATENCY_TIMER, 0xf8); pci_write_config_byte(pdev, PCI_LATENCY_TIMER, 0xf8);
pci_set_master(pdev); pci_set_master(pdev);
if (dscc4_found1(pdev, ioaddr)) rc = dscc4_found1(pdev, ioaddr);
goto err_out_iounmap; if (rc < 0)
goto err_iounmap_3;
priv = (struct dscc4_pci_priv *)pci_get_drvdata(pdev); priv = (struct dscc4_pci_priv *)pci_get_drvdata(pdev);
if (request_irq(pdev->irq, &dscc4_irq, SA_SHIRQ, DRV_NAME, priv->root)){ rc = request_irq(pdev->irq, dscc4_irq, SA_SHIRQ, DRV_NAME, priv->root);
if (rc < 0) {
printk(KERN_WARNING "%s: IRQ %d busy\n", DRV_NAME, pdev->irq); printk(KERN_WARNING "%s: IRQ %d busy\n", DRV_NAME, pdev->irq);
goto err_out_free1; goto err_release_4;
} }
/* power up/little endian/dma core controlled via lrda/ltda */ /* power up/little endian/dma core controlled via lrda/ltda */
...@@ -769,9 +775,11 @@ static int __devinit dscc4_init_one(struct pci_dev *pdev, ...@@ -769,9 +775,11 @@ static int __devinit dscc4_init_one(struct pci_dev *pdev,
priv->iqcfg = (u32 *) pci_alloc_consistent(pdev, priv->iqcfg = (u32 *) pci_alloc_consistent(pdev,
IRQ_RING_SIZE*sizeof(u32), &priv->iqcfg_dma); IRQ_RING_SIZE*sizeof(u32), &priv->iqcfg_dma);
if (!priv->iqcfg) if (!priv->iqcfg)
goto err_out_free_irq; goto err_free_irq_5;
writel(priv->iqcfg_dma, ioaddr + IQCFG); writel(priv->iqcfg_dma, ioaddr + IQCFG);
rc = -ENOMEM;
/* /*
* SCC 0-3 private rx/tx irq structures * SCC 0-3 private rx/tx irq structures
* IQRX/TXi needs to be set soon. Learned it the hard way... * IQRX/TXi needs to be set soon. Learned it the hard way...
...@@ -781,7 +789,7 @@ static int __devinit dscc4_init_one(struct pci_dev *pdev, ...@@ -781,7 +789,7 @@ static int __devinit dscc4_init_one(struct pci_dev *pdev,
dpriv->iqtx = (u32 *) pci_alloc_consistent(pdev, dpriv->iqtx = (u32 *) pci_alloc_consistent(pdev,
IRQ_RING_SIZE*sizeof(u32), &dpriv->iqtx_dma); IRQ_RING_SIZE*sizeof(u32), &dpriv->iqtx_dma);
if (!dpriv->iqtx) if (!dpriv->iqtx)
goto err_out_free_iqtx; goto err_free_iqtx_6;
writel(dpriv->iqtx_dma, ioaddr + IQTX0 + i*4); writel(dpriv->iqtx_dma, ioaddr + IQTX0 + i*4);
} }
for (i = 0; i < dev_per_card; i++) { for (i = 0; i < dev_per_card; i++) {
...@@ -789,7 +797,7 @@ static int __devinit dscc4_init_one(struct pci_dev *pdev, ...@@ -789,7 +797,7 @@ static int __devinit dscc4_init_one(struct pci_dev *pdev,
dpriv->iqrx = (u32 *) pci_alloc_consistent(pdev, dpriv->iqrx = (u32 *) pci_alloc_consistent(pdev,
IRQ_RING_SIZE*sizeof(u32), &dpriv->iqrx_dma); IRQ_RING_SIZE*sizeof(u32), &dpriv->iqrx_dma);
if (!dpriv->iqrx) if (!dpriv->iqrx)
goto err_out_free_iqrx; goto err_free_iqrx_7;
writel(dpriv->iqrx_dma, ioaddr + IQRX0 + i*4); writel(dpriv->iqrx_dma, ioaddr + IQRX0 + i*4);
} }
...@@ -805,16 +813,19 @@ static int __devinit dscc4_init_one(struct pci_dev *pdev, ...@@ -805,16 +813,19 @@ static int __devinit dscc4_init_one(struct pci_dev *pdev,
writel(0xff200001, ioaddr + GCMDR); writel(0xff200001, ioaddr + GCMDR);
cards_found++; cards_found++;
return 0;
err_out_free_iqrx: rc = 0;
out:
return rc;
err_free_iqrx_7:
while (--i >= 0) { while (--i >= 0) {
dpriv = priv->root + i; dpriv = priv->root + i;
pci_free_consistent(pdev, IRQ_RING_SIZE*sizeof(u32), pci_free_consistent(pdev, IRQ_RING_SIZE*sizeof(u32),
dpriv->iqrx, dpriv->iqrx_dma); dpriv->iqrx, dpriv->iqrx_dma);
} }
i = dev_per_card; i = dev_per_card;
err_out_free_iqtx: err_free_iqtx_6:
while (--i >= 0) { while (--i >= 0) {
dpriv = priv->root + i; dpriv = priv->root + i;
pci_free_consistent(pdev, IRQ_RING_SIZE*sizeof(u32), pci_free_consistent(pdev, IRQ_RING_SIZE*sizeof(u32),
...@@ -822,20 +833,19 @@ static int __devinit dscc4_init_one(struct pci_dev *pdev, ...@@ -822,20 +833,19 @@ static int __devinit dscc4_init_one(struct pci_dev *pdev,
} }
pci_free_consistent(pdev, IRQ_RING_SIZE*sizeof(u32), priv->iqcfg, pci_free_consistent(pdev, IRQ_RING_SIZE*sizeof(u32), priv->iqcfg,
priv->iqcfg_dma); priv->iqcfg_dma);
err_out_free_irq: err_free_irq_5:
free_irq(pdev->irq, priv->root); free_irq(pdev->irq, priv->root);
err_out_free1: err_release_4:
dscc4_free1(pdev); dscc4_free1(pdev);
err_out_iounmap: err_iounmap_3:
iounmap (ioaddr); iounmap (ioaddr);
err_out_free_mmio_region: err_free_mmio_regions_2:
release_mem_region(pci_resource_start(pdev, 1), pci_release_region(pdev, 1);
pci_resource_len(pdev, 1)); err_free_mmio_region_1:
err_out_free_mmio_region0: pci_release_region(pdev, 0);
release_mem_region(pci_resource_start(pdev, 0), err_disable_0:
pci_resource_len(pdev, 0)); pci_disable_device(pdev);
err_out: goto out;
return -ENODEV;
}; };
/* /*
...@@ -1997,10 +2007,10 @@ static void __devexit dscc4_remove_one(struct pci_dev *pdev) ...@@ -1997,10 +2007,10 @@ static void __devexit dscc4_remove_one(struct pci_dev *pdev)
iounmap(ioaddr); iounmap(ioaddr);
release_mem_region(pci_resource_start(pdev, 1), pci_release_region(pdev, 1);
pci_resource_len(pdev, 1)); pci_release_region(pdev, 0);
release_mem_region(pci_resource_start(pdev, 0),
pci_resource_len(pdev, 0)); pci_disable_device(pdev);
} }
static int dscc4_hdlc_attach(struct net_device *dev, unsigned short encoding, static int dscc4_hdlc_attach(struct net_device *dev, unsigned short encoding,
......
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