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