target/linux/brcm47xx/patches-3.6/051-mtd-add-parallel-flash-driver.patch

   1 --- a/drivers/mtd/maps/Kconfig
   2 +++ b/drivers/mtd/maps/Kconfig
   3 @@ -249,6 +249,15 @@ config MTD_LANTIQ
   4         help
   5           Support for NOR flash attached to the Lantiq SoC's External Bus Unit.
   6
   7 +config MTD_BCM47XX_PFLASH
   8 +       tristate "bcm47xx parallel flash support"
   9 +       default y
  10 +       depends on BCM47XX
  11 +       select MTD_PARTITIONS
  12 +       select MTD_BCM47XX_PARTS
  13 +       help
  14 +         Support for bcm47xx parallel flash
  15 +
  16  config MTD_DILNETPC
  17         tristate "CFI Flash device mapped on DIL/Net PC"
  18         depends on X86 && MTD_CFI_INTELEXT && BROKEN
  19 --- a/drivers/mtd/maps/Makefile
  20 +++ b/drivers/mtd/maps/Makefile
  21 @@ -57,3 +57,4 @@ obj-$(CONFIG_MTD_VMU)         += vmu-flash.o
  22  obj-$(CONFIG_MTD_GPIO_ADDR)    += gpio-addr-flash.o
  23  obj-$(CONFIG_MTD_LATCH_ADDR)   += latch-addr-flash.o
  24  obj-$(CONFIG_MTD_LANTIQ)       += lantiq-flash.o
  25 +obj-$(CONFIG_MTD_BCM47XX_PFLASH)+= bcm47xx-pflash.o
  26 --- /dev/null
  27 +++ b/drivers/mtd/maps/bcm47xx-pflash.c
  28 @@ -0,0 +1,196 @@
  29 +/*
  30 + *  Copyright (C) 2006 Felix Fietkau <nbd@openwrt.org>
  31 + *  Copyright (C) 2005 Waldemar Brodkorb <wbx@openwrt.org>
  32 + *  Copyright (C) 2004 Florian Schirmer (jolt@tuxbox.org)
  33 + *
  34 + *  original functions for finding root filesystem from Mike Baker
  35 + *
  36 + *  This program is free software; you can redistribute  it and/or modify it
  37 + *  under  the terms of  the GNU General  Public License as published by the
  38 + *  Free Software Foundation;  either version 2 of the  License, or (at your
  39 + *  option) any later version.
  40 + *
  41 + *  THIS  SOFTWARE  IS PROVIDED   ``AS  IS'' AND   ANY  EXPRESS OR IMPLIED
  42 + *  WARRANTIES,   INCLUDING, BUT NOT  LIMITED  TO, THE IMPLIED WARRANTIES OF
  43 + *  MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.  IN
  44 + *  NO  EVENT  SHALL   THE AUTHOR  BE    LIABLE FOR ANY   DIRECT, INDIRECT,
  45 + *  INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
  46 + *  NOT LIMITED   TO, PROCUREMENT OF  SUBSTITUTE GOODS  OR SERVICES; LOSS OF
  47 + *  USE, DATA,  OR PROFITS; OR  BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON
  48 + *  ANY THEORY OF LIABILITY, WHETHER IN  CONTRACT, STRICT LIABILITY, OR TORT
  49 + *  (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
  50 + *  THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  51 + *
  52 + *  You should have received a copy of the  GNU General Public License along
  53 + *  with this program; if not, write  to the Free Software Foundation, Inc.,
  54 + *  675 Mass Ave, Cambridge, MA 02139, USA.
  55 + *
  56 + *  Copyright 2001-2003, Broadcom Corporation
  57 + *  All Rights Reserved.
  58 + *
  59 + *  THIS SOFTWARE IS OFFERED "AS IS", AND BROADCOM GRANTS NO WARRANTIES OF ANY
  60 + *  KIND, EXPRESS OR IMPLIED, BY STATUTE, COMMUNICATION OR OTHERWISE. BROADCOM
  61 + *  SPECIFICALLY DISCLAIMS ANY IMPLIED WARRANTIES OF MERCHANTABILITY, FITNESS
  62 + *  FOR A SPECIFIC PURPOSE OR NONINFRINGEMENT CONCERNING THIS SOFTWARE.
  63 + *
  64 + *  Flash mapping for BCM947XX boards
  65 + */
  66 +
  67 +#define pr_fmt(fmt) "bcm47xx_pflash: " fmt
  68 +#include <linux/init.h>
  69 +#include <linux/module.h>
  70 +#include <linux/types.h>
  71 +#include <linux/kernel.h>
  72 +#include <linux/sched.h>
  73 +#include <linux/mtd/mtd.h>
  74 +#include <linux/mtd/map.h>
  75 +#include <linux/mtd/partitions.h>
  76 +#include <linux/io.h>
  77 +#include <asm/mach-bcm47xx/bcm47xx.h>
  78 +#include <linux/platform_device.h>
  79 +
  80 +#define WINDOW_ADDR 0x1fc00000
  81 +#define WINDOW_SIZE 0x400000
  82 +#define BUSWIDTH 2
  83 +
  84 +static struct mtd_info *bcm47xx_mtd;
  85 +
  86 +static void bcm47xx_map_copy_from(struct map_info *map, void *to, unsigned long from, ssize_t len)
  87 +{
  88 +       if (len == 1) {
  89 +               memcpy_fromio(to, map->virt + from, len);
  90 +       } else {
  91 +               int i;
  92 +               u16 *dest = (u16 *) to;
  93 +               u16 *src  = (u16 *) (map->virt + from);
  94 +               for (i = 0; i < (len / 2); i++)
  95 +                       dest[i] = src[i];
  96 +               if (len & 1)
  97 +                       *((u8 *)dest+len-1) = src[i] & 0xff;
  98 +       }
  99 +}
 100 +
 101 +static struct map_info bcm47xx_map = {
 102 +       name: "Physically mapped flash",
 103 +       size : WINDOW_SIZE,
 104 +       bankwidth : BUSWIDTH,
 105 +       phys : WINDOW_ADDR,
 106 +};
 107 +
 108 +static const char *probes[] = { "bcm47xx", NULL };
 109 +
 110 +static int bcm47xx_pflash_probe(struct platform_device *pdev)
 111 +{
 112 +#ifdef CONFIG_BCM47XX_SSB
 113 +       struct ssb_mipscore *ssb_mcore;
 114 +#endif
 115 +#ifdef CONFIG_BCM47XX_BCMA
 116 +       struct bcma_drv_cc *bcma_cc;
 117 +#endif
 118 +       int ret = 0;
 119 +
 120 +       switch (bcm47xx_bus_type) {
 121 +#ifdef CONFIG_BCM47XX_SSB
 122 +       case BCM47XX_BUS_TYPE_SSB:
 123 +               ssb_mcore = &bcm47xx_bus.ssb.mipscore;
 124 +               if (!ssb_mcore->pflash.present)
 125 +                       return -ENODEV;
 126 +
 127 +               bcm47xx_map.phys = ssb_mcore->pflash.window;
 128 +               bcm47xx_map.size = ssb_mcore->pflash.window_size;
 129 +               bcm47xx_map.bankwidth = ssb_mcore->pflash.buswidth;
 130 +               break;
 131 +#endif
 132 +#ifdef CONFIG_BCM47XX_BCMA
 133 +       case BCM47XX_BUS_TYPE_BCMA:
 134 +               bcma_cc = &bcm47xx_bus.bcma.bus.drv_cc;
 135 +               if (!bcma_cc->pflash.present)
 136 +                       return -ENODEV;
 137 +
 138 +               bcm47xx_map.phys = bcma_cc->pflash.window;
 139 +               bcm47xx_map.size = bcma_cc->pflash.window_size;
 140 +               bcm47xx_map.bankwidth = bcma_cc->pflash.buswidth;
 141 +               break;
 142 +#endif
 143 +       }
 144 +
 145 +       pr_notice("flash init: 0x%08x 0x%08lx\n", bcm47xx_map.phys, bcm47xx_map.size);
 146 +       bcm47xx_map.virt = ioremap_nocache(bcm47xx_map.phys, bcm47xx_map.size);
 147 +
 148 +       if (!bcm47xx_map.virt) {
 149 +               pr_err("Failed to ioremap\n");
 150 +               return -EIO;
 151 +       }
 152 +
 153 +       simple_map_init(&bcm47xx_map);
 154 +       /* override copy_from routine */
 155 +       bcm47xx_map.copy_from = bcm47xx_map_copy_from;
 156 +
 157 +       bcm47xx_mtd = do_map_probe("cfi_probe", &bcm47xx_map);
 158 +       if (!bcm47xx_mtd) {
 159 +               pr_err("Failed to do_map_probe\n");
 160 +               ret = -ENXIO;
 161 +               goto err_unmap;
 162 +       }
 163 +       bcm47xx_mtd->owner = THIS_MODULE;
 164 +
 165 +       pr_notice("Flash device: 0x%lx at 0x%x\n", bcm47xx_map.size, WINDOW_ADDR);
 166 +
 167 +       ret = mtd_device_parse_register(bcm47xx_mtd, probes, NULL, NULL, 0);
 168 +
 169 +       if (ret) {
 170 +               pr_err("Flash: mtd_device_register failed\n");
 171 +               goto err_destroy;
 172 +       }
 173 +       return 0;
 174 +
 175 +err_destroy:
 176 +       map_destroy(bcm47xx_mtd);
 177 +err_unmap:
 178 +       iounmap(bcm47xx_map.virt);
 179 +       return ret;
 180 +}
 181 +
 182 +static int __devexit bcm47xx_pflash_remove(struct platform_device *pdev)
 183 +{
 184 +       mtd_device_unregister(bcm47xx_mtd);
 185 +       map_destroy(bcm47xx_mtd);
 186 +       iounmap(bcm47xx_map.virt);
 187 +       return 0;
 188 +}
 189 +
 190 +static const struct platform_device_id bcm47xx_pflash_table[] = {
 191 +       { "bcm47xx-pflash", 0 },
 192 +       { }
 193 +};
 194 +MODULE_DEVICE_TABLE(platform, bcm47xx_pflash_table);
 195 +
 196 +static struct platform_driver bcm47xx_pflash_driver = {
 197 +       .id_table       = bcm47xx_pflash_table,
 198 +       .probe  = bcm47xx_pflash_probe,
 199 +       .remove = __devexit_p(bcm47xx_pflash_remove),
 200 +       .driver = {
 201 +               .name = "bcm47xx-pflash",
 202 +               .owner = THIS_MODULE,
 203 +       },
 204 +};
 205 +
 206 +static int __init init_bcm47xx_pflash(void)
 207 +{
 208 +       int ret = platform_driver_register(&bcm47xx_pflash_driver);
 209 +
 210 +       if (ret)
 211 +               pr_err("error registering platform driver: %i\n", ret);
 212 +       return ret;
 213 +}
 214 +
 215 +static void __exit exit_bcm47xx_pflash(void)
 216 +{
 217 +       platform_driver_unregister(&bcm47xx_pflash_driver);
 218 +}
 219 +
 220 +module_init(init_bcm47xx_pflash);
 221 +module_exit(exit_bcm47xx_pflash);
 222 +
 223 +MODULE_LICENSE("GPL");
 224 +MODULE_DESCRIPTION("BCM47XX parallel flash driver");