Linux 4.1.16
[linux/fpc-iii.git] / drivers / mtd / maps / pci.c
blobeb0242e0b2d9903df922f811e41b9584a39cb212
1 /*
2 * linux/drivers/mtd/maps/pci.c
4 * Copyright (C) 2001 Russell King, All rights reserved.
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License version 2 as
8 * published by the Free Software Foundation.
10 * Generic PCI memory map driver. We support the following boards:
11 * - Intel IQ80310 ATU.
12 * - Intel EBSA285 (blank rom programming mode). Tested working 27/09/2001
14 #include <linux/module.h>
15 #include <linux/kernel.h>
16 #include <linux/pci.h>
17 #include <linux/slab.h>
19 #include <linux/mtd/mtd.h>
20 #include <linux/mtd/map.h>
21 #include <linux/mtd/partitions.h>
23 struct map_pci_info;
25 struct mtd_pci_info {
26 int (*init)(struct pci_dev *dev, struct map_pci_info *map);
27 void (*exit)(struct pci_dev *dev, struct map_pci_info *map);
28 unsigned long (*translate)(struct map_pci_info *map, unsigned long ofs);
29 const char *map_name;
32 struct map_pci_info {
33 struct map_info map;
34 void __iomem *base;
35 void (*exit)(struct pci_dev *dev, struct map_pci_info *map);
36 unsigned long (*translate)(struct map_pci_info *map, unsigned long ofs);
37 struct pci_dev *dev;
40 static map_word mtd_pci_read8(struct map_info *_map, unsigned long ofs)
42 struct map_pci_info *map = (struct map_pci_info *)_map;
43 map_word val;
44 val.x[0]= readb(map->base + map->translate(map, ofs));
45 return val;
48 static map_word mtd_pci_read32(struct map_info *_map, unsigned long ofs)
50 struct map_pci_info *map = (struct map_pci_info *)_map;
51 map_word val;
52 val.x[0] = readl(map->base + map->translate(map, ofs));
53 return val;
56 static void mtd_pci_copyfrom(struct map_info *_map, void *to, unsigned long from, ssize_t len)
58 struct map_pci_info *map = (struct map_pci_info *)_map;
59 memcpy_fromio(to, map->base + map->translate(map, from), len);
62 static void mtd_pci_write8(struct map_info *_map, map_word val, unsigned long ofs)
64 struct map_pci_info *map = (struct map_pci_info *)_map;
65 writeb(val.x[0], map->base + map->translate(map, ofs));
68 static void mtd_pci_write32(struct map_info *_map, map_word val, unsigned long ofs)
70 struct map_pci_info *map = (struct map_pci_info *)_map;
71 writel(val.x[0], map->base + map->translate(map, ofs));
74 static void mtd_pci_copyto(struct map_info *_map, unsigned long to, const void *from, ssize_t len)
76 struct map_pci_info *map = (struct map_pci_info *)_map;
77 memcpy_toio(map->base + map->translate(map, to), from, len);
80 static const struct map_info mtd_pci_map = {
81 .phys = NO_XIP,
82 .copy_from = mtd_pci_copyfrom,
83 .copy_to = mtd_pci_copyto,
87 * Intel IOP80310 Flash driver
90 static int
91 intel_iq80310_init(struct pci_dev *dev, struct map_pci_info *map)
93 u32 win_base;
95 map->map.bankwidth = 1;
96 map->map.read = mtd_pci_read8,
97 map->map.write = mtd_pci_write8,
99 map->map.size = 0x00800000;
100 map->base = ioremap_nocache(pci_resource_start(dev, 0),
101 pci_resource_len(dev, 0));
103 if (!map->base)
104 return -ENOMEM;
107 * We want to base the memory window at Xscale
108 * bus address 0, not 0x1000.
110 pci_read_config_dword(dev, 0x44, &win_base);
111 pci_write_config_dword(dev, 0x44, 0);
113 map->map.map_priv_2 = win_base;
115 return 0;
118 static void
119 intel_iq80310_exit(struct pci_dev *dev, struct map_pci_info *map)
121 if (map->base)
122 iounmap(map->base);
123 pci_write_config_dword(dev, 0x44, map->map.map_priv_2);
126 static unsigned long
127 intel_iq80310_translate(struct map_pci_info *map, unsigned long ofs)
129 unsigned long page_addr = ofs & 0x00400000;
132 * This mundges the flash location so we avoid
133 * the first 80 bytes (they appear to read nonsense).
135 if (page_addr) {
136 writel(0x00000008, map->base + 0x1558);
137 writel(0x00000000, map->base + 0x1550);
138 } else {
139 writel(0x00000007, map->base + 0x1558);
140 writel(0x00800000, map->base + 0x1550);
141 ofs += 0x00800000;
144 return ofs;
147 static struct mtd_pci_info intel_iq80310_info = {
148 .init = intel_iq80310_init,
149 .exit = intel_iq80310_exit,
150 .translate = intel_iq80310_translate,
151 .map_name = "cfi_probe",
155 * Intel DC21285 driver
158 static int
159 intel_dc21285_init(struct pci_dev *dev, struct map_pci_info *map)
161 unsigned long base, len;
163 base = pci_resource_start(dev, PCI_ROM_RESOURCE);
164 len = pci_resource_len(dev, PCI_ROM_RESOURCE);
166 if (!len || !base) {
168 * No ROM resource
170 base = pci_resource_start(dev, 2);
171 len = pci_resource_len(dev, 2);
174 * We need to re-allocate PCI BAR2 address range to the
175 * PCI ROM BAR, and disable PCI BAR2.
177 } else {
179 * Hmm, if an address was allocated to the ROM resource, but
180 * not enabled, should we be allocating a new resource for it
181 * or simply enabling it?
183 pci_enable_rom(dev);
184 printk("%s: enabling expansion ROM\n", pci_name(dev));
187 if (!len || !base)
188 return -ENXIO;
190 map->map.bankwidth = 4;
191 map->map.read = mtd_pci_read32,
192 map->map.write = mtd_pci_write32,
193 map->map.size = len;
194 map->base = ioremap_nocache(base, len);
196 if (!map->base)
197 return -ENOMEM;
199 return 0;
202 static void
203 intel_dc21285_exit(struct pci_dev *dev, struct map_pci_info *map)
205 if (map->base)
206 iounmap(map->base);
209 * We need to undo the PCI BAR2/PCI ROM BAR address alteration.
211 pci_disable_rom(dev);
214 static unsigned long
215 intel_dc21285_translate(struct map_pci_info *map, unsigned long ofs)
217 return ofs & 0x00ffffc0 ? ofs : (ofs ^ (1 << 5));
220 static struct mtd_pci_info intel_dc21285_info = {
221 .init = intel_dc21285_init,
222 .exit = intel_dc21285_exit,
223 .translate = intel_dc21285_translate,
224 .map_name = "jedec_probe",
228 * PCI device ID table
231 static struct pci_device_id mtd_pci_ids[] = {
233 .vendor = PCI_VENDOR_ID_INTEL,
234 .device = 0x530d,
235 .subvendor = PCI_ANY_ID,
236 .subdevice = PCI_ANY_ID,
237 .class = PCI_CLASS_MEMORY_OTHER << 8,
238 .class_mask = 0xffff00,
239 .driver_data = (unsigned long)&intel_iq80310_info,
242 .vendor = PCI_VENDOR_ID_DEC,
243 .device = PCI_DEVICE_ID_DEC_21285,
244 .subvendor = 0, /* DC21285 defaults to 0 on reset */
245 .subdevice = 0, /* DC21285 defaults to 0 on reset */
246 .driver_data = (unsigned long)&intel_dc21285_info,
248 { 0, }
252 * Generic code follows.
255 static int mtd_pci_probe(struct pci_dev *dev, const struct pci_device_id *id)
257 struct mtd_pci_info *info = (struct mtd_pci_info *)id->driver_data;
258 struct map_pci_info *map = NULL;
259 struct mtd_info *mtd = NULL;
260 int err;
262 err = pci_enable_device(dev);
263 if (err)
264 goto out;
266 err = pci_request_regions(dev, "pci mtd");
267 if (err)
268 goto out;
270 map = kmalloc(sizeof(*map), GFP_KERNEL);
271 err = -ENOMEM;
272 if (!map)
273 goto release;
275 map->map = mtd_pci_map;
276 map->map.name = pci_name(dev);
277 map->dev = dev;
278 map->exit = info->exit;
279 map->translate = info->translate;
281 err = info->init(dev, map);
282 if (err)
283 goto release;
285 mtd = do_map_probe(info->map_name, &map->map);
286 err = -ENODEV;
287 if (!mtd)
288 goto release;
290 mtd->owner = THIS_MODULE;
291 mtd_device_register(mtd, NULL, 0);
293 pci_set_drvdata(dev, mtd);
295 return 0;
297 release:
298 if (map) {
299 map->exit(dev, map);
300 kfree(map);
303 pci_release_regions(dev);
304 out:
305 return err;
308 static void mtd_pci_remove(struct pci_dev *dev)
310 struct mtd_info *mtd = pci_get_drvdata(dev);
311 struct map_pci_info *map = mtd->priv;
313 mtd_device_unregister(mtd);
314 map_destroy(mtd);
315 map->exit(dev, map);
316 kfree(map);
318 pci_release_regions(dev);
321 static struct pci_driver mtd_pci_driver = {
322 .name = "MTD PCI",
323 .probe = mtd_pci_probe,
324 .remove = mtd_pci_remove,
325 .id_table = mtd_pci_ids,
328 module_pci_driver(mtd_pci_driver);
330 MODULE_LICENSE("GPL");
331 MODULE_AUTHOR("Russell King <rmk@arm.linux.org.uk>");
332 MODULE_DESCRIPTION("Generic PCI map driver");
333 MODULE_DEVICE_TABLE(pci, mtd_pci_ids);