tjh.dev
Linux kernel mirror (for testing)
git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git
kernel
os
linux
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);