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 <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_SLEEP 22 static 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 43 static 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 61 static 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 67 static 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 keep 86 * 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 97 out: 98 return err; 99 100 err_pci_release_regions: 101 pci_release_regions(dev); 102 err_pci_disable: 103 pci_disable_device(dev); 104 err_kfree_ssb: 105 kfree(ssb); 106 return err; 107 } 108 109 static 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 120 int ssb_pcihost_register(struct pci_driver *driver) 121 { 122 driver->probe = ssb_pcihost_probe; 123 driver->remove = ssb_pcihost_remove; 124 #ifdef CONFIG_PM_SLEEP 125 driver->driver.pm = &ssb_pcihost_pm_ops; 126 #endif 127 128 return pci_register_driver(driver); 129 } 130 EXPORT_SYMBOL(ssb_pcihost_register); 131