/****************************************************************************/
/*
 * Flash memory access on uClinux MCF5407 board
 * Copyright (C) ENSEIRB 2003, Patrice Kadionik <kadionik@enseirb.fr>
 */
/****************************************************************************/

/*
 *
 * Normal mappings of chips in physical memory
 */

#include <linux/module.h>
#include <linux/types.h>
#include <linux/kernel.h>
#include <asm/io.h>
#include <linux/mtd/mtd.h>
#include <linux/mtd/map.h>
#include <linux/mtd/partitions.h>
#include <linux/config.h>


#define WINDOW_ADDR 0x7fe00000
#define WINDOW_SIZE 0x200000
#define BUSWIDTH 2


static struct mtd_info *mymtd;

__u8 m5407c3_read8(struct map_info *map, unsigned long ofs)
{
	return __raw_readb(map->map_priv_1 + ofs);
}

__u16 m5407c3_read16(struct map_info *map, unsigned long ofs)
{
	return __raw_readw(map->map_priv_1 + ofs);
}

__u32 m5407c3_read32(struct map_info *map, unsigned long ofs)
{
	return __raw_readl(map->map_priv_1 + ofs);
}

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

void m5407c3_write8(struct map_info *map, __u8 d, unsigned long adr)
{
	__raw_writeb(d, map->map_priv_1 + adr);
	mb();
}

void m5407c3_write16(struct map_info *map, __u16 d, unsigned long adr)
{
	__raw_writew(d, map->map_priv_1 + adr);
	mb();
}

void m5407c3_write32(struct map_info *map, __u32 d, unsigned long adr)
{
	__raw_writel(d, map->map_priv_1 + adr);
	mb();
}

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

struct map_info m5407c3_map = {
	name: "MCF5407C3 flash device",
	size: WINDOW_SIZE,
	buswidth: BUSWIDTH,
	read8: m5407c3_read8,
	read16: m5407c3_read16,
	read32: m5407c3_read32,
	copy_from: m5407c3_copy_from,
	write8: m5407c3_write8,
	write16: m5407c3_write16,
	write32: m5407c3_write32,
	copy_to: m5407c3_copy_to
};

/*
 * MTD 'PARTITIONING' STUFF 
 */

static struct mtd_partition m5407c3_partitions[] = {
        {
                name: "dBUG (256K)",
                size: 0x40000,
                offset: 0x0
        },
        {
                name: "user (1792K)",
                size: 0x1c0000,
                offset: 0x40000
        }
};

int __init init_m5407c3(void)
{
       	printk(KERN_NOTICE "m5407c3 flash device: %x at %x\n", WINDOW_SIZE, WINDOW_ADDR);
	m5407c3_map.map_priv_1 = (unsigned long)ioremap(WINDOW_ADDR, WINDOW_SIZE);

	if (!m5407c3_map.map_priv_1) {
		printk("Failed to ioremap\n");
		return -EIO;
	}
	mymtd = do_map_probe("cfi_probe", &m5407c3_map);
	if (mymtd) {
		mymtd->module = THIS_MODULE;
		mymtd->erasesize = 0x40000;

		return add_mtd_partitions(mymtd, m5407c3_partitions,
					  sizeof(m5407c3_partitions) /
					  sizeof(struct mtd_partition));
	}

	iounmap((void *)m5407c3_map.map_priv_1);
	return -ENXIO;
}

static void __exit cleanup_m5407c3(void)
{
	if (mymtd) {
		del_mtd_partitions(mymtd);
		map_destroy(mymtd);
	}
	if (m5407c3_map.map_priv_1) {
		iounmap((void *)m5407c3_map.map_priv_1);
		m5407c3_map.map_priv_1 = 0;
	}
}

module_init(init_m5407c3);
module_exit(cleanup_m5407c3);

/****************************************************************************/
/*
 * Flash memory access on uClinux SnapGear like devices
 * Copyright (C) 2001-2002, David McCullough <davidm@snapgear.com>
 */
/****************************************************************************/