Merge git://git.kernel.org/pub/scm/linux/kernel/git/davem/sparc-2.6
[linux-2.6.git] / drivers / ssb / pcihost_wrapper.c
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
19 static 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
34 static 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
55 static 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
82 out:
83         return err;
84
85 err_pci_release_regions:
86         pci_release_regions(dev);
87 err_pci_disable:
88         pci_disable_device(dev);
89 err_kfree_ssb:
90         kfree(ssb);
91         return err;
92 }
93
94 static 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
105 int 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 }
114 EXPORT_SYMBOL(ssb_pcihost_register);