1 /*
2 * mix.c
3 *
4 * Copyright (c) 2015 Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License version 2 as
8 * published by the Free Software Foundation.
9 */
10 #include "rsnd.h"
11
12 #define MIX_NAME_SIZE 16
13 #define MIX_NAME "mix"
14
15 struct rsnd_mix {
16 struct rsnd_mod mod;
17 };
18
19 #define rsnd_mix_get(priv, id) ((struct rsnd_mix *)(priv->mix) + id)
20 #define rsnd_mix_nr(priv) ((priv)->mix_nr)
21 #define for_each_rsnd_mix(pos, priv, i) \
22 for ((i) = 0; \
23 ((i) < rsnd_mix_nr(priv)) && \
24 ((pos) = (struct rsnd_mix *)(priv)->mix + i); \
25 i++)
26
rsnd_mix_activation(struct rsnd_mod * mod)27 static void rsnd_mix_activation(struct rsnd_mod *mod)
28 {
29 rsnd_mod_write(mod, MIX_SWRSR, 0);
30 rsnd_mod_write(mod, MIX_SWRSR, 1);
31 }
32
rsnd_mix_halt(struct rsnd_mod * mod)33 static void rsnd_mix_halt(struct rsnd_mod *mod)
34 {
35 rsnd_mod_write(mod, MIX_MIXIR, 1);
36 rsnd_mod_write(mod, MIX_SWRSR, 0);
37 }
38
rsnd_mix_volume_parameter(struct rsnd_dai_stream * io,struct rsnd_mod * mod)39 static void rsnd_mix_volume_parameter(struct rsnd_dai_stream *io,
40 struct rsnd_mod *mod)
41 {
42 rsnd_mod_write(mod, MIX_MDBAR, 0);
43 rsnd_mod_write(mod, MIX_MDBBR, 0);
44 rsnd_mod_write(mod, MIX_MDBCR, 0);
45 rsnd_mod_write(mod, MIX_MDBDR, 0);
46 }
47
rsnd_mix_volume_init(struct rsnd_dai_stream * io,struct rsnd_mod * mod)48 static void rsnd_mix_volume_init(struct rsnd_dai_stream *io,
49 struct rsnd_mod *mod)
50 {
51 rsnd_mod_write(mod, MIX_MIXIR, 1);
52
53 /* General Information */
54 rsnd_mod_write(mod, MIX_ADINR, rsnd_runtime_channel_after_ctu(io));
55
56 /* volume step */
57 rsnd_mod_write(mod, MIX_MIXMR, 0);
58 rsnd_mod_write(mod, MIX_MVPDR, 0);
59
60 /* common volume parameter */
61 rsnd_mix_volume_parameter(io, mod);
62
63 rsnd_mod_write(mod, MIX_MIXIR, 0);
64 }
65
rsnd_mix_volume_update(struct rsnd_dai_stream * io,struct rsnd_mod * mod)66 static void rsnd_mix_volume_update(struct rsnd_dai_stream *io,
67 struct rsnd_mod *mod)
68 {
69 /* Disable MIX dB setting */
70 rsnd_mod_write(mod, MIX_MDBER, 0);
71
72 /* common volume parameter */
73 rsnd_mix_volume_parameter(io, mod);
74
75 /* Enable MIX dB setting */
76 rsnd_mod_write(mod, MIX_MDBER, 1);
77 }
78
rsnd_mix_probe_(struct rsnd_mod * mod,struct rsnd_dai_stream * io,struct rsnd_priv * priv)79 static int rsnd_mix_probe_(struct rsnd_mod *mod,
80 struct rsnd_dai_stream *io,
81 struct rsnd_priv *priv)
82 {
83 return rsnd_cmd_attach(io, rsnd_mod_id(mod));
84 }
85
rsnd_mix_init(struct rsnd_mod * mod,struct rsnd_dai_stream * io,struct rsnd_priv * priv)86 static int rsnd_mix_init(struct rsnd_mod *mod,
87 struct rsnd_dai_stream *io,
88 struct rsnd_priv *priv)
89 {
90 rsnd_mod_power_on(mod);
91
92 rsnd_mix_activation(mod);
93
94 rsnd_mix_volume_init(io, mod);
95
96 rsnd_mix_volume_update(io, mod);
97
98 return 0;
99 }
100
rsnd_mix_quit(struct rsnd_mod * mod,struct rsnd_dai_stream * io,struct rsnd_priv * priv)101 static int rsnd_mix_quit(struct rsnd_mod *mod,
102 struct rsnd_dai_stream *io,
103 struct rsnd_priv *priv)
104 {
105 rsnd_mix_halt(mod);
106
107 rsnd_mod_power_off(mod);
108
109 return 0;
110 }
111
112 static struct rsnd_mod_ops rsnd_mix_ops = {
113 .name = MIX_NAME,
114 .probe = rsnd_mix_probe_,
115 .init = rsnd_mix_init,
116 .quit = rsnd_mix_quit,
117 };
118
rsnd_mix_mod_get(struct rsnd_priv * priv,int id)119 struct rsnd_mod *rsnd_mix_mod_get(struct rsnd_priv *priv, int id)
120 {
121 if (WARN_ON(id < 0 || id >= rsnd_mix_nr(priv)))
122 id = 0;
123
124 return rsnd_mod_get(rsnd_mix_get(priv, id));
125 }
126
rsnd_mix_probe(struct rsnd_priv * priv)127 int rsnd_mix_probe(struct rsnd_priv *priv)
128 {
129 struct device_node *node;
130 struct device_node *np;
131 struct device *dev = rsnd_priv_to_dev(priv);
132 struct rsnd_mix *mix;
133 struct clk *clk;
134 char name[MIX_NAME_SIZE];
135 int i, nr, ret;
136
137 /* This driver doesn't support Gen1 at this point */
138 if (rsnd_is_gen1(priv))
139 return 0;
140
141 node = rsnd_mix_of_node(priv);
142 if (!node)
143 return 0; /* not used is not error */
144
145 nr = of_get_child_count(node);
146 if (!nr) {
147 ret = -EINVAL;
148 goto rsnd_mix_probe_done;
149 }
150
151 mix = devm_kzalloc(dev, sizeof(*mix) * nr, GFP_KERNEL);
152 if (!mix) {
153 ret = -ENOMEM;
154 goto rsnd_mix_probe_done;
155 }
156
157 priv->mix_nr = nr;
158 priv->mix = mix;
159
160 i = 0;
161 ret = 0;
162 for_each_child_of_node(node, np) {
163 mix = rsnd_mix_get(priv, i);
164
165 snprintf(name, MIX_NAME_SIZE, "%s.%d",
166 MIX_NAME, i);
167
168 clk = devm_clk_get(dev, name);
169 if (IS_ERR(clk)) {
170 ret = PTR_ERR(clk);
171 of_node_put(np);
172 goto rsnd_mix_probe_done;
173 }
174
175 ret = rsnd_mod_init(priv, rsnd_mod_get(mix), &rsnd_mix_ops,
176 clk, rsnd_mod_get_status, RSND_MOD_MIX, i);
177 if (ret) {
178 of_node_put(np);
179 goto rsnd_mix_probe_done;
180 }
181
182 i++;
183 }
184
185 rsnd_mix_probe_done:
186 of_node_put(node);
187
188 return ret;
189 }
190
rsnd_mix_remove(struct rsnd_priv * priv)191 void rsnd_mix_remove(struct rsnd_priv *priv)
192 {
193 struct rsnd_mix *mix;
194 int i;
195
196 for_each_rsnd_mix(mix, priv, i) {
197 rsnd_mod_quit(rsnd_mod_get(mix));
198 }
199 }
200