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