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 { | |
14 | int (*path_init)(struct rsnd_priv *priv, | |
15 | struct rsnd_dai *rdai, | |
16 | struct rsnd_dai_stream *io); | |
17 | int (*path_exit)(struct rsnd_priv *priv, | |
18 | struct rsnd_dai *rdai, | |
19 | struct rsnd_dai_stream *io); | |
20 | }; | |
21 | ||
22 | struct rsnd_gen_reg_map { | |
23 | int index; /* -1 : not supported */ | |
24 | u32 offset_id; /* offset of ssi0, ssi1, ssi2... */ | |
25 | u32 offset_adr; /* offset of SSICR, SSISR, ... */ | |
26 | }; | |
27 | ||
28 | struct rsnd_gen { | |
29 | void __iomem *base[RSND_BASE_MAX]; | |
30 | ||
31 | struct rsnd_gen_reg_map reg_map[RSND_REG_MAX]; | |
32 | struct rsnd_gen_ops *ops; | |
33 | }; | |
34 | ||
35 | #define rsnd_priv_to_gen(p) ((struct rsnd_gen *)(p)->gen) | |
36 | ||
37 | #define rsnd_is_gen1(s) ((s)->info->flags & RSND_GEN1) | |
38 | #define rsnd_is_gen2(s) ((s)->info->flags & RSND_GEN2) | |
39 | ||
40 | /* | |
41 | * Gen2 | |
42 | * will be filled in the future | |
43 | */ | |
44 | ||
45 | /* | |
46 | * Gen1 | |
47 | */ | |
07539c1d KM |
48 | static int rsnd_gen1_path_init(struct rsnd_priv *priv, |
49 | struct rsnd_dai *rdai, | |
50 | struct rsnd_dai_stream *io) | |
51 | { | |
52 | struct rsnd_dai_platform_info *info = rsnd_dai_get_platform_info(rdai); | |
53 | struct rsnd_mod *mod; | |
54 | int ret; | |
55 | int id; | |
56 | ||
57 | /* | |
58 | * Gen1 is created by SRU/SSI, and this SRU is base module of | |
59 | * Gen2's SCU/SSIU/SSI. (Gen2 SCU/SSIU came from SRU) | |
60 | * | |
61 | * Easy image is.. | |
62 | * Gen1 SRU = Gen2 SCU + SSIU + etc | |
63 | * | |
64 | * Gen2 SCU path is very flexible, but, Gen1 SRU (SCU parts) is | |
65 | * using fixed path. | |
66 | * | |
67 | * Then, SSI id = SCU id here | |
68 | */ | |
69 | ||
70 | if (rsnd_dai_is_play(rdai, io)) | |
71 | id = info->ssi_id_playback; | |
72 | else | |
73 | id = info->ssi_id_capture; | |
74 | ||
ae5c3223 KM |
75 | /* SSI */ |
76 | mod = rsnd_ssi_mod_get(priv, id); | |
77 | ret = rsnd_dai_connect(rdai, mod, io); | |
78 | if (ret < 0) | |
79 | return ret; | |
80 | ||
07539c1d KM |
81 | /* SCU */ |
82 | mod = rsnd_scu_mod_get(priv, id); | |
83 | ret = rsnd_dai_connect(rdai, mod, io); | |
84 | ||
85 | return ret; | |
86 | } | |
87 | ||
88 | static int rsnd_gen1_path_exit(struct rsnd_priv *priv, | |
89 | struct rsnd_dai *rdai, | |
90 | struct rsnd_dai_stream *io) | |
91 | { | |
92 | struct rsnd_mod *mod, *n; | |
93 | int ret = 0; | |
94 | ||
95 | /* | |
96 | * remove all mod from rdai | |
97 | */ | |
98 | for_each_rsnd_mod(mod, n, io) | |
99 | ret |= rsnd_dai_disconnect(mod); | |
100 | ||
101 | return ret; | |
102 | } | |
103 | ||
104 | static struct rsnd_gen_ops rsnd_gen1_ops = { | |
105 | .path_init = rsnd_gen1_path_init, | |
106 | .path_exit = rsnd_gen1_path_exit, | |
107 | }; | |
108 | ||
109 | #define RSND_GEN1_REG_MAP(g, s, i, oi, oa) \ | |
110 | do { \ | |
111 | (g)->reg_map[RSND_REG_##i].index = RSND_GEN1_##s; \ | |
112 | (g)->reg_map[RSND_REG_##i].offset_id = oi; \ | |
113 | (g)->reg_map[RSND_REG_##i].offset_adr = oa; \ | |
114 | } while (0) | |
115 | ||
116 | static void rsnd_gen1_reg_map_init(struct rsnd_gen *gen) | |
117 | { | |
118 | RSND_GEN1_REG_MAP(gen, SRU, SSI_MODE0, 0x0, 0xD0); | |
119 | RSND_GEN1_REG_MAP(gen, SRU, SSI_MODE1, 0x0, 0xD4); | |
dfc9403b KM |
120 | |
121 | RSND_GEN1_REG_MAP(gen, ADG, BRRA, 0x0, 0x00); | |
122 | RSND_GEN1_REG_MAP(gen, ADG, BRRB, 0x0, 0x04); | |
123 | RSND_GEN1_REG_MAP(gen, ADG, SSICKR, 0x0, 0x08); | |
124 | RSND_GEN1_REG_MAP(gen, ADG, AUDIO_CLK_SEL0, 0x0, 0x0c); | |
125 | RSND_GEN1_REG_MAP(gen, ADG, AUDIO_CLK_SEL1, 0x0, 0x10); | |
126 | RSND_GEN1_REG_MAP(gen, ADG, AUDIO_CLK_SEL3, 0x0, 0x18); | |
127 | RSND_GEN1_REG_MAP(gen, ADG, AUDIO_CLK_SEL4, 0x0, 0x1c); | |
128 | RSND_GEN1_REG_MAP(gen, ADG, AUDIO_CLK_SEL5, 0x0, 0x20); | |
ae5c3223 KM |
129 | |
130 | RSND_GEN1_REG_MAP(gen, SSI, SSICR, 0x40, 0x00); | |
131 | RSND_GEN1_REG_MAP(gen, SSI, SSISR, 0x40, 0x04); | |
132 | RSND_GEN1_REG_MAP(gen, SSI, SSITDR, 0x40, 0x08); | |
133 | RSND_GEN1_REG_MAP(gen, SSI, SSIRDR, 0x40, 0x0c); | |
134 | RSND_GEN1_REG_MAP(gen, SSI, SSIWSR, 0x40, 0x20); | |
07539c1d KM |
135 | } |
136 | ||
3337744a KM |
137 | static int rsnd_gen1_probe(struct platform_device *pdev, |
138 | struct rcar_snd_info *info, | |
139 | struct rsnd_priv *priv) | |
140 | { | |
07539c1d KM |
141 | struct device *dev = rsnd_priv_to_dev(priv); |
142 | struct rsnd_gen *gen = rsnd_priv_to_gen(priv); | |
143 | struct resource *sru_res; | |
dfc9403b | 144 | struct resource *adg_res; |
ae5c3223 | 145 | struct resource *ssi_res; |
07539c1d KM |
146 | |
147 | /* | |
148 | * map address | |
149 | */ | |
150 | sru_res = platform_get_resource(pdev, IORESOURCE_MEM, RSND_GEN1_SRU); | |
dfc9403b | 151 | adg_res = platform_get_resource(pdev, IORESOURCE_MEM, RSND_GEN1_ADG); |
ae5c3223 | 152 | ssi_res = platform_get_resource(pdev, IORESOURCE_MEM, RSND_GEN1_SSI); |
07539c1d KM |
153 | |
154 | gen->base[RSND_GEN1_SRU] = devm_ioremap_resource(dev, sru_res); | |
dfc9403b | 155 | gen->base[RSND_GEN1_ADG] = devm_ioremap_resource(dev, adg_res); |
ae5c3223 | 156 | gen->base[RSND_GEN1_SSI] = devm_ioremap_resource(dev, ssi_res); |
70263cb4 WY |
157 | if (IS_ERR(gen->base[RSND_GEN1_SRU]) || |
158 | IS_ERR(gen->base[RSND_GEN1_ADG]) || | |
159 | IS_ERR(gen->base[RSND_GEN1_SSI])) | |
07539c1d | 160 | return -ENODEV; |
07539c1d | 161 | |
70263cb4 | 162 | gen->ops = &rsnd_gen1_ops; |
07539c1d KM |
163 | rsnd_gen1_reg_map_init(gen); |
164 | ||
165 | dev_dbg(dev, "Gen1 device probed\n"); | |
166 | dev_dbg(dev, "SRU : %08x => %p\n", sru_res->start, | |
167 | gen->base[RSND_GEN1_SRU]); | |
dfc9403b KM |
168 | dev_dbg(dev, "ADG : %08x => %p\n", adg_res->start, |
169 | gen->base[RSND_GEN1_ADG]); | |
ae5c3223 KM |
170 | dev_dbg(dev, "SSI : %08x => %p\n", ssi_res->start, |
171 | gen->base[RSND_GEN1_SSI]); | |
07539c1d | 172 | |
3337744a | 173 | return 0; |
ae5c3223 | 174 | |
3337744a KM |
175 | } |
176 | ||
177 | static void rsnd_gen1_remove(struct platform_device *pdev, | |
178 | struct rsnd_priv *priv) | |
179 | { | |
180 | } | |
181 | ||
182 | /* | |
183 | * Gen | |
184 | */ | |
185 | int rsnd_gen_path_init(struct rsnd_priv *priv, | |
186 | struct rsnd_dai *rdai, | |
187 | struct rsnd_dai_stream *io) | |
188 | { | |
189 | struct rsnd_gen *gen = rsnd_priv_to_gen(priv); | |
190 | ||
191 | return gen->ops->path_init(priv, rdai, io); | |
192 | } | |
193 | ||
194 | int rsnd_gen_path_exit(struct rsnd_priv *priv, | |
195 | struct rsnd_dai *rdai, | |
196 | struct rsnd_dai_stream *io) | |
197 | { | |
198 | struct rsnd_gen *gen = rsnd_priv_to_gen(priv); | |
199 | ||
200 | return gen->ops->path_exit(priv, rdai, io); | |
201 | } | |
202 | ||
203 | void __iomem *rsnd_gen_reg_get(struct rsnd_priv *priv, | |
204 | struct rsnd_mod *mod, | |
205 | enum rsnd_reg reg) | |
206 | { | |
207 | struct rsnd_gen *gen = rsnd_priv_to_gen(priv); | |
208 | struct device *dev = rsnd_priv_to_dev(priv); | |
209 | int index; | |
210 | u32 offset_id, offset_adr; | |
211 | ||
212 | if (reg >= RSND_REG_MAX) { | |
213 | dev_err(dev, "rsnd_reg reg error\n"); | |
214 | return NULL; | |
215 | } | |
216 | ||
217 | index = gen->reg_map[reg].index; | |
218 | offset_id = gen->reg_map[reg].offset_id; | |
219 | offset_adr = gen->reg_map[reg].offset_adr; | |
220 | ||
221 | if (index < 0) { | |
222 | dev_err(dev, "unsupported reg access %d\n", reg); | |
223 | return NULL; | |
224 | } | |
225 | ||
226 | if (offset_id && mod) | |
227 | offset_id *= rsnd_mod_id(mod); | |
228 | ||
229 | /* | |
230 | * index/offset were set on gen1/gen2 | |
231 | */ | |
232 | ||
233 | return gen->base[index] + offset_id + offset_adr; | |
234 | } | |
235 | ||
236 | int rsnd_gen_probe(struct platform_device *pdev, | |
237 | struct rcar_snd_info *info, | |
238 | struct rsnd_priv *priv) | |
239 | { | |
240 | struct device *dev = rsnd_priv_to_dev(priv); | |
241 | struct rsnd_gen *gen; | |
242 | int i; | |
243 | ||
244 | gen = devm_kzalloc(dev, sizeof(*gen), GFP_KERNEL); | |
245 | if (!gen) { | |
246 | dev_err(dev, "GEN allocate failed\n"); | |
247 | return -ENOMEM; | |
248 | } | |
249 | ||
250 | priv->gen = gen; | |
251 | ||
252 | /* | |
253 | * see | |
254 | * rsnd_reg_get() | |
255 | * rsnd_gen_probe() | |
256 | */ | |
257 | for (i = 0; i < RSND_REG_MAX; i++) | |
258 | gen->reg_map[i].index = -1; | |
259 | ||
260 | /* | |
261 | * init each module | |
262 | */ | |
263 | if (rsnd_is_gen1(priv)) | |
264 | return rsnd_gen1_probe(pdev, info, priv); | |
265 | ||
266 | dev_err(dev, "unknown generation R-Car sound device\n"); | |
267 | ||
268 | return -ENODEV; | |
269 | } | |
270 | ||
271 | void rsnd_gen_remove(struct platform_device *pdev, | |
272 | struct rsnd_priv *priv) | |
273 | { | |
274 | if (rsnd_is_gen1(priv)) | |
275 | rsnd_gen1_remove(pdev, priv); | |
276 | } |