projects / linux-2.6-block.git / blame
| Commit | Line | Data |
|---|---|---|
| 8c6bb62f PU |
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> | |
| ce310bd7 | 12 | #include <linux/sys_soc.h> |
| 8c6bb62f PU |
13 | |
| 14 | #include "k3-psil-priv.h" | |
| 15 | ||
| 8c6bb62f | 16 | static DEFINE_MUTEX(ep_map_mutex); |
| ce310bd7 PU |
17 | static const struct psil_ep_map *soc_ep_map; |
| 18 | ||
| 19 | static const struct soc_device_attribute k3_soc_devices[] = { | |
| 20 | { .family = "AM65X", .data = &am654_ep_map }, | |
| 21 | { .family = "J721E", .data = &j721e_ep_map }, | |
| e9ca48d9 | 22 | { .family = "J7200", .data = &j7200_ep_map }, |
| 2329725d | 23 | { .family = "AM64X", .data = &am64_ep_map }, |
| ce310bd7 PU |
24 | { /* sentinel */ } |
| 25 | }; | |
| 8c6bb62f PU |
26 | |
| 27 | struct psil_endpoint_config *psil_get_ep_config(u32 thread_id) | |
| 28 | { | |
| 29 | int i; | |
| 30 | ||
| 31 | mutex_lock(&ep_map_mutex); | |
| 32 | if (!soc_ep_map) { | |
| ce310bd7 PU |
33 | const struct soc_device_attribute *soc; |
| 34 | ||
| 35 | soc = soc_device_match(k3_soc_devices); | |
| 36 | if (soc) { | |
| 37 | soc_ep_map = soc->data; | |
| 8c6bb62f PU |
38 | } else { |
| 39 | pr_err("PSIL: No compatible machine found for map\n"); | |
| 172d59ec | 40 | mutex_unlock(&ep_map_mutex); |
| 8c6bb62f PU |
41 | return ERR_PTR(-ENOTSUPP); |
| 42 | } | |
| 43 | pr_debug("%s: Using map for %s\n", __func__, soc_ep_map->name); | |
| 44 | } | |
| 45 | mutex_unlock(&ep_map_mutex); | |
| 46 | ||
| 47 | if (thread_id & K3_PSIL_DST_THREAD_ID_OFFSET && soc_ep_map->dst) { | |
| 48 | /* check in destination thread map */ | |
| 49 | for (i = 0; i < soc_ep_map->dst_count; i++) { | |
| 50 | if (soc_ep_map->dst[i].thread_id == thread_id) | |
| 51 | return &soc_ep_map->dst[i].ep_config; | |
| 52 | } | |
| 53 | } | |
| 54 | ||
| 55 | thread_id &= ~K3_PSIL_DST_THREAD_ID_OFFSET; | |
| 56 | if (soc_ep_map->src) { | |
| 57 | for (i = 0; i < soc_ep_map->src_count; i++) { | |
| 58 | if (soc_ep_map->src[i].thread_id == thread_id) | |
| 59 | return &soc_ep_map->src[i].ep_config; | |
| 60 | } | |
| 61 | } | |
| 62 | ||
| 63 | return ERR_PTR(-ENOENT); | |
| 64 | } | |
| 65 | EXPORT_SYMBOL_GPL(psil_get_ep_config); | |
| 66 | ||
| 67 | int psil_set_new_ep_config(struct device *dev, const char *name, | |
| 68 | struct psil_endpoint_config *ep_config) | |
| 69 | { | |
| 70 | struct psil_endpoint_config *dst_ep_config; | |
| 71 | struct of_phandle_args dma_spec; | |
| 72 | u32 thread_id; | |
| 73 | int index; | |
| 74 | ||
| 75 | if (!dev || !dev->of_node) | |
| 76 | return -EINVAL; | |
| 77 | ||
| 78 | index = of_property_match_string(dev->of_node, "dma-names", name); | |
| 79 | if (index < 0) | |
| 80 | return index; | |
| 81 | ||
| 82 | if (of_parse_phandle_with_args(dev->of_node, "dmas", "#dma-cells", | |
| 83 | index, &dma_spec)) | |
| 84 | return -ENOENT; | |
| 85 | ||
| 86 | thread_id = dma_spec.args[0]; | |
| 87 | ||
| 88 | dst_ep_config = psil_get_ep_config(thread_id); | |
| 89 | if (IS_ERR(dst_ep_config)) { | |
| 90 | pr_err("PSIL: thread ID 0x%04x not defined in map\n", | |
| 91 | thread_id); | |
| 92 | of_node_put(dma_spec.np); | |
| 93 | return PTR_ERR(dst_ep_config); | |
| 94 | } | |
| 95 | ||
| 96 | memcpy(dst_ep_config, ep_config, sizeof(*dst_ep_config)); | |
| 97 | ||
| 98 | of_node_put(dma_spec.np); | |
| 99 | return 0; | |
| 100 | } | |
| 101 | EXPORT_SYMBOL_GPL(psil_set_new_ep_config); |