11da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/*
21da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * amd76xrom.c
31da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *
41da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Normal mappings of chips in physical memory
51da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */
61da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
71da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/module.h>
81da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/types.h>
91da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/kernel.h>
101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/init.h>
115a0e3ad6af8660be21ca98a971cd00f331318c05Tejun Heo#include <linux/slab.h>
121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <asm/io.h>
131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/mtd/mtd.h>
141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/mtd/map.h>
151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/mtd/cfi.h>
161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/mtd/flashchip.h>
171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/pci.h>
181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/pci_ids.h>
191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/list.h>
201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define xstr(s) str(s)
231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define str(s) #s
241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define MOD_NAME xstr(KBUILD_BASENAME)
251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define ADDRESS_NAME_LEN 18
271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define ROM_PROBE_STEP_SIZE (64*1024) /* 64KiB */
291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstruct amd76xrom_window {
311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	void __iomem *virt;
321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	unsigned long phys;
331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	unsigned long size;
341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	struct list_head maps;
351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	struct resource rsrc;
361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	struct pci_dev *pdev;
371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds};
381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstruct amd76xrom_map_info {
401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	struct list_head list;
411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	struct map_info map;
421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	struct mtd_info *mtd;
431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	struct resource rsrc;
441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	char map_name[sizeof(MOD_NAME) + 2 + ADDRESS_NAME_LEN];
451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds};
461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
47c9073ce02adfa273a3d6d53eac8c4c035510ad9cRyan Jackson/* The 2 bits controlling the window size are often set to allow reading
48c9073ce02adfa273a3d6d53eac8c4c035510ad9cRyan Jackson * the BIOS, but too small to allow writing, since the lock registers are
49c9073ce02adfa273a3d6d53eac8c4c035510ad9cRyan Jackson * 4MiB lower in the address space than the data.
50c9073ce02adfa273a3d6d53eac8c4c035510ad9cRyan Jackson *
51c9073ce02adfa273a3d6d53eac8c4c035510ad9cRyan Jackson * This is intended to prevent flashing the bios, perhaps accidentally.
52c9073ce02adfa273a3d6d53eac8c4c035510ad9cRyan Jackson *
53c9073ce02adfa273a3d6d53eac8c4c035510ad9cRyan Jackson * This parameter allows the normal driver to over-ride the BIOS settings.
54c9073ce02adfa273a3d6d53eac8c4c035510ad9cRyan Jackson *
55c9073ce02adfa273a3d6d53eac8c4c035510ad9cRyan Jackson * The bits are 6 and 7.  If both bits are set, it is a 5MiB window.
56c9073ce02adfa273a3d6d53eac8c4c035510ad9cRyan Jackson * If only the 7 Bit is set, it is a 4MiB window.  Otherwise, a
57c9073ce02adfa273a3d6d53eac8c4c035510ad9cRyan Jackson * 64KiB window.
58c9073ce02adfa273a3d6d53eac8c4c035510ad9cRyan Jackson *
59c9073ce02adfa273a3d6d53eac8c4c035510ad9cRyan Jackson */
60c9073ce02adfa273a3d6d53eac8c4c035510ad9cRyan Jacksonstatic uint win_size_bits;
61c9073ce02adfa273a3d6d53eac8c4c035510ad9cRyan Jacksonmodule_param(win_size_bits, uint, 0);
62c9073ce02adfa273a3d6d53eac8c4c035510ad9cRyan JacksonMODULE_PARM_DESC(win_size_bits, "ROM window size bits override for 0x43 byte, normally set by BIOS.");
63c9073ce02adfa273a3d6d53eac8c4c035510ad9cRyan Jackson
641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct amd76xrom_window amd76xrom_window = {
651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	.maps = LIST_HEAD_INIT(amd76xrom_window.maps),
661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds};
671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void amd76xrom_cleanup(struct amd76xrom_window *window)
691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{
701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	struct amd76xrom_map_info *map, *scratch;
711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	u8 byte;
721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	if (window->pdev) {
741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		/* Disable writes through the rom window */
751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		pci_read_config_byte(window->pdev, 0x40, &byte);
761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		pci_write_config_byte(window->pdev, 0x40, byte & ~1);
77dd8e9ed6ed544e2b924429d29cd2a6b55590109bAlan Cox		pci_dev_put(window->pdev);
781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	}
791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	/* Free all of the mtd devices */
811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	list_for_each_entry_safe(map, scratch, &window->maps, list) {
821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		if (map->rsrc.parent) {
831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			release_resource(&map->rsrc);
841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		}
85ee0e87b174bb41f0310cf089262bf5dd8f95a212Jamie Iles		mtd_device_unregister(map->mtd);
861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		map_destroy(map->mtd);
871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		list_del(&map->list);
881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		kfree(map);
891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	}
9069f34c98c1416eb74c55e38a21dbf3e294966514Thomas Gleixner	if (window->rsrc.parent)
911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		release_resource(&window->rsrc);
921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	if (window->virt) {
941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		iounmap(window->virt);
951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		window->virt = NULL;
961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		window->phys = 0;
971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		window->size = 0;
981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		window->pdev = NULL;
991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	}
1001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}
1011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
1021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
1031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int __devinit amd76xrom_init_one (struct pci_dev *pdev,
1041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	const struct pci_device_id *ent)
1051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{
1061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	static char *rom_probe_types[] = { "cfi_probe", "jedec_probe", NULL };
1071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	u8 byte;
1081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	struct amd76xrom_window *window = &amd76xrom_window;
1091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	struct amd76xrom_map_info *map = NULL;
1101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	unsigned long map_top;
1111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
112dd8e9ed6ed544e2b924429d29cd2a6b55590109bAlan Cox	/* Remember the pci dev I find the window in - already have a ref */
1131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	window->pdev = pdev;
1141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
115c9073ce02adfa273a3d6d53eac8c4c035510ad9cRyan Jackson	/* Enable the selected rom window.  This is often incorrectly
116c9073ce02adfa273a3d6d53eac8c4c035510ad9cRyan Jackson	 * set up by the BIOS, and the 4MiB offset for the lock registers
117c9073ce02adfa273a3d6d53eac8c4c035510ad9cRyan Jackson	 * requires the full 5MiB of window space.
118c9073ce02adfa273a3d6d53eac8c4c035510ad9cRyan Jackson	 *
119c9073ce02adfa273a3d6d53eac8c4c035510ad9cRyan Jackson	 * This 'write, then read' approach leaves the bits for
120c9073ce02adfa273a3d6d53eac8c4c035510ad9cRyan Jackson	 * other uses of the hardware info.
121c9073ce02adfa273a3d6d53eac8c4c035510ad9cRyan Jackson	 */
122c9073ce02adfa273a3d6d53eac8c4c035510ad9cRyan Jackson	pci_read_config_byte(pdev, 0x43, &byte);
123c9073ce02adfa273a3d6d53eac8c4c035510ad9cRyan Jackson	pci_write_config_byte(pdev, 0x43, byte | win_size_bits );
124c9073ce02adfa273a3d6d53eac8c4c035510ad9cRyan Jackson
1251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	/* Assume the rom window is properly setup, and find it's size */
1261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	pci_read_config_byte(pdev, 0x43, &byte);
1271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	if ((byte & ((1<<7)|(1<<6))) == ((1<<7)|(1<<6))) {
1281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		window->phys = 0xffb00000; /* 5MiB */
1291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	}
1301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	else if ((byte & (1<<7)) == (1<<7)) {
1311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		window->phys = 0xffc00000; /* 4MiB */
1321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	}
1331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	else {
1341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		window->phys = 0xffff0000; /* 64KiB */
1351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	}
1361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	window->size = 0xffffffffUL - window->phys + 1UL;
13769f34c98c1416eb74c55e38a21dbf3e294966514Thomas Gleixner
1381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	/*
1391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	 * Try to reserve the window mem region.  If this fails then
1401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	 * it is likely due to a fragment of the window being
1411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	 * "reseved" by the BIOS.  In the case that the
1421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	 * request_mem_region() fails then once the rom size is
1431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	 * discovered we will try to reserve the unreserved fragment.
1441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	 */
1451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	window->rsrc.name = MOD_NAME;
1461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	window->rsrc.start = window->phys;
1471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	window->rsrc.end   = window->phys + window->size - 1;
1481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	window->rsrc.flags = IORESOURCE_MEM | IORESOURCE_BUSY;
1491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	if (request_resource(&iomem_resource, &window->rsrc)) {
1501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		window->rsrc.parent = NULL;
1511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		printk(KERN_ERR MOD_NAME
152f9a5279c70af10e967872e922b91310a91f87b05Joe Perches		       " %s(): Unable to register resource %pR - kernel bug?\n",
153f9a5279c70af10e967872e922b91310a91f87b05Joe Perches		       __func__, &window->rsrc);
15482013d988fc03a1b908b2b0360a1e34f6152fda6Stanislaw Gruszka		return -EBUSY;
1551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	}
1561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
1571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
1581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	/* Enable writes through the rom window */
1591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	pci_read_config_byte(pdev, 0x40, &byte);
1601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	pci_write_config_byte(pdev, 0x40, byte | 1);
16169f34c98c1416eb74c55e38a21dbf3e294966514Thomas Gleixner
1621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	/* FIXME handle registers 0x80 - 0x8C the bios region locks */
1631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
1641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	/* For write accesses caches are useless */
1651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	window->virt = ioremap_nocache(window->phys, window->size);
1661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	if (!window->virt) {
1671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		printk(KERN_ERR MOD_NAME ": ioremap(%08lx, %08lx) failed\n",
1681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			window->phys, window->size);
1691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		goto out;
1701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	}
1711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
1721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	/* Get the first address to look for an rom chip at */
1731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	map_top = window->phys;
1741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#if 1
1751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	/* The probe sequence run over the firmware hub lock
1761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	 * registers sets them to 0x7 (no access).
1771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	 * Probe at most the last 4M of the address space.
1781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	 */
1791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	if (map_top < 0xffc00000) {
1801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		map_top = 0xffc00000;
1811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	}
1821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif
1831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	/* Loop  through and look for rom chips */
1841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	while((map_top - 1) < 0xffffffffUL) {
1851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		struct cfi_private *cfi;
1861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		unsigned long offset;
1871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		int i;
1881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
1891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		if (!map) {
1901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			map = kmalloc(sizeof(*map), GFP_KERNEL);
1911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		}
1921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		if (!map) {
1931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			printk(KERN_ERR MOD_NAME ": kmalloc failed");
1941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			goto out;
1951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		}
1961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		memset(map, 0, sizeof(*map));
1971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		INIT_LIST_HEAD(&map->list);
1981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		map->map.name = map->map_name;
1991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		map->map.phys = map_top;
2001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		offset = map_top - window->phys;
2011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		map->map.virt = (void __iomem *)
2021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			(((unsigned long)(window->virt)) + offset);
2031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		map->map.size = 0xffffffffUL - map_top + 1UL;
2041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		/* Set the name of the map to the address I am trying */
2051a6284cb6f44b2484505ee7567831316a90bc09fAndrew Morton		sprintf(map->map_name, "%s @%08Lx",
2061a6284cb6f44b2484505ee7567831316a90bc09fAndrew Morton			MOD_NAME, (unsigned long long)map->map.phys);
2071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
2081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		/* There is no generic VPP support */
20969f34c98c1416eb74c55e38a21dbf3e294966514Thomas Gleixner		for(map->map.bankwidth = 32; map->map.bankwidth;
2101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			map->map.bankwidth >>= 1)
2111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		{
2121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			char **probe_type;
2131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			/* Skip bankwidths that are not supported */
2141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			if (!map_bankwidth_supported(map->map.bankwidth))
2151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds				continue;
2161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
2171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			/* Setup the map methods */
2181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			simple_map_init(&map->map);
2191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
2201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			/* Try all of the probe methods */
2211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			probe_type = rom_probe_types;
2221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			for(; *probe_type; probe_type++) {
2231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds				map->mtd = do_map_probe(*probe_type, &map->map);
2241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds				if (map->mtd)
2251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds					goto found;
2261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			}
2271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		}
2281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		map_top += ROM_PROBE_STEP_SIZE;
2291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		continue;
2301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	found:
2311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		/* Trim the size if we are larger than the map */
2321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		if (map->mtd->size > map->map.size) {
2331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			printk(KERN_WARNING MOD_NAME
23469423d99fc182a81f3c5db3eb5c140acc6fc64beAdrian Hunter				" rom(%llu) larger than window(%lu). fixing...\n",
23569423d99fc182a81f3c5db3eb5c140acc6fc64beAdrian Hunter				(unsigned long long)map->mtd->size, map->map.size);
2361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			map->mtd->size = map->map.size;
2371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		}
2381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		if (window->rsrc.parent) {
2391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			/*
2401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			 * Registering the MTD device in iomem may not be possible
2411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			 * if there is a BIOS "reserved" and BUSY range.  If this
2421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			 * fails then continue anyway.
2431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			 */
2441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			map->rsrc.name  = map->map_name;
2451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			map->rsrc.start = map->map.phys;
2461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			map->rsrc.end   = map->map.phys + map->mtd->size - 1;
2471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			map->rsrc.flags = IORESOURCE_MEM | IORESOURCE_BUSY;
2481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			if (request_resource(&window->rsrc, &map->rsrc)) {
2491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds				printk(KERN_ERR MOD_NAME
2501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds					": cannot reserve MTD resource\n");
2511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds				map->rsrc.parent = NULL;
2521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			}
2531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		}
2541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
2551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		/* Make the whole region visible in the map */
2561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		map->map.virt = window->virt;
2571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		map->map.phys = window->phys;
2581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		cfi = map->map.fldrv_priv;
2591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		for(i = 0; i < cfi->numchips; i++) {
2601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			cfi->chips[i].start += offset;
2611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		}
26269f34c98c1416eb74c55e38a21dbf3e294966514Thomas Gleixner
2631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		/* Now that the mtd devices is complete claim and export it */
2641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		map->mtd->owner = THIS_MODULE;
265ee0e87b174bb41f0310cf089262bf5dd8f95a212Jamie Iles		if (mtd_device_register(map->mtd, NULL, 0)) {
2661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			map_destroy(map->mtd);
2671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			map->mtd = NULL;
2681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			goto out;
2691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		}
2701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
2711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
2721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		/* Calculate the new value of map_top */
2731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		map_top += map->mtd->size;
2741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
2751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		/* File away the map structure */
2761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		list_add(&map->list, &window->maps);
2771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		map = NULL;
2781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	}
2791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
2801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out:
2811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	/* Free any left over map structures */
282fa671646f61182cd18234461a6e65f50c6558695Jesper Juhl	kfree(map);
2831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	/* See if I have any map structures */
2841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	if (list_empty(&window->maps)) {
2851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		amd76xrom_cleanup(window);
2861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		return -ENODEV;
2871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	}
2881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	return 0;
2891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}
2901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
2911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
2921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void __devexit amd76xrom_remove_one (struct pci_dev *pdev)
2931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{
2941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	struct amd76xrom_window *window = &amd76xrom_window;
2951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
2961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	amd76xrom_cleanup(window);
2971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}
2981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
2991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct pci_device_id amd76xrom_pci_tbl[] = {
30069f34c98c1416eb74c55e38a21dbf3e294966514Thomas Gleixner	{ PCI_VENDOR_ID_AMD, PCI_DEVICE_ID_AMD_VIPER_7410,
3011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		PCI_ANY_ID, PCI_ANY_ID, },
30269f34c98c1416eb74c55e38a21dbf3e294966514Thomas Gleixner	{ PCI_VENDOR_ID_AMD, PCI_DEVICE_ID_AMD_VIPER_7440,
3031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		PCI_ANY_ID, PCI_ANY_ID, },
3041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	{ PCI_VENDOR_ID_AMD, 0x7468 }, /* amd8111 support */
3051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	{ 0, }
3061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds};
3071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
3081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_DEVICE_TABLE(pci, amd76xrom_pci_tbl);
3091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
3101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#if 0
3111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct pci_driver amd76xrom_driver = {
3121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	.name =		MOD_NAME,
3131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	.id_table =	amd76xrom_pci_tbl,
3141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	.probe =	amd76xrom_init_one,
3151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	.remove =	amd76xrom_remove_one,
3161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds};
3171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif
3181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
3191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int __init init_amd76xrom(void)
3201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{
3211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	struct pci_dev *pdev;
3221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	struct pci_device_id *id;
3231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	pdev = NULL;
3241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	for(id = amd76xrom_pci_tbl; id->vendor; id++) {
325dd8e9ed6ed544e2b924429d29cd2a6b55590109bAlan Cox		pdev = pci_get_device(id->vendor, id->device, NULL);
3261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		if (pdev) {
3271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			break;
3281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		}
3291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	}
3301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	if (pdev) {
3311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		return amd76xrom_init_one(pdev, &amd76xrom_pci_tbl[0]);
3321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	}
3331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	return -ENXIO;
3341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#if 0
335ff3bc4eb94ec3d2ce6e8f615d38c94151ccb6553Domen Puncer	return pci_register_driver(&amd76xrom_driver);
3361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif
3371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}
3381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
3391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void __exit cleanup_amd76xrom(void)
3401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{
3411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	amd76xrom_remove_one(amd76xrom_window.pdev);
3421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}
3431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
3441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmodule_init(init_amd76xrom);
3451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmodule_exit(cleanup_amd76xrom);
3461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
3471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_LICENSE("GPL");
3481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_AUTHOR("Eric Biederman <ebiederman@lnxi.com>");
3491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_DESCRIPTION("MTD map driver for BIOS chips on the AMD76X southbridge");
3501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
351