1 // SPDX-License-Identifier: GPL-2.0-only
13 #include <linux/dma-mapping.h>
54 		return sprintf(buf, "%pa\n", &rmtfs_mem->addr);  in qcom_rmtfs_mem_show()
56 		return sprintf(buf, "%pa\n", &rmtfs_mem->size);  in qcom_rmtfs_mem_show()
58 		return sprintf(buf, "%d\n", rmtfs_mem->client_id);  in qcom_rmtfs_mem_show()
60 	return -EINVAL;  in qcom_rmtfs_mem_show()
73 	struct qcom_rmtfs_mem *rmtfs_mem = container_of(inode->i_cdev,  in qcom_rmtfs_mem_open()
77 	get_device(&rmtfs_mem->dev);  in qcom_rmtfs_mem_open()
78 	filp->private_data = rmtfs_mem;  in qcom_rmtfs_mem_open()
85 	struct qcom_rmtfs_mem *rmtfs_mem = filp->private_data;  in qcom_rmtfs_mem_read()
87 	if (*f_pos >= rmtfs_mem->size)  in qcom_rmtfs_mem_read()
90 	if (*f_pos + count >= rmtfs_mem->size)  in qcom_rmtfs_mem_read()
91 		count = rmtfs_mem->size - *f_pos;  in qcom_rmtfs_mem_read()
93 	if (copy_to_user(buf, rmtfs_mem->base + *f_pos, count))  in qcom_rmtfs_mem_read()
94 		return -EFAULT;  in qcom_rmtfs_mem_read()
104 	struct qcom_rmtfs_mem *rmtfs_mem = filp->private_data;  in qcom_rmtfs_mem_write()
106 	if (*f_pos >= rmtfs_mem->size)  in qcom_rmtfs_mem_write()
109 	if (*f_pos + count >= rmtfs_mem->size)  in qcom_rmtfs_mem_write()
110 		count = rmtfs_mem->size - *f_pos;  in qcom_rmtfs_mem_write()
112 	if (copy_from_user(rmtfs_mem->base + *f_pos, buf, count))  in qcom_rmtfs_mem_write()
113 		return -EFAULT;  in qcom_rmtfs_mem_write()
121 	struct qcom_rmtfs_mem *rmtfs_mem = filp->private_data;  in qcom_rmtfs_mem_release()
123 	put_device(&rmtfs_mem->dev);  in qcom_rmtfs_mem_release()
129 	.name           = "rmtfs",
134 	struct qcom_rmtfs_mem *rmtfs_mem = filep->private_data;  in qcom_rmtfs_mem_mmap()
136 	if (vma->vm_end - vma->vm_start > rmtfs_mem->size) {  in qcom_rmtfs_mem_mmap()
137 		dev_dbg(&rmtfs_mem->dev,  in qcom_rmtfs_mem_mmap()
138 			"vm_end[%lu] - vm_start[%lu] [%lu] > mem->size[%pa]\n",  in qcom_rmtfs_mem_mmap()
139 			vma->vm_end, vma->vm_start,  in qcom_rmtfs_mem_mmap()
140 			(vma->vm_end - vma->vm_start), &rmtfs_mem->size);  in qcom_rmtfs_mem_mmap()
141 		return -EINVAL;  in qcom_rmtfs_mem_mmap()
144 	vma->vm_page_prot = pgprot_writecombine(vma->vm_page_prot);  in qcom_rmtfs_mem_mmap()
146 			       vma->vm_start,  in qcom_rmtfs_mem_mmap()
147 			       rmtfs_mem->addr >> PAGE_SHIFT,  in qcom_rmtfs_mem_mmap()
148 			       vma->vm_end - vma->vm_start,  in qcom_rmtfs_mem_mmap()
149 			       vma->vm_page_prot);  in qcom_rmtfs_mem_mmap()
173 	struct device_node *node = pdev->dev.of_node;  in qcom_rmtfs_mem_probe()
184 		dev_err(&pdev->dev, "failed to acquire memory region\n");  in qcom_rmtfs_mem_probe()
185 		return -EINVAL;  in qcom_rmtfs_mem_probe()
188 	ret = of_property_read_u32(node, "qcom,client-id", &client_id);  in qcom_rmtfs_mem_probe()
190 		dev_err(&pdev->dev, "failed to parse \"qcom,client-id\"\n");  in qcom_rmtfs_mem_probe()
197 		return -ENOMEM;  in qcom_rmtfs_mem_probe()
199 	rmtfs_mem->addr = rmem->base;  in qcom_rmtfs_mem_probe()
200 	rmtfs_mem->client_id = client_id;  in qcom_rmtfs_mem_probe()
201 	rmtfs_mem->size = rmem->size;  in qcom_rmtfs_mem_probe()
203 	device_initialize(&rmtfs_mem->dev);  in qcom_rmtfs_mem_probe()
204 	rmtfs_mem->dev.parent = &pdev->dev;  in qcom_rmtfs_mem_probe()
205 	rmtfs_mem->dev.groups = qcom_rmtfs_mem_groups;  in qcom_rmtfs_mem_probe()
206 	rmtfs_mem->dev.release = qcom_rmtfs_mem_release_device;  in qcom_rmtfs_mem_probe()
208 	rmtfs_mem->base = devm_memremap(&rmtfs_mem->dev, rmtfs_mem->addr,  in qcom_rmtfs_mem_probe()
209 					rmtfs_mem->size, MEMREMAP_WC);  in qcom_rmtfs_mem_probe()
210 	if (IS_ERR(rmtfs_mem->base)) {  in qcom_rmtfs_mem_probe()
211 		dev_err(&pdev->dev, "failed to remap rmtfs_mem region\n");  in qcom_rmtfs_mem_probe()
212 		ret = PTR_ERR(rmtfs_mem->base);  in qcom_rmtfs_mem_probe()
216 	cdev_init(&rmtfs_mem->cdev, &qcom_rmtfs_mem_fops);  in qcom_rmtfs_mem_probe()
217 	rmtfs_mem->cdev.owner = THIS_MODULE;  in qcom_rmtfs_mem_probe()
219 	dev_set_name(&rmtfs_mem->dev, "qcom_rmtfs_mem%d", client_id);  in qcom_rmtfs_mem_probe()
220 	rmtfs_mem->dev.id = client_id;  in qcom_rmtfs_mem_probe()
221 	rmtfs_mem->dev.class = &rmtfs_class;  in qcom_rmtfs_mem_probe()
222 	rmtfs_mem->dev.devt = MKDEV(MAJOR(qcom_rmtfs_mem_major), client_id);  in qcom_rmtfs_mem_probe()
224 	ret = cdev_device_add(&rmtfs_mem->cdev, &rmtfs_mem->dev);  in qcom_rmtfs_mem_probe()
226 		dev_err(&pdev->dev, "failed to add cdev: %d\n", ret);  in qcom_rmtfs_mem_probe()
231 	if (num_vmids == -EINVAL) {  in qcom_rmtfs_mem_probe()
235 		dev_err(&pdev->dev, "failed to count qcom,vmid elements: %d\n", num_vmids);  in qcom_rmtfs_mem_probe()
239 		dev_warn(&pdev->dev,  in qcom_rmtfs_mem_probe()
246 	if (ret < 0 && ret != -EINVAL) {  in qcom_rmtfs_mem_probe()
247 		dev_err(&pdev->dev, "failed to parse qcom,vmid\n");  in qcom_rmtfs_mem_probe()
251 			ret = -EPROBE_DEFER;  in qcom_rmtfs_mem_probe()
263 		rmtfs_mem->perms = BIT(QCOM_SCM_VMID_HLOS);  in qcom_rmtfs_mem_probe()
264 		ret = qcom_scm_assign_mem(rmtfs_mem->addr, rmtfs_mem->size,  in qcom_rmtfs_mem_probe()
265 					  &rmtfs_mem->perms, perms, num_vmids + 1);  in qcom_rmtfs_mem_probe()
267 			dev_err(&pdev->dev, "assign memory failed\n");  in qcom_rmtfs_mem_probe()
272 	dev_set_drvdata(&pdev->dev, rmtfs_mem);  in qcom_rmtfs_mem_probe()
277 	cdev_device_del(&rmtfs_mem->cdev, &rmtfs_mem->dev);  in qcom_rmtfs_mem_probe()
279 	put_device(&rmtfs_mem->dev);  in qcom_rmtfs_mem_probe()
286 	struct qcom_rmtfs_mem *rmtfs_mem = dev_get_drvdata(&pdev->dev);  in qcom_rmtfs_mem_remove()
289 	if (rmtfs_mem->perms) {  in qcom_rmtfs_mem_remove()
293 		qcom_scm_assign_mem(rmtfs_mem->addr, rmtfs_mem->size,  in qcom_rmtfs_mem_remove()
294 				    &rmtfs_mem->perms, &perm, 1);  in qcom_rmtfs_mem_remove()
297 	cdev_device_del(&rmtfs_mem->cdev, &rmtfs_mem->dev);  in qcom_rmtfs_mem_remove()
298 	put_device(&rmtfs_mem->dev);  in qcom_rmtfs_mem_remove()
304 	{ .compatible = "qcom,rmtfs-mem" },