diff --git a/target/linux/brcm63xx-2.6/patches/040-bcm963xx_flashmap.patch b/target/linux/brcm63xx-2.6/patches/040-bcm963xx_flashmap.patch index 997cc980f9..6dd4bf8164 100644 --- a/target/linux/brcm63xx-2.6/patches/040-bcm963xx_flashmap.patch +++ b/target/linux/brcm63xx-2.6/patches/040-bcm963xx_flashmap.patch @@ -1,7 +1,7 @@ diff -urN linux-2.6.17/drivers/mtd/maps/bcm963xx-flash.c linux-2.6.17-brcm63xx/drivers/mtd/maps/bcm963xx-flash.c --- linux-2.6.17/drivers/mtd/maps/bcm963xx-flash.c 1970-01-01 01:00:00.000000000 +0100 -+++ linux-2.6.17-brcm63xx/drivers/mtd/maps/bcm963xx-flash.c 2006-08-30 13:03:16.000000000 +0200 -@@ -0,0 +1,135 @@ ++++ linux-2.6.17-brcm63xx/drivers/mtd/maps/bcm963xx-flash.c 2006-11-06 22:43:59.000000000 +0000 +@@ -0,0 +1,276 @@ +/* + * $Id$ + * Copyright (C) 2006 Florian Fainelli @@ -11,12 +11,12 @@ diff -urN linux-2.6.17/drivers/mtd/maps/bcm963xx-flash.c linux-2.6.17-brcm63xx/d + * it under the terms of the GNU General Public License as published by + * the Free Software Foundation; either version 2 of the License, or + * (at your option) any later version. -+ * ++ * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. -+ * ++ * + * 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., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA @@ -24,7 +24,7 @@ diff -urN linux-2.6.17/drivers/mtd/maps/bcm963xx-flash.c linux-2.6.17-brcm63xx/d + +/* This is the BCM963xx flash map driver, in its actual state it only supports BCM96348 devices + * this driver is able to manage both bootloader we found on these boards : CFE and RedBoot -+ * ++ * + * RedBoot : + * - this bootloader allows us to parse partitions and therefore deduce the MTD partition table + * @@ -35,17 +35,22 @@ diff -urN linux-2.6.17/drivers/mtd/maps/bcm963xx-flash.c linux-2.6.17-brcm63xx/d + +#include +#include ++#include +#include +#include +#include ++#include +#include + -+#define WINDOW_ADDR 0x1e400000 /* Real address of the flash */ -+#define WINDOW_SIZE 0x800000 /* Size of flash */ -+#define BUSWIDTH 2 /* Buswidth */ -+#define EXTENDED_SIZE 0xBE400000 /* Extended flash addresse */ ++#define WINDOW_ADDR 0x1FC00000 /* Real address of the flash */ ++#define WINDOW_SIZE 0x400000 /* Size of flash */ ++#define BUSWIDTH 2 /* Buswidth */ ++#define EXTENDED_SIZE 0xBFC00000 /* Extended flash address */ ++#define IMAGE_LEN 10 /* Length of Length Field */ ++#define ADDRESS_LEN 12 /* Length of Address field */ ++#define ROUNDUP(x, y) ((((x)+((y)-1))/(y))*(y)) + -+extern int boot_loader_type; /* For RedBoot / CFE detection */ ++extern int boot_loader_type; /* For RedBoot / CFE detection */ +extern int parse_redboot_partitions(struct mtd_info *master, struct mtd_partition **pparts, unsigned long fis_origin); +static struct mtd_partition *parsed_parts; + @@ -54,10 +59,121 @@ diff -urN linux-2.6.17/drivers/mtd/maps/bcm963xx-flash.c linux-2.6.17-brcm63xx/d +static struct mtd_info *bcm963xx_mtd_info; + +static struct map_info bcm963xx_map = { -+ .name = "bcm963xx", -+ .size = WINDOW_SIZE, -+ .bankwidth = BUSWIDTH, -+ .phys = WINDOW_ADDR, ++ .name = "bcm963xx", ++ .size = WINDOW_SIZE, ++ .bankwidth = BUSWIDTH, ++ .phys = WINDOW_ADDR, ++}; ++ ++ ++int parse_cfe_partitions( struct mtd_info *master, struct mtd_partition **pparts) ++{ ++ int nrparts = 2, curpart = 0; // CFE and NVRAM always present. ++ struct bcm963xx_cfe_map { ++ unsigned char tagVersion[4]; // Version of the image tag ++ unsigned char sig_1[20]; // Company Line 1 ++ unsigned char sig_2[14]; // Company Line 2 ++ unsigned char chipid[6]; // Chip this image is for ++ unsigned char boardid[16]; // Board name ++ unsigned char bigEndian[2]; // Map endianness -- 1 BE 0 LE ++ unsigned char totalLength[IMAGE_LEN]; //Total length of image ++ unsigned char cfeAddress[ADDRESS_LEN]; // Address in memory of CFE ++ unsigned char cfeLength[IMAGE_LEN]; // Size of CFE ++ unsigned char rootAddress[ADDRESS_LEN]; // Address in memory of rootfs ++ unsigned char rootLength[IMAGE_LEN]; // Size of rootfs ++ unsigned char kernelAddress[ADDRESS_LEN]; // Address in memory of kernel ++ unsigned char kernelLength[IMAGE_LEN]; // Size of kernel ++ unsigned char dualImage[2]; // Unused at present ++ unsigned char inactiveFlag[2]; // Unused at present ++ unsigned char reserved1[74]; // Reserved area not in use ++ unsigned char imageCRC[4]; // CRC32 of images ++ unsigned char reserved2[16]; // Unused at present ++ unsigned char headerCRC[4]; // CRC32 of header excluding tagVersion ++ unsigned char reserved3[16]; // Unused at present ++ } *buf; ++ struct mtd_partition *parts; ++ int ret; ++ size_t retlen; ++ unsigned int rootfsaddr, kerneladdr, spareaddr; ++ unsigned int rootfslen, kernellen, sparelen, totallen; ++ int namelen = 0; ++ int i; ++ // Allocate memory for buffer ++ buf = vmalloc(sizeof(struct bcm963xx_cfe_map)); ++ ++ if (!buf) ++ return -ENOMEM; ++ ++ // Get the tag ++ ret = master->read(master,master->erasesize,sizeof(struct bcm963xx_cfe_map), &retlen, (void *)buf); ++ if (retlen != sizeof(struct bcm963xx_cfe_map)){ ++ vfree(buf); ++ return -EIO; ++ }; ++ printk("bcm963xx: CFE boot tag found with version %s and board type %s.\n",buf->tagVersion,buf->boardid); ++ // Get the values and calculate ++ sscanf(buf->rootAddress,"%u", &rootfsaddr); ++ rootfsaddr = rootfsaddr - EXTENDED_SIZE; ++ sscanf(buf->rootLength, "%u", &rootfslen); ++ sscanf(buf->kernelAddress, "%u", &kerneladdr); ++ kerneladdr = kerneladdr - EXTENDED_SIZE; ++ sscanf(buf->kernelLength, "%u", &kernellen); ++ sscanf(buf->totalLength, "%u", &totallen); ++ spareaddr = ROUNDUP(totallen,master->erasesize) + master->erasesize; ++ sparelen = master->size - spareaddr - master->erasesize; ++ // Determine number of partitions ++ namelen = 8; ++ if (rootfslen > 0){ ++ nrparts++; ++ namelen =+ 6; ++ }; ++ if (kernellen > 0){ ++ nrparts++; ++ namelen =+ 6; ++ }; ++ if (sparelen > 0){ ++ nrparts++; ++ namelen =+ 6; ++ }; ++ // Ask kernel for more memory. ++ parts = kmalloc(sizeof(*parts)*nrparts+10*nrparts, GFP_KERNEL); ++ if (!parts){ ++ vfree(buf); ++ return -ENOMEM; ++ }; ++ memset(parts,0,sizeof(*parts)*nrparts+10*nrparts); ++ // Start building partition list ++ parts[curpart].name = "CFE"; ++ parts[curpart].offset = 0; ++ parts[curpart].size = master->erasesize; ++ curpart++; ++ if (kernellen > 0){ ++ parts[curpart].name = "Kernel"; ++ parts[curpart].offset = kerneladdr; ++ parts[curpart].size = kernellen; ++ curpart++; ++ }; ++ if (rootfslen > 0){ ++ parts[curpart].name = "Rootfs"; ++ parts[curpart].offset = rootfsaddr; ++ parts[curpart].size = rootfslen; ++ curpart++; ++ }; ++ if (sparelen > 0){ ++ parts[curpart].name = "OpenWrt"; ++ parts[curpart].offset = spareaddr; ++ parts[curpart].size = sparelen; ++ curpart++; ++ }; ++ parts[curpart].name = "NVRAM"; ++ parts[curpart].offset = master->size - master->erasesize; ++ parts[curpart].size = master->erasesize; ++ for (i = 0; i < nrparts; i++) { ++ printk("bcm963xx: Partition %d is %s offset %x and length %x\n", i, parts[i].name, parts[i].offset, parts[i].size); ++ } ++ *pparts = parts; ++ vfree(buf); ++ return nrparts; +}; + +static struct mtd_partition bcm963xx_parts[] = { @@ -68,68 +184,93 @@ diff -urN linux-2.6.17/drivers/mtd/maps/bcm963xx-flash.c linux-2.6.17-brcm63xx/d + +static int bcm963xx_parts_size = sizeof(bcm963xx_parts) / sizeof(bcm963xx_parts[0]); + ++static int bcm963xx_detect_cfe(struct mtd_info *master) ++{ ++ int idoffset = 0x4e0; ++ static char idstring[8] = "CFE1CFE1"; ++ char buf[8]; ++ int ret; ++ size_t retlen; ++ ++ ret = master->read(master, idoffset, 8, &retlen, (void *)buf); ++ printk("bcm963xx: Read Signature value of %s\n", buf); ++ return strcmp(idstring,buf); ++} ++ +static int __init bcm963xx_mtd_init(void) +{ -+ printk("bcm963xx: 0x%08x at 0x%08x\n", WINDOW_SIZE, WINDOW_ADDR); -+ bcm963xx_map.virt = ioremap(WINDOW_ADDR, WINDOW_SIZE); ++ printk("bcm963xx: 0x%08x at 0x%08x\n", WINDOW_SIZE, WINDOW_ADDR); ++ bcm963xx_map.virt = ioremap(WINDOW_ADDR, WINDOW_SIZE); + -+ if (!bcm963xx_map.virt) { -+ printk("bcm963xx: Failed to ioremap\n"); -+ return -EIO; -+ } ++ if (!bcm963xx_map.virt) { ++ printk("bcm963xx: Failed to ioremap\n"); ++ return -EIO; ++ } + -+ simple_map_init(&bcm963xx_map); ++ simple_map_init(&bcm963xx_map); + -+ bcm963xx_mtd_info = do_map_probe("cfi_probe", &bcm963xx_map); ++ bcm963xx_mtd_info = do_map_probe("cfi_probe", &bcm963xx_map); + -+ if (bcm963xx_mtd_info) { -+ bcm963xx_mtd_info->owner = THIS_MODULE; ++ if (bcm963xx_mtd_info) { ++ bcm963xx_mtd_info->owner = THIS_MODULE; + -+ if (boot_loader_type == BOOT_CFE) -+ { -+ add_mtd_device(bcm963xx_mtd_info); -+ add_mtd_partitions(bcm963xx_mtd_info, bcm963xx_parts, bcm963xx_parts_size); -+ return 0; -+ } -+ else -+ { -+ int parsed_nr_parts = 0; -+ char * part_type; ++ //if (boot_loader_type == BOOT_CFE) ++ if (bcm963xx_detect_cfe(bcm963xx_mtd_info) == 0) ++ { ++ int parsed_nr_parts = 0; ++ char * part_type; ++ printk("bcm963xx: CFE bootloader detected\n"); ++ //add_mtd_device(bcm963xx_mtd_info); ++ //add_mtd_partitions(bcm963xx_mtd_info, bcm963xx_parts, bcm963xx_parts_size); ++ if (parsed_nr_parts == 0) { ++ int ret = parse_cfe_partitions(bcm963xx_mtd_info, &parsed_parts); ++ if (ret > 0) { ++ part_type = "CFE"; ++ parsed_nr_parts = ret; ++ } ++ } ++ add_mtd_partitions(bcm963xx_mtd_info, parsed_parts, parsed_nr_parts); ++ return 0; ++ } ++ else ++ { ++ int parsed_nr_parts = 0; ++ char * part_type; + -+ if (bcm963xx_mtd_info->size > 0x00400000) { -+ printk("Support for extended flash memory size : 0x%08X ; ONLY 64MBIT SUPPORT\n", bcm963xx_mtd_info->size); -+ bcm963xx_map.virt = (unsigned long)(EXTENDED_SIZE); -+ } ++ if (bcm963xx_mtd_info->size > 0x00400000) { ++ printk("Support for extended flash memory size : 0x%08X ; ONLY 64MBIT SUPPORT\n", bcm963xx_mtd_info->size); ++ bcm963xx_map.virt = (unsigned long)(EXTENDED_SIZE); ++ } + -+#ifdef CONFIG_MTD_REDBOOT_PARTS -+ if (parsed_nr_parts == 0) { -+ int ret = parse_redboot_partitions(bcm963xx_mtd_info, &parsed_parts, 0); -+ if (ret > 0) { -+ part_type = "RedBoot"; -+ parsed_nr_parts = ret; -+ } -+ } ++#ifdef CONFIG_MTD_REDBOOT_PARTS ++ if (parsed_nr_parts == 0) { ++ int ret = parse_redboot_partitions(bcm963xx_mtd_info, &parsed_parts, 0); ++ if (ret > 0) { ++ part_type = "RedBoot"; ++ parsed_nr_parts = ret; ++ } ++ } +#endif -+ add_mtd_partitions(bcm963xx_mtd_info, parsed_parts, parsed_nr_parts); ++ add_mtd_partitions(bcm963xx_mtd_info, parsed_parts, parsed_nr_parts); + -+ return 0; -+ } -+ } -+ iounmap(bcm963xx_map.virt); -+ return -ENXIO; ++ return 0; ++ } ++ } ++ iounmap(bcm963xx_map.virt); ++ return -ENXIO; +} + +static void __exit bcm963xx_mtd_cleanup(void) +{ -+ if (bcm963xx_mtd_info) { -+ del_mtd_partitions(bcm963xx_mtd_info); -+ map_destroy(bcm963xx_mtd_info); -+ } ++ if (bcm963xx_mtd_info) { ++ del_mtd_partitions(bcm963xx_mtd_info); ++ map_destroy(bcm963xx_mtd_info); ++ } + -+ if (bcm963xx_map.virt) { -+ iounmap(bcm963xx_map.virt); -+ bcm963xx_map.virt = 0; -+ } ++ if (bcm963xx_map.virt) { ++ iounmap(bcm963xx_map.virt); ++ bcm963xx_map.virt = 0; ++ } +} + +module_init(bcm963xx_mtd_init);