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 | ||
42ee5d22 KM |
89 | static int rsnd_is_accessible_reg(struct rsnd_priv *priv, |
90 | struct rsnd_gen *gen, enum rsnd_reg reg) | |
91 | { | |
92 | if (!gen->regs[reg]) { | |
93 | struct device *dev = rsnd_priv_to_dev(priv); | |
94 | ||
95 | dev_err(dev, "unsupported register access %x\n", reg); | |
96 | return 0; | |
97 | } | |
98 | ||
99 | return 1; | |
100 | } | |
101 | ||
55e5b6fd KM |
102 | u32 rsnd_read(struct rsnd_priv *priv, |
103 | struct rsnd_mod *mod, enum rsnd_reg reg) | |
104 | { | |
105 | struct rsnd_gen *gen = rsnd_priv_to_gen(priv); | |
106 | u32 val; | |
107 | ||
42ee5d22 KM |
108 | if (!rsnd_is_accessible_reg(priv, gen, reg)) |
109 | return 0; | |
110 | ||
55e5b6fd KM |
111 | regmap_fields_read(gen->regs[reg], rsnd_mod_id(mod), &val); |
112 | ||
113 | return val; | |
114 | } | |
115 | ||
116 | void rsnd_write(struct rsnd_priv *priv, | |
117 | struct rsnd_mod *mod, | |
118 | enum rsnd_reg reg, u32 data) | |
119 | { | |
120 | struct rsnd_gen *gen = rsnd_priv_to_gen(priv); | |
121 | ||
42ee5d22 KM |
122 | if (!rsnd_is_accessible_reg(priv, gen, reg)) |
123 | return; | |
124 | ||
55e5b6fd KM |
125 | regmap_fields_write(gen->regs[reg], rsnd_mod_id(mod), data); |
126 | } | |
127 | ||
128 | void rsnd_bset(struct rsnd_priv *priv, struct rsnd_mod *mod, | |
129 | enum rsnd_reg reg, u32 mask, u32 data) | |
130 | { | |
131 | struct rsnd_gen *gen = rsnd_priv_to_gen(priv); | |
132 | ||
42ee5d22 KM |
133 | if (!rsnd_is_accessible_reg(priv, gen, reg)) |
134 | return; | |
135 | ||
55e5b6fd KM |
136 | regmap_fields_update_bits(gen->regs[reg], rsnd_mod_id(mod), |
137 | mask, data); | |
138 | } | |
139 | ||
c1e6cc5e KM |
140 | static int rsnd_gen_regmap_init(struct rsnd_priv *priv, |
141 | struct rsnd_gen *gen, | |
142 | struct reg_field *regf) | |
143 | { | |
144 | int i; | |
145 | struct device *dev = rsnd_priv_to_dev(priv); | |
146 | struct regmap_config regc; | |
147 | ||
148 | memset(®c, 0, sizeof(regc)); | |
149 | regc.reg_bits = 32; | |
150 | regc.val_bits = 32; | |
151 | ||
152 | gen->regmap = devm_regmap_init(dev, &rsnd_regmap_bus, priv, ®c); | |
153 | if (IS_ERR(gen->regmap)) { | |
154 | dev_err(dev, "regmap error %ld\n", PTR_ERR(gen->regmap)); | |
155 | return PTR_ERR(gen->regmap); | |
156 | } | |
157 | ||
158 | for (i = 0; i < RSND_REG_MAX; i++) { | |
42ee5d22 KM |
159 | gen->regs[i] = NULL; |
160 | if (!regf[i].reg) | |
161 | continue; | |
162 | ||
c1e6cc5e KM |
163 | gen->regs[i] = devm_regmap_field_alloc(dev, gen->regmap, regf[i]); |
164 | if (IS_ERR(gen->regs[i])) | |
165 | return PTR_ERR(gen->regs[i]); | |
166 | ||
167 | } | |
168 | ||
169 | return 0; | |
170 | } | |
3337744a KM |
171 | /* |
172 | * Gen2 | |
173 | * will be filled in the future | |
174 | */ | |
175 | ||
176 | /* | |
177 | * Gen1 | |
178 | */ | |
07539c1d KM |
179 | static int rsnd_gen1_path_init(struct rsnd_priv *priv, |
180 | struct rsnd_dai *rdai, | |
181 | struct rsnd_dai_stream *io) | |
182 | { | |
07539c1d KM |
183 | struct rsnd_mod *mod; |
184 | int ret; | |
185 | int id; | |
186 | ||
187 | /* | |
188 | * Gen1 is created by SRU/SSI, and this SRU is base module of | |
189 | * Gen2's SCU/SSIU/SSI. (Gen2 SCU/SSIU came from SRU) | |
190 | * | |
191 | * Easy image is.. | |
192 | * Gen1 SRU = Gen2 SCU + SSIU + etc | |
193 | * | |
194 | * Gen2 SCU path is very flexible, but, Gen1 SRU (SCU parts) is | |
195 | * using fixed path. | |
196 | * | |
197 | * Then, SSI id = SCU id here | |
198 | */ | |
199 | ||
4b4dab82 KM |
200 | /* get SSI's ID */ |
201 | mod = rsnd_ssi_mod_get_frm_dai(priv, | |
202 | rsnd_dai_id(priv, rdai), | |
203 | rsnd_dai_is_play(rdai, io)); | |
204 | id = rsnd_mod_id(mod); | |
07539c1d | 205 | |
ae5c3223 KM |
206 | /* SSI */ |
207 | mod = rsnd_ssi_mod_get(priv, id); | |
208 | ret = rsnd_dai_connect(rdai, mod, io); | |
209 | if (ret < 0) | |
210 | return ret; | |
211 | ||
07539c1d KM |
212 | /* SCU */ |
213 | mod = rsnd_scu_mod_get(priv, id); | |
214 | ret = rsnd_dai_connect(rdai, mod, io); | |
215 | ||
216 | return ret; | |
217 | } | |
218 | ||
219 | static int rsnd_gen1_path_exit(struct rsnd_priv *priv, | |
220 | struct rsnd_dai *rdai, | |
221 | struct rsnd_dai_stream *io) | |
222 | { | |
223 | struct rsnd_mod *mod, *n; | |
224 | int ret = 0; | |
225 | ||
226 | /* | |
227 | * remove all mod from rdai | |
228 | */ | |
229 | for_each_rsnd_mod(mod, n, io) | |
230 | ret |= rsnd_dai_disconnect(mod); | |
231 | ||
232 | return ret; | |
233 | } | |
234 | ||
55e5b6fd KM |
235 | /* single address mapping */ |
236 | #define RSND_GEN1_S_REG(gen, reg, id, offset) \ | |
237 | RSND_REG_SET(gen, RSND_REG_##id, RSND_GEN1_##reg, offset, 0, 9) | |
07539c1d | 238 | |
55e5b6fd KM |
239 | /* multi address mapping */ |
240 | #define RSND_GEN1_M_REG(gen, reg, id, offset, _id_offset) \ | |
241 | RSND_REG_SET(gen, RSND_REG_##id, RSND_GEN1_##reg, offset, _id_offset, 9) | |
242 | ||
243 | static int rsnd_gen1_regmap_init(struct rsnd_priv *priv, struct rsnd_gen *gen) | |
07539c1d | 244 | { |
55e5b6fd KM |
245 | struct reg_field regf[RSND_REG_MAX] = { |
246 | RSND_GEN1_S_REG(gen, SRU, SRC_ROUTE_SEL, 0x00), | |
247 | RSND_GEN1_S_REG(gen, SRU, SRC_TMG_SEL0, 0x08), | |
248 | RSND_GEN1_S_REG(gen, SRU, SRC_TMG_SEL1, 0x0c), | |
249 | RSND_GEN1_S_REG(gen, SRU, SRC_TMG_SEL2, 0x10), | |
250 | RSND_GEN1_S_REG(gen, SRU, SRC_CTRL, 0xc0), | |
251 | RSND_GEN1_S_REG(gen, SRU, SSI_MODE0, 0xD0), | |
252 | RSND_GEN1_S_REG(gen, SRU, SSI_MODE1, 0xD4), | |
253 | RSND_GEN1_M_REG(gen, SRU, BUSIF_MODE, 0x20, 0x4), | |
254 | RSND_GEN1_M_REG(gen, SRU, BUSIF_ADINR, 0x214, 0x40), | |
255 | ||
256 | RSND_GEN1_S_REG(gen, ADG, BRRA, 0x00), | |
257 | RSND_GEN1_S_REG(gen, ADG, BRRB, 0x04), | |
258 | RSND_GEN1_S_REG(gen, ADG, SSICKR, 0x08), | |
259 | RSND_GEN1_S_REG(gen, ADG, AUDIO_CLK_SEL0, 0x0c), | |
260 | RSND_GEN1_S_REG(gen, ADG, AUDIO_CLK_SEL1, 0x10), | |
55e5b6fd KM |
261 | |
262 | RSND_GEN1_M_REG(gen, SSI, SSICR, 0x00, 0x40), | |
263 | RSND_GEN1_M_REG(gen, SSI, SSISR, 0x04, 0x40), | |
264 | RSND_GEN1_M_REG(gen, SSI, SSITDR, 0x08, 0x40), | |
265 | RSND_GEN1_M_REG(gen, SSI, SSIRDR, 0x0c, 0x40), | |
266 | RSND_GEN1_M_REG(gen, SSI, SSIWSR, 0x20, 0x40), | |
267 | }; | |
268 | ||
c1e6cc5e | 269 | return rsnd_gen_regmap_init(priv, gen, regf); |
07539c1d KM |
270 | } |
271 | ||
3337744a KM |
272 | static int rsnd_gen1_probe(struct platform_device *pdev, |
273 | struct rcar_snd_info *info, | |
274 | struct rsnd_priv *priv) | |
275 | { | |
07539c1d KM |
276 | struct device *dev = rsnd_priv_to_dev(priv); |
277 | struct rsnd_gen *gen = rsnd_priv_to_gen(priv); | |
278 | struct resource *sru_res; | |
dfc9403b | 279 | struct resource *adg_res; |
ae5c3223 | 280 | struct resource *ssi_res; |
55e5b6fd | 281 | int ret; |
07539c1d KM |
282 | |
283 | /* | |
284 | * map address | |
285 | */ | |
286 | sru_res = platform_get_resource(pdev, IORESOURCE_MEM, RSND_GEN1_SRU); | |
dfc9403b | 287 | adg_res = platform_get_resource(pdev, IORESOURCE_MEM, RSND_GEN1_ADG); |
ae5c3223 | 288 | ssi_res = platform_get_resource(pdev, IORESOURCE_MEM, RSND_GEN1_SSI); |
07539c1d KM |
289 | |
290 | gen->base[RSND_GEN1_SRU] = devm_ioremap_resource(dev, sru_res); | |
dfc9403b | 291 | gen->base[RSND_GEN1_ADG] = devm_ioremap_resource(dev, adg_res); |
ae5c3223 | 292 | gen->base[RSND_GEN1_SSI] = devm_ioremap_resource(dev, ssi_res); |
70263cb4 WY |
293 | if (IS_ERR(gen->base[RSND_GEN1_SRU]) || |
294 | IS_ERR(gen->base[RSND_GEN1_ADG]) || | |
295 | IS_ERR(gen->base[RSND_GEN1_SSI])) | |
07539c1d | 296 | return -ENODEV; |
07539c1d | 297 | |
55e5b6fd KM |
298 | ret = rsnd_gen1_regmap_init(priv, gen); |
299 | if (ret < 0) | |
300 | return ret; | |
07539c1d KM |
301 | |
302 | dev_dbg(dev, "Gen1 device probed\n"); | |
303 | dev_dbg(dev, "SRU : %08x => %p\n", sru_res->start, | |
304 | gen->base[RSND_GEN1_SRU]); | |
dfc9403b KM |
305 | dev_dbg(dev, "ADG : %08x => %p\n", adg_res->start, |
306 | gen->base[RSND_GEN1_ADG]); | |
ae5c3223 KM |
307 | dev_dbg(dev, "SSI : %08x => %p\n", ssi_res->start, |
308 | gen->base[RSND_GEN1_SSI]); | |
07539c1d | 309 | |
3337744a | 310 | return 0; |
ae5c3223 | 311 | |
3337744a KM |
312 | } |
313 | ||
314 | static void rsnd_gen1_remove(struct platform_device *pdev, | |
315 | struct rsnd_priv *priv) | |
316 | { | |
317 | } | |
318 | ||
072188b6 KM |
319 | static struct rsnd_gen_ops rsnd_gen1_ops = { |
320 | .probe = rsnd_gen1_probe, | |
321 | .remove = rsnd_gen1_remove, | |
322 | .path_init = rsnd_gen1_path_init, | |
323 | .path_exit = rsnd_gen1_path_exit, | |
324 | }; | |
325 | ||
3337744a KM |
326 | /* |
327 | * Gen | |
328 | */ | |
329 | int rsnd_gen_path_init(struct rsnd_priv *priv, | |
330 | struct rsnd_dai *rdai, | |
331 | struct rsnd_dai_stream *io) | |
332 | { | |
333 | struct rsnd_gen *gen = rsnd_priv_to_gen(priv); | |
334 | ||
335 | return gen->ops->path_init(priv, rdai, io); | |
336 | } | |
337 | ||
338 | int rsnd_gen_path_exit(struct rsnd_priv *priv, | |
339 | struct rsnd_dai *rdai, | |
340 | struct rsnd_dai_stream *io) | |
341 | { | |
342 | struct rsnd_gen *gen = rsnd_priv_to_gen(priv); | |
343 | ||
344 | return gen->ops->path_exit(priv, rdai, io); | |
345 | } | |
346 | ||
3337744a KM |
347 | int rsnd_gen_probe(struct platform_device *pdev, |
348 | struct rcar_snd_info *info, | |
349 | struct rsnd_priv *priv) | |
350 | { | |
351 | struct device *dev = rsnd_priv_to_dev(priv); | |
352 | struct rsnd_gen *gen; | |
3337744a KM |
353 | |
354 | gen = devm_kzalloc(dev, sizeof(*gen), GFP_KERNEL); | |
355 | if (!gen) { | |
356 | dev_err(dev, "GEN allocate failed\n"); | |
357 | return -ENOMEM; | |
358 | } | |
359 | ||
072188b6 KM |
360 | if (rsnd_is_gen1(priv)) |
361 | gen->ops = &rsnd_gen1_ops; | |
362 | ||
363 | if (!gen->ops) { | |
364 | dev_err(dev, "unknown generation R-Car sound device\n"); | |
365 | return -ENODEV; | |
366 | } | |
367 | ||
3337744a KM |
368 | priv->gen = gen; |
369 | ||
072188b6 | 370 | return gen->ops->probe(pdev, info, priv); |
3337744a KM |
371 | } |
372 | ||
373 | void rsnd_gen_remove(struct platform_device *pdev, | |
374 | struct rsnd_priv *priv) | |
375 | { | |
072188b6 KM |
376 | struct rsnd_gen *gen = rsnd_priv_to_gen(priv); |
377 | ||
378 | gen->ops->remove(pdev, priv); | |
3337744a | 379 | } |