?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
iwlwifi: mvm: fix version check for GEO_TX_POWER_LIMIT support
[linux/fpc-iii.git] / arch / s390 / pci / pci.c
blob9f6f392a44619ef41b910f5e6899c69d07a24edf
1 // SPDX-License-Identifier: GPL-2.0
2 /*
3 * Copyright IBM Corp. 2012
4 *
5 * Author(s):
6 * Jan Glauber <jang@linux.vnet.ibm.com>
7 *
8 * The System z PCI code is a rewrite from a prototype by
9 * the following people (Kudoz!):
10 * Alexander Schmidt
11 * Christoph Raisch
12 * Hannes Hering
13 * Hoang-Nam Nguyen
14 * Jan-Bernd Themann
15 * Stefan Roscher
16 * Thomas Klein
17 */
18
19 #define KMSG_COMPONENT "zpci"
20 #define pr_fmt(fmt) KMSG_COMPONENT ": " fmt
21
22 #include <linux/kernel.h>
23 #include <linux/slab.h>
24 #include <linux/err.h>
25 #include <linux/export.h>
26 #include <linux/delay.h>
27 #include <linux/irq.h>
28 #include <linux/kernel_stat.h>
29 #include <linux/seq_file.h>
30 #include <linux/pci.h>
31 #include <linux/msi.h>
32
33 #include <asm/isc.h>
34 #include <asm/airq.h>
35 #include <asm/facility.h>
36 #include <asm/pci_insn.h>
37 #include <asm/pci_clp.h>
38 #include <asm/pci_dma.h>
39
40 #define DEBUG /* enable pr_debug */
41
42 #define SIC_IRQ_MODE_ALL 0
43 #define SIC_IRQ_MODE_SINGLE 1
44
45 #define ZPCI_NR_DMA_SPACES 1
46 #define ZPCI_NR_DEVICES CONFIG_PCI_NR_FUNCTIONS
47
48 /* list of all detected zpci devices */
49 static LIST_HEAD(zpci_list);
50 static DEFINE_SPINLOCK(zpci_list_lock);
51
52 static struct irq_chip zpci_irq_chip = {
53 .name = "zPCI",
54 .irq_unmask = pci_msi_unmask_irq,
55 .irq_mask = pci_msi_mask_irq,
56 };
57
58 static DECLARE_BITMAP(zpci_domain, ZPCI_NR_DEVICES);
59 static DEFINE_SPINLOCK(zpci_domain_lock);
60
61 static struct airq_iv *zpci_aisb_iv;
62 static struct airq_iv *zpci_aibv[ZPCI_NR_DEVICES];
63
64 #define ZPCI_IOMAP_ENTRIES \
65 min(((unsigned long) ZPCI_NR_DEVICES * PCI_BAR_COUNT / 2), \
66 ZPCI_IOMAP_MAX_ENTRIES)
67
68 static DEFINE_SPINLOCK(zpci_iomap_lock);
69 static unsigned long *zpci_iomap_bitmap;
70 struct zpci_iomap_entry *zpci_iomap_start;
71 EXPORT_SYMBOL_GPL(zpci_iomap_start);
72
73 static struct kmem_cache *zdev_fmb_cache;
74
75 struct zpci_dev *get_zdev_by_fid(u32 fid)
76 {
77 struct zpci_dev *tmp, *zdev = NULL;
78
79 spin_lock(&zpci_list_lock);
80 list_for_each_entry(tmp, &zpci_list, entry) {
81 if (tmp->fid == fid) {
82 zdev = tmp;
83 break;
84 }
85 }
86 spin_unlock(&zpci_list_lock);
87 return zdev;
88 }
89
90 void zpci_remove_reserved_devices(void)
91 {
92 struct zpci_dev *tmp, *zdev;
93 enum zpci_state state;
94 LIST_HEAD(remove);
95
96 spin_lock(&zpci_list_lock);
97 list_for_each_entry_safe(zdev, tmp, &zpci_list, entry) {
98 if (zdev->state == ZPCI_FN_STATE_STANDBY &&
99 !clp_get_state(zdev->fid, &state) &&
100 state == ZPCI_FN_STATE_RESERVED)
101 list_move_tail(&zdev->entry, &remove);
102 }
103 spin_unlock(&zpci_list_lock);
104
105 list_for_each_entry_safe(zdev, tmp, &remove, entry)
106 zpci_remove_device(zdev);
107 }
108
109 static struct zpci_dev *get_zdev_by_bus(struct pci_bus *bus)
110 {
111 return (bus && bus->sysdata) ? (struct zpci_dev *) bus->sysdata : NULL;
112 }
113
114 int pci_domain_nr(struct pci_bus *bus)
115 {
116 return ((struct zpci_dev *) bus->sysdata)->domain;
117 }
118 EXPORT_SYMBOL_GPL(pci_domain_nr);
119
120 int pci_proc_domain(struct pci_bus *bus)
121 {
122 return pci_domain_nr(bus);
123 }
124 EXPORT_SYMBOL_GPL(pci_proc_domain);
125
126 /* Modify PCI: Register adapter interruptions */
127 static int zpci_set_airq(struct zpci_dev *zdev)
128 {
129 u64 req = ZPCI_CREATE_REQ(zdev->fh, 0, ZPCI_MOD_FC_REG_INT);
130 struct zpci_fib fib = {0};
131 u8 status;
132
133 fib.isc = PCI_ISC;
134 fib.sum = 1; /* enable summary notifications */
135 fib.noi = airq_iv_end(zdev->aibv);
136 fib.aibv = (unsigned long) zdev->aibv->vector;
137 fib.aibvo = 0; /* each zdev has its own interrupt vector */
138 fib.aisb = (unsigned long) zpci_aisb_iv->vector + (zdev->aisb/64)*8;
139 fib.aisbo = zdev->aisb & 63;
140
141 return zpci_mod_fc(req, &fib, &status) ? -EIO : 0;
142 }
143
144 /* Modify PCI: Unregister adapter interruptions */
145 static int zpci_clear_airq(struct zpci_dev *zdev)
146 {
147 u64 req = ZPCI_CREATE_REQ(zdev->fh, 0, ZPCI_MOD_FC_DEREG_INT);
148 struct zpci_fib fib = {0};
149 u8 cc, status;
150
151 cc = zpci_mod_fc(req, &fib, &status);
152 if (cc == 3 || (cc == 1 && status == 24))
153 /* Function already gone or IRQs already deregistered. */
154 cc = 0;
155
156 return cc ? -EIO : 0;
157 }
158
159 /* Modify PCI: Register I/O address translation parameters */
160 int zpci_register_ioat(struct zpci_dev *zdev, u8 dmaas,
161 u64 base, u64 limit, u64 iota)
162 {
163 u64 req = ZPCI_CREATE_REQ(zdev->fh, dmaas, ZPCI_MOD_FC_REG_IOAT);
164 struct zpci_fib fib = {0};
165 u8 status;
166
167 WARN_ON_ONCE(iota & 0x3fff);
168 fib.pba = base;
169 fib.pal = limit;
170 fib.iota = iota | ZPCI_IOTA_RTTO_FLAG;
171 return zpci_mod_fc(req, &fib, &status) ? -EIO : 0;
172 }
173
174 /* Modify PCI: Unregister I/O address translation parameters */
175 int zpci_unregister_ioat(struct zpci_dev *zdev, u8 dmaas)
176 {
177 u64 req = ZPCI_CREATE_REQ(zdev->fh, dmaas, ZPCI_MOD_FC_DEREG_IOAT);
178 struct zpci_fib fib = {0};
179 u8 cc, status;
180
181 cc = zpci_mod_fc(req, &fib, &status);
182 if (cc == 3) /* Function already gone. */
183 cc = 0;
184 return cc ? -EIO : 0;
185 }
186
187 /* Modify PCI: Set PCI function measurement parameters */
188 int zpci_fmb_enable_device(struct zpci_dev *zdev)
189 {
190 u64 req = ZPCI_CREATE_REQ(zdev->fh, 0, ZPCI_MOD_FC_SET_MEASURE);
191 struct zpci_fib fib = {0};
192 u8 cc, status;
193
194 if (zdev->fmb || sizeof(*zdev->fmb) < zdev->fmb_length)
195 return -EINVAL;
196
197 zdev->fmb = kmem_cache_zalloc(zdev_fmb_cache, GFP_KERNEL);
198 if (!zdev->fmb)
199 return -ENOMEM;
200 WARN_ON((u64) zdev->fmb & 0xf);
201
202 /* reset software counters */
203 atomic64_set(&zdev->allocated_pages, 0);
204 atomic64_set(&zdev->mapped_pages, 0);
205 atomic64_set(&zdev->unmapped_pages, 0);
206
207 fib.fmb_addr = virt_to_phys(zdev->fmb);
208 cc = zpci_mod_fc(req, &fib, &status);
209 if (cc) {
210 kmem_cache_free(zdev_fmb_cache, zdev->fmb);
211 zdev->fmb = NULL;
212 }
213 return cc ? -EIO : 0;
214 }
215
216 /* Modify PCI: Disable PCI function measurement */
217 int zpci_fmb_disable_device(struct zpci_dev *zdev)
218 {
219 u64 req = ZPCI_CREATE_REQ(zdev->fh, 0, ZPCI_MOD_FC_SET_MEASURE);
220 struct zpci_fib fib = {0};
221 u8 cc, status;
222
223 if (!zdev->fmb)
224 return -EINVAL;
225
226 /* Function measurement is disabled if fmb address is zero */
227 cc = zpci_mod_fc(req, &fib, &status);
228 if (cc == 3) /* Function already gone. */
229 cc = 0;
230
231 if (!cc) {
232 kmem_cache_free(zdev_fmb_cache, zdev->fmb);
233 zdev->fmb = NULL;
234 }
235 return cc ? -EIO : 0;
236 }
237
238 static int zpci_cfg_load(struct zpci_dev *zdev, int offset, u32 *val, u8 len)
239 {
240 u64 req = ZPCI_CREATE_REQ(zdev->fh, ZPCI_PCIAS_CFGSPC, len);
241 u64 data;
242 int rc;
243
244 rc = zpci_load(&data, req, offset);
245 if (!rc) {
246 data = le64_to_cpu((__force __le64) data);
247 data >>= (8 - len) * 8;
248 *val = (u32) data;
249 } else
250 *val = 0xffffffff;
251 return rc;
252 }
253
254 static int zpci_cfg_store(struct zpci_dev *zdev, int offset, u32 val, u8 len)
255 {
256 u64 req = ZPCI_CREATE_REQ(zdev->fh, ZPCI_PCIAS_CFGSPC, len);
257 u64 data = val;
258 int rc;
259
260 data <<= (8 - len) * 8;
261 data = (__force u64) cpu_to_le64(data);
262 rc = zpci_store(data, req, offset);
263 return rc;
264 }
265
266 resource_size_t pcibios_align_resource(void *data, const struct resource *res,
267 resource_size_t size,
268 resource_size_t align)
269 {
270 return 0;
271 }
272
273 /* combine single writes by using store-block insn */
274 void __iowrite64_copy(void __iomem *to, const void *from, size_t count)
275 {
276 zpci_memcpy_toio(to, from, count);
277 }
278
279 /* Create a virtual mapping cookie for a PCI BAR */
280 void __iomem *pci_iomap_range(struct pci_dev *pdev,
281 int bar,
282 unsigned long offset,
283 unsigned long max)
284 {
285 struct zpci_dev *zdev = to_zpci(pdev);
286 int idx;
287
288 if (!pci_resource_len(pdev, bar))
289 return NULL;
290
291 idx = zdev->bars[bar].map_idx;
292 spin_lock(&zpci_iomap_lock);
293 /* Detect overrun */
294 WARN_ON(!++zpci_iomap_start[idx].count);
295 zpci_iomap_start[idx].fh = zdev->fh;
296 zpci_iomap_start[idx].bar = bar;
297 spin_unlock(&zpci_iomap_lock);
298
299 return (void __iomem *) ZPCI_ADDR(idx) + offset;
300 }
301 EXPORT_SYMBOL(pci_iomap_range);
302
303 void __iomem *pci_iomap(struct pci_dev *dev, int bar, unsigned long maxlen)
304 {
305 return pci_iomap_range(dev, bar, 0, maxlen);
306 }
307 EXPORT_SYMBOL(pci_iomap);
308
309 void pci_iounmap(struct pci_dev *pdev, void __iomem *addr)
310 {
311 unsigned int idx = ZPCI_IDX(addr);
312
313 spin_lock(&zpci_iomap_lock);
314 /* Detect underrun */
315 WARN_ON(!zpci_iomap_start[idx].count);
316 if (!--zpci_iomap_start[idx].count) {
317 zpci_iomap_start[idx].fh = 0;
318 zpci_iomap_start[idx].bar = 0;
319 }
320 spin_unlock(&zpci_iomap_lock);
321 }
322 EXPORT_SYMBOL(pci_iounmap);
323
324 static int pci_read(struct pci_bus *bus, unsigned int devfn, int where,
325 int size, u32 *val)
326 {
327 struct zpci_dev *zdev = get_zdev_by_bus(bus);
328 int ret;
329
330 if (!zdev || devfn != ZPCI_DEVFN)
331 ret = -ENODEV;
332 else
333 ret = zpci_cfg_load(zdev, where, val, size);
334
335 return ret;
336 }
337
338 static int pci_write(struct pci_bus *bus, unsigned int devfn, int where,
339 int size, u32 val)
340 {
341 struct zpci_dev *zdev = get_zdev_by_bus(bus);
342 int ret;
343
344 if (!zdev || devfn != ZPCI_DEVFN)
345 ret = -ENODEV;
346 else
347 ret = zpci_cfg_store(zdev, where, val, size);
348
349 return ret;
350 }
351
352 static struct pci_ops pci_root_ops = {
353 .read = pci_read,
354 .write = pci_write,
355 };
356
357 static void zpci_irq_handler(struct airq_struct *airq)
358 {
359 unsigned long si, ai;
360 struct airq_iv *aibv;
361 int irqs_on = 0;
362
363 inc_irq_stat(IRQIO_PCI);
364 for (si = 0;;) {
365 /* Scan adapter summary indicator bit vector */
366 si = airq_iv_scan(zpci_aisb_iv, si, airq_iv_end(zpci_aisb_iv));
367 if (si == -1UL) {
368 if (irqs_on++)
369 /* End of second scan with interrupts on. */
370 break;
371 /* First scan complete, reenable interrupts. */
372 if (zpci_set_irq_ctrl(SIC_IRQ_MODE_SINGLE, NULL, PCI_ISC))
373 break;
374 si = 0;
375 continue;
376 }
377
378 /* Scan the adapter interrupt vector for this device. */
379 aibv = zpci_aibv[si];
380 for (ai = 0;;) {
381 ai = airq_iv_scan(aibv, ai, airq_iv_end(aibv));
382 if (ai == -1UL)
383 break;
384 inc_irq_stat(IRQIO_MSI);
385 airq_iv_lock(aibv, ai);
386 generic_handle_irq(airq_iv_get_data(aibv, ai));
387 airq_iv_unlock(aibv, ai);
388 }
389 }
390 }
391
392 int arch_setup_msi_irqs(struct pci_dev *pdev, int nvec, int type)
393 {
394 struct zpci_dev *zdev = to_zpci(pdev);
395 unsigned int hwirq, msi_vecs;
396 unsigned long aisb;
397 struct msi_desc *msi;
398 struct msi_msg msg;
399 int rc, irq;
400
401 zdev->aisb = -1UL;
402 if (type == PCI_CAP_ID_MSI && nvec > 1)
403 return 1;
404 msi_vecs = min_t(unsigned int, nvec, zdev->max_msi);
405
406 /* Allocate adapter summary indicator bit */
407 aisb = airq_iv_alloc_bit(zpci_aisb_iv);
408 if (aisb == -1UL)
409 return -EIO;
410 zdev->aisb = aisb;
411
412 /* Create adapter interrupt vector */
413 zdev->aibv = airq_iv_create(msi_vecs, AIRQ_IV_DATA | AIRQ_IV_BITLOCK);
414 if (!zdev->aibv)
415 return -ENOMEM;
416
417 /* Wire up shortcut pointer */
418 zpci_aibv[aisb] = zdev->aibv;
419
420 /* Request MSI interrupts */
421 hwirq = 0;
422 for_each_pci_msi_entry(msi, pdev) {
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