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