drivers/dma/ti/k3-psil.c

   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);