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