Commit | Line | Data |
---|---|---|
3337744a KM |
1 | /* |
2 | * Renesas R-Car Gen1 SRU/SSI support | |
3 | * | |
4 | * Copyright (C) 2013 Renesas Solutions Corp. | |
5 | * Kuninori Morimoto <kuninori.morimoto.gx@renesas.com> | |
6 | * | |
7 | * This program is free software; you can redistribute it and/or modify | |
8 | * it under the terms of the GNU General Public License version 2 as | |
9 | * published by the Free Software Foundation. | |
10 | */ | |
11 | #include "rsnd.h" | |
12 | ||
13 | struct rsnd_gen_ops { | |
072188b6 KM |
14 | int (*probe)(struct platform_device *pdev, |
15 | struct rcar_snd_info *info, | |
16 | struct rsnd_priv *priv); | |
17 | void (*remove)(struct platform_device *pdev, | |
18 | struct rsnd_priv *priv); | |
3337744a KM |
19 | int (*path_init)(struct rsnd_priv *priv, |
20 | struct rsnd_dai *rdai, | |
21 | struct rsnd_dai_stream *io); | |
22 | int (*path_exit)(struct rsnd_priv *priv, | |
23 | struct rsnd_dai *rdai, | |
24 | struct rsnd_dai_stream *io); | |
25 | }; | |
26 | ||
3337744a KM |
27 | struct rsnd_gen { |
28 | void __iomem *base[RSND_BASE_MAX]; | |
29 | ||
3337744a | 30 | struct rsnd_gen_ops *ops; |
55e5b6fd KM |
31 | |
32 | struct regmap *regmap; | |
33 | struct regmap_field *regs[RSND_REG_MAX]; | |
3337744a KM |
34 | }; |
35 | ||
36 | #define rsnd_priv_to_gen(p) ((struct rsnd_gen *)(p)->gen) | |
37 | ||
55e5b6fd KM |
38 | #define RSND_REG_SET(gen, id, reg_id, offset, _id_offset, _id_size) \ |
39 | [id] = { \ | |
40 | .reg = (unsigned int)gen->base[reg_id] + offset, \ | |
41 | .lsb = 0, \ | |
42 | .msb = 31, \ | |
43 | .id_size = _id_size, \ | |
44 | .id_offset = _id_offset, \ | |
45 | } | |
46 | ||
47 | /* | |
48 | * basic function | |
49 | */ | |
50 | static int rsnd_regmap_write32(void *context, const void *_data, size_t count) | |
51 | { | |
52 | struct rsnd_priv *priv = context; | |
53 | struct device *dev = rsnd_priv_to_dev(priv); | |
54 | u32 *data = (u32 *)_data; | |
55 | u32 val = data[1]; | |
56 | void __iomem *reg = (void *)data[0]; | |
57 | ||
58 | iowrite32(val, reg); | |
59 | ||
60 | dev_dbg(dev, "w %p : %08x\n", reg, val); | |
61 | ||
62 | return 0; | |
63 | } | |
64 | ||
65 | static int rsnd_regmap_read32(void *context, | |
66 | const void *_data, size_t reg_size, | |
67 | void *_val, size_t val_size) | |
68 | { | |
69 | struct rsnd_priv *priv = context; | |
70 | struct device *dev = rsnd_priv_to_dev(priv); | |
71 | u32 *data = (u32 *)_data; | |
72 | u32 *val = (u32 *)_val; | |
73 | void __iomem *reg = (void *)data[0]; | |
74 | ||
75 | *val = ioread32(reg); | |
76 | ||
77 | dev_dbg(dev, "r %p : %08x\n", reg, *val); | |
78 | ||
79 | return 0; | |
80 | } | |
81 | ||
82 | static struct regmap_bus rsnd_regmap_bus = { | |
83 | .write = rsnd_regmap_write32, | |
84 | .read = rsnd_regmap_read32, | |
85 | .reg_format_endian_default = REGMAP_ENDIAN_NATIVE, | |
86 | .val_format_endian_default = REGMAP_ENDIAN_NATIVE, | |
87 | }; | |
88 | ||
89 | u32 rsnd_read(struct rsnd_priv *priv, | |
90 | struct rsnd_mod *mod, enum rsnd_reg reg) | |
91 | { | |
92 | struct rsnd_gen *gen = rsnd_priv_to_gen(priv); | |
93 | u32 val; | |
94 | ||
95 | regmap_fields_read(gen->regs[reg], rsnd_mod_id(mod), &val); | |
96 | ||
97 | return val; | |
98 | } | |
99 | ||
100 | void rsnd_write(struct rsnd_priv *priv, | |
101 | struct rsnd_mod *mod, | |
102 | enum rsnd_reg reg, u32 data) | |
103 | { | |
104 | struct rsnd_gen *gen = rsnd_priv_to_gen(priv); | |
105 | ||
106 | regmap_fields_write(gen->regs[reg], rsnd_mod_id(mod), data); | |
107 | } | |
108 | ||
109 | void rsnd_bset(struct rsnd_priv *priv, struct rsnd_mod *mod, | |
110 | enum rsnd_reg reg, u32 mask, u32 data) | |
111 | { | |
112 | struct rsnd_gen *gen = rsnd_priv_to_gen(priv); | |
113 | ||
114 | regmap_fields_update_bits(gen->regs[reg], rsnd_mod_id(mod), | |
115 | mask, data); | |
116 | } | |
117 | ||
c1e6cc5e KM |
118 | static int rsnd_gen_regmap_init(struct rsnd_priv *priv, |
119 | struct rsnd_gen *gen, | |
120 | struct reg_field *regf) | |
121 | { | |
122 | int i; | |
123 | struct device *dev = rsnd_priv_to_dev(priv); | |
124 | struct regmap_config regc; | |
125 | ||
126 | memset(®c, 0, sizeof(regc)); | |
127 | regc.reg_bits = 32; | |
128 | regc.val_bits = 32; | |
129 | ||
130 | gen->regmap = devm_regmap_init(dev, &rsnd_regmap_bus, priv, ®c); | |
131 | if (IS_ERR(gen->regmap)) { | |
132 | dev_err(dev, "regmap error %ld\n", PTR_ERR(gen->regmap)); | |
133 | return PTR_ERR(gen->regmap); | |
134 | } | |
135 | ||
136 | for (i = 0; i < RSND_REG_MAX; i++) { | |
137 | gen->regs[i] = devm_regmap_field_alloc(dev, gen->regmap, regf[i]); | |
138 | if (IS_ERR(gen->regs[i])) | |
139 | return PTR_ERR(gen->regs[i]); | |
140 | ||
141 | } | |
142 | ||
143 | return 0; | |
144 | } | |
3337744a KM |
145 | /* |
146 | * Gen2 | |
147 | * will be filled in the future | |
148 | */ | |
149 | ||
150 | /* | |
151 | * Gen1 | |
152 | */ | |
07539c1d KM |
153 | static int rsnd_gen1_path_init(struct rsnd_priv *priv, |
154 | struct rsnd_dai *rdai, | |
155 | struct rsnd_dai_stream *io) | |
156 | { | |
07539c1d KM |
157 | struct rsnd_mod *mod; |
158 | int ret; | |
159 | int id; | |
160 | ||
161 | /* | |
162 | * Gen1 is created by SRU/SSI, and this SRU is base module of | |
163 | * Gen2's SCU/SSIU/SSI. (Gen2 SCU/SSIU came from SRU) | |
164 | * | |
165 | * Easy image is.. | |
166 | * Gen1 SRU = Gen2 SCU + SSIU + etc | |
167 | * | |
168 | * Gen2 SCU path is very flexible, but, Gen1 SRU (SCU parts) is | |
169 | * using fixed path. | |
170 | * | |
171 | * Then, SSI id = SCU id here | |
172 | */ | |
173 | ||
4b4dab82 KM |
174 | /* get SSI's ID */ |
175 | mod = rsnd_ssi_mod_get_frm_dai(priv, | |
176 | rsnd_dai_id(priv, rdai), | |
177 | rsnd_dai_is_play(rdai, io)); | |
178 | id = rsnd_mod_id(mod); | |
07539c1d | 179 | |
ae5c3223 KM |
180 | /* SSI */ |
181 | mod = rsnd_ssi_mod_get(priv, id); | |
182 | ret = rsnd_dai_connect(rdai, mod, io); | |
183 | if (ret < 0) | |
184 | return ret; | |
185 | ||
07539c1d KM |
186 | /* SCU */ |
187 | mod = rsnd_scu_mod_get(priv, id); | |
188 | ret = rsnd_dai_connect(rdai, mod, io); | |
189 | ||
190 | return ret; | |
191 | } | |
192 | ||
193 | static int rsnd_gen1_path_exit(struct rsnd_priv *priv, | |
194 | struct rsnd_dai *rdai, | |
195 | struct rsnd_dai_stream *io) | |
196 | { | |
197 | struct rsnd_mod *mod, *n; | |
198 | int ret = 0; | |
199 | ||
200 | /* | |
201 | * remove all mod from rdai | |
202 | */ | |
203 | for_each_rsnd_mod(mod, n, io) | |
204 | ret |= rsnd_dai_disconnect(mod); | |
205 | ||
206 | return ret; | |
207 | } | |
208 | ||
55e5b6fd KM |
209 | /* single address mapping */ |
210 | #define RSND_GEN1_S_REG(gen, reg, id, offset) \ | |
211 | RSND_REG_SET(gen, RSND_REG_##id, RSND_GEN1_##reg, offset, 0, 9) | |
07539c1d | 212 | |
55e5b6fd KM |
213 | /* multi address mapping */ |
214 | #define RSND_GEN1_M_REG(gen, reg, id, offset, _id_offset) \ | |
215 | RSND_REG_SET(gen, RSND_REG_##id, RSND_GEN1_##reg, offset, _id_offset, 9) | |
216 | ||
217 | static int rsnd_gen1_regmap_init(struct rsnd_priv *priv, struct rsnd_gen *gen) | |
07539c1d | 218 | { |
55e5b6fd KM |
219 | struct reg_field regf[RSND_REG_MAX] = { |
220 | RSND_GEN1_S_REG(gen, SRU, SRC_ROUTE_SEL, 0x00), | |
221 | RSND_GEN1_S_REG(gen, SRU, SRC_TMG_SEL0, 0x08), | |
222 | RSND_GEN1_S_REG(gen, SRU, SRC_TMG_SEL1, 0x0c), | |
223 | RSND_GEN1_S_REG(gen, SRU, SRC_TMG_SEL2, 0x10), | |
224 | RSND_GEN1_S_REG(gen, SRU, SRC_CTRL, 0xc0), | |
225 | RSND_GEN1_S_REG(gen, SRU, SSI_MODE0, 0xD0), | |
226 | RSND_GEN1_S_REG(gen, SRU, SSI_MODE1, 0xD4), | |
227 | RSND_GEN1_M_REG(gen, SRU, BUSIF_MODE, 0x20, 0x4), | |
228 | RSND_GEN1_M_REG(gen, SRU, BUSIF_ADINR, 0x214, 0x40), | |
229 | ||
230 | RSND_GEN1_S_REG(gen, ADG, BRRA, 0x00), | |
231 | RSND_GEN1_S_REG(gen, ADG, BRRB, 0x04), | |
232 | RSND_GEN1_S_REG(gen, ADG, SSICKR, 0x08), | |
233 | RSND_GEN1_S_REG(gen, ADG, AUDIO_CLK_SEL0, 0x0c), | |
234 | RSND_GEN1_S_REG(gen, ADG, AUDIO_CLK_SEL1, 0x10), | |
55e5b6fd KM |
235 | |
236 | RSND_GEN1_M_REG(gen, SSI, SSICR, 0x00, 0x40), | |
237 | RSND_GEN1_M_REG(gen, SSI, SSISR, 0x04, 0x40), | |
238 | RSND_GEN1_M_REG(gen, SSI, SSITDR, 0x08, 0x40), | |
239 | RSND_GEN1_M_REG(gen, SSI, SSIRDR, 0x0c, 0x40), | |
240 | RSND_GEN1_M_REG(gen, SSI, SSIWSR, 0x20, 0x40), | |
241 | }; | |
242 | ||
c1e6cc5e | 243 | return rsnd_gen_regmap_init(priv, gen, regf); |
07539c1d KM |
244 | } |
245 | ||
3337744a KM |
246 | static int rsnd_gen1_probe(struct platform_device *pdev, |
247 | struct rcar_snd_info *info, | |
248 | struct rsnd_priv *priv) | |
249 | { | |
07539c1d KM |
250 | struct device *dev = rsnd_priv_to_dev(priv); |
251 | struct rsnd_gen *gen = rsnd_priv_to_gen(priv); | |
252 | struct resource *sru_res; | |
dfc9403b | 253 | struct resource *adg_res; |
ae5c3223 | 254 | struct resource *ssi_res; |
55e5b6fd | 255 | int ret; |
07539c1d KM |
256 | |
257 | /* | |
258 | * map address | |
259 | */ | |
260 | sru_res = platform_get_resource(pdev, IORESOURCE_MEM, RSND_GEN1_SRU); | |
dfc9403b | 261 | adg_res = platform_get_resource(pdev, IORESOURCE_MEM, RSND_GEN1_ADG); |
ae5c3223 | 262 | ssi_res = platform_get_resource(pdev, IORESOURCE_MEM, RSND_GEN1_SSI); |
07539c1d KM |
263 | |
264 | gen->base[RSND_GEN1_SRU] = devm_ioremap_resource(dev, sru_res); | |
dfc9403b | 265 | gen->base[RSND_GEN1_ADG] = devm_ioremap_resource(dev, adg_res); |
ae5c3223 | 266 | gen->base[RSND_GEN1_SSI] = devm_ioremap_resource(dev, ssi_res); |
70263cb4 WY |
267 | if (IS_ERR(gen->base[RSND_GEN1_SRU]) || |
268 | IS_ERR(gen->base[RSND_GEN1_ADG]) || | |
269 | IS_ERR(gen->base[RSND_GEN1_SSI])) | |
07539c1d | 270 | return -ENODEV; |
07539c1d | 271 | |
55e5b6fd KM |
272 | ret = rsnd_gen1_regmap_init(priv, gen); |
273 | if (ret < 0) | |
274 | return ret; | |
07539c1d KM |
275 | |
276 | dev_dbg(dev, "Gen1 device probed\n"); | |
277 | dev_dbg(dev, "SRU : %08x => %p\n", sru_res->start, | |
278 | gen->base[RSND_GEN1_SRU]); | |
dfc9403b KM |
279 | dev_dbg(dev, "ADG : %08x => %p\n", adg_res->start, |
280 | gen->base[RSND_GEN1_ADG]); | |
ae5c3223 KM |
281 | dev_dbg(dev, "SSI : %08x => %p\n", ssi_res->start, |
282 | gen->base[RSND_GEN1_SSI]); | |
07539c1d | 283 | |
3337744a | 284 | return 0; |
ae5c3223 | 285 | |
3337744a KM |
286 | } |
287 | ||
288 | static void rsnd_gen1_remove(struct platform_device *pdev, | |
289 | struct rsnd_priv *priv) | |
290 | { | |
291 | } | |
292 | ||
072188b6 KM |
293 | static struct rsnd_gen_ops rsnd_gen1_ops = { |
294 | .probe = rsnd_gen1_probe, | |
295 | .remove = rsnd_gen1_remove, | |
296 | .path_init = rsnd_gen1_path_init, | |
297 | .path_exit = rsnd_gen1_path_exit, | |
298 | }; | |
299 | ||
3337744a KM |
300 | /* |
301 | * Gen | |
302 | */ | |
303 | int rsnd_gen_path_init(struct rsnd_priv *priv, | |
304 | struct rsnd_dai *rdai, | |
305 | struct rsnd_dai_stream *io) | |
306 | { | |
307 | struct rsnd_gen *gen = rsnd_priv_to_gen(priv); | |
308 | ||
309 | return gen->ops->path_init(priv, rdai, io); | |
310 | } | |
311 | ||
312 | int rsnd_gen_path_exit(struct rsnd_priv *priv, | |
313 | struct rsnd_dai *rdai, | |
314 | struct rsnd_dai_stream *io) | |
315 | { | |
316 | struct rsnd_gen *gen = rsnd_priv_to_gen(priv); | |
317 | ||
318 | return gen->ops->path_exit(priv, rdai, io); | |
319 | } | |
320 | ||
3337744a KM |
321 | int rsnd_gen_probe(struct platform_device *pdev, |
322 | struct rcar_snd_info *info, | |
323 | struct rsnd_priv *priv) | |
324 | { | |
325 | struct device *dev = rsnd_priv_to_dev(priv); | |
326 | struct rsnd_gen *gen; | |
3337744a KM |
327 | |
328 | gen = devm_kzalloc(dev, sizeof(*gen), GFP_KERNEL); | |
329 | if (!gen) { | |
330 | dev_err(dev, "GEN allocate failed\n"); | |
331 | return -ENOMEM; | |
332 | } | |
333 | ||
072188b6 KM |
334 | if (rsnd_is_gen1(priv)) |
335 | gen->ops = &rsnd_gen1_ops; | |
336 | ||
337 | if (!gen->ops) { | |
338 | dev_err(dev, "unknown generation R-Car sound device\n"); | |
339 | return -ENODEV; | |
340 | } | |
341 | ||
3337744a KM |
342 | priv->gen = gen; |
343 | ||
072188b6 | 344 | return gen->ops->probe(pdev, info, priv); |
3337744a KM |
345 | } |
346 | ||
347 | void rsnd_gen_remove(struct platform_device *pdev, | |
348 | struct rsnd_priv *priv) | |
349 | { | |
072188b6 KM |
350 | struct rsnd_gen *gen = rsnd_priv_to_gen(priv); |
351 | ||
352 | gen->ops->remove(pdev, priv); | |
3337744a | 353 | } |