1989d42e8SGreg Kroah-Hartman // SPDX-License-Identifier: GPL-2.0
2a5117ba7SRene Herman /*
3a5117ba7SRene Herman * ISA bus.
4a5117ba7SRene Herman */
5a5117ba7SRene Herman
6a5117ba7SRene Herman #include <linux/device.h>
7a5117ba7SRene Herman #include <linux/kernel.h>
8a5117ba7SRene Herman #include <linux/slab.h>
9a5117ba7SRene Herman #include <linux/module.h>
10a5117ba7SRene Herman #include <linux/init.h>
1100412be1SRene Herman #include <linux/dma-mapping.h>
12a5117ba7SRene Herman #include <linux/isa.h>
13a5117ba7SRene Herman
14a5117ba7SRene Herman static struct device isa_bus = {
151e0b2cf9SKay Sievers .init_name = "isa"
16a5117ba7SRene Herman };
17a5117ba7SRene Herman
18a5117ba7SRene Herman struct isa_dev {
19a5117ba7SRene Herman struct device dev;
20a5117ba7SRene Herman struct device *next;
21a5117ba7SRene Herman unsigned int id;
22a5117ba7SRene Herman };
23a5117ba7SRene Herman
24a5117ba7SRene Herman #define to_isa_dev(x) container_of((x), struct isa_dev, dev)
25a5117ba7SRene Herman
isa_bus_match(struct device * dev,struct device_driver * driver)26a5117ba7SRene Herman static int isa_bus_match(struct device *dev, struct device_driver *driver)
27a5117ba7SRene Herman {
28a5117ba7SRene Herman struct isa_driver *isa_driver = to_isa_driver(driver);
29a5117ba7SRene Herman
30a5117ba7SRene Herman if (dev->platform_data == isa_driver) {
31a5117ba7SRene Herman if (!isa_driver->match ||
32a5117ba7SRene Herman isa_driver->match(dev, to_isa_dev(dev)->id))
33a5117ba7SRene Herman return 1;
34a5117ba7SRene Herman dev->platform_data = NULL;
35a5117ba7SRene Herman }
36a5117ba7SRene Herman return 0;
37a5117ba7SRene Herman }
38a5117ba7SRene Herman
isa_bus_probe(struct device * dev)39a5117ba7SRene Herman static int isa_bus_probe(struct device *dev)
40a5117ba7SRene Herman {
41a5117ba7SRene Herman struct isa_driver *isa_driver = dev->platform_data;
42a5117ba7SRene Herman
435a244727SWilliam Breathitt Gray if (isa_driver && isa_driver->probe)
44a5117ba7SRene Herman return isa_driver->probe(dev, to_isa_dev(dev)->id);
45a5117ba7SRene Herman
46a5117ba7SRene Herman return 0;
47a5117ba7SRene Herman }
48a5117ba7SRene Herman
isa_bus_remove(struct device * dev)49*fc7a6209SUwe Kleine-König static void isa_bus_remove(struct device *dev)
50a5117ba7SRene Herman {
51a5117ba7SRene Herman struct isa_driver *isa_driver = dev->platform_data;
52a5117ba7SRene Herman
535a244727SWilliam Breathitt Gray if (isa_driver && isa_driver->remove)
5430e88d01SUwe Kleine-König isa_driver->remove(dev, to_isa_dev(dev)->id);
55a5117ba7SRene Herman }
56a5117ba7SRene Herman
isa_bus_shutdown(struct device * dev)57a5117ba7SRene Herman static void isa_bus_shutdown(struct device *dev)
58a5117ba7SRene Herman {
59a5117ba7SRene Herman struct isa_driver *isa_driver = dev->platform_data;
60a5117ba7SRene Herman
615a244727SWilliam Breathitt Gray if (isa_driver && isa_driver->shutdown)
62a5117ba7SRene Herman isa_driver->shutdown(dev, to_isa_dev(dev)->id);
63a5117ba7SRene Herman }
64a5117ba7SRene Herman
isa_bus_suspend(struct device * dev,pm_message_t state)65a5117ba7SRene Herman static int isa_bus_suspend(struct device *dev, pm_message_t state)
66a5117ba7SRene Herman {
67a5117ba7SRene Herman struct isa_driver *isa_driver = dev->platform_data;
68a5117ba7SRene Herman
695a244727SWilliam Breathitt Gray if (isa_driver && isa_driver->suspend)
70a5117ba7SRene Herman return isa_driver->suspend(dev, to_isa_dev(dev)->id, state);
71a5117ba7SRene Herman
72a5117ba7SRene Herman return 0;
73a5117ba7SRene Herman }
74a5117ba7SRene Herman
isa_bus_resume(struct device * dev)75a5117ba7SRene Herman static int isa_bus_resume(struct device *dev)
76a5117ba7SRene Herman {
77a5117ba7SRene Herman struct isa_driver *isa_driver = dev->platform_data;
78a5117ba7SRene Herman
795a244727SWilliam Breathitt Gray if (isa_driver && isa_driver->resume)
80a5117ba7SRene Herman return isa_driver->resume(dev, to_isa_dev(dev)->id);
81a5117ba7SRene Herman
82a5117ba7SRene Herman return 0;
83a5117ba7SRene Herman }
84a5117ba7SRene Herman
85a5117ba7SRene Herman static struct bus_type isa_bus_type = {
86a5117ba7SRene Herman .name = "isa",
87a5117ba7SRene Herman .match = isa_bus_match,
88a5117ba7SRene Herman .probe = isa_bus_probe,
89a5117ba7SRene Herman .remove = isa_bus_remove,
90a5117ba7SRene Herman .shutdown = isa_bus_shutdown,
91a5117ba7SRene Herman .suspend = isa_bus_suspend,
92a5117ba7SRene Herman .resume = isa_bus_resume
93a5117ba7SRene Herman };
94a5117ba7SRene Herman
isa_dev_release(struct device * dev)95a5117ba7SRene Herman static void isa_dev_release(struct device *dev)
96a5117ba7SRene Herman {
97a5117ba7SRene Herman kfree(to_isa_dev(dev));
98a5117ba7SRene Herman }
99a5117ba7SRene Herman
isa_unregister_driver(struct isa_driver * isa_driver)100a5117ba7SRene Herman void isa_unregister_driver(struct isa_driver *isa_driver)
101a5117ba7SRene Herman {
102a5117ba7SRene Herman struct device *dev = isa_driver->devices;
103a5117ba7SRene Herman
104a5117ba7SRene Herman while (dev) {
105a5117ba7SRene Herman struct device *tmp = to_isa_dev(dev)->next;
106a5117ba7SRene Herman device_unregister(dev);
107a5117ba7SRene Herman dev = tmp;
108a5117ba7SRene Herman }
109a5117ba7SRene Herman driver_unregister(&isa_driver->driver);
110a5117ba7SRene Herman }
111a5117ba7SRene Herman EXPORT_SYMBOL_GPL(isa_unregister_driver);
112a5117ba7SRene Herman
isa_register_driver(struct isa_driver * isa_driver,unsigned int ndev)113a5117ba7SRene Herman int isa_register_driver(struct isa_driver *isa_driver, unsigned int ndev)
114a5117ba7SRene Herman {
115a5117ba7SRene Herman int error;
116a5117ba7SRene Herman unsigned int id;
117a5117ba7SRene Herman
118a5117ba7SRene Herman isa_driver->driver.bus = &isa_bus_type;
119a5117ba7SRene Herman isa_driver->devices = NULL;
120a5117ba7SRene Herman
121a5117ba7SRene Herman error = driver_register(&isa_driver->driver);
122a5117ba7SRene Herman if (error)
123a5117ba7SRene Herman return error;
124a5117ba7SRene Herman
125a5117ba7SRene Herman for (id = 0; id < ndev; id++) {
126a5117ba7SRene Herman struct isa_dev *isa_dev;
127a5117ba7SRene Herman
128a5117ba7SRene Herman isa_dev = kzalloc(sizeof *isa_dev, GFP_KERNEL);
129a5117ba7SRene Herman if (!isa_dev) {
130a5117ba7SRene Herman error = -ENOMEM;
131a5117ba7SRene Herman break;
132a5117ba7SRene Herman }
133a5117ba7SRene Herman
134a5117ba7SRene Herman isa_dev->dev.parent = &isa_bus;
135a5117ba7SRene Herman isa_dev->dev.bus = &isa_bus_type;
136a5117ba7SRene Herman
1371e0b2cf9SKay Sievers dev_set_name(&isa_dev->dev, "%s.%u",
138a5117ba7SRene Herman isa_driver->driver.name, id);
139a5117ba7SRene Herman isa_dev->dev.platform_data = isa_driver;
140a5117ba7SRene Herman isa_dev->dev.release = isa_dev_release;
141a5117ba7SRene Herman isa_dev->id = id;
142a5117ba7SRene Herman
1432f4f27d4SYang Hongyang isa_dev->dev.coherent_dma_mask = DMA_BIT_MASK(24);
14400412be1SRene Herman isa_dev->dev.dma_mask = &isa_dev->dev.coherent_dma_mask;
14500412be1SRene Herman
146a5117ba7SRene Herman error = device_register(&isa_dev->dev);
147a5117ba7SRene Herman if (error) {
148a5117ba7SRene Herman put_device(&isa_dev->dev);
149a5117ba7SRene Herman break;
150a5117ba7SRene Herman }
151a5117ba7SRene Herman
152a5117ba7SRene Herman isa_dev->next = isa_driver->devices;
153a5117ba7SRene Herman isa_driver->devices = &isa_dev->dev;
154a5117ba7SRene Herman }
155a5117ba7SRene Herman
156a5117ba7SRene Herman if (!error && !isa_driver->devices)
157a5117ba7SRene Herman error = -ENODEV;
158a5117ba7SRene Herman
159a5117ba7SRene Herman if (error)
160a5117ba7SRene Herman isa_unregister_driver(isa_driver);
161a5117ba7SRene Herman
162a5117ba7SRene Herman return error;
163a5117ba7SRene Herman }
164a5117ba7SRene Herman EXPORT_SYMBOL_GPL(isa_register_driver);
165a5117ba7SRene Herman
isa_bus_init(void)166a5117ba7SRene Herman static int __init isa_bus_init(void)
167a5117ba7SRene Herman {
168a5117ba7SRene Herman int error;
169a5117ba7SRene Herman
170a5117ba7SRene Herman error = bus_register(&isa_bus_type);
171a5117ba7SRene Herman if (!error) {
172a5117ba7SRene Herman error = device_register(&isa_bus);
173a5117ba7SRene Herman if (error)
174a5117ba7SRene Herman bus_unregister(&isa_bus_type);
175a5117ba7SRene Herman }
176a5117ba7SRene Herman return error;
177a5117ba7SRene Herman }
178a5117ba7SRene Herman
17932a5a0c0SWilliam Breathitt Gray postcore_initcall(isa_bus_init);
180