drivers/ssb/pcihost_wrapper.c

   1 /*
   2  * Sonics Silicon Backplane
   3  * PCI Hostdevice wrapper
   4  *
   5  * Copyright (c) 2005 Martin Langer <martin-langer@gmx.de>
   6  * Copyright (c) 2005 Stefano Brivio <st3@riseup.net>
   7  * Copyright (c) 2005 Danny van Dyk <kugelfang@gentoo.org>
   8  * Copyright (c) 2005 Andreas Jaggi <andreas.jaggi@waterwave.ch>
   9  * Copyright (c) 2005-2007 Michael Buesch <mbuesch@freenet.de>
  10  *
  11  * Licensed under the GNU/GPL. See COPYING for details.
  12  */
  13
  14 #include <linux/pci.h>
  15 #include <linux/slab.h>
  16 #include <linux/ssb/ssb.h>
  17
  18
  19 #ifdef CONFIG_PM
  20 static int ssb_pcihost_suspend(struct pci_dev *dev, pm_message_t state)
  21 {
  22         struct ssb_bus *ssb = pci_get_drvdata(dev);
  23         int err;
  24
  25         err = ssb_bus_suspend(ssb);
  26         if (err)
  27                 return err;
  28         pci_save_state(dev);
  29         pci_disable_device(dev);
  30         pci_set_power_state(dev, pci_choose_state(dev, state));
  31
  32         return 0;
  33 }
  34
  35 static int ssb_pcihost_resume(struct pci_dev *dev)
  36 {
  37         struct ssb_bus *ssb = pci_get_drvdata(dev);
  38         int err;
  39
  40         pci_set_power_state(dev, 0);
  41         err = pci_enable_device(dev);
  42         if (err)
  43                 return err;
  44         pci_restore_state(dev);
  45         err = ssb_bus_resume(ssb);
  46         if (err)
  47                 return err;
  48
  49         return 0;
  50 }
  51 #else /* CONFIG_PM */
  52 # define ssb_pcihost_suspend    NULL
  53 # define ssb_pcihost_resume     NULL
  54 #endif /* CONFIG_PM */
  55
  56 static int __devinit ssb_pcihost_probe(struct pci_dev *dev,
  57                                        const struct pci_device_id *id)
  58 {
  59         struct ssb_bus *ssb;
  60         int err = -ENOMEM;
  61         const char *name;
  62         u32 val;
  63
  64         ssb = kzalloc(sizeof(*ssb), GFP_KERNEL);
  65         if (!ssb)
  66                 goto out;
  67         err = pci_enable_device(dev);
  68         if (err)
  69                 goto err_kfree_ssb;
  70         name = dev_name(&dev->dev);
  71         if (dev->driver && dev->driver->name)
  72                 name = dev->driver->name;
  73         err = pci_request_regions(dev, name);
  74         if (err)
  75                 goto err_pci_disable;
  76         pci_set_master(dev);
  77
  78         /* Disable the RETRY_TIMEOUT register (0x41) to keep
  79          * PCI Tx retries from interfering with C3 CPU state */
  80         pci_read_config_dword(dev, 0x40, &val);
  81         if ((val & 0x0000ff00) != 0)
  82                 pci_write_config_dword(dev, 0x40, val & 0xffff00ff);
  83
  84         err = ssb_bus_pcibus_register(ssb, dev);
  85         if (err)
  86                 goto err_pci_release_regions;
  87
  88         pci_set_drvdata(dev, ssb);
  89
  90 out:
  91         return err;
  92
  93 err_pci_release_regions:
  94         pci_release_regions(dev);
  95 err_pci_disable:
  96         pci_disable_device(dev);
  97 err_kfree_ssb:
  98         kfree(ssb);
  99         return err;
 100 }
 101
 102 static void ssb_pcihost_remove(struct pci_dev *dev)
 103 {
 104         struct ssb_bus *ssb = pci_get_drvdata(dev);
 105
 106         ssb_bus_unregister(ssb);
 107         pci_release_regions(dev);
 108         pci_disable_device(dev);
 109         kfree(ssb);
 110         pci_set_drvdata(dev, NULL);
 111 }
 112
 113 int __devinit ssb_pcihost_register(struct pci_driver *driver)
 114 {
 115         driver->probe = ssb_pcihost_probe;
 116         driver->remove = ssb_pcihost_remove;
 117         driver->suspend = ssb_pcihost_suspend;
 118         driver->resume = ssb_pcihost_resume;
 119
 120         return pci_register_driver(driver);
 121 }
 122 EXPORT_SYMBOL(ssb_pcihost_register);