Linux kernel & device driver programming

Cross-Referenced Linux and Device Driver Code

[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ]
Version: [ 2.6.11.8 ] [ 2.6.25 ] [ 2.6.25.8 ] [ 2.6.31.13 ] Architecture: [ i386 ]
  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 */
237 
  This page was automatically generated by the LXR engine.