1 // SPDX-License-Identifier: (GPL-2.0+ OR BSD-3-Clause)
3  * Copyright 2013-2016 Freescale Semiconductor Inc.
8 #include <linux/fsl/mc.h>
10 #include "fsl-mc-private.h"
17 	if (mc_io->dpmcp_dev)  in fsl_mc_io_set_dpmcp()
18 		return -EINVAL;  in fsl_mc_io_set_dpmcp()
20 	if (dpmcp_dev->mc_io)  in fsl_mc_io_set_dpmcp()
21 		return -EINVAL;  in fsl_mc_io_set_dpmcp()
25 			   dpmcp_dev->obj_desc.id,  in fsl_mc_io_set_dpmcp()
26 			   &dpmcp_dev->mc_handle);  in fsl_mc_io_set_dpmcp()
30 	mc_io->dpmcp_dev = dpmcp_dev;  in fsl_mc_io_set_dpmcp()
31 	dpmcp_dev->mc_io = mc_io;  in fsl_mc_io_set_dpmcp()
38 	struct fsl_mc_device *dpmcp_dev = mc_io->dpmcp_dev;  in fsl_mc_io_unset_dpmcp()
42 			    dpmcp_dev->mc_handle);  in fsl_mc_io_unset_dpmcp()
44 		dev_err(&dpmcp_dev->dev, "dpmcp_close() failed: %d\n",  in fsl_mc_io_unset_dpmcp()
48 	mc_io->dpmcp_dev = NULL;  in fsl_mc_io_unset_dpmcp()
49 	dpmcp_dev->mc_io = NULL;  in fsl_mc_io_unset_dpmcp()
53  * fsl_create_mc_io() - Creates an MC I/O object
55  * @dev: device to be associated with the MC I/O object
56  * @mc_portal_phys_addr: physical address of the MC portal to use
57  * @mc_portal_size: size in bytes of the MC portal
58  * @dpmcp_dev: Pointer to the DPMCP object associated with this MC I/O
60  * @flags: flags for the new MC I/O object
61  * @new_mc_io: Area to return pointer to newly created MC I/O object
78 		return -ENOMEM;  in fsl_create_mc_io()
80 	mc_io->dev = dev;  in fsl_create_mc_io()
81 	mc_io->flags = flags;  in fsl_create_mc_io()
82 	mc_io->portal_phys_addr = mc_portal_phys_addr;  in fsl_create_mc_io()
83 	mc_io->portal_size = mc_portal_size;  in fsl_create_mc_io()
85 		raw_spin_lock_init(&mc_io->spinlock);  in fsl_create_mc_io()
87 		mutex_init(&mc_io->mutex);  in fsl_create_mc_io()
95 			"devm_request_mem_region failed for MC portal %pa\n",  in fsl_create_mc_io()
97 		return -EBUSY;  in fsl_create_mc_io()
105 			"devm_ioremap failed for MC portal %pa\n",  in fsl_create_mc_io()
107 		return -ENXIO;  in fsl_create_mc_io()
110 	mc_io->portal_virt_addr = mc_portal_virt_addr;  in fsl_create_mc_io()
126  * fsl_destroy_mc_io() - Destroys an MC I/O object
128  * @mc_io: MC I/O object to destroy
137 	dpmcp_dev = mc_io->dpmcp_dev;  in fsl_destroy_mc_io()
142 	devm_iounmap(mc_io->dev, mc_io->portal_virt_addr);  in fsl_destroy_mc_io()
143 	devm_release_mem_region(mc_io->dev,  in fsl_destroy_mc_io()
144 				mc_io->portal_phys_addr,  in fsl_destroy_mc_io()
145 				mc_io->portal_size);  in fsl_destroy_mc_io()
147 	mc_io->portal_virt_addr = NULL;  in fsl_destroy_mc_io()
148 	devm_kfree(mc_io->dev, mc_io);  in fsl_destroy_mc_io()
152  * fsl_mc_portal_allocate - Allocates an MC portal
154  * @mc_dev: MC device for which the MC portal is to be allocated
156  * MC portal.
158  * that wraps the allocated MC portal is to be returned
160  * This function allocates an MC portal from the device's parent DPRC,
161  * from the corresponding MC bus' pool of MC portals and wraps
163  * portal is allocated from its own MC bus.
174 	int error = -EINVAL;  in fsl_mc_portal_allocate()
178 	if (mc_dev->flags & FSL_MC_IS_DPRC) {  in fsl_mc_portal_allocate()
181 		if (!dev_is_fsl_mc(mc_dev->dev.parent))  in fsl_mc_portal_allocate()
184 		mc_bus_dev = to_fsl_mc_device(mc_dev->dev.parent);  in fsl_mc_portal_allocate()
193 	error = -EINVAL;  in fsl_mc_portal_allocate()
194 	dpmcp_dev = resource->data;  in fsl_mc_portal_allocate()
196 	if (dpmcp_dev->obj_desc.ver_major < DPMCP_MIN_VER_MAJOR ||  in fsl_mc_portal_allocate()
197 	    (dpmcp_dev->obj_desc.ver_major == DPMCP_MIN_VER_MAJOR &&  in fsl_mc_portal_allocate()
198 	     dpmcp_dev->obj_desc.ver_minor < DPMCP_MIN_VER_MINOR)) {  in fsl_mc_portal_allocate()
199 		dev_err(&dpmcp_dev->dev,  in fsl_mc_portal_allocate()
201 			dpmcp_dev->obj_desc.ver_major,  in fsl_mc_portal_allocate()
202 			dpmcp_dev->obj_desc.ver_minor);  in fsl_mc_portal_allocate()
203 		error = -ENOTSUPP;  in fsl_mc_portal_allocate()
207 	mc_portal_phys_addr = dpmcp_dev->regions[0].start;  in fsl_mc_portal_allocate()
208 	mc_portal_size = resource_size(dpmcp_dev->regions);  in fsl_mc_portal_allocate()
210 	error = fsl_create_mc_io(&mc_bus_dev->dev,  in fsl_mc_portal_allocate()
217 	dpmcp_dev->consumer_link = device_link_add(&mc_dev->dev,  in fsl_mc_portal_allocate()
218 						   &dpmcp_dev->dev,  in fsl_mc_portal_allocate()
220 	if (!dpmcp_dev->consumer_link) {  in fsl_mc_portal_allocate()
221 		error = -EINVAL;  in fsl_mc_portal_allocate()
237  * fsl_mc_portal_free - Returns an MC portal to the pool of free MC portals
238  * of a given MC bus
240  * @mc_io: Pointer to the fsl_mc_io object that wraps the MC portal to free
251 	dpmcp_dev = mc_io->dpmcp_dev;  in fsl_mc_portal_free()
253 	resource = dpmcp_dev->resource;  in fsl_mc_portal_free()
254 	if (!resource || resource->type != FSL_MC_POOL_DPMCP)  in fsl_mc_portal_free()
257 	if (resource->data != dpmcp_dev)  in fsl_mc_portal_free()
263 	dpmcp_dev->consumer_link = NULL;  in fsl_mc_portal_free()
268  * fsl_mc_portal_reset - Resets the dpmcp object for a given fsl_mc_io object
270  * @mc_io: Pointer to the fsl_mc_io object that wraps the MC portal to free
275 	struct fsl_mc_device *dpmcp_dev = mc_io->dpmcp_dev;  in fsl_mc_portal_reset()
277 	error = dpmcp_reset(mc_io, 0, dpmcp_dev->mc_handle);  in fsl_mc_portal_reset()
279 		dev_err(&dpmcp_dev->dev, "dpmcp_reset() failed: %d\n", error);  in fsl_mc_portal_reset()