|
@@ -5,6 +5,8 @@
|
|
#include <linux/module.h>
|
|
#include <linux/module.h>
|
|
#include <linux/of_address.h>
|
|
#include <linux/of_address.h>
|
|
#include <linux/pci_regs.h>
|
|
#include <linux/pci_regs.h>
|
|
|
|
+#include <linux/sizes.h>
|
|
|
|
+#include <linux/slab.h>
|
|
#include <linux/string.h>
|
|
#include <linux/string.h>
|
|
|
|
|
|
/* Max address size we deal with */
|
|
/* Max address size we deal with */
|
|
@@ -293,6 +295,51 @@ struct of_pci_range *of_pci_range_parser_one(struct of_pci_range_parser *parser,
|
|
}
|
|
}
|
|
EXPORT_SYMBOL_GPL(of_pci_range_parser_one);
|
|
EXPORT_SYMBOL_GPL(of_pci_range_parser_one);
|
|
|
|
|
|
|
|
+/*
|
|
|
|
+ * of_pci_range_to_resource - Create a resource from an of_pci_range
|
|
|
|
+ * @range: the PCI range that describes the resource
|
|
|
|
+ * @np: device node where the range belongs to
|
|
|
|
+ * @res: pointer to a valid resource that will be updated to
|
|
|
|
+ * reflect the values contained in the range.
|
|
|
|
+ *
|
|
|
|
+ * Returns EINVAL if the range cannot be converted to resource.
|
|
|
|
+ *
|
|
|
|
+ * Note that if the range is an IO range, the resource will be converted
|
|
|
|
+ * using pci_address_to_pio() which can fail if it is called too early or
|
|
|
|
+ * if the range cannot be matched to any host bridge IO space (our case here).
|
|
|
|
+ * To guard against that we try to register the IO range first.
|
|
|
|
+ * If that fails we know that pci_address_to_pio() will do too.
|
|
|
|
+ */
|
|
|
|
+int of_pci_range_to_resource(struct of_pci_range *range,
|
|
|
|
+ struct device_node *np, struct resource *res)
|
|
|
|
+{
|
|
|
|
+ int err;
|
|
|
|
+ res->flags = range->flags;
|
|
|
|
+ res->parent = res->child = res->sibling = NULL;
|
|
|
|
+ res->name = np->full_name;
|
|
|
|
+
|
|
|
|
+ if (res->flags & IORESOURCE_IO) {
|
|
|
|
+ unsigned long port;
|
|
|
|
+ err = pci_register_io_range(range->cpu_addr, range->size);
|
|
|
|
+ if (err)
|
|
|
|
+ goto invalid_range;
|
|
|
|
+ port = pci_address_to_pio(range->cpu_addr);
|
|
|
|
+ if (port == (unsigned long)-1) {
|
|
|
|
+ err = -EINVAL;
|
|
|
|
+ goto invalid_range;
|
|
|
|
+ }
|
|
|
|
+ res->start = port;
|
|
|
|
+ } else {
|
|
|
|
+ res->start = range->cpu_addr;
|
|
|
|
+ }
|
|
|
|
+ res->end = res->start + range->size - 1;
|
|
|
|
+ return 0;
|
|
|
|
+
|
|
|
|
+invalid_range:
|
|
|
|
+ res->start = (resource_size_t)OF_BAD_ADDR;
|
|
|
|
+ res->end = (resource_size_t)OF_BAD_ADDR;
|
|
|
|
+ return err;
|
|
|
|
+}
|
|
#endif /* CONFIG_PCI */
|
|
#endif /* CONFIG_PCI */
|
|
|
|
|
|
/*
|
|
/*
|
|
@@ -601,12 +648,119 @@ const __be32 *of_get_address(struct device_node *dev, int index, u64 *size,
|
|
}
|
|
}
|
|
EXPORT_SYMBOL(of_get_address);
|
|
EXPORT_SYMBOL(of_get_address);
|
|
|
|
|
|
|
|
+#ifdef PCI_IOBASE
|
|
|
|
+struct io_range {
|
|
|
|
+ struct list_head list;
|
|
|
|
+ phys_addr_t start;
|
|
|
|
+ resource_size_t size;
|
|
|
|
+};
|
|
|
|
+
|
|
|
|
+static LIST_HEAD(io_range_list);
|
|
|
|
+static DEFINE_SPINLOCK(io_range_lock);
|
|
|
|
+#endif
|
|
|
|
+
|
|
|
|
+/*
|
|
|
|
+ * Record the PCI IO range (expressed as CPU physical address + size).
|
|
|
|
+ * Return a negative value if an error has occured, zero otherwise
|
|
|
|
+ */
|
|
|
|
+int __weak pci_register_io_range(phys_addr_t addr, resource_size_t size)
|
|
|
|
+{
|
|
|
|
+ int err = 0;
|
|
|
|
+
|
|
|
|
+#ifdef PCI_IOBASE
|
|
|
|
+ struct io_range *range;
|
|
|
|
+ resource_size_t allocated_size = 0;
|
|
|
|
+
|
|
|
|
+ /* check if the range hasn't been previously recorded */
|
|
|
|
+ spin_lock(&io_range_lock);
|
|
|
|
+ list_for_each_entry(range, &io_range_list, list) {
|
|
|
|
+ if (addr >= range->start && addr + size <= range->start + size) {
|
|
|
|
+ /* range already registered, bail out */
|
|
|
|
+ goto end_register;
|
|
|
|
+ }
|
|
|
|
+ allocated_size += range->size;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ /* range not registed yet, check for available space */
|
|
|
|
+ if (allocated_size + size - 1 > IO_SPACE_LIMIT) {
|
|
|
|
+ /* if it's too big check if 64K space can be reserved */
|
|
|
|
+ if (allocated_size + SZ_64K - 1 > IO_SPACE_LIMIT) {
|
|
|
|
+ err = -E2BIG;
|
|
|
|
+ goto end_register;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ size = SZ_64K;
|
|
|
|
+ pr_warn("Requested IO range too big, new size set to 64K\n");
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ /* add the range to the list */
|
|
|
|
+ range = kzalloc(sizeof(*range), GFP_KERNEL);
|
|
|
|
+ if (!range) {
|
|
|
|
+ err = -ENOMEM;
|
|
|
|
+ goto end_register;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ range->start = addr;
|
|
|
|
+ range->size = size;
|
|
|
|
+
|
|
|
|
+ list_add_tail(&range->list, &io_range_list);
|
|
|
|
+
|
|
|
|
+end_register:
|
|
|
|
+ spin_unlock(&io_range_lock);
|
|
|
|
+#endif
|
|
|
|
+
|
|
|
|
+ return err;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+phys_addr_t pci_pio_to_address(unsigned long pio)
|
|
|
|
+{
|
|
|
|
+ phys_addr_t address = (phys_addr_t)OF_BAD_ADDR;
|
|
|
|
+
|
|
|
|
+#ifdef PCI_IOBASE
|
|
|
|
+ struct io_range *range;
|
|
|
|
+ resource_size_t allocated_size = 0;
|
|
|
|
+
|
|
|
|
+ if (pio > IO_SPACE_LIMIT)
|
|
|
|
+ return address;
|
|
|
|
+
|
|
|
|
+ spin_lock(&io_range_lock);
|
|
|
|
+ list_for_each_entry(range, &io_range_list, list) {
|
|
|
|
+ if (pio >= allocated_size && pio < allocated_size + range->size) {
|
|
|
|
+ address = range->start + pio - allocated_size;
|
|
|
|
+ break;
|
|
|
|
+ }
|
|
|
|
+ allocated_size += range->size;
|
|
|
|
+ }
|
|
|
|
+ spin_unlock(&io_range_lock);
|
|
|
|
+#endif
|
|
|
|
+
|
|
|
|
+ return address;
|
|
|
|
+}
|
|
|
|
+
|
|
unsigned long __weak pci_address_to_pio(phys_addr_t address)
|
|
unsigned long __weak pci_address_to_pio(phys_addr_t address)
|
|
{
|
|
{
|
|
|
|
+#ifdef PCI_IOBASE
|
|
|
|
+ struct io_range *res;
|
|
|
|
+ resource_size_t offset = 0;
|
|
|
|
+ unsigned long addr = -1;
|
|
|
|
+
|
|
|
|
+ spin_lock(&io_range_lock);
|
|
|
|
+ list_for_each_entry(res, &io_range_list, list) {
|
|
|
|
+ if (address >= res->start && address < res->start + res->size) {
|
|
|
|
+ addr = res->start - address + offset;
|
|
|
|
+ break;
|
|
|
|
+ }
|
|
|
|
+ offset += res->size;
|
|
|
|
+ }
|
|
|
|
+ spin_unlock(&io_range_lock);
|
|
|
|
+
|
|
|
|
+ return addr;
|
|
|
|
+#else
|
|
if (address > IO_SPACE_LIMIT)
|
|
if (address > IO_SPACE_LIMIT)
|
|
return (unsigned long)-1;
|
|
return (unsigned long)-1;
|
|
|
|
|
|
return (unsigned long) address;
|
|
return (unsigned long) address;
|
|
|
|
+#endif
|
|
}
|
|
}
|
|
|
|
|
|
static int __of_address_to_resource(struct device_node *dev,
|
|
static int __of_address_to_resource(struct device_node *dev,
|