1
2
3
4
5
6
7#include "rsnd.h"
8
9#define SSIU_NAME "ssiu"
10
11struct 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
22static 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
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
55
56 rsnd_mod_bset(mod, SSI_MODE0, (1 << id), !use_busif << id);
57
58
59
60
61 mask1 = (1 << 4) | (1 << 20);
62 mask2 = (1 << 4);
63 val1 = val2 = 0;
64 if (id == 8) {
65
66
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:
96 val2 = (1 << 4) |
97 (rsnd_rdai_is_clk_master(rdai) ? 0x2 : 0x1);
98
99 case 0x0006:
100 val1 = rsnd_rdai_is_clk_master(rdai) ?
101 0xa : 0x5;
102
103 if (!val2)
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
114static struct rsnd_mod_ops rsnd_ssiu_ops_gen1 = {
115 .name = SSIU_NAME,
116 .init = rsnd_ssiu_init,
117};
118
119static 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
134
135
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
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) + 16;
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
193static 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
208static 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
223static 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
230static 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
238int 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
249int 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
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
281void 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}
290
