?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
x86/speculation/mds: Fix documentation typo
[linux/fpc-iii.git] / arch / s390 / pci / pci.c
blob960c4a362d8cdeb525bf020729cd8007bfa836ec
1 /*
2 * Copyright IBM Corp. 2012
3 *
4 * Author(s):
5 * Jan Glauber <jang@linux.vnet.ibm.com>
6 *
7 * The System z PCI code is a rewrite from a prototype by
8 * the following people (Kudoz!):
9 * Alexander Schmidt
10 * Christoph Raisch
11 * Hannes Hering
12 * Hoang-Nam Nguyen
13 * Jan-Bernd Themann
14 * Stefan Roscher
15 * Thomas Klein
16 */
17
18 #define KMSG_COMPONENT "zpci"
19 #define pr_fmt(fmt) KMSG_COMPONENT ": " fmt
20
21 #include <linux/kernel.h>
22 #include <linux/slab.h>
23 #include <linux/err.h>
24 #include <linux/export.h>
25 #include <linux/delay.h>
26 #include <linux/irq.h>
27 #include <linux/kernel_stat.h>
28 #include <linux/seq_file.h>
29 #include <linux/pci.h>
30 #include <linux/msi.h>
31
32 #include <asm/isc.h>
33 #include <asm/airq.h>
34 #include <asm/facility.h>
35 #include <asm/pci_insn.h>
36 #include <asm/pci_clp.h>
37 #include <asm/pci_dma.h>
38
39 #define DEBUG /* enable pr_debug */
40
41 #define SIC_IRQ_MODE_ALL 0
42 #define SIC_IRQ_MODE_SINGLE 1
43
44 #define ZPCI_NR_DMA_SPACES 1
45 #define ZPCI_NR_DEVICES CONFIG_PCI_NR_FUNCTIONS
46
47 /* list of all detected zpci devices */
48 static LIST_HEAD(zpci_list);
49 static DEFINE_SPINLOCK(zpci_list_lock);
50
51 static struct irq_chip zpci_irq_chip = {
52 .name = "zPCI",
53 .irq_unmask = pci_msi_unmask_irq,
54 .irq_mask = pci_msi_mask_irq,
55 };
56
57 static DECLARE_BITMAP(zpci_domain, ZPCI_NR_DEVICES);
58 static DEFINE_SPINLOCK(zpci_domain_lock);
59
60 static struct airq_iv *zpci_aisb_iv;
61 static struct airq_iv *zpci_aibv[ZPCI_NR_DEVICES];
62
63 #define ZPCI_IOMAP_ENTRIES \
64 min(((unsigned long) ZPCI_NR_DEVICES * PCI_BAR_COUNT / 2), \
65 ZPCI_IOMAP_MAX_ENTRIES)
66
67 static DEFINE_SPINLOCK(zpci_iomap_lock);
68 static unsigned long *zpci_iomap_bitmap;
69 struct zpci_iomap_entry *zpci_iomap_start;
70 EXPORT_SYMBOL_GPL(zpci_iomap_start);
71
72 static struct kmem_cache *zdev_fmb_cache;
73
74 struct zpci_dev *get_zdev_by_fid(u32 fid)
75 {
76 struct zpci_dev *tmp, *zdev = NULL;
77
78 spin_lock(&zpci_list_lock);
79 list_for_each_entry(tmp, &zpci_list, entry) {
80 if (tmp->fid == fid) {
81 zdev = tmp;
82 break;
83 }
84 }
85 spin_unlock(&zpci_list_lock);
86 return zdev;
87 }
88
89 void zpci_remove_reserved_devices(void)
90 {
91 struct zpci_dev *tmp, *zdev;
92 enum zpci_state state;
93 LIST_HEAD(remove);
94
95 spin_lock(&zpci_list_lock);
96 list_for_each_entry_safe(zdev, tmp, &zpci_list, entry) {
97 if (zdev->state == ZPCI_FN_STATE_STANDBY &&
98 !clp_get_state(zdev->fid, &state) &&
99 state == ZPCI_FN_STATE_RESERVED)
100 list_move_tail(&zdev->entry, &remove);
101 }
102 spin_unlock(&zpci_list_lock);
103
104 list_for_each_entry_safe(zdev, tmp, &remove, entry)
105 zpci_remove_device(zdev);
106 }
107
108 static struct zpci_dev *get_zdev_by_bus(struct pci_bus *bus)
109 {
110 return (bus && bus->sysdata) ? (struct zpci_dev *) bus->sysdata : NULL;
111 }
112
113 int pci_domain_nr(struct pci_bus *bus)
114 {
115 return ((struct zpci_dev *) bus->sysdata)->domain;
116 }
117 EXPORT_SYMBOL_GPL(pci_domain_nr);
118
119 int pci_proc_domain(struct pci_bus *bus)
120 {
121 return pci_domain_nr(bus);
122 }
123 EXPORT_SYMBOL_GPL(pci_proc_domain);
124
125 /* Modify PCI: Register adapter interruptions */
126 static int zpci_set_airq(struct zpci_dev *zdev)
127 {
128 u64 req = ZPCI_CREATE_REQ(zdev->fh, 0, ZPCI_MOD_FC_REG_INT);
129 struct zpci_fib fib = {0};
130 u8 status;
131
132 fib.isc = PCI_ISC;
133 fib.sum = 1; /* enable summary notifications */
134 fib.noi = airq_iv_end(zdev->aibv);
135 fib.aibv = (unsigned long) zdev->aibv->vector;
136 fib.aibvo = 0; /* each zdev has its own interrupt vector */
137 fib.aisb = (unsigned long) zpci_aisb_iv->vector + (zdev->aisb/64)*8;
138 fib.aisbo = zdev->aisb & 63;
139
140 return zpci_mod_fc(req, &fib, &status) ? -EIO : 0;
141 }
142
143 /* Modify PCI: Unregister adapter interruptions */
144 static int zpci_clear_airq(struct zpci_dev *zdev)
145 {
146 u64 req = ZPCI_CREATE_REQ(zdev->fh, 0, ZPCI_MOD_FC_DEREG_INT);
147 struct zpci_fib fib = {0};
148 u8 cc, status;
149
150 cc = zpci_mod_fc(req, &fib, &status);
151 if (cc == 3 || (cc == 1 && status == 24))
152 /* Function already gone or IRQs already deregistered. */
153 cc = 0;
154
155 return cc ? -EIO : 0;
156 }
157
158 /* Modify PCI: Register I/O address translation parameters */
159 int zpci_register_ioat(struct zpci_dev *zdev, u8 dmaas,
160 u64 base, u64 limit, u64 iota)
161 {
162 u64 req = ZPCI_CREATE_REQ(zdev->fh, dmaas, ZPCI_MOD_FC_REG_IOAT);
163 struct zpci_fib fib = {0};
164 u8 status;
165
166 WARN_ON_ONCE(iota & 0x3fff);
167 fib.pba = base;
168 fib.pal = limit;
169 fib.iota = iota | ZPCI_IOTA_RTTO_FLAG;
170 return zpci_mod_fc(req, &fib, &status) ? -EIO : 0;
171 }
172
173 /* Modify PCI: Unregister I/O address translation parameters */
174 int zpci_unregister_ioat(struct zpci_dev *zdev, u8 dmaas)
175 {
176 u64 req = ZPCI_CREATE_REQ(zdev->fh, dmaas, ZPCI_MOD_FC_DEREG_IOAT);
177 struct zpci_fib fib = {0};
178 u8 cc, status;
179
180 cc = zpci_mod_fc(req, &fib, &status);
181 if (cc == 3) /* Function already gone. */
182 cc = 0;
183 return cc ? -EIO : 0;
184 }
185
186 /* Modify PCI: Set PCI function measurement parameters */
187 int zpci_fmb_enable_device(struct zpci_dev *zdev)
188 {
189 u64 req = ZPCI_CREATE_REQ(zdev->fh, 0, ZPCI_MOD_FC_SET_MEASURE);
190 struct zpci_fib fib = {0};
191 u8 cc, status;
192
193 if (zdev->fmb || sizeof(*zdev->fmb) < zdev->fmb_length)
194 return -EINVAL;
195
196 zdev->fmb = kmem_cache_zalloc(zdev_fmb_cache, GFP_KERNEL);
197 if (!zdev->fmb)
198 return -ENOMEM;
199 WARN_ON((u64) zdev->fmb & 0xf);
200
201 /* reset software counters */
202 atomic64_set(&zdev->allocated_pages, 0);
203 atomic64_set(&zdev->mapped_pages, 0);
204 atomic64_set(&zdev->unmapped_pages, 0);
205
206 fib.fmb_addr = virt_to_phys(zdev->fmb);
207 cc = zpci_mod_fc(req, &fib, &status);
208 if (cc) {
209 kmem_cache_free(zdev_fmb_cache, zdev->fmb);
210 zdev->fmb = NULL;
211 }
212 return cc ? -EIO : 0;
213 }
214
215 /* Modify PCI: Disable PCI function measurement */
216 int zpci_fmb_disable_device(struct zpci_dev *zdev)
217 {
218 u64 req = ZPCI_CREATE_REQ(zdev->fh, 0, ZPCI_MOD_FC_SET_MEASURE);
219 struct zpci_fib fib = {0};
220 u8 cc, status;
221
222 if (!zdev->fmb)
223 return -EINVAL;
224
225 /* Function measurement is disabled if fmb address is zero */
226 cc = zpci_mod_fc(req, &fib, &status);
227 if (cc == 3) /* Function already gone. */
228 cc = 0;
229
230 if (!cc) {
231 kmem_cache_free(zdev_fmb_cache, zdev->fmb);
232 zdev->fmb = NULL;
233 }
234 return cc ? -EIO : 0;
235 }
236
237 static int zpci_cfg_load(struct zpci_dev *zdev, int offset, u32 *val, u8 len)
238 {
239 u64 req = ZPCI_CREATE_REQ(zdev->fh, ZPCI_PCIAS_CFGSPC, len);
240 u64 data;
241 int rc;
242
243 rc = zpci_load(&data, req, offset);
244 if (!rc) {
245 data = le64_to_cpu((__force __le64) data);
246 data >>= (8 - len) * 8;
247 *val = (u32) data;
248 } else
249 *val = 0xffffffff;
250 return rc;
251 }
252
253 static int zpci_cfg_store(struct zpci_dev *zdev, int offset, u32 val, u8 len)
254 {
255 u64 req = ZPCI_CREATE_REQ(zdev->fh, ZPCI_PCIAS_CFGSPC, len);
256 u64 data = val;
257 int rc;
258
259 data <<= (8 - len) * 8;
260 data = (__force u64) cpu_to_le64(data);
261 rc = zpci_store(data, req, offset);
262 return rc;
263 }
264
265 resource_size_t pcibios_align_resource(void *data, const struct resource *res,
266 resource_size_t size,
267 resource_size_t align)
268 {
269 return 0;
270 }
271
272 /* combine single writes by using store-block insn */
273 void __iowrite64_copy(void __iomem *to, const void *from, size_t count)
274 {
275 zpci_memcpy_toio(to, from, count);
276 }
277
278 /* Create a virtual mapping cookie for a PCI BAR */
279 void __iomem *pci_iomap_range(struct pci_dev *pdev,
280 int bar,
281 unsigned long offset,
282 unsigned long max)
283 {
284 struct zpci_dev *zdev = to_zpci(pdev);
285 int idx;
286
287 if (!pci_resource_len(pdev, bar))
288 return NULL;
289
290 idx = zdev->bars[bar].map_idx;
291 spin_lock(&zpci_iomap_lock);
292 /* Detect overrun */
293 WARN_ON(!++zpci_iomap_start[idx].count);
294 zpci_iomap_start[idx].fh = zdev->fh;
295 zpci_iomap_start[idx].bar = bar;
296 spin_unlock(&zpci_iomap_lock);
297
298 return (void __iomem *) ZPCI_ADDR(idx) + offset;
299 }
300 EXPORT_SYMBOL(pci_iomap_range);
301
302 void __iomem *pci_iomap(struct pci_dev *dev, int bar, unsigned long maxlen)
303 {
304 return pci_iomap_range(dev, bar, 0, maxlen);
305 }
306 EXPORT_SYMBOL(pci_iomap);
307
308 void pci_iounmap(struct pci_dev *pdev, void __iomem *addr)
309 {
310 unsigned int idx = ZPCI_IDX(addr);
311
312 spin_lock(&zpci_iomap_lock);
313 /* Detect underrun */
314 WARN_ON(!zpci_iomap_start[idx].count);
315 if (!--zpci_iomap_start[idx].count) {
316 zpci_iomap_start[idx].fh = 0;
317 zpci_iomap_start[idx].bar = 0;
318 }
319 spin_unlock(&zpci_iomap_lock);
320 }
321 EXPORT_SYMBOL(pci_iounmap);
322
323 static int pci_read(struct pci_bus *bus, unsigned int devfn, int where,
324 int size, u32 *val)
325 {
326 struct zpci_dev *zdev = get_zdev_by_bus(bus);
327 int ret;
328
329 if (!zdev || devfn != ZPCI_DEVFN)
330 ret = -ENODEV;
331 else
332 ret = zpci_cfg_load(zdev, where, val, size);
333
334 return ret;
335 }
336
337 static int pci_write(struct pci_bus *bus, unsigned int devfn, int where,
338 int size, u32 val)
339 {
340 struct zpci_dev *zdev = get_zdev_by_bus(bus);
341 int ret;
342
343 if (!zdev || devfn != ZPCI_DEVFN)
344 ret = -ENODEV;
345 else
346 ret = zpci_cfg_store(zdev, where, val, size);
347
348 return ret;
349 }
350
351 static struct pci_ops pci_root_ops = {
352 .read = pci_read,
353 .write = pci_write,
354 };
355
356 static void zpci_irq_handler(struct airq_struct *airq)
357 {
358 unsigned long si, ai;
359 struct airq_iv *aibv;
360 int irqs_on = 0;
361
362 inc_irq_stat(IRQIO_PCI);
363 for (si = 0;;) {
364 /* Scan adapter summary indicator bit vector */
365 si = airq_iv_scan(zpci_aisb_iv, si, airq_iv_end(zpci_aisb_iv));
366 if (si == -1UL) {
367 if (irqs_on++)
368 /* End of second scan with interrupts on. */
369 break;
370 /* First scan complete, reenable interrupts. */
371 if (zpci_set_irq_ctrl(SIC_IRQ_MODE_SINGLE, NULL, PCI_ISC))
372 break;
373 si = 0;
374 continue;
375 }
376
377 /* Scan the adapter interrupt vector for this device. */
378 aibv = zpci_aibv[si];
379 for (ai = 0;;) {
380 ai = airq_iv_scan(aibv, ai, airq_iv_end(aibv));
381 if (ai == -1UL)
382 break;
383 inc_irq_stat(IRQIO_MSI);
384 airq_iv_lock(aibv, ai);
385 generic_handle_irq(airq_iv_get_data(aibv, ai));
386 airq_iv_unlock(aibv, ai);
387 }
388 }
389 }
390
391 int arch_setup_msi_irqs(struct pci_dev *pdev, int nvec, int type)
392 {
393 struct zpci_dev *zdev = to_zpci(pdev);
394 unsigned int hwirq, msi_vecs;
395 unsigned long aisb;
396 struct msi_desc *msi;
397 struct msi_msg msg;
398 int rc, irq;
399
400 zdev->aisb = -1UL;
401 if (type == PCI_CAP_ID_MSI && nvec > 1)
402 return 1;
403 msi_vecs = min_t(unsigned int, nvec, zdev->max_msi);
404
405 /* Allocate adapter summary indicator bit */
406 aisb = airq_iv_alloc_bit(zpci_aisb_iv);
407 if (aisb == -1UL)
408 return -EIO;
409 zdev->aisb = aisb;
410
411 /* Create adapter interrupt vector */
412 zdev->aibv = airq_iv_create(msi_vecs, AIRQ_IV_DATA | AIRQ_IV_BITLOCK);
413 if (!zdev->aibv)
414 return -ENOMEM;
415
416 /* Wire up shortcut pointer */
417 zpci_aibv[aisb] = zdev->aibv;
418
419 /* Request MSI interrupts */
420 hwirq = 0;
421 for_each_pci_msi_entry(msi, pdev) {
422 rc = -EIO;
423 if (hwirq >= msi_vecs)
424 break;
425 irq = irq_alloc_desc(0); /* Alloc irq on node 0 */
426 if (irq < 0)
427 return -ENOMEM;
428 rc = irq_set_msi_desc(irq, msi);
429 if (rc)
430 return rc;
431 irq_set_chip_and_handler(irq, &zpci_irq_chip,
432 handle_simple_irq);
433 msg.data = hwirq;
434 msg.address_lo = zdev->msi_addr & 0xffffffff;
435 msg.address_hi = zdev->msi_addr >> 32;
436 pci_write_msi_msg(irq, &msg);
437 airq_iv_set_data(zdev->aibv, hwirq, irq);
438 hwirq++;
439 }
440
441 /* Enable adapter interrupts */
442 rc = zpci_set_airq(zdev);
443 if (rc)
444 return rc;
445
446 return (msi_vecs == nvec) ? 0 : msi_vecs;
447 }
448
449 void arch_teardown_msi_irqs(struct pci_dev *pdev)
450 {
451 struct zpci_dev *zdev = to_zpci(pdev);
452 struct msi_desc *msi;
453 int rc;
454
455 /* Disable adapter interrupts */
456 rc = zpci_clear_airq(zdev);
457 if (rc)
458 return;
459
460 /* Release MSI interrupts */
461 for_each_pci_msi_entry(msi, pdev) {
462 if (!msi->irq)
463 continue;
464 if (msi->msi_attrib.is_msix)
465 __pci_msix_desc_mask_irq(msi, 1);
466 else
467 __pci_msi_desc_mask_irq(msi, 1, 1);
468 irq_set_msi_desc(msi->irq, NULL);
469 irq_free_desc(msi->irq);
470 msi->msg.address_lo = 0;
471 msi->msg.address_hi = 0;
472 msi->msg.data = 0;
473 msi->irq = 0;
474 }
475
476 if (zdev->aisb != -1UL) {
477 zpci_aibv[zdev->aisb] = NULL;
478 airq_iv_free_bit(zpci_aisb_iv, zdev->aisb);
479 zdev->aisb = -1UL;
480 }
481 if (zdev->aibv) {
482 airq_iv_release(zdev->aibv);
483 zdev->aibv = NULL;
484 }
485 }
486
487 static void zpci_map_resources(struct pci_dev *pdev)
488 {
489 resource_size_t len;
490 int i;
491
492 for (i = 0; i < PCI_BAR_COUNT; i++) {
493 len = pci_resource_len(pdev, i);
494 if (!len)
495 continue;
496 pdev->resource[i].start =
497 (resource_size_t __force) pci_iomap(pdev, i, 0);
498 pdev->resource[i].end = pdev->resource[i].start + len - 1;
499 }
500 }
501
502 static void zpci_unmap_resources(struct pci_dev *pdev)
503 {
504 resource_size_t len;
505 int i;
506
507 for (i = 0; i < PCI_BAR_COUNT; i++) {
508 len = pci_resource_len(pdev, i);
509 if (!len)
510 continue;
511 pci_iounmap(pdev, (void __iomem __force *)
512 pdev->resource[i].start);
513 }
514 }
515
516 static struct airq_struct zpci_airq = {
517 .handler = zpci_irq_handler,
518 .isc = PCI_ISC,
519 };
520
521 static int __init zpci_irq_init(void)
522 {
523 int rc;
524
525 rc = register_adapter_interrupt(&zpci_airq);
526 if (rc)
527 goto out;
528 /* Set summary to 1 to be called every time for the ISC. */
529 *zpci_airq.lsi_ptr = 1;
530
531 rc = -ENOMEM;
532 zpci_aisb_iv = airq_iv_create(ZPCI_NR_DEVICES, AIRQ_IV_ALLOC);
533 if (!zpci_aisb_iv)
534 goto out_airq;
535
536 zpci_set_irq_ctrl(SIC_IRQ_MODE_SINGLE, NULL, PCI_ISC);
537 return 0;
538
539 out_airq:
540 unregister_adapter_interrupt(&zpci_airq);
541 out:
542 return rc;
543 }
544
545 static void zpci_irq_exit(void)
546 {
547 airq_iv_release(zpci_aisb_iv);
548 unregister_adapter_interrupt(&zpci_airq);
549 }
550
551 static int zpci_alloc_iomap(struct zpci_dev *zdev)
552 {
553 unsigned long entry;
554
555 spin_lock(&zpci_iomap_lock);
556 entry = find_first_zero_bit(zpci_iomap_bitmap, ZPCI_IOMAP_ENTRIES);
557 if (entry == ZPCI_IOMAP_ENTRIES) {
558 spin_unlock(&zpci_iomap_lock);
559 return -ENOSPC;
560 }
561 set_bit(entry, zpci_iomap_bitmap);
562 spin_unlock(&zpci_iomap_lock);
563 return entry;
564 }
565
566 static void zpci_free_iomap(struct zpci_dev *zdev, int entry)
567 {
568 spin_lock(&zpci_iomap_lock);
569 memset(&zpci_iomap_start[entry], 0, sizeof(struct zpci_iomap_entry));
570 clear_bit(entry, zpci_iomap_bitmap);
571 spin_unlock(&zpci_iomap_lock);
572 }
573
574 static struct resource *__alloc_res(struct zpci_dev *zdev, unsigned long start,
575 unsigned long size, unsigned long flags)
576 {
577 struct resource *r;
578
579 r = kzalloc(sizeof(*r), GFP_KERNEL);
580 if (!r)
581 return NULL;
582
583 r->start = start;
584 r->end = r->start + size - 1;
585 r->flags = flags;
586 r->name = zdev->res_name;
587
588 if (request_resource(&iomem_resource, r)) {
589 kfree(r);
590 return NULL;
591 }
592 return r;
593 }
594
595 static int zpci_setup_bus_resources(struct zpci_dev *zdev,
596 struct list_head *resources)
597 {
598 unsigned long addr, size, flags;
599 struct resource *res;
600 int i, entry;
601
602 snprintf(zdev->res_name, sizeof(zdev->res_name),
603 "PCI Bus %04x:%02x", zdev->domain, ZPCI_BUS_NR);
604
605 for (i = 0; i < PCI_BAR_COUNT; i++) {
606 if (!zdev->bars[i].size)
607 continue;
608 entry = zpci_alloc_iomap(zdev);
609 if (entry < 0)
610 return entry;
611 zdev->bars[i].map_idx = entry;
612
613 /* only MMIO is supported */
614 flags = IORESOURCE_MEM;
615 if (zdev->bars[i].val & 8)
616 flags |= IORESOURCE_PREFETCH;
617 if (zdev->bars[i].val & 4)
618 flags |= IORESOURCE_MEM_64;
619
620 addr = ZPCI_ADDR(entry);
621 size = 1UL << zdev->bars[i].size;
622
623 res = __alloc_res(zdev, addr, size, flags);
624 if (!res) {
625 zpci_free_iomap(zdev, entry);
626 return -ENOMEM;
627 }
628 zdev->bars[i].res = res;
629 pci_add_resource(resources, res);
630 }
631
632 return 0;
633 }
634
635 static void zpci_cleanup_bus_resources(struct zpci_dev *zdev)
636 {
637 int i;
638
639 for (i = 0; i < PCI_BAR_COUNT; i++) {
640 if (!zdev->bars[i].size || !zdev->bars[i].res)
641 continue;
642
643 zpci_free_iomap(zdev, zdev->bars[i].map_idx);
644 release_resource(zdev->bars[i].res);
645 kfree(zdev->bars[i].res);
646 }
647 }
648
649 int pcibios_add_device(struct pci_dev *pdev)
650 {
651 struct resource *res;
652 int i;
653
654 pdev->dev.groups = zpci_attr_groups;
655 pdev->dev.dma_ops = &s390_pci_dma_ops;
656 zpci_map_resources(pdev);
657
658 for (i = 0; i < PCI_BAR_COUNT; i++) {
659 res = &pdev->resource[i];
660 if (res->parent || !res->flags)
661 continue;
662 pci_claim_resource(pdev, i);
663 }
664
665 return 0;
666 }
667
668 void pcibios_release_device(struct pci_dev *pdev)
669 {
670 zpci_unmap_resources(pdev);
671 }
672
673 int pcibios_enable_device(struct pci_dev *pdev, int mask)
674 {
675 struct zpci_dev *zdev = to_zpci(pdev);
676
677 zpci_debug_init_device(zdev, dev_name(&pdev->dev));
678 zpci_fmb_enable_device(zdev);
679
680 return pci_enable_resources(pdev, mask);
681 }
682
683 void pcibios_disable_device(struct pci_dev *pdev)
684 {
685 struct zpci_dev *zdev = to_zpci(pdev);
686
687 zpci_fmb_disable_device(zdev);
688 zpci_debug_exit_device(zdev);
689 }
690
691 #ifdef CONFIG_HIBERNATE_CALLBACKS
692 static int zpci_restore(struct device *dev)
693 {
694 struct pci_dev *pdev = to_pci_dev(dev);
695 struct zpci_dev *zdev = to_zpci(pdev);
696 int ret = 0;
697
698 if (zdev->state != ZPCI_FN_STATE_ONLINE)
699 goto out;
700
701 ret = clp_enable_fh(zdev, ZPCI_NR_DMA_SPACES);
702 if (ret)
703 goto out;
704
705 zpci_map_resources(pdev);
706 zpci_register_ioat(zdev, 0, zdev->start_dma, zdev->end_dma,
707 (u64) zdev->dma_table);
708
709 out:
710 return ret;
711 }
712
713 static int zpci_freeze(struct device *dev)
714 {
715 struct pci_dev *pdev = to_pci_dev(dev);
716 struct zpci_dev *zdev = to_zpci(pdev);
717
718 if (zdev->state != ZPCI_FN_STATE_ONLINE)
719 return 0;
720
721 zpci_unregister_ioat(zdev, 0);
722 zpci_unmap_resources(pdev);
723 return clp_disable_fh(zdev);
724 }
725
726 struct dev_pm_ops pcibios_pm_ops = {
727 .thaw_noirq = zpci_restore,
728 .freeze_noirq = zpci_freeze,
729 .restore_noirq = zpci_restore,
730 .poweroff_noirq = zpci_freeze,
731 };
732 #endif /* CONFIG_HIBERNATE_CALLBACKS */
733
734 static int zpci_alloc_domain(struct zpci_dev *zdev)
735 {
736 if (zpci_unique_uid) {
737 zdev->domain = (u16) zdev->uid;
738 if (zdev->domain >= ZPCI_NR_DEVICES)
739 return 0;
740
741 spin_lock(&zpci_domain_lock);
742 if (test_bit(zdev->domain, zpci_domain)) {
743 spin_unlock(&zpci_domain_lock);
744 return -EEXIST;
745 }
746 set_bit(zdev->domain, zpci_domain);
747 spin_unlock(&zpci_domain_lock);
748 return 0;
749 }
750
751 spin_lock(&zpci_domain_lock);
752 zdev->domain = find_first_zero_bit(zpci_domain, ZPCI_NR_DEVICES);
753 if (zdev->domain == ZPCI_NR_DEVICES) {
754 spin_unlock(&zpci_domain_lock);
755 return -ENOSPC;
756 }
757 set_bit(zdev->domain, zpci_domain);
758 spin_unlock(&zpci_domain_lock);
759 return 0;
760 }
761
762 static void zpci_free_domain(struct zpci_dev *zdev)
763 {
764 if (zdev->domain >= ZPCI_NR_DEVICES)
765 return;
766
767 spin_lock(&zpci_domain_lock);
768 clear_bit(zdev->domain, zpci_domain);
769 spin_unlock(&zpci_domain_lock);
770 }
771
772 void pcibios_remove_bus(struct pci_bus *bus)
773 {
774 struct zpci_dev *zdev = get_zdev_by_bus(bus);
775
776 zpci_exit_slot(zdev);
777 zpci_cleanup_bus_resources(zdev);
778 zpci_destroy_iommu(zdev);
779 zpci_free_domain(zdev);
780
781 spin_lock(&zpci_list_lock);
782 list_del(&zdev->entry);
783 spin_unlock(&zpci_list_lock);
784
785 zpci_dbg(3, "rem fid:%x\n", zdev->fid);
786 kfree(zdev);
787 }
788
789 static int zpci_scan_bus(struct zpci_dev *zdev)
790 {
791 LIST_HEAD(resources);
792 int ret;
793
794 ret = zpci_setup_bus_resources(zdev, &resources);
795 if (ret)
796 goto error;
797
798 zdev->bus = pci_scan_root_bus(NULL, ZPCI_BUS_NR, &pci_root_ops,
799 zdev, &resources);
800 if (!zdev->bus) {
801 ret = -EIO;
802 goto error;
803 }
804 zdev->bus->max_bus_speed = zdev->max_bus_speed;
805 pci_bus_add_devices(zdev->bus);
806 return 0;
807
808 error:
809 zpci_cleanup_bus_resources(zdev);
810 pci_free_resource_list(&resources);
811 return ret;
812 }
813
814 int zpci_enable_device(struct zpci_dev *zdev)
815 {
816 int rc;
817
818 rc = clp_enable_fh(zdev, ZPCI_NR_DMA_SPACES);
819 if (rc)
820 goto out;
821
822 rc = zpci_dma_init_device(zdev);
823 if (rc)
824 goto out_dma;
825
826 zdev->state = ZPCI_FN_STATE_ONLINE;
827 return 0;
828
829 out_dma:
830 clp_disable_fh(zdev);
831 out:
832 return rc;
833 }
834 EXPORT_SYMBOL_GPL(zpci_enable_device);
835
836 int zpci_disable_device(struct zpci_dev *zdev)
837 {
838 zpci_dma_exit_device(zdev);
839 return clp_disable_fh(zdev);
840 }
841 EXPORT_SYMBOL_GPL(zpci_disable_device);
842
843 int zpci_create_device(struct zpci_dev *zdev)
844 {
845 int rc;
846
847 rc = zpci_alloc_domain(zdev);
848 if (rc)
849 goto out;
850
851 rc = zpci_init_iommu(zdev);
852 if (rc)
853 goto out_free;
854
855 mutex_init(&zdev->lock);
856 if (zdev->state == ZPCI_FN_STATE_CONFIGURED) {
857 rc = zpci_enable_device(zdev);
858 if (rc)
859 goto out_destroy_iommu;
860 }
861 rc = zpci_scan_bus(zdev);
862 if (rc)
863 goto out_disable;
864
865 spin_lock(&zpci_list_lock);
866 list_add_tail(&zdev->entry, &zpci_list);
867 spin_unlock(&zpci_list_lock);
868
869 zpci_init_slot(zdev);
870
871 return 0;
872
873 out_disable:
874 if (zdev->state == ZPCI_FN_STATE_ONLINE)
875 zpci_disable_device(zdev);
876 out_destroy_iommu:
877 zpci_destroy_iommu(zdev);
878 out_free:
879 zpci_free_domain(zdev);
880 out:
881 return rc;
882 }
883
884 void zpci_remove_device(struct zpci_dev *zdev)
885 {
886 if (!zdev->bus)
887 return;
888
889 pci_stop_root_bus(zdev->bus);
890 pci_remove_root_bus(zdev->bus);
891 }
892
893 int zpci_report_error(struct pci_dev *pdev,
894 struct zpci_report_error_header *report)
895 {
896 struct zpci_dev *zdev = to_zpci(pdev);
897
898 return sclp_pci_report(report, zdev->fh, zdev->fid);
899 }
900 EXPORT_SYMBOL(zpci_report_error);
901
902 static int zpci_mem_init(void)
903 {
904 BUILD_BUG_ON(!is_power_of_2(__alignof__(struct zpci_fmb)) ||
905 __alignof__(struct zpci_fmb) < sizeof(struct zpci_fmb));
906
907 zdev_fmb_cache = kmem_cache_create("PCI_FMB_cache", sizeof(struct zpci_fmb),
908 __alignof__(struct zpci_fmb), 0, NULL);
909 if (!zdev_fmb_cache)
910 goto error_fmb;
911
912 zpci_iomap_start = kcalloc(ZPCI_IOMAP_ENTRIES,
913 sizeof(*zpci_iomap_start), GFP_KERNEL);
914 if (!zpci_iomap_start)
915 goto error_iomap;
916
917 zpci_iomap_bitmap = kcalloc(BITS_TO_LONGS(ZPCI_IOMAP_ENTRIES),
918 sizeof(*zpci_iomap_bitmap), GFP_KERNEL);
919 if (!zpci_iomap_bitmap)
920 goto error_iomap_bitmap;
921
922 return 0;
923 error_iomap_bitmap:
924 kfree(zpci_iomap_start);
925 error_iomap:
926 kmem_cache_destroy(zdev_fmb_cache);
927 error_fmb:
928 return -ENOMEM;
929 }
930
931 static void zpci_mem_exit(void)
932 {
933 kfree(zpci_iomap_bitmap);
934 kfree(zpci_iomap_start);
935 kmem_cache_destroy(zdev_fmb_cache);
936 }
937
938 static unsigned int s390_pci_probe = 1;
939 static unsigned int s390_pci_initialized;
940
941 char * __init pcibios_setup(char *str)
942 {
943 if (!strcmp(str, "off")) {
944 s390_pci_probe = 0;
945 return NULL;
946 }
947 return str;
948 }
949
950 bool zpci_is_enabled(void)
951 {
952 return s390_pci_initialized;
953 }
954
955 static int __init pci_base_init(void)
956 {
957 int rc;
958
959 if (!s390_pci_probe)
960 return 0;
961
962 if (!test_facility(69) || !test_facility(71))
963 return 0;
964
965 rc = zpci_debug_init();
966 if (rc)
967 goto out;
968
969 rc = zpci_mem_init();
970 if (rc)
971 goto out_mem;
972
973 rc = zpci_irq_init();
974 if (rc)
975 goto out_irq;
976
977 rc = zpci_dma_init();
978 if (rc)
979 goto out_dma;
980
981 rc = clp_scan_pci_devices();
982 if (rc)
983 goto out_find;
984
985 s390_pci_initialized = 1;
986 return 0;
987
988 out_find:
989 zpci_dma_exit();
990 out_dma:
991 zpci_irq_exit();
992 out_irq:
993 zpci_mem_exit();
994 out_mem:
995 zpci_debug_exit();
996 out:
997 return rc;
998 }
999 subsys_initcall_sync(pci_base_init);
1000
1001 void zpci_rescan(void)
1002 {
1003 if (zpci_is_enabled())
1004 clp_rescan_pci_devices_simple();
1005 }
Linux with added FPC-III support