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