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 | ||
3337744a KM |
13 | struct rsnd_gen { |
14 | void __iomem *base[RSND_BASE_MAX]; | |
15 | ||
3337744a | 16 | struct rsnd_gen_ops *ops; |
55e5b6fd KM |
17 | |
18 | struct regmap *regmap; | |
19 | struct regmap_field *regs[RSND_REG_MAX]; | |
3337744a KM |
20 | }; |
21 | ||
22 | #define rsnd_priv_to_gen(p) ((struct rsnd_gen *)(p)->gen) | |
23 | ||
55e5b6fd KM |
24 | #define RSND_REG_SET(gen, id, reg_id, offset, _id_offset, _id_size) \ |
25 | [id] = { \ | |
26 | .reg = (unsigned int)gen->base[reg_id] + offset, \ | |
27 | .lsb = 0, \ | |
28 | .msb = 31, \ | |
29 | .id_size = _id_size, \ | |
30 | .id_offset = _id_offset, \ | |
31 | } | |
32 | ||
33 | /* | |
34 | * basic function | |
35 | */ | |
36 | static int rsnd_regmap_write32(void *context, const void *_data, size_t count) | |
37 | { | |
38 | struct rsnd_priv *priv = context; | |
39 | struct device *dev = rsnd_priv_to_dev(priv); | |
40 | u32 *data = (u32 *)_data; | |
41 | u32 val = data[1]; | |
42 | void __iomem *reg = (void *)data[0]; | |
43 | ||
44 | iowrite32(val, reg); | |
45 | ||
46 | dev_dbg(dev, "w %p : %08x\n", reg, val); | |
47 | ||
48 | return 0; | |
49 | } | |
50 | ||
51 | static int rsnd_regmap_read32(void *context, | |
52 | const void *_data, size_t reg_size, | |
53 | void *_val, size_t val_size) | |
54 | { | |
55 | struct rsnd_priv *priv = context; | |
56 | struct device *dev = rsnd_priv_to_dev(priv); | |
57 | u32 *data = (u32 *)_data; | |
58 | u32 *val = (u32 *)_val; | |
59 | void __iomem *reg = (void *)data[0]; | |
60 | ||
61 | *val = ioread32(reg); | |
62 | ||
63 | dev_dbg(dev, "r %p : %08x\n", reg, *val); | |
64 | ||
65 | return 0; | |
66 | } | |
67 | ||
68 | static struct regmap_bus rsnd_regmap_bus = { | |
69 | .write = rsnd_regmap_write32, | |
70 | .read = rsnd_regmap_read32, | |
71 | .reg_format_endian_default = REGMAP_ENDIAN_NATIVE, | |
72 | .val_format_endian_default = REGMAP_ENDIAN_NATIVE, | |
73 | }; | |
74 | ||
42ee5d22 KM |
75 | static int rsnd_is_accessible_reg(struct rsnd_priv *priv, |
76 | struct rsnd_gen *gen, enum rsnd_reg reg) | |
77 | { | |
78 | if (!gen->regs[reg]) { | |
79 | struct device *dev = rsnd_priv_to_dev(priv); | |
80 | ||
81 | dev_err(dev, "unsupported register access %x\n", reg); | |
82 | return 0; | |
83 | } | |
84 | ||
85 | return 1; | |
86 | } | |
87 | ||
55e5b6fd KM |
88 | u32 rsnd_read(struct rsnd_priv *priv, |
89 | struct rsnd_mod *mod, enum rsnd_reg reg) | |
90 | { | |
91 | struct rsnd_gen *gen = rsnd_priv_to_gen(priv); | |
92 | u32 val; | |
93 | ||
42ee5d22 KM |
94 | if (!rsnd_is_accessible_reg(priv, gen, reg)) |
95 | return 0; | |
96 | ||
55e5b6fd KM |
97 | regmap_fields_read(gen->regs[reg], rsnd_mod_id(mod), &val); |
98 | ||
99 | return val; | |
100 | } | |
101 | ||
102 | void rsnd_write(struct rsnd_priv *priv, | |
103 | struct rsnd_mod *mod, | |
104 | enum rsnd_reg reg, u32 data) | |
105 | { | |
106 | struct rsnd_gen *gen = rsnd_priv_to_gen(priv); | |
107 | ||
42ee5d22 KM |
108 | if (!rsnd_is_accessible_reg(priv, gen, reg)) |
109 | return; | |
110 | ||
55e5b6fd KM |
111 | regmap_fields_write(gen->regs[reg], rsnd_mod_id(mod), data); |
112 | } | |
113 | ||
114 | void rsnd_bset(struct rsnd_priv *priv, struct rsnd_mod *mod, | |
115 | enum rsnd_reg reg, u32 mask, u32 data) | |
116 | { | |
117 | struct rsnd_gen *gen = rsnd_priv_to_gen(priv); | |
118 | ||
42ee5d22 KM |
119 | if (!rsnd_is_accessible_reg(priv, gen, reg)) |
120 | return; | |
121 | ||
55e5b6fd KM |
122 | regmap_fields_update_bits(gen->regs[reg], rsnd_mod_id(mod), |
123 | mask, data); | |
124 | } | |
125 | ||
c1e6cc5e KM |
126 | static int rsnd_gen_regmap_init(struct rsnd_priv *priv, |
127 | struct rsnd_gen *gen, | |
128 | struct reg_field *regf) | |
129 | { | |
130 | int i; | |
131 | struct device *dev = rsnd_priv_to_dev(priv); | |
132 | struct regmap_config regc; | |
133 | ||
134 | memset(®c, 0, sizeof(regc)); | |
135 | regc.reg_bits = 32; | |
136 | regc.val_bits = 32; | |
137 | ||
138 | gen->regmap = devm_regmap_init(dev, &rsnd_regmap_bus, priv, ®c); | |
139 | if (IS_ERR(gen->regmap)) { | |
140 | dev_err(dev, "regmap error %ld\n", PTR_ERR(gen->regmap)); | |
141 | return PTR_ERR(gen->regmap); | |
142 | } | |
143 | ||
144 | for (i = 0; i < RSND_REG_MAX; i++) { | |
42ee5d22 KM |
145 | gen->regs[i] = NULL; |
146 | if (!regf[i].reg) | |
147 | continue; | |
148 | ||
c1e6cc5e KM |
149 | gen->regs[i] = devm_regmap_field_alloc(dev, gen->regmap, regf[i]); |
150 | if (IS_ERR(gen->regs[i])) | |
151 | return PTR_ERR(gen->regs[i]); | |
152 | ||
153 | } | |
154 | ||
155 | return 0; | |
156 | } | |
3337744a | 157 | |
994a9df1 KM |
158 | int rsnd_gen_path_init(struct rsnd_priv *priv, |
159 | struct rsnd_dai *rdai, | |
160 | struct rsnd_dai_stream *io) | |
07539c1d | 161 | { |
07539c1d KM |
162 | struct rsnd_mod *mod; |
163 | int ret; | |
164 | int id; | |
165 | ||
166 | /* | |
167 | * Gen1 is created by SRU/SSI, and this SRU is base module of | |
168 | * Gen2's SCU/SSIU/SSI. (Gen2 SCU/SSIU came from SRU) | |
169 | * | |
170 | * Easy image is.. | |
171 | * Gen1 SRU = Gen2 SCU + SSIU + etc | |
172 | * | |
173 | * Gen2 SCU path is very flexible, but, Gen1 SRU (SCU parts) is | |
174 | * using fixed path. | |
175 | * | |
176 | * Then, SSI id = SCU id here | |
177 | */ | |
178 | ||
4b4dab82 KM |
179 | /* get SSI's ID */ |
180 | mod = rsnd_ssi_mod_get_frm_dai(priv, | |
181 | rsnd_dai_id(priv, rdai), | |
182 | rsnd_dai_is_play(rdai, io)); | |
183 | id = rsnd_mod_id(mod); | |
07539c1d | 184 | |
ae5c3223 KM |
185 | /* SSI */ |
186 | mod = rsnd_ssi_mod_get(priv, id); | |
187 | ret = rsnd_dai_connect(rdai, mod, io); | |
188 | if (ret < 0) | |
189 | return ret; | |
190 | ||
07539c1d KM |
191 | /* SCU */ |
192 | mod = rsnd_scu_mod_get(priv, id); | |
193 | ret = rsnd_dai_connect(rdai, mod, io); | |
194 | ||
195 | return ret; | |
196 | } | |
197 | ||
994a9df1 KM |
198 | int rsnd_gen_path_exit(struct rsnd_priv *priv, |
199 | struct rsnd_dai *rdai, | |
200 | struct rsnd_dai_stream *io) | |
07539c1d KM |
201 | { |
202 | struct rsnd_mod *mod, *n; | |
203 | int ret = 0; | |
204 | ||
205 | /* | |
206 | * remove all mod from rdai | |
207 | */ | |
208 | for_each_rsnd_mod(mod, n, io) | |
209 | ret |= rsnd_dai_disconnect(mod); | |
210 | ||
211 | return ret; | |
212 | } | |
213 | ||
994a9df1 KM |
214 | /* |
215 | * Gen2 | |
994a9df1 KM |
216 | */ |
217 | ||
507d466c KM |
218 | /* single address mapping */ |
219 | #define RSND_GEN2_S_REG(gen, reg, id, offset) \ | |
1a1c75a7 | 220 | RSND_REG_SET(gen, RSND_REG_##id, RSND_GEN2_##reg, offset, 0, 10) |
507d466c KM |
221 | |
222 | /* multi address mapping */ | |
223 | #define RSND_GEN2_M_REG(gen, reg, id, offset, _id_offset) \ | |
1a1c75a7 | 224 | RSND_REG_SET(gen, RSND_REG_##id, RSND_GEN2_##reg, offset, _id_offset, 10) |
507d466c KM |
225 | |
226 | static int rsnd_gen2_regmap_init(struct rsnd_priv *priv, struct rsnd_gen *gen) | |
227 | { | |
228 | struct reg_field regf[RSND_REG_MAX] = { | |
229 | RSND_GEN2_S_REG(gen, SSIU, SSI_MODE0, 0x800), | |
230 | RSND_GEN2_S_REG(gen, SSIU, SSI_MODE1, 0x804), | |
231 | /* FIXME: it needs SSI_MODE2/3 in the future */ | |
232 | RSND_GEN2_M_REG(gen, SSIU, INT_ENABLE, 0x18, 0x80), | |
233 | ||
234 | RSND_GEN2_S_REG(gen, ADG, BRRA, 0x00), | |
235 | RSND_GEN2_S_REG(gen, ADG, BRRB, 0x04), | |
236 | RSND_GEN2_S_REG(gen, ADG, SSICKR, 0x08), | |
237 | RSND_GEN2_S_REG(gen, ADG, AUDIO_CLK_SEL0, 0x0c), | |
238 | RSND_GEN2_S_REG(gen, ADG, AUDIO_CLK_SEL1, 0x10), | |
239 | RSND_GEN2_S_REG(gen, ADG, AUDIO_CLK_SEL2, 0x14), | |
240 | ||
241 | RSND_GEN2_M_REG(gen, SSI, SSICR, 0x00, 0x40), | |
242 | RSND_GEN2_M_REG(gen, SSI, SSISR, 0x04, 0x40), | |
243 | RSND_GEN2_M_REG(gen, SSI, SSITDR, 0x08, 0x40), | |
244 | RSND_GEN2_M_REG(gen, SSI, SSIRDR, 0x0c, 0x40), | |
245 | RSND_GEN2_M_REG(gen, SSI, SSIWSR, 0x20, 0x40), | |
246 | }; | |
247 | ||
248 | return rsnd_gen_regmap_init(priv, gen, regf); | |
249 | } | |
250 | ||
251 | static int rsnd_gen2_probe(struct platform_device *pdev, | |
252 | struct rcar_snd_info *info, | |
253 | struct rsnd_priv *priv) | |
254 | { | |
255 | struct device *dev = rsnd_priv_to_dev(priv); | |
256 | struct rsnd_gen *gen = rsnd_priv_to_gen(priv); | |
257 | struct resource *scu_res; | |
258 | struct resource *adg_res; | |
259 | struct resource *ssiu_res; | |
260 | struct resource *ssi_res; | |
261 | int ret; | |
262 | ||
263 | /* | |
264 | * map address | |
265 | */ | |
266 | scu_res = platform_get_resource(pdev, IORESOURCE_MEM, RSND_GEN2_SCU); | |
267 | adg_res = platform_get_resource(pdev, IORESOURCE_MEM, RSND_GEN2_ADG); | |
268 | ssiu_res = platform_get_resource(pdev, IORESOURCE_MEM, RSND_GEN2_SSIU); | |
269 | ssi_res = platform_get_resource(pdev, IORESOURCE_MEM, RSND_GEN2_SSI); | |
270 | ||
271 | gen->base[RSND_GEN2_SCU] = devm_ioremap_resource(dev, scu_res); | |
272 | gen->base[RSND_GEN2_ADG] = devm_ioremap_resource(dev, adg_res); | |
273 | gen->base[RSND_GEN2_SSIU] = devm_ioremap_resource(dev, ssiu_res); | |
274 | gen->base[RSND_GEN2_SSI] = devm_ioremap_resource(dev, ssi_res); | |
275 | if (IS_ERR(gen->base[RSND_GEN2_SCU]) || | |
276 | IS_ERR(gen->base[RSND_GEN2_ADG]) || | |
277 | IS_ERR(gen->base[RSND_GEN2_SSIU]) || | |
278 | IS_ERR(gen->base[RSND_GEN2_SSI])) | |
279 | return -ENODEV; | |
280 | ||
281 | ret = rsnd_gen2_regmap_init(priv, gen); | |
282 | if (ret < 0) | |
283 | return ret; | |
284 | ||
285 | dev_dbg(dev, "Gen2 device probed\n"); | |
286 | dev_dbg(dev, "SRU : %08x => %p\n", scu_res->start, | |
287 | gen->base[RSND_GEN2_SCU]); | |
288 | dev_dbg(dev, "ADG : %08x => %p\n", adg_res->start, | |
289 | gen->base[RSND_GEN2_ADG]); | |
290 | dev_dbg(dev, "SSIU : %08x => %p\n", ssiu_res->start, | |
291 | gen->base[RSND_GEN2_SSIU]); | |
292 | dev_dbg(dev, "SSI : %08x => %p\n", ssi_res->start, | |
293 | gen->base[RSND_GEN2_SSI]); | |
294 | ||
295 | return 0; | |
296 | } | |
297 | ||
994a9df1 KM |
298 | /* |
299 | * Gen1 | |
300 | */ | |
301 | ||
55e5b6fd KM |
302 | /* single address mapping */ |
303 | #define RSND_GEN1_S_REG(gen, reg, id, offset) \ | |
304 | RSND_REG_SET(gen, RSND_REG_##id, RSND_GEN1_##reg, offset, 0, 9) | |
07539c1d | 305 | |
55e5b6fd KM |
306 | /* multi address mapping */ |
307 | #define RSND_GEN1_M_REG(gen, reg, id, offset, _id_offset) \ | |
308 | RSND_REG_SET(gen, RSND_REG_##id, RSND_GEN1_##reg, offset, _id_offset, 9) | |
309 | ||
310 | static int rsnd_gen1_regmap_init(struct rsnd_priv *priv, struct rsnd_gen *gen) | |
07539c1d | 311 | { |
55e5b6fd KM |
312 | struct reg_field regf[RSND_REG_MAX] = { |
313 | RSND_GEN1_S_REG(gen, SRU, SRC_ROUTE_SEL, 0x00), | |
314 | RSND_GEN1_S_REG(gen, SRU, SRC_TMG_SEL0, 0x08), | |
315 | RSND_GEN1_S_REG(gen, SRU, SRC_TMG_SEL1, 0x0c), | |
316 | RSND_GEN1_S_REG(gen, SRU, SRC_TMG_SEL2, 0x10), | |
690ef81e | 317 | RSND_GEN1_S_REG(gen, SRU, SRC_ROUTE_CTRL, 0xc0), |
55e5b6fd KM |
318 | RSND_GEN1_S_REG(gen, SRU, SSI_MODE0, 0xD0), |
319 | RSND_GEN1_S_REG(gen, SRU, SSI_MODE1, 0xD4), | |
320 | RSND_GEN1_M_REG(gen, SRU, BUSIF_MODE, 0x20, 0x4), | |
ef749400 KM |
321 | RSND_GEN1_M_REG(gen, SRU, SRC_ROUTE_MODE0,0x50, 0x8), |
322 | RSND_GEN1_M_REG(gen, SRU, SRC_SWRSR, 0x200, 0x40), | |
323 | RSND_GEN1_M_REG(gen, SRU, SRC_SRCIR, 0x204, 0x40), | |
690ef81e | 324 | RSND_GEN1_M_REG(gen, SRU, SRC_ADINR, 0x214, 0x40), |
ef749400 KM |
325 | RSND_GEN1_M_REG(gen, SRU, SRC_IFSCR, 0x21c, 0x40), |
326 | RSND_GEN1_M_REG(gen, SRU, SRC_IFSVR, 0x220, 0x40), | |
327 | RSND_GEN1_M_REG(gen, SRU, SRC_SRCCR, 0x224, 0x40), | |
328 | RSND_GEN1_M_REG(gen, SRU, SRC_MNFSR, 0x228, 0x40), | |
55e5b6fd KM |
329 | |
330 | RSND_GEN1_S_REG(gen, ADG, BRRA, 0x00), | |
331 | RSND_GEN1_S_REG(gen, ADG, BRRB, 0x04), | |
332 | RSND_GEN1_S_REG(gen, ADG, SSICKR, 0x08), | |
333 | RSND_GEN1_S_REG(gen, ADG, AUDIO_CLK_SEL0, 0x0c), | |
334 | RSND_GEN1_S_REG(gen, ADG, AUDIO_CLK_SEL1, 0x10), | |
ef749400 KM |
335 | RSND_GEN1_S_REG(gen, ADG, AUDIO_CLK_SEL3, 0x18), |
336 | RSND_GEN1_S_REG(gen, ADG, AUDIO_CLK_SEL4, 0x1c), | |
337 | RSND_GEN1_S_REG(gen, ADG, AUDIO_CLK_SEL5, 0x20), | |
55e5b6fd KM |
338 | |
339 | RSND_GEN1_M_REG(gen, SSI, SSICR, 0x00, 0x40), | |
340 | RSND_GEN1_M_REG(gen, SSI, SSISR, 0x04, 0x40), | |
341 | RSND_GEN1_M_REG(gen, SSI, SSITDR, 0x08, 0x40), | |
342 | RSND_GEN1_M_REG(gen, SSI, SSIRDR, 0x0c, 0x40), | |
343 | RSND_GEN1_M_REG(gen, SSI, SSIWSR, 0x20, 0x40), | |
344 | }; | |
345 | ||
c1e6cc5e | 346 | return rsnd_gen_regmap_init(priv, gen, regf); |
07539c1d KM |
347 | } |
348 | ||
3337744a KM |
349 | static int rsnd_gen1_probe(struct platform_device *pdev, |
350 | struct rcar_snd_info *info, | |
351 | struct rsnd_priv *priv) | |
352 | { | |
07539c1d KM |
353 | struct device *dev = rsnd_priv_to_dev(priv); |
354 | struct rsnd_gen *gen = rsnd_priv_to_gen(priv); | |
355 | struct resource *sru_res; | |
dfc9403b | 356 | struct resource *adg_res; |
ae5c3223 | 357 | struct resource *ssi_res; |
55e5b6fd | 358 | int ret; |
07539c1d KM |
359 | |
360 | /* | |
361 | * map address | |
362 | */ | |
363 | sru_res = platform_get_resource(pdev, IORESOURCE_MEM, RSND_GEN1_SRU); | |
dfc9403b | 364 | adg_res = platform_get_resource(pdev, IORESOURCE_MEM, RSND_GEN1_ADG); |
ae5c3223 | 365 | ssi_res = platform_get_resource(pdev, IORESOURCE_MEM, RSND_GEN1_SSI); |
07539c1d KM |
366 | |
367 | gen->base[RSND_GEN1_SRU] = devm_ioremap_resource(dev, sru_res); | |
dfc9403b | 368 | gen->base[RSND_GEN1_ADG] = devm_ioremap_resource(dev, adg_res); |
ae5c3223 | 369 | gen->base[RSND_GEN1_SSI] = devm_ioremap_resource(dev, ssi_res); |
70263cb4 WY |
370 | if (IS_ERR(gen->base[RSND_GEN1_SRU]) || |
371 | IS_ERR(gen->base[RSND_GEN1_ADG]) || | |
372 | IS_ERR(gen->base[RSND_GEN1_SSI])) | |
07539c1d | 373 | return -ENODEV; |
07539c1d | 374 | |
55e5b6fd KM |
375 | ret = rsnd_gen1_regmap_init(priv, gen); |
376 | if (ret < 0) | |
377 | return ret; | |
07539c1d KM |
378 | |
379 | dev_dbg(dev, "Gen1 device probed\n"); | |
380 | dev_dbg(dev, "SRU : %08x => %p\n", sru_res->start, | |
381 | gen->base[RSND_GEN1_SRU]); | |
dfc9403b KM |
382 | dev_dbg(dev, "ADG : %08x => %p\n", adg_res->start, |
383 | gen->base[RSND_GEN1_ADG]); | |
ae5c3223 KM |
384 | dev_dbg(dev, "SSI : %08x => %p\n", ssi_res->start, |
385 | gen->base[RSND_GEN1_SSI]); | |
07539c1d | 386 | |
3337744a | 387 | return 0; |
ae5c3223 | 388 | |
3337744a KM |
389 | } |
390 | ||
3337744a KM |
391 | /* |
392 | * Gen | |
393 | */ | |
3337744a KM |
394 | int rsnd_gen_probe(struct platform_device *pdev, |
395 | struct rcar_snd_info *info, | |
396 | struct rsnd_priv *priv) | |
397 | { | |
398 | struct device *dev = rsnd_priv_to_dev(priv); | |
399 | struct rsnd_gen *gen; | |
531eaf49 | 400 | int ret; |
3337744a KM |
401 | |
402 | gen = devm_kzalloc(dev, sizeof(*gen), GFP_KERNEL); | |
403 | if (!gen) { | |
404 | dev_err(dev, "GEN allocate failed\n"); | |
405 | return -ENOMEM; | |
406 | } | |
407 | ||
531eaf49 | 408 | priv->gen = gen; |
072188b6 | 409 | |
507d466c KM |
410 | ret = -ENODEV; |
411 | if (rsnd_is_gen1(priv)) | |
531eaf49 | 412 | ret = rsnd_gen1_probe(pdev, info, priv); |
507d466c KM |
413 | else if (rsnd_is_gen2(priv)) |
414 | ret = rsnd_gen2_probe(pdev, info, priv); | |
415 | ||
416 | if (ret < 0) | |
072188b6 | 417 | dev_err(dev, "unknown generation R-Car sound device\n"); |
072188b6 | 418 | |
531eaf49 | 419 | return ret; |
3337744a KM |
420 | } |
421 | ||
422 | void rsnd_gen_remove(struct platform_device *pdev, | |
423 | struct rsnd_priv *priv) | |
424 | { | |
3337744a | 425 | } |