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 if (pdev->rom && pdev->romlen) {
124 *size = pdev->romlen;
125 return phys_to_virt(pdev->rom);
126
127
128
129
130
131 } else if (res->flags & IORESOURCE_ROM_SHADOW) {
132
133 start = (loff_t)0xC0000;
134 *size = 0x20000;
135 } else {
136 if (res->flags &
137 (IORESOURCE_ROM_COPY | IORESOURCE_ROM_BIOS_COPY)) {
138 *size = pci_resource_len(pdev, PCI_ROM_RESOURCE);
139 return (void __iomem *)(unsigned long)
140 pci_resource_start(pdev, PCI_ROM_RESOURCE);
141 } else {
142
143 if (res->parent == NULL &&
144 pci_assign_resource(pdev,PCI_ROM_RESOURCE))
145 return NULL;
146 start = pci_resource_start(pdev, PCI_ROM_RESOURCE);
147 *size = pci_resource_len(pdev, PCI_ROM_RESOURCE);
148 if (*size == 0)
149 return NULL;
150
151
152 if (pci_enable_rom(pdev))
153 return NULL;
154 }
155 }
156
157 rom = ioremap(start, *size);
158 if (!rom) {
159
160 if (!(res->flags & (IORESOURCE_ROM_ENABLE |
161 IORESOURCE_ROM_SHADOW |
162 IORESOURCE_ROM_COPY)))
163 pci_disable_rom(pdev);
164 return NULL;
165 }
166
167
168
169
170
171
172 *size = pci_get_rom_size(pdev, rom, *size);
173 return rom;
174}
175
176
177
178
179
180
181
182
183void pci_unmap_rom(struct pci_dev *pdev, void __iomem *rom)
184{
185 struct resource *res = &pdev->resource[PCI_ROM_RESOURCE];
186
187 if (res->flags & (IORESOURCE_ROM_COPY | IORESOURCE_ROM_BIOS_COPY))
188 return;
189
190 if (!pdev->rom || !pdev->romlen)
191 iounmap(rom);
192
193
194 if (!(res->flags & (IORESOURCE_ROM_ENABLE | IORESOURCE_ROM_SHADOW)))
195 pci_disable_rom(pdev);
196}
197
198
199
200
201
202
203
204void pci_cleanup_rom(struct pci_dev *pdev)
205{
206 struct resource *res = &pdev->resource[PCI_ROM_RESOURCE];
207 if (res->flags & IORESOURCE_ROM_COPY) {
208 kfree((void*)(unsigned long)res->start);
209 res->flags &= ~IORESOURCE_ROM_COPY;
210 res->start = 0;
211 res->end = 0;
212 }
213}
214
215EXPORT_SYMBOL(pci_map_rom);
216EXPORT_SYMBOL(pci_unmap_rom);
217EXPORT_SYMBOL_GPL(pci_enable_rom);
218EXPORT_SYMBOL_GPL(pci_disable_rom);
219