]>
Commit | Line | Data |
---|---|---|
511ed5fd RS |
1 | /* |
2 | * Copyright (C) 2012 Samsung Electronics | |
3 | * R. Chandrasekar <rcsekar@samsung.com> | |
4 | * | |
1a459660 | 5 | * SPDX-License-Identifier: GPL-2.0+ |
511ed5fd RS |
6 | */ |
7 | ||
8 | #include <malloc.h> | |
9 | #include <common.h> | |
10 | #include <asm/io.h> | |
f482310c RS |
11 | #include <libfdt.h> |
12 | #include <fdtdec.h> | |
511ed5fd RS |
13 | #include <i2c.h> |
14 | #include <i2s.h> | |
15 | #include <sound.h> | |
511ed5fd | 16 | #include <asm/arch/sound.h> |
f482310c | 17 | #include "wm8994.h" |
14d2dfc3 | 18 | #include "max98095.h" |
511ed5fd RS |
19 | |
20 | /* defines */ | |
21 | #define SOUND_400_HZ 400 | |
22 | #define SOUND_BITS_IN_BYTE 8 | |
23 | ||
24 | static struct i2stx_info g_i2stx_pri; | |
511ed5fd RS |
25 | |
26 | /* | |
f482310c | 27 | * get_sound_i2s_values gets values for i2s parameters |
511ed5fd RS |
28 | * |
29 | * @param i2stx_info i2s transmitter transfer param structure | |
f482310c | 30 | * @param blob FDT blob if enabled else NULL |
511ed5fd | 31 | */ |
f482310c | 32 | static int get_sound_i2s_values(struct i2stx_info *i2s, const void *blob) |
511ed5fd | 33 | { |
f482310c RS |
34 | #ifdef CONFIG_OF_CONTROL |
35 | int node; | |
511ed5fd | 36 | int error = 0; |
f482310c | 37 | int base; |
511ed5fd | 38 | |
d981d80d | 39 | node = fdt_path_offset(blob, "i2s"); |
f482310c RS |
40 | if (node <= 0) { |
41 | debug("EXYNOS_SOUND: No node for sound in device tree\n"); | |
511ed5fd RS |
42 | return -1; |
43 | } | |
44 | ||
f482310c RS |
45 | /* |
46 | * Get the pre-defined sound specific values from FDT. | |
47 | * All of these are expected to be correct otherwise | |
48 | * wrong register values in i2s setup parameters | |
49 | * may result in no sound play. | |
50 | */ | |
51 | base = fdtdec_get_addr(blob, node, "reg"); | |
52 | if (base == FDT_ADDR_T_NONE) { | |
53 | debug("%s: Missing i2s base\n", __func__); | |
54 | return -1; | |
55 | } | |
56 | i2s->base_address = base; | |
57 | ||
58 | i2s->audio_pll_clk = fdtdec_get_int(blob, | |
59 | node, "samsung,i2s-epll-clock-frequency", -1); | |
60 | error |= i2s->audio_pll_clk; | |
61 | debug("audio_pll_clk = %d\n", i2s->audio_pll_clk); | |
62 | i2s->samplingrate = fdtdec_get_int(blob, | |
63 | node, "samsung,i2s-sampling-rate", -1); | |
64 | error |= i2s->samplingrate; | |
65 | debug("samplingrate = %d\n", i2s->samplingrate); | |
66 | i2s->bitspersample = fdtdec_get_int(blob, | |
67 | node, "samsung,i2s-bits-per-sample", -1); | |
68 | error |= i2s->bitspersample; | |
69 | debug("bitspersample = %d\n", i2s->bitspersample); | |
70 | i2s->channels = fdtdec_get_int(blob, | |
71 | node, "samsung,i2s-channels", -1); | |
72 | error |= i2s->channels; | |
73 | debug("channels = %d\n", i2s->channels); | |
74 | i2s->rfs = fdtdec_get_int(blob, | |
75 | node, "samsung,i2s-lr-clk-framesize", -1); | |
76 | error |= i2s->rfs; | |
77 | debug("rfs = %d\n", i2s->rfs); | |
78 | i2s->bfs = fdtdec_get_int(blob, | |
79 | node, "samsung,i2s-bit-clk-framesize", -1); | |
80 | error |= i2s->bfs; | |
81 | debug("bfs = %d\n", i2s->bfs); | |
d981d80d DKM |
82 | |
83 | i2s->id = fdtdec_get_int(blob, node, "samsung,i2s-id", -1); | |
84 | error |= i2s->id; | |
85 | debug("id = %d\n", i2s->id); | |
86 | ||
511ed5fd | 87 | if (error == -1) { |
f482310c | 88 | debug("fail to get sound i2s node properties\n"); |
511ed5fd RS |
89 | return -1; |
90 | } | |
f482310c RS |
91 | #else |
92 | i2s->base_address = samsung_get_base_i2s(); | |
93 | i2s->audio_pll_clk = I2S_PLL_CLK; | |
94 | i2s->samplingrate = I2S_SAMPLING_RATE; | |
95 | i2s->bitspersample = I2S_BITS_PER_SAMPLE; | |
96 | i2s->channels = I2S_CHANNELS; | |
97 | i2s->rfs = I2S_RFS; | |
98 | i2s->bfs = I2S_BFS; | |
d981d80d | 99 | i2s->id = 0; |
f482310c | 100 | #endif |
511ed5fd RS |
101 | return 0; |
102 | } | |
103 | ||
104 | /* | |
f482310c | 105 | * Init codec |
511ed5fd | 106 | * |
f482310c RS |
107 | * @param blob FDT blob |
108 | * @param pi2s_tx i2s parameters required by codec | |
109 | * @return int value, 0 for success | |
511ed5fd | 110 | */ |
f482310c | 111 | static int codec_init(const void *blob, struct i2stx_info *pi2s_tx) |
511ed5fd | 112 | { |
f482310c | 113 | int ret; |
511ed5fd | 114 | const char *codectype; |
f482310c RS |
115 | #ifdef CONFIG_OF_CONTROL |
116 | int node; | |
117 | ||
118 | /* Get the node from FDT for sound */ | |
6b40852d | 119 | node = fdt_path_offset(blob, "i2s"); |
f482310c RS |
120 | if (node <= 0) { |
121 | debug("EXYNOS_SOUND: No node for sound in device tree\n"); | |
122 | debug("node = %d\n", node); | |
123 | return -1; | |
124 | } | |
511ed5fd | 125 | |
f482310c RS |
126 | /* |
127 | * Get the pre-defined sound codec specific values from FDT. | |
128 | * All of these are expected to be correct otherwise sound | |
129 | * can not be played | |
130 | */ | |
131 | codectype = fdt_getprop(blob, node, "samsung,codec-type", NULL); | |
132 | debug("device = %s\n", codectype); | |
133 | #else | |
511ed5fd | 134 | codectype = AUDIO_CODEC; |
f482310c | 135 | #endif |
511ed5fd | 136 | if (!strcmp(codectype, "wm8994")) { |
f482310c | 137 | /* Check the codec type and initialise the same */ |
d981d80d | 138 | ret = wm8994_init(blob, pi2s_tx->id + 1, |
6b40852d DKM |
139 | pi2s_tx->samplingrate, |
140 | (pi2s_tx->samplingrate * (pi2s_tx->rfs)), | |
141 | pi2s_tx->bitspersample, pi2s_tx->channels); | |
14d2dfc3 | 142 | } else if (!strcmp(codectype, "max98095")) { |
6b40852d DKM |
143 | ret = max98095_init(blob, pi2s_tx->id + 1, |
144 | pi2s_tx->samplingrate, | |
145 | (pi2s_tx->samplingrate * (pi2s_tx->rfs)), | |
146 | pi2s_tx->bitspersample); | |
511ed5fd | 147 | } else { |
14d2dfc3 | 148 | debug("%s: Unknown codec type %s\n", __func__, codectype); |
f482310c | 149 | return -1; |
511ed5fd | 150 | } |
14d2dfc3 | 151 | |
f482310c RS |
152 | if (ret) { |
153 | debug("%s: Codec init failed\n", __func__); | |
511ed5fd RS |
154 | return -1; |
155 | } | |
156 | ||
157 | return 0; | |
158 | } | |
159 | ||
f482310c | 160 | int sound_init(const void *blob) |
511ed5fd RS |
161 | { |
162 | int ret; | |
163 | struct i2stx_info *pi2s_tx = &g_i2stx_pri; | |
511ed5fd RS |
164 | |
165 | /* Get the I2S Values */ | |
f482310c RS |
166 | if (get_sound_i2s_values(pi2s_tx, blob) < 0) { |
167 | debug(" FDT I2S values failed\n"); | |
168 | return -1; | |
169 | } | |
511ed5fd | 170 | |
f482310c RS |
171 | if (codec_init(blob, pi2s_tx) < 0) { |
172 | debug(" Codec init failed\n"); | |
511ed5fd | 173 | return -1; |
f482310c | 174 | } |
511ed5fd RS |
175 | |
176 | ret = i2s_tx_init(pi2s_tx); | |
177 | if (ret) { | |
178 | debug("%s: Failed to init i2c transmit: ret=%d\n", __func__, | |
179 | ret); | |
180 | return ret; | |
181 | } | |
182 | ||
511ed5fd RS |
183 | |
184 | return ret; | |
185 | } | |
186 | ||
187 | /* | |
188 | * Generates square wave sound data for 1 second | |
189 | * | |
190 | * @param data data buffer pointer | |
191 | * @param size size of the buffer | |
192 | * @param freq frequency of the wave | |
193 | */ | |
194 | static void sound_prepare_buffer(unsigned short *data, int size, uint32_t freq) | |
195 | { | |
196 | const int sample = 48000; | |
197 | const unsigned short amplitude = 16000; /* between 1 and 32767 */ | |
198 | const int period = freq ? sample / freq : 0; | |
199 | const int half = period / 2; | |
200 | ||
201 | assert(freq); | |
202 | ||
203 | /* Make sure we don't overflow our buffer */ | |
204 | if (size % 2) | |
205 | size--; | |
206 | ||
207 | while (size) { | |
208 | int i; | |
209 | for (i = 0; size && i < half; i++) { | |
210 | size -= 2; | |
211 | *data++ = amplitude; | |
212 | *data++ = amplitude; | |
213 | } | |
214 | for (i = 0; size && i < period - half; i++) { | |
215 | size -= 2; | |
216 | *data++ = -amplitude; | |
217 | *data++ = -amplitude; | |
218 | } | |
219 | } | |
220 | } | |
221 | ||
222 | int sound_play(uint32_t msec, uint32_t frequency) | |
223 | { | |
224 | unsigned int *data; | |
225 | unsigned long data_size; | |
226 | unsigned int ret = 0; | |
227 | ||
228 | /*Buffer length computation */ | |
229 | data_size = g_i2stx_pri.samplingrate * g_i2stx_pri.channels; | |
230 | data_size *= (g_i2stx_pri.bitspersample / SOUND_BITS_IN_BYTE); | |
231 | data = malloc(data_size); | |
232 | ||
233 | if (data == NULL) { | |
234 | debug("%s: malloc failed\n", __func__); | |
235 | return -1; | |
236 | } | |
237 | ||
238 | sound_prepare_buffer((unsigned short *)data, | |
6b40852d | 239 | data_size / sizeof(unsigned short), frequency); |
511ed5fd RS |
240 | |
241 | while (msec >= 1000) { | |
242 | ret = i2s_transfer_tx_data(&g_i2stx_pri, data, | |
243 | (data_size / sizeof(int))); | |
244 | msec -= 1000; | |
245 | } | |
246 | if (msec) { | |
247 | unsigned long size = | |
248 | (data_size * msec) / (sizeof(int) * 1000); | |
249 | ||
250 | ret = i2s_transfer_tx_data(&g_i2stx_pri, data, size); | |
251 | } | |
252 | ||
253 | free(data); | |
254 | ||
255 | return ret; | |
256 | } |