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 mutex_unlock(&ep_map_mutex); 31 return ERR_PTR(-ENOTSUPP); 32 } 33 pr_debug("%s: Using map for %s\n", __func__, soc_ep_map->name); 34 } 35 mutex_unlock(&ep_map_mutex); 36 37 if (thread_id & K3_PSIL_DST_THREAD_ID_OFFSET && soc_ep_map->dst) { 38 /* check in destination thread map */ 39 for (i = 0; i < soc_ep_map->dst_count; i++) { 40 if (soc_ep_map->dst[i].thread_id == thread_id) 41 return &soc_ep_map->dst[i].ep_config; 42 } 43 } 44 45 thread_id &= ~K3_PSIL_DST_THREAD_ID_OFFSET; 46 if (soc_ep_map->src) { 47 for (i = 0; i < soc_ep_map->src_count; i++) { 48 if (soc_ep_map->src[i].thread_id == thread_id) 49 return &soc_ep_map->src[i].ep_config; 50 } 51 } 52 53 return ERR_PTR(-ENOENT); 54 } 55 EXPORT_SYMBOL_GPL(psil_get_ep_config); 56 57 int psil_set_new_ep_config(struct device *dev, const char *name, 58 struct psil_endpoint_config *ep_config) 59 { 60 struct psil_endpoint_config *dst_ep_config; 61 struct of_phandle_args dma_spec; 62 u32 thread_id; 63 int index; 64 65 if (!dev || !dev->of_node) 66 return -EINVAL; 67 68 index = of_property_match_string(dev->of_node, "dma-names", name); 69 if (index < 0) 70 return index; 71 72 if (of_parse_phandle_with_args(dev->of_node, "dmas", "#dma-cells", 73 index, &dma_spec)) 74 return -ENOENT; 75 76 thread_id = dma_spec.args[0]; 77 78 dst_ep_config = psil_get_ep_config(thread_id); 79 if (IS_ERR(dst_ep_config)) { 80 pr_err("PSIL: thread ID 0x%04x not defined in map\n", 81 thread_id); 82 of_node_put(dma_spec.np); 83 return PTR_ERR(dst_ep_config); 84 } 85 86 memcpy(dst_ep_config, ep_config, sizeof(*dst_ep_config)); 87 88 of_node_put(dma_spec.np); 89 return 0; 90 } 91 EXPORT_SYMBOL_GPL(psil_set_new_ep_config); 92