This source file includes following definitions.
- fixed_bar_cap
- pci_device_update_fixed
- type1_access_ok
- pci_read
- pci_write
- intel_mid_pci_irq_enable
- intel_mid_pci_irq_disable
- intel_mid_pci_init
- pci_d3delay_fixup
- mid_power_off_one_device
- mid_power_off_devices
- pci_fixed_bar_fixup
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22 #include <linux/sched.h>
23 #include <linux/pci.h>
24 #include <linux/ioport.h>
25 #include <linux/init.h>
26 #include <linux/dmi.h>
27 #include <linux/acpi.h>
28 #include <linux/io.h>
29 #include <linux/smp.h>
30
31 #include <asm/segment.h>
32 #include <asm/pci_x86.h>
33 #include <asm/hw_irq.h>
34 #include <asm/io_apic.h>
35 #include <asm/intel-mid.h>
36
37 #define PCIE_CAP_OFFSET 0x100
38
39
40 #define PCI_DEVICE_ID_INTEL_MRFLD_MMC 0x1190
41 #define PCI_DEVICE_ID_INTEL_MRFLD_HSU 0x1191
42
43
44 #define PCIE_VNDR_CAP_ID_FIXED_BAR 0x00
45 #define PCI_FIXED_BAR_0_SIZE 0x04
46 #define PCI_FIXED_BAR_1_SIZE 0x08
47 #define PCI_FIXED_BAR_2_SIZE 0x0c
48 #define PCI_FIXED_BAR_3_SIZE 0x10
49 #define PCI_FIXED_BAR_4_SIZE 0x14
50 #define PCI_FIXED_BAR_5_SIZE 0x1c
51
52 static int pci_soc_mode;
53
54
55
56
57
58
59
60
61
62 static int fixed_bar_cap(struct pci_bus *bus, unsigned int devfn)
63 {
64 int pos;
65 u32 pcie_cap = 0, cap_data;
66
67 pos = PCIE_CAP_OFFSET;
68
69 if (!raw_pci_ext_ops)
70 return 0;
71
72 while (pos) {
73 if (raw_pci_ext_ops->read(pci_domain_nr(bus), bus->number,
74 devfn, pos, 4, &pcie_cap))
75 return 0;
76
77 if (PCI_EXT_CAP_ID(pcie_cap) == 0x0000 ||
78 PCI_EXT_CAP_ID(pcie_cap) == 0xffff)
79 break;
80
81 if (PCI_EXT_CAP_ID(pcie_cap) == PCI_EXT_CAP_ID_VNDR) {
82 raw_pci_ext_ops->read(pci_domain_nr(bus), bus->number,
83 devfn, pos + 4, 4, &cap_data);
84 if ((cap_data & 0xffff) == PCIE_VNDR_CAP_ID_FIXED_BAR)
85 return pos;
86 }
87
88 pos = PCI_EXT_CAP_NEXT(pcie_cap);
89 }
90
91 return 0;
92 }
93
94 static int pci_device_update_fixed(struct pci_bus *bus, unsigned int devfn,
95 int reg, int len, u32 val, int offset)
96 {
97 u32 size;
98 unsigned int domain, busnum;
99 int bar = (reg - PCI_BASE_ADDRESS_0) >> 2;
100
101 domain = pci_domain_nr(bus);
102 busnum = bus->number;
103
104 if (val == ~0 && len == 4) {
105 unsigned long decode;
106
107 raw_pci_ext_ops->read(domain, busnum, devfn,
108 offset + 8 + (bar * 4), 4, &size);
109
110
111 if (size) {
112 decode = size - 1;
113 decode |= decode >> 1;
114 decode |= decode >> 2;
115 decode |= decode >> 4;
116 decode |= decode >> 8;
117 decode |= decode >> 16;
118 decode++;
119 decode = ~(decode - 1);
120 } else {
121 decode = 0;
122 }
123
124
125
126
127
128
129
130 return raw_pci_ext_ops->write(domain, busnum, devfn, reg, 4,
131 decode);
132 }
133
134
135 return raw_pci_ext_ops->write(domain, busnum, devfn, reg, len, val);
136 }
137
138
139
140
141
142
143
144
145
146
147
148 static bool type1_access_ok(unsigned int bus, unsigned int devfn, int reg)
149 {
150
151
152
153
154
155
156
157
158 if (reg >= 0x100 || reg == PCI_STATUS || reg == PCI_HEADER_TYPE)
159 return false;
160 if (bus == 0 && (devfn == PCI_DEVFN(2, 0)
161 || devfn == PCI_DEVFN(0, 0)
162 || devfn == PCI_DEVFN(3, 0)))
163 return true;
164 return false;
165 }
166
167 static int pci_read(struct pci_bus *bus, unsigned int devfn, int where,
168 int size, u32 *value)
169 {
170 if (type1_access_ok(bus->number, devfn, where))
171 return pci_direct_conf1.read(pci_domain_nr(bus), bus->number,
172 devfn, where, size, value);
173 return raw_pci_ext_ops->read(pci_domain_nr(bus), bus->number,
174 devfn, where, size, value);
175 }
176
177 static int pci_write(struct pci_bus *bus, unsigned int devfn, int where,
178 int size, u32 value)
179 {
180 int offset;
181
182
183
184
185
186 if (where == PCI_ROM_ADDRESS)
187 return 0;
188
189
190
191
192
193
194
195 offset = fixed_bar_cap(bus, devfn);
196 if (offset &&
197 (where >= PCI_BASE_ADDRESS_0 && where <= PCI_BASE_ADDRESS_5)) {
198 return pci_device_update_fixed(bus, devfn, where, size, value,
199 offset);
200 }
201
202
203
204
205
206
207 if (type1_access_ok(bus->number, devfn, where))
208 return pci_direct_conf1.write(pci_domain_nr(bus), bus->number,
209 devfn, where, size, value);
210 return raw_pci_ext_ops->write(pci_domain_nr(bus), bus->number, devfn,
211 where, size, value);
212 }
213
214 static int intel_mid_pci_irq_enable(struct pci_dev *dev)
215 {
216 struct irq_alloc_info info;
217 int polarity;
218 int ret;
219 u8 gsi;
220
221 if (dev->irq_managed && dev->irq > 0)
222 return 0;
223
224 ret = pci_read_config_byte(dev, PCI_INTERRUPT_LINE, &gsi);
225 if (ret < 0) {
226 dev_warn(&dev->dev, "Failed to read interrupt line: %d\n", ret);
227 return ret;
228 }
229
230 switch (intel_mid_identify_cpu()) {
231 case INTEL_MID_CPU_CHIP_TANGIER:
232 polarity = IOAPIC_POL_HIGH;
233
234
235 if (gsi == 0) {
236
237
238
239
240 if (dev->device == PCI_DEVICE_ID_INTEL_MRFLD_HSU)
241 return -EBUSY;
242
243
244
245
246
247
248
249 if (dev->device != PCI_DEVICE_ID_INTEL_MRFLD_MMC)
250 return 0;
251 }
252 break;
253 default:
254 polarity = IOAPIC_POL_LOW;
255 break;
256 }
257
258 ioapic_set_alloc_attr(&info, dev_to_node(&dev->dev), 1, polarity);
259
260
261
262
263
264 ret = mp_map_gsi_to_irq(gsi, IOAPIC_MAP_ALLOC, &info);
265 if (ret < 0)
266 return ret;
267
268 dev->irq = ret;
269 dev->irq_managed = 1;
270
271 return 0;
272 }
273
274 static void intel_mid_pci_irq_disable(struct pci_dev *dev)
275 {
276 if (!mp_should_keep_irq(&dev->dev) && dev->irq_managed &&
277 dev->irq > 0) {
278 mp_unmap_irq(dev->irq);
279 dev->irq_managed = 0;
280 }
281 }
282
283 static const struct pci_ops intel_mid_pci_ops __initconst = {
284 .read = pci_read,
285 .write = pci_write,
286 };
287
288
289
290
291
292
293
294 int __init intel_mid_pci_init(void)
295 {
296 pr_info("Intel MID platform detected, using MID PCI ops\n");
297 pci_mmcfg_late_init();
298 pcibios_enable_irq = intel_mid_pci_irq_enable;
299 pcibios_disable_irq = intel_mid_pci_irq_disable;
300 pci_root_ops = intel_mid_pci_ops;
301 pci_soc_mode = 1;
302
303 acpi_noirq_set();
304 return 1;
305 }
306
307
308
309
310
311 static void pci_d3delay_fixup(struct pci_dev *dev)
312 {
313
314
315
316
317 if (!pci_soc_mode)
318 return;
319
320
321
322
323 if (type1_access_ok(dev->bus->number, dev->devfn, PCI_DEVICE_ID))
324 return;
325 dev->d3_delay = 0;
326 }
327 DECLARE_PCI_FIXUP_FINAL(PCI_VENDOR_ID_INTEL, PCI_ANY_ID, pci_d3delay_fixup);
328
329 static void mid_power_off_one_device(struct pci_dev *dev)
330 {
331 u16 pmcsr;
332
333
334
335
336
337 pci_read_config_word(dev, dev->pm_cap + PCI_PM_CTRL, &pmcsr);
338 dev->current_state = (pci_power_t __force)(pmcsr & PCI_PM_CTRL_STATE_MASK);
339
340 pci_set_power_state(dev, PCI_D3hot);
341 }
342
343 static void mid_power_off_devices(struct pci_dev *dev)
344 {
345 int id;
346
347 if (!pci_soc_mode)
348 return;
349
350 id = intel_mid_pwr_get_lss_id(dev);
351 if (id < 0)
352 return;
353
354
355
356
357
358 mid_power_off_one_device(dev);
359 }
360
361 DECLARE_PCI_FIXUP_FINAL(PCI_VENDOR_ID_INTEL, PCI_ANY_ID, mid_power_off_devices);
362
363
364
365
366 static void pci_fixed_bar_fixup(struct pci_dev *dev)
367 {
368 unsigned long offset;
369 u32 size;
370 int i;
371
372 if (!pci_soc_mode)
373 return;
374
375
376 if (dev->cfg_size < PCIE_CAP_OFFSET + 4)
377 return;
378
379
380 offset = fixed_bar_cap(dev->bus, dev->devfn);
381 if (!offset || PCI_DEVFN(2, 0) == dev->devfn ||
382 PCI_DEVFN(2, 2) == dev->devfn)
383 return;
384
385 for (i = 0; i < PCI_ROM_RESOURCE; i++) {
386 pci_read_config_dword(dev, offset + 8 + (i * 4), &size);
387 dev->resource[i].end = dev->resource[i].start + size - 1;
388 dev->resource[i].flags |= IORESOURCE_PCI_FIXED;
389 }
390 }
391 DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_INTEL, PCI_ANY_ID, pci_fixed_bar_fixup);