Split up drivers and specific files, update flash map driver

git-svn-id: svn://svn.openwrt.org/openwrt/trunk@6765 3c298f89-4303-0410-b956-a3cf2f4a3e73

2 files changed, 269 insertions, 0 deletions

diff --git a/target/linux/rdc-2.6/files/drivers/mtd/maps/imghdr.h b/target/linux/rdc-2.6/files/drivers/mtd/maps/imghdr.h
new file mode 100644
index 000000000..bec8ee778
--- /dev/null
+++ b/target/linux/rdc-2.6/files/drivers/mtd/maps/imghdr.h
@@ -0,0 +1,25 @@
+#ifndef GT_IMGHDR_H
+#define GT_IMGHDR_H
+
+#define GTIMG_MAGIC		"GMTK"
+
+/* Product ID */
+#define PID_RTL_AIRGO		1
+#define PID_RTL_RALINK		2
+#define PID_RDC_AIRGO		3
+#define PID_RDC_RALINK		5	/* White Lable */
+
+/* Gemtek */
+typedef struct
+{
+	UINT8		magic[4];		/* ASICII: GMTK */
+	UINT32		checksum;		/* CRC32 */
+	UINT32		version;		/* x.x.x.x */
+	UINT32		kernelsz;		/* The size of the kernel image */
+	UINT32		imagesz;		/* The length of this image file ( kernel + romfs + this header) */
+	UINT32		pid;			/* Product ID */
+	UINT32		fastcksum;		/* Partial CRC32 on (First(256), medium(256), last(512)) */
+	UINT32		reserved;
+}gt_imghdr_t;
+
+#endif
diff --git a/target/linux/rdc-2.6/files/drivers/mtd/maps/rdc3210.c b/target/linux/rdc-2.6/files/drivers/mtd/maps/rdc3210.c
new file mode 100644
index 000000000..7a8193f02
--- /dev/null
+++ b/target/linux/rdc-2.6/files/drivers/mtd/maps/rdc3210.c
@@ -0,0 +1,244 @@
+/*******************************************************************
+ * Simple Flash mapping for RDC3210                                *
+ *                                                                 *
+ *                                                     2005.03.23  *
+ *                              Dante Su (dante_su@gemtek.com.tw)  *
+ *                          Copyright (C) 2005 Gemtek Corporation  *
+ *******************************************************************/
+
+#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>
+
+#ifndef RDC3210_STATIC_MAP
+#define RDC3210_STATIC_MAP	0
+#endif
+#ifndef RDC3210_NO_FACTORY_DFLT
+#define RDC3210_NO_FACTORY_DFLT	1
+#endif
+#ifndef RDC3210_USING_JFFS2
+#define RDC3210_USING_JFFS2	1
+#endif
+
+#define WINDOW_ADDR		0xFFC00000
+#define WINDOW_SIZE		0x00400000
+
+#define BUSWIDTH 2
+
+/* Dante: linked from linux-2.4.x/drivers/mtd/chips/flashdrv.c */
+extern int flashdrv_get_size(void);
+extern int flashdrv_get_sector(int addr);
+extern int flashdrv_get_sector_addr(int sector);
+extern int flashdrv_get_sector_size(int sector);
+
+static struct mtd_info		*rdc3210_mtd;
+
+__u8  rdc3210_map_read8(struct map_info *map, unsigned long ofs)
+{
+	return *(__u8 *)(map->map_priv_1 + ofs);
+}
+
+__u16 rdc3210_map_read16(struct map_info *map, unsigned long ofs)
+{
+	return *(__u16 *)(map->map_priv_1 + ofs);
+}
+
+__u32 rdc3210_map_read32(struct map_info *map, unsigned long ofs)
+{
+	return *(__u32 *)(map->map_priv_1 + ofs);
+}
+
+void rdc3210_map_write8(struct map_info *map, __u8 d, unsigned long adr)
+{
+	*(__u8 *)(map->map_priv_1 + adr) = d;
+}
+
+void rdc3210_map_write16(struct map_info *map, __u16 d, unsigned long adr)
+{
+	*(__u16 *)(map->map_priv_1 + adr) = d;
+}
+
+void rdc3210_map_write32(struct map_info *map, __u32 d, unsigned long adr)
+{
+	*(__u32 *)(map->map_priv_1 + adr) = d;
+}
+
+void rdc3210_map_copy_from(struct map_info *map, void *to, unsigned long from, ssize_t len)
+{
+	int	i;
+	u16	*dst = (u16 *)(to);
+	u16	*src = (u16 *)(map->map_priv_1 + from);
+
+	for(i = 0; i < (len / 2); ++i)
+		dst[i] = src[i];
+
+	if(len & 1)
+	{
+		printk("# WARNNING!!! rdc3210_map_copy_from has odd length\n");
+		//dst[len - 1] = B0(src[i]);
+	}
+}
+
+void rdc3210_map_copy_to(struct map_info *map, void *to, unsigned long from, ssize_t len)
+{
+	int	i;
+	u16	*dst = (u16 *)(map->map_priv_1 + to);
+	u16	*src = (u16 *)(from);
+	
+	for(i = 0; i < (len / 2); ++i)
+		dst[i] = src[i];
+
+	if(len & 1)
+	{
+		printk("# WARNNING!!! rdc3210_map_copy_from has odd length\n");
+		//dst[len - 1] = B0(src[i]);
+	}
+}
+
+struct map_info rdc3210_map = 
+{
+	name:		"RDC3210 Flash",
+	size:		WINDOW_SIZE,
+	buswidth:	BUSWIDTH,
+	read8:		rdc3210_map_read8,
+	read16:		rdc3210_map_read16,
+	read32:		rdc3210_map_read32,
+	copy_from:	rdc3210_map_copy_from,
+	write8:		rdc3210_map_write8,
+	write16:	rdc3210_map_write16,
+	write32:	rdc3210_map_write32,
+	copy_to:	rdc3210_map_copy_to,
+};
+
+/* Dante: This is the default static mapping, however this is nothing but a hint. (Say dynamic mapping) */
+static struct mtd_partition rdc3210_parts[] = 
+{
+	{ name: "linux",   offset:  0,          size: 0x003C0000 },	/* 3840 KB = (Kernel + ROMFS) = (768 KB + 3072 KB) */
+	{ name: "romfs",   offset:  0x000C0000, size: 0x00300000 },	/* 3072 KB */
+	{ name: "nvram",   offset:  0x003C0000, size: 0x00010000 },	/*   64 KB */
+#if RDC3210_STATIC_MAP || !RDC3210_NO_FACTORY_DFLT
+	{ name: "factory", offset:  0x003D0000, size: 0x00010000 },	/*   64 KB */
+#endif
+	{ name: "bootldr", offset:  0x003E0000, size: 0x00020000 },	/*  128 KB */
+};
+
+#if LINUX_VERSION_CODE < 0x20212 && defined(MODULE)
+#define init_rdc3210_map		init_module
+#define cleanup_rdc3210_map		cleanup_module
+#endif
+
+mod_init_t init_rdc3210_map(void)
+{
+       	printk(KERN_NOTICE "flash device: %x at %x\n", WINDOW_SIZE, WINDOW_ADDR);
+       	
+	rdc3210_map.map_priv_1 = ioremap(WINDOW_ADDR, WINDOW_SIZE);
+
+	if (!rdc3210_map.map_priv_1) 
+	{
+		printk("Failed to ioremap\n");
+		return -EIO;
+	}
+	rdc3210_mtd = do_map_probe("cfi_probe", &rdc3210_map);
+#if RDC3210_STATIC_MAP	/* Dante: This is for fixed map */
+	if (rdc3210_mtd) 
+	{
+		rdc3210_mtd->module = THIS_MODULE;
+		add_mtd_partitions(rdc3210_mtd, rdc3210_parts, sizeof(rdc3210_parts)/sizeof(rdc3210_parts[0]));
+		return 0;
+	}
+#else	/* Dante: This is for dynamic mapping */
+
+#include <gemtek/sysdep.h>
+#include <gemtek/imghdr.h>
+
+	if (rdc3210_mtd) 
+	{	// Dante
+#if RDC3210_USING_JFFS2
+		unsigned int	tmp, tmp2 = rdc3210_mtd->erasesize;
+#else
+		unsigned int	tmp, tmp2 = 32;
+#endif
+		gt_imghdr_t	*hdr;
+		
+		hdr = (gt_imghdr_t *)(rdc3210_map.map_priv_1);
+		
+		if(memcmp(hdr->magic, GTIMG_MAGIC, 4))
+		{
+			printk("Invalid MAGIC for Firmware Image!!!\n");
+			return -EIO;
+		}
+
+		/* 1. Adjust Redboot */
+		tmp = flashdrv_get_size() - rdc3210_parts[4].size;
+		rdc3210_parts[4].offset = flashdrv_get_sector_addr(flashdrv_get_sector(tmp));
+		rdc3210_parts[4].size   = flashdrv_get_size() - rdc3210_parts[4].offset;
+		
+		/* 2. Adjust NVRAM */
+		tmp -= rdc3210_parts[3].size;
+		rdc3210_parts[3].offset = flashdrv_get_sector_addr(flashdrv_get_sector(tmp));
+		rdc3210_parts[3].size   = rdc3210_parts[4].offset - rdc3210_parts[3].offset;
+		
+		/* 3. Adjust Factory Default */
+		tmp -= rdc3210_parts[2].size;
+		rdc3210_parts[2].offset = flashdrv_get_sector_addr(flashdrv_get_sector(tmp));
+		rdc3210_parts[2].size   = rdc3210_parts[3].offset - rdc3210_parts[2].offset;
+		
+		/* 4. Adjust Linux (Kernel + ROMFS) */
+		rdc3210_parts[0].size   = rdc3210_parts[2].offset - rdc3210_parts[0].offset;
+
+		/* 5. Adjust ROMFS */
+		tmp = hdr->kernelsz + sizeof(gt_imghdr_t);
+		rdc3210_parts[1].offset = rdc3210_parts[0].offset + (((tmp / tmp2) + ((tmp % tmp2) ? 1 : 0)) * tmp2);
+		rdc3210_parts[1].size   = rdc3210_parts[2].offset - rdc3210_parts[1].offset;
+#if RDC3210_NO_FACTORY_DFLT
+		/* 1. Adjust Redboot */
+		tmp = flashdrv_get_size() - rdc3210_parts[3].size;
+		rdc3210_parts[3].offset = flashdrv_get_sector_addr(flashdrv_get_sector(tmp));
+		rdc3210_parts[3].size   = flashdrv_get_size() - rdc3210_parts[3].offset;
+		
+		/* 2. Adjust NVRAM */
+		tmp -= rdc3210_parts[2].size;
+		rdc3210_parts[2].offset = flashdrv_get_sector_addr(flashdrv_get_sector(tmp));
+		rdc3210_parts[2].size   = rdc3210_parts[3].offset - rdc3210_parts[2].offset;
+				
+		/* 4. Adjust Linux (Kernel + ROMFS) */
+		rdc3210_parts[0].size   = rdc3210_parts[2].offset - rdc3210_parts[0].offset;
+
+		/* 5. Adjust ROMFS */
+		tmp = hdr->kernelsz + sizeof(gt_imghdr_t);
+		rdc3210_parts[1].offset = rdc3210_parts[0].offset + (((tmp / tmp2) + ((tmp % tmp2) ? 1 : 0)) * tmp2);
+		rdc3210_parts[1].size   = rdc3210_parts[2].offset - rdc3210_parts[1].offset;
+#endif
+		
+		rdc3210_mtd->module = THIS_MODULE;
+		add_mtd_partitions(rdc3210_mtd, rdc3210_parts, sizeof(rdc3210_parts)/sizeof(rdc3210_parts[0]));
+		return 0;
+	}
+#endif
+
+	iounmap((void *)rdc3210_map.map_priv_1);
+	return -ENXIO;
+}
+
+mod_exit_t cleanup_rdc3210_map(void)
+{
+	if (rdc3210_mtd) 
+	{
+		del_mtd_partitions(rdc3210_mtd);
+		map_destroy(rdc3210_mtd);
+	}
+	
+	if (rdc3210_map.map_priv_1) 
+	{
+		iounmap((void *)rdc3210_map.map_priv_1);
+		rdc3210_map.map_priv_1 = NULL;
+	}
+}
+
+module_init(init_rdc3210_map);
+module_exit(cleanup_rdc3210_map);