/* * Copyright (c) 2015, Linaro Limited, Shannon Zhao * * This program is free software; you can redistribute it and/or modify it * under the terms and conditions of the GNU General Public License, * version 2, as published by the Free Software Foundation. * * This program is distributed in the hope it will be useful, but WITHOUT * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * * You should have received a copy of the GNU General Public License * along with this program. If not, see . */ #include #include #include #include #include #include #include static int xen_unmap_device_mmio(const struct resource *resources, unsigned int count) { unsigned int i, j, nr; int rc = 0; const struct resource *r; struct xen_remove_from_physmap xrp; for (i = 0; i < count; i++) { r = &resources[i]; nr = DIV_ROUND_UP(resource_size(r), XEN_PAGE_SIZE); if ((resource_type(r) != IORESOURCE_MEM) || (nr == 0)) continue; for (j = 0; j < nr; j++) { xrp.domid = DOMID_SELF; xrp.gpfn = XEN_PFN_DOWN(r->start) + j; rc = HYPERVISOR_memory_op(XENMEM_remove_from_physmap, &xrp); if (rc) return rc; } } return rc; } static int xen_map_device_mmio(const struct resource *resources, unsigned int count) { unsigned int i, j, nr; int rc = 0; const struct resource *r; xen_pfn_t *gpfns; xen_ulong_t *idxs; int *errs; for (i = 0; i < count; i++) { struct xen_add_to_physmap_range xatp = { .domid = DOMID_SELF, .space = XENMAPSPACE_dev_mmio }; r = &resources[i]; nr = DIV_ROUND_UP(resource_size(r), XEN_PAGE_SIZE); if ((resource_type(r) != IORESOURCE_MEM) || (nr == 0)) continue; gpfns = kzalloc(sizeof(xen_pfn_t) * nr, GFP_KERNEL); idxs = kzalloc(sizeof(xen_ulong_t) * nr, GFP_KERNEL); errs = kzalloc(sizeof(int) * nr, GFP_KERNEL); if (!gpfns || !idxs || !errs) { kfree(gpfns); kfree(idxs); kfree(errs); rc = -ENOMEM; goto unmap; } for (j = 0; j < nr; j++) { /* * The regions are always mapped 1:1 to DOM0 and this is * fine because the memory map for DOM0 is the same as * the host (except for the RAM). */ gpfns[j] = XEN_PFN_DOWN(r->start) + j; idxs[j] = XEN_PFN_DOWN(r->start) + j; } xatp.size = nr; set_xen_guest_handle(xatp.gpfns, gpfns); set_xen_guest_handle(xatp.idxs, idxs); set_xen_guest_handle(xatp.errs, errs); rc = HYPERVISOR_memory_op(XENMEM_add_to_physmap_range, &xatp); kfree(gpfns); kfree(idxs); kfree(errs); if (rc) goto unmap; } return rc; unmap: xen_unmap_device_mmio(resources, i); return rc; } static int xen_platform_notifier(struct notifier_block *nb, unsigned long action, void *data) { struct platform_device *pdev = to_platform_device(data); int r = 0; if (pdev->num_resources == 0 || pdev->resource == NULL) return NOTIFY_OK; switch (action) { case BUS_NOTIFY_ADD_DEVICE: r = xen_map_device_mmio(pdev->resource, pdev->num_resources); break; case BUS_NOTIFY_DEL_DEVICE: r = xen_unmap_device_mmio(pdev->resource, pdev->num_resources); break; default: return NOTIFY_DONE; } if (r) dev_err(&pdev->dev, "Platform: Failed to %s device %s MMIO!\n", action == BUS_NOTIFY_ADD_DEVICE ? "map" : (action == BUS_NOTIFY_DEL_DEVICE ? "unmap" : "?"), pdev->name); return NOTIFY_OK; } static struct notifier_block platform_device_nb = { .notifier_call = xen_platform_notifier, }; static int __init register_xen_platform_notifier(void) { if (!xen_initial_domain() || acpi_disabled) return 0; return bus_register_notifier(&platform_bus_type, &platform_device_nb); } arch_initcall(register_xen_platform_notifier); #ifdef CONFIG_ARM_AMBA #include static int xen_amba_notifier(struct notifier_block *nb, unsigned long action, void *data) { struct amba_device *adev = to_amba_device(data); int r = 0; switch (action) { case BUS_NOTIFY_ADD_DEVICE: r = xen_map_device_mmio(&adev->res, 1); break; case BUS_NOTIFY_DEL_DEVICE: r = xen_unmap_device_mmio(&adev->res, 1); break; default: return NOTIFY_DONE; } if (r) dev_err(&adev->dev, "AMBA: Failed to %s device %s MMIO!\n", action == BUS_NOTIFY_ADD_DEVICE ? "map" : (action == BUS_NOTIFY_DEL_DEVICE ? "unmap" : "?"), adev->dev.init_name); return NOTIFY_OK; } static struct notifier_block amba_device_nb = { .notifier_call = xen_amba_notifier, }; static int __init register_xen_amba_notifier(void) { if (!xen_initial_domain() || acpi_disabled) return 0; return bus_register_notifier(&amba_bustype, &amba_device_nb); } arch_initcall(register_xen_amba_notifier); #endif ript>
authorOlof Johansson <olof@lixom.net>2017-01-29 21:00:48 -0800
committerOlof Johansson <olof@lixom.net>2017-01-29 21:00:48 -0800
commit0a019a28e0ca0af7dc2691d1a9527960b07ad2bb (patch)
tree5ee1db9aacacd6af6701fb290e8a294ef3cc2bf2 /net/6lowpan/nhc_ipv6.c
parentec026b5020688a8bde5fae9a69ae3c59b66ba3ae (diff)
parent8413299cb3933dade6186bbee8363f190032107e (diff)
Merge tag 'sti-dt-for-v4.10-rc' of git://git.kernel.org/pub/scm/linux/kernel/git/pchotard/sti into fixes
STi DT fix: Since v4.10-rc1, xhci is complaining in loop with : [ 801.953836] usb usb6-port1: Cannot enable. Maybe the USB cable is bad? [ 801.960455] xhci-hcd xhci-hcd.0.auto: Cannot set link state. [ 801.966611] usb usb6-port1: cannot disable (err = -32) set property "snps,dis_u3_susphy_quirk" in DT fix it. * tag 'sti-dt-for-v4.10-rc' of git://git.kernel.org/pub/scm/linux/kernel/git/pchotard/sti: ARM: dts: STiH407-family: set snps,dis_u3_susphy_quirk Signed-off-by: Olof Johansson <olof@lixom.net>
Diffstat (limited to 'net/6lowpan/nhc_ipv6.c')