From f20dffc06169a609d3a1a3e03aabbda4bbf2ab3d Mon Sep 17 00:00:00 2001 From: Florian Fainelli Date: Fri, 30 Mar 2007 21:56:07 +0000 Subject: 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 --- .../linux/rdc-2.6/files/drivers/mtd/maps/imghdr.h | 25 +++ .../linux/rdc-2.6/files/drivers/mtd/maps/rdc3210.c | 244 +++++++++++++++++++++ 2 files changed, 269 insertions(+) create mode 100644 target/linux/rdc-2.6/files/drivers/mtd/maps/imghdr.h create mode 100644 target/linux/rdc-2.6/files/drivers/mtd/maps/rdc3210.c (limited to 'target/linux/rdc-2.6/files/drivers/mtd/maps') 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 0000000000..bec8ee7783 --- /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 0000000000..7a8193f023 --- /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 +#include +#include +#include +#include +#include +#include +#include + +#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 +#include + + 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); -- cgit v1.2.3