aboutsummaryrefslogtreecommitdiffstats
path: root/drivers/sh/superhyway/superhyway.c
diff options
context:
space:
mode:
authorLinus Torvalds <torvalds@ppc970.osdl.org>2005-04-16 18:20:36 -0400
committerLinus Torvalds <torvalds@ppc970.osdl.org>2005-04-16 18:20:36 -0400
commit1da177e4c3f41524e886b7f1b8a0c1fc7321cac2 (patch)
tree0bba044c4ce775e45a88a51686b5d9f90697ea9d /drivers/sh/superhyway/superhyway.c
Linux-2.6.12-rc2v2.6.12-rc2
Initial git repository build. I'm not bothering with the full history, even though we have it. We can create a separate "historical" git archive of that later if we want to, and in the meantime it's about 3.2GB when imported into git - space that would just make the early git days unnecessarily complicated, when we don't have a lot of good infrastructure for it. Let it rip!
Diffstat (limited to 'drivers/sh/superhyway/superhyway.c')
-rw-r--r--drivers/sh/superhyway/superhyway.c201
1 files changed, 201 insertions, 0 deletions
diff --git a/drivers/sh/superhyway/superhyway.c b/drivers/sh/superhyway/superhyway.c
new file mode 100644
index 000000000000..f056276b08a1
--- /dev/null
+++ b/drivers/sh/superhyway/superhyway.c
@@ -0,0 +1,201 @@
1/*
2 * drivers/sh/superhyway/superhyway.c
3 *
4 * SuperHyway Bus Driver
5 *
6 * Copyright (C) 2004, 2005 Paul Mundt <lethal@linux-sh.org>
7 *
8 * This file is subject to the terms and conditions of the GNU General Public
9 * License. See the file "COPYING" in the main directory of this archive
10 * for more details.
11 */
12#include <linux/kernel.h>
13#include <linux/device.h>
14#include <linux/init.h>
15#include <linux/module.h>
16#include <linux/types.h>
17#include <linux/list.h>
18#include <linux/superhyway.h>
19
20static int superhyway_devices;
21
22static struct device superhyway_bus_device = {
23 .bus_id = "superhyway",
24};
25
26static void superhyway_device_release(struct device *dev)
27{
28 kfree(to_superhyway_device(dev));
29}
30
31/**
32 * superhyway_add_device - Add a SuperHyway module
33 * @mod_id: Module ID (taken from MODULE.VCR.MOD_ID).
34 * @base: Physical address where module is mapped.
35 * @vcr: VCR value.
36 *
37 * This is responsible for adding a new SuperHyway module. This sets up a new
38 * struct superhyway_device for the module being added. Each one of @mod_id,
39 * @base, and @vcr are registered with the new device for further use
40 * elsewhere.
41 *
42 * Devices are initially added in the order that they are scanned (from the
43 * top-down of the memory map), and are assigned an ID based on the order that
44 * they are added. Any manual addition of a module will thus get the ID after
45 * the devices already discovered regardless of where it resides in memory.
46 *
47 * Further work can and should be done in superhyway_scan_bus(), to be sure
48 * that any new modules are properly discovered and subsequently registered.
49 */
50int superhyway_add_device(unsigned int mod_id, unsigned long base,
51 unsigned long long vcr)
52{
53 struct superhyway_device *dev;
54
55 dev = kmalloc(sizeof(struct superhyway_device), GFP_KERNEL);
56 if (!dev)
57 return -ENOMEM;
58
59 memset(dev, 0, sizeof(struct superhyway_device));
60
61 dev->id.id = mod_id;
62 sprintf(dev->name, "SuperHyway device %04x", dev->id.id);
63
64 dev->vcr = *((struct vcr_info *)(&vcr));
65 dev->resource.name = dev->name;
66 dev->resource.start = base;
67 dev->resource.end = dev->resource.start + 0x01000000;
68 dev->dev.parent = &superhyway_bus_device;
69 dev->dev.bus = &superhyway_bus_type;
70 dev->dev.release = superhyway_device_release;
71
72 sprintf(dev->dev.bus_id, "%02x", superhyway_devices);
73
74 superhyway_devices++;
75
76 return device_register(&dev->dev);
77}
78
79static int __init superhyway_init(void)
80{
81 device_register(&superhyway_bus_device);
82 return superhyway_scan_bus();
83}
84
85postcore_initcall(superhyway_init);
86
87static const struct superhyway_device_id *
88superhyway_match_id(const struct superhyway_device_id *ids,
89 struct superhyway_device *dev)
90{
91 while (ids->id) {
92 if (ids->id == dev->id.id)
93 return ids;
94
95 ids++;
96 }
97
98 return NULL;
99}
100
101static int superhyway_device_probe(struct device *dev)
102{
103 struct superhyway_device *shyway_dev = to_superhyway_device(dev);
104 struct superhyway_driver *shyway_drv = to_superhyway_driver(dev->driver);
105
106 if (shyway_drv && shyway_drv->probe) {
107 const struct superhyway_device_id *id;
108
109 id = superhyway_match_id(shyway_drv->id_table, shyway_dev);
110 if (id)
111 return shyway_drv->probe(shyway_dev, id);
112 }
113
114 return -ENODEV;
115}
116
117static int superhyway_device_remove(struct device *dev)
118{
119 struct superhyway_device *shyway_dev = to_superhyway_device(dev);
120 struct superhyway_driver *shyway_drv = to_superhyway_driver(dev->driver);
121
122 if (shyway_drv && shyway_drv->remove) {
123 shyway_drv->remove(shyway_dev);
124 return 0;
125 }
126
127 return -ENODEV;
128}
129
130/**
131 * superhyway_register_driver - Register a new SuperHyway driver
132 * @drv: SuperHyway driver to register.
133 *
134 * This registers the passed in @drv. Any devices matching the id table will
135 * automatically be populated and handed off to the driver's specified probe
136 * routine.
137 */
138int superhyway_register_driver(struct superhyway_driver *drv)
139{
140 drv->drv.name = drv->name;
141 drv->drv.bus = &superhyway_bus_type;
142 drv->drv.probe = superhyway_device_probe;
143 drv->drv.remove = superhyway_device_remove;
144
145 return driver_register(&drv->drv);
146}
147
148/**
149 * superhyway_unregister_driver - Unregister a SuperHyway driver
150 * @drv: SuperHyway driver to unregister.
151 *
152 * This cleans up after superhyway_register_driver(), and should be invoked in
153 * the exit path of any module drivers.
154 */
155void superhyway_unregister_driver(struct superhyway_driver *drv)
156{
157 driver_unregister(&drv->drv);
158}
159
160static int superhyway_bus_match(struct device *dev, struct device_driver *drv)
161{
162 struct superhyway_device *shyway_dev = to_superhyway_device(dev);
163 struct superhyway_driver *shyway_drv = to_superhyway_driver(drv);
164 const struct superhyway_device_id *ids = shyway_drv->id_table;
165
166 if (!ids)
167 return -EINVAL;
168 if (superhyway_match_id(ids, shyway_dev))
169 return 1;
170
171 return -ENODEV;
172}
173
174struct bus_type superhyway_bus_type = {
175 .name = "superhyway",
176 .match = superhyway_bus_match,
177#ifdef CONFIG_SYSFS
178 .dev_attrs = superhyway_dev_attrs,
179#endif
180};
181
182static int __init superhyway_bus_init(void)
183{
184 return bus_register(&superhyway_bus_type);
185}
186
187static void __exit superhyway_bus_exit(void)
188{
189 device_unregister(&superhyway_bus_device);
190 bus_unregister(&superhyway_bus_type);
191}
192
193core_initcall(superhyway_bus_init);
194module_exit(superhyway_bus_exit);
195
196EXPORT_SYMBOL(superhyway_bus_type);
197EXPORT_SYMBOL(superhyway_add_device);
198EXPORT_SYMBOL(superhyway_register_driver);
199EXPORT_SYMBOL(superhyway_unregister_driver);
200
201MODULE_LICENSE("GPL");