release/src-rt-6.x.4708/linux/linux-2.6.36/drivers/mtd/devices/ms02-nv.c

   1 /*
   2  *      Copyright (c) 2001 Maciej W. Rozycki
   3  *
   4  *      This program is free software; you can redistribute it and/or
   5  *      modify it under the terms of the GNU General Public License
   6  *      as published by the Free Software Foundation; either version
   7  *      2 of the License, or (at your option) any later version.
   8  */
   9
  10 #include <linux/init.h>
  11 #include <linux/ioport.h>
  12 #include <linux/kernel.h>
  13 #include <linux/module.h>
  14 #include <linux/mtd/mtd.h>
  15 #include <linux/slab.h>
  16 #include <linux/types.h>
  17
  18 #include <asm/addrspace.h>
  19 #include <asm/bootinfo.h>
  20 #include <asm/dec/ioasic_addrs.h>
  21 #include <asm/dec/kn02.h>
  22 #include <asm/dec/kn03.h>
  23 #include <asm/io.h>
  24 #include <asm/paccess.h>
  25
  26 #include "ms02-nv.h"
  27
  28
  29 static char version[] __initdata =
  30         "ms02-nv.c: v.1.0.0  13 Aug 2001  Maciej W. Rozycki.\n";
  31
  32 MODULE_AUTHOR("Maciej W. Rozycki <macro@linux-mips.org>");
  33 MODULE_DESCRIPTION("DEC MS02-NV NVRAM module driver");
  34 MODULE_LICENSE("GPL");
  35
  36
  37 /*
  38  * Addresses we probe for an MS02-NV at.  Modules may be located
  39  * at any 8MiB boundary within a 0MiB up to 112MiB range or at any 32MiB
  40  * boundary within a 0MiB up to 448MiB range.  We don't support a module
  41  * at 0MiB, though.
  42  */
  43 static ulong ms02nv_addrs[] __initdata = {
  44         0x07000000, 0x06800000, 0x06000000, 0x05800000, 0x05000000,
  45         0x04800000, 0x04000000, 0x03800000, 0x03000000, 0x02800000,
  46         0x02000000, 0x01800000, 0x01000000, 0x00800000
  47 };
  48
  49 static const char ms02nv_name[] = "DEC MS02-NV NVRAM";
  50 static const char ms02nv_res_diag_ram[] = "Diagnostic RAM";
  51 static const char ms02nv_res_user_ram[] = "General-purpose RAM";
  52 static const char ms02nv_res_csr[] = "Control and status register";
  53
  54 static struct mtd_info *root_ms02nv_mtd;
  55
  56
  57 static int ms02nv_read(struct mtd_info *mtd, loff_t from,
  58                         size_t len, size_t *retlen, u_char *buf)
  59 {
  60         struct ms02nv_private *mp = mtd->priv;
  61
  62         if (from + len > mtd->size)
  63                 return -EINVAL;
  64
  65         memcpy(buf, mp->uaddr + from, len);
  66         *retlen = len;
  67
  68         return 0;
  69 }
  70
  71 static int ms02nv_write(struct mtd_info *mtd, loff_t to,
  72                         size_t len, size_t *retlen, const u_char *buf)
  73 {
  74         struct ms02nv_private *mp = mtd->priv;
  75
  76         if (to + len > mtd->size)
  77                 return -EINVAL;
  78
  79         memcpy(mp->uaddr + to, buf, len);
  80         *retlen = len;
  81
  82         return 0;
  83 }
  84
  85
  86 static inline uint ms02nv_probe_one(ulong addr)
  87 {
  88         ms02nv_uint *ms02nv_diagp;
  89         ms02nv_uint *ms02nv_magicp;
  90         uint ms02nv_diag;
  91         uint ms02nv_magic;
  92         size_t size;
  93
  94         int err;
  95
  96         /*
  97          * The firmware writes MS02NV_ID at MS02NV_MAGIC and also
  98          * a diagnostic status at MS02NV_DIAG.
  99          */
 100         ms02nv_diagp = (ms02nv_uint *)(CKSEG1ADDR(addr + MS02NV_DIAG));
 101         ms02nv_magicp = (ms02nv_uint *)(CKSEG1ADDR(addr + MS02NV_MAGIC));
 102         err = get_dbe(ms02nv_magic, ms02nv_magicp);
 103         if (err)
 104                 return 0;
 105         if (ms02nv_magic != MS02NV_ID)
 106                 return 0;
 107
 108         ms02nv_diag = *ms02nv_diagp;
 109         size = (ms02nv_diag & MS02NV_DIAG_SIZE_MASK) << MS02NV_DIAG_SIZE_SHIFT;
 110         if (size > MS02NV_CSR)
 111                 size = MS02NV_CSR;
 112
 113         return size;
 114 }
 115
 116 static int __init ms02nv_init_one(ulong addr)
 117 {
 118         struct mtd_info *mtd;
 119         struct ms02nv_private *mp;
 120         struct resource *mod_res;
 121         struct resource *diag_res;
 122         struct resource *user_res;
 123         struct resource *csr_res;
 124         ulong fixaddr;
 125         size_t size, fixsize;
 126
 127         static int version_printed;
 128
 129         int ret = -ENODEV;
 130
 131         /* The module decodes 8MiB of address space. */
 132         mod_res = kzalloc(sizeof(*mod_res), GFP_KERNEL);
 133         if (!mod_res)
 134                 return -ENOMEM;
 135
 136         mod_res->name = ms02nv_name;
 137         mod_res->start = addr;
 138         mod_res->end = addr + MS02NV_SLOT_SIZE - 1;
 139         mod_res->flags = IORESOURCE_MEM | IORESOURCE_BUSY;
 140         if (request_resource(&iomem_resource, mod_res) < 0)
 141                 goto err_out_mod_res;
 142
 143         size = ms02nv_probe_one(addr);
 144         if (!size)
 145                 goto err_out_mod_res_rel;
 146
 147         if (!version_printed) {
 148                 printk(KERN_INFO "%s", version);
 149                 version_printed = 1;
 150         }
 151
 152         ret = -ENOMEM;
 153         mtd = kzalloc(sizeof(*mtd), GFP_KERNEL);
 154         if (!mtd)
 155                 goto err_out_mod_res_rel;
 156         mp = kzalloc(sizeof(*mp), GFP_KERNEL);
 157         if (!mp)
 158                 goto err_out_mtd;
 159
 160         mtd->priv = mp;
 161         mp->resource.module = mod_res;
 162
 163         /* Firmware's diagnostic NVRAM area. */
 164         diag_res = kzalloc(sizeof(*diag_res), GFP_KERNEL);
 165         if (!diag_res)
 166                 goto err_out_mp;
 167
 168         diag_res->name = ms02nv_res_diag_ram;
 169         diag_res->start = addr;
 170         diag_res->end = addr + MS02NV_RAM - 1;
 171         diag_res->flags = IORESOURCE_BUSY;
 172         request_resource(mod_res, diag_res);
 173
 174         mp->resource.diag_ram = diag_res;
 175
 176         /* User-available general-purpose NVRAM area. */
 177         user_res = kzalloc(sizeof(*user_res), GFP_KERNEL);
 178         if (!user_res)
 179                 goto err_out_diag_res;
 180
 181         user_res->name = ms02nv_res_user_ram;
 182         user_res->start = addr + MS02NV_RAM;
 183         user_res->end = addr + size - 1;
 184         user_res->flags = IORESOURCE_BUSY;
 185         request_resource(mod_res, user_res);
 186
 187         mp->resource.user_ram = user_res;
 188
 189         /* Control and status register. */
 190         csr_res = kzalloc(sizeof(*csr_res), GFP_KERNEL);
 191         if (!csr_res)
 192                 goto err_out_user_res;
 193
 194         csr_res->name = ms02nv_res_csr;
 195         csr_res->start = addr + MS02NV_CSR;
 196         csr_res->end = addr + MS02NV_CSR + 3;
 197         csr_res->flags = IORESOURCE_BUSY;
 198         request_resource(mod_res, csr_res);
 199
 200         mp->resource.csr = csr_res;
 201
 202         mp->addr = phys_to_virt(addr);
 203         mp->size = size;
 204
 205         /*
 206          * Hide the firmware's diagnostic area.  It may get destroyed
 207          * upon a reboot.  Take paging into account for mapping support.
 208          */
 209         fixaddr = (addr + MS02NV_RAM + PAGE_SIZE - 1) & ~(PAGE_SIZE - 1);
 210         fixsize = (size - (fixaddr - addr)) & ~(PAGE_SIZE - 1);
 211         mp->uaddr = phys_to_virt(fixaddr);
 212
 213         mtd->type = MTD_RAM;
 214         mtd->flags = MTD_CAP_RAM;
 215         mtd->size = fixsize;
 216         mtd->name = (char *)ms02nv_name;
 217         mtd->owner = THIS_MODULE;
 218         mtd->read = ms02nv_read;
 219         mtd->write = ms02nv_write;
 220         mtd->writesize = 1;
 221
 222         ret = -EIO;
 223         if (add_mtd_device(mtd)) {
 224                 printk(KERN_ERR
 225                         "ms02-nv: Unable to register MTD device, aborting!\n");
 226                 goto err_out_csr_res;
 227         }
 228
 229         printk(KERN_INFO "mtd%d: %s at 0x%08lx, size %zuMiB.\n",
 230                 mtd->index, ms02nv_name, addr, size >> 20);
 231
 232         mp->next = root_ms02nv_mtd;
 233         root_ms02nv_mtd = mtd;
 234
 235         return 0;
 236
 237
 238 err_out_csr_res:
 239         release_resource(csr_res);
 240         kfree(csr_res);
 241 err_out_user_res:
 242         release_resource(user_res);
 243         kfree(user_res);
 244 err_out_diag_res:
 245         release_resource(diag_res);
 246         kfree(diag_res);
 247 err_out_mp:
 248         kfree(mp);
 249 err_out_mtd:
 250         kfree(mtd);
 251 err_out_mod_res_rel:
 252         release_resource(mod_res);
 253 err_out_mod_res:
 254         kfree(mod_res);
 255         return ret;
 256 }
 257
 258 static void __exit ms02nv_remove_one(void)
 259 {
 260         struct mtd_info *mtd = root_ms02nv_mtd;
 261         struct ms02nv_private *mp = mtd->priv;
 262
 263         root_ms02nv_mtd = mp->next;
 264
 265         del_mtd_device(mtd);
 266
 267         release_resource(mp->resource.csr);
 268         kfree(mp->resource.csr);
 269         release_resource(mp->resource.user_ram);
 270         kfree(mp->resource.user_ram);
 271         release_resource(mp->resource.diag_ram);
 272         kfree(mp->resource.diag_ram);
 273         release_resource(mp->resource.module);
 274         kfree(mp->resource.module);
 275         kfree(mp);
 276         kfree(mtd);
 277 }
 278
 279
 280 static int __init ms02nv_init(void)
 281 {
 282         volatile u32 *csr;
 283         uint stride = 0;
 284         int count = 0;
 285         int i;
 286
 287         switch (mips_machtype) {
 288         case MACH_DS5000_200:
 289                 csr = (volatile u32 *)CKSEG1ADDR(KN02_SLOT_BASE + KN02_CSR);
 290                 if (*csr & KN02_CSR_BNK32M)
 291                         stride = 2;
 292                 break;
 293         case MACH_DS5000_2X0:
 294         case MACH_DS5900:
 295                 csr = (volatile u32 *)CKSEG1ADDR(KN03_SLOT_BASE + IOASIC_MCR);
 296                 if (*csr & KN03_MCR_BNK32M)
 297                         stride = 2;
 298                 break;
 299         default:
 300                 return -ENODEV;
 301                 break;
 302         }
 303
 304         for (i = 0; i < ARRAY_SIZE(ms02nv_addrs); i++)
 305                 if (!ms02nv_init_one(ms02nv_addrs[i] << stride))
 306                         count++;
 307
 308         return (count > 0) ? 0 : -ENODEV;
 309 }
 310
 311 static void __exit ms02nv_cleanup(void)
 312 {
 313         while (root_ms02nv_mtd)
 314                 ms02nv_remove_one();
 315 }
 316
 317
 318 module_init(ms02nv_init);
 319 module_exit(ms02nv_cleanup);