mirror of
https://git.kernel.org/pub/scm/linux/kernel/git/stable/linux.git
synced 2024-08-23 17:30:02 +00:00
![Kay Sievers](/assets/img/avatar_default.png)
Cc: macro@linux-mips.org Acked-by: Greg Kroah-Hartman <gregkh@suse.de> Signed-off-by: Kay Sievers <kay.sievers@vrfy.org>
193 lines
5.1 KiB
C
193 lines
5.1 KiB
C
/*
|
|
* TURBOchannel bus services.
|
|
*
|
|
* Copyright (c) Harald Koerfgen, 1998
|
|
* Copyright (c) 2001, 2003, 2005, 2006 Maciej W. Rozycki
|
|
* Copyright (c) 2005 James Simmons
|
|
*
|
|
* This file is subject to the terms and conditions of the GNU
|
|
* General Public License. See the file "COPYING" in the main
|
|
* directory of this archive for more details.
|
|
*/
|
|
#include <linux/compiler.h>
|
|
#include <linux/errno.h>
|
|
#include <linux/init.h>
|
|
#include <linux/ioport.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/list.h>
|
|
#include <linux/module.h>
|
|
#include <linux/string.h>
|
|
#include <linux/tc.h>
|
|
#include <linux/types.h>
|
|
|
|
#include <asm/io.h>
|
|
|
|
static struct tc_bus tc_bus = {
|
|
.name = "TURBOchannel",
|
|
};
|
|
|
|
/*
|
|
* Probing for TURBOchannel modules.
|
|
*/
|
|
static void __init tc_bus_add_devices(struct tc_bus *tbus)
|
|
{
|
|
resource_size_t slotsize = tbus->info.slot_size << 20;
|
|
resource_size_t extslotsize = tbus->ext_slot_size;
|
|
resource_size_t slotaddr;
|
|
resource_size_t extslotaddr;
|
|
resource_size_t devsize;
|
|
void __iomem *module;
|
|
struct tc_dev *tdev;
|
|
int i, slot, err;
|
|
u8 pattern[4];
|
|
long offset;
|
|
|
|
for (slot = 0; slot < tbus->num_tcslots; slot++) {
|
|
slotaddr = tbus->slot_base + slot * slotsize;
|
|
extslotaddr = tbus->ext_slot_base + slot * extslotsize;
|
|
module = ioremap_nocache(slotaddr, slotsize);
|
|
BUG_ON(!module);
|
|
|
|
offset = TC_OLDCARD;
|
|
|
|
err = 0;
|
|
err |= tc_preadb(pattern + 0, module + offset + TC_PATTERN0);
|
|
err |= tc_preadb(pattern + 1, module + offset + TC_PATTERN1);
|
|
err |= tc_preadb(pattern + 2, module + offset + TC_PATTERN2);
|
|
err |= tc_preadb(pattern + 3, module + offset + TC_PATTERN3);
|
|
if (err)
|
|
goto out_err;
|
|
|
|
if (pattern[0] != 0x55 || pattern[1] != 0x00 ||
|
|
pattern[2] != 0xaa || pattern[3] != 0xff) {
|
|
offset = TC_NEWCARD;
|
|
|
|
err = 0;
|
|
err |= tc_preadb(pattern + 0,
|
|
module + offset + TC_PATTERN0);
|
|
err |= tc_preadb(pattern + 1,
|
|
module + offset + TC_PATTERN1);
|
|
err |= tc_preadb(pattern + 2,
|
|
module + offset + TC_PATTERN2);
|
|
err |= tc_preadb(pattern + 3,
|
|
module + offset + TC_PATTERN3);
|
|
if (err)
|
|
goto out_err;
|
|
}
|
|
|
|
if (pattern[0] != 0x55 || pattern[1] != 0x00 ||
|
|
pattern[2] != 0xaa || pattern[3] != 0xff)
|
|
goto out_err;
|
|
|
|
/* Found a board, allocate it an entry in the list */
|
|
tdev = kzalloc(sizeof(*tdev), GFP_KERNEL);
|
|
if (!tdev) {
|
|
printk(KERN_ERR "tc%x: unable to allocate tc_dev\n",
|
|
slot);
|
|
goto out_err;
|
|
}
|
|
dev_set_name(&tdev->dev, "tc%x", slot);
|
|
tdev->bus = tbus;
|
|
tdev->dev.parent = &tbus->dev;
|
|
tdev->dev.bus = &tc_bus_type;
|
|
tdev->slot = slot;
|
|
|
|
for (i = 0; i < 8; i++) {
|
|
tdev->firmware[i] =
|
|
readb(module + offset + TC_FIRM_VER + 4 * i);
|
|
tdev->vendor[i] =
|
|
readb(module + offset + TC_VENDOR + 4 * i);
|
|
tdev->name[i] =
|
|
readb(module + offset + TC_MODULE + 4 * i);
|
|
}
|
|
tdev->firmware[8] = 0;
|
|
tdev->vendor[8] = 0;
|
|
tdev->name[8] = 0;
|
|
|
|
pr_info("%s: %s %s %s\n", dev_name(&tdev->dev), tdev->vendor,
|
|
tdev->name, tdev->firmware);
|
|
|
|
devsize = readb(module + offset + TC_SLOT_SIZE);
|
|
devsize <<= 22;
|
|
if (devsize <= slotsize) {
|
|
tdev->resource.start = slotaddr;
|
|
tdev->resource.end = slotaddr + devsize - 1;
|
|
} else if (devsize <= extslotsize) {
|
|
tdev->resource.start = extslotaddr;
|
|
tdev->resource.end = extslotaddr + devsize - 1;
|
|
} else {
|
|
printk(KERN_ERR "%s: Cannot provide slot space "
|
|
"(%dMiB required, up to %dMiB supported)\n",
|
|
dev_name(&tdev->dev), devsize >> 20,
|
|
max(slotsize, extslotsize) >> 20);
|
|
kfree(tdev);
|
|
goto out_err;
|
|
}
|
|
tdev->resource.name = tdev->name;
|
|
tdev->resource.flags = IORESOURCE_MEM;
|
|
|
|
tc_device_get_irq(tdev);
|
|
|
|
device_register(&tdev->dev);
|
|
list_add_tail(&tdev->node, &tbus->devices);
|
|
|
|
out_err:
|
|
iounmap(module);
|
|
}
|
|
}
|
|
|
|
/*
|
|
* The main entry.
|
|
*/
|
|
static int __init tc_init(void)
|
|
{
|
|
/* Initialize the TURBOchannel bus */
|
|
if (tc_bus_get_info(&tc_bus))
|
|
return 0;
|
|
|
|
INIT_LIST_HEAD(&tc_bus.devices);
|
|
dev_set_name(&tc_bus.dev, "tc");
|
|
device_register(&tc_bus.dev);
|
|
|
|
if (tc_bus.info.slot_size) {
|
|
unsigned int tc_clock = tc_get_speed(&tc_bus) / 100000;
|
|
|
|
pr_info("tc: TURBOchannel rev. %d at %d.%d MHz "
|
|
"(with%s parity)\n", tc_bus.info.revision,
|
|
tc_clock / 10, tc_clock % 10,
|
|
tc_bus.info.parity ? "" : "out");
|
|
|
|
tc_bus.resource[0].start = tc_bus.slot_base;
|
|
tc_bus.resource[0].end = tc_bus.slot_base +
|
|
(tc_bus.info.slot_size << 20) *
|
|
tc_bus.num_tcslots - 1;
|
|
tc_bus.resource[0].name = tc_bus.name;
|
|
tc_bus.resource[0].flags = IORESOURCE_MEM;
|
|
if (request_resource(&iomem_resource,
|
|
&tc_bus.resource[0]) < 0) {
|
|
printk(KERN_ERR "tc: Cannot reserve resource\n");
|
|
return 0;
|
|
}
|
|
if (tc_bus.ext_slot_size) {
|
|
tc_bus.resource[1].start = tc_bus.ext_slot_base;
|
|
tc_bus.resource[1].end = tc_bus.ext_slot_base +
|
|
tc_bus.ext_slot_size *
|
|
tc_bus.num_tcslots - 1;
|
|
tc_bus.resource[1].name = tc_bus.name;
|
|
tc_bus.resource[1].flags = IORESOURCE_MEM;
|
|
if (request_resource(&iomem_resource,
|
|
&tc_bus.resource[1]) < 0) {
|
|
printk(KERN_ERR
|
|
"tc: Cannot reserve resource\n");
|
|
release_resource(&tc_bus.resource[0]);
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
tc_bus_add_devices(&tc_bus);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
subsys_initcall(tc_init);
|