Loading Documentation/devicetree/bindings/uio/msm_sharedmem.txt 0 → 100644 +18 −0 Original line number Diff line number Diff line msm_sharedmem provides the shared memory addresses for various clients in user-space Required properties: - compatible: Must be "qcom,sharedmem-uio" - reg : The address and size of the shared memory. The address/sizes may vary. A reg address of Zero indicates that the shared memory is dynamically allocated using dma_alloc_coherent. A non zero reg address is used directly. - reg-names : Indicates various client-names. - qcom,client-id : The client id for the QMI clients. Example: qcom,msm_sharedmem@0dc80000 { compatible = "qcom,sharedmem-uio"; reg = <0x0dc80000 0x00180000>, reg-names = "rmtfs"; qcom,client-id = <0x00000001>; }; drivers/uio/Kconfig +10 −0 Original line number Diff line number Diff line Loading @@ -164,4 +164,14 @@ config UIO_HV_GENERIC to network and storage devices from userspace. If you compile this as a module, it will be called uio_hv_generic. config UIO_MSM_SHAREDMEM bool "MSM shared memory driver" default n help Provides the clients with their respective alloted shared memory addresses which are used as transport buffer. If you don't know what to do here, say N. endif drivers/uio/Makefile +1 −0 Original line number Diff line number Diff line Loading @@ -11,3 +11,4 @@ obj-$(CONFIG_UIO_PRUSS) += uio_pruss.o obj-$(CONFIG_UIO_MF624) += uio_mf624.o obj-$(CONFIG_UIO_FSL_ELBC_GPCM) += uio_fsl_elbc_gpcm.o obj-$(CONFIG_UIO_HV_GENERIC) += uio_hv_generic.o obj-$(CONFIG_UIO_MSM_SHAREDMEM) += msm_sharedmem/ drivers/uio/msm_sharedmem/Makefile 0 → 100644 +2 −0 Original line number Diff line number Diff line # SPDX-License-Identifier: GPL-2.0-only obj-$(CONFIG_UIO_MSM_SHAREDMEM) := msm_sharedmem.o drivers/uio/msm_sharedmem/msm_sharedmem.c 0 → 100644 +214 −0 Original line number Diff line number Diff line // SPDX-License-Identifier: GPL-2.0-only /* * Copyright (c) 2015-2019, The Linux Foundation. All rights reserved. */ #define DRIVER_NAME "msm_sharedmem" #define pr_fmt(fmt) DRIVER_NAME ": %s: " fmt, __func__ #include <linux/uio_driver.h> #include <linux/module.h> #include <linux/platform_device.h> #include <linux/err.h> #include <linux/of.h> #include <linux/dma-mapping.h> #include <soc/qcom/secure_buffer.h> #define CLIENT_ID_PROP "qcom,client-id" #define MPSS_RMTS_CLIENT_ID 1 static int uio_get_mem_index(struct uio_info *info, struct vm_area_struct *vma) { if (vma->vm_pgoff >= MAX_UIO_MAPS) return -EINVAL; if (info->mem[vma->vm_pgoff].size == 0) return -EINVAL; return (int)vma->vm_pgoff; } static int sharedmem_mmap(struct uio_info *info, struct vm_area_struct *vma) { int result; struct uio_mem *mem; int mem_index = uio_get_mem_index(info, vma); if (mem_index < 0) { pr_err("mem_index is invalid errno %d\n", mem_index); return mem_index; } mem = info->mem + mem_index; if (vma->vm_end - vma->vm_start > mem->size) { pr_err("vm_end[%lu] - vm_start[%lu] [%lu] > mem->size[%pa]\n", vma->vm_end, vma->vm_start, (vma->vm_end - vma->vm_start), &mem->size); return -EINVAL; } pr_debug("Attempting to setup mmap.\n"); vma->vm_page_prot = pgprot_writecombine(vma->vm_page_prot); result = remap_pfn_range(vma, vma->vm_start, mem->addr >> PAGE_SHIFT, vma->vm_end - vma->vm_start, vma->vm_page_prot); if (result != 0) pr_err("mmap Failed with errno %d\n", result); else pr_debug("mmap success\n"); return result; } /* Setup the shared ram permissions. * This function currently supports the mpss client only. */ static void setup_shared_ram_perms(u32 client_id, phys_addr_t addr, u32 size) { int ret; u32 source_vmlist[1] = {VMID_HLOS}; int dest_vmids[2] = {VMID_HLOS, VMID_MSS_MSA}; int dest_perms[2] = {PERM_READ|PERM_WRITE, PERM_READ|PERM_WRITE}; if (client_id != MPSS_RMTS_CLIENT_ID) return; ret = hyp_assign_phys(addr, size, source_vmlist, 1, dest_vmids, dest_perms, 2); if (ret != 0) { if (ret == -EINVAL) pr_warn("hyp_assign_phys is not supported!\n"); else pr_err("hyp_assign_phys failed IPA=0x016%pa size=%u err=%d\n", &addr, size, ret); } } static int msm_sharedmem_probe(struct platform_device *pdev) { int ret = 0; struct uio_info *info = NULL; struct resource *clnt_res = NULL; u32 client_id = ((u32)~0U); u32 shared_mem_size = 0; void *shared_mem = NULL; phys_addr_t shared_mem_pyhsical = 0; bool is_addr_dynamic = false; /* Get the addresses from platform-data */ if (!pdev->dev.of_node) { pr_err("Node not found\n"); ret = -ENODEV; goto out; } clnt_res = platform_get_resource(pdev, IORESOURCE_MEM, 0); if (!clnt_res) { pr_err("resource not found\n"); return -ENODEV; } ret = of_property_read_u32(pdev->dev.of_node, CLIENT_ID_PROP, &client_id); if (ret) { client_id = ((u32)~0U); pr_warn("qcom,client-id property not found\n"); } info = devm_kzalloc(&pdev->dev, sizeof(struct uio_info), GFP_KERNEL); if (!info) return -ENOMEM; shared_mem_size = resource_size(clnt_res); shared_mem_pyhsical = clnt_res->start; if (shared_mem_size == 0) { pr_err("Shared memory size is zero\n"); return -EINVAL; } if (shared_mem_pyhsical == 0) { is_addr_dynamic = true; shared_mem = dma_alloc_coherent(&pdev->dev, shared_mem_size, &shared_mem_pyhsical, GFP_KERNEL); if (shared_mem == NULL) { pr_err("Shared mem alloc client=%s, size=%u\n", clnt_res->name, shared_mem_size); return -ENOMEM; } } /* Set up the permissions for the shared ram that was allocated. */ setup_shared_ram_perms(client_id, shared_mem_pyhsical, shared_mem_size); /* Setup device */ info->mmap = sharedmem_mmap; /* Custom mmap function. */ info->name = clnt_res->name; info->version = "1.0"; info->mem[0].addr = shared_mem_pyhsical; info->mem[0].size = shared_mem_size; info->mem[0].memtype = UIO_MEM_PHYS; ret = uio_register_device(&pdev->dev, info); if (ret) { pr_err("uio register failed ret=%d\n", ret); goto out; } dev_set_drvdata(&pdev->dev, info); pr_info("Device created for client '%s'\n", clnt_res->name); out: return ret; } static int msm_sharedmem_remove(struct platform_device *pdev) { struct uio_info *info = dev_get_drvdata(&pdev->dev); uio_unregister_device(info); return 0; } static const struct of_device_id msm_sharedmem_of_match[] = { {.compatible = "qcom,sharedmem-uio",}, {}, }; MODULE_DEVICE_TABLE(of, msm_sharedmem_of_match); static struct platform_driver msm_sharedmem_driver = { .probe = msm_sharedmem_probe, .remove = msm_sharedmem_remove, .driver = { .name = DRIVER_NAME, .of_match_table = msm_sharedmem_of_match, }, }; static int __init msm_sharedmem_init(void) { int result; result = platform_driver_register(&msm_sharedmem_driver); if (result != 0) { pr_err("Platform driver registration failed\n"); return result; } return 0; } static void __exit msm_sharedmem_exit(void) { platform_driver_unregister(&msm_sharedmem_driver); } module_init(msm_sharedmem_init); module_exit(msm_sharedmem_exit); MODULE_LICENSE("GPL v2"); Loading
Documentation/devicetree/bindings/uio/msm_sharedmem.txt 0 → 100644 +18 −0 Original line number Diff line number Diff line msm_sharedmem provides the shared memory addresses for various clients in user-space Required properties: - compatible: Must be "qcom,sharedmem-uio" - reg : The address and size of the shared memory. The address/sizes may vary. A reg address of Zero indicates that the shared memory is dynamically allocated using dma_alloc_coherent. A non zero reg address is used directly. - reg-names : Indicates various client-names. - qcom,client-id : The client id for the QMI clients. Example: qcom,msm_sharedmem@0dc80000 { compatible = "qcom,sharedmem-uio"; reg = <0x0dc80000 0x00180000>, reg-names = "rmtfs"; qcom,client-id = <0x00000001>; };
drivers/uio/Kconfig +10 −0 Original line number Diff line number Diff line Loading @@ -164,4 +164,14 @@ config UIO_HV_GENERIC to network and storage devices from userspace. If you compile this as a module, it will be called uio_hv_generic. config UIO_MSM_SHAREDMEM bool "MSM shared memory driver" default n help Provides the clients with their respective alloted shared memory addresses which are used as transport buffer. If you don't know what to do here, say N. endif
drivers/uio/Makefile +1 −0 Original line number Diff line number Diff line Loading @@ -11,3 +11,4 @@ obj-$(CONFIG_UIO_PRUSS) += uio_pruss.o obj-$(CONFIG_UIO_MF624) += uio_mf624.o obj-$(CONFIG_UIO_FSL_ELBC_GPCM) += uio_fsl_elbc_gpcm.o obj-$(CONFIG_UIO_HV_GENERIC) += uio_hv_generic.o obj-$(CONFIG_UIO_MSM_SHAREDMEM) += msm_sharedmem/
drivers/uio/msm_sharedmem/Makefile 0 → 100644 +2 −0 Original line number Diff line number Diff line # SPDX-License-Identifier: GPL-2.0-only obj-$(CONFIG_UIO_MSM_SHAREDMEM) := msm_sharedmem.o
drivers/uio/msm_sharedmem/msm_sharedmem.c 0 → 100644 +214 −0 Original line number Diff line number Diff line // SPDX-License-Identifier: GPL-2.0-only /* * Copyright (c) 2015-2019, The Linux Foundation. All rights reserved. */ #define DRIVER_NAME "msm_sharedmem" #define pr_fmt(fmt) DRIVER_NAME ": %s: " fmt, __func__ #include <linux/uio_driver.h> #include <linux/module.h> #include <linux/platform_device.h> #include <linux/err.h> #include <linux/of.h> #include <linux/dma-mapping.h> #include <soc/qcom/secure_buffer.h> #define CLIENT_ID_PROP "qcom,client-id" #define MPSS_RMTS_CLIENT_ID 1 static int uio_get_mem_index(struct uio_info *info, struct vm_area_struct *vma) { if (vma->vm_pgoff >= MAX_UIO_MAPS) return -EINVAL; if (info->mem[vma->vm_pgoff].size == 0) return -EINVAL; return (int)vma->vm_pgoff; } static int sharedmem_mmap(struct uio_info *info, struct vm_area_struct *vma) { int result; struct uio_mem *mem; int mem_index = uio_get_mem_index(info, vma); if (mem_index < 0) { pr_err("mem_index is invalid errno %d\n", mem_index); return mem_index; } mem = info->mem + mem_index; if (vma->vm_end - vma->vm_start > mem->size) { pr_err("vm_end[%lu] - vm_start[%lu] [%lu] > mem->size[%pa]\n", vma->vm_end, vma->vm_start, (vma->vm_end - vma->vm_start), &mem->size); return -EINVAL; } pr_debug("Attempting to setup mmap.\n"); vma->vm_page_prot = pgprot_writecombine(vma->vm_page_prot); result = remap_pfn_range(vma, vma->vm_start, mem->addr >> PAGE_SHIFT, vma->vm_end - vma->vm_start, vma->vm_page_prot); if (result != 0) pr_err("mmap Failed with errno %d\n", result); else pr_debug("mmap success\n"); return result; } /* Setup the shared ram permissions. * This function currently supports the mpss client only. */ static void setup_shared_ram_perms(u32 client_id, phys_addr_t addr, u32 size) { int ret; u32 source_vmlist[1] = {VMID_HLOS}; int dest_vmids[2] = {VMID_HLOS, VMID_MSS_MSA}; int dest_perms[2] = {PERM_READ|PERM_WRITE, PERM_READ|PERM_WRITE}; if (client_id != MPSS_RMTS_CLIENT_ID) return; ret = hyp_assign_phys(addr, size, source_vmlist, 1, dest_vmids, dest_perms, 2); if (ret != 0) { if (ret == -EINVAL) pr_warn("hyp_assign_phys is not supported!\n"); else pr_err("hyp_assign_phys failed IPA=0x016%pa size=%u err=%d\n", &addr, size, ret); } } static int msm_sharedmem_probe(struct platform_device *pdev) { int ret = 0; struct uio_info *info = NULL; struct resource *clnt_res = NULL; u32 client_id = ((u32)~0U); u32 shared_mem_size = 0; void *shared_mem = NULL; phys_addr_t shared_mem_pyhsical = 0; bool is_addr_dynamic = false; /* Get the addresses from platform-data */ if (!pdev->dev.of_node) { pr_err("Node not found\n"); ret = -ENODEV; goto out; } clnt_res = platform_get_resource(pdev, IORESOURCE_MEM, 0); if (!clnt_res) { pr_err("resource not found\n"); return -ENODEV; } ret = of_property_read_u32(pdev->dev.of_node, CLIENT_ID_PROP, &client_id); if (ret) { client_id = ((u32)~0U); pr_warn("qcom,client-id property not found\n"); } info = devm_kzalloc(&pdev->dev, sizeof(struct uio_info), GFP_KERNEL); if (!info) return -ENOMEM; shared_mem_size = resource_size(clnt_res); shared_mem_pyhsical = clnt_res->start; if (shared_mem_size == 0) { pr_err("Shared memory size is zero\n"); return -EINVAL; } if (shared_mem_pyhsical == 0) { is_addr_dynamic = true; shared_mem = dma_alloc_coherent(&pdev->dev, shared_mem_size, &shared_mem_pyhsical, GFP_KERNEL); if (shared_mem == NULL) { pr_err("Shared mem alloc client=%s, size=%u\n", clnt_res->name, shared_mem_size); return -ENOMEM; } } /* Set up the permissions for the shared ram that was allocated. */ setup_shared_ram_perms(client_id, shared_mem_pyhsical, shared_mem_size); /* Setup device */ info->mmap = sharedmem_mmap; /* Custom mmap function. */ info->name = clnt_res->name; info->version = "1.0"; info->mem[0].addr = shared_mem_pyhsical; info->mem[0].size = shared_mem_size; info->mem[0].memtype = UIO_MEM_PHYS; ret = uio_register_device(&pdev->dev, info); if (ret) { pr_err("uio register failed ret=%d\n", ret); goto out; } dev_set_drvdata(&pdev->dev, info); pr_info("Device created for client '%s'\n", clnt_res->name); out: return ret; } static int msm_sharedmem_remove(struct platform_device *pdev) { struct uio_info *info = dev_get_drvdata(&pdev->dev); uio_unregister_device(info); return 0; } static const struct of_device_id msm_sharedmem_of_match[] = { {.compatible = "qcom,sharedmem-uio",}, {}, }; MODULE_DEVICE_TABLE(of, msm_sharedmem_of_match); static struct platform_driver msm_sharedmem_driver = { .probe = msm_sharedmem_probe, .remove = msm_sharedmem_remove, .driver = { .name = DRIVER_NAME, .of_match_table = msm_sharedmem_of_match, }, }; static int __init msm_sharedmem_init(void) { int result; result = platform_driver_register(&msm_sharedmem_driver); if (result != 0) { pr_err("Platform driver registration failed\n"); return result; } return 0; } static void __exit msm_sharedmem_exit(void) { platform_driver_unregister(&msm_sharedmem_driver); } module_init(msm_sharedmem_init); module_exit(msm_sharedmem_exit); MODULE_LICENSE("GPL v2");
