Root/
1 | /* |
2 | * Zorro Driver Services |
3 | * |
4 | * Copyright (C) 2003 Geert Uytterhoeven |
5 | * |
6 | * Loosely based on drivers/pci/pci-driver.c |
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 | |
13 | #include <linux/init.h> |
14 | #include <linux/module.h> |
15 | #include <linux/zorro.h> |
16 | |
17 | |
18 | /** |
19 | * zorro_match_device - Tell if a Zorro device structure has a matching |
20 | * Zorro device id structure |
21 | * @ids: array of Zorro device id structures to search in |
22 | * @dev: the Zorro device structure to match against |
23 | * |
24 | * Used by a driver to check whether a Zorro device present in the |
25 | * system is in its list of supported devices. Returns the matching |
26 | * zorro_device_id structure or %NULL if there is no match. |
27 | */ |
28 | |
29 | const struct zorro_device_id * |
30 | zorro_match_device(const struct zorro_device_id *ids, |
31 | const struct zorro_dev *z) |
32 | { |
33 | while (ids->id) { |
34 | if (ids->id == ZORRO_WILDCARD || ids->id == z->id) |
35 | return ids; |
36 | ids++; |
37 | } |
38 | return NULL; |
39 | } |
40 | EXPORT_SYMBOL(zorro_match_device); |
41 | |
42 | |
43 | static int zorro_device_probe(struct device *dev) |
44 | { |
45 | int error = 0; |
46 | struct zorro_driver *drv = to_zorro_driver(dev->driver); |
47 | struct zorro_dev *z = to_zorro_dev(dev); |
48 | |
49 | if (!z->driver && drv->probe) { |
50 | const struct zorro_device_id *id; |
51 | |
52 | id = zorro_match_device(drv->id_table, z); |
53 | if (id) |
54 | error = drv->probe(z, id); |
55 | if (error >= 0) { |
56 | z->driver = drv; |
57 | error = 0; |
58 | } |
59 | } |
60 | return error; |
61 | } |
62 | |
63 | |
64 | static int zorro_device_remove(struct device *dev) |
65 | { |
66 | struct zorro_dev *z = to_zorro_dev(dev); |
67 | struct zorro_driver *drv = to_zorro_driver(dev->driver); |
68 | |
69 | if (drv) { |
70 | if (drv->remove) |
71 | drv->remove(z); |
72 | z->driver = NULL; |
73 | } |
74 | return 0; |
75 | } |
76 | |
77 | |
78 | /** |
79 | * zorro_register_driver - register a new Zorro driver |
80 | * @drv: the driver structure to register |
81 | * |
82 | * Adds the driver structure to the list of registered drivers |
83 | * Returns zero or a negative error value. |
84 | */ |
85 | |
86 | int zorro_register_driver(struct zorro_driver *drv) |
87 | { |
88 | /* initialize common driver fields */ |
89 | drv->driver.name = drv->name; |
90 | drv->driver.bus = &zorro_bus_type; |
91 | |
92 | /* register with core */ |
93 | return driver_register(&drv->driver); |
94 | } |
95 | EXPORT_SYMBOL(zorro_register_driver); |
96 | |
97 | |
98 | /** |
99 | * zorro_unregister_driver - unregister a zorro driver |
100 | * @drv: the driver structure to unregister |
101 | * |
102 | * Deletes the driver structure from the list of registered Zorro drivers, |
103 | * gives it a chance to clean up by calling its remove() function for |
104 | * each device it was responsible for, and marks those devices as |
105 | * driverless. |
106 | */ |
107 | |
108 | void zorro_unregister_driver(struct zorro_driver *drv) |
109 | { |
110 | driver_unregister(&drv->driver); |
111 | } |
112 | EXPORT_SYMBOL(zorro_unregister_driver); |
113 | |
114 | |
115 | /** |
116 | * zorro_bus_match - Tell if a Zorro device structure has a matching Zorro |
117 | * device id structure |
118 | * @ids: array of Zorro device id structures to search in |
119 | * @dev: the Zorro device structure to match against |
120 | * |
121 | * Used by a driver to check whether a Zorro device present in the |
122 | * system is in its list of supported devices.Returns the matching |
123 | * zorro_device_id structure or %NULL if there is no match. |
124 | */ |
125 | |
126 | static int zorro_bus_match(struct device *dev, struct device_driver *drv) |
127 | { |
128 | struct zorro_dev *z = to_zorro_dev(dev); |
129 | struct zorro_driver *zorro_drv = to_zorro_driver(drv); |
130 | const struct zorro_device_id *ids = zorro_drv->id_table; |
131 | |
132 | if (!ids) |
133 | return 0; |
134 | |
135 | while (ids->id) { |
136 | if (ids->id == ZORRO_WILDCARD || ids->id == z->id) |
137 | return 1; |
138 | ids++; |
139 | } |
140 | return 0; |
141 | } |
142 | |
143 | static int zorro_uevent(struct device *dev, struct kobj_uevent_env *env) |
144 | { |
145 | struct zorro_dev *z; |
146 | |
147 | if (!dev) |
148 | return -ENODEV; |
149 | |
150 | z = to_zorro_dev(dev); |
151 | if (!z) |
152 | return -ENODEV; |
153 | |
154 | if (add_uevent_var(env, "ZORRO_ID=%08X", z->id) || |
155 | add_uevent_var(env, "ZORRO_SLOT_NAME=%s", dev_name(dev)) || |
156 | add_uevent_var(env, "ZORRO_SLOT_ADDR=%04X", z->slotaddr) || |
157 | add_uevent_var(env, "MODALIAS=" ZORRO_DEVICE_MODALIAS_FMT, z->id)) |
158 | return -ENOMEM; |
159 | |
160 | return 0; |
161 | } |
162 | |
163 | struct bus_type zorro_bus_type = { |
164 | .name = "zorro", |
165 | .match = zorro_bus_match, |
166 | .uevent = zorro_uevent, |
167 | .probe = zorro_device_probe, |
168 | .remove = zorro_device_remove, |
169 | }; |
170 | EXPORT_SYMBOL(zorro_bus_type); |
171 | |
172 | |
173 | static int __init zorro_driver_init(void) |
174 | { |
175 | return bus_register(&zorro_bus_type); |
176 | } |
177 | |
178 | postcore_initcall(zorro_driver_init); |
179 | |
180 |
Branches:
ben-wpan
ben-wpan-stefan
javiroman/ks7010
jz-2.6.34
jz-2.6.34-rc5
jz-2.6.34-rc6
jz-2.6.34-rc7
jz-2.6.35
jz-2.6.36
jz-2.6.37
jz-2.6.38
jz-2.6.39
jz-3.0
jz-3.1
jz-3.11
jz-3.12
jz-3.13
jz-3.15
jz-3.16
jz-3.18-dt
jz-3.2
jz-3.3
jz-3.4
jz-3.5
jz-3.6
jz-3.6-rc2-pwm
jz-3.9
jz-3.9-clk
jz-3.9-rc8
jz47xx
jz47xx-2.6.38
master
Tags:
od-2011-09-04
od-2011-09-18
v2.6.34-rc5
v2.6.34-rc6
v2.6.34-rc7
v3.9