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