leon_pci.c 2.9 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100
  1. /*
  2. * leon_pci.c: LEON Host PCI support
  3. *
  4. * Copyright (C) 2011 Aeroflex Gaisler AB, Daniel Hellstrom
  5. *
  6. * Code is partially derived from pcic.c
  7. */
  8. #include <linux/of_device.h>
  9. #include <linux/kernel.h>
  10. #include <linux/pci.h>
  11. #include <linux/export.h>
  12. #include <asm/leon.h>
  13. #include <asm/leon_pci.h>
  14. /* The LEON architecture does not rely on a BIOS or bootloader to setup
  15. * PCI for us. The Linux generic routines are used to setup resources,
  16. * reset values of configuration-space register settings are preserved.
  17. *
  18. * PCI Memory and Prefetchable Memory is direct-mapped. However I/O Space is
  19. * accessed through a Window which is translated to low 64KB in PCI space, the
  20. * first 4KB is not used so 60KB is available.
  21. */
  22. void leon_pci_init(struct platform_device *ofdev, struct leon_pci_info *info)
  23. {
  24. LIST_HEAD(resources);
  25. struct pci_bus *root_bus;
  26. pci_add_resource_offset(&resources, &info->io_space,
  27. info->io_space.start - 0x1000);
  28. pci_add_resource(&resources, &info->mem_space);
  29. info->busn.flags = IORESOURCE_BUS;
  30. pci_add_resource(&resources, &info->busn);
  31. root_bus = pci_scan_root_bus(&ofdev->dev, 0, info->ops, info,
  32. &resources);
  33. if (root_bus) {
  34. /* Setup IRQs of all devices using custom routines */
  35. pci_fixup_irqs(pci_common_swizzle, info->map_irq);
  36. /* Assign devices with resources */
  37. pci_assign_unassigned_resources();
  38. } else {
  39. pci_free_resource_list(&resources);
  40. }
  41. }
  42. void pcibios_fixup_bus(struct pci_bus *pbus)
  43. {
  44. struct pci_dev *dev;
  45. int i, has_io, has_mem;
  46. u16 cmd;
  47. list_for_each_entry(dev, &pbus->devices, bus_list) {
  48. /*
  49. * We can not rely on that the bootloader has enabled I/O
  50. * or memory access to PCI devices. Instead we enable it here
  51. * if the device has BARs of respective type.
  52. */
  53. has_io = has_mem = 0;
  54. for (i = 0; i < PCI_ROM_RESOURCE; i++) {
  55. unsigned long f = dev->resource[i].flags;
  56. if (f & IORESOURCE_IO)
  57. has_io = 1;
  58. else if (f & IORESOURCE_MEM)
  59. has_mem = 1;
  60. }
  61. /* ROM BARs are mapped into 32-bit memory space */
  62. if (dev->resource[PCI_ROM_RESOURCE].end != 0) {
  63. dev->resource[PCI_ROM_RESOURCE].flags |=
  64. IORESOURCE_ROM_ENABLE;
  65. has_mem = 1;
  66. }
  67. pci_bus_read_config_word(pbus, dev->devfn, PCI_COMMAND, &cmd);
  68. if (has_io && !(cmd & PCI_COMMAND_IO)) {
  69. #ifdef CONFIG_PCI_DEBUG
  70. printk(KERN_INFO "LEONPCI: Enabling I/O for dev %s\n",
  71. pci_name(dev));
  72. #endif
  73. cmd |= PCI_COMMAND_IO;
  74. pci_bus_write_config_word(pbus, dev->devfn, PCI_COMMAND,
  75. cmd);
  76. }
  77. if (has_mem && !(cmd & PCI_COMMAND_MEMORY)) {
  78. #ifdef CONFIG_PCI_DEBUG
  79. printk(KERN_INFO "LEONPCI: Enabling MEMORY for dev"
  80. "%s\n", pci_name(dev));
  81. #endif
  82. cmd |= PCI_COMMAND_MEMORY;
  83. pci_bus_write_config_word(pbus, dev->devfn, PCI_COMMAND,
  84. cmd);
  85. }
  86. }
  87. }
  88. resource_size_t pcibios_align_resource(void *data, const struct resource *res,
  89. resource_size_t size, resource_size_t align)
  90. {
  91. return res->start;
  92. }