From 000ae30f6f7f195adfd94da9df8699d08006f660 Mon Sep 17 00:00:00 2001 From: Felix Fietkau Date: Tue, 19 Jun 2007 22:29:51 +0000 Subject: [PATCH] add brcm47xx mtd corruption fix by b.sander (#1502) SVN-Revision: 7675 --- .../files/drivers/mtd/maps/bcm47xx-flash.c | 20 +++++++++++++++++++ 1 file changed, 20 insertions(+) diff --git a/target/linux/brcm47xx-2.6/files/drivers/mtd/maps/bcm47xx-flash.c b/target/linux/brcm47xx-2.6/files/drivers/mtd/maps/bcm47xx-flash.c index 5068af848f..6a82f362c6 100644 --- a/target/linux/brcm47xx-2.6/files/drivers/mtd/maps/bcm47xx-flash.c +++ b/target/linux/brcm47xx-2.6/files/drivers/mtd/maps/bcm47xx-flash.c @@ -80,6 +80,22 @@ extern struct ssb_bus ssb; #endif static struct mtd_info *bcm947xx_mtd; +static void bcm947xx_map_copy_from(struct map_info *map, void *to, unsigned long from, ssize_t len) +{ + if (len==1) { + memcpy_fromio(to, map->virt + from, len); + } else { + int i; + u16 *dest = (u16 *) to; + u16 *src = (u16 *) (map->virt + from); + for (i = 0; i < (len / 2); i++) { + dest[i] = src[i]; + } + if (len & 1) + *((u8 *)dest+len-1) = src[i] & 0xff; + } +} + static struct map_info bcm947xx_map = { name: "Physically mapped flash", size: WINDOW_SIZE, @@ -372,6 +388,7 @@ int __init init_bcm947xx_map(void) printk("Failed to ioremap\n"); return -EIO; } + simple_map_init(&bcm947xx_map); if (!(bcm947xx_mtd = do_map_probe("cfi_probe", &bcm947xx_map))) { @@ -380,6 +397,9 @@ int __init init_bcm947xx_map(void) return -ENXIO; } + /* override copy_from routine */ + bcm947xx_map.copy_from = bcm947xx_map_copy_from; + bcm947xx_mtd->owner = THIS_MODULE; size = bcm947xx_mtd->size; -- 2.30.2