GNU Linux-libre 4.9.337-gnu1
[releases.git] / sound / soc / sh / rcar / ssiu.c
1 /*
2  * Renesas R-Car SSIU support
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 SSIU_NAME "ssiu"
13
14 struct rsnd_ssiu {
15         struct rsnd_mod mod;
16 };
17
18 #define rsnd_ssiu_nr(priv) ((priv)->ssiu_nr)
19 #define for_each_rsnd_ssiu(pos, priv, i)                                \
20         for (i = 0;                                                     \
21              (i < rsnd_ssiu_nr(priv)) &&                                \
22                      ((pos) = ((struct rsnd_ssiu *)(priv)->ssiu + i));  \
23              i++)
24
25 static int rsnd_ssiu_init(struct rsnd_mod *mod,
26                           struct rsnd_dai_stream *io,
27                           struct rsnd_priv *priv)
28 {
29         struct rsnd_dai *rdai = rsnd_io_to_rdai(io);
30         u32 multi_ssi_slaves = rsnd_ssi_multi_slaves_runtime(io);
31         int use_busif = rsnd_ssi_use_busif(io);
32         int id = rsnd_mod_id(mod);
33         u32 mask1, val1;
34         u32 mask2, val2;
35
36         /*
37          * SSI_MODE0
38          */
39         rsnd_mod_bset(mod, SSI_MODE0, (1 << id), !use_busif << id);
40
41         /*
42          * SSI_MODE1
43          */
44         mask1 = (1 << 4) | (1 << 20);   /* mask sync bit */
45         mask2 = (1 << 4);               /* mask sync bit */
46         val1  = val2  = 0;
47         if (id == 8) {
48                 /*
49                  * SSI8 pin is sharing with SSI7, nothing to do.
50                  */
51         } else if (rsnd_ssi_is_pin_sharing(io)) {
52                 int shift = -1;
53
54                 switch (id) {
55                 case 1:
56                         shift = 0;
57                         break;
58                 case 2:
59                         shift = 2;
60                         break;
61                 case 4:
62                         shift = 16;
63                         break;
64                 default:
65                         return -EINVAL;
66                 }
67
68                 mask1 |= 0x3 << shift;
69                 val1 = rsnd_rdai_is_clk_master(rdai) ?
70                         0x2 << shift : 0x1 << shift;
71
72         } else if (multi_ssi_slaves) {
73
74                 mask2 |= 0x00000007;
75                 mask1 |= 0x0000000f;
76
77                 switch (multi_ssi_slaves) {
78                 case 0x0206: /* SSI0/1/2/9 */
79                         val2 = (1 << 4) | /* SSI0129 sync */
80                                 (rsnd_rdai_is_clk_master(rdai) ? 0x2 : 0x1);
81                         /* fall through */
82                 case 0x0006: /* SSI0/1/2 */
83                         val1 = rsnd_rdai_is_clk_master(rdai) ?
84                                 0xa : 0x5;
85
86                         if (!val2)  /* SSI012 sync */
87                                 val1 |= (1 << 4);
88                 }
89         }
90
91         rsnd_mod_bset(mod, SSI_MODE1, mask1, val1);
92         rsnd_mod_bset(mod, SSI_MODE2, mask2, val2);
93
94         return 0;
95 }
96
97 static struct rsnd_mod_ops rsnd_ssiu_ops_gen1 = {
98         .name   = SSIU_NAME,
99         .init   = rsnd_ssiu_init,
100 };
101
102 static int rsnd_ssiu_init_gen2(struct rsnd_mod *mod,
103                                struct rsnd_dai_stream *io,
104                                struct rsnd_priv *priv)
105 {
106         int ret;
107
108         ret = rsnd_ssiu_init(mod, io, priv);
109         if (ret < 0)
110                 return ret;
111
112         if (rsnd_runtime_is_ssi_tdm(io)) {
113                 /*
114                  * TDM Extend Mode
115                  * see
116                  *      rsnd_ssi_config_init()
117                  */
118                 rsnd_mod_write(mod, SSI_MODE, 0x1);
119         }
120
121         if (rsnd_ssi_use_busif(io)) {
122                 rsnd_mod_write(mod, SSI_BUSIF_ADINR,
123                                rsnd_get_adinr_bit(mod, io) |
124                                (rsnd_io_is_play(io) ?
125                                 rsnd_runtime_channel_after_ctu(io) :
126                                 rsnd_runtime_channel_original(io)));
127                 rsnd_mod_write(mod, SSI_BUSIF_MODE,  1);
128                 rsnd_mod_write(mod, SSI_BUSIF_DALIGN,
129                                rsnd_get_dalign(mod, io));
130         }
131
132         return 0;
133 }
134
135 static int rsnd_ssiu_start_gen2(struct rsnd_mod *mod,
136                                 struct rsnd_dai_stream *io,
137                                 struct rsnd_priv *priv)
138 {
139         if (!rsnd_ssi_use_busif(io))
140                 return 0;
141
142         rsnd_mod_write(mod, SSI_CTRL, 0x1);
143
144         if (rsnd_ssi_multi_slaves_runtime(io))
145                 rsnd_mod_write(mod, SSI_CONTROL, 0x1);
146
147         return 0;
148 }
149
150 static int rsnd_ssiu_stop_gen2(struct rsnd_mod *mod,
151                                struct rsnd_dai_stream *io,
152                                struct rsnd_priv *priv)
153 {
154         if (!rsnd_ssi_use_busif(io))
155                 return 0;
156
157         rsnd_mod_write(mod, SSI_CTRL, 0);
158
159         if (rsnd_ssi_multi_slaves_runtime(io))
160                 rsnd_mod_write(mod, SSI_CONTROL, 0);
161
162         return 0;
163 }
164
165 static struct rsnd_mod_ops rsnd_ssiu_ops_gen2 = {
166         .name   = SSIU_NAME,
167         .init   = rsnd_ssiu_init_gen2,
168         .start  = rsnd_ssiu_start_gen2,
169         .stop   = rsnd_ssiu_stop_gen2,
170 };
171
172 static struct rsnd_mod *rsnd_ssiu_mod_get(struct rsnd_priv *priv, int id)
173 {
174         if (WARN_ON(id < 0 || id >= rsnd_ssiu_nr(priv)))
175                 id = 0;
176
177         return rsnd_mod_get((struct rsnd_ssiu *)(priv->ssiu) + id);
178 }
179
180 int rsnd_ssiu_attach(struct rsnd_dai_stream *io,
181                      struct rsnd_mod *ssi_mod)
182 {
183         struct rsnd_priv *priv = rsnd_io_to_priv(io);
184         struct rsnd_mod *mod = rsnd_ssiu_mod_get(priv, rsnd_mod_id(ssi_mod));
185
186         rsnd_mod_confirm_ssi(ssi_mod);
187
188         return rsnd_dai_connect(mod, io, mod->type);
189 }
190
191 int rsnd_ssiu_probe(struct rsnd_priv *priv)
192 {
193         struct device *dev = rsnd_priv_to_dev(priv);
194         struct rsnd_ssiu *ssiu;
195         static struct rsnd_mod_ops *ops;
196         int i, nr, ret;
197
198         /* same number to SSI */
199         nr      = priv->ssi_nr;
200         ssiu    = devm_kzalloc(dev, sizeof(*ssiu) * nr, GFP_KERNEL);
201         if (!ssiu)
202                 return -ENOMEM;
203
204         priv->ssiu      = ssiu;
205         priv->ssiu_nr   = nr;
206
207         if (rsnd_is_gen1(priv))
208                 ops = &rsnd_ssiu_ops_gen1;
209         else
210                 ops = &rsnd_ssiu_ops_gen2;
211
212         for_each_rsnd_ssiu(ssiu, priv, i) {
213                 ret = rsnd_mod_init(priv, rsnd_mod_get(ssiu),
214                                     ops, NULL, rsnd_mod_get_status,
215                                     RSND_MOD_SSIU, i);
216                 if (ret)
217                         return ret;
218         }
219
220         return 0;
221 }
222
223 void rsnd_ssiu_remove(struct rsnd_priv *priv)
224 {
225         struct rsnd_ssiu *ssiu;
226         int i;
227
228         for_each_rsnd_ssiu(ssiu, priv, i) {
229                 rsnd_mod_quit(rsnd_mod_get(ssiu));
230         }
231 }