cmd.c (4109B)
1// SPDX-License-Identifier: GPL-2.0 2// 3// Renesas R-Car CMD support 4// 5// Copyright (C) 2015 Renesas Solutions Corp. 6// Kuninori Morimoto <kuninori.morimoto.gx@renesas.com> 7 8#include "rsnd.h" 9 10struct rsnd_cmd { 11 struct rsnd_mod mod; 12}; 13 14#define CMD_NAME "cmd" 15 16#define rsnd_cmd_nr(priv) ((priv)->cmd_nr) 17#define for_each_rsnd_cmd(pos, priv, i) \ 18 for ((i) = 0; \ 19 ((i) < rsnd_cmd_nr(priv)) && \ 20 ((pos) = (struct rsnd_cmd *)(priv)->cmd + i); \ 21 i++) 22 23static int rsnd_cmd_init(struct rsnd_mod *mod, 24 struct rsnd_dai_stream *io, 25 struct rsnd_priv *priv) 26{ 27 struct rsnd_mod *dvc = rsnd_io_to_mod_dvc(io); 28 struct rsnd_mod *mix = rsnd_io_to_mod_mix(io); 29 struct device *dev = rsnd_priv_to_dev(priv); 30 u32 data; 31 static const u32 path[] = { 32 [1] = 1 << 0, 33 [5] = 1 << 8, 34 [6] = 1 << 12, 35 [9] = 1 << 15, 36 }; 37 38 if (!mix && !dvc) 39 return 0; 40 41 if (ARRAY_SIZE(path) < rsnd_mod_id(mod) + 1) 42 return -ENXIO; 43 44 if (mix) { 45 struct rsnd_dai *rdai; 46 int i; 47 48 /* 49 * it is assuming that integrater is well understanding about 50 * data path. Here doesn't check impossible connection, 51 * like src2 + src5 52 */ 53 data = 0; 54 for_each_rsnd_dai(rdai, priv, i) { 55 struct rsnd_dai_stream *tio = &rdai->playback; 56 struct rsnd_mod *src = rsnd_io_to_mod_src(tio); 57 58 if (mix == rsnd_io_to_mod_mix(tio)) 59 data |= path[rsnd_mod_id(src)]; 60 61 tio = &rdai->capture; 62 src = rsnd_io_to_mod_src(tio); 63 if (mix == rsnd_io_to_mod_mix(tio)) 64 data |= path[rsnd_mod_id(src)]; 65 } 66 67 } else { 68 struct rsnd_mod *src = rsnd_io_to_mod_src(io); 69 70 static const u8 cmd_case[] = { 71 [0] = 0x3, 72 [1] = 0x3, 73 [2] = 0x4, 74 [3] = 0x1, 75 [4] = 0x2, 76 [5] = 0x4, 77 [6] = 0x1, 78 [9] = 0x2, 79 }; 80 81 if (unlikely(!src)) 82 return -EIO; 83 84 data = path[rsnd_mod_id(src)] | 85 cmd_case[rsnd_mod_id(src)] << 16; 86 } 87 88 dev_dbg(dev, "ctu/mix path = 0x%08x\n", data); 89 90 rsnd_mod_write(mod, CMD_ROUTE_SLCT, data); 91 rsnd_mod_write(mod, CMD_BUSIF_MODE, rsnd_get_busif_shift(io, mod) | 1); 92 rsnd_mod_write(mod, CMD_BUSIF_DALIGN, rsnd_get_dalign(mod, io)); 93 94 rsnd_adg_set_cmd_timsel_gen2(mod, io); 95 96 return 0; 97} 98 99static int rsnd_cmd_start(struct rsnd_mod *mod, 100 struct rsnd_dai_stream *io, 101 struct rsnd_priv *priv) 102{ 103 rsnd_mod_write(mod, CMD_CTRL, 0x10); 104 105 return 0; 106} 107 108static int rsnd_cmd_stop(struct rsnd_mod *mod, 109 struct rsnd_dai_stream *io, 110 struct rsnd_priv *priv) 111{ 112 rsnd_mod_write(mod, CMD_CTRL, 0); 113 114 return 0; 115} 116 117#ifdef CONFIG_DEBUG_FS 118static void rsnd_cmd_debug_info(struct seq_file *m, 119 struct rsnd_dai_stream *io, 120 struct rsnd_mod *mod) 121{ 122 rsnd_debugfs_mod_reg_show(m, mod, RSND_GEN2_SCU, 123 0x180 + rsnd_mod_id_raw(mod) * 0x20, 0x30); 124} 125#define DEBUG_INFO .debug_info = rsnd_cmd_debug_info 126#else 127#define DEBUG_INFO 128#endif 129 130static struct rsnd_mod_ops rsnd_cmd_ops = { 131 .name = CMD_NAME, 132 .init = rsnd_cmd_init, 133 .start = rsnd_cmd_start, 134 .stop = rsnd_cmd_stop, 135 .get_status = rsnd_mod_get_status, 136 DEBUG_INFO 137}; 138 139static struct rsnd_mod *rsnd_cmd_mod_get(struct rsnd_priv *priv, int id) 140{ 141 if (WARN_ON(id < 0 || id >= rsnd_cmd_nr(priv))) 142 id = 0; 143 144 return rsnd_mod_get((struct rsnd_cmd *)(priv->cmd) + id); 145} 146int rsnd_cmd_attach(struct rsnd_dai_stream *io, int id) 147{ 148 struct rsnd_priv *priv = rsnd_io_to_priv(io); 149 struct rsnd_mod *mod = rsnd_cmd_mod_get(priv, id); 150 151 return rsnd_dai_connect(mod, io, mod->type); 152} 153 154int rsnd_cmd_probe(struct rsnd_priv *priv) 155{ 156 struct device *dev = rsnd_priv_to_dev(priv); 157 struct rsnd_cmd *cmd; 158 int i, nr; 159 160 /* This driver doesn't support Gen1 at this point */ 161 if (rsnd_is_gen1(priv)) 162 return 0; 163 164 /* same number as DVC */ 165 nr = priv->dvc_nr; 166 if (!nr) 167 return 0; 168 169 cmd = devm_kcalloc(dev, nr, sizeof(*cmd), GFP_KERNEL); 170 if (!cmd) 171 return -ENOMEM; 172 173 priv->cmd_nr = nr; 174 priv->cmd = cmd; 175 176 for_each_rsnd_cmd(cmd, priv, i) { 177 int ret = rsnd_mod_init(priv, rsnd_mod_get(cmd), 178 &rsnd_cmd_ops, NULL, 179 RSND_MOD_CMD, i); 180 if (ret) 181 return ret; 182 } 183 184 return 0; 185} 186 187void rsnd_cmd_remove(struct rsnd_priv *priv) 188{ 189 struct rsnd_cmd *cmd; 190 int i; 191 192 for_each_rsnd_cmd(cmd, priv, i) { 193 rsnd_mod_quit(rsnd_mod_get(cmd)); 194 } 195}