131 lines · c
1/*2 * Sonics Silicon Backplane3 * PCI Hostdevice wrapper4 *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 <m@bues.ch>10 *11 * Licensed under the GNU/GPL. See COPYING for details.12 */13 14#include <linux/pm.h>15#include <linux/pci.h>16#include <linux/export.h>17#include <linux/slab.h>18#include <linux/ssb/ssb.h>19 20 21#ifdef CONFIG_PM_SLEEP22static int ssb_pcihost_suspend(struct device *d)23{24 struct pci_dev *dev = to_pci_dev(d);25 struct ssb_bus *ssb = pci_get_drvdata(dev);26 int err;27 28 err = ssb_bus_suspend(ssb);29 if (err)30 return err;31 pci_save_state(dev);32 pci_disable_device(dev);33 34 /* if there is a wakeup enabled child device on ssb bus,35 enable pci wakeup posibility. */36 device_set_wakeup_enable(d, d->power.wakeup_path);37 38 pci_prepare_to_sleep(dev);39 40 return 0;41}42 43static int ssb_pcihost_resume(struct device *d)44{45 struct pci_dev *dev = to_pci_dev(d);46 struct ssb_bus *ssb = pci_get_drvdata(dev);47 int err;48 49 pci_back_from_sleep(dev);50 err = pci_enable_device(dev);51 if (err)52 return err;53 pci_restore_state(dev);54 err = ssb_bus_resume(ssb);55 if (err)56 return err;57 58 return 0;59}60 61static const struct dev_pm_ops ssb_pcihost_pm_ops = {62 SET_SYSTEM_SLEEP_PM_OPS(ssb_pcihost_suspend, ssb_pcihost_resume)63};64 65#endif /* CONFIG_PM_SLEEP */66 67static int ssb_pcihost_probe(struct pci_dev *dev,68 const struct pci_device_id *id)69{70 struct ssb_bus *ssb;71 int err = -ENOMEM;72 u32 val;73 74 ssb = kzalloc(sizeof(*ssb), GFP_KERNEL);75 if (!ssb)76 goto out;77 err = pci_enable_device(dev);78 if (err)79 goto err_kfree_ssb;80 err = pci_request_regions(dev, dev_driver_string(&dev->dev));81 if (err)82 goto err_pci_disable;83 pci_set_master(dev);84 85 /* Disable the RETRY_TIMEOUT register (0x41) to keep86 * PCI Tx retries from interfering with C3 CPU state */87 pci_read_config_dword(dev, 0x40, &val);88 if ((val & 0x0000ff00) != 0)89 pci_write_config_dword(dev, 0x40, val & 0xffff00ff);90 91 err = ssb_bus_pcibus_register(ssb, dev);92 if (err)93 goto err_pci_release_regions;94 95 pci_set_drvdata(dev, ssb);96 97out:98 return err;99 100err_pci_release_regions:101 pci_release_regions(dev);102err_pci_disable:103 pci_disable_device(dev);104err_kfree_ssb:105 kfree(ssb);106 return err;107}108 109static void ssb_pcihost_remove(struct pci_dev *dev)110{111 struct ssb_bus *ssb = pci_get_drvdata(dev);112 113 ssb_bus_unregister(ssb);114 pci_release_regions(dev);115 pci_disable_device(dev);116 kfree(ssb);117 pci_set_drvdata(dev, NULL);118}119 120int ssb_pcihost_register(struct pci_driver *driver)121{122 driver->probe = ssb_pcihost_probe;123 driver->remove = ssb_pcihost_remove;124#ifdef CONFIG_PM_SLEEP125 driver->driver.pm = &ssb_pcihost_pm_ops;126#endif127 128 return pci_register_driver(driver);129}130EXPORT_SYMBOL(ssb_pcihost_register);131