/* *  linux/drivers/mtd/maps/pci.c * *  Copyright (C) 2001 Russell King, All rights reserved. * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License version 2 as * published by the Free Software Foundation. * *  $Id: pci.c,v 1.5 2003/05/20 20:59:31 dwmw2 Exp $ *  * Generic PCI memory map driver.  We support the following boards: *  - Intel IQ80310 ATU. *  - Intel EBSA285 (blank rom programming mode). Tested working 27/09/2001 */#include <linux/module.h>#include <linux/kernel.h>#include <linux/pci.h>#include <linux/init.h>#include <linux/mtd/mtd.h>#include <linux/mtd/map.h>#include <linux/mtd/partitions.h>struct map_pci_info;struct mtd_pci_info {	int  (*init)(struct pci_dev *dev, struct map_pci_info *map);	void (*exit)(struct pci_dev *dev, struct map_pci_info *map);	unsigned long (*translate)(struct map_pci_info *map, unsigned long ofs);	const char *map_name;};struct map_pci_info {	struct map_info map;	void *base;	void (*exit)(struct pci_dev *dev, struct map_pci_info *map);	unsigned long (*translate)(struct map_pci_info *map, unsigned long ofs);	struct pci_dev *dev;};	/* * Intel IOP80310 Flash driver */static intintel_iq80310_init(struct pci_dev *dev, struct map_pci_info *map){	u32 win_base;	map->map.buswidth = 1;	map->map.size     = 0x00800000;	map->base         = ioremap_nocache(pci_resource_start(dev, 0),					    pci_resource_len(dev, 0));	if (!map->base)		return -ENOMEM;	/*	 * We want to base the memory window at Xscale	 * bus address 0, not 0x1000.	 */	pci_read_config_dword(dev, 0x44, &win_base);	pci_write_config_dword(dev, 0x44, 0);	map->map.map_priv_2 = win_base;	return 0;}static voidintel_iq80310_exit(struct pci_dev *dev, struct map_pci_info *map){	if (map->base)		iounmap((void *)map->base);	pci_write_config_dword(dev, 0x44, map->map.map_priv_2);}static unsigned longintel_iq80310_translate(struct map_pci_info *map, unsigned long ofs){	unsigned long page_addr = ofs & 0x00400000;	/*	 * This mundges the flash location so we avoid	 * the first 80 bytes (they appear to read nonsense).	 */	if (page_addr) {		writel(0x00000008, map->base + 0x1558);		writel(0x00000000, map->base + 0x1550);	} else {		writel(0x00000007, map->base + 0x1558);		writel(0x00800000, map->base + 0x1550);		ofs += 0x00800000;	}	return ofs;}static struct mtd_pci_info intel_iq80310_info = {	.init =		intel_iq80310_init,	.exit =		intel_iq80310_exit,	.translate =	intel_iq80310_translate,	.map_name =	"cfi_probe",};/* * Intel DC21285 driver */static intintel_dc21285_init(struct pci_dev *dev, struct map_pci_info *map){	unsigned long base, len;	base = pci_resource_start(dev, PCI_ROM_RESOURCE);	len  = pci_resource_len(dev, PCI_ROM_RESOURCE);	if (!len || !base) {		/*		 * No ROM resource		 */		base = pci_resource_start(dev, 2);		len  = pci_resource_len(dev, 2);		/*		 * We need to re-allocate PCI BAR2 address range to the		 * PCI ROM BAR, and disable PCI BAR2.		 */	} else {		/*		 * Hmm, if an address was allocated to the ROM resource, but		 * not enabled, should we be allocating a new resource for it		 * or simply enabling it?		 */		if (!(pci_resource_flags(dev, PCI_ROM_RESOURCE) &		     PCI_ROM_ADDRESS_ENABLE)) {		     	u32 val;			pci_resource_flags(dev, PCI_ROM_RESOURCE) |= PCI_ROM_ADDRESS_ENABLE;			pci_read_config_dword(dev, PCI_ROM_ADDRESS, &val);			val |= PCI_ROM_ADDRESS_ENABLE;			pci_write_config_dword(dev, PCI_ROM_ADDRESS, val);			printk("%s: enabling expansion ROM\n", dev->slot_name);		}	}	if (!len || !base)		return -ENXIO;	map->map.buswidth = 4;	map->map.size     = len;	map->base         = ioremap_nocache(base, len);	if (!map->base)		return -ENOMEM;	return 0;}static voidintel_dc21285_exit(struct pci_dev *dev, struct map_pci_info *map){	u32 val;	if (map->base)		iounmap((void *)map->base);	/*	 * We need to undo the PCI BAR2/PCI ROM BAR address alteration.	 */	pci_resource_flags(dev, PCI_ROM_RESOURCE) &= ~PCI_ROM_ADDRESS_ENABLE;	pci_read_config_dword(dev, PCI_ROM_ADDRESS, &val);	val &= ~PCI_ROM_ADDRESS_ENABLE;	pci_write_config_dword(dev, PCI_ROM_ADDRESS, val);}static unsigned longintel_dc21285_translate(struct map_pci_info *map, unsigned long ofs){	return ofs & 0x00ffffc0 ? ofs : (ofs ^ (1 << 5));}static struct mtd_pci_info intel_dc21285_info = {	.init =		intel_dc21285_init,	.exit =		intel_dc21285_exit,	.translate =	intel_dc21285_translate,	.map_name =	"jedec_probe",};/* * PCI device ID table */static struct pci_device_id mtd_pci_ids[] __devinitdata = {	{		.vendor =	PCI_VENDOR_ID_INTEL,		.device =	0x530d,		.subvendor =	PCI_ANY_ID,		.subdevice =	PCI_ANY_ID,		.class =	PCI_CLASS_MEMORY_OTHER << 8,		.class_mask =	0xffff00,		.driver_data =	(unsigned long)&intel_iq80310_info,	},	{		.vendor =	PCI_VENDOR_ID_DEC,		.device =	PCI_DEVICE_ID_DEC_21285,		.subvendor =	0,	/* DC21285 defaults to 0 on reset */		.subdevice =	0,	/* DC21285 defaults to 0 on reset */		.driver_data =	(unsigned long)&intel_dc21285_info,	},	{ 0, }};/* * Generic code follows. */static u8 mtd_pci_read8(struct map_info *_map, unsigned long ofs){	struct map_pci_info *map = (struct map_pci_info *)_map;	u8 val = readb(map->base + map->translate(map, ofs));//	printk("read8 : %08lx => %02x\n", ofs, val);	return val;}static u16 mtd_pci_read16(struct map_info *_map, unsigned long ofs){	struct map_pci_info *map = (struct map_pci_info *)_map;	u16 val = readw(map->base + map->translate(map, ofs));//	printk("read16: %08lx => %04x\n", ofs, val);	return val;}static u32 mtd_pci_read32(struct map_info *_map, unsigned long ofs){	struct map_pci_info *map = (struct map_pci_info *)_map;	u32 val = readl(map->base + map->translate(map, ofs));//	printk("read32: %08lx => %08x\n", ofs, val);	return val;}static void mtd_pci_copyfrom(struct map_info *_map, void *to, unsigned long from, ssize_t len){	struct map_pci_info *map = (struct map_pci_info *)_map;	memcpy_fromio(to, map->base + map->translate(map, from), len);}static void mtd_pci_write8(struct map_info *_map, u8 val, unsigned long ofs){	struct map_pci_info *map = (struct map_pci_info *)_map;//	printk("write8 : %08lx <= %02x\n", ofs, val);	writeb(val, map->base + map->translate(map, ofs));}static void mtd_pci_write16(struct map_info *_map, u16 val, unsigned long ofs){	struct map_pci_info *map = (struct map_pci_info *)_map;//	printk("write16: %08lx <= %04x\n", ofs, val);	writew(val, map->base + map->translate(map, ofs));}static void mtd_pci_write32(struct map_info *_map, u32 val, unsigned long ofs){	struct map_pci_info *map = (struct map_pci_info *)_map;//	printk("write32: %08lx <= %08x\n", ofs, val);	writel(val, map->base + map->translate(map, ofs));}static void mtd_pci_copyto(struct map_info *_map, unsigned long to, const void *from, ssize_t len){	struct map_pci_info *map = (struct map_pci_info *)_map;	memcpy_toio(map->base + map->translate(map, to), from, len);}static struct map_info mtd_pci_map = {	.phys =		NO_XIP,	.read8 =	mtd_pci_read8,	.read16 =	mtd_pci_read16,	.read32 =	mtd_pci_read32,	.copy_from =	mtd_pci_copyfrom,	.write8 =	mtd_pci_write8,	.write16 =	mtd_pci_write16,	.write32 =	mtd_pci_write32,	.copy_to =	mtd_pci_copyto,};static int __devinitmtd_pci_probe(struct pci_dev *dev, const struct pci_device_id *id){	struct mtd_pci_info *info = (struct mtd_pci_info *)id->driver_data;	struct map_pci_info *map = NULL;	struct mtd_info *mtd = NULL;	int err;	err = pci_enable_device(dev);	if (err)		goto out;	err = pci_request_regions(dev, "pci mtd");	if (err)		goto out;	map = kmalloc(sizeof(*map), GFP_KERNEL);	err = -ENOMEM;	if (!map)		goto release;	map->map       = mtd_pci_map;	map->map.name  = dev->slot_name;	map->dev       = dev;	map->exit      = info->exit;	map->translate = info->translate;	err = info->init(dev, map);	if (err)		goto release;	/* tsk - do_map_probe should take const char * */	mtd = do_map_probe((char *)info->map_name, &map->map);	err = -ENODEV;	if (!mtd)		goto release;	mtd->owner = THIS_MODULE;	add_mtd_device(mtd);	pci_set_drvdata(dev, mtd);	return 0;release:	if (mtd)		map_destroy(mtd);	if (map) {		map->exit(dev, map);		kfree(map);	}	pci_release_regions(dev);out:	return err;}static void __devexitmtd_pci_remove(struct pci_dev *dev){	struct mtd_info *mtd = pci_get_drvdata(dev);	struct map_pci_info *map = mtd->priv;	del_mtd_device(mtd);	map_destroy(mtd);	map->exit(dev, map);	kfree(map);	pci_set_drvdata(dev, NULL);	pci_release_regions(dev);}static struct pci_driver mtd_pci_driver = {	.name =		"MTD PCI",	.probe =	mtd_pci_probe,	.remove =	__devexit_p(mtd_pci_remove),	.id_table =	mtd_pci_ids,};static int __init mtd_pci_maps_init(void){	return pci_module_init(&mtd_pci_driver);}static void __exit mtd_pci_maps_exit(void){	pci_unregister_driver(&mtd_pci_driver);}module_init(mtd_pci_maps_init);module_exit(mtd_pci_maps_exit);MODULE_LICENSE("GPL");MODULE_AUTHOR("Russell King <rmk@arm.linux.org.uk>");MODULE_DESCRIPTION("Generic PCI map driver");MODULE_DEVICE_TABLE(pci, mtd_pci_ids);