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 
fsl_mc_io_set_dpmcp(struct fsl_mc_io * mc_io,struct fsl_mc_device * dpmcp_dev)12 static 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 
fsl_mc_io_unset_dpmcp(struct fsl_mc_io * mc_io)35 static 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 object
54  *
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
59  * object or NULL if none.
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
62  *
63  * Returns '0' on Success; Error code otherwise.
64  */
fsl_create_mc_io(struct device * dev,phys_addr_t mc_portal_phys_addr,u32 mc_portal_size,struct fsl_mc_device * dpmcp_dev,u32 flags,struct fsl_mc_io ** new_mc_io)65 int __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 	else
87 		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 
120 error_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 object
127  *
128  * @mc_io: MC I/O object to destroy
129  */
fsl_destroy_mc_io(struct fsl_mc_io * mc_io)130 void 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 portal
153  *
154  * @mc_dev: MC device for which the MC portal is to be allocated
155  * @mc_io_flags: Flags for the fsl_mc_io object that wraps the allocated
156  * MC portal.
157  * @new_mc_io: Pointer to area where the pointer to the fsl_mc_io object
158  * that wraps the allocated MC portal is to be returned
159  *
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
162  * it in a new fsl_mc_io object. If 'mc_dev' is a DPRC itself, the
163  * portal is allocated from its own MC bus.
164  */
fsl_mc_portal_allocate(struct fsl_mc_device * mc_dev,u16 mc_io_flags,struct fsl_mc_io ** new_mc_io)165 int __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 
228 error_cleanup_mc_io:
229 	fsl_destroy_mc_io(mc_io);
230 error_cleanup_resource:
231 	fsl_mc_resource_free(resource);
232 	return error;
233 }
234 EXPORT_SYMBOL_GPL(fsl_mc_portal_allocate);
235 
236 /**
237  * fsl_mc_portal_free - Returns an MC portal to the pool of free MC portals
238  * of a given MC bus
239  *
240  * @mc_io: Pointer to the fsl_mc_io object that wraps the MC portal to free
241  */
fsl_mc_portal_free(struct fsl_mc_io * mc_io)242 void 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 supposed
249 	 * 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 }
265 EXPORT_SYMBOL_GPL(fsl_mc_portal_free);
266 
267 /**
268  * fsl_mc_portal_reset - Resets the dpmcp object for a given fsl_mc_io object
269  *
270  * @mc_io: Pointer to the fsl_mc_io object that wraps the MC portal to free
271  */
fsl_mc_portal_reset(struct fsl_mc_io * mc_io)272 int 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 }
285 EXPORT_SYMBOL_GPL(fsl_mc_portal_reset);
286