1 // SPDX-License-Identifier: GPL-2.0 2 /* 3 * Copyright (C) 2019 Texas Instruments Incorporated - http://www.ti.com 4 * Author: Peter Ujfalusi <peter.ujfalusi@ti.com> 5 */ 6 7 #include <linux/kernel.h> 8 #include <linux/device.h> 9 #include <linux/init.h> 10 #include <linux/mutex.h> 11 #include <linux/of.h> 12 13 #include "k3-psil-priv.h" 14 15 static DEFINE_MUTEX(ep_map_mutex); 16 static struct psil_ep_map *soc_ep_map; 17 18 struct psil_endpoint_config *psil_get_ep_config(u32 thread_id) 19 { 20 int i; 21 22 mutex_lock(&ep_map_mutex); 23 if (!soc_ep_map) { 24 if (of_machine_is_compatible("ti,am654")) { 25 soc_ep_map = &am654_ep_map; 26 } else if (of_machine_is_compatible("ti,j721e")) { 27 soc_ep_map = &j721e_ep_map; 28 } else { 29 pr_err("PSIL: No compatible machine found for map\n"); 30 return ERR_PTR(-ENOTSUPP); 31 } 32 pr_debug("%s: Using map for %s\n", __func__, soc_ep_map->name); 33 } 34 mutex_unlock(&ep_map_mutex); 35 36 if (thread_id & K3_PSIL_DST_THREAD_ID_OFFSET && soc_ep_map->dst) { 37 /* check in destination thread map */ 38 for (i = 0; i < soc_ep_map->dst_count; i++) { 39 if (soc_ep_map->dst[i].thread_id == thread_id) 40 return &soc_ep_map->dst[i].ep_config; 41 } 42 } 43 44 thread_id &= ~K3_PSIL_DST_THREAD_ID_OFFSET; 45 if (soc_ep_map->src) { 46 for (i = 0; i < soc_ep_map->src_count; i++) { 47 if (soc_ep_map->src[i].thread_id == thread_id) 48 return &soc_ep_map->src[i].ep_config; 49 } 50 } 51 52 return ERR_PTR(-ENOENT); 53 } 54 EXPORT_SYMBOL_GPL(psil_get_ep_config); 55 56 int psil_set_new_ep_config(struct device *dev, const char *name, 57 struct psil_endpoint_config *ep_config) 58 { 59 struct psil_endpoint_config *dst_ep_config; 60 struct of_phandle_args dma_spec; 61 u32 thread_id; 62 int index; 63 64 if (!dev || !dev->of_node) 65 return -EINVAL; 66 67 index = of_property_match_string(dev->of_node, "dma-names", name); 68 if (index < 0) 69 return index; 70 71 if (of_parse_phandle_with_args(dev->of_node, "dmas", "#dma-cells", 72 index, &dma_spec)) 73 return -ENOENT; 74 75 thread_id = dma_spec.args[0]; 76 77 dst_ep_config = psil_get_ep_config(thread_id); 78 if (IS_ERR(dst_ep_config)) { 79 pr_err("PSIL: thread ID 0x%04x not defined in map\n", 80 thread_id); 81 of_node_put(dma_spec.np); 82 return PTR_ERR(dst_ep_config); 83 } 84 85 memcpy(dst_ep_config, ep_config, sizeof(*dst_ep_config)); 86 87 of_node_put(dma_spec.np); 88 return 0; 89 } 90 EXPORT_SYMBOL_GPL(psil_set_new_ep_config); 91