X-Git-Url: https://git.rohieb.name/openwrt.git/blobdiff_plain/67b44a7096164d0dd8009fa168e7b36ba589ce77..015aed13171ff6201459286e15fc5e0686a46907:/target/linux/adm5120-2.6/files/drivers/mtd/maps/adm5120_mtd.c?ds=sidebyside diff --git a/target/linux/adm5120-2.6/files/drivers/mtd/maps/adm5120_mtd.c b/target/linux/adm5120-2.6/files/drivers/mtd/maps/adm5120_mtd.c index 1fdbc7f10..230fceee2 100644 --- a/target/linux/adm5120-2.6/files/drivers/mtd/maps/adm5120_mtd.c +++ b/target/linux/adm5120-2.6/files/drivers/mtd/maps/adm5120_mtd.c @@ -3,7 +3,7 @@ * Copyright (C) 2005 Waldemar Brodkorb * Copyright (C) 2004 Florian Schirmer (jolt@tuxbox.org) * - * original functions for finding root filesystem from Mike Baker + * original functions for finding root filesystem from Mike Baker * * This program is free software; you can redistribute it and/or modify it * under the terms of the GNU General Public License as published by the @@ -24,10 +24,10 @@ * You should have received a copy of the GNU General Public License along * with this program; if not, write to the Free Software Foundation, Inc., * 675 Mass Ave, Cambridge, MA 02139, USA. - * + * * Copyright 2001-2003, Broadcom Corporation * All Rights Reserved. - * + * * THIS SOFTWARE IS OFFERED "AS IS", AND BROADCOM GRANTS NO WARRANTIES OF ANY * KIND, EXPRESS OR IMPLIED, BY STATUTE, COMMUNICATION OR OTHERWISE. BROADCOM * SPECIFICALLY DISCLAIMS ANY IMPLIED WARRANTIES OF MERCHANTABILITY, FITNESS @@ -43,22 +43,34 @@ #include #include #include +#include #ifdef CONFIG_MTD_PARTITIONS #include #endif #include #include #include -#ifdef CONFIG_SSB -#include -#endif #include +#include +#include + +extern int parse_myloader_partitions(struct mtd_info *master, + struct mtd_partition **pparts, + unsigned long origin); + +/* Macros for switching flash bank + ADM5120 only support 2MB flash address space + so GPIO5 is used as A20 + */ +#define GPIO_IO ((volatile unsigned long *)0xb20000b8) +#define FLASH_A20_GPIO 5 +#define FLASH_BOUNDARY 0x200000 #define TRX_MAGIC 0x30524448 /* "HDR0" */ #define TRX_VERSION 1 #define TRX_MAX_LEN 0x3A0000 -#define TRX_NO_HEADER 1 /* Do not write TRX header */ +#define TRX_NO_HEADER 1 /* Do not write TRX header */ #define TRX_GZ_FILES 0x2 /* Contains up to TRX_MAX_OFFSET individual gzip files */ #define TRX_MAX_OFFSET 3 @@ -76,9 +88,6 @@ struct trx_header { #define WINDOW_SIZE 0x400000 #define BUSWIDTH 2 -#ifdef CONFIG_SSB -extern struct ssb_bus ssb; -#endif static struct mtd_info *adm5120_mtd; static struct map_info adm5120_map = { @@ -90,15 +99,60 @@ static struct map_info adm5120_map = { #ifdef CONFIG_MTD_PARTITIONS -static struct mtd_partition adm5120_parts[] = { +static struct mtd_partition adm5120_cfe_parts[] = { { name: "cfe", offset: 0, size: 0, mask_flags: MTD_WRITEABLE, }, { name: "linux", offset: 0, size: 0, }, { name: "rootfs", offset: 0, size: 0, }, { name: "nvram", offset: 0, size: 0, }, - { name: "OpenWrt", offset: 0, size: 0, }, { name: NULL, }, }; + +static void flash_switch_bank(unsigned long addr) +{ + unsigned long val; + + /* Set GPIO as output */ + val = *GPIO_IO | (1 << (FLASH_A20_GPIO+16)); + if ( addr & FLASH_BOUNDARY ) { + val |= 1 << (FLASH_A20_GPIO + 24); + } else { + val &= ~(1 << (FLASH_A20_GPIO + 24)); + } + *GPIO_IO = val; +} + +static map_word adm5120_map_read(struct map_info *map, unsigned long ofs) +{ + flash_switch_bank(ofs); + return inline_map_read(map, ofs); +} + +static void adm5120_map_write(struct map_info *map, const map_word datum, unsigned long ofs) +{ + flash_switch_bank(ofs); + inline_map_write(map, datum, ofs); +} + +static void adm5120_map_copy_from(struct map_info *map, void *to, unsigned long from, ssize_t len) +{ + ssize_t tmp; + + if (from < FLASH_BOUNDARY) { + tmp = (len < (FLASH_BOUNDARY - from)) ? len : (FLASH_BOUNDARY - from); + flash_switch_bank(0); + inline_map_copy_from(map, to, from, tmp); + to = (void *)((char *)to + tmp); + from += tmp; + len -= tmp; + } + if (len > 0) { + flash_switch_bank(FLASH_BOUNDARY); + inline_map_copy_from(map, to, from, len); + } + +} + static int __init find_cfe_size(struct mtd_info *mtd, size_t size) { @@ -118,7 +172,7 @@ find_cfe_size(struct mtd_info *mtd, size_t size) memset(buf, 0xe5, sizeof(buf)); /* - * Read into buffer + * Read into buffer */ if (mtd->read(mtd, off, sizeof(buf), &len, buf) || len != sizeof(buf)) @@ -145,7 +199,7 @@ find_cfe_size(struct mtd_info *mtd, size_t size) * Copied from mtdblock.c * * Cache stuff... - * + * * Since typical flash erasable sectors are much larger than what Linux's * buffer cache can handle, we must implement read-modify-write on flash * sectors for each block write requests. To avoid over-erasing flash sectors @@ -159,7 +213,7 @@ static void erase_callback(struct erase_info *done) wake_up(wait_q); } -static int erase_write (struct mtd_info *mtd, unsigned long pos, +static int erase_write (struct mtd_info *mtd, unsigned long pos, int len, const char *buf) { struct erase_info erase; @@ -228,7 +282,7 @@ find_root(struct mtd_info *mtd, size_t size, struct mtd_partition *part) memset(&trx, 0xe5, sizeof(trx)); /* - * Read into buffer + * Read into buffer */ if (mtd->read(mtd, off, sizeof(trx), &len, (char *) &trx) || len != sizeof(trx)) @@ -236,9 +290,9 @@ find_root(struct mtd_info *mtd, size_t size, struct mtd_partition *part) /* found a TRX header */ if (le32_to_cpu(trx.magic) == TRX_MAGIC) { - part->offset = le32_to_cpu(trx.offsets[2]) ? : + part->offset = le32_to_cpu(trx.offsets[2]) ? : le32_to_cpu(trx.offsets[1]); - part->size = le32_to_cpu(trx.len); + part->size = le32_to_cpu(trx.len); part->size -= part->offset; part->offset += off; @@ -255,33 +309,17 @@ find_root(struct mtd_info *mtd, size_t size, struct mtd_partition *part) found: if (part->size == 0) return 0; - + if (mtd->read(mtd, part->offset, sizeof(buf), &len, buf) || len != sizeof(buf)) return 0; - if (*((__u32 *) buf) == SQUASHFS_MAGIC) { - printk(KERN_INFO "%s: Filesystem type: squashfs, size=0x%x\n", mtd->name, (u32) sb->bytes_used); - - /* Update the squashfs partition size based on the superblock info */ - part->size = sb->bytes_used; - len = part->offset + part->size; - len += (mtd->erasesize - 1); - len &= ~(mtd->erasesize - 1); - part->size = len - part->offset; - } else if (*((__u16 *) buf) == JFFS2_MAGIC_BITMASK) { - printk(KERN_INFO "%s: Filesystem type: jffs2\n", mtd->name); - - /* Move the squashfs outside of the trx */ - part->size = 0; - } else { - printk(KERN_INFO "%s: Filesystem type: unknown\n", mtd->name); - return 0; - } + /* Move the fs outside of the trx */ + part->size = 0; if (trx.len != part->offset + part->size - off) { /* Update the trx offsets and length */ trx.len = part->offset + part->size - off; - + /* Update the trx crc32 */ for (i = (u32) &(((struct trx_header *)NULL)->flag_version); i <= trx.len; i += sizeof(buf)) { if (mtd->read(mtd, off + i, sizeof(buf), &len, buf) || len != sizeof(buf)) @@ -297,7 +335,7 @@ find_root(struct mtd_info *mtd, size_t size, struct mtd_partition *part) printk("Error accessing the first trx eraseblock\n"); return 0; } - + printk("Updating TRX offsets and length:\n"); printk("old trx = [0x%08x, 0x%08x, 0x%08x], len=0x%08x crc32=0x%08x\n", trx2->offsets[0], trx2->offsets[1], trx2->offsets[2], trx2->len, trx2->crc32); printk("new trx = [0x%08x, 0x%08x, 0x%08x], len=0x%08x crc32=0x%08x\n", trx.offsets[0], trx.offsets[1], trx.offsets[2], trx.len, trx.crc32); @@ -312,7 +350,7 @@ find_root(struct mtd_info *mtd, size_t size, struct mtd_partition *part) kfree(block); printk("Done\n"); } - + return part->size; } @@ -325,98 +363,62 @@ init_mtd_partitions(struct mtd_info *mtd, size_t size) return NULL; /* boot loader */ - adm5120_parts[0].offset = 0; - adm5120_parts[0].size = cfe_size; + adm5120_cfe_parts[0].offset = 0; + adm5120_cfe_parts[0].size = cfe_size; /* nvram */ if (cfe_size != 384 * 1024) { - adm5120_parts[3].offset = size - ROUNDUP(NVRAM_SPACE, mtd->erasesize); - adm5120_parts[3].size = ROUNDUP(NVRAM_SPACE, mtd->erasesize); + adm5120_cfe_parts[3].offset = size - ROUNDUP(NVRAM_SPACE, mtd->erasesize); + adm5120_cfe_parts[3].size = ROUNDUP(NVRAM_SPACE, mtd->erasesize); } else { /* nvram (old 128kb config partition on netgear wgt634u) */ - adm5120_parts[3].offset = adm5120_parts[0].size; - adm5120_parts[3].size = ROUNDUP(NVRAM_SPACE, mtd->erasesize); + adm5120_cfe_parts[3].offset = adm5120_cfe_parts[0].size; + adm5120_cfe_parts[3].size = ROUNDUP(NVRAM_SPACE, mtd->erasesize); } /* linux (kernel and rootfs) */ if (cfe_size != 384 * 1024) { - adm5120_parts[1].offset = adm5120_parts[0].size; - adm5120_parts[1].size = adm5120_parts[3].offset - - adm5120_parts[1].offset; + adm5120_cfe_parts[1].offset = adm5120_cfe_parts[0].size; + adm5120_cfe_parts[1].size = adm5120_cfe_parts[3].offset - + adm5120_cfe_parts[1].offset; } else { /* do not count the elf loader, which is on one block */ - adm5120_parts[1].offset = adm5120_parts[0].size + - adm5120_parts[3].size + mtd->erasesize; - adm5120_parts[1].size = size - - adm5120_parts[0].size - - (2*adm5120_parts[3].size) - + adm5120_cfe_parts[1].offset = adm5120_cfe_parts[0].size + + adm5120_cfe_parts[3].size + mtd->erasesize; + adm5120_cfe_parts[1].size = size - + adm5120_cfe_parts[0].size - + (2*adm5120_cfe_parts[3].size) - mtd->erasesize; } /* find and size rootfs */ - if (find_root(mtd,size,&adm5120_parts[2])==0) { - /* entirely jffs2 */ - adm5120_parts[4].name = NULL; - adm5120_parts[2].size = size - adm5120_parts[2].offset - - adm5120_parts[3].size; - } else { - /* legacy setup */ - /* calculate leftover flash, and assign it to the jffs2 partition */ - if (cfe_size != 384 * 1024) { - adm5120_parts[4].offset = adm5120_parts[2].offset + - adm5120_parts[2].size; - if ((adm5120_parts[4].offset % mtd->erasesize) > 0) { - adm5120_parts[4].offset += mtd->erasesize - - (adm5120_parts[4].offset % mtd->erasesize); - } - adm5120_parts[4].size = adm5120_parts[3].offset - - adm5120_parts[4].offset; - } else { - adm5120_parts[4].offset = adm5120_parts[2].offset + - adm5120_parts[2].size; - if ((adm5120_parts[4].offset % mtd->erasesize) > 0) { - adm5120_parts[4].offset += mtd->erasesize - - (adm5120_parts[4].offset % mtd->erasesize); - } - adm5120_parts[4].size = size - adm5120_parts[3].size - - adm5120_parts[4].offset; - } - } + find_root(mtd,size,&adm5120_cfe_parts[2]); + adm5120_cfe_parts[2].size = size - adm5120_cfe_parts[2].offset - adm5120_cfe_parts[3].size; - return adm5120_parts; + return adm5120_cfe_parts; } #endif int __init init_adm5120_map(void) { -#ifdef CONFIG_SSB - struct ssb_mipscore *mcore = &ssb.mipscore; -#endif size_t size; int ret = 0; -#ifdef CONFIG_MTD_PARTITIONS +#if defined (CONFIG_MTD_PARTITIONS) || (CONFIG_MTD_MYLOADER_PARTS) struct mtd_partition *parts; - int i; -#endif -#ifdef CONFIG_SSB - u32 window = mcore->flash_window; - u32 window_size = mcore->flash_window_size; - - printk("adm5120 : flash init: 0x%08x 0x%08x\n", window, window_size); - adm5120_map.phys = window; - adm5120_map.size = window_size; - adm5120_map.virt = ioremap_nocache(window, window_size); -#else - printk("adm5120 : flash init : 0x%08x 0x%08x\n", WINDOW_ADDR, WINDOW_SIZE); - adm5120_map.virt = ioremap_nocache(WINDOW_ADDR, WINDOW_SIZE); + int i, parsed_nr_parts = 0; #endif + printk("adm5120 : flash init : 0x%08x 0x%08x\n", WINDOW_ADDR, adm5120_board.flash0_size); + adm5120_map.virt = ioremap_nocache(WINDOW_ADDR, adm5120_board.flash0_size); if (!adm5120_map.virt) { printk("Failed to ioremap\n"); return -EIO; } simple_map_init(&adm5120_map); - + adm5120_map.read = adm5120_map_read; + adm5120_map.write = adm5120_map_write; + adm5120_map.copy_from = adm5120_map_copy_from; + if (!(adm5120_mtd = do_map_probe("cfi_probe", &adm5120_map))) { printk("Failed to do_map_probe\n"); iounmap((void *)adm5120_map.virt); @@ -430,12 +432,41 @@ int __init init_adm5120_map(void) printk(KERN_NOTICE "Flash device: 0x%x at 0x%x\n", size, WINDOW_ADDR); #ifdef CONFIG_MTD_PARTITIONS - parts = init_mtd_partitions(adm5120_mtd, size); - for (i = 0; parts[i].name; i++); - ret = add_mtd_partitions(adm5120_mtd, parts, i); - if (ret) { - printk(KERN_ERR "Flash: add_mtd_partitions failed\n"); - goto fail; + + if (adm5120_boot_loader == BOOT_LOADER_CFE) + { + printk(KERN_NOTICE "adm5120 : using CFE flash mapping\n"); + parts = init_mtd_partitions(adm5120_mtd, size); + + for (i = 0; parts[i].name; i++); + ret = add_mtd_partitions(adm5120_mtd, parts, i); + + if (ret) { + printk(KERN_ERR "Flash: add_mtd_partitions failed\n"); + goto fail; + } + } +#endif +#ifdef CONFIG_MTD_MYLOADER_PARTS + if (adm5120_boot_loader == BOOT_LOADER_MYLOADER) + { + printk(KERN_NOTICE "adm5120 : using MyLoader flash mapping\n"); + char *part_type; + + if (parsed_nr_parts == 0) { + ret = parse_myloader_partitions(adm5120_mtd, &parts, 0); + + if (ret > 0) { + part_type ="MyLoader"; + parsed_nr_parts = ret; + } + } + ret = add_mtd_partitions(adm5120_mtd, parts, parsed_nr_parts); + + if (ret) { + printk(KERN_ERR "Flash: add_mtd_partitions failed\n"); + goto fail; + } } #endif return 0;