blob: ad3d17c42e23ccef936430210b36e9e649034e01 [file] [log] [blame]
Finn Thain7f86c762018-01-13 17:37:14 -05001// 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>
Finn Thaina8c5cb92018-06-25 21:46:11 +10008#include <linux/dma-mapping.h>
Finn Thain7f86c762018-01-13 17:37:14 -05009#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
17static int nubus_bus_match(struct device *dev, struct device_driver *driver)
18{
19 return 1;
20}
21
22static 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
32static 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
42struct bus_type nubus_bus_type = {
43 .name = "nubus",
44 .match = nubus_bus_match,
45 .probe = nubus_device_probe,
46 .remove = nubus_device_remove,
47};
48EXPORT_SYMBOL(nubus_bus_type);
49
50int nubus_driver_register(struct nubus_driver *ndrv)
51{
52 ndrv->driver.bus = &nubus_bus_type;
53 return driver_register(&ndrv->driver);
54}
55EXPORT_SYMBOL(nubus_driver_register);
56
57void nubus_driver_unregister(struct nubus_driver *ndrv)
58{
59 driver_unregister(&ndrv->driver);
60}
61EXPORT_SYMBOL(nubus_driver_unregister);
62
63static struct device nubus_parent = {
64 .init_name = "nubus",
65};
66
Finn Thainbdeeed02018-05-09 11:04:48 +100067static int __init nubus_bus_register(void)
Finn Thain7f86c762018-01-13 17:37:14 -050068{
Finn Thainbdeeed02018-05-09 11:04:48 +100069 return bus_register(&nubus_bus_type);
70}
71postcore_initcall(nubus_bus_register);
Finn Thain7f86c762018-01-13 17:37:14 -050072
Finn Thainbdeeed02018-05-09 11:04:48 +100073int __init nubus_parent_device_register(void)
74{
75 return device_register(&nubus_parent);
Finn Thain7f86c762018-01-13 17:37:14 -050076}
77
78static 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
91int 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);
Finn Thaina8c5cb92018-06-25 21:46:11 +100097 board->dev.dma_mask = &board->dev.coherent_dma_mask;
98 dma_set_mask(&board->dev, DMA_BIT_MASK(32));
Finn Thain7f86c762018-01-13 17:37:14 -050099 return device_register(&board->dev);
100}
101
102static 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
111int 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}