1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47#include <linux/module.h>
48#include <linux/types.h>
49#include <linux/kernel.h>
50#include <linux/init.h>
51#include <asm/io.h>
52#include <linux/mtd/mtd.h>
53#include <linux/mtd/map.h>
54#include <linux/mtd/cfi.h>
55#include <linux/pci.h>
56#include <linux/pci_ids.h>
57
58#define MODNAME "scb2_flash"
59#define SCB2_ADDR 0xfff00000
60#define SCB2_WINDOW 0x00100000
61
62
63static void __iomem *scb2_ioaddr;
64static struct mtd_info *scb2_mtd;
65static struct map_info scb2_map = {
66 .name = "SCB2 BIOS Flash",
67 .size = 0,
68 .bankwidth = 1,
69};
70static int region_fail;
71
72static int scb2_fixup_mtd(struct mtd_info *mtd)
73{
74 int i;
75 int done = 0;
76 struct map_info *map = mtd->priv;
77 struct cfi_private *cfi = map->fldrv_priv;
78
79
80 if (cfi->cfiq->InterfaceDesc != CFI_INTERFACE_X16_ASYNC) {
81 printk(KERN_ERR MODNAME ": unsupported InterfaceDesc: %#x\n",
82 cfi->cfiq->InterfaceDesc);
83 return -1;
84 }
85
86
87
88
89 mtd->size = map->size;
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104 mtd->erasesize /= 2;
105 for (i = 0; i < mtd->numeraseregions; i++) {
106 struct mtd_erase_region_info *region = &mtd->eraseregions[i];
107 region->erasesize /= 2;
108 }
109
110
111
112
113
114
115
116 for (i = 0; !done && i < mtd->numeraseregions; i++) {
117 struct mtd_erase_region_info *region = &mtd->eraseregions[i];
118
119 if (region->numblocks * region->erasesize > mtd->size) {
120 region->numblocks = ((unsigned long)mtd->size /
121 region->erasesize);
122 done = 1;
123 } else {
124 region->numblocks = 0;
125 }
126 region->offset = 0;
127 }
128
129 return 0;
130}
131
132
133#define CSB5_FCR 0x41
134#define CSB5_FCR_DECODE_ALL 0x0e
135static int scb2_flash_probe(struct pci_dev *dev,
136 const struct pci_device_id *ent)
137{
138 u8 reg;
139
140
141 pci_read_config_byte(dev, CSB5_FCR, ®);
142 pci_write_config_byte(dev, CSB5_FCR, reg | CSB5_FCR_DECODE_ALL);
143
144 if (!request_mem_region(SCB2_ADDR, SCB2_WINDOW, scb2_map.name)) {
145
146
147
148
149 printk(KERN_WARNING MODNAME
150 ": warning - can't reserve rom window, continuing\n");
151 region_fail = 1;
152 }
153
154
155 scb2_ioaddr = ioremap_nocache(SCB2_ADDR, SCB2_WINDOW);
156 if (!scb2_ioaddr) {
157 printk(KERN_ERR MODNAME ": Failed to ioremap window!\n");
158 if (!region_fail)
159 release_mem_region(SCB2_ADDR, SCB2_WINDOW);
160 return -ENOMEM;
161 }
162
163 scb2_map.phys = SCB2_ADDR;
164 scb2_map.virt = scb2_ioaddr;
165 scb2_map.size = SCB2_WINDOW;
166
167 simple_map_init(&scb2_map);
168
169
170 scb2_mtd = do_map_probe("cfi_probe", &scb2_map);
171
172 if (!scb2_mtd) {
173 printk(KERN_ERR MODNAME ": flash probe failed!\n");
174 iounmap(scb2_ioaddr);
175 if (!region_fail)
176 release_mem_region(SCB2_ADDR, SCB2_WINDOW);
177 return -ENODEV;
178 }
179
180 scb2_mtd->owner = THIS_MODULE;
181 if (scb2_fixup_mtd(scb2_mtd) < 0) {
182 mtd_device_unregister(scb2_mtd);
183 map_destroy(scb2_mtd);
184 iounmap(scb2_ioaddr);
185 if (!region_fail)
186 release_mem_region(SCB2_ADDR, SCB2_WINDOW);
187 return -ENODEV;
188 }
189
190 printk(KERN_NOTICE MODNAME ": chip size 0x%llx at offset 0x%llx\n",
191 (unsigned long long)scb2_mtd->size,
192 (unsigned long long)(SCB2_WINDOW - scb2_mtd->size));
193
194 mtd_device_register(scb2_mtd, NULL, 0);
195
196 return 0;
197}
198
199static void scb2_flash_remove(struct pci_dev *dev)
200{
201 if (!scb2_mtd)
202 return;
203
204
205 mtd_lock(scb2_mtd, 0, scb2_mtd->size);
206
207 mtd_device_unregister(scb2_mtd);
208 map_destroy(scb2_mtd);
209
210 iounmap(scb2_ioaddr);
211 scb2_ioaddr = NULL;
212
213 if (!region_fail)
214 release_mem_region(SCB2_ADDR, SCB2_WINDOW);
215 pci_set_drvdata(dev, NULL);
216}
217
218static struct pci_device_id scb2_flash_pci_ids[] = {
219 {
220 .vendor = PCI_VENDOR_ID_SERVERWORKS,
221 .device = PCI_DEVICE_ID_SERVERWORKS_CSB5,
222 .subvendor = PCI_ANY_ID,
223 .subdevice = PCI_ANY_ID
224 },
225 { 0, }
226};
227
228static struct pci_driver scb2_flash_driver = {
229 .name = "Intel SCB2 BIOS Flash",
230 .id_table = scb2_flash_pci_ids,
231 .probe = scb2_flash_probe,
232 .remove = scb2_flash_remove,
233};
234
235module_pci_driver(scb2_flash_driver);
236
237MODULE_LICENSE("GPL");
238MODULE_AUTHOR("Tim Hockin <thockin@sun.com>");
239MODULE_DESCRIPTION("MTD map driver for Intel SCB2 BIOS Flash");
240MODULE_DEVICE_TABLE(pci, scb2_flash_pci_ids);
241