Linux/Unix编程

开发平台：
Unix_Linux

pci.c：源码内容
							/*
 *  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.1 2001/09/27 20:28:45 rmk 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 int
intel_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 void
intel_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 long
intel_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 int
intel_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 ROMn", 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 void
intel_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 long
intel_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 */
		class:		0,
		class_mask:	0,
		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 => %02xn", 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 => %04xn", 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 => %08xn", 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 <= %02xn", 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 <= %04xn", 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 <= %08xn", 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 = {
	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 __devinit
mtd_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->module = 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 __devexit
mtd_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);

						