1
2
3
4
5
6
7
8
9
10
11#include <linux/module.h>
12#include <linux/types.h>
13#include <linux/kernel.h>
14#include <linux/init.h>
15#include <linux/zorro.h>
16#include <linux/bitops.h>
17#include <linux/string.h>
18#include <linux/platform_device.h>
19#include <linux/slab.h>
20
21#include <asm/setup.h>
22#include <asm/amigahw.h>
23
24#include "zorro.h"
25
26
27
28
29
30
31unsigned int zorro_num_autocon;
32struct zorro_dev zorro_autocon[ZORRO_NUM_AUTO];
33
34
35
36
37
38
39struct zorro_bus {
40 struct device dev;
41};
42
43
44
45
46
47
48struct zorro_dev *zorro_find_device(zorro_id id, struct zorro_dev *from)
49{
50 struct zorro_dev *z;
51
52 if (!zorro_num_autocon)
53 return NULL;
54
55 for (z = from ? from+1 : &zorro_autocon[0];
56 z < zorro_autocon+zorro_num_autocon;
57 z++)
58 if (id == ZORRO_WILDCARD || id == z->id)
59 return z;
60 return NULL;
61}
62EXPORT_SYMBOL(zorro_find_device);
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80DECLARE_BITMAP(zorro_unused_z2ram, 128);
81EXPORT_SYMBOL(zorro_unused_z2ram);
82
83
84static void __init mark_region(unsigned long start, unsigned long end,
85 int flag)
86{
87 if (flag)
88 start += Z2RAM_CHUNKMASK;
89 else
90 end += Z2RAM_CHUNKMASK;
91 start &= ~Z2RAM_CHUNKMASK;
92 end &= ~Z2RAM_CHUNKMASK;
93
94 if (end <= Z2RAM_START || start >= Z2RAM_END)
95 return;
96 start = start < Z2RAM_START ? 0x00000000 : start-Z2RAM_START;
97 end = end > Z2RAM_END ? Z2RAM_SIZE : end-Z2RAM_START;
98 while (start < end) {
99 u32 chunk = start>>Z2RAM_CHUNKSHIFT;
100 if (flag)
101 set_bit(chunk, zorro_unused_z2ram);
102 else
103 clear_bit(chunk, zorro_unused_z2ram);
104 start += Z2RAM_CHUNKSIZE;
105 }
106}
107
108
109static struct resource __init *zorro_find_parent_resource(
110 struct platform_device *bridge, struct zorro_dev *z)
111{
112 int i;
113
114 for (i = 0; i < bridge->num_resources; i++) {
115 struct resource *r = &bridge->resource[i];
116 if (zorro_resource_start(z) >= r->start &&
117 zorro_resource_end(z) <= r->end)
118 return r;
119 }
120 return &iomem_resource;
121}
122
123
124
125static int __init amiga_zorro_probe(struct platform_device *pdev)
126{
127 struct zorro_bus *bus;
128 struct zorro_dev *z;
129 struct resource *r;
130 unsigned int i;
131 int error;
132
133
134 bus = kzalloc(sizeof(*bus), GFP_KERNEL);
135 if (!bus)
136 return -ENOMEM;
137
138 bus->dev.parent = &pdev->dev;
139 dev_set_name(&bus->dev, "zorro");
140 error = device_register(&bus->dev);
141 if (error) {
142 pr_err("Zorro: Error registering zorro_bus\n");
143 put_device(&bus->dev);
144 kfree(bus);
145 return error;
146 }
147 platform_set_drvdata(pdev, bus);
148
149 pr_info("Zorro: Probing AutoConfig expansion devices: %u device%s\n",
150 zorro_num_autocon, zorro_num_autocon == 1 ? "" : "s");
151
152
153 for (i = 0; i < zorro_num_autocon; i++) {
154 z = &zorro_autocon[i];
155 z->id = (z->rom.er_Manufacturer<<16) | (z->rom.er_Product<<8);
156 if (z->id == ZORRO_PROD_GVP_EPC_BASE) {
157
158 unsigned long magic = zorro_resource_start(z)+0x8000;
159 z->id |= *(u16 *)ZTWO_VADDR(magic) & GVP_PRODMASK;
160 }
161 sprintf(z->name, "Zorro device %08x", z->id);
162 zorro_name_device(z);
163 z->resource.name = z->name;
164 r = zorro_find_parent_resource(pdev, z);
165 error = request_resource(r, &z->resource);
166 if (error)
167 dev_err(&bus->dev,
168 "Address space collision on device %s %pR\n",
169 z->name, &z->resource);
170 dev_set_name(&z->dev, "%02x", i);
171 z->dev.parent = &bus->dev;
172 z->dev.bus = &zorro_bus_type;
173 }
174
175
176 for (i = 0; i < zorro_num_autocon; i++) {
177 z = &zorro_autocon[i];
178 error = device_register(&z->dev);
179 if (error) {
180 dev_err(&bus->dev, "Error registering device %s\n",
181 z->name);
182 put_device(&z->dev);
183 continue;
184 }
185 error = zorro_create_sysfs_dev_files(z);
186 if (error)
187 dev_err(&z->dev, "Error creating sysfs files\n");
188 }
189
190
191 zorro_for_each_dev(z) {
192 if (z->rom.er_Type & ERTF_MEMLIST)
193 mark_region(zorro_resource_start(z),
194 zorro_resource_end(z)+1, 1);
195 }
196
197
198 for (i = 0; i < m68k_num_memory; i++)
199 if (m68k_memory[i].addr < 16*1024*1024)
200 mark_region(m68k_memory[i].addr,
201 m68k_memory[i].addr+m68k_memory[i].size,
202 0);
203
204 return 0;
205}
206
207static struct platform_driver amiga_zorro_driver = {
208 .driver = {
209 .name = "amiga-zorro",
210 .owner = THIS_MODULE,
211 },
212};
213
214static int __init amiga_zorro_init(void)
215{
216 return platform_driver_probe(&amiga_zorro_driver, amiga_zorro_probe);
217}
218
219module_init(amiga_zorro_init);
220
221MODULE_LICENSE("GPL");
222