1
2
3
4
5
6
7
8
9#include <linux/kernel.h>
10#include <linux/export.h>
11#include <linux/pci.h>
12#include <linux/slab.h>
13
14#include "pci.h"
15
16
17
18
19
20
21
22
23
24
25int pci_enable_rom(struct pci_dev *pdev)
26{
27 struct resource *res = pdev->resource + PCI_ROM_RESOURCE;
28 struct pci_bus_region region;
29 u32 rom_addr;
30
31 if (!res->flags)
32 return -1;
33
34 pcibios_resource_to_bus(pdev, ®ion, res);
35 pci_read_config_dword(pdev, pdev->rom_base_reg, &rom_addr);
36 rom_addr &= ~PCI_ROM_ADDRESS_MASK;
37 rom_addr |= region.start | PCI_ROM_ADDRESS_ENABLE;
38 pci_write_config_dword(pdev, pdev->rom_base_reg, rom_addr);
39 return 0;
40}
41
42
43
44
45
46
47
48
49void pci_disable_rom(struct pci_dev *pdev)
50{
51 u32 rom_addr;
52 pci_read_config_dword(pdev, pdev->rom_base_reg, &rom_addr);
53 rom_addr &= ~PCI_ROM_ADDRESS_ENABLE;
54 pci_write_config_dword(pdev, pdev->rom_base_reg, rom_addr);
55}
56
57
58
59
60
61
62
63
64
65
66
67
68size_t pci_get_rom_size(struct pci_dev *pdev, void __iomem *rom, size_t size)
69{
70 void __iomem *image;
71 int last_image;
72
73 image = rom;
74 do {
75 void __iomem *pds;
76
77 if (readb(image) != 0x55) {
78 dev_err(&pdev->dev, "Invalid ROM contents\n");
79 break;
80 }
81 if (readb(image + 1) != 0xAA)
82 break;
83
84 pds = image + readw(image + 24);
85 if (readb(pds) != 'P')
86 break;
87 if (readb(pds + 1) != 'C')
88 break;
89 if (readb(pds + 2) != 'I')
90 break;
91 if (readb(pds + 3) != 'R')
92 break;
93 last_image = readb(pds + 21) & 0x80;
94
95 image += readw(pds + 16) * 512;
96 } while (!last_image);
97
98
99
100 return min((size_t)(image - rom), size);
101}
102
103
104
105
106
107
108
109
110
111
112
113
114void __iomem *pci_map_rom(struct pci_dev *pdev, size_t *size)
115{
116 struct resource *res = &pdev->resource[PCI_ROM_RESOURCE];
117 loff_t start;
118 void __iomem *rom;
119
120
121
122
123
124
125 if (res->flags & IORESOURCE_ROM_SHADOW) {
126
127 start = (loff_t)0xC0000;
128 *size = 0x20000;
129 } else {
130 if (res->flags &
131 (IORESOURCE_ROM_COPY | IORESOURCE_ROM_BIOS_COPY)) {
132 *size = pci_resource_len(pdev, PCI_ROM_RESOURCE);
133 return (void __iomem *)(unsigned long)
134 pci_resource_start(pdev, PCI_ROM_RESOURCE);
135 } else {
136
137 if (res->parent == NULL &&
138 pci_assign_resource(pdev,PCI_ROM_RESOURCE))
139 return NULL;
140 start = pci_resource_start(pdev, PCI_ROM_RESOURCE);
141 *size = pci_resource_len(pdev, PCI_ROM_RESOURCE);
142 if (*size == 0)
143 return NULL;
144
145
146 if (pci_enable_rom(pdev))
147 return NULL;
148 }
149 }
150
151 rom = ioremap(start, *size);
152 if (!rom) {
153
154 if (!(res->flags & (IORESOURCE_ROM_ENABLE |
155 IORESOURCE_ROM_SHADOW |
156 IORESOURCE_ROM_COPY)))
157 pci_disable_rom(pdev);
158 return NULL;
159 }
160
161
162
163
164
165
166 *size = pci_get_rom_size(pdev, rom, *size);
167 return rom;
168}
169
170
171
172
173
174
175
176
177void pci_unmap_rom(struct pci_dev *pdev, void __iomem *rom)
178{
179 struct resource *res = &pdev->resource[PCI_ROM_RESOURCE];
180
181 if (res->flags & (IORESOURCE_ROM_COPY | IORESOURCE_ROM_BIOS_COPY))
182 return;
183
184 iounmap(rom);
185
186
187 if (!(res->flags & (IORESOURCE_ROM_ENABLE | IORESOURCE_ROM_SHADOW)))
188 pci_disable_rom(pdev);
189}
190
191
192
193
194
195
196
197void pci_cleanup_rom(struct pci_dev *pdev)
198{
199 struct resource *res = &pdev->resource[PCI_ROM_RESOURCE];
200 if (res->flags & IORESOURCE_ROM_COPY) {
201 kfree((void*)(unsigned long)res->start);
202 res->flags &= ~IORESOURCE_ROM_COPY;
203 res->start = 0;
204 res->end = 0;
205 }
206}
207
208
209
210
211
212
213
214void __iomem *pci_platform_rom(struct pci_dev *pdev, size_t *size)
215{
216 if (pdev->rom && pdev->romlen) {
217 *size = pdev->romlen;
218 return phys_to_virt((phys_addr_t)pdev->rom);
219 }
220
221 return NULL;
222}
223
224EXPORT_SYMBOL(pci_map_rom);
225EXPORT_SYMBOL(pci_unmap_rom);
226EXPORT_SYMBOL_GPL(pci_enable_rom);
227EXPORT_SYMBOL_GPL(pci_disable_rom);
228EXPORT_SYMBOL(pci_platform_rom);
229