tjh.dev
Linux kernel mirror (for testing)
git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git
kernel
os
linux
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
15static DEFINE_MUTEX(ep_map_mutex);
16static struct psil_ep_map *soc_ep_map;
17
18struct 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}
54EXPORT_SYMBOL_GPL(psil_get_ep_config);
55
56int 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}
90EXPORT_SYMBOL_GPL(psil_set_new_ep_config);