2 * Copyright IBM Corp. 2012
5 * Jan Glauber <jang@linux.vnet.ibm.com>
7 * The System z PCI code is a rewrite from a prototype by
8 * the following people (Kudoz!):
18 #define KMSG_COMPONENT "zpci"
19 #define pr_fmt(fmt) KMSG_COMPONENT ": " fmt
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>
34 #include <asm/facility.h>
35 #include <asm/pci_insn.h>
36 #include <asm/pci_clp.h>
37 #include <asm/pci_dma.h>
39 #define DEBUG /* enable pr_debug */
41 #define SIC_IRQ_MODE_ALL 0
42 #define SIC_IRQ_MODE_SINGLE 1
44 #define ZPCI_NR_DMA_SPACES 1
45 #define ZPCI_NR_DEVICES CONFIG_PCI_NR_FUNCTIONS
47 /* list of all detected zpci devices */
48 static LIST_HEAD(zpci_list);
49 static DEFINE_SPINLOCK(zpci_list_lock);
51 static struct irq_chip zpci_irq_chip = {
53 .irq_unmask = pci_msi_unmask_irq,
54 .irq_mask = pci_msi_mask_irq,
57 static DECLARE_BITMAP(zpci_domain, ZPCI_NR_DEVICES);
58 static DEFINE_SPINLOCK(zpci_domain_lock);
60 static struct airq_iv *zpci_aisb_iv;
61 static struct airq_iv *zpci_aibv[ZPCI_NR_DEVICES];
63 /* Adapter interrupt definitions */
64 static void zpci_irq_handler(struct airq_struct *airq);
66 static struct airq_struct zpci_airq = {
67 .handler = zpci_irq_handler,
72 static DEFINE_SPINLOCK(zpci_iomap_lock);
73 static DECLARE_BITMAP(zpci_iomap, ZPCI_IOMAP_MAX_ENTRIES);
74 struct zpci_iomap_entry *zpci_iomap_start;
75 EXPORT_SYMBOL_GPL(zpci_iomap_start);
77 static struct kmem_cache *zdev_fmb_cache;
79 struct zpci_dev *get_zdev_by_fid(u32 fid)
81 struct zpci_dev *tmp, *zdev = NULL;
83 spin_lock(&zpci_list_lock);
84 list_for_each_entry(tmp, &zpci_list, entry) {
85 if (tmp->fid == fid) {
90 spin_unlock(&zpci_list_lock);
94 static struct zpci_dev *get_zdev_by_bus(struct pci_bus *bus)
96 return (bus && bus->sysdata) ? (struct zpci_dev *) bus->sysdata : NULL;
99 int pci_domain_nr(struct pci_bus *bus)
101 return ((struct zpci_dev *) bus->sysdata)->domain;
103 EXPORT_SYMBOL_GPL(pci_domain_nr);
105 int pci_proc_domain(struct pci_bus *bus)
107 return pci_domain_nr(bus);
109 EXPORT_SYMBOL_GPL(pci_proc_domain);
111 /* Modify PCI: Register adapter interruptions */
112 static int zpci_set_airq(struct zpci_dev *zdev)
114 u64 req = ZPCI_CREATE_REQ(zdev->fh, 0, ZPCI_MOD_FC_REG_INT);
115 struct zpci_fib fib = {0};
118 fib.sum = 1; /* enable summary notifications */
119 fib.noi = airq_iv_end(zdev->aibv);
120 fib.aibv = (unsigned long) zdev->aibv->vector;
121 fib.aibvo = 0; /* each zdev has its own interrupt vector */
122 fib.aisb = (unsigned long) zpci_aisb_iv->vector + (zdev->aisb/64)*8;
123 fib.aisbo = zdev->aisb & 63;
125 return zpci_mod_fc(req, &fib);
128 struct mod_pci_args {
135 static int mod_pci(struct zpci_dev *zdev, int fn, u8 dmaas, struct mod_pci_args *args)
137 u64 req = ZPCI_CREATE_REQ(zdev->fh, dmaas, fn);
138 struct zpci_fib fib = {0};
140 fib.pba = args->base;
141 fib.pal = args->limit;
142 fib.iota = args->iota;
143 fib.fmb_addr = args->fmb_addr;
145 return zpci_mod_fc(req, &fib);
148 /* Modify PCI: Register I/O address translation parameters */
149 int zpci_register_ioat(struct zpci_dev *zdev, u8 dmaas,
150 u64 base, u64 limit, u64 iota)
152 struct mod_pci_args args = { base, limit, iota, 0 };
154 WARN_ON_ONCE(iota & 0x3fff);
155 args.iota |= ZPCI_IOTA_RTTO_FLAG;
156 return mod_pci(zdev, ZPCI_MOD_FC_REG_IOAT, dmaas, &args);
159 /* Modify PCI: Unregister I/O address translation parameters */
160 int zpci_unregister_ioat(struct zpci_dev *zdev, u8 dmaas)
162 struct mod_pci_args args = { 0, 0, 0, 0 };
164 return mod_pci(zdev, ZPCI_MOD_FC_DEREG_IOAT, dmaas, &args);
167 /* Modify PCI: Unregister adapter interruptions */
168 static int zpci_clear_airq(struct zpci_dev *zdev)
170 struct mod_pci_args args = { 0, 0, 0, 0 };
172 return mod_pci(zdev, ZPCI_MOD_FC_DEREG_INT, 0, &args);
175 /* Modify PCI: Set PCI function measurement parameters */
176 int zpci_fmb_enable_device(struct zpci_dev *zdev)
178 struct mod_pci_args args = { 0, 0, 0, 0 };
183 zdev->fmb = kmem_cache_zalloc(zdev_fmb_cache, GFP_KERNEL);
186 WARN_ON((u64) zdev->fmb & 0xf);
188 /* reset software counters */
189 atomic64_set(&zdev->allocated_pages, 0);
190 atomic64_set(&zdev->mapped_pages, 0);
191 atomic64_set(&zdev->unmapped_pages, 0);
193 args.fmb_addr = virt_to_phys(zdev->fmb);
194 return mod_pci(zdev, ZPCI_MOD_FC_SET_MEASURE, 0, &args);
197 /* Modify PCI: Disable PCI function measurement */
198 int zpci_fmb_disable_device(struct zpci_dev *zdev)
200 struct mod_pci_args args = { 0, 0, 0, 0 };
206 /* Function measurement is disabled if fmb address is zero */
207 rc = mod_pci(zdev, ZPCI_MOD_FC_SET_MEASURE, 0, &args);
209 kmem_cache_free(zdev_fmb_cache, zdev->fmb);
214 #define ZPCI_PCIAS_CFGSPC 15
216 static int zpci_cfg_load(struct zpci_dev *zdev, int offset, u32 *val, u8 len)
218 u64 req = ZPCI_CREATE_REQ(zdev->fh, ZPCI_PCIAS_CFGSPC, len);
222 rc = zpci_load(&data, req, offset);
224 data = data << ((8 - len) * 8);
225 data = le64_to_cpu(data);
232 static int zpci_cfg_store(struct zpci_dev *zdev, int offset, u32 val, u8 len)
234 u64 req = ZPCI_CREATE_REQ(zdev->fh, ZPCI_PCIAS_CFGSPC, len);
238 data = cpu_to_le64(data);
239 data = data >> ((8 - len) * 8);
240 rc = zpci_store(data, req, offset);
244 void pcibios_fixup_bus(struct pci_bus *bus)
248 resource_size_t pcibios_align_resource(void *data, const struct resource *res,
249 resource_size_t size,
250 resource_size_t align)
255 /* combine single writes by using store-block insn */
256 void __iowrite64_copy(void __iomem *to, const void *from, size_t count)
258 zpci_memcpy_toio(to, from, count);
261 /* Create a virtual mapping cookie for a PCI BAR */
262 void __iomem *pci_iomap_range(struct pci_dev *pdev,
264 unsigned long offset,
267 struct zpci_dev *zdev = to_zpci(pdev);
270 if ((bar & 7) != bar)
273 idx = zdev->bars[bar].map_idx;
274 spin_lock(&zpci_iomap_lock);
275 if (zpci_iomap_start[idx].count++) {
276 BUG_ON(zpci_iomap_start[idx].fh != zdev->fh ||
277 zpci_iomap_start[idx].bar != bar);
279 zpci_iomap_start[idx].fh = zdev->fh;
280 zpci_iomap_start[idx].bar = bar;
283 BUG_ON(!zpci_iomap_start[idx].count);
284 spin_unlock(&zpci_iomap_lock);
286 return (void __iomem *) ZPCI_ADDR(idx) + offset;
288 EXPORT_SYMBOL(pci_iomap_range);
290 void __iomem *pci_iomap(struct pci_dev *dev, int bar, unsigned long maxlen)
292 return pci_iomap_range(dev, bar, 0, maxlen);
294 EXPORT_SYMBOL(pci_iomap);
296 void pci_iounmap(struct pci_dev *pdev, void __iomem *addr)
298 unsigned int idx = ZPCI_IDX(addr);
300 spin_lock(&zpci_iomap_lock);
301 /* Detect underrun */
302 BUG_ON(!zpci_iomap_start[idx].count);
303 if (!--zpci_iomap_start[idx].count) {
304 zpci_iomap_start[idx].fh = 0;
305 zpci_iomap_start[idx].bar = 0;
307 spin_unlock(&zpci_iomap_lock);
309 EXPORT_SYMBOL(pci_iounmap);
311 static int pci_read(struct pci_bus *bus, unsigned int devfn, int where,
314 struct zpci_dev *zdev = get_zdev_by_bus(bus);
317 if (!zdev || devfn != ZPCI_DEVFN)
320 ret = zpci_cfg_load(zdev, where, val, size);
325 static int pci_write(struct pci_bus *bus, unsigned int devfn, int where,
328 struct zpci_dev *zdev = get_zdev_by_bus(bus);
331 if (!zdev || devfn != ZPCI_DEVFN)
334 ret = zpci_cfg_store(zdev, where, val, size);
339 static struct pci_ops pci_root_ops = {
344 static void zpci_irq_handler(struct airq_struct *airq)
346 unsigned long si, ai;
347 struct airq_iv *aibv;
350 inc_irq_stat(IRQIO_PCI);
352 /* Scan adapter summary indicator bit vector */
353 si = airq_iv_scan(zpci_aisb_iv, si, airq_iv_end(zpci_aisb_iv));
356 /* End of second scan with interrupts on. */
358 /* First scan complete, reenable interrupts. */
359 zpci_set_irq_ctrl(SIC_IRQ_MODE_SINGLE, NULL, PCI_ISC);
364 /* Scan the adapter interrupt vector for this device. */
365 aibv = zpci_aibv[si];
367 ai = airq_iv_scan(aibv, ai, airq_iv_end(aibv));
370 inc_irq_stat(IRQIO_MSI);
371 airq_iv_lock(aibv, ai);
372 generic_handle_irq(airq_iv_get_data(aibv, ai));
373 airq_iv_unlock(aibv, ai);
378 int arch_setup_msi_irqs(struct pci_dev *pdev, int nvec, int type)
380 struct zpci_dev *zdev = to_zpci(pdev);
381 unsigned int hwirq, msi_vecs;
383 struct msi_desc *msi;
387 if (type == PCI_CAP_ID_MSI && nvec > 1)
389 msi_vecs = min_t(unsigned int, nvec, zdev->max_msi);
391 /* Allocate adapter summary indicator bit */
393 aisb = airq_iv_alloc_bit(zpci_aisb_iv);
398 /* Create adapter interrupt vector */
400 zdev->aibv = airq_iv_create(msi_vecs, AIRQ_IV_DATA | AIRQ_IV_BITLOCK);
404 /* Wire up shortcut pointer */
405 zpci_aibv[aisb] = zdev->aibv;
407 /* Request MSI interrupts */
409 for_each_pci_msi_entry(msi, pdev) {
411 irq = irq_alloc_desc(0); /* Alloc irq on node 0 */
414 rc = irq_set_msi_desc(irq, msi);
417 irq_set_chip_and_handler(irq, &zpci_irq_chip,
420 msg.address_lo = zdev->msi_addr & 0xffffffff;
421 msg.address_hi = zdev->msi_addr >> 32;
422 pci_write_msi_msg(irq, &msg);
423 airq_iv_set_data(zdev->aibv, hwirq, irq);
427 /* Enable adapter interrupts */
428 rc = zpci_set_airq(zdev);
432 return (msi_vecs == nvec) ? 0 : msi_vecs;
435 for_each_pci_msi_entry(msi, pdev) {
438 irq_set_msi_desc(msi->irq, NULL);
439 irq_free_desc(msi->irq);
440 msi->msg.address_lo = 0;
441 msi->msg.address_hi = 0;
445 zpci_aibv[aisb] = NULL;
446 airq_iv_release(zdev->aibv);
448 airq_iv_free_bit(zpci_aisb_iv, aisb);
453 void arch_teardown_msi_irqs(struct pci_dev *pdev)
455 struct zpci_dev *zdev = to_zpci(pdev);
456 struct msi_desc *msi;
459 /* Disable adapter interrupts */
460 rc = zpci_clear_airq(zdev);
464 /* Release MSI interrupts */
465 for_each_pci_msi_entry(msi, pdev) {
466 if (msi->msi_attrib.is_msix)
467 __pci_msix_desc_mask_irq(msi, 1);
469 __pci_msi_desc_mask_irq(msi, 1, 1);
470 irq_set_msi_desc(msi->irq, NULL);
471 irq_free_desc(msi->irq);
472 msi->msg.address_lo = 0;
473 msi->msg.address_hi = 0;
478 zpci_aibv[zdev->aisb] = NULL;
479 airq_iv_release(zdev->aibv);
480 airq_iv_free_bit(zpci_aisb_iv, zdev->aisb);
483 static void zpci_map_resources(struct pci_dev *pdev)
488 for (i = 0; i < PCI_BAR_COUNT; i++) {
489 len = pci_resource_len(pdev, i);
492 pdev->resource[i].start =
493 (resource_size_t __force) pci_iomap(pdev, i, 0);
494 pdev->resource[i].end = pdev->resource[i].start + len - 1;
498 static void zpci_unmap_resources(struct pci_dev *pdev)
503 for (i = 0; i < PCI_BAR_COUNT; i++) {
504 len = pci_resource_len(pdev, i);
507 pci_iounmap(pdev, (void __iomem __force *)
508 pdev->resource[i].start);
512 static int __init zpci_irq_init(void)
516 rc = register_adapter_interrupt(&zpci_airq);
519 /* Set summary to 1 to be called every time for the ISC. */
520 *zpci_airq.lsi_ptr = 1;
523 zpci_aisb_iv = airq_iv_create(ZPCI_NR_DEVICES, AIRQ_IV_ALLOC);
527 zpci_set_irq_ctrl(SIC_IRQ_MODE_SINGLE, NULL, PCI_ISC);
531 unregister_adapter_interrupt(&zpci_airq);
536 static void zpci_irq_exit(void)
538 airq_iv_release(zpci_aisb_iv);
539 unregister_adapter_interrupt(&zpci_airq);
542 static int zpci_alloc_iomap(struct zpci_dev *zdev)
546 spin_lock(&zpci_iomap_lock);
547 entry = find_first_zero_bit(zpci_iomap, ZPCI_IOMAP_MAX_ENTRIES);
548 if (entry == ZPCI_IOMAP_MAX_ENTRIES) {
549 spin_unlock(&zpci_iomap_lock);
552 set_bit(entry, zpci_iomap);
553 spin_unlock(&zpci_iomap_lock);
557 static void zpci_free_iomap(struct zpci_dev *zdev, int entry)
559 spin_lock(&zpci_iomap_lock);
560 memset(&zpci_iomap_start[entry], 0, sizeof(struct zpci_iomap_entry));
561 clear_bit(entry, zpci_iomap);
562 spin_unlock(&zpci_iomap_lock);
565 static struct resource *__alloc_res(struct zpci_dev *zdev, unsigned long start,
566 unsigned long size, unsigned long flags)
570 r = kzalloc(sizeof(*r), GFP_KERNEL);
575 r->end = r->start + size - 1;
577 r->name = zdev->res_name;
579 if (request_resource(&iomem_resource, r)) {
586 static int zpci_setup_bus_resources(struct zpci_dev *zdev,
587 struct list_head *resources)
589 unsigned long addr, size, flags;
590 struct resource *res;
593 snprintf(zdev->res_name, sizeof(zdev->res_name),
594 "PCI Bus %04x:%02x", zdev->domain, ZPCI_BUS_NR);
596 for (i = 0; i < PCI_BAR_COUNT; i++) {
597 if (!zdev->bars[i].size)
599 entry = zpci_alloc_iomap(zdev);
602 zdev->bars[i].map_idx = entry;
604 /* only MMIO is supported */
605 flags = IORESOURCE_MEM;
606 if (zdev->bars[i].val & 8)
607 flags |= IORESOURCE_PREFETCH;
608 if (zdev->bars[i].val & 4)
609 flags |= IORESOURCE_MEM_64;
611 addr = ZPCI_ADDR(entry);
612 size = 1UL << zdev->bars[i].size;
614 res = __alloc_res(zdev, addr, size, flags);
616 zpci_free_iomap(zdev, entry);
619 zdev->bars[i].res = res;
620 pci_add_resource(resources, res);
626 static void zpci_cleanup_bus_resources(struct zpci_dev *zdev)
630 for (i = 0; i < PCI_BAR_COUNT; i++) {
631 if (!zdev->bars[i].size || !zdev->bars[i].res)
634 zpci_free_iomap(zdev, zdev->bars[i].map_idx);
635 release_resource(zdev->bars[i].res);
636 kfree(zdev->bars[i].res);
640 int pcibios_add_device(struct pci_dev *pdev)
642 struct zpci_dev *zdev = to_zpci(pdev);
643 struct resource *res;
647 pdev->dev.groups = zpci_attr_groups;
648 zpci_map_resources(pdev);
650 for (i = 0; i < PCI_BAR_COUNT; i++) {
651 res = &pdev->resource[i];
652 if (res->parent || !res->flags)
654 pci_claim_resource(pdev, i);
660 void pcibios_release_device(struct pci_dev *pdev)
662 zpci_unmap_resources(pdev);
665 int pcibios_enable_device(struct pci_dev *pdev, int mask)
667 struct zpci_dev *zdev = to_zpci(pdev);
670 zpci_debug_init_device(zdev);
671 zpci_fmb_enable_device(zdev);
673 return pci_enable_resources(pdev, mask);
676 void pcibios_disable_device(struct pci_dev *pdev)
678 struct zpci_dev *zdev = to_zpci(pdev);
680 zpci_fmb_disable_device(zdev);
681 zpci_debug_exit_device(zdev);
685 #ifdef CONFIG_HIBERNATE_CALLBACKS
686 static int zpci_restore(struct device *dev)
688 struct pci_dev *pdev = to_pci_dev(dev);
689 struct zpci_dev *zdev = to_zpci(pdev);
692 if (zdev->state != ZPCI_FN_STATE_ONLINE)
695 ret = clp_enable_fh(zdev, ZPCI_NR_DMA_SPACES);
699 zpci_map_resources(pdev);
700 zpci_register_ioat(zdev, 0, zdev->start_dma, zdev->end_dma,
701 (u64) zdev->dma_table);
707 static int zpci_freeze(struct device *dev)
709 struct pci_dev *pdev = to_pci_dev(dev);
710 struct zpci_dev *zdev = to_zpci(pdev);
712 if (zdev->state != ZPCI_FN_STATE_ONLINE)
715 zpci_unregister_ioat(zdev, 0);
716 zpci_unmap_resources(pdev);
717 return clp_disable_fh(zdev);
720 struct dev_pm_ops pcibios_pm_ops = {
721 .thaw_noirq = zpci_restore,
722 .freeze_noirq = zpci_freeze,
723 .restore_noirq = zpci_restore,
724 .poweroff_noirq = zpci_freeze,
726 #endif /* CONFIG_HIBERNATE_CALLBACKS */
728 static int zpci_alloc_domain(struct zpci_dev *zdev)
730 spin_lock(&zpci_domain_lock);
731 zdev->domain = find_first_zero_bit(zpci_domain, ZPCI_NR_DEVICES);
732 if (zdev->domain == ZPCI_NR_DEVICES) {
733 spin_unlock(&zpci_domain_lock);
736 set_bit(zdev->domain, zpci_domain);
737 spin_unlock(&zpci_domain_lock);
741 static void zpci_free_domain(struct zpci_dev *zdev)
743 spin_lock(&zpci_domain_lock);
744 clear_bit(zdev->domain, zpci_domain);
745 spin_unlock(&zpci_domain_lock);
748 void pcibios_remove_bus(struct pci_bus *bus)
750 struct zpci_dev *zdev = get_zdev_by_bus(bus);
752 zpci_exit_slot(zdev);
753 zpci_cleanup_bus_resources(zdev);
754 zpci_free_domain(zdev);
756 spin_lock(&zpci_list_lock);
757 list_del(&zdev->entry);
758 spin_unlock(&zpci_list_lock);
763 static int zpci_scan_bus(struct zpci_dev *zdev)
765 LIST_HEAD(resources);
768 ret = zpci_setup_bus_resources(zdev, &resources);
772 zdev->bus = pci_scan_root_bus(NULL, ZPCI_BUS_NR, &pci_root_ops,
778 zdev->bus->max_bus_speed = zdev->max_bus_speed;
779 pci_bus_add_devices(zdev->bus);
783 zpci_cleanup_bus_resources(zdev);
784 pci_free_resource_list(&resources);
788 int zpci_enable_device(struct zpci_dev *zdev)
792 rc = clp_enable_fh(zdev, ZPCI_NR_DMA_SPACES);
796 rc = zpci_dma_init_device(zdev);
800 zdev->state = ZPCI_FN_STATE_ONLINE;
804 clp_disable_fh(zdev);
808 EXPORT_SYMBOL_GPL(zpci_enable_device);
810 int zpci_disable_device(struct zpci_dev *zdev)
812 zpci_dma_exit_device(zdev);
813 return clp_disable_fh(zdev);
815 EXPORT_SYMBOL_GPL(zpci_disable_device);
817 int zpci_create_device(struct zpci_dev *zdev)
821 rc = zpci_alloc_domain(zdev);
825 mutex_init(&zdev->lock);
826 if (zdev->state == ZPCI_FN_STATE_CONFIGURED) {
827 rc = zpci_enable_device(zdev);
831 rc = zpci_scan_bus(zdev);
835 spin_lock(&zpci_list_lock);
836 list_add_tail(&zdev->entry, &zpci_list);
837 spin_unlock(&zpci_list_lock);
839 zpci_init_slot(zdev);
844 if (zdev->state == ZPCI_FN_STATE_ONLINE)
845 zpci_disable_device(zdev);
847 zpci_free_domain(zdev);
852 void zpci_stop_device(struct zpci_dev *zdev)
854 zpci_dma_exit_device(zdev);
856 * Note: SCLP disables fh via set-pci-fn so don't
860 EXPORT_SYMBOL_GPL(zpci_stop_device);
862 static inline int barsize(u8 size)
864 return (size) ? (1 << size) >> 10 : 0;
867 static int zpci_mem_init(void)
869 zdev_fmb_cache = kmem_cache_create("PCI_FMB_cache", sizeof(struct zpci_fmb),
874 /* TODO: use realloc */
875 zpci_iomap_start = kzalloc(ZPCI_IOMAP_MAX_ENTRIES * sizeof(*zpci_iomap_start),
877 if (!zpci_iomap_start)
882 kmem_cache_destroy(zdev_fmb_cache);
887 static void zpci_mem_exit(void)
889 kfree(zpci_iomap_start);
890 kmem_cache_destroy(zdev_fmb_cache);
893 static unsigned int s390_pci_probe = 1;
894 static unsigned int s390_pci_initialized;
896 char * __init pcibios_setup(char *str)
898 if (!strcmp(str, "off")) {
905 bool zpci_is_enabled(void)
907 return s390_pci_initialized;
910 static int __init pci_base_init(void)
917 if (!test_facility(69) || !test_facility(71) || !test_facility(72))
920 rc = zpci_debug_init();
924 rc = zpci_mem_init();
928 rc = zpci_irq_init();
932 rc = zpci_dma_init();
936 rc = clp_scan_pci_devices();
940 s390_pci_initialized = 1;
954 subsys_initcall_sync(pci_base_init);
956 void zpci_rescan(void)
958 if (zpci_is_enabled())
959 clp_rescan_pci_devices_simple();