GNU Linux-libre 4.19.286-gnu1
[releases.git] / sound / soc / sh / rcar / ssiu.c
1 // SPDX-License-Identifier: GPL-2.0
2 //
3 // Renesas R-Car SSIU support
4 //
5 // Copyright (c) 2015 Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>
6
7 #include "rsnd.h"
8
9 #define SSIU_NAME "ssiu"
10
11 struct rsnd_ssiu {
12         struct rsnd_mod mod;
13 };
14
15 #define rsnd_ssiu_nr(priv) ((priv)->ssiu_nr)
16 #define for_each_rsnd_ssiu(pos, priv, i)                                \
17         for (i = 0;                                                     \
18              (i < rsnd_ssiu_nr(priv)) &&                                \
19                      ((pos) = ((struct rsnd_ssiu *)(priv)->ssiu + i));  \
20              i++)
21
22 static int rsnd_ssiu_init(struct rsnd_mod *mod,
23                           struct rsnd_dai_stream *io,
24                           struct rsnd_priv *priv)
25 {
26         struct rsnd_dai *rdai = rsnd_io_to_rdai(io);
27         u32 multi_ssi_slaves = rsnd_ssi_multi_slaves_runtime(io);
28         int use_busif = rsnd_ssi_use_busif(io);
29         int id = rsnd_mod_id(mod);
30         u32 mask1, val1;
31         u32 mask2, val2;
32
33         /* clear status */
34         switch (id) {
35         case 0:
36         case 1:
37         case 2:
38         case 3:
39         case 4:
40                 rsnd_mod_write(mod, SSI_SYS_STATUS0, 0xf << (id * 4));
41                 rsnd_mod_write(mod, SSI_SYS_STATUS2, 0xf << (id * 4));
42                 rsnd_mod_write(mod, SSI_SYS_STATUS4, 0xf << (id * 4));
43                 rsnd_mod_write(mod, SSI_SYS_STATUS6, 0xf << (id * 4));
44                 break;
45         case 9:
46                 rsnd_mod_write(mod, SSI_SYS_STATUS1, 0xf << 4);
47                 rsnd_mod_write(mod, SSI_SYS_STATUS3, 0xf << 4);
48                 rsnd_mod_write(mod, SSI_SYS_STATUS5, 0xf << 4);
49                 rsnd_mod_write(mod, SSI_SYS_STATUS7, 0xf << 4);
50                 break;
51         }
52
53         /*
54          * SSI_MODE0
55          */
56         rsnd_mod_bset(mod, SSI_MODE0, (1 << id), !use_busif << id);
57
58         /*
59          * SSI_MODE1
60          */
61         mask1 = (1 << 4) | (1 << 20);   /* mask sync bit */
62         mask2 = (1 << 4);               /* mask sync bit */
63         val1  = val2  = 0;
64         if (id == 8) {
65                 /*
66                  * SSI8 pin is sharing with SSI7, nothing to do.
67                  */
68         } else if (rsnd_ssi_is_pin_sharing(io)) {
69                 int shift = -1;
70
71                 switch (id) {
72                 case 1:
73                         shift = 0;
74                         break;
75                 case 2:
76                         shift = 2;
77                         break;
78                 case 4:
79                         shift = 16;
80                         break;
81                 default:
82                         return -EINVAL;
83                 }
84
85                 mask1 |= 0x3 << shift;
86                 val1 = rsnd_rdai_is_clk_master(rdai) ?
87                         0x2 << shift : 0x1 << shift;
88
89         } else if (multi_ssi_slaves) {
90
91                 mask2 |= 0x00000007;
92                 mask1 |= 0x0000000f;
93
94                 switch (multi_ssi_slaves) {
95                 case 0x0206: /* SSI0/1/2/9 */
96                         val2 = (1 << 4) | /* SSI0129 sync */
97                                 (rsnd_rdai_is_clk_master(rdai) ? 0x2 : 0x1);
98                         /* fall through */
99                 case 0x0006: /* SSI0/1/2 */
100                         val1 = rsnd_rdai_is_clk_master(rdai) ?
101                                 0xa : 0x5;
102
103                         if (!val2)  /* SSI012 sync */
104                                 val1 |= (1 << 4);
105                 }
106         }
107
108         rsnd_mod_bset(mod, SSI_MODE1, mask1, val1);
109         rsnd_mod_bset(mod, SSI_MODE2, mask2, val2);
110
111         return 0;
112 }
113
114 static struct rsnd_mod_ops rsnd_ssiu_ops_gen1 = {
115         .name   = SSIU_NAME,
116         .init   = rsnd_ssiu_init,
117 };
118
119 static int rsnd_ssiu_init_gen2(struct rsnd_mod *mod,
120                                struct rsnd_dai_stream *io,
121                                struct rsnd_priv *priv)
122 {
123         int hdmi = rsnd_ssi_hdmi_port(io);
124         int ret;
125         u32 mode = 0;
126
127         ret = rsnd_ssiu_init(mod, io, priv);
128         if (ret < 0)
129                 return ret;
130
131         if (rsnd_runtime_is_ssi_tdm(io)) {
132                 /*
133                  * TDM Extend Mode
134                  * see
135                  *      rsnd_ssi_config_init()
136                  */
137                 mode = 0x1;
138         }
139
140         rsnd_mod_write(mod, SSI_MODE, mode);
141
142         if (rsnd_ssi_use_busif(io)) {
143                 rsnd_mod_write(mod, SSI_BUSIF_ADINR,
144                                rsnd_get_adinr_bit(mod, io) |
145                                (rsnd_io_is_play(io) ?
146                                 rsnd_runtime_channel_after_ctu(io) :
147                                 rsnd_runtime_channel_original(io)));
148                 rsnd_mod_write(mod, SSI_BUSIF_MODE,
149                                rsnd_get_busif_shift(io, mod) | 1);
150                 rsnd_mod_write(mod, SSI_BUSIF_DALIGN,
151                                rsnd_get_dalign(mod, io));
152         }
153
154         if (hdmi) {
155                 enum rsnd_mod_type rsnd_ssi_array[] = {
156                         RSND_MOD_SSIM1,
157                         RSND_MOD_SSIM2,
158                         RSND_MOD_SSIM3,
159                 };
160                 struct rsnd_mod *ssi_mod = rsnd_io_to_mod_ssi(io);
161                 struct rsnd_mod *pos;
162                 u32 val;
163                 int i, shift;
164
165                 i = rsnd_mod_id(ssi_mod);
166
167                 /* output all same SSI as default */
168                 val =   i << 16 |
169                         i << 20 |
170                         i << 24 |
171                         i << 28 |
172                         i;
173
174                 for_each_rsnd_mod_array(i, pos, io, rsnd_ssi_array) {
175                         shift   = (i * 4) + 20;
176                         val     = (val & ~(0xF << shift)) |
177                                 rsnd_mod_id(pos) << shift;
178                 }
179
180                 switch (hdmi) {
181                 case RSND_SSI_HDMI_PORT0:
182                         rsnd_mod_write(mod, HDMI0_SEL, val);
183                         break;
184                 case RSND_SSI_HDMI_PORT1:
185                         rsnd_mod_write(mod, HDMI1_SEL, val);
186                         break;
187                 }
188         }
189
190         return 0;
191 }
192
193 static int rsnd_ssiu_start_gen2(struct rsnd_mod *mod,
194                                 struct rsnd_dai_stream *io,
195                                 struct rsnd_priv *priv)
196 {
197         if (!rsnd_ssi_use_busif(io))
198                 return 0;
199
200         rsnd_mod_write(mod, SSI_CTRL, 0x1);
201
202         if (rsnd_ssi_multi_slaves_runtime(io))
203                 rsnd_mod_write(mod, SSI_CONTROL, 0x1);
204
205         return 0;
206 }
207
208 static int rsnd_ssiu_stop_gen2(struct rsnd_mod *mod,
209                                struct rsnd_dai_stream *io,
210                                struct rsnd_priv *priv)
211 {
212         if (!rsnd_ssi_use_busif(io))
213                 return 0;
214
215         rsnd_mod_write(mod, SSI_CTRL, 0);
216
217         if (rsnd_ssi_multi_slaves_runtime(io))
218                 rsnd_mod_write(mod, SSI_CONTROL, 0);
219
220         return 0;
221 }
222
223 static struct rsnd_mod_ops rsnd_ssiu_ops_gen2 = {
224         .name   = SSIU_NAME,
225         .init   = rsnd_ssiu_init_gen2,
226         .start  = rsnd_ssiu_start_gen2,
227         .stop   = rsnd_ssiu_stop_gen2,
228 };
229
230 static struct rsnd_mod *rsnd_ssiu_mod_get(struct rsnd_priv *priv, int id)
231 {
232         if (WARN_ON(id < 0 || id >= rsnd_ssiu_nr(priv)))
233                 id = 0;
234
235         return rsnd_mod_get((struct rsnd_ssiu *)(priv->ssiu) + id);
236 }
237
238 int rsnd_ssiu_attach(struct rsnd_dai_stream *io,
239                      struct rsnd_mod *ssi_mod)
240 {
241         struct rsnd_priv *priv = rsnd_io_to_priv(io);
242         struct rsnd_mod *mod = rsnd_ssiu_mod_get(priv, rsnd_mod_id(ssi_mod));
243
244         rsnd_mod_confirm_ssi(ssi_mod);
245
246         return rsnd_dai_connect(mod, io, mod->type);
247 }
248
249 int rsnd_ssiu_probe(struct rsnd_priv *priv)
250 {
251         struct device *dev = rsnd_priv_to_dev(priv);
252         struct rsnd_ssiu *ssiu;
253         struct rsnd_mod_ops *ops;
254         int i, nr, ret;
255
256         /* same number to SSI */
257         nr      = priv->ssi_nr;
258         ssiu    = devm_kcalloc(dev, nr, sizeof(*ssiu), GFP_KERNEL);
259         if (!ssiu)
260                 return -ENOMEM;
261
262         priv->ssiu      = ssiu;
263         priv->ssiu_nr   = nr;
264
265         if (rsnd_is_gen1(priv))
266                 ops = &rsnd_ssiu_ops_gen1;
267         else
268                 ops = &rsnd_ssiu_ops_gen2;
269
270         for_each_rsnd_ssiu(ssiu, priv, i) {
271                 ret = rsnd_mod_init(priv, rsnd_mod_get(ssiu),
272                                     ops, NULL, rsnd_mod_get_status,
273                                     RSND_MOD_SSIU, i);
274                 if (ret)
275                         return ret;
276         }
277
278         return 0;
279 }
280
281 void rsnd_ssiu_remove(struct rsnd_priv *priv)
282 {
283         struct rsnd_ssiu *ssiu;
284         int i;
285
286         for_each_rsnd_ssiu(ssiu, priv, i) {
287                 rsnd_mod_quit(rsnd_mod_get(ssiu));
288         }
289 }