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