release/src-rt-6.x.4708/linux/linux-2.6.36/drivers/mtd/maps/scx200_docflash.c

   1 /* linux/drivers/mtd/maps/scx200_docflash.c
   2
   3    Copyright (c) 2001,2002 Christer Weinigel <wingel@nano-system.com>
   4
   5    National Semiconductor SCx200 flash mapped with DOCCS
   6 */
   7
   8 #include <linux/module.h>
   9 #include <linux/types.h>
  10 #include <linux/kernel.h>
  11 #include <linux/init.h>
  12 #include <asm/io.h>
  13 #include <linux/mtd/mtd.h>
  14 #include <linux/mtd/map.h>
  15 #include <linux/mtd/partitions.h>
  16
  17 #include <linux/pci.h>
  18 #include <linux/scx200.h>
  19
  20 #define NAME "scx200_docflash"
  21
  22 MODULE_AUTHOR("Christer Weinigel <wingel@hack.org>");
  23 MODULE_DESCRIPTION("NatSemi SCx200 DOCCS Flash Driver");
  24 MODULE_LICENSE("GPL");
  25
  26 static int probe = 0;           /* Don't autoprobe */
  27 static unsigned size = 0x1000000; /* 16 MiB the whole ISA address space */
  28 static unsigned width = 8;      /* Default to 8 bits wide */
  29 static char *flashtype = "cfi_probe";
  30
  31 module_param(probe, int, 0);
  32 MODULE_PARM_DESC(probe, "Probe for a BIOS mapping");
  33 module_param(size, int, 0);
  34 MODULE_PARM_DESC(size, "Size of the flash mapping");
  35 module_param(width, int, 0);
  36 MODULE_PARM_DESC(width, "Data width of the flash mapping (8/16)");
  37 module_param(flashtype, charp, 0);
  38 MODULE_PARM_DESC(flashtype, "Type of MTD probe to do");
  39
  40 static struct resource docmem = {
  41         .flags = IORESOURCE_MEM,
  42         .name  = "NatSemi SCx200 DOCCS Flash",
  43 };
  44
  45 static struct mtd_info *mymtd;
  46
  47 #ifdef CONFIG_MTD_PARTITIONS
  48 static struct mtd_partition partition_info[] = {
  49         {
  50                 .name   = "DOCCS Boot kernel",
  51                 .offset = 0,
  52                 .size   = 0xc0000
  53         },
  54         {
  55                 .name   = "DOCCS Low BIOS",
  56                 .offset = 0xc0000,
  57                 .size   = 0x40000
  58         },
  59         {
  60                 .name   = "DOCCS File system",
  61                 .offset = 0x100000,
  62                 .size   = ~0    /* calculate from flash size */
  63         },
  64         {
  65                 .name   = "DOCCS High BIOS",
  66                 .offset = ~0,   /* calculate from flash size */
  67                 .size   = 0x80000
  68         },
  69 };
  70 #define NUM_PARTITIONS ARRAY_SIZE(partition_info)
  71 #endif
  72
  73
  74 static struct map_info scx200_docflash_map = {
  75         .name      = "NatSemi SCx200 DOCCS Flash",
  76 };
  77
  78 static int __init init_scx200_docflash(void)
  79 {
  80         unsigned u;
  81         unsigned base;
  82         unsigned ctrl;
  83         unsigned pmr;
  84         struct pci_dev *bridge;
  85
  86         printk(KERN_DEBUG NAME ": NatSemi SCx200 DOCCS Flash Driver\n");
  87
  88         if ((bridge = pci_get_device(PCI_VENDOR_ID_NS,
  89                                       PCI_DEVICE_ID_NS_SCx200_BRIDGE,
  90                                       NULL)) == NULL)
  91                 return -ENODEV;
  92
  93         /* check that we have found the configuration block */
  94         if (!scx200_cb_present()) {
  95                 pci_dev_put(bridge);
  96                 return -ENODEV;
  97         }
  98
  99         if (probe) {
 100                 /* Try to use the present flash mapping if any */
 101                 pci_read_config_dword(bridge, SCx200_DOCCS_BASE, &base);
 102                 pci_read_config_dword(bridge, SCx200_DOCCS_CTRL, &ctrl);
 103                 pci_dev_put(bridge);
 104
 105                 pmr = inl(scx200_cb_base + SCx200_PMR);
 106
 107                 if (base == 0
 108                     || (ctrl & 0x07000000) != 0x07000000
 109                     || (ctrl & 0x0007ffff) == 0)
 110                         return -ENODEV;
 111
 112                 size = ((ctrl&0x1fff)<<13) + (1<<13);
 113
 114                 for (u = size; u > 1; u >>= 1)
 115                         ;
 116                 if (u != 1)
 117                         return -ENODEV;
 118
 119                 if (pmr & (1<<6))
 120                         width = 16;
 121                 else
 122                         width = 8;
 123
 124                 docmem.start = base;
 125                 docmem.end = base + size;
 126
 127                 if (request_resource(&iomem_resource, &docmem)) {
 128                         printk(KERN_ERR NAME ": unable to allocate memory for flash mapping\n");
 129                         return -ENOMEM;
 130                 }
 131         } else {
 132                 pci_dev_put(bridge);
 133                 for (u = size; u > 1; u >>= 1)
 134                         ;
 135                 if (u != 1) {
 136                         printk(KERN_ERR NAME ": invalid size for flash mapping\n");
 137                         return -EINVAL;
 138                 }
 139
 140                 if (width != 8 && width != 16) {
 141                         printk(KERN_ERR NAME ": invalid bus width for flash mapping\n");
 142                         return -EINVAL;
 143                 }
 144
 145                 if (allocate_resource(&iomem_resource, &docmem,
 146                                       size,
 147                                       0xc0000000, 0xffffffff,
 148                                       size, NULL, NULL)) {
 149                         printk(KERN_ERR NAME ": unable to allocate memory for flash mapping\n");
 150                         return -ENOMEM;
 151                 }
 152
 153                 ctrl = 0x07000000 | ((size-1) >> 13);
 154
 155                 printk(KERN_INFO "DOCCS BASE=0x%08lx, CTRL=0x%08lx\n", (long)docmem.start, (long)ctrl);
 156
 157                 pci_write_config_dword(bridge, SCx200_DOCCS_BASE, docmem.start);
 158                 pci_write_config_dword(bridge, SCx200_DOCCS_CTRL, ctrl);
 159                 pmr = inl(scx200_cb_base + SCx200_PMR);
 160
 161                 if (width == 8) {
 162                         pmr &= ~(1<<6);
 163                 } else {
 164                         pmr |= (1<<6);
 165                 }
 166                 outl(pmr, scx200_cb_base + SCx200_PMR);
 167         }
 168
 169         printk(KERN_INFO NAME ": DOCCS mapped at 0x%llx-0x%llx, width %d\n",
 170                         (unsigned long long)docmem.start,
 171                         (unsigned long long)docmem.end, width);
 172
 173         scx200_docflash_map.size = size;
 174         if (width == 8)
 175                 scx200_docflash_map.bankwidth = 1;
 176         else
 177                 scx200_docflash_map.bankwidth = 2;
 178
 179         simple_map_init(&scx200_docflash_map);
 180
 181         scx200_docflash_map.phys = docmem.start;
 182         scx200_docflash_map.virt = ioremap(docmem.start, scx200_docflash_map.size);
 183         if (!scx200_docflash_map.virt) {
 184                 printk(KERN_ERR NAME ": failed to ioremap the flash\n");
 185                 release_resource(&docmem);
 186                 return -EIO;
 187         }
 188
 189         mymtd = do_map_probe(flashtype, &scx200_docflash_map);
 190         if (!mymtd) {
 191                 printk(KERN_ERR NAME ": unable to detect flash\n");
 192                 iounmap(scx200_docflash_map.virt);
 193                 release_resource(&docmem);
 194                 return -ENXIO;
 195         }
 196
 197         if (size < mymtd->size)
 198                 printk(KERN_WARNING NAME ": warning, flash mapping is smaller than flash size\n");
 199
 200         mymtd->owner = THIS_MODULE;
 201
 202 #ifdef CONFIG_MTD_PARTITIONS
 203         partition_info[3].offset = mymtd->size-partition_info[3].size;
 204         partition_info[2].size = partition_info[3].offset-partition_info[2].offset;
 205         add_mtd_partitions(mymtd, partition_info, NUM_PARTITIONS);
 206 #else
 207         add_mtd_device(mymtd);
 208 #endif
 209         return 0;
 210 }
 211
 212 static void __exit cleanup_scx200_docflash(void)
 213 {
 214         if (mymtd) {
 215 #ifdef CONFIG_MTD_PARTITIONS
 216                 del_mtd_partitions(mymtd);
 217 #else
 218                 del_mtd_device(mymtd);
 219 #endif
 220                 map_destroy(mymtd);
 221         }
 222         if (scx200_docflash_map.virt) {
 223                 iounmap(scx200_docflash_map.virt);
 224                 release_resource(&docmem);
 225         }
 226 }
 227
 228 module_init(init_scx200_docflash);
 229 module_exit(cleanup_scx200_docflash);
 230
 231 /*
 232     Local variables:
 233         compile-command: "make -k -C ../../.. SUBDIRS=drivers/mtd/maps modules"
 234         c-basic-offset: 8
 235     End:
 236 */