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