1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36static int check_asic_status(struct echoaudio *chip)
37{
38 u32 box_status;
39
40 if (wait_handshake(chip))
41 return -EIO;
42
43 chip->comm_page->ext_box_status = cpu_to_le32(E3G_ASIC_NOT_LOADED);
44 chip->asic_loaded = false;
45 clear_handshake(chip);
46 send_vector(chip, DSP_VC_TEST_ASIC);
47
48 if (wait_handshake(chip)) {
49 chip->dsp_code = NULL;
50 return -EIO;
51 }
52
53 box_status = le32_to_cpu(chip->comm_page->ext_box_status);
54 dev_dbg(chip->card->dev, "box_status=%x\n", box_status);
55 if (box_status == E3G_ASIC_NOT_LOADED)
56 return -ENODEV;
57
58 chip->asic_loaded = true;
59 return box_status & E3G_BOX_TYPE_MASK;
60}
61
62
63
64static inline u32 get_frq_reg(struct echoaudio *chip)
65{
66 return le32_to_cpu(chip->comm_page->e3g_frq_register);
67}
68
69
70
71
72
73static int write_control_reg(struct echoaudio *chip, u32 ctl, u32 frq,
74 char force)
75{
76 if (wait_handshake(chip))
77 return -EIO;
78
79 dev_dbg(chip->card->dev,
80 "WriteControlReg: Setting 0x%x, 0x%x\n", ctl, frq);
81
82 ctl = cpu_to_le32(ctl);
83 frq = cpu_to_le32(frq);
84
85 if (ctl != chip->comm_page->control_register ||
86 frq != chip->comm_page->e3g_frq_register || force) {
87 chip->comm_page->e3g_frq_register = frq;
88 chip->comm_page->control_register = ctl;
89 clear_handshake(chip);
90 return send_vector(chip, DSP_VC_WRITE_CONTROL_REG);
91 }
92
93 dev_dbg(chip->card->dev, "WriteControlReg: not written, no change\n");
94 return 0;
95}
96
97
98
99
100static int set_digital_mode(struct echoaudio *chip, u8 mode)
101{
102 u8 previous_mode;
103 int err, i, o;
104
105
106 if (snd_BUG_ON(chip->pipe_alloc_mask))
107 return -EAGAIN;
108
109 if (snd_BUG_ON(!(chip->digital_modes & (1 << mode))))
110 return -EINVAL;
111
112 previous_mode = chip->digital_mode;
113 err = dsp_set_digital_mode(chip, mode);
114
115
116
117
118 if (err >= 0 && previous_mode != mode &&
119 (previous_mode == DIGITAL_MODE_ADAT || mode == DIGITAL_MODE_ADAT)) {
120 spin_lock_irq(&chip->lock);
121 for (o = 0; o < num_busses_out(chip); o++)
122 for (i = 0; i < num_busses_in(chip); i++)
123 set_monitor_gain(chip, o, i,
124 chip->monitor_gain[o][i]);
125
126#ifdef ECHOCARD_HAS_INPUT_GAIN
127 for (i = 0; i < num_busses_in(chip); i++)
128 set_input_gain(chip, i, chip->input_gain[i]);
129 update_input_line_level(chip);
130#endif
131
132 for (o = 0; o < num_busses_out(chip); o++)
133 set_output_gain(chip, o, chip->output_gain[o]);
134 update_output_line_level(chip);
135 spin_unlock_irq(&chip->lock);
136 }
137
138 return err;
139}
140
141
142
143static u32 set_spdif_bits(struct echoaudio *chip, u32 control_reg, u32 rate)
144{
145 control_reg &= E3G_SPDIF_FORMAT_CLEAR_MASK;
146
147 switch (rate) {
148 case 32000 :
149 control_reg |= E3G_SPDIF_SAMPLE_RATE0 | E3G_SPDIF_SAMPLE_RATE1;
150 break;
151 case 44100 :
152 if (chip->professional_spdif)
153 control_reg |= E3G_SPDIF_SAMPLE_RATE0;
154 break;
155 case 48000 :
156 control_reg |= E3G_SPDIF_SAMPLE_RATE1;
157 break;
158 }
159
160 if (chip->professional_spdif)
161 control_reg |= E3G_SPDIF_PRO_MODE;
162
163 if (chip->non_audio_spdif)
164 control_reg |= E3G_SPDIF_NOT_AUDIO;
165
166 control_reg |= E3G_SPDIF_24_BIT | E3G_SPDIF_TWO_CHANNEL |
167 E3G_SPDIF_COPY_PERMIT;
168
169 return control_reg;
170}
171
172
173
174
175static int set_professional_spdif(struct echoaudio *chip, char prof)
176{
177 u32 control_reg;
178
179 control_reg = le32_to_cpu(chip->comm_page->control_register);
180 chip->professional_spdif = prof;
181 control_reg = set_spdif_bits(chip, control_reg, chip->sample_rate);
182 return write_control_reg(chip, control_reg, get_frq_reg(chip), 0);
183}
184
185
186
187
188
189
190
191static u32 detect_input_clocks(const struct echoaudio *chip)
192{
193 u32 clocks_from_dsp, clock_bits;
194
195
196
197 clocks_from_dsp = le32_to_cpu(chip->comm_page->status_clocks);
198
199 clock_bits = ECHO_CLOCK_BIT_INTERNAL;
200
201 if (clocks_from_dsp & E3G_CLOCK_DETECT_BIT_WORD)
202 clock_bits |= ECHO_CLOCK_BIT_WORD;
203
204 switch(chip->digital_mode) {
205 case DIGITAL_MODE_SPDIF_RCA:
206 case DIGITAL_MODE_SPDIF_OPTICAL:
207 if (clocks_from_dsp & E3G_CLOCK_DETECT_BIT_SPDIF)
208 clock_bits |= ECHO_CLOCK_BIT_SPDIF;
209 break;
210 case DIGITAL_MODE_ADAT:
211 if (clocks_from_dsp & E3G_CLOCK_DETECT_BIT_ADAT)
212 clock_bits |= ECHO_CLOCK_BIT_ADAT;
213 break;
214 }
215
216 return clock_bits;
217}
218
219
220
221static int load_asic(struct echoaudio *chip)
222{
223 int box_type, err;
224
225 if (chip->asic_loaded)
226 return 0;
227
228
229 mdelay(2);
230
231 err = load_asic_generic(chip, DSP_FNC_LOAD_3G_ASIC, FW_3G_ASIC);
232 if (err < 0)
233 return err;
234
235 chip->asic_code = FW_3G_ASIC;
236
237
238 msleep(1000);
239
240 box_type = check_asic_status(chip);
241
242
243
244 if (box_type >= 0) {
245 err = write_control_reg(chip, E3G_48KHZ,
246 E3G_FREQ_REG_DEFAULT, true);
247 if (err < 0)
248 return err;
249 }
250
251 return box_type;
252}
253
254
255
256static int set_sample_rate(struct echoaudio *chip, u32 rate)
257{
258 u32 control_reg, clock, base_rate, frq_reg;
259
260
261 if (chip->input_clock != ECHO_CLOCK_INTERNAL) {
262 dev_warn(chip->card->dev,
263 "Cannot set sample rate - clock not set to CLK_CLOCKININTERNAL\n");
264
265 chip->comm_page->sample_rate = cpu_to_le32(rate);
266 chip->sample_rate = rate;
267 set_input_clock(chip, chip->input_clock);
268 return 0;
269 }
270
271 if (snd_BUG_ON(rate >= 50000 &&
272 chip->digital_mode == DIGITAL_MODE_ADAT))
273 return -EINVAL;
274
275 clock = 0;
276 control_reg = le32_to_cpu(chip->comm_page->control_register);
277 control_reg &= E3G_CLOCK_CLEAR_MASK;
278
279 switch (rate) {
280 case 96000:
281 clock = E3G_96KHZ;
282 break;
283 case 88200:
284 clock = E3G_88KHZ;
285 break;
286 case 48000:
287 clock = E3G_48KHZ;
288 break;
289 case 44100:
290 clock = E3G_44KHZ;
291 break;
292 case 32000:
293 clock = E3G_32KHZ;
294 break;
295 default:
296 clock = E3G_CONTINUOUS_CLOCK;
297 if (rate > 50000)
298 clock |= E3G_DOUBLE_SPEED_MODE;
299 break;
300 }
301
302 control_reg |= clock;
303 control_reg = set_spdif_bits(chip, control_reg, rate);
304
305 base_rate = rate;
306 if (base_rate > 50000)
307 base_rate /= 2;
308 if (base_rate < 32000)
309 base_rate = 32000;
310
311 frq_reg = E3G_MAGIC_NUMBER / base_rate - 2;
312 if (frq_reg > E3G_FREQ_REG_MAX)
313 frq_reg = E3G_FREQ_REG_MAX;
314
315 chip->comm_page->sample_rate = cpu_to_le32(rate);
316 chip->sample_rate = rate;
317 dev_dbg(chip->card->dev,
318 "SetSampleRate: %d clock %x\n", rate, control_reg);
319
320
321 return write_control_reg(chip, control_reg, frq_reg, 0);
322}
323
324
325
326
327static int set_input_clock(struct echoaudio *chip, u16 clock)
328{
329 u32 control_reg, clocks_from_dsp;
330
331
332
333 control_reg = le32_to_cpu(chip->comm_page->control_register) &
334 E3G_CLOCK_CLEAR_MASK;
335 clocks_from_dsp = le32_to_cpu(chip->comm_page->status_clocks);
336
337 switch (clock) {
338 case ECHO_CLOCK_INTERNAL:
339 chip->input_clock = ECHO_CLOCK_INTERNAL;
340 return set_sample_rate(chip, chip->sample_rate);
341 case ECHO_CLOCK_SPDIF:
342 if (chip->digital_mode == DIGITAL_MODE_ADAT)
343 return -EAGAIN;
344 control_reg |= E3G_SPDIF_CLOCK;
345 if (clocks_from_dsp & E3G_CLOCK_DETECT_BIT_SPDIF96)
346 control_reg |= E3G_DOUBLE_SPEED_MODE;
347 else
348 control_reg &= ~E3G_DOUBLE_SPEED_MODE;
349 break;
350 case ECHO_CLOCK_ADAT:
351 if (chip->digital_mode != DIGITAL_MODE_ADAT)
352 return -EAGAIN;
353 control_reg |= E3G_ADAT_CLOCK;
354 control_reg &= ~E3G_DOUBLE_SPEED_MODE;
355 break;
356 case ECHO_CLOCK_WORD:
357 control_reg |= E3G_WORD_CLOCK;
358 if (clocks_from_dsp & E3G_CLOCK_DETECT_BIT_WORD96)
359 control_reg |= E3G_DOUBLE_SPEED_MODE;
360 else
361 control_reg &= ~E3G_DOUBLE_SPEED_MODE;
362 break;
363 default:
364 dev_err(chip->card->dev,
365 "Input clock 0x%x not supported for Echo3G\n", clock);
366 return -EINVAL;
367 }
368
369 chip->input_clock = clock;
370 return write_control_reg(chip, control_reg, get_frq_reg(chip), 1);
371}
372
373
374
375static int dsp_set_digital_mode(struct echoaudio *chip, u8 mode)
376{
377 u32 control_reg;
378 int err, incompatible_clock;
379
380
381 incompatible_clock = false;
382 switch (mode) {
383 case DIGITAL_MODE_SPDIF_OPTICAL:
384 case DIGITAL_MODE_SPDIF_RCA:
385 if (chip->input_clock == ECHO_CLOCK_ADAT)
386 incompatible_clock = true;
387 break;
388 case DIGITAL_MODE_ADAT:
389 if (chip->input_clock == ECHO_CLOCK_SPDIF)
390 incompatible_clock = true;
391 break;
392 default:
393 dev_err(chip->card->dev,
394 "Digital mode not supported: %d\n", mode);
395 return -EINVAL;
396 }
397
398 spin_lock_irq(&chip->lock);
399
400 if (incompatible_clock) {
401 chip->sample_rate = 48000;
402 set_input_clock(chip, ECHO_CLOCK_INTERNAL);
403 }
404
405
406 control_reg = le32_to_cpu(chip->comm_page->control_register);
407 control_reg &= E3G_DIGITAL_MODE_CLEAR_MASK;
408
409
410 switch (mode) {
411 case DIGITAL_MODE_SPDIF_OPTICAL:
412 control_reg |= E3G_SPDIF_OPTICAL_MODE;
413 break;
414 case DIGITAL_MODE_SPDIF_RCA:
415
416 break;
417 case DIGITAL_MODE_ADAT:
418 control_reg |= E3G_ADAT_MODE;
419 control_reg &= ~E3G_DOUBLE_SPEED_MODE;
420 break;
421 }
422
423 err = write_control_reg(chip, control_reg, get_frq_reg(chip), 1);
424 spin_unlock_irq(&chip->lock);
425 if (err < 0)
426 return err;
427 chip->digital_mode = mode;
428
429 dev_dbg(chip->card->dev, "set_digital_mode(%d)\n", chip->digital_mode);
430 return incompatible_clock;
431}
432