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