?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
regulator: s2mps11: Adjust supported buck voltages to real values
[linux/fpc-iii.git] / arch / s390 / pci / pci.c
blobdc9bc82c072c6d9309882f84dca095b131a53b90
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) || bar >= PCI_BAR_COUNT)
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 #ifdef CONFIG_PCI_IOV
488 static struct resource iov_res = {
489 .name = "PCI IOV res",
490 .start = 0,
491 .end = -1,
492 .flags = IORESOURCE_MEM,
493 };
494 #endif
495
496 static void zpci_map_resources(struct pci_dev *pdev)
497 {
498 resource_size_t len;
499 int i;
500
501 for (i = 0; i < PCI_BAR_COUNT; i++) {
502 len = pci_resource_len(pdev, i);
503 if (!len)
504 continue;
505 pdev->resource[i].start =
506 (resource_size_t __force) pci_iomap(pdev, i, 0);
507 pdev->resource[i].end = pdev->resource[i].start + len - 1;
508 }
509
510 #ifdef CONFIG_PCI_IOV
511 i = PCI_IOV_RESOURCES;
512
513 for (; i < PCI_SRIOV_NUM_BARS + PCI_IOV_RESOURCES; i++) {
514 len = pci_resource_len(pdev, i);
515 if (!len)
516 continue;
517 pdev->resource[i].parent = &iov_res;
518 }
519 #endif
520 }
521
522 static void zpci_unmap_resources(struct pci_dev *pdev)
523 {
524 resource_size_t len;
525 int i;
526
527 for (i = 0; i < PCI_BAR_COUNT; i++) {
528 len = pci_resource_len(pdev, i);
529 if (!len)
530 continue;
531 pci_iounmap(pdev, (void __iomem __force *)
532 pdev->resource[i].start);
533 }
534 }
535
536 static struct airq_struct zpci_airq = {
537 .handler = zpci_irq_handler,
538 .isc = PCI_ISC,
539 };
540
541 static int __init zpci_irq_init(void)
542 {
543 int rc;
544
545 rc = register_adapter_interrupt(&zpci_airq);
546 if (rc)
547 goto out;
548 /* Set summary to 1 to be called every time for the ISC. */
549 *zpci_airq.lsi_ptr = 1;
550
551 rc = -ENOMEM;
552 zpci_aisb_iv = airq_iv_create(ZPCI_NR_DEVICES, AIRQ_IV_ALLOC);
553 if (!zpci_aisb_iv)
554 goto out_airq;
555
556 zpci_set_irq_ctrl(SIC_IRQ_MODE_SINGLE, NULL, PCI_ISC);
557 return 0;
558
559 out_airq:
560 unregister_adapter_interrupt(&zpci_airq);
561 out:
562 return rc;
563 }
564
565 static void zpci_irq_exit(void)
566 {
567 airq_iv_release(zpci_aisb_iv);
568 unregister_adapter_interrupt(&zpci_airq);
569 }
570
571 static int zpci_alloc_iomap(struct zpci_dev *zdev)
572 {
573 unsigned long entry;
574
575 spin_lock(&zpci_iomap_lock);
576 entry = find_first_zero_bit(zpci_iomap_bitmap, ZPCI_IOMAP_ENTRIES);
577 if (entry == ZPCI_IOMAP_ENTRIES) {
578 spin_unlock(&zpci_iomap_lock);
579 return -ENOSPC;
580 }
581 set_bit(entry, zpci_iomap_bitmap);
582 spin_unlock(&zpci_iomap_lock);
583 return entry;
584 }
585
586 static void zpci_free_iomap(struct zpci_dev *zdev, int entry)
587 {
588 spin_lock(&zpci_iomap_lock);
589 memset(&zpci_iomap_start[entry], 0, sizeof(struct zpci_iomap_entry));
590 clear_bit(entry, zpci_iomap_bitmap);
591 spin_unlock(&zpci_iomap_lock);
592 }
593
594 static struct resource *__alloc_res(struct zpci_dev *zdev, unsigned long start,
595 unsigned long size, unsigned long flags)
596 {
597 struct resource *r;
598
599 r = kzalloc(sizeof(*r), GFP_KERNEL);
600 if (!r)
601 return NULL;
602
603 r->start = start;
604 r->end = r->start + size - 1;
605 r->flags = flags;
606 r->name = zdev->res_name;
607
608 if (request_resource(&iomem_resource, r)) {
609 kfree(r);
610 return NULL;
611 }
612 return r;
613 }
614
615 static int zpci_setup_bus_resources(struct zpci_dev *zdev,
616 struct list_head *resources)
617 {
618 unsigned long addr, size, flags;
619 struct resource *res;
620 int i, entry;
621
622 snprintf(zdev->res_name, sizeof(zdev->res_name),
623 "PCI Bus %04x:%02x", zdev->domain, ZPCI_BUS_NR);
624
625 for (i = 0; i < PCI_BAR_COUNT; i++) {
626 if (!zdev->bars[i].size)
627 continue;
628 entry = zpci_alloc_iomap(zdev);
629 if (entry < 0)
630 return entry;
631 zdev->bars[i].map_idx = entry;
632
633 /* only MMIO is supported */
634 flags = IORESOURCE_MEM;
635 if (zdev->bars[i].val & 8)
636 flags |= IORESOURCE_PREFETCH;
637 if (zdev->bars[i].val & 4)
638 flags |= IORESOURCE_MEM_64;
639
640 addr = ZPCI_ADDR(entry);
641 size = 1UL << zdev->bars[i].size;
642
643 res = __alloc_res(zdev, addr, size, flags);
644 if (!res) {
645 zpci_free_iomap(zdev, entry);
646 return -ENOMEM;
647 }
648 zdev->bars[i].res = res;
649 pci_add_resource(resources, res);
650 }
651
652 return 0;
653 }
654
655 static void zpci_cleanup_bus_resources(struct zpci_dev *zdev)
656 {
657 int i;
658
659 for (i = 0; i < PCI_BAR_COUNT; i++) {
660 if (!zdev->bars[i].size || !zdev->bars[i].res)
661 continue;
662
663 zpci_free_iomap(zdev, zdev->bars[i].map_idx);
664 release_resource(zdev->bars[i].res);
665 kfree(zdev->bars[i].res);
666 }
667 }
668
669 int pcibios_add_device(struct pci_dev *pdev)
670 {
671 struct resource *res;
672 int i;
673
674 if (pdev->is_physfn)
675 pdev->no_vf_scan = 1;
676
677 pdev->dev.groups = zpci_attr_groups;
678 pdev->dev.dma_ops = &s390_pci_dma_ops;
679 zpci_map_resources(pdev);
680
681 for (i = 0; i < PCI_BAR_COUNT; i++) {
682 res = &pdev->resource[i];
683 if (res->parent || !res->flags)
684 continue;
685 pci_claim_resource(pdev, i);
686 }
687
688 return 0;
689 }
690
691 void pcibios_release_device(struct pci_dev *pdev)
692 {
693 zpci_unmap_resources(pdev);
694 }
695
696 int pcibios_enable_device(struct pci_dev *pdev, int mask)
697 {
698 struct zpci_dev *zdev = to_zpci(pdev);
699
700 zpci_debug_init_device(zdev, dev_name(&pdev->dev));
701 zpci_fmb_enable_device(zdev);
702
703 return pci_enable_resources(pdev, mask);
704 }
705
706 void pcibios_disable_device(struct pci_dev *pdev)
707 {
708 struct zpci_dev *zdev = to_zpci(pdev);
709
710 zpci_fmb_disable_device(zdev);
711 zpci_debug_exit_device(zdev);
712 }
713
714 #ifdef CONFIG_HIBERNATE_CALLBACKS
715 static int zpci_restore(struct device *dev)
716 {
717 struct pci_dev *pdev = to_pci_dev(dev);
718 struct zpci_dev *zdev = to_zpci(pdev);
719 int ret = 0;
720
721 if (zdev->state != ZPCI_FN_STATE_ONLINE)
722 goto out;
723
724 ret = clp_enable_fh(zdev, ZPCI_NR_DMA_SPACES);
725 if (ret)
726 goto out;
727
728 zpci_map_resources(pdev);
729 zpci_register_ioat(zdev, 0, zdev->start_dma, zdev->end_dma,
730 (u64) zdev->dma_table);
731
732 out:
733 return ret;
734 }
735
736 static int zpci_freeze(struct device *dev)
737 {
738 struct pci_dev *pdev = to_pci_dev(dev);
739 struct zpci_dev *zdev = to_zpci(pdev);
740
741 if (zdev->state != ZPCI_FN_STATE_ONLINE)
742 return 0;
743
744 zpci_unregister_ioat(zdev, 0);
745 zpci_unmap_resources(pdev);
746 return clp_disable_fh(zdev);
747 }
748
749 struct dev_pm_ops pcibios_pm_ops = {
750 .thaw_noirq = zpci_restore,
751 .freeze_noirq = zpci_freeze,
752 .restore_noirq = zpci_restore,
753 .poweroff_noirq = zpci_freeze,
754 };
755 #endif /* CONFIG_HIBERNATE_CALLBACKS */
756
757 static int zpci_alloc_domain(struct zpci_dev *zdev)
758 {
759 if (zpci_unique_uid) {
760 zdev->domain = (u16) zdev->uid;
761 if (zdev->domain >= ZPCI_NR_DEVICES)
762 return 0;
763
764 spin_lock(&zpci_domain_lock);
765 if (test_bit(zdev->domain, zpci_domain)) {
766 spin_unlock(&zpci_domain_lock);
767 return -EEXIST;
768 }
769 set_bit(zdev->domain, zpci_domain);
770 spin_unlock(&zpci_domain_lock);
771 return 0;
772 }
773
774 spin_lock(&zpci_domain_lock);
775 zdev->domain = find_first_zero_bit(zpci_domain, ZPCI_NR_DEVICES);
776 if (zdev->domain == ZPCI_NR_DEVICES) {
777 spin_unlock(&zpci_domain_lock);
778 return -ENOSPC;
779 }
780 set_bit(zdev->domain, zpci_domain);
781 spin_unlock(&zpci_domain_lock);
782 return 0;
783 }
784
785 static void zpci_free_domain(struct zpci_dev *zdev)
786 {
787 if (zdev->domain >= ZPCI_NR_DEVICES)
788 return;
789
790 spin_lock(&zpci_domain_lock);
791 clear_bit(zdev->domain, zpci_domain);
792 spin_unlock(&zpci_domain_lock);
793 }
794
795 void pcibios_remove_bus(struct pci_bus *bus)
796 {
797 struct zpci_dev *zdev = get_zdev_by_bus(bus);
798
799 zpci_exit_slot(zdev);
800 zpci_cleanup_bus_resources(zdev);
801 zpci_destroy_iommu(zdev);
802 zpci_free_domain(zdev);
803
804 spin_lock(&zpci_list_lock);
805 list_del(&zdev->entry);
806 spin_unlock(&zpci_list_lock);
807
808 zpci_dbg(3, "rem fid:%x\n", zdev->fid);
809 kfree(zdev);
810 }
811
812 static int zpci_scan_bus(struct zpci_dev *zdev)
813 {
814 LIST_HEAD(resources);
815 int ret;
816
817 ret = zpci_setup_bus_resources(zdev, &resources);
818 if (ret)
819 goto error;
820
821 zdev->bus = pci_scan_root_bus(NULL, ZPCI_BUS_NR, &pci_root_ops,
822 zdev, &resources);
823 if (!zdev->bus) {
824 ret = -EIO;
825 goto error;
826 }
827 zdev->bus->max_bus_speed = zdev->max_bus_speed;
828 pci_bus_add_devices(zdev->bus);
829 return 0;
830
831 error:
832 zpci_cleanup_bus_resources(zdev);
833 pci_free_resource_list(&resources);
834 return ret;
835 }
836
837 int zpci_enable_device(struct zpci_dev *zdev)
838 {
839 int rc;
840
841 rc = clp_enable_fh(zdev, ZPCI_NR_DMA_SPACES);
842 if (rc)
843 goto out;
844
845 rc = zpci_dma_init_device(zdev);
846 if (rc)
847 goto out_dma;
848
849 zdev->state = ZPCI_FN_STATE_ONLINE;
850 return 0;
851
852 out_dma:
853 clp_disable_fh(zdev);
854 out:
855 return rc;
856 }
857 EXPORT_SYMBOL_GPL(zpci_enable_device);
858
859 int zpci_disable_device(struct zpci_dev *zdev)
860 {
861 zpci_dma_exit_device(zdev);
862 return clp_disable_fh(zdev);
863 }
864 EXPORT_SYMBOL_GPL(zpci_disable_device);
865
866 int zpci_create_device(struct zpci_dev *zdev)
867 {
868 int rc;
869
870 rc = zpci_alloc_domain(zdev);
871 if (rc)
872 goto out;
873
874 rc = zpci_init_iommu(zdev);
875 if (rc)
876 goto out_free;
877
878 mutex_init(&zdev->lock);
879 if (zdev->state == ZPCI_FN_STATE_CONFIGURED) {
880 rc = zpci_enable_device(zdev);
881 if (rc)
882 goto out_destroy_iommu;
883 }
884 rc = zpci_scan_bus(zdev);
885 if (rc)
886 goto out_disable;
887
888 spin_lock(&zpci_list_lock);
889 list_add_tail(&zdev->entry, &zpci_list);
890 spin_unlock(&zpci_list_lock);
891
892 zpci_init_slot(zdev);
893
894 return 0;
895
896 out_disable:
897 if (zdev->state == ZPCI_FN_STATE_ONLINE)
898 zpci_disable_device(zdev);
899 out_destroy_iommu:
900 zpci_destroy_iommu(zdev);
901 out_free:
902 zpci_free_domain(zdev);
903 out:
904 return rc;
905 }
906
907 void zpci_remove_device(struct zpci_dev *zdev)
908 {
909 if (!zdev->bus)
910 return;
911
912 pci_stop_root_bus(zdev->bus);
913 pci_remove_root_bus(zdev->bus);
914 }
915
916 int zpci_report_error(struct pci_dev *pdev,
917 struct zpci_report_error_header *report)
918 {
919 struct zpci_dev *zdev = to_zpci(pdev);
920
921 return sclp_pci_report(report, zdev->fh, zdev->fid);
922 }
923 EXPORT_SYMBOL(zpci_report_error);
924
925 static int zpci_mem_init(void)
926 {
927 BUILD_BUG_ON(!is_power_of_2(__alignof__(struct zpci_fmb)) ||
928 __alignof__(struct zpci_fmb) < sizeof(struct zpci_fmb));
929
930 zdev_fmb_cache = kmem_cache_create("PCI_FMB_cache", sizeof(struct zpci_fmb),
931 __alignof__(struct zpci_fmb), 0, NULL);
932 if (!zdev_fmb_cache)
933 goto error_fmb;
934
935 zpci_iomap_start = kcalloc(ZPCI_IOMAP_ENTRIES,
936 sizeof(*zpci_iomap_start), GFP_KERNEL);
937 if (!zpci_iomap_start)
938 goto error_iomap;
939
940 zpci_iomap_bitmap = kcalloc(BITS_TO_LONGS(ZPCI_IOMAP_ENTRIES),
941 sizeof(*zpci_iomap_bitmap), GFP_KERNEL);
942 if (!zpci_iomap_bitmap)
943 goto error_iomap_bitmap;
944
945 return 0;
946 error_iomap_bitmap:
947 kfree(zpci_iomap_start);
948 error_iomap:
949 kmem_cache_destroy(zdev_fmb_cache);
950 error_fmb:
951 return -ENOMEM;
952 }
953
954 static void zpci_mem_exit(void)
955 {
956 kfree(zpci_iomap_bitmap);
957 kfree(zpci_iomap_start);
958 kmem_cache_destroy(zdev_fmb_cache);
959 }
960
961 static unsigned int s390_pci_probe = 1;
962 static unsigned int s390_pci_initialized;
963
964 char * __init pcibios_setup(char *str)
965 {
966 if (!strcmp(str, "off")) {
967 s390_pci_probe = 0;
968 return NULL;
969 }
970 return str;
971 }
972
973 bool zpci_is_enabled(void)
974 {
975 return s390_pci_initialized;
976 }
977
978 static int __init pci_base_init(void)
979 {
980 int rc;
981
982 if (!s390_pci_probe)
983 return 0;
984
985 if (!test_facility(69) || !test_facility(71))
986 return 0;
987
988 rc = zpci_debug_init();
989 if (rc)
990 goto out;
991
992 rc = zpci_mem_init();
993 if (rc)
994 goto out_mem;
995
996 rc = zpci_irq_init();
997 if (rc)
998 goto out_irq;
999
1000 rc = zpci_dma_init();
1001 if (rc)
1002 goto out_dma;
1003
1004 rc = clp_scan_pci_devices();
1005 if (rc)
1006 goto out_find;
1007
1008 s390_pci_initialized = 1;
1009 return 0;
1010
1011 out_find:
1012 zpci_dma_exit();
1013 out_dma:
1014 zpci_irq_exit();
1015 out_irq:
1016 zpci_mem_exit();
1017 out_mem:
1018 zpci_debug_exit();
1019 out:
1020 return rc;
1021 }
1022 subsys_initcall_sync(pci_base_init);
1023
1024 void zpci_rescan(void)
1025 {
1026 if (zpci_is_enabled())
1027 clp_rescan_pci_devices_simple();
1028 }
Linux with added FPC-III support