LXR linux/drivers/ssb/pcihost

   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/ssb/ssb.h>
  16
  17
  18#ifdef CONFIG_PM
  19static int ssb_pcihost_suspend(struct pci_dev *dev, pm_message_t state)
  20{
  21        struct ssb_bus *ssb = pci_get_drvdata(dev);
  22        int err;
  23
  24        err = ssb_bus_suspend(ssb);
  25        if (err)
  26                return err;
  27        pci_save_state(dev);
  28        pci_disable_device(dev);
  29        pci_set_power_state(dev, pci_choose_state(dev, state));
  30
  31        return 0;
  32}
  33
  34static int ssb_pcihost_resume(struct pci_dev *dev)
  35{
  36        struct ssb_bus *ssb = pci_get_drvdata(dev);
  37        int err;
  38
  39        pci_set_power_state(dev, 0);
  40        err = pci_enable_device(dev);
  41        if (err)
  42                return err;
  43        pci_restore_state(dev);
  44        err = ssb_bus_resume(ssb);
  45        if (err)
  46                return err;
  47
  48        return 0;
  49}
  50#else /* CONFIG_PM */
  51# define ssb_pcihost_suspend    NULL
  52# define ssb_pcihost_resume     NULL
  53#endif /* CONFIG_PM */
  54
  55static int ssb_pcihost_probe(struct pci_dev *dev,
  56                             const struct pci_device_id *id)
  57{
  58        struct ssb_bus *ssb;
  59        int err = -ENOMEM;
  60        const char *name;
  61
  62        ssb = kzalloc(sizeof(*ssb), GFP_KERNEL);
  63        if (!ssb)
  64                goto out;
  65        err = pci_enable_device(dev);
  66        if (err)
  67                goto err_kfree_ssb;
  68        name = dev_name(&dev->dev);
  69        if (dev->driver && dev->driver->name)
  70                name = dev->driver->name;
  71        err = pci_request_regions(dev, name);
  72        if (err)
  73                goto err_pci_disable;
  74        pci_set_master(dev);
  75
  76        err = ssb_bus_pcibus_register(ssb, dev);
  77        if (err)
  78                goto err_pci_release_regions;
  79
  80        pci_set_drvdata(dev, ssb);
  81
  82out:
  83        return err;
  84
  85err_pci_release_regions:
  86        pci_release_regions(dev);
  87err_pci_disable:
  88        pci_disable_device(dev);
  89err_kfree_ssb:
  90        kfree(ssb);
  91        return err;
  92}
  93
  94static void ssb_pcihost_remove(struct pci_dev *dev)
  95{
  96        struct ssb_bus *ssb = pci_get_drvdata(dev);
  97
  98        ssb_bus_unregister(ssb);
  99        pci_release_regions(dev);
 100        pci_disable_device(dev);
 101        kfree(ssb);
 102        pci_set_drvdata(dev, NULL);
 103}
 104
 105int ssb_pcihost_register(struct pci_driver *driver)
 106{
 107        driver->probe = ssb_pcihost_probe;
 108        driver->remove = ssb_pcihost_remove;
 109        driver->suspend = ssb_pcihost_suspend;
 110        driver->resume = ssb_pcihost_resume;
 111
 112        return pci_register_driver(driver);
 113}
 114EXPORT_SYMBOL(ssb_pcihost_register);
 115