|
@@ -15,6 +15,8 @@
|
|
|
#include <linux/zorro.h>
|
|
|
#include <linux/bitops.h>
|
|
|
#include <linux/string.h>
|
|
|
+#include <linux/platform_device.h>
|
|
|
+#include <linux/slab.h>
|
|
|
|
|
|
#include <asm/setup.h>
|
|
|
#include <asm/amigahw.h>
|
|
@@ -26,24 +28,17 @@
|
|
|
* Zorro Expansion Devices
|
|
|
*/
|
|
|
|
|
|
-u_int zorro_num_autocon = 0;
|
|
|
+unsigned int zorro_num_autocon;
|
|
|
struct zorro_dev zorro_autocon[ZORRO_NUM_AUTO];
|
|
|
|
|
|
|
|
|
/*
|
|
|
- * Single Zorro bus
|
|
|
+ * Zorro bus
|
|
|
*/
|
|
|
|
|
|
-struct zorro_bus zorro_bus = {\
|
|
|
- .resources = {
|
|
|
- /* Zorro II regions (on Zorro II/III) */
|
|
|
- { .name = "Zorro II exp", .start = 0x00e80000, .end = 0x00efffff },
|
|
|
- { .name = "Zorro II mem", .start = 0x00200000, .end = 0x009fffff },
|
|
|
- /* Zorro III regions (on Zorro III only) */
|
|
|
- { .name = "Zorro III exp", .start = 0xff000000, .end = 0xffffffff },
|
|
|
- { .name = "Zorro III cfg", .start = 0x40000000, .end = 0x7fffffff }
|
|
|
- },
|
|
|
- .name = "Zorro bus"
|
|
|
+struct zorro_bus {
|
|
|
+ struct list_head devices; /* list of devices on this bus */
|
|
|
+ struct device dev;
|
|
|
};
|
|
|
|
|
|
|
|
@@ -53,18 +48,19 @@ struct zorro_bus zorro_bus = {\
|
|
|
|
|
|
struct zorro_dev *zorro_find_device(zorro_id id, struct zorro_dev *from)
|
|
|
{
|
|
|
- struct zorro_dev *z;
|
|
|
+ struct zorro_dev *z;
|
|
|
|
|
|
- if (!MACH_IS_AMIGA || !AMIGAHW_PRESENT(ZORRO))
|
|
|
- return NULL;
|
|
|
+ if (!zorro_num_autocon)
|
|
|
+ return NULL;
|
|
|
|
|
|
- for (z = from ? from+1 : &zorro_autocon[0];
|
|
|
- z < zorro_autocon+zorro_num_autocon;
|
|
|
- z++)
|
|
|
- if (id == ZORRO_WILDCARD || id == z->id)
|
|
|
- return z;
|
|
|
- return NULL;
|
|
|
+ for (z = from ? from+1 : &zorro_autocon[0];
|
|
|
+ z < zorro_autocon+zorro_num_autocon;
|
|
|
+ z++)
|
|
|
+ if (id == ZORRO_WILDCARD || id == z->id)
|
|
|
+ return z;
|
|
|
+ return NULL;
|
|
|
}
|
|
|
+EXPORT_SYMBOL(zorro_find_device);
|
|
|
|
|
|
|
|
|
/*
|
|
@@ -83,121 +79,138 @@ struct zorro_dev *zorro_find_device(zorro_id id, struct zorro_dev *from)
|
|
|
*/
|
|
|
|
|
|
DECLARE_BITMAP(zorro_unused_z2ram, 128);
|
|
|
+EXPORT_SYMBOL(zorro_unused_z2ram);
|
|
|
|
|
|
|
|
|
static void __init mark_region(unsigned long start, unsigned long end,
|
|
|
int flag)
|
|
|
{
|
|
|
- if (flag)
|
|
|
- start += Z2RAM_CHUNKMASK;
|
|
|
- else
|
|
|
- end += Z2RAM_CHUNKMASK;
|
|
|
- start &= ~Z2RAM_CHUNKMASK;
|
|
|
- end &= ~Z2RAM_CHUNKMASK;
|
|
|
-
|
|
|
- if (end <= Z2RAM_START || start >= Z2RAM_END)
|
|
|
- return;
|
|
|
- start = start < Z2RAM_START ? 0x00000000 : start-Z2RAM_START;
|
|
|
- end = end > Z2RAM_END ? Z2RAM_SIZE : end-Z2RAM_START;
|
|
|
- while (start < end) {
|
|
|
- u32 chunk = start>>Z2RAM_CHUNKSHIFT;
|
|
|
if (flag)
|
|
|
- set_bit(chunk, zorro_unused_z2ram);
|
|
|
+ start += Z2RAM_CHUNKMASK;
|
|
|
else
|
|
|
- clear_bit(chunk, zorro_unused_z2ram);
|
|
|
- start += Z2RAM_CHUNKSIZE;
|
|
|
- }
|
|
|
+ end += Z2RAM_CHUNKMASK;
|
|
|
+ start &= ~Z2RAM_CHUNKMASK;
|
|
|
+ end &= ~Z2RAM_CHUNKMASK;
|
|
|
+
|
|
|
+ if (end <= Z2RAM_START || start >= Z2RAM_END)
|
|
|
+ return;
|
|
|
+ start = start < Z2RAM_START ? 0x00000000 : start-Z2RAM_START;
|
|
|
+ end = end > Z2RAM_END ? Z2RAM_SIZE : end-Z2RAM_START;
|
|
|
+ while (start < end) {
|
|
|
+ u32 chunk = start>>Z2RAM_CHUNKSHIFT;
|
|
|
+ if (flag)
|
|
|
+ set_bit(chunk, zorro_unused_z2ram);
|
|
|
+ else
|
|
|
+ clear_bit(chunk, zorro_unused_z2ram);
|
|
|
+ start += Z2RAM_CHUNKSIZE;
|
|
|
+ }
|
|
|
}
|
|
|
|
|
|
|
|
|
-static struct resource __init *zorro_find_parent_resource(struct zorro_dev *z)
|
|
|
+static struct resource __init *zorro_find_parent_resource(
|
|
|
+ struct platform_device *bridge, struct zorro_dev *z)
|
|
|
{
|
|
|
- int i;
|
|
|
+ int i;
|
|
|
|
|
|
- for (i = 0; i < zorro_bus.num_resources; i++)
|
|
|
- if (zorro_resource_start(z) >= zorro_bus.resources[i].start &&
|
|
|
- zorro_resource_end(z) <= zorro_bus.resources[i].end)
|
|
|
- return &zorro_bus.resources[i];
|
|
|
- return &iomem_resource;
|
|
|
+ for (i = 0; i < bridge->num_resources; i++) {
|
|
|
+ struct resource *r = &bridge->resource[i];
|
|
|
+ if (zorro_resource_start(z) >= r->start &&
|
|
|
+ zorro_resource_end(z) <= r->end)
|
|
|
+ return r;
|
|
|
+ }
|
|
|
+ return &iomem_resource;
|
|
|
}
|
|
|
|
|
|
|
|
|
- /*
|
|
|
- * Initialization
|
|
|
- */
|
|
|
|
|
|
-static int __init zorro_init(void)
|
|
|
+static int __init amiga_zorro_probe(struct platform_device *pdev)
|
|
|
{
|
|
|
- struct zorro_dev *z;
|
|
|
- unsigned int i;
|
|
|
- int error;
|
|
|
-
|
|
|
- if (!MACH_IS_AMIGA || !AMIGAHW_PRESENT(ZORRO))
|
|
|
- return 0;
|
|
|
-
|
|
|
- pr_info("Zorro: Probing AutoConfig expansion devices: %d device%s\n",
|
|
|
- zorro_num_autocon, zorro_num_autocon == 1 ? "" : "s");
|
|
|
-
|
|
|
- /* Initialize the Zorro bus */
|
|
|
- INIT_LIST_HEAD(&zorro_bus.devices);
|
|
|
- dev_set_name(&zorro_bus.dev, "zorro");
|
|
|
- error = device_register(&zorro_bus.dev);
|
|
|
- if (error) {
|
|
|
- pr_err("Zorro: Error registering zorro_bus\n");
|
|
|
- return error;
|
|
|
- }
|
|
|
-
|
|
|
- /* Request the resources */
|
|
|
- zorro_bus.num_resources = AMIGAHW_PRESENT(ZORRO3) ? 4 : 2;
|
|
|
- for (i = 0; i < zorro_bus.num_resources; i++)
|
|
|
- request_resource(&iomem_resource, &zorro_bus.resources[i]);
|
|
|
-
|
|
|
- /* Register all devices */
|
|
|
- for (i = 0; i < zorro_num_autocon; i++) {
|
|
|
- z = &zorro_autocon[i];
|
|
|
- z->id = (z->rom.er_Manufacturer<<16) | (z->rom.er_Product<<8);
|
|
|
- if (z->id == ZORRO_PROD_GVP_EPC_BASE) {
|
|
|
- /* GVP quirk */
|
|
|
- unsigned long magic = zorro_resource_start(z)+0x8000;
|
|
|
- z->id |= *(u16 *)ZTWO_VADDR(magic) & GVP_PRODMASK;
|
|
|
- }
|
|
|
- sprintf(z->name, "Zorro device %08x", z->id);
|
|
|
- zorro_name_device(z);
|
|
|
- z->resource.name = z->name;
|
|
|
- if (request_resource(zorro_find_parent_resource(z), &z->resource))
|
|
|
- pr_err("Zorro: Address space collision on device %s %pR\n",
|
|
|
- z->name, &z->resource);
|
|
|
- dev_set_name(&z->dev, "%02x", i);
|
|
|
- z->dev.parent = &zorro_bus.dev;
|
|
|
- z->dev.bus = &zorro_bus_type;
|
|
|
- error = device_register(&z->dev);
|
|
|
+ struct zorro_bus *bus;
|
|
|
+ struct zorro_dev *z;
|
|
|
+ struct resource *r;
|
|
|
+ unsigned int i;
|
|
|
+ int error;
|
|
|
+
|
|
|
+ /* Initialize the Zorro bus */
|
|
|
+ bus = kzalloc(sizeof(*bus), GFP_KERNEL);
|
|
|
+ if (!bus)
|
|
|
+ return -ENOMEM;
|
|
|
+
|
|
|
+ INIT_LIST_HEAD(&bus->devices);
|
|
|
+ bus->dev.parent = &pdev->dev;
|
|
|
+ dev_set_name(&bus->dev, "zorro");
|
|
|
+ error = device_register(&bus->dev);
|
|
|
if (error) {
|
|
|
- pr_err("Zorro: Error registering device %s\n", z->name);
|
|
|
- continue;
|
|
|
+ pr_err("Zorro: Error registering zorro_bus\n");
|
|
|
+ kfree(bus);
|
|
|
+ return error;
|
|
|
}
|
|
|
- error = zorro_create_sysfs_dev_files(z);
|
|
|
- if (error)
|
|
|
- dev_err(&z->dev, "Error creating sysfs files\n");
|
|
|
- }
|
|
|
-
|
|
|
- /* Mark all available Zorro II memory */
|
|
|
- zorro_for_each_dev(z) {
|
|
|
- if (z->rom.er_Type & ERTF_MEMLIST)
|
|
|
- mark_region(zorro_resource_start(z), zorro_resource_end(z)+1, 1);
|
|
|
- }
|
|
|
-
|
|
|
- /* Unmark all used Zorro II memory */
|
|
|
- for (i = 0; i < m68k_num_memory; i++)
|
|
|
- if (m68k_memory[i].addr < 16*1024*1024)
|
|
|
- mark_region(m68k_memory[i].addr,
|
|
|
- m68k_memory[i].addr+m68k_memory[i].size, 0);
|
|
|
-
|
|
|
- return 0;
|
|
|
+ platform_set_drvdata(pdev, bus);
|
|
|
+
|
|
|
+ /* Register all devices */
|
|
|
+ pr_info("Zorro: Probing AutoConfig expansion devices: %u device%s\n",
|
|
|
+ zorro_num_autocon, zorro_num_autocon == 1 ? "" : "s");
|
|
|
+
|
|
|
+ for (i = 0; i < zorro_num_autocon; i++) {
|
|
|
+ z = &zorro_autocon[i];
|
|
|
+ z->id = (z->rom.er_Manufacturer<<16) | (z->rom.er_Product<<8);
|
|
|
+ if (z->id == ZORRO_PROD_GVP_EPC_BASE) {
|
|
|
+ /* GVP quirk */
|
|
|
+ unsigned long magic = zorro_resource_start(z)+0x8000;
|
|
|
+ z->id |= *(u16 *)ZTWO_VADDR(magic) & GVP_PRODMASK;
|
|
|
+ }
|
|
|
+ sprintf(z->name, "Zorro device %08x", z->id);
|
|
|
+ zorro_name_device(z);
|
|
|
+ z->resource.name = z->name;
|
|
|
+ r = zorro_find_parent_resource(pdev, z);
|
|
|
+ error = request_resource(r, &z->resource);
|
|
|
+ if (error)
|
|
|
+ dev_err(&bus->dev,
|
|
|
+ "Address space collision on device %s %pR\n",
|
|
|
+ z->name, &z->resource);
|
|
|
+ dev_set_name(&z->dev, "%02x", i);
|
|
|
+ z->dev.parent = &bus->dev;
|
|
|
+ z->dev.bus = &zorro_bus_type;
|
|
|
+ error = device_register(&z->dev);
|
|
|
+ if (error) {
|
|
|
+ dev_err(&bus->dev, "Error registering device %s\n",
|
|
|
+ z->name);
|
|
|
+ continue;
|
|
|
+ }
|
|
|
+ error = zorro_create_sysfs_dev_files(z);
|
|
|
+ if (error)
|
|
|
+ dev_err(&z->dev, "Error creating sysfs files\n");
|
|
|
+ }
|
|
|
+
|
|
|
+ /* Mark all available Zorro II memory */
|
|
|
+ zorro_for_each_dev(z) {
|
|
|
+ if (z->rom.er_Type & ERTF_MEMLIST)
|
|
|
+ mark_region(zorro_resource_start(z),
|
|
|
+ zorro_resource_end(z)+1, 1);
|
|
|
+ }
|
|
|
+
|
|
|
+ /* Unmark all used Zorro II memory */
|
|
|
+ for (i = 0; i < m68k_num_memory; i++)
|
|
|
+ if (m68k_memory[i].addr < 16*1024*1024)
|
|
|
+ mark_region(m68k_memory[i].addr,
|
|
|
+ m68k_memory[i].addr+m68k_memory[i].size,
|
|
|
+ 0);
|
|
|
+
|
|
|
+ return 0;
|
|
|
}
|
|
|
|
|
|
-subsys_initcall(zorro_init);
|
|
|
+static struct platform_driver amiga_zorro_driver = {
|
|
|
+ .driver = {
|
|
|
+ .name = "amiga-zorro",
|
|
|
+ .owner = THIS_MODULE,
|
|
|
+ },
|
|
|
+};
|
|
|
|
|
|
-EXPORT_SYMBOL(zorro_find_device);
|
|
|
-EXPORT_SYMBOL(zorro_unused_z2ram);
|
|
|
+static int __init amiga_zorro_init(void)
|
|
|
+{
|
|
|
+ return platform_driver_probe(&amiga_zorro_driver, amiga_zorro_probe);
|
|
|
+}
|
|
|
+
|
|
|
+module_init(amiga_zorro_init);
|
|
|
|
|
|
MODULE_LICENSE("GPL");
|