pxa250_flash.c

来自「比较好的VIVI开发源码」· C语言 代码 · 共 120 行

/*
 * vivi/drivers/mtd/maps/pxa250-flash.c: 
 *   Flash memory access on SA11x0 based devices
 *
 * Copyright (C) 2002 MIZI Research, Inc.
 * 
 * Based on linux/drivers/mtd/maps/sa1100-flash.c
 *
 * This code is GPL.
 * 
 * Author: Janghoon Lyu <[e-mail]>
 * Date  : $Date: 2002/08/21 06:31:08 $
 *
 * $Revision: 1.3 $
 * $Id: pxa250_flash.c,v 1.3 2002/08/21 06:31:08 nandy Exp $
 *
 * 扁拌俊 蝶扼 促弗 甘 沥焊甫 捞侩秦辑 flash 皋葛府甫 檬扁拳茄促.
 *
 * History
 *
 * 2002-06-26: Janghoon Lyu <[e-mail]>
 *    - Created this code
 *
 */

#include "config.h"
#include "machine.h"
#include "mtd/mtd.h"
#include "mtd/map.h"
#include "io.h"
#include "printk.h"
#include <types.h>
#include <errno.h>

#ifndef CONFIG_ARCH_PXA250
#error This is for PXA250 architecture only
#endif

#define ARRAY_SIZE(x) (sizeof(x) / sizeof((x)[0]))
#define WINDOW_ADDR	FLASH_UNCACHED_BASE

static __u8 pxa250_read8(struct map_info *map, unsigned long ofs)
{
	return readb(map->map_priv_1 + ofs);
}

static __u16 pxa250_read16(struct map_info *map, unsigned long ofs)
{
	return readw(map->map_priv_1 + ofs);
}

static __u32 pxa250_read32(struct map_info *map, unsigned long ofs)
{
	return readl(map->map_priv_1 + ofs);
}

static void pxa250_copy_from(struct map_info *map, void *to, unsigned long from, ssize_t len)
{
	memcpy(to, (void *)(map->map_priv_1 + from), len);
}

static void pxa250_write8(struct map_info *map, __u8 d, unsigned long adr)
{
	writeb(d, map->map_priv_1 + adr);
}

static void pxa250_write16(struct map_info *map, __u16 d, unsigned long adr)
{
	writew(d, map->map_priv_1 + adr);
}

static void pxa250_write32(struct map_info *map, __u32 d, unsigned long adr)
{
	writel(d, map->map_priv_1 + adr);
}

static void pxa250_copy_to(struct map_info *map, unsigned long to, const void *from, ssize_t len)
{
	memcpy((void *)(map->map_priv_1 + to), from, len);
}

static struct map_info pxa250_map = {
	name:		"PXA250 flash",
	read8:		pxa250_read8,
	read16:		pxa250_read16,
	read32:		pxa250_read32,
	copy_from:	pxa250_copy_from,
	write8:		pxa250_write8,
	write16:	pxa250_write16,
	write32:	pxa250_write32,
	copy_to:	pxa250_copy_to,

	map_priv_1:	WINDOW_ADDR,
	map_priv_2:	-1,
};


extern void set_vpp(struct map_info *map, int vpp);

extern struct mtd_info *mymtd;

int mtd_init(void)
{
	/* Default flash buswidth */
	pxa250_map.buswidth = FLASH_BUSWIDTH;
	/* Default flash size */
	pxa250_map.size = FLASH_SIZE;

	pxa250_map.set_vpp = set_vpp;

	/*
	 * Now let's probe for the actual flash.  Do it here since
	 * specific machine settings might have been set above.
	 */
	printk("PXA250 flash: probing %d-bit flash bus\n", pxa250_map.buswidth*8);
	mymtd = do_map_probe("cfi_probe", &pxa250_map);
	if (!mymtd) return -ENXIO;
	return 0;
}