1 // SPDX-License-Identifier: GPL-2.0
2 /*
3 * Freescale data path resource container (DPRC) driver
4 *
5 * Copyright (C) 2014-2016 Freescale Semiconductor, Inc.
6 * Copyright 2019-2020 NXP
7 * Author: German Rivera <German.Rivera@freescale.com>
8 *
9 */
10
11 #include <linux/module.h>
12 #include <linux/slab.h>
13 #include <linux/interrupt.h>
14 #include <linux/fsl/mc.h>
15
16 #include "fsl-mc-private.h"
17
18 #define FSL_MC_DPRC_DRIVER_NAME "fsl_mc_dprc"
19
20 struct fsl_mc_child_objs {
21 int child_count;
22 struct fsl_mc_obj_desc *child_array;
23 };
24
fsl_mc_device_match(struct fsl_mc_device * mc_dev,struct fsl_mc_obj_desc * obj_desc)25 static bool fsl_mc_device_match(struct fsl_mc_device *mc_dev,
26 struct fsl_mc_obj_desc *obj_desc)
27 {
28 return mc_dev->obj_desc.id == obj_desc->id &&
29 strcmp(mc_dev->obj_desc.type, obj_desc->type) == 0;
30 }
31
fsl_mc_obj_desc_is_allocatable(struct fsl_mc_obj_desc * obj)32 static bool fsl_mc_obj_desc_is_allocatable(struct fsl_mc_obj_desc *obj)
33 {
34 if (strcmp(obj->type, "dpmcp") == 0 ||
35 strcmp(obj->type, "dpcon") == 0 ||
36 strcmp(obj->type, "dpbp") == 0)
37 return true;
38 else
39 return false;
40 }
41
__fsl_mc_device_remove_if_not_in_mc(struct device * dev,void * data)42 static int __fsl_mc_device_remove_if_not_in_mc(struct device *dev, void *data)
43 {
44 int i;
45 struct fsl_mc_child_objs *objs;
46 struct fsl_mc_device *mc_dev;
47
48 if (!dev_is_fsl_mc(dev))
49 return 0;
50
51 mc_dev = to_fsl_mc_device(dev);
52 objs = data;
53
54 for (i = 0; i < objs->child_count; i++) {
55 struct fsl_mc_obj_desc *obj_desc = &objs->child_array[i];
56
57 if (strlen(obj_desc->type) != 0 &&
58 fsl_mc_device_match(mc_dev, obj_desc))
59 break;
60 }
61
62 if (i == objs->child_count)
63 fsl_mc_device_remove(mc_dev);
64
65 return 0;
66 }
67
__fsl_mc_device_remove(struct device * dev,void * data)68 static int __fsl_mc_device_remove(struct device *dev, void *data)
69 {
70 if (!dev_is_fsl_mc(dev))
71 return 0;
72
73 fsl_mc_device_remove(to_fsl_mc_device(dev));
74 return 0;
75 }
76
77 /**
78 * dprc_remove_devices - Removes devices for objects removed from a DPRC
79 *
80 * @mc_bus_dev: pointer to the fsl-mc device that represents a DPRC object
81 * @obj_desc_array: array of object descriptors for child objects currently
82 * present in the DPRC in the MC.
83 * @num_child_objects_in_mc: number of entries in obj_desc_array
84 *
85 * Synchronizes the state of the Linux bus driver with the actual state of
86 * the MC by removing devices that represent MC objects that have
87 * been dynamically removed in the physical DPRC.
88 */
dprc_remove_devices(struct fsl_mc_device * mc_bus_dev,struct fsl_mc_obj_desc * obj_desc_array,int num_child_objects_in_mc)89 void dprc_remove_devices(struct fsl_mc_device *mc_bus_dev,
90 struct fsl_mc_obj_desc *obj_desc_array,
91 int num_child_objects_in_mc)
92 {
93 if (num_child_objects_in_mc != 0) {
94 /*
95 * Remove child objects that are in the DPRC in Linux,
96 * but not in the MC:
97 */
98 struct fsl_mc_child_objs objs;
99
100 objs.child_count = num_child_objects_in_mc;
101 objs.child_array = obj_desc_array;
102 device_for_each_child(&mc_bus_dev->dev, &objs,
103 __fsl_mc_device_remove_if_not_in_mc);
104 } else {
105 /*
106 * There are no child objects for this DPRC in the MC.
107 * So, remove all the child devices from Linux:
108 */
109 device_for_each_child(&mc_bus_dev->dev, NULL,
110 __fsl_mc_device_remove);
111 }
112 }
113 EXPORT_SYMBOL_GPL(dprc_remove_devices);
114
__fsl_mc_device_match(struct device * dev,void * data)115 static int __fsl_mc_device_match(struct device *dev, void *data)
116 {
117 struct fsl_mc_obj_desc *obj_desc = data;
118 struct fsl_mc_device *mc_dev = to_fsl_mc_device(dev);
119
120 return fsl_mc_device_match(mc_dev, obj_desc);
121 }
122
fsl_mc_device_lookup(struct fsl_mc_obj_desc * obj_desc,struct fsl_mc_device * mc_bus_dev)123 struct fsl_mc_device *fsl_mc_device_lookup(struct fsl_mc_obj_desc *obj_desc,
124 struct fsl_mc_device *mc_bus_dev)
125 {
126 struct device *dev;
127
128 dev = device_find_child(&mc_bus_dev->dev, obj_desc,
129 __fsl_mc_device_match);
130
131 return dev ? to_fsl_mc_device(dev) : NULL;
132 }
133
134 /**
135 * check_plugged_state_change - Check change in an MC object's plugged state
136 *
137 * @mc_dev: pointer to the fsl-mc device for a given MC object
138 * @obj_desc: pointer to the MC object's descriptor in the MC
139 *
140 * If the plugged state has changed from unplugged to plugged, the fsl-mc
141 * device is bound to the corresponding device driver.
142 * If the plugged state has changed from plugged to unplugged, the fsl-mc
143 * device is unbound from the corresponding device driver.
144 */
check_plugged_state_change(struct fsl_mc_device * mc_dev,struct fsl_mc_obj_desc * obj_desc)145 static void check_plugged_state_change(struct fsl_mc_device *mc_dev,
146 struct fsl_mc_obj_desc *obj_desc)
147 {
148 int error;
149 u32 plugged_flag_at_mc =
150 obj_desc->state & FSL_MC_OBJ_STATE_PLUGGED;
151
152 if (plugged_flag_at_mc !=
153 (mc_dev->obj_desc.state & FSL_MC_OBJ_STATE_PLUGGED)) {
154 if (plugged_flag_at_mc) {
155 mc_dev->obj_desc.state |= FSL_MC_OBJ_STATE_PLUGGED;
156 error = device_attach(&mc_dev->dev);
157 if (error < 0) {
158 dev_err(&mc_dev->dev,
159 "device_attach() failed: %d\n",
160 error);
161 }
162 } else {
163 mc_dev->obj_desc.state &= ~FSL_MC_OBJ_STATE_PLUGGED;
164 device_release_driver(&mc_dev->dev);
165 }
166 }
167 }
168
fsl_mc_obj_device_add(struct fsl_mc_device * mc_bus_dev,struct fsl_mc_obj_desc * obj_desc)169 static void fsl_mc_obj_device_add(struct fsl_mc_device *mc_bus_dev,
170 struct fsl_mc_obj_desc *obj_desc)
171 {
172 int error;
173 struct fsl_mc_device *child_dev;
174
175 /*
176 * Check if device is already known to Linux:
177 */
178 child_dev = fsl_mc_device_lookup(obj_desc, mc_bus_dev);
179 if (child_dev) {
180 check_plugged_state_change(child_dev, obj_desc);
181 put_device(&child_dev->dev);
182 } else {
183 error = fsl_mc_device_add(obj_desc, NULL, &mc_bus_dev->dev,
184 &child_dev);
185 if (error < 0)
186 return;
187 }
188 }
189
190 /**
191 * dprc_add_new_devices - Adds devices to the logical bus for a DPRC
192 *
193 * @mc_bus_dev: pointer to the fsl-mc device that represents a DPRC object
194 * @obj_desc_array: array of device descriptors for child devices currently
195 * present in the physical DPRC.
196 * @num_child_objects_in_mc: number of entries in obj_desc_array
197 *
198 * Synchronizes the state of the Linux bus driver with the actual
199 * state of the MC by adding objects that have been newly discovered
200 * in the physical DPRC.
201 */
dprc_add_new_devices(struct fsl_mc_device * mc_bus_dev,struct fsl_mc_obj_desc * obj_desc_array,int num_child_objects_in_mc)202 static void dprc_add_new_devices(struct fsl_mc_device *mc_bus_dev,
203 struct fsl_mc_obj_desc *obj_desc_array,
204 int num_child_objects_in_mc)
205 {
206 int i;
207
208 /* probe the allocable objects first */
209 for (i = 0; i < num_child_objects_in_mc; i++) {
210 struct fsl_mc_obj_desc *obj_desc = &obj_desc_array[i];
211
212 if (strlen(obj_desc->type) > 0 &&
213 fsl_mc_obj_desc_is_allocatable(obj_desc))
214 fsl_mc_obj_device_add(mc_bus_dev, obj_desc);
215 }
216
217 for (i = 0; i < num_child_objects_in_mc; i++) {
218 struct fsl_mc_obj_desc *obj_desc = &obj_desc_array[i];
219
220 if (strlen(obj_desc->type) > 0 &&
221 !fsl_mc_obj_desc_is_allocatable(obj_desc))
222 fsl_mc_obj_device_add(mc_bus_dev, obj_desc);
223 }
224 }
225
226 /**
227 * dprc_scan_objects - Discover objects in a DPRC
228 *
229 * @mc_bus_dev: pointer to the fsl-mc device that represents a DPRC object
230 * @alloc_interrupts: if true the function allocates the interrupt pool,
231 * otherwise the interrupt allocation is delayed
232 *
233 * Detects objects added and removed from a DPRC and synchronizes the
234 * state of the Linux bus driver, MC by adding and removing
235 * devices accordingly.
236 * Two types of devices can be found in a DPRC: allocatable objects (e.g.,
237 * dpbp, dpmcp) and non-allocatable devices (e.g., dprc, dpni).
238 * All allocatable devices needed to be probed before all non-allocatable
239 * devices, to ensure that device drivers for non-allocatable
240 * devices can allocate any type of allocatable devices.
241 * That is, we need to ensure that the corresponding resource pools are
242 * populated before they can get allocation requests from probe callbacks
243 * of the device drivers for the non-allocatable devices.
244 */
dprc_scan_objects(struct fsl_mc_device * mc_bus_dev,bool alloc_interrupts)245 int dprc_scan_objects(struct fsl_mc_device *mc_bus_dev,
246 bool alloc_interrupts)
247 {
248 int num_child_objects;
249 int dprc_get_obj_failures;
250 int error;
251 unsigned int irq_count = mc_bus_dev->obj_desc.irq_count;
252 struct fsl_mc_obj_desc *child_obj_desc_array = NULL;
253 struct fsl_mc_bus *mc_bus = to_fsl_mc_bus(mc_bus_dev);
254
255 error = dprc_get_obj_count(mc_bus_dev->mc_io,
256 0,
257 mc_bus_dev->mc_handle,
258 &num_child_objects);
259 if (error < 0) {
260 dev_err(&mc_bus_dev->dev, "dprc_get_obj_count() failed: %d\n",
261 error);
262 return error;
263 }
264
265 if (num_child_objects != 0) {
266 int i;
267
268 child_obj_desc_array =
269 devm_kmalloc_array(&mc_bus_dev->dev, num_child_objects,
270 sizeof(*child_obj_desc_array),
271 GFP_KERNEL);
272 if (!child_obj_desc_array)
273 return -ENOMEM;
274
275 /*
276 * Discover objects currently present in the physical DPRC:
277 */
278 dprc_get_obj_failures = 0;
279 for (i = 0; i < num_child_objects; i++) {
280 struct fsl_mc_obj_desc *obj_desc =
281 &child_obj_desc_array[i];
282
283 error = dprc_get_obj(mc_bus_dev->mc_io,
284 0,
285 mc_bus_dev->mc_handle,
286 i, obj_desc);
287 if (error < 0) {
288 dev_err(&mc_bus_dev->dev,
289 "dprc_get_obj(i=%d) failed: %d\n",
290 i, error);
291 /*
292 * Mark the obj entry as "invalid", by using the
293 * empty string as obj type:
294 */
295 obj_desc->type[0] = '\0';
296 obj_desc->id = error;
297 dprc_get_obj_failures++;
298 continue;
299 }
300
301 /*
302 * add a quirk for all versions of dpsec < 4.0...none
303 * are coherent regardless of what the MC reports.
304 */
305 if ((strcmp(obj_desc->type, "dpseci") == 0) &&
306 (obj_desc->ver_major < 4))
307 obj_desc->flags |=
308 FSL_MC_OBJ_FLAG_NO_MEM_SHAREABILITY;
309
310 irq_count += obj_desc->irq_count;
311 dev_dbg(&mc_bus_dev->dev,
312 "Discovered object: type %s, id %d\n",
313 obj_desc->type, obj_desc->id);
314 }
315
316 if (dprc_get_obj_failures != 0) {
317 dev_err(&mc_bus_dev->dev,
318 "%d out of %d devices could not be retrieved\n",
319 dprc_get_obj_failures, num_child_objects);
320 }
321 }
322
323 /*
324 * Allocate IRQ's before binding the scanned devices with their
325 * respective drivers.
326 */
327 if (dev_get_msi_domain(&mc_bus_dev->dev)) {
328 if (irq_count > FSL_MC_IRQ_POOL_MAX_TOTAL_IRQS) {
329 dev_warn(&mc_bus_dev->dev,
330 "IRQs needed (%u) exceed IRQs preallocated (%u)\n",
331 irq_count, FSL_MC_IRQ_POOL_MAX_TOTAL_IRQS);
332 }
333
334 if (alloc_interrupts && !mc_bus->irq_resources) {
335 error = fsl_mc_populate_irq_pool(mc_bus_dev,
336 FSL_MC_IRQ_POOL_MAX_TOTAL_IRQS);
337 if (error < 0)
338 return error;
339 }
340 }
341
342 dprc_remove_devices(mc_bus_dev, child_obj_desc_array,
343 num_child_objects);
344
345 dprc_add_new_devices(mc_bus_dev, child_obj_desc_array,
346 num_child_objects);
347
348 if (child_obj_desc_array)
349 devm_kfree(&mc_bus_dev->dev, child_obj_desc_array);
350
351 return 0;
352 }
353
354 /**
355 * dprc_scan_container - Scans a physical DPRC and synchronizes Linux bus state
356 *
357 * @mc_bus_dev: pointer to the fsl-mc device that represents a DPRC object
358 * @alloc_interrupts: if true the function allocates the interrupt pool,
359 * otherwise the interrupt allocation is delayed
360 * Scans the physical DPRC and synchronizes the state of the Linux
361 * bus driver with the actual state of the MC by adding and removing
362 * devices as appropriate.
363 */
dprc_scan_container(struct fsl_mc_device * mc_bus_dev,bool alloc_interrupts)364 int dprc_scan_container(struct fsl_mc_device *mc_bus_dev,
365 bool alloc_interrupts)
366 {
367 int error = 0;
368 struct fsl_mc_bus *mc_bus = to_fsl_mc_bus(mc_bus_dev);
369
370 fsl_mc_init_all_resource_pools(mc_bus_dev);
371
372 /*
373 * Discover objects in the DPRC:
374 */
375 mutex_lock(&mc_bus->scan_mutex);
376 error = dprc_scan_objects(mc_bus_dev, alloc_interrupts);
377 mutex_unlock(&mc_bus->scan_mutex);
378
379 return error;
380 }
381 EXPORT_SYMBOL_GPL(dprc_scan_container);
382
383 /**
384 * dprc_irq0_handler - Regular ISR for DPRC interrupt 0
385 *
386 * @irq_num: IRQ number of the interrupt being handled
387 * @arg: Pointer to device structure
388 */
dprc_irq0_handler(int irq_num,void * arg)389 static irqreturn_t dprc_irq0_handler(int irq_num, void *arg)
390 {
391 return IRQ_WAKE_THREAD;
392 }
393
394 /**
395 * dprc_irq0_handler_thread - Handler thread function for DPRC interrupt 0
396 *
397 * @irq_num: IRQ number of the interrupt being handled
398 * @arg: Pointer to device structure
399 */
dprc_irq0_handler_thread(int irq_num,void * arg)400 static irqreturn_t dprc_irq0_handler_thread(int irq_num, void *arg)
401 {
402 int error;
403 u32 status;
404 struct device *dev = arg;
405 struct fsl_mc_device *mc_dev = to_fsl_mc_device(dev);
406 struct fsl_mc_bus *mc_bus = to_fsl_mc_bus(mc_dev);
407 struct fsl_mc_io *mc_io = mc_dev->mc_io;
408 int irq = mc_dev->irqs[0]->virq;
409
410 dev_dbg(dev, "DPRC IRQ %d triggered on CPU %u\n",
411 irq_num, smp_processor_id());
412
413 if (!(mc_dev->flags & FSL_MC_IS_DPRC))
414 return IRQ_HANDLED;
415
416 mutex_lock(&mc_bus->scan_mutex);
417 if (irq != (u32)irq_num)
418 goto out;
419
420 status = 0;
421 error = dprc_get_irq_status(mc_io, 0, mc_dev->mc_handle, 0,
422 &status);
423 if (error < 0) {
424 dev_err(dev,
425 "dprc_get_irq_status() failed: %d\n", error);
426 goto out;
427 }
428
429 error = dprc_clear_irq_status(mc_io, 0, mc_dev->mc_handle, 0,
430 status);
431 if (error < 0) {
432 dev_err(dev,
433 "dprc_clear_irq_status() failed: %d\n", error);
434 goto out;
435 }
436
437 if (status & (DPRC_IRQ_EVENT_OBJ_ADDED |
438 DPRC_IRQ_EVENT_OBJ_REMOVED |
439 DPRC_IRQ_EVENT_CONTAINER_DESTROYED |
440 DPRC_IRQ_EVENT_OBJ_DESTROYED |
441 DPRC_IRQ_EVENT_OBJ_CREATED)) {
442
443 error = dprc_scan_objects(mc_dev, true);
444 if (error < 0) {
445 /*
446 * If the error is -ENXIO, we ignore it, as it indicates
447 * that the object scan was aborted, as we detected that
448 * an object was removed from the DPRC in the MC, while
449 * we were scanning the DPRC.
450 */
451 if (error != -ENXIO) {
452 dev_err(dev, "dprc_scan_objects() failed: %d\n",
453 error);
454 }
455
456 goto out;
457 }
458 }
459
460 out:
461 mutex_unlock(&mc_bus->scan_mutex);
462 return IRQ_HANDLED;
463 }
464
465 /*
466 * Disable and clear interrupt for a given DPRC object
467 */
disable_dprc_irq(struct fsl_mc_device * mc_dev)468 int disable_dprc_irq(struct fsl_mc_device *mc_dev)
469 {
470 struct fsl_mc_bus *mc_bus = to_fsl_mc_bus(mc_dev);
471 int error;
472 struct fsl_mc_io *mc_io = mc_dev->mc_io;
473
474 /*
475 * Disable generation of interrupt, while we configure it:
476 */
477 error = dprc_set_irq_enable(mc_io, 0, mc_dev->mc_handle, 0, 0);
478 if (error < 0) {
479 dev_err(&mc_dev->dev,
480 "Disabling DPRC IRQ failed: dprc_set_irq_enable() failed: %d\n",
481 error);
482 return error;
483 }
484
485 /*
486 * Disable all interrupt causes for the interrupt:
487 */
488 error = dprc_set_irq_mask(mc_io, 0, mc_dev->mc_handle, 0, 0x0);
489 if (error < 0) {
490 dev_err(&mc_dev->dev,
491 "Disabling DPRC IRQ failed: dprc_set_irq_mask() failed: %d\n",
492 error);
493 return error;
494 }
495
496 /*
497 * Clear any leftover interrupts:
498 */
499 error = dprc_clear_irq_status(mc_io, 0, mc_dev->mc_handle, 0, ~0x0U);
500 if (error < 0) {
501 dev_err(&mc_dev->dev,
502 "Disabling DPRC IRQ failed: dprc_clear_irq_status() failed: %d\n",
503 error);
504 return error;
505 }
506
507 mc_bus->irq_enabled = 0;
508
509 return 0;
510 }
511
get_dprc_irq_state(struct fsl_mc_device * mc_dev)512 int get_dprc_irq_state(struct fsl_mc_device *mc_dev)
513 {
514 struct fsl_mc_bus *mc_bus = to_fsl_mc_bus(mc_dev);
515
516 return mc_bus->irq_enabled;
517 }
518
register_dprc_irq_handler(struct fsl_mc_device * mc_dev)519 static int register_dprc_irq_handler(struct fsl_mc_device *mc_dev)
520 {
521 int error;
522 struct fsl_mc_device_irq *irq = mc_dev->irqs[0];
523
524 /*
525 * NOTE: devm_request_threaded_irq() invokes the device-specific
526 * function that programs the MSI physically in the device
527 */
528 error = devm_request_threaded_irq(&mc_dev->dev,
529 irq->virq,
530 dprc_irq0_handler,
531 dprc_irq0_handler_thread,
532 IRQF_NO_SUSPEND | IRQF_ONESHOT,
533 dev_name(&mc_dev->dev),
534 &mc_dev->dev);
535 if (error < 0) {
536 dev_err(&mc_dev->dev,
537 "devm_request_threaded_irq() failed: %d\n",
538 error);
539 return error;
540 }
541
542 return 0;
543 }
544
enable_dprc_irq(struct fsl_mc_device * mc_dev)545 int enable_dprc_irq(struct fsl_mc_device *mc_dev)
546 {
547 struct fsl_mc_bus *mc_bus = to_fsl_mc_bus(mc_dev);
548 int error;
549
550 /*
551 * Enable all interrupt causes for the interrupt:
552 */
553 error = dprc_set_irq_mask(mc_dev->mc_io, 0, mc_dev->mc_handle, 0,
554 ~0x0u);
555 if (error < 0) {
556 dev_err(&mc_dev->dev,
557 "Enabling DPRC IRQ failed: dprc_set_irq_mask() failed: %d\n",
558 error);
559
560 return error;
561 }
562
563 /*
564 * Enable generation of the interrupt:
565 */
566 error = dprc_set_irq_enable(mc_dev->mc_io, 0, mc_dev->mc_handle, 0, 1);
567 if (error < 0) {
568 dev_err(&mc_dev->dev,
569 "Enabling DPRC IRQ failed: dprc_set_irq_enable() failed: %d\n",
570 error);
571
572 return error;
573 }
574
575 mc_bus->irq_enabled = 1;
576
577 return 0;
578 }
579
580 /*
581 * Setup interrupt for a given DPRC device
582 */
dprc_setup_irq(struct fsl_mc_device * mc_dev)583 static int dprc_setup_irq(struct fsl_mc_device *mc_dev)
584 {
585 int error;
586
587 error = fsl_mc_allocate_irqs(mc_dev);
588 if (error < 0)
589 return error;
590
591 error = disable_dprc_irq(mc_dev);
592 if (error < 0)
593 goto error_free_irqs;
594
595 error = register_dprc_irq_handler(mc_dev);
596 if (error < 0)
597 goto error_free_irqs;
598
599 error = enable_dprc_irq(mc_dev);
600 if (error < 0)
601 goto error_free_irqs;
602
603 return 0;
604
605 error_free_irqs:
606 fsl_mc_free_irqs(mc_dev);
607 return error;
608 }
609
610 /**
611 * dprc_setup - opens and creates a mc_io for DPRC
612 *
613 * @mc_dev: Pointer to fsl-mc device representing a DPRC
614 *
615 * It opens the physical DPRC in the MC.
616 * It configures the DPRC portal used to communicate with MC
617 */
618
dprc_setup(struct fsl_mc_device * mc_dev)619 int dprc_setup(struct fsl_mc_device *mc_dev)
620 {
621 struct device *parent_dev = mc_dev->dev.parent;
622 struct fsl_mc_bus *mc_bus = to_fsl_mc_bus(mc_dev);
623 struct irq_domain *mc_msi_domain;
624 bool mc_io_created = false;
625 bool msi_domain_set = false;
626 bool uapi_created = false;
627 u16 major_ver, minor_ver;
628 size_t region_size;
629 int error;
630
631 if (!is_fsl_mc_bus_dprc(mc_dev))
632 return -EINVAL;
633
634 if (dev_get_msi_domain(&mc_dev->dev))
635 return -EINVAL;
636
637 if (!mc_dev->mc_io) {
638 /*
639 * This is a child DPRC:
640 */
641 if (!dev_is_fsl_mc(parent_dev))
642 return -EINVAL;
643
644 if (mc_dev->obj_desc.region_count == 0)
645 return -EINVAL;
646
647 region_size = resource_size(mc_dev->regions);
648
649 error = fsl_create_mc_io(&mc_dev->dev,
650 mc_dev->regions[0].start,
651 region_size,
652 NULL,
653 FSL_MC_IO_ATOMIC_CONTEXT_PORTAL,
654 &mc_dev->mc_io);
655 if (error < 0)
656 return error;
657
658 mc_io_created = true;
659 } else {
660 error = fsl_mc_uapi_create_device_file(mc_bus);
661 if (error < 0)
662 return -EPROBE_DEFER;
663 uapi_created = true;
664 }
665
666 mc_msi_domain = fsl_mc_find_msi_domain(&mc_dev->dev);
667 if (!mc_msi_domain) {
668 dev_warn(&mc_dev->dev,
669 "WARNING: MC bus without interrupt support\n");
670 } else {
671 dev_set_msi_domain(&mc_dev->dev, mc_msi_domain);
672 msi_domain_set = true;
673 }
674
675 error = dprc_open(mc_dev->mc_io, 0, mc_dev->obj_desc.id,
676 &mc_dev->mc_handle);
677 if (error < 0) {
678 dev_err(&mc_dev->dev, "dprc_open() failed: %d\n", error);
679 goto error_cleanup_msi_domain;
680 }
681
682 error = dprc_get_attributes(mc_dev->mc_io, 0, mc_dev->mc_handle,
683 &mc_bus->dprc_attr);
684 if (error < 0) {
685 dev_err(&mc_dev->dev, "dprc_get_attributes() failed: %d\n",
686 error);
687 goto error_cleanup_open;
688 }
689
690 error = dprc_get_api_version(mc_dev->mc_io, 0,
691 &major_ver,
692 &minor_ver);
693 if (error < 0) {
694 dev_err(&mc_dev->dev, "dprc_get_api_version() failed: %d\n",
695 error);
696 goto error_cleanup_open;
697 }
698
699 if (major_ver < DPRC_MIN_VER_MAJOR) {
700 dev_err(&mc_dev->dev,
701 "ERROR: DPRC version %d.%d not supported\n",
702 major_ver, minor_ver);
703 error = -ENOTSUPP;
704 goto error_cleanup_open;
705 }
706
707 return 0;
708
709 error_cleanup_open:
710 (void)dprc_close(mc_dev->mc_io, 0, mc_dev->mc_handle);
711
712 error_cleanup_msi_domain:
713 if (msi_domain_set)
714 dev_set_msi_domain(&mc_dev->dev, NULL);
715
716 if (mc_io_created) {
717 fsl_destroy_mc_io(mc_dev->mc_io);
718 mc_dev->mc_io = NULL;
719 }
720
721 if (uapi_created)
722 fsl_mc_uapi_remove_device_file(mc_bus);
723
724 return error;
725 }
726 EXPORT_SYMBOL_GPL(dprc_setup);
727
728 /**
729 * dprc_probe - callback invoked when a DPRC is being bound to this driver
730 *
731 * @mc_dev: Pointer to fsl-mc device representing a DPRC
732 *
733 * It opens the physical DPRC in the MC.
734 * It scans the DPRC to discover the MC objects contained in it.
735 * It creates the interrupt pool for the MC bus associated with the DPRC.
736 * It configures the interrupts for the DPRC device itself.
737 */
dprc_probe(struct fsl_mc_device * mc_dev)738 static int dprc_probe(struct fsl_mc_device *mc_dev)
739 {
740 int error;
741
742 error = dprc_setup(mc_dev);
743 if (error < 0)
744 return error;
745
746 /*
747 * Discover MC objects in DPRC object:
748 */
749 error = dprc_scan_container(mc_dev, true);
750 if (error < 0)
751 goto dprc_cleanup;
752
753 /*
754 * Configure interrupt for the DPRC object associated with this MC bus:
755 */
756 error = dprc_setup_irq(mc_dev);
757 if (error < 0)
758 goto scan_cleanup;
759
760 dev_info(&mc_dev->dev, "DPRC device bound to driver");
761 return 0;
762
763 scan_cleanup:
764 device_for_each_child(&mc_dev->dev, NULL, __fsl_mc_device_remove);
765 dprc_cleanup:
766 dprc_cleanup(mc_dev);
767 return error;
768 }
769
770 /*
771 * Tear down interrupt for a given DPRC object
772 */
dprc_teardown_irq(struct fsl_mc_device * mc_dev)773 static void dprc_teardown_irq(struct fsl_mc_device *mc_dev)
774 {
775 struct fsl_mc_device_irq *irq = mc_dev->irqs[0];
776
777 (void)disable_dprc_irq(mc_dev);
778
779 devm_free_irq(&mc_dev->dev, irq->virq, &mc_dev->dev);
780
781 fsl_mc_free_irqs(mc_dev);
782 }
783
784 /**
785 * dprc_cleanup - function that cleanups a DPRC
786 *
787 * @mc_dev: Pointer to fsl-mc device representing the DPRC
788 *
789 * It closes the DPRC device in the MC.
790 * It destroys the interrupt pool associated with this MC bus.
791 */
792
dprc_cleanup(struct fsl_mc_device * mc_dev)793 int dprc_cleanup(struct fsl_mc_device *mc_dev)
794 {
795 struct fsl_mc_bus *mc_bus = to_fsl_mc_bus(mc_dev);
796 int error;
797
798 /* this function should be called only for DPRCs, it
799 * is an error to call it for regular objects
800 */
801 if (!is_fsl_mc_bus_dprc(mc_dev))
802 return -EINVAL;
803
804 if (dev_get_msi_domain(&mc_dev->dev)) {
805 fsl_mc_cleanup_irq_pool(mc_dev);
806 dev_set_msi_domain(&mc_dev->dev, NULL);
807 }
808
809 fsl_mc_cleanup_all_resource_pools(mc_dev);
810
811 /* if this step fails we cannot go further with cleanup as there is no way of
812 * communicating with the firmware
813 */
814 if (!mc_dev->mc_io) {
815 dev_err(&mc_dev->dev, "mc_io is NULL, tear down cannot be performed in firmware\n");
816 return -EINVAL;
817 }
818
819 error = dprc_close(mc_dev->mc_io, 0, mc_dev->mc_handle);
820 if (error < 0)
821 dev_err(&mc_dev->dev, "dprc_close() failed: %d\n", error);
822
823 if (!fsl_mc_is_root_dprc(&mc_dev->dev)) {
824 fsl_destroy_mc_io(mc_dev->mc_io);
825 mc_dev->mc_io = NULL;
826 } else {
827 fsl_mc_uapi_remove_device_file(mc_bus);
828 }
829
830 return 0;
831 }
832 EXPORT_SYMBOL_GPL(dprc_cleanup);
833
834 /**
835 * dprc_remove - callback invoked when a DPRC is being unbound from this driver
836 *
837 * @mc_dev: Pointer to fsl-mc device representing the DPRC
838 *
839 * It removes the DPRC's child objects from Linux (not from the MC) and
840 * closes the DPRC device in the MC.
841 * It tears down the interrupts that were configured for the DPRC device.
842 * It destroys the interrupt pool associated with this MC bus.
843 */
dprc_remove(struct fsl_mc_device * mc_dev)844 static void dprc_remove(struct fsl_mc_device *mc_dev)
845 {
846 struct fsl_mc_bus *mc_bus = to_fsl_mc_bus(mc_dev);
847
848 if (!mc_bus->irq_resources) {
849 dev_err(&mc_dev->dev, "No irq resources, so unbinding the device failed\n");
850 return;
851 }
852
853 if (dev_get_msi_domain(&mc_dev->dev))
854 dprc_teardown_irq(mc_dev);
855
856 device_for_each_child(&mc_dev->dev, NULL, __fsl_mc_device_remove);
857
858 dprc_cleanup(mc_dev);
859
860 dev_info(&mc_dev->dev, "DPRC device unbound from driver");
861 }
862
863 static const struct fsl_mc_device_id match_id_table[] = {
864 {
865 .vendor = FSL_MC_VENDOR_FREESCALE,
866 .obj_type = "dprc"},
867 {.vendor = 0x0},
868 };
869
870 static struct fsl_mc_driver dprc_driver = {
871 .driver = {
872 .name = FSL_MC_DPRC_DRIVER_NAME,
873 .owner = THIS_MODULE,
874 .pm = NULL,
875 },
876 .match_id_table = match_id_table,
877 .probe = dprc_probe,
878 .remove = dprc_remove,
879 };
880
dprc_driver_init(void)881 int __init dprc_driver_init(void)
882 {
883 return fsl_mc_driver_register(&dprc_driver);
884 }
885
dprc_driver_exit(void)886 void dprc_driver_exit(void)
887 {
888 fsl_mc_driver_unregister(&dprc_driver);
889 }
890