1 // SPDX-License-Identifier: GPL-2.0
2 //
3 // Bus implementation for the NuBus subsystem.
4 //
5 // Copyright (C) 2017 Finn Thain
6
7 #include <linux/device.h>
8 #include <linux/dma-mapping.h>
9 #include <linux/list.h>
10 #include <linux/nubus.h>
11 #include <linux/seq_file.h>
12 #include <linux/slab.h>
13
14 #define to_nubus_board(d) container_of(d, struct nubus_board, dev)
15 #define to_nubus_driver(d) container_of(d, struct nubus_driver, driver)
16
nubus_bus_match(struct device * dev,struct device_driver * driver)17 static int nubus_bus_match(struct device *dev, struct device_driver *driver)
18 {
19 return 1;
20 }
21
nubus_device_probe(struct device * dev)22 static int nubus_device_probe(struct device *dev)
23 {
24 struct nubus_driver *ndrv = to_nubus_driver(dev->driver);
25 int err = -ENODEV;
26
27 if (ndrv->probe)
28 err = ndrv->probe(to_nubus_board(dev));
29 return err;
30 }
31
nubus_device_remove(struct device * dev)32 static int nubus_device_remove(struct device *dev)
33 {
34 struct nubus_driver *ndrv = to_nubus_driver(dev->driver);
35 int err = -ENODEV;
36
37 if (dev->driver && ndrv->remove)
38 err = ndrv->remove(to_nubus_board(dev));
39 return err;
40 }
41
42 struct bus_type nubus_bus_type = {
43 .name = "nubus",
44 .match = nubus_bus_match,
45 .probe = nubus_device_probe,
46 .remove = nubus_device_remove,
47 };
48 EXPORT_SYMBOL(nubus_bus_type);
49
nubus_driver_register(struct nubus_driver * ndrv)50 int nubus_driver_register(struct nubus_driver *ndrv)
51 {
52 ndrv->driver.bus = &nubus_bus_type;
53 return driver_register(&ndrv->driver);
54 }
55 EXPORT_SYMBOL(nubus_driver_register);
56
nubus_driver_unregister(struct nubus_driver * ndrv)57 void nubus_driver_unregister(struct nubus_driver *ndrv)
58 {
59 driver_unregister(&ndrv->driver);
60 }
61 EXPORT_SYMBOL(nubus_driver_unregister);
62
63 static struct device nubus_parent = {
64 .init_name = "nubus",
65 };
66
nubus_bus_register(void)67 static int __init nubus_bus_register(void)
68 {
69 return bus_register(&nubus_bus_type);
70 }
71 postcore_initcall(nubus_bus_register);
72
nubus_parent_device_register(void)73 int __init nubus_parent_device_register(void)
74 {
75 return device_register(&nubus_parent);
76 }
77
nubus_device_release(struct device * dev)78 static void nubus_device_release(struct device *dev)
79 {
80 struct nubus_board *board = to_nubus_board(dev);
81 struct nubus_rsrc *fres, *tmp;
82
83 list_for_each_entry_safe(fres, tmp, &nubus_func_rsrcs, list)
84 if (fres->board == board) {
85 list_del(&fres->list);
86 kfree(fres);
87 }
88 kfree(board);
89 }
90
nubus_device_register(struct nubus_board * board)91 int nubus_device_register(struct nubus_board *board)
92 {
93 board->dev.parent = &nubus_parent;
94 board->dev.release = nubus_device_release;
95 board->dev.bus = &nubus_bus_type;
96 dev_set_name(&board->dev, "slot.%X", board->slot);
97 board->dev.dma_mask = &board->dev.coherent_dma_mask;
98 dma_set_mask(&board->dev, DMA_BIT_MASK(32));
99 return device_register(&board->dev);
100 }
101
nubus_print_device_name_fn(struct device * dev,void * data)102 static int nubus_print_device_name_fn(struct device *dev, void *data)
103 {
104 struct nubus_board *board = to_nubus_board(dev);
105 struct seq_file *m = data;
106
107 seq_printf(m, "Slot %X: %s\n", board->slot, board->name);
108 return 0;
109 }
110
nubus_proc_show(struct seq_file * m,void * data)111 int nubus_proc_show(struct seq_file *m, void *data)
112 {
113 return bus_for_each_dev(&nubus_bus_type, NULL, m,
114 nubus_print_device_name_fn);
115 }
116