x86: arch/x86/mm/init_32.c cleanup
[wrt350n-kernel.git] / drivers / mtd / maps / scx200_docflash.c
blob5e2bce22f37ca6146ee46c7abf3eca84628ff2f0
1 /* linux/drivers/mtd/maps/scx200_docflash.c
3 Copyright (c) 2001,2002 Christer Weinigel <wingel@nano-system.com>
5 $Id: scx200_docflash.c,v 1.12 2005/11/07 11:14:28 gleixner Exp $
7 National Semiconductor SCx200 flash mapped with DOCCS
8 */
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>
19 #include <linux/pci.h>
20 #include <linux/scx200.h>
22 #define NAME "scx200_docflash"
24 MODULE_AUTHOR("Christer Weinigel <wingel@hack.org>");
25 MODULE_DESCRIPTION("NatSemi SCx200 DOCCS Flash Driver");
26 MODULE_LICENSE("GPL");
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";
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");
42 static struct resource docmem = {
43 .flags = IORESOURCE_MEM,
44 .name = "NatSemi SCx200 DOCCS Flash",
47 static struct mtd_info *mymtd;
49 #ifdef CONFIG_MTD_PARTITIONS
50 static struct mtd_partition partition_info[] = {
52 .name = "DOCCS Boot kernel",
53 .offset = 0,
54 .size = 0xc0000
57 .name = "DOCCS Low BIOS",
58 .offset = 0xc0000,
59 .size = 0x40000
62 .name = "DOCCS File system",
63 .offset = 0x100000,
64 .size = ~0 /* calculate from flash size */
67 .name = "DOCCS High BIOS",
68 .offset = ~0, /* calculate from flash size */
69 .size = 0x80000
72 #define NUM_PARTITIONS ARRAY_SIZE(partition_info)
73 #endif
76 static struct map_info scx200_docflash_map = {
77 .name = "NatSemi SCx200 DOCCS Flash",
80 static int __init init_scx200_docflash(void)
82 unsigned u;
83 unsigned base;
84 unsigned ctrl;
85 unsigned pmr;
86 struct pci_dev *bridge;
88 printk(KERN_DEBUG NAME ": NatSemi SCx200 DOCCS Flash Driver\n");
90 if ((bridge = pci_get_device(PCI_VENDOR_ID_NS,
91 PCI_DEVICE_ID_NS_SCx200_BRIDGE,
92 NULL)) == NULL)
93 return -ENODEV;
95 /* check that we have found the configuration block */
96 if (!scx200_cb_present()) {
97 pci_dev_put(bridge);
98 return -ENODEV;
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);
107 pmr = inl(scx200_cb_base + SCx200_PMR);
109 if (base == 0
110 || (ctrl & 0x07000000) != 0x07000000
111 || (ctrl & 0x0007ffff) == 0)
112 return -ENODEV;
114 size = ((ctrl&0x1fff)<<13) + (1<<13);
116 for (u = size; u > 1; u >>= 1)
118 if (u != 1)
119 return -ENODEV;
121 if (pmr & (1<<6))
122 width = 16;
123 else
124 width = 8;
126 docmem.start = base;
127 docmem.end = base + size;
129 if (request_resource(&iomem_resource, &docmem)) {
130 printk(KERN_ERR NAME ": unable to allocate memory for flash mapping\n");
131 return -ENOMEM;
133 } else {
134 pci_dev_put(bridge);
135 for (u = size; u > 1; u >>= 1)
137 if (u != 1) {
138 printk(KERN_ERR NAME ": invalid size for flash mapping\n");
139 return -EINVAL;
142 if (width != 8 && width != 16) {
143 printk(KERN_ERR NAME ": invalid bus width for flash mapping\n");
144 return -EINVAL;
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;
155 ctrl = 0x07000000 | ((size-1) >> 13);
157 printk(KERN_INFO "DOCCS BASE=0x%08lx, CTRL=0x%08lx\n", (long)docmem.start, (long)ctrl);
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);
163 if (width == 8) {
164 pmr &= ~(1<<6);
165 } else {
166 pmr |= (1<<6);
168 outl(pmr, scx200_cb_base + SCx200_PMR);
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);
175 scx200_docflash_map.size = size;
176 if (width == 8)
177 scx200_docflash_map.bankwidth = 1;
178 else
179 scx200_docflash_map.bankwidth = 2;
181 simple_map_init(&scx200_docflash_map);
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;
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;
199 if (size < mymtd->size)
200 printk(KERN_WARNING NAME ": warning, flash mapping is smaller than flash size\n");
202 mymtd->owner = THIS_MODULE;
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;
214 static void __exit cleanup_scx200_docflash(void)
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);
224 if (scx200_docflash_map.virt) {
225 iounmap(scx200_docflash_map.virt);
226 release_resource(&docmem);
230 module_init(init_scx200_docflash);
231 module_exit(cleanup_scx200_docflash);
234 Local variables:
235 compile-command: "make -k -C ../../.. SUBDIRS=drivers/mtd/maps modules"
236 c-basic-offset: 8
237 End: