286 lines · c
1// SPDX-License-Identifier: (GPL-2.0+ OR BSD-3-Clause)2/*3 * Copyright 2013-2016 Freescale Semiconductor Inc.4 *5 */6 7#include <linux/io.h>8#include <linux/fsl/mc.h>9 10#include "fsl-mc-private.h"11 12static int fsl_mc_io_set_dpmcp(struct fsl_mc_io *mc_io,13 struct fsl_mc_device *dpmcp_dev)14{15 int error;16 17 if (mc_io->dpmcp_dev)18 return -EINVAL;19 20 if (dpmcp_dev->mc_io)21 return -EINVAL;22 23 error = dpmcp_open(mc_io,24 0,25 dpmcp_dev->obj_desc.id,26 &dpmcp_dev->mc_handle);27 if (error < 0)28 return error;29 30 mc_io->dpmcp_dev = dpmcp_dev;31 dpmcp_dev->mc_io = mc_io;32 return 0;33}34 35static void fsl_mc_io_unset_dpmcp(struct fsl_mc_io *mc_io)36{37 int error;38 struct fsl_mc_device *dpmcp_dev = mc_io->dpmcp_dev;39 40 error = dpmcp_close(mc_io,41 0,42 dpmcp_dev->mc_handle);43 if (error < 0) {44 dev_err(&dpmcp_dev->dev, "dpmcp_close() failed: %d\n",45 error);46 }47 48 mc_io->dpmcp_dev = NULL;49 dpmcp_dev->mc_io = NULL;50}51 52/**53 * fsl_create_mc_io() - Creates an MC I/O object54 *55 * @dev: device to be associated with the MC I/O object56 * @mc_portal_phys_addr: physical address of the MC portal to use57 * @mc_portal_size: size in bytes of the MC portal58 * @dpmcp_dev: Pointer to the DPMCP object associated with this MC I/O59 * object or NULL if none.60 * @flags: flags for the new MC I/O object61 * @new_mc_io: Area to return pointer to newly created MC I/O object62 *63 * Returns '0' on Success; Error code otherwise.64 */65int __must_check fsl_create_mc_io(struct device *dev,66 phys_addr_t mc_portal_phys_addr,67 u32 mc_portal_size,68 struct fsl_mc_device *dpmcp_dev,69 u32 flags, struct fsl_mc_io **new_mc_io)70{71 int error;72 struct fsl_mc_io *mc_io;73 void __iomem *mc_portal_virt_addr;74 struct resource *res;75 76 mc_io = devm_kzalloc(dev, sizeof(*mc_io), GFP_KERNEL);77 if (!mc_io)78 return -ENOMEM;79 80 mc_io->dev = dev;81 mc_io->flags = flags;82 mc_io->portal_phys_addr = mc_portal_phys_addr;83 mc_io->portal_size = mc_portal_size;84 if (flags & FSL_MC_IO_ATOMIC_CONTEXT_PORTAL)85 raw_spin_lock_init(&mc_io->spinlock);86 else87 mutex_init(&mc_io->mutex);88 89 res = devm_request_mem_region(dev,90 mc_portal_phys_addr,91 mc_portal_size,92 "mc_portal");93 if (!res) {94 dev_err(dev,95 "devm_request_mem_region failed for MC portal %pa\n",96 &mc_portal_phys_addr);97 return -EBUSY;98 }99 100 mc_portal_virt_addr = devm_ioremap(dev,101 mc_portal_phys_addr,102 mc_portal_size);103 if (!mc_portal_virt_addr) {104 dev_err(dev,105 "devm_ioremap failed for MC portal %pa\n",106 &mc_portal_phys_addr);107 return -ENXIO;108 }109 110 mc_io->portal_virt_addr = mc_portal_virt_addr;111 if (dpmcp_dev) {112 error = fsl_mc_io_set_dpmcp(mc_io, dpmcp_dev);113 if (error < 0)114 goto error_destroy_mc_io;115 }116 117 *new_mc_io = mc_io;118 return 0;119 120error_destroy_mc_io:121 fsl_destroy_mc_io(mc_io);122 return error;123}124 125/**126 * fsl_destroy_mc_io() - Destroys an MC I/O object127 *128 * @mc_io: MC I/O object to destroy129 */130void fsl_destroy_mc_io(struct fsl_mc_io *mc_io)131{132 struct fsl_mc_device *dpmcp_dev;133 134 if (!mc_io)135 return;136 137 dpmcp_dev = mc_io->dpmcp_dev;138 139 if (dpmcp_dev)140 fsl_mc_io_unset_dpmcp(mc_io);141 142 devm_iounmap(mc_io->dev, mc_io->portal_virt_addr);143 devm_release_mem_region(mc_io->dev,144 mc_io->portal_phys_addr,145 mc_io->portal_size);146 147 mc_io->portal_virt_addr = NULL;148 devm_kfree(mc_io->dev, mc_io);149}150 151/**152 * fsl_mc_portal_allocate - Allocates an MC portal153 *154 * @mc_dev: MC device for which the MC portal is to be allocated155 * @mc_io_flags: Flags for the fsl_mc_io object that wraps the allocated156 * MC portal.157 * @new_mc_io: Pointer to area where the pointer to the fsl_mc_io object158 * that wraps the allocated MC portal is to be returned159 *160 * This function allocates an MC portal from the device's parent DPRC,161 * from the corresponding MC bus' pool of MC portals and wraps162 * it in a new fsl_mc_io object. If 'mc_dev' is a DPRC itself, the163 * portal is allocated from its own MC bus.164 */165int __must_check fsl_mc_portal_allocate(struct fsl_mc_device *mc_dev,166 u16 mc_io_flags,167 struct fsl_mc_io **new_mc_io)168{169 struct fsl_mc_device *mc_bus_dev;170 struct fsl_mc_bus *mc_bus;171 phys_addr_t mc_portal_phys_addr;172 size_t mc_portal_size;173 struct fsl_mc_device *dpmcp_dev;174 int error = -EINVAL;175 struct fsl_mc_resource *resource = NULL;176 struct fsl_mc_io *mc_io = NULL;177 178 if (mc_dev->flags & FSL_MC_IS_DPRC) {179 mc_bus_dev = mc_dev;180 } else {181 if (!dev_is_fsl_mc(mc_dev->dev.parent))182 return error;183 184 mc_bus_dev = to_fsl_mc_device(mc_dev->dev.parent);185 }186 187 mc_bus = to_fsl_mc_bus(mc_bus_dev);188 *new_mc_io = NULL;189 error = fsl_mc_resource_allocate(mc_bus, FSL_MC_POOL_DPMCP, &resource);190 if (error < 0)191 return error;192 193 error = -EINVAL;194 dpmcp_dev = resource->data;195 196 if (dpmcp_dev->obj_desc.ver_major < DPMCP_MIN_VER_MAJOR ||197 (dpmcp_dev->obj_desc.ver_major == DPMCP_MIN_VER_MAJOR &&198 dpmcp_dev->obj_desc.ver_minor < DPMCP_MIN_VER_MINOR)) {199 dev_err(&dpmcp_dev->dev,200 "ERROR: Version %d.%d of DPMCP not supported.\n",201 dpmcp_dev->obj_desc.ver_major,202 dpmcp_dev->obj_desc.ver_minor);203 error = -ENOTSUPP;204 goto error_cleanup_resource;205 }206 207 mc_portal_phys_addr = dpmcp_dev->regions[0].start;208 mc_portal_size = resource_size(dpmcp_dev->regions);209 210 error = fsl_create_mc_io(&mc_bus_dev->dev,211 mc_portal_phys_addr,212 mc_portal_size, dpmcp_dev,213 mc_io_flags, &mc_io);214 if (error < 0)215 goto error_cleanup_resource;216 217 dpmcp_dev->consumer_link = device_link_add(&mc_dev->dev,218 &dpmcp_dev->dev,219 DL_FLAG_AUTOREMOVE_CONSUMER);220 if (!dpmcp_dev->consumer_link) {221 error = -EINVAL;222 goto error_cleanup_mc_io;223 }224 225 *new_mc_io = mc_io;226 return 0;227 228error_cleanup_mc_io:229 fsl_destroy_mc_io(mc_io);230error_cleanup_resource:231 fsl_mc_resource_free(resource);232 return error;233}234EXPORT_SYMBOL_GPL(fsl_mc_portal_allocate);235 236/**237 * fsl_mc_portal_free - Returns an MC portal to the pool of free MC portals238 * of a given MC bus239 *240 * @mc_io: Pointer to the fsl_mc_io object that wraps the MC portal to free241 */242void fsl_mc_portal_free(struct fsl_mc_io *mc_io)243{244 struct fsl_mc_device *dpmcp_dev;245 struct fsl_mc_resource *resource;246 247 /*248 * Every mc_io obtained by calling fsl_mc_portal_allocate() is supposed249 * to have a DPMCP object associated with.250 */251 dpmcp_dev = mc_io->dpmcp_dev;252 253 resource = dpmcp_dev->resource;254 if (!resource || resource->type != FSL_MC_POOL_DPMCP)255 return;256 257 if (resource->data != dpmcp_dev)258 return;259 260 fsl_destroy_mc_io(mc_io);261 fsl_mc_resource_free(resource);262 263 dpmcp_dev->consumer_link = NULL;264}265EXPORT_SYMBOL_GPL(fsl_mc_portal_free);266 267/**268 * fsl_mc_portal_reset - Resets the dpmcp object for a given fsl_mc_io object269 *270 * @mc_io: Pointer to the fsl_mc_io object that wraps the MC portal to free271 */272int fsl_mc_portal_reset(struct fsl_mc_io *mc_io)273{274 int error;275 struct fsl_mc_device *dpmcp_dev = mc_io->dpmcp_dev;276 277 error = dpmcp_reset(mc_io, 0, dpmcp_dev->mc_handle);278 if (error < 0) {279 dev_err(&dpmcp_dev->dev, "dpmcp_reset() failed: %d\n", error);280 return error;281 }282 283 return 0;284}285EXPORT_SYMBOL_GPL(fsl_mc_portal_reset);286