Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | * This program is free software; you can redistribute it and/or modify | |
3 | * it under the terms of the GNU General Public License as published by | |
4 | * the Free Software Foundation; either version 2 of the License, or | |
5 | * (at your option) any later version. | |
6 | * | |
7 | * This program is distributed in the hope that it will be useful, | |
8 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
9 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
10 | * GNU Library General Public License for more details. | |
11 | * | |
12 | * You should have received a copy of the GNU General Public License | |
13 | * along with this program; if not, write to the Free Software | |
14 | * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. | |
15 | */ | |
16 | ||
17 | /* | |
18 | Vortex core low level functions. | |
19 | ||
20 | Author: Manuel Jander (mjander@users.sourceforge.cl) | |
21 | These functions are mainly the result of translations made | |
22 | from the original disassembly of the au88x0 binary drivers, | |
23 | written by Aureal before they went down. | |
24 | Many thanks to the Jeff Muizelaar, Kester Maddock, and whoever | |
25 | contributed to the OpenVortex project. | |
26 | The author of this file, put the few available pieces together | |
27 | and translated the rest of the riddle (Mix, Src and connection stuff). | |
28 | Some things are still to be discovered, and their meanings are unclear. | |
29 | ||
30 | Some of these functions aren't intended to be really used, rather | |
31 | to help to understand how does the AU88X0 chips work. Keep them in, because | |
32 | they could be used somewhere in the future. | |
33 | ||
34 | This code hasn't been tested or proof read thoroughly. If you wanna help, | |
35 | take a look at the AU88X0 assembly and check if this matches. | |
36 | Functions tested ok so far are (they show the desired effect | |
37 | at least): | |
38 | vortex_routes(); (1 bug fixed). | |
39 | vortex_adb_addroute(); | |
40 | vortex_adb_addroutes(); | |
41 | vortex_connect_codecplay(); | |
42 | vortex_src_flushbuffers(); | |
43 | vortex_adbdma_setmode(); note: still some unknown arguments! | |
44 | vortex_adbdma_startfifo(); | |
45 | vortex_adbdma_stopfifo(); | |
46 | vortex_fifo_setadbctrl(); note: still some unknown arguments! | |
47 | vortex_mix_setinputvolumebyte(); | |
48 | vortex_mix_enableinput(); | |
49 | vortex_mixer_addWTD(); (fixed) | |
50 | vortex_connection_adbdma_src_src(); | |
51 | vortex_connection_adbdma_src(); | |
52 | vortex_src_change_convratio(); | |
53 | vortex_src_addWTD(); (fixed) | |
54 | ||
55 | History: | |
56 | ||
57 | 01-03-2003 First revision. | |
58 | 01-21-2003 Some bug fixes. | |
59 | 17-02-2003 many bugfixes after a big versioning mess. | |
60 | 18-02-2003 JAAAAAHHHUUUUUU!!!! The mixer works !! I'm just so happy ! | |
61 | (2 hours later...) I cant believe it! Im really lucky today. | |
62 | Now the SRC is working too! Yeah! XMMS works ! | |
63 | 20-02-2003 First steps into the ALSA world. | |
64 | 28-02-2003 As my birthday present, i discovered how the DMA buffer pages really | |
65 | work :-). It was all wrong. | |
66 | 12-03-2003 ALSA driver starts working (2 channels). | |
67 | 16-03-2003 More srcblock_setupchannel discoveries. | |
68 | 12-04-2003 AU8830 playback support. Recording in the works. | |
69 | 17-04-2003 vortex_route() and vortex_routes() bug fixes. AU8830 recording | |
70 | works now, but chipn' dale effect is still there. | |
71 | 16-05-2003 SrcSetupChannel cleanup. Moved the Src setup stuff entirely | |
72 | into au88x0_pcm.c . | |
73 | 06-06-2003 Buffer shifter bugfix. Mixer volume fix. | |
74 | 07-12-2003 A3D routing finally fixed. Believed to be OK. | |
75 | 25-03-2004 Many thanks to Claudia, for such valuable bug reports. | |
76 | ||
77 | */ | |
78 | ||
79 | #include "au88x0.h" | |
80 | #include "au88x0_a3d.h" | |
81 | #include <linux/delay.h> | |
82 | ||
83 | /* MIXER (CAsp4Mix.s and CAsp4Mixer.s) */ | |
84 | ||
85 | // FIXME: get rid of this. | |
86 | static int mchannels[NR_MIXIN]; | |
87 | static int rampchs[NR_MIXIN]; | |
88 | ||
89 | static void vortex_mixer_en_sr(vortex_t * vortex, int channel) | |
90 | { | |
91 | hwwrite(vortex->mmio, VORTEX_MIXER_SR, | |
92 | hwread(vortex->mmio, VORTEX_MIXER_SR) | (0x1 << channel)); | |
93 | } | |
94 | static void vortex_mixer_dis_sr(vortex_t * vortex, int channel) | |
95 | { | |
96 | hwwrite(vortex->mmio, VORTEX_MIXER_SR, | |
97 | hwread(vortex->mmio, VORTEX_MIXER_SR) & ~(0x1 << channel)); | |
98 | } | |
99 | ||
100 | #if 0 | |
101 | static void | |
102 | vortex_mix_muteinputgain(vortex_t * vortex, unsigned char mix, | |
103 | unsigned char channel) | |
104 | { | |
105 | hwwrite(vortex->mmio, VORTEX_MIX_INVOL_A + ((mix << 5) + channel), | |
106 | 0x80); | |
107 | hwwrite(vortex->mmio, VORTEX_MIX_INVOL_B + ((mix << 5) + channel), | |
108 | 0x80); | |
109 | } | |
110 | ||
111 | static int vortex_mix_getvolume(vortex_t * vortex, unsigned char mix) | |
112 | { | |
113 | int a; | |
114 | a = hwread(vortex->mmio, VORTEX_MIX_VOL_A + (mix << 2)) & 0xff; | |
115 | //FP2LinearFrac(a); | |
116 | return (a); | |
117 | } | |
118 | ||
119 | static int | |
120 | vortex_mix_getinputvolume(vortex_t * vortex, unsigned char mix, | |
121 | int channel, int *vol) | |
122 | { | |
123 | int a; | |
124 | if (!(mchannels[mix] & (1 << channel))) | |
125 | return 0; | |
126 | a = hwread(vortex->mmio, | |
127 | VORTEX_MIX_INVOL_A + (((mix << 5) + channel) << 2)); | |
128 | /* | |
129 | if (rampchs[mix] == 0) | |
130 | a = FP2LinearFrac(a); | |
131 | else | |
132 | a = FP2LinearFracWT(a); | |
133 | */ | |
134 | *vol = a; | |
135 | return (0); | |
136 | } | |
137 | ||
138 | static unsigned int vortex_mix_boost6db(unsigned char vol) | |
139 | { | |
140 | return (vol + 8); /* WOW! what a complex function! */ | |
141 | } | |
142 | ||
143 | static void vortex_mix_rampvolume(vortex_t * vortex, int mix) | |
144 | { | |
145 | int ch; | |
146 | char a; | |
147 | // This function is intended for ramping down only (see vortex_disableinput()). | |
148 | for (ch = 0; ch < 0x20; ch++) { | |
149 | if (((1 << ch) & rampchs[mix]) == 0) | |
150 | continue; | |
151 | a = hwread(vortex->mmio, | |
152 | VORTEX_MIX_INVOL_B + (((mix << 5) + ch) << 2)); | |
153 | if (a > -126) { | |
154 | a -= 2; | |
155 | hwwrite(vortex->mmio, | |
156 | VORTEX_MIX_INVOL_A + | |
157 | (((mix << 5) + ch) << 2), a); | |
158 | hwwrite(vortex->mmio, | |
159 | VORTEX_MIX_INVOL_B + | |
160 | (((mix << 5) + ch) << 2), a); | |
161 | } else | |
162 | vortex_mix_killinput(vortex, mix, ch); | |
163 | } | |
164 | } | |
165 | ||
166 | static int | |
167 | vortex_mix_getenablebit(vortex_t * vortex, unsigned char mix, int mixin) | |
168 | { | |
169 | int addr, temp; | |
170 | if (mixin >= 0) | |
171 | addr = mixin; | |
172 | else | |
173 | addr = mixin + 3; | |
174 | addr = ((mix << 3) + (addr >> 2)) << 2; | |
175 | temp = hwread(vortex->mmio, VORTEX_MIX_ENIN + addr); | |
176 | return ((temp >> (mixin & 3)) & 1); | |
177 | } | |
178 | #endif | |
179 | static void | |
180 | vortex_mix_setvolumebyte(vortex_t * vortex, unsigned char mix, | |
181 | unsigned char vol) | |
182 | { | |
183 | int temp; | |
184 | hwwrite(vortex->mmio, VORTEX_MIX_VOL_A + (mix << 2), vol); | |
185 | if (1) { /*if (this_10) */ | |
186 | temp = hwread(vortex->mmio, VORTEX_MIX_VOL_B + (mix << 2)); | |
187 | if ((temp != 0x80) || (vol == 0x80)) | |
188 | return; | |
189 | } | |
190 | hwwrite(vortex->mmio, VORTEX_MIX_VOL_B + (mix << 2), vol); | |
191 | } | |
192 | ||
193 | static void | |
194 | vortex_mix_setinputvolumebyte(vortex_t * vortex, unsigned char mix, | |
195 | int mixin, unsigned char vol) | |
196 | { | |
197 | int temp; | |
198 | ||
199 | hwwrite(vortex->mmio, | |
200 | VORTEX_MIX_INVOL_A + (((mix << 5) + mixin) << 2), vol); | |
201 | if (1) { /* this_10, initialized to 1. */ | |
202 | temp = | |
203 | hwread(vortex->mmio, | |
204 | VORTEX_MIX_INVOL_B + (((mix << 5) + mixin) << 2)); | |
205 | if ((temp != 0x80) || (vol == 0x80)) | |
206 | return; | |
207 | } | |
208 | hwwrite(vortex->mmio, | |
209 | VORTEX_MIX_INVOL_B + (((mix << 5) + mixin) << 2), vol); | |
210 | } | |
211 | ||
212 | static void | |
213 | vortex_mix_setenablebit(vortex_t * vortex, unsigned char mix, int mixin, int en) | |
214 | { | |
215 | int temp, addr; | |
216 | ||
217 | if (mixin < 0) | |
218 | addr = (mixin + 3); | |
219 | else | |
220 | addr = mixin; | |
221 | addr = ((mix << 3) + (addr >> 2)) << 2; | |
222 | temp = hwread(vortex->mmio, VORTEX_MIX_ENIN + addr); | |
223 | if (en) | |
224 | temp |= (1 << (mixin & 3)); | |
225 | else | |
226 | temp &= ~(1 << (mixin & 3)); | |
227 | /* Mute input. Astatic void crackling? */ | |
228 | hwwrite(vortex->mmio, | |
229 | VORTEX_MIX_INVOL_B + (((mix << 5) + mixin) << 2), 0x80); | |
230 | /* Looks like clear buffer. */ | |
231 | hwwrite(vortex->mmio, VORTEX_MIX_SMP + (mixin << 2), 0x0); | |
232 | hwwrite(vortex->mmio, VORTEX_MIX_SMP + 4 + (mixin << 2), 0x0); | |
233 | /* Write enable bit. */ | |
234 | hwwrite(vortex->mmio, VORTEX_MIX_ENIN + addr, temp); | |
235 | } | |
236 | ||
237 | static void | |
238 | vortex_mix_killinput(vortex_t * vortex, unsigned char mix, int mixin) | |
239 | { | |
240 | rampchs[mix] &= ~(1 << mixin); | |
241 | vortex_mix_setinputvolumebyte(vortex, mix, mixin, 0x80); | |
242 | mchannels[mix] &= ~(1 << mixin); | |
243 | vortex_mix_setenablebit(vortex, mix, mixin, 0); | |
244 | } | |
245 | ||
246 | static void | |
247 | vortex_mix_enableinput(vortex_t * vortex, unsigned char mix, int mixin) | |
248 | { | |
249 | vortex_mix_killinput(vortex, mix, mixin); | |
250 | if ((mchannels[mix] & (1 << mixin)) == 0) { | |
251 | vortex_mix_setinputvolumebyte(vortex, mix, mixin, 0x80); /*0x80 : mute */ | |
252 | mchannels[mix] |= (1 << mixin); | |
253 | } | |
254 | vortex_mix_setenablebit(vortex, mix, mixin, 1); | |
255 | } | |
256 | ||
257 | static void | |
258 | vortex_mix_disableinput(vortex_t * vortex, unsigned char mix, int channel, | |
259 | int ramp) | |
260 | { | |
261 | if (ramp) { | |
262 | rampchs[mix] |= (1 << channel); | |
263 | // Register callback. | |
264 | //vortex_mix_startrampvolume(vortex); | |
265 | vortex_mix_killinput(vortex, mix, channel); | |
266 | } else | |
267 | vortex_mix_killinput(vortex, mix, channel); | |
268 | } | |
269 | ||
270 | static int | |
271 | vortex_mixer_addWTD(vortex_t * vortex, unsigned char mix, unsigned char ch) | |
272 | { | |
273 | int temp, lifeboat = 0, prev; | |
274 | ||
275 | temp = hwread(vortex->mmio, VORTEX_MIXER_SR); | |
276 | if ((temp & (1 << ch)) == 0) { | |
277 | hwwrite(vortex->mmio, VORTEX_MIXER_CHNBASE + (ch << 2), mix); | |
278 | vortex_mixer_en_sr(vortex, ch); | |
279 | return 1; | |
280 | } | |
281 | prev = VORTEX_MIXER_CHNBASE + (ch << 2); | |
282 | temp = hwread(vortex->mmio, prev); | |
283 | while (temp & 0x10) { | |
284 | prev = VORTEX_MIXER_RTBASE + ((temp & 0xf) << 2); | |
285 | temp = hwread(vortex->mmio, prev); | |
286 | //printk(KERN_INFO "vortex: mixAddWTD: while addr=%x, val=%x\n", prev, temp); | |
287 | if ((++lifeboat) > 0xf) { | |
288 | printk(KERN_ERR | |
289 | "vortex_mixer_addWTD: lifeboat overflow\n"); | |
290 | return 0; | |
291 | } | |
292 | } | |
293 | hwwrite(vortex->mmio, VORTEX_MIXER_RTBASE + ((temp & 0xf) << 2), mix); | |
294 | hwwrite(vortex->mmio, prev, (temp & 0xf) | 0x10); | |
295 | return 1; | |
296 | } | |
297 | ||
298 | static int | |
299 | vortex_mixer_delWTD(vortex_t * vortex, unsigned char mix, unsigned char ch) | |
300 | { | |
301 | int esp14 = -1, esp18, eax, ebx, edx, ebp, esi = 0; | |
302 | //int esp1f=edi(while)=src, esp10=ch; | |
303 | ||
304 | eax = hwread(vortex->mmio, VORTEX_MIXER_SR); | |
305 | if (((1 << ch) & eax) == 0) { | |
306 | printk(KERN_ERR "mix ALARM %x\n", eax); | |
307 | return 0; | |
308 | } | |
309 | ebp = VORTEX_MIXER_CHNBASE + (ch << 2); | |
310 | esp18 = hwread(vortex->mmio, ebp); | |
311 | if (esp18 & 0x10) { | |
312 | ebx = (esp18 & 0xf); | |
313 | if (mix == ebx) { | |
314 | ebx = VORTEX_MIXER_RTBASE + (mix << 2); | |
315 | edx = hwread(vortex->mmio, ebx); | |
316 | //7b60 | |
317 | hwwrite(vortex->mmio, ebp, edx); | |
318 | hwwrite(vortex->mmio, ebx, 0); | |
319 | } else { | |
320 | //7ad3 | |
321 | edx = | |
322 | hwread(vortex->mmio, | |
323 | VORTEX_MIXER_RTBASE + (ebx << 2)); | |
324 | //printk(KERN_INFO "vortex: mixdelWTD: 1 addr=%x, val=%x, src=%x\n", ebx, edx, src); | |
325 | while ((edx & 0xf) != mix) { | |
326 | if ((esi) > 0xf) { | |
327 | printk(KERN_ERR | |
328 | "vortex: mixdelWTD: error lifeboat overflow\n"); | |
329 | return 0; | |
330 | } | |
331 | esp14 = ebx; | |
332 | ebx = edx & 0xf; | |
333 | ebp = ebx << 2; | |
334 | edx = | |
335 | hwread(vortex->mmio, | |
336 | VORTEX_MIXER_RTBASE + ebp); | |
337 | //printk(KERN_INFO "vortex: mixdelWTD: while addr=%x, val=%x\n", ebp, edx); | |
338 | esi++; | |
339 | } | |
340 | //7b30 | |
341 | ebp = ebx << 2; | |
342 | if (edx & 0x10) { /* Delete entry in between others */ | |
343 | ebx = VORTEX_MIXER_RTBASE + ((edx & 0xf) << 2); | |
344 | edx = hwread(vortex->mmio, ebx); | |
345 | //7b60 | |
346 | hwwrite(vortex->mmio, | |
347 | VORTEX_MIXER_RTBASE + ebp, edx); | |
348 | hwwrite(vortex->mmio, ebx, 0); | |
349 | //printk(KERN_INFO "vortex mixdelWTD between addr= 0x%x, val= 0x%x\n", ebp, edx); | |
350 | } else { /* Delete last entry */ | |
351 | //7b83 | |
352 | if (esp14 == -1) | |
353 | hwwrite(vortex->mmio, | |
354 | VORTEX_MIXER_CHNBASE + | |
355 | (ch << 2), esp18 & 0xef); | |
356 | else { | |
357 | ebx = (0xffffffe0 & edx) | (0xf & ebx); | |
358 | hwwrite(vortex->mmio, | |
359 | VORTEX_MIXER_RTBASE + | |
360 | (esp14 << 2), ebx); | |
361 | //printk(KERN_INFO "vortex mixdelWTD last addr= 0x%x, val= 0x%x\n", esp14, ebx); | |
362 | } | |
363 | hwwrite(vortex->mmio, | |
364 | VORTEX_MIXER_RTBASE + ebp, 0); | |
365 | return 1; | |
366 | } | |
367 | } | |
368 | } else { | |
369 | //printk(KERN_INFO "removed last mix\n"); | |
370 | //7be0 | |
371 | vortex_mixer_dis_sr(vortex, ch); | |
372 | hwwrite(vortex->mmio, ebp, 0); | |
373 | } | |
374 | return 1; | |
375 | } | |
376 | ||
377 | static void vortex_mixer_init(vortex_t * vortex) | |
378 | { | |
97c67b65 | 379 | u32 addr; |
1da177e4 LT |
380 | int x; |
381 | ||
382 | // FIXME: get rid of this crap. | |
383 | memset(mchannels, 0, NR_MIXOUT * sizeof(int)); | |
384 | memset(rampchs, 0, NR_MIXOUT * sizeof(int)); | |
385 | ||
386 | addr = VORTEX_MIX_SMP + 0x17c; | |
387 | for (x = 0x5f; x >= 0; x--) { | |
388 | hwwrite(vortex->mmio, addr, 0); | |
389 | addr -= 4; | |
390 | } | |
391 | addr = VORTEX_MIX_ENIN + 0x1fc; | |
392 | for (x = 0x7f; x >= 0; x--) { | |
393 | hwwrite(vortex->mmio, addr, 0); | |
394 | addr -= 4; | |
395 | } | |
396 | addr = VORTEX_MIX_SMP + 0x17c; | |
397 | for (x = 0x5f; x >= 0; x--) { | |
398 | hwwrite(vortex->mmio, addr, 0); | |
399 | addr -= 4; | |
400 | } | |
401 | addr = VORTEX_MIX_INVOL_A + 0x7fc; | |
402 | for (x = 0x1ff; x >= 0; x--) { | |
403 | hwwrite(vortex->mmio, addr, 0x80); | |
404 | addr -= 4; | |
405 | } | |
406 | addr = VORTEX_MIX_VOL_A + 0x3c; | |
407 | for (x = 0xf; x >= 0; x--) { | |
408 | hwwrite(vortex->mmio, addr, 0x80); | |
409 | addr -= 4; | |
410 | } | |
411 | addr = VORTEX_MIX_INVOL_B + 0x7fc; | |
412 | for (x = 0x1ff; x >= 0; x--) { | |
413 | hwwrite(vortex->mmio, addr, 0x80); | |
414 | addr -= 4; | |
415 | } | |
416 | addr = VORTEX_MIX_VOL_B + 0x3c; | |
417 | for (x = 0xf; x >= 0; x--) { | |
418 | hwwrite(vortex->mmio, addr, 0x80); | |
419 | addr -= 4; | |
420 | } | |
421 | addr = VORTEX_MIXER_RTBASE + (MIXER_RTBASE_SIZE - 1) * 4; | |
422 | for (x = (MIXER_RTBASE_SIZE - 1); x >= 0; x--) { | |
423 | hwwrite(vortex->mmio, addr, 0x0); | |
424 | addr -= 4; | |
425 | } | |
426 | hwwrite(vortex->mmio, VORTEX_MIXER_SR, 0); | |
427 | ||
428 | /* Set clipping ceiling (this may be all wrong). */ | |
429 | /* | |
c534cc84 | 430 | for (x = 0; x < 0x80; x++) { |
1da177e4 LT |
431 | hwwrite(vortex->mmio, VORTEX_MIXER_CLIP + (x << 2), 0x3ffff); |
432 | } | |
433 | */ | |
434 | /* | |
435 | call CAsp4Mix__Initialize_CAsp4HwIO____CAsp4Mixer____ | |
436 | Register ISR callback for volume smooth fade out. | |
437 | Maybe this avoids clicks when press "stop" ? | |
438 | */ | |
439 | } | |
440 | ||
441 | /* SRC (CAsp4Src.s and CAsp4SrcBlock) */ | |
442 | ||
443 | static void vortex_src_en_sr(vortex_t * vortex, int channel) | |
444 | { | |
445 | hwwrite(vortex->mmio, VORTEX_SRCBLOCK_SR, | |
446 | hwread(vortex->mmio, VORTEX_SRCBLOCK_SR) | (0x1 << channel)); | |
447 | } | |
448 | ||
449 | static void vortex_src_dis_sr(vortex_t * vortex, int channel) | |
450 | { | |
451 | hwwrite(vortex->mmio, VORTEX_SRCBLOCK_SR, | |
452 | hwread(vortex->mmio, VORTEX_SRCBLOCK_SR) & ~(0x1 << channel)); | |
453 | } | |
454 | ||
455 | static void vortex_src_flushbuffers(vortex_t * vortex, unsigned char src) | |
456 | { | |
457 | int i; | |
458 | ||
459 | for (i = 0x1f; i >= 0; i--) | |
460 | hwwrite(vortex->mmio, | |
461 | VORTEX_SRC_DATA0 + (src << 7) + (i << 2), 0); | |
462 | hwwrite(vortex->mmio, VORTEX_SRC_DATA + (src << 3), 0); | |
463 | hwwrite(vortex->mmio, VORTEX_SRC_DATA + (src << 3) + 4, 0); | |
464 | } | |
465 | ||
466 | static void vortex_src_cleardrift(vortex_t * vortex, unsigned char src) | |
467 | { | |
468 | hwwrite(vortex->mmio, VORTEX_SRC_DRIFT0 + (src << 2), 0); | |
469 | hwwrite(vortex->mmio, VORTEX_SRC_DRIFT1 + (src << 2), 0); | |
470 | hwwrite(vortex->mmio, VORTEX_SRC_DRIFT2 + (src << 2), 1); | |
471 | } | |
472 | ||
473 | static void | |
474 | vortex_src_set_throttlesource(vortex_t * vortex, unsigned char src, int en) | |
475 | { | |
476 | int temp; | |
477 | ||
478 | temp = hwread(vortex->mmio, VORTEX_SRC_SOURCE); | |
479 | if (en) | |
480 | temp |= 1 << src; | |
481 | else | |
482 | temp &= ~(1 << src); | |
483 | hwwrite(vortex->mmio, VORTEX_SRC_SOURCE, temp); | |
484 | } | |
485 | ||
486 | static int | |
487 | vortex_src_persist_convratio(vortex_t * vortex, unsigned char src, int ratio) | |
488 | { | |
489 | int temp, lifeboat = 0; | |
490 | ||
491 | do { | |
492 | hwwrite(vortex->mmio, VORTEX_SRC_CONVRATIO + (src << 2), ratio); | |
493 | temp = hwread(vortex->mmio, VORTEX_SRC_CONVRATIO + (src << 2)); | |
494 | if ((++lifeboat) > 0x9) { | |
495 | printk(KERN_ERR "Vortex: Src cvr fail\n"); | |
496 | break; | |
497 | } | |
498 | } | |
499 | while (temp != ratio); | |
500 | return temp; | |
501 | } | |
502 | ||
503 | #if 0 | |
504 | static void vortex_src_slowlock(vortex_t * vortex, unsigned char src) | |
505 | { | |
506 | int temp; | |
507 | ||
508 | hwwrite(vortex->mmio, VORTEX_SRC_DRIFT2 + (src << 2), 1); | |
509 | hwwrite(vortex->mmio, VORTEX_SRC_DRIFT0 + (src << 2), 0); | |
510 | temp = hwread(vortex->mmio, VORTEX_SRC_U0 + (src << 2)); | |
511 | if (temp & 0x200) | |
512 | hwwrite(vortex->mmio, VORTEX_SRC_U0 + (src << 2), | |
513 | temp & ~0x200L); | |
514 | } | |
515 | ||
516 | static void | |
517 | vortex_src_change_convratio(vortex_t * vortex, unsigned char src, int ratio) | |
518 | { | |
519 | int temp, a; | |
520 | ||
521 | if ((ratio & 0x10000) && (ratio != 0x10000)) { | |
522 | if (ratio & 0x3fff) | |
523 | a = (0x11 - ((ratio >> 0xe) & 0x3)) - 1; | |
524 | else | |
525 | a = (0x11 - ((ratio >> 0xe) & 0x3)) - 2; | |
526 | } else | |
527 | a = 0xc; | |
528 | temp = hwread(vortex->mmio, VORTEX_SRC_U0 + (src << 2)); | |
529 | if (((temp >> 4) & 0xf) != a) | |
530 | hwwrite(vortex->mmio, VORTEX_SRC_U0 + (src << 2), | |
531 | (temp & 0xf) | ((a & 0xf) << 4)); | |
532 | ||
533 | vortex_src_persist_convratio(vortex, src, ratio); | |
534 | } | |
535 | ||
536 | static int | |
537 | vortex_src_checkratio(vortex_t * vortex, unsigned char src, | |
538 | unsigned int desired_ratio) | |
539 | { | |
540 | int hw_ratio, lifeboat = 0; | |
541 | ||
542 | hw_ratio = hwread(vortex->mmio, VORTEX_SRC_CONVRATIO + (src << 2)); | |
543 | ||
544 | while (hw_ratio != desired_ratio) { | |
545 | hwwrite(vortex->mmio, VORTEX_SRC_CONVRATIO + (src << 2), desired_ratio); | |
546 | ||
547 | if ((lifeboat++) > 15) { | |
548 | printk(KERN_ERR "Vortex: could not set src-%d from %d to %d\n", | |
549 | src, hw_ratio, desired_ratio); | |
550 | break; | |
551 | } | |
552 | } | |
553 | ||
554 | return hw_ratio; | |
555 | } | |
556 | ||
557 | #endif | |
558 | /* | |
559 | Objective: Set samplerate for given SRC module. | |
560 | Arguments: | |
561 | card: pointer to vortex_t strcut. | |
562 | src: Integer index of the SRC module. | |
563 | cr: Current sample rate conversion factor. | |
564 | b: unknown 16 bit value. | |
565 | sweep: Enable Samplerate fade from cr toward tr flag. | |
566 | dirplay: 1: playback, 0: recording. | |
567 | sl: Slow Lock flag. | |
568 | tr: Target samplerate conversion. | |
569 | thsource: Throttle source flag (no idea what that means). | |
570 | */ | |
571 | static void vortex_src_setupchannel(vortex_t * card, unsigned char src, | |
572 | unsigned int cr, unsigned int b, int sweep, int d, | |
573 | int dirplay, int sl, unsigned int tr, int thsource) | |
574 | { | |
575 | // noplayback: d=2,4,7,0xa,0xb when using first 2 src's. | |
576 | // c: enables pitch sweep. | |
577 | // looks like g is c related. Maybe g is a sweep parameter ? | |
578 | // g = cvr | |
579 | // dirplay: 0 = recording, 1 = playback | |
580 | // d = src hw index. | |
581 | ||
582 | int esi, ebp = 0, esp10; | |
583 | ||
584 | vortex_src_flushbuffers(card, src); | |
585 | ||
586 | if (sweep) { | |
587 | if ((tr & 0x10000) && (tr != 0x10000)) { | |
588 | tr = 0; | |
589 | esi = 0x7; | |
590 | } else { | |
591 | if ((((short)tr) < 0) && (tr != 0x8000)) { | |
592 | tr = 0; | |
593 | esi = 0x8; | |
594 | } else { | |
595 | tr = 1; | |
596 | esi = 0xc; | |
597 | } | |
598 | } | |
599 | } else { | |
600 | if ((cr & 0x10000) && (cr != 0x10000)) { | |
601 | tr = 0; /*ebx = 0 */ | |
602 | esi = 0x11 - ((cr >> 0xe) & 7); | |
603 | if (cr & 0x3fff) | |
604 | esi -= 1; | |
605 | else | |
606 | esi -= 2; | |
607 | } else { | |
608 | tr = 1; | |
609 | esi = 0xc; | |
610 | } | |
611 | } | |
612 | vortex_src_cleardrift(card, src); | |
613 | vortex_src_set_throttlesource(card, src, thsource); | |
614 | ||
615 | if ((dirplay == 0) && (sweep == 0)) { | |
616 | if (tr) | |
617 | esp10 = 0xf; | |
618 | else | |
619 | esp10 = 0xc; | |
620 | ebp = 0; | |
621 | } else { | |
622 | if (tr) | |
623 | ebp = 0xf; | |
624 | else | |
625 | ebp = 0xc; | |
626 | esp10 = 0; | |
627 | } | |
628 | hwwrite(card->mmio, VORTEX_SRC_U0 + (src << 2), | |
629 | (sl << 0x9) | (sweep << 0x8) | ((esi & 0xf) << 4) | d); | |
630 | /* 0xc0 esi=0xc c=f=0 d=0 */ | |
631 | vortex_src_persist_convratio(card, src, cr); | |
632 | hwwrite(card->mmio, VORTEX_SRC_U1 + (src << 2), b & 0xffff); | |
633 | /* 0 b=0 */ | |
634 | hwwrite(card->mmio, VORTEX_SRC_U2 + (src << 2), | |
635 | (tr << 0x11) | (dirplay << 0x10) | (ebp << 0x8) | esp10); | |
636 | /* 0x30f00 e=g=1 esp10=0 ebp=f */ | |
637 | //printk(KERN_INFO "vortex: SRC %d, d=0x%x, esi=0x%x, esp10=0x%x, ebp=0x%x\n", src, d, esi, esp10, ebp); | |
638 | } | |
639 | ||
640 | static void vortex_srcblock_init(vortex_t * vortex) | |
641 | { | |
97c67b65 | 642 | u32 addr; |
1da177e4 LT |
643 | int x; |
644 | hwwrite(vortex->mmio, VORTEX_SRC_SOURCESIZE, 0x1ff); | |
645 | /* | |
646 | for (x=0; x<0x10; x++) { | |
647 | vortex_src_init(&vortex_src[x], x); | |
648 | } | |
649 | */ | |
650 | //addr = 0xcc3c; | |
651 | //addr = 0x26c3c; | |
652 | addr = VORTEX_SRC_RTBASE + 0x3c; | |
653 | for (x = 0xf; x >= 0; x--) { | |
654 | hwwrite(vortex->mmio, addr, 0); | |
655 | addr -= 4; | |
656 | } | |
657 | //addr = 0xcc94; | |
658 | //addr = 0x26c94; | |
659 | addr = VORTEX_SRC_CHNBASE + 0x54; | |
660 | for (x = 0x15; x >= 0; x--) { | |
661 | hwwrite(vortex->mmio, addr, 0); | |
662 | addr -= 4; | |
663 | } | |
664 | } | |
665 | ||
666 | static int | |
667 | vortex_src_addWTD(vortex_t * vortex, unsigned char src, unsigned char ch) | |
668 | { | |
669 | int temp, lifeboat = 0, prev; | |
670 | // esp13 = src | |
671 | ||
672 | temp = hwread(vortex->mmio, VORTEX_SRCBLOCK_SR); | |
673 | if ((temp & (1 << ch)) == 0) { | |
674 | hwwrite(vortex->mmio, VORTEX_SRC_CHNBASE + (ch << 2), src); | |
675 | vortex_src_en_sr(vortex, ch); | |
676 | return 1; | |
677 | } | |
678 | prev = VORTEX_SRC_CHNBASE + (ch << 2); /*ebp */ | |
679 | temp = hwread(vortex->mmio, prev); | |
680 | //while (temp & NR_SRC) { | |
681 | while (temp & 0x10) { | |
682 | prev = VORTEX_SRC_RTBASE + ((temp & 0xf) << 2); /*esp12 */ | |
683 | //prev = VORTEX_SRC_RTBASE + ((temp & (NR_SRC-1)) << 2); /*esp12*/ | |
684 | temp = hwread(vortex->mmio, prev); | |
685 | //printk(KERN_INFO "vortex: srcAddWTD: while addr=%x, val=%x\n", prev, temp); | |
686 | if ((++lifeboat) > 0xf) { | |
687 | printk(KERN_ERR | |
688 | "vortex_src_addWTD: lifeboat overflow\n"); | |
689 | return 0; | |
690 | } | |
691 | } | |
692 | hwwrite(vortex->mmio, VORTEX_SRC_RTBASE + ((temp & 0xf) << 2), src); | |
693 | //hwwrite(vortex->mmio, prev, (temp & (NR_SRC-1)) | NR_SRC); | |
694 | hwwrite(vortex->mmio, prev, (temp & 0xf) | 0x10); | |
695 | return 1; | |
696 | } | |
697 | ||
698 | static int | |
699 | vortex_src_delWTD(vortex_t * vortex, unsigned char src, unsigned char ch) | |
700 | { | |
701 | int esp14 = -1, esp18, eax, ebx, edx, ebp, esi = 0; | |
702 | //int esp1f=edi(while)=src, esp10=ch; | |
703 | ||
704 | eax = hwread(vortex->mmio, VORTEX_SRCBLOCK_SR); | |
705 | if (((1 << ch) & eax) == 0) { | |
706 | printk(KERN_ERR "src alarm\n"); | |
707 | return 0; | |
708 | } | |
709 | ebp = VORTEX_SRC_CHNBASE + (ch << 2); | |
710 | esp18 = hwread(vortex->mmio, ebp); | |
711 | if (esp18 & 0x10) { | |
712 | ebx = (esp18 & 0xf); | |
713 | if (src == ebx) { | |
714 | ebx = VORTEX_SRC_RTBASE + (src << 2); | |
715 | edx = hwread(vortex->mmio, ebx); | |
716 | //7b60 | |
717 | hwwrite(vortex->mmio, ebp, edx); | |
718 | hwwrite(vortex->mmio, ebx, 0); | |
719 | } else { | |
720 | //7ad3 | |
721 | edx = | |
722 | hwread(vortex->mmio, | |
723 | VORTEX_SRC_RTBASE + (ebx << 2)); | |
724 | //printk(KERN_INFO "vortex: srcdelWTD: 1 addr=%x, val=%x, src=%x\n", ebx, edx, src); | |
725 | while ((edx & 0xf) != src) { | |
726 | if ((esi) > 0xf) { | |
727 | printk | |
728 | ("vortex: srcdelWTD: error, lifeboat overflow\n"); | |
729 | return 0; | |
730 | } | |
731 | esp14 = ebx; | |
732 | ebx = edx & 0xf; | |
733 | ebp = ebx << 2; | |
734 | edx = | |
735 | hwread(vortex->mmio, | |
736 | VORTEX_SRC_RTBASE + ebp); | |
737 | //printk(KERN_INFO "vortex: srcdelWTD: while addr=%x, val=%x\n", ebp, edx); | |
738 | esi++; | |
739 | } | |
740 | //7b30 | |
741 | ebp = ebx << 2; | |
742 | if (edx & 0x10) { /* Delete entry in between others */ | |
743 | ebx = VORTEX_SRC_RTBASE + ((edx & 0xf) << 2); | |
744 | edx = hwread(vortex->mmio, ebx); | |
745 | //7b60 | |
746 | hwwrite(vortex->mmio, | |
747 | VORTEX_SRC_RTBASE + ebp, edx); | |
748 | hwwrite(vortex->mmio, ebx, 0); | |
749 | //printk(KERN_INFO "vortex srcdelWTD between addr= 0x%x, val= 0x%x\n", ebp, edx); | |
750 | } else { /* Delete last entry */ | |
751 | //7b83 | |
752 | if (esp14 == -1) | |
753 | hwwrite(vortex->mmio, | |
754 | VORTEX_SRC_CHNBASE + | |
755 | (ch << 2), esp18 & 0xef); | |
756 | else { | |
757 | ebx = (0xffffffe0 & edx) | (0xf & ebx); | |
758 | hwwrite(vortex->mmio, | |
759 | VORTEX_SRC_RTBASE + | |
760 | (esp14 << 2), ebx); | |
761 | //printk(KERN_INFO"vortex srcdelWTD last addr= 0x%x, val= 0x%x\n", esp14, ebx); | |
762 | } | |
763 | hwwrite(vortex->mmio, | |
764 | VORTEX_SRC_RTBASE + ebp, 0); | |
765 | return 1; | |
766 | } | |
767 | } | |
768 | } else { | |
769 | //7be0 | |
770 | vortex_src_dis_sr(vortex, ch); | |
771 | hwwrite(vortex->mmio, ebp, 0); | |
772 | } | |
773 | return 1; | |
774 | } | |
775 | ||
776 | /*FIFO*/ | |
777 | ||
778 | static void | |
779 | vortex_fifo_clearadbdata(vortex_t * vortex, int fifo, int x) | |
780 | { | |
781 | for (x--; x >= 0; x--) | |
782 | hwwrite(vortex->mmio, | |
783 | VORTEX_FIFO_ADBDATA + | |
784 | (((fifo << FIFO_SIZE_BITS) + x) << 2), 0); | |
785 | } | |
786 | ||
787 | #if 0 | |
788 | static void vortex_fifo_adbinitialize(vortex_t * vortex, int fifo, int j) | |
789 | { | |
790 | vortex_fifo_clearadbdata(vortex, fifo, FIFO_SIZE); | |
791 | #ifdef CHIP_AU8820 | |
792 | hwwrite(vortex->mmio, VORTEX_FIFO_ADBCTRL + (fifo << 2), | |
793 | (FIFO_U1 | ((j & FIFO_MASK) << 0xb))); | |
794 | #else | |
795 | hwwrite(vortex->mmio, VORTEX_FIFO_ADBCTRL + (fifo << 2), | |
796 | (FIFO_U1 | ((j & FIFO_MASK) << 0xc))); | |
797 | #endif | |
798 | } | |
799 | #endif | |
800 | static void vortex_fifo_setadbvalid(vortex_t * vortex, int fifo, int en) | |
801 | { | |
802 | hwwrite(vortex->mmio, VORTEX_FIFO_ADBCTRL + (fifo << 2), | |
803 | (hwread(vortex->mmio, VORTEX_FIFO_ADBCTRL + (fifo << 2)) & | |
804 | 0xffffffef) | ((1 & en) << 4) | FIFO_U1); | |
805 | } | |
806 | ||
807 | static void | |
3ae4e1f7 | 808 | vortex_fifo_setadbctrl(vortex_t * vortex, int fifo, int stereo, int priority, |
1da177e4 LT |
809 | int empty, int valid, int f) |
810 | { | |
811 | int temp, lifeboat = 0; | |
812 | //int this_8[NR_ADB] = {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0}; /* position */ | |
813 | int this_4 = 0x2; | |
814 | /* f seems priority related. | |
815 | * CAsp4AdbDma::SetPriority is the only place that calls SetAdbCtrl with f set to 1 | |
816 | * every where else it is set to 0. It seems, however, that CAsp4AdbDma::SetPriority | |
817 | * is never called, thus the f related bits remain a mystery for now. | |
818 | */ | |
819 | do { | |
820 | temp = hwread(vortex->mmio, VORTEX_FIFO_ADBCTRL + (fifo << 2)); | |
821 | if (lifeboat++ > 0xbb8) { | |
822 | printk(KERN_ERR | |
823 | "Vortex: vortex_fifo_setadbctrl fail\n"); | |
824 | break; | |
825 | } | |
826 | } | |
827 | while (temp & FIFO_RDONLY); | |
828 | ||
829 | // AU8830 semes to take some special care about fifo content (data). | |
830 | // But i'm just to lazy to translate that :) | |
831 | if (valid) { | |
832 | if ((temp & FIFO_VALID) == 0) { | |
833 | //this_8[fifo] = 0; | |
834 | vortex_fifo_clearadbdata(vortex, fifo, FIFO_SIZE); // this_4 | |
835 | #ifdef CHIP_AU8820 | |
836 | temp = (this_4 & 0x1f) << 0xb; | |
837 | #else | |
838 | temp = (this_4 & 0x3f) << 0xc; | |
839 | #endif | |
3ae4e1f7 | 840 | temp = (temp & 0xfffffffd) | ((stereo & 1) << 1); |
1da177e4 LT |
841 | temp = (temp & 0xfffffff3) | ((priority & 3) << 2); |
842 | temp = (temp & 0xffffffef) | ((valid & 1) << 4); | |
843 | temp |= FIFO_U1; | |
844 | temp = (temp & 0xffffffdf) | ((empty & 1) << 5); | |
845 | #ifdef CHIP_AU8820 | |
846 | temp = (temp & 0xfffbffff) | ((f & 1) << 0x12); | |
847 | #endif | |
848 | #ifdef CHIP_AU8830 | |
849 | temp = (temp & 0xf7ffffff) | ((f & 1) << 0x1b); | |
850 | temp = (temp & 0xefffffff) | ((f & 1) << 0x1c); | |
851 | #endif | |
852 | #ifdef CHIP_AU8810 | |
853 | temp = (temp & 0xfeffffff) | ((f & 1) << 0x18); | |
854 | temp = (temp & 0xfdffffff) | ((f & 1) << 0x19); | |
855 | #endif | |
856 | } | |
857 | } else { | |
858 | if (temp & FIFO_VALID) { | |
859 | #ifdef CHIP_AU8820 | |
860 | temp = ((f & 1) << 0x12) | (temp & 0xfffbffef); | |
861 | #endif | |
862 | #ifdef CHIP_AU8830 | |
863 | temp = | |
864 | ((f & 1) << 0x1b) | (temp & 0xe7ffffef) | FIFO_BITS; | |
865 | #endif | |
866 | #ifdef CHIP_AU8810 | |
867 | temp = | |
868 | ((f & 1) << 0x18) | (temp & 0xfcffffef) | FIFO_BITS; | |
869 | #endif | |
870 | } else | |
871 | /*if (this_8[fifo]) */ | |
872 | vortex_fifo_clearadbdata(vortex, fifo, FIFO_SIZE); | |
873 | } | |
874 | hwwrite(vortex->mmio, VORTEX_FIFO_ADBCTRL + (fifo << 2), temp); | |
875 | hwread(vortex->mmio, VORTEX_FIFO_ADBCTRL + (fifo << 2)); | |
876 | } | |
877 | ||
878 | #ifndef CHIP_AU8810 | |
879 | static void vortex_fifo_clearwtdata(vortex_t * vortex, int fifo, int x) | |
880 | { | |
881 | if (x < 1) | |
882 | return; | |
883 | for (x--; x >= 0; x--) | |
884 | hwwrite(vortex->mmio, | |
885 | VORTEX_FIFO_WTDATA + | |
886 | (((fifo << FIFO_SIZE_BITS) + x) << 2), 0); | |
887 | } | |
888 | ||
889 | static void vortex_fifo_wtinitialize(vortex_t * vortex, int fifo, int j) | |
890 | { | |
891 | vortex_fifo_clearwtdata(vortex, fifo, FIFO_SIZE); | |
892 | #ifdef CHIP_AU8820 | |
893 | hwwrite(vortex->mmio, VORTEX_FIFO_WTCTRL + (fifo << 2), | |
894 | (FIFO_U1 | ((j & FIFO_MASK) << 0xb))); | |
895 | #else | |
896 | hwwrite(vortex->mmio, VORTEX_FIFO_WTCTRL + (fifo << 2), | |
897 | (FIFO_U1 | ((j & FIFO_MASK) << 0xc))); | |
898 | #endif | |
899 | } | |
900 | ||
901 | static void vortex_fifo_setwtvalid(vortex_t * vortex, int fifo, int en) | |
902 | { | |
903 | hwwrite(vortex->mmio, VORTEX_FIFO_WTCTRL + (fifo << 2), | |
904 | (hwread(vortex->mmio, VORTEX_FIFO_WTCTRL + (fifo << 2)) & | |
905 | 0xffffffef) | ((en & 1) << 4) | FIFO_U1); | |
906 | } | |
907 | ||
908 | static void | |
909 | vortex_fifo_setwtctrl(vortex_t * vortex, int fifo, int ctrl, int priority, | |
910 | int empty, int valid, int f) | |
911 | { | |
912 | int temp = 0, lifeboat = 0; | |
913 | int this_4 = 2; | |
914 | ||
915 | do { | |
916 | temp = hwread(vortex->mmio, VORTEX_FIFO_WTCTRL + (fifo << 2)); | |
917 | if (lifeboat++ > 0xbb8) { | |
918 | printk(KERN_ERR "Vortex: vortex_fifo_setwtctrl fail\n"); | |
919 | break; | |
920 | } | |
921 | } | |
922 | while (temp & FIFO_RDONLY); | |
923 | ||
924 | if (valid) { | |
925 | if ((temp & FIFO_VALID) == 0) { | |
926 | vortex_fifo_clearwtdata(vortex, fifo, FIFO_SIZE); // this_4 | |
927 | #ifdef CHIP_AU8820 | |
928 | temp = (this_4 & 0x1f) << 0xb; | |
929 | #else | |
930 | temp = (this_4 & 0x3f) << 0xc; | |
931 | #endif | |
932 | temp = (temp & 0xfffffffd) | ((ctrl & 1) << 1); | |
933 | temp = (temp & 0xfffffff3) | ((priority & 3) << 2); | |
934 | temp = (temp & 0xffffffef) | ((valid & 1) << 4); | |
935 | temp |= FIFO_U1; | |
936 | temp = (temp & 0xffffffdf) | ((empty & 1) << 5); | |
937 | #ifdef CHIP_AU8820 | |
938 | temp = (temp & 0xfffbffff) | ((f & 1) << 0x12); | |
939 | #endif | |
940 | #ifdef CHIP_AU8830 | |
941 | temp = (temp & 0xf7ffffff) | ((f & 1) << 0x1b); | |
942 | temp = (temp & 0xefffffff) | ((f & 1) << 0x1c); | |
943 | #endif | |
944 | #ifdef CHIP_AU8810 | |
945 | temp = (temp & 0xfeffffff) | ((f & 1) << 0x18); | |
946 | temp = (temp & 0xfdffffff) | ((f & 1) << 0x19); | |
947 | #endif | |
948 | } | |
949 | } else { | |
950 | if (temp & FIFO_VALID) { | |
951 | #ifdef CHIP_AU8820 | |
952 | temp = ((f & 1) << 0x12) | (temp & 0xfffbffef); | |
953 | #endif | |
954 | #ifdef CHIP_AU8830 | |
955 | temp = | |
956 | ((f & 1) << 0x1b) | (temp & 0xe7ffffef) | FIFO_BITS; | |
957 | #endif | |
958 | #ifdef CHIP_AU8810 | |
959 | temp = | |
960 | ((f & 1) << 0x18) | (temp & 0xfcffffef) | FIFO_BITS; | |
961 | #endif | |
962 | } else | |
963 | /*if (this_8[fifo]) */ | |
964 | vortex_fifo_clearwtdata(vortex, fifo, FIFO_SIZE); | |
965 | } | |
966 | hwwrite(vortex->mmio, VORTEX_FIFO_WTCTRL + (fifo << 2), temp); | |
967 | hwread(vortex->mmio, VORTEX_FIFO_WTCTRL + (fifo << 2)); | |
968 | ||
969 | /* | |
970 | do { | |
971 | temp = hwread(vortex->mmio, VORTEX_FIFO_WTCTRL + (fifo << 2)); | |
972 | if (lifeboat++ > 0xbb8) { | |
973 | printk(KERN_ERR "Vortex: vortex_fifo_setwtctrl fail (hanging)\n"); | |
974 | break; | |
975 | } | |
976 | } while ((temp & FIFO_RDONLY)&&(temp & FIFO_VALID)&&(temp != 0xFFFFFFFF)); | |
977 | ||
978 | ||
979 | if (valid) { | |
980 | if (temp & FIFO_VALID) { | |
981 | temp = 0x40000; | |
982 | //temp |= 0x08000000; | |
983 | //temp |= 0x10000000; | |
984 | //temp |= 0x04000000; | |
985 | //temp |= 0x00400000; | |
986 | temp |= 0x1c400000; | |
987 | temp &= 0xFFFFFFF3; | |
988 | temp &= 0xFFFFFFEF; | |
989 | temp |= (valid & 1) << 4; | |
990 | hwwrite(vortex->mmio, VORTEX_FIFO_WTCTRL + (fifo << 2), temp); | |
991 | return; | |
992 | } else { | |
993 | vortex_fifo_clearwtdata(vortex, fifo, FIFO_SIZE); | |
994 | return; | |
995 | } | |
996 | } else { | |
997 | temp &= 0xffffffef; | |
998 | temp |= 0x08000000; | |
999 | temp |= 0x10000000; | |
1000 | temp |= 0x04000000; | |
1001 | temp |= 0x00400000; | |
1002 | hwwrite(vortex->mmio, VORTEX_FIFO_WTCTRL + (fifo << 2), temp); | |
1003 | temp = hwread(vortex->mmio, VORTEX_FIFO_WTCTRL + (fifo << 2)); | |
1004 | //((temp >> 6) & 0x3f) | |
1005 | ||
1006 | priority = 0; | |
1007 | if (((temp & 0x0fc0) ^ ((temp >> 6) & 0x0fc0)) & 0FFFFFFC0) | |
1008 | vortex_fifo_clearwtdata(vortex, fifo, FIFO_SIZE); | |
1009 | valid = 0xfb; | |
1010 | temp = (temp & 0xfffffffd) | ((ctrl & 1) << 1); | |
1011 | temp = (temp & 0xfffdffff) | ((f & 1) << 0x11); | |
1012 | temp = (temp & 0xfffffff3) | ((priority & 3) << 2); | |
1013 | temp = (temp & 0xffffffef) | ((valid & 1) << 4); | |
1014 | temp = (temp & 0xffffffdf) | ((empty & 1) << 5); | |
1015 | hwwrite(vortex->mmio, VORTEX_FIFO_WTCTRL + (fifo << 2), temp); | |
1016 | } | |
1017 | ||
1018 | */ | |
1019 | ||
1020 | /* | |
1021 | temp = (temp & 0xfffffffd) | ((ctrl & 1) << 1); | |
1022 | temp = (temp & 0xfffdffff) | ((f & 1) << 0x11); | |
1023 | temp = (temp & 0xfffffff3) | ((priority & 3) << 2); | |
1024 | temp = (temp & 0xffffffef) | ((valid & 1) << 4); | |
1025 | temp = (temp & 0xffffffdf) | ((empty & 1) << 5); | |
1026 | #ifdef FIFO_BITS | |
1027 | temp = temp | FIFO_BITS | 40000; | |
1028 | #endif | |
1029 | // 0x1c440010, 0x1c400000 | |
1030 | hwwrite(vortex->mmio, VORTEX_FIFO_WTCTRL + (fifo << 2), temp); | |
1031 | */ | |
1032 | } | |
1033 | ||
1034 | #endif | |
1035 | static void vortex_fifo_init(vortex_t * vortex) | |
1036 | { | |
1037 | int x; | |
97c67b65 | 1038 | u32 addr; |
1da177e4 LT |
1039 | |
1040 | /* ADB DMA channels fifos. */ | |
1041 | addr = VORTEX_FIFO_ADBCTRL + ((NR_ADB - 1) * 4); | |
1042 | for (x = NR_ADB - 1; x >= 0; x--) { | |
1043 | hwwrite(vortex->mmio, addr, (FIFO_U0 | FIFO_U1)); | |
1044 | if (hwread(vortex->mmio, addr) != (FIFO_U0 | FIFO_U1)) | |
1045 | printk(KERN_ERR "bad adb fifo reset!"); | |
1046 | vortex_fifo_clearadbdata(vortex, x, FIFO_SIZE); | |
1047 | addr -= 4; | |
1048 | } | |
1049 | ||
1050 | #ifndef CHIP_AU8810 | |
1051 | /* WT DMA channels fifos. */ | |
1052 | addr = VORTEX_FIFO_WTCTRL + ((NR_WT - 1) * 4); | |
1053 | for (x = NR_WT - 1; x >= 0; x--) { | |
1054 | hwwrite(vortex->mmio, addr, FIFO_U0); | |
1055 | if (hwread(vortex->mmio, addr) != FIFO_U0) | |
1056 | printk(KERN_ERR | |
97c67b65 | 1057 | "bad wt fifo reset (0x%08x, 0x%08x)!\n", |
1da177e4 LT |
1058 | addr, hwread(vortex->mmio, addr)); |
1059 | vortex_fifo_clearwtdata(vortex, x, FIFO_SIZE); | |
1060 | addr -= 4; | |
1061 | } | |
1062 | #endif | |
1063 | /* trigger... */ | |
1064 | #ifdef CHIP_AU8820 | |
1065 | hwwrite(vortex->mmio, 0xf8c0, 0xd03); //0x0843 0xd6b | |
1066 | #else | |
1067 | #ifdef CHIP_AU8830 | |
1068 | hwwrite(vortex->mmio, 0x17000, 0x61); /* wt a */ | |
1069 | hwwrite(vortex->mmio, 0x17004, 0x61); /* wt b */ | |
1070 | #endif | |
1071 | hwwrite(vortex->mmio, 0x17008, 0x61); /* adb */ | |
1072 | #endif | |
1073 | } | |
1074 | ||
1075 | /* ADBDMA */ | |
1076 | ||
1077 | static void vortex_adbdma_init(vortex_t * vortex) | |
1078 | { | |
1079 | } | |
1080 | ||
1081 | static void vortex_adbdma_setfirstbuffer(vortex_t * vortex, int adbdma) | |
1082 | { | |
1083 | stream_t *dma = &vortex->dma_adb[adbdma]; | |
1084 | ||
1085 | hwwrite(vortex->mmio, VORTEX_ADBDMA_CTRL + (adbdma << 2), | |
1086 | dma->dma_ctrl); | |
1087 | } | |
1088 | ||
1089 | static void vortex_adbdma_setstartbuffer(vortex_t * vortex, int adbdma, int sb) | |
1090 | { | |
1091 | stream_t *dma = &vortex->dma_adb[adbdma]; | |
1092 | //hwwrite(vortex->mmio, VORTEX_ADBDMA_START + (adbdma << 2), sb << (((NR_ADB-1)-((adbdma&0xf)*2)))); | |
1093 | hwwrite(vortex->mmio, VORTEX_ADBDMA_START + (adbdma << 2), | |
1094 | sb << ((0xf - (adbdma & 0xf)) * 2)); | |
1095 | dma->period_real = dma->period_virt = sb; | |
1096 | } | |
1097 | ||
1098 | static void | |
1099 | vortex_adbdma_setbuffers(vortex_t * vortex, int adbdma, | |
77a23f26 | 1100 | int psize, int count) |
1da177e4 LT |
1101 | { |
1102 | stream_t *dma = &vortex->dma_adb[adbdma]; | |
1103 | ||
1da177e4 LT |
1104 | dma->period_bytes = psize; |
1105 | dma->nr_periods = count; | |
1da177e4 LT |
1106 | |
1107 | dma->cfg0 = 0; | |
1108 | dma->cfg1 = 0; | |
1109 | switch (count) { | |
1110 | /* Four or more pages */ | |
1111 | default: | |
1112 | case 4: | |
1113 | dma->cfg1 |= 0x88000000 | 0x44000000 | 0x30000000 | (psize - 1); | |
1114 | hwwrite(vortex->mmio, | |
1115 | VORTEX_ADBDMA_BUFBASE + (adbdma << 4) + 0xc, | |
77a23f26 | 1116 | snd_pcm_sgbuf_get_addr(dma->substream, psize * 3)); |
1da177e4 LT |
1117 | /* 3 pages */ |
1118 | case 3: | |
1119 | dma->cfg0 |= 0x12000000; | |
1120 | dma->cfg1 |= 0x80000000 | 0x40000000 | ((psize - 1) << 0xc); | |
1121 | hwwrite(vortex->mmio, | |
1122 | VORTEX_ADBDMA_BUFBASE + (adbdma << 4) + 0x8, | |
77a23f26 | 1123 | snd_pcm_sgbuf_get_addr(dma->substream, psize * 2)); |
1da177e4 LT |
1124 | /* 2 pages */ |
1125 | case 2: | |
1126 | dma->cfg0 |= 0x88000000 | 0x44000000 | 0x10000000 | (psize - 1); | |
1127 | hwwrite(vortex->mmio, | |
1128 | VORTEX_ADBDMA_BUFBASE + (adbdma << 4) + 0x4, | |
77a23f26 | 1129 | snd_pcm_sgbuf_get_addr(dma->substream, psize)); |
1da177e4 LT |
1130 | /* 1 page */ |
1131 | case 1: | |
1132 | dma->cfg0 |= 0x80000000 | 0x40000000 | ((psize - 1) << 0xc); | |
1133 | hwwrite(vortex->mmio, | |
1134 | VORTEX_ADBDMA_BUFBASE + (adbdma << 4), | |
77a23f26 | 1135 | snd_pcm_sgbuf_get_addr(dma->substream, 0)); |
1da177e4 LT |
1136 | break; |
1137 | } | |
ee419653 TI |
1138 | /* |
1139 | printk(KERN_DEBUG "vortex: cfg0 = 0x%x\nvortex: cfg1=0x%x\n", | |
1140 | dma->cfg0, dma->cfg1); | |
1141 | */ | |
1da177e4 LT |
1142 | hwwrite(vortex->mmio, VORTEX_ADBDMA_BUFCFG0 + (adbdma << 3), dma->cfg0); |
1143 | hwwrite(vortex->mmio, VORTEX_ADBDMA_BUFCFG1 + (adbdma << 3), dma->cfg1); | |
1144 | ||
1145 | vortex_adbdma_setfirstbuffer(vortex, adbdma); | |
1146 | vortex_adbdma_setstartbuffer(vortex, adbdma, 0); | |
1147 | } | |
1148 | ||
1149 | static void | |
1150 | vortex_adbdma_setmode(vortex_t * vortex, int adbdma, int ie, int dir, | |
3ae4e1f7 | 1151 | int fmt, int stereo, u32 offset) |
1da177e4 LT |
1152 | { |
1153 | stream_t *dma = &vortex->dma_adb[adbdma]; | |
1154 | ||
3ae4e1f7 | 1155 | dma->dma_unknown = stereo; |
1da177e4 LT |
1156 | dma->dma_ctrl = |
1157 | ((offset & OFFSET_MASK) | (dma->dma_ctrl & ~OFFSET_MASK)); | |
1158 | /* Enable PCMOUT interrupts. */ | |
1159 | dma->dma_ctrl = | |
1160 | (dma->dma_ctrl & ~IE_MASK) | ((ie << IE_SHIFT) & IE_MASK); | |
1161 | ||
1162 | dma->dma_ctrl = | |
1163 | (dma->dma_ctrl & ~DIR_MASK) | ((dir << DIR_SHIFT) & DIR_MASK); | |
1164 | dma->dma_ctrl = | |
1165 | (dma->dma_ctrl & ~FMT_MASK) | ((fmt << FMT_SHIFT) & FMT_MASK); | |
1166 | ||
1167 | hwwrite(vortex->mmio, VORTEX_ADBDMA_CTRL + (adbdma << 2), | |
1168 | dma->dma_ctrl); | |
1169 | hwread(vortex->mmio, VORTEX_ADBDMA_CTRL + (adbdma << 2)); | |
1170 | } | |
1171 | ||
1172 | static int vortex_adbdma_bufshift(vortex_t * vortex, int adbdma) | |
1173 | { | |
1174 | stream_t *dma = &vortex->dma_adb[adbdma]; | |
1175 | int page, p, pp, delta, i; | |
1176 | ||
1177 | page = | |
1178 | (hwread(vortex->mmio, VORTEX_ADBDMA_STAT + (adbdma << 2)) & | |
1179 | ADB_SUBBUF_MASK) >> ADB_SUBBUF_SHIFT; | |
1180 | if (dma->nr_periods >= 4) | |
1181 | delta = (page - dma->period_real) & 3; | |
1182 | else { | |
1183 | delta = (page - dma->period_real); | |
1184 | if (delta < 0) | |
1185 | delta += dma->nr_periods; | |
1186 | } | |
1187 | if (delta == 0) | |
1188 | return 0; | |
1189 | ||
1190 | /* refresh hw page table */ | |
1191 | if (dma->nr_periods > 4) { | |
1192 | for (i = 0; i < delta; i++) { | |
1193 | /* p: audio buffer page index */ | |
1194 | p = dma->period_virt + i + 4; | |
1195 | if (p >= dma->nr_periods) | |
1196 | p -= dma->nr_periods; | |
1197 | /* pp: hardware DMA page index. */ | |
1198 | pp = dma->period_real + i; | |
1199 | if (pp >= 4) | |
1200 | pp -= 4; | |
1201 | //hwwrite(vortex->mmio, VORTEX_ADBDMA_BUFBASE+(((adbdma << 2)+pp) << 2), dma->table[p].addr); | |
1202 | hwwrite(vortex->mmio, | |
1203 | VORTEX_ADBDMA_BUFBASE + (((adbdma << 2) + pp) << 2), | |
77a23f26 | 1204 | snd_pcm_sgbuf_get_addr(dma->substream, |
1da177e4 LT |
1205 | dma->period_bytes * p)); |
1206 | /* Force write thru cache. */ | |
1207 | hwread(vortex->mmio, VORTEX_ADBDMA_BUFBASE + | |
1208 | (((adbdma << 2) + pp) << 2)); | |
1209 | } | |
1210 | } | |
1211 | dma->period_virt += delta; | |
1212 | dma->period_real = page; | |
1213 | if (dma->period_virt >= dma->nr_periods) | |
1214 | dma->period_virt -= dma->nr_periods; | |
1215 | if (delta != 1) | |
1216 | printk(KERN_INFO "vortex: %d virt=%d, real=%d, delta=%d\n", | |
1217 | adbdma, dma->period_virt, dma->period_real, delta); | |
1218 | ||
1219 | return delta; | |
1220 | } | |
1221 | ||
1222 | ||
1223 | static void vortex_adbdma_resetup(vortex_t *vortex, int adbdma) { | |
1224 | stream_t *dma = &vortex->dma_adb[adbdma]; | |
1225 | int p, pp, i; | |
1226 | ||
1227 | /* refresh hw page table */ | |
1228 | for (i=0 ; i < 4 && i < dma->nr_periods; i++) { | |
1229 | /* p: audio buffer page index */ | |
1230 | p = dma->period_virt + i; | |
1231 | if (p >= dma->nr_periods) | |
1232 | p -= dma->nr_periods; | |
1233 | /* pp: hardware DMA page index. */ | |
1234 | pp = dma->period_real + i; | |
1235 | if (dma->nr_periods < 4) { | |
1236 | if (pp >= dma->nr_periods) | |
1237 | pp -= dma->nr_periods; | |
1238 | } | |
1239 | else { | |
1240 | if (pp >= 4) | |
1241 | pp -= 4; | |
1242 | } | |
77a23f26 TI |
1243 | hwwrite(vortex->mmio, |
1244 | VORTEX_ADBDMA_BUFBASE + (((adbdma << 2) + pp) << 2), | |
1245 | snd_pcm_sgbuf_get_addr(dma->substream, | |
1246 | dma->period_bytes * p)); | |
1da177e4 LT |
1247 | /* Force write thru cache. */ |
1248 | hwread(vortex->mmio, VORTEX_ADBDMA_BUFBASE + (((adbdma << 2)+pp) << 2)); | |
1249 | } | |
1250 | } | |
1251 | ||
42b16b3f | 1252 | static inline int vortex_adbdma_getlinearpos(vortex_t * vortex, int adbdma) |
1da177e4 LT |
1253 | { |
1254 | stream_t *dma = &vortex->dma_adb[adbdma]; | |
5e5677f2 | 1255 | int temp, page, delta; |
1da177e4 LT |
1256 | |
1257 | temp = hwread(vortex->mmio, VORTEX_ADBDMA_STAT + (adbdma << 2)); | |
5e5677f2 RY |
1258 | page = (temp & ADB_SUBBUF_MASK) >> ADB_SUBBUF_SHIFT; |
1259 | if (dma->nr_periods >= 4) | |
1260 | delta = (page - dma->period_real) & 3; | |
1261 | else { | |
1262 | delta = (page - dma->period_real); | |
1263 | if (delta < 0) | |
1264 | delta += dma->nr_periods; | |
1265 | } | |
1266 | return (dma->period_virt + delta) * dma->period_bytes | |
1267 | + (temp & (dma->period_bytes - 1)); | |
1da177e4 LT |
1268 | } |
1269 | ||
1270 | static void vortex_adbdma_startfifo(vortex_t * vortex, int adbdma) | |
1271 | { | |
1272 | int this_8 = 0 /*empty */ , this_4 = 0 /*priority */ ; | |
1273 | stream_t *dma = &vortex->dma_adb[adbdma]; | |
1274 | ||
1275 | switch (dma->fifo_status) { | |
1276 | case FIFO_START: | |
1277 | vortex_fifo_setadbvalid(vortex, adbdma, | |
1278 | dma->fifo_enabled ? 1 : 0); | |
1279 | break; | |
1280 | case FIFO_STOP: | |
1281 | this_8 = 1; | |
1282 | hwwrite(vortex->mmio, VORTEX_ADBDMA_CTRL + (adbdma << 2), | |
1283 | dma->dma_ctrl); | |
1284 | vortex_fifo_setadbctrl(vortex, adbdma, dma->dma_unknown, | |
1285 | this_4, this_8, | |
1286 | dma->fifo_enabled ? 1 : 0, 0); | |
1287 | break; | |
1288 | case FIFO_PAUSE: | |
1289 | vortex_fifo_setadbctrl(vortex, adbdma, dma->dma_unknown, | |
1290 | this_4, this_8, | |
1291 | dma->fifo_enabled ? 1 : 0, 0); | |
1292 | break; | |
1293 | } | |
1294 | dma->fifo_status = FIFO_START; | |
1295 | } | |
1296 | ||
1297 | static void vortex_adbdma_resumefifo(vortex_t * vortex, int adbdma) | |
1298 | { | |
1299 | stream_t *dma = &vortex->dma_adb[adbdma]; | |
1300 | ||
1301 | int this_8 = 1, this_4 = 0; | |
1302 | switch (dma->fifo_status) { | |
1303 | case FIFO_STOP: | |
1304 | hwwrite(vortex->mmio, VORTEX_ADBDMA_CTRL + (adbdma << 2), | |
1305 | dma->dma_ctrl); | |
1306 | vortex_fifo_setadbctrl(vortex, adbdma, dma->dma_unknown, | |
1307 | this_4, this_8, | |
1308 | dma->fifo_enabled ? 1 : 0, 0); | |
1309 | break; | |
1310 | case FIFO_PAUSE: | |
1311 | vortex_fifo_setadbctrl(vortex, adbdma, dma->dma_unknown, | |
1312 | this_4, this_8, | |
1313 | dma->fifo_enabled ? 1 : 0, 0); | |
1314 | break; | |
1315 | } | |
1316 | dma->fifo_status = FIFO_START; | |
1317 | } | |
1318 | ||
1319 | static void vortex_adbdma_pausefifo(vortex_t * vortex, int adbdma) | |
1320 | { | |
1321 | stream_t *dma = &vortex->dma_adb[adbdma]; | |
1322 | ||
1323 | int this_8 = 0, this_4 = 0; | |
1324 | switch (dma->fifo_status) { | |
1325 | case FIFO_START: | |
1326 | vortex_fifo_setadbctrl(vortex, adbdma, dma->dma_unknown, | |
1327 | this_4, this_8, 0, 0); | |
1328 | break; | |
1329 | case FIFO_STOP: | |
1330 | hwwrite(vortex->mmio, VORTEX_ADBDMA_CTRL + (adbdma << 2), | |
1331 | dma->dma_ctrl); | |
1332 | vortex_fifo_setadbctrl(vortex, adbdma, dma->dma_unknown, | |
1333 | this_4, this_8, 0, 0); | |
1334 | break; | |
1335 | } | |
1336 | dma->fifo_status = FIFO_PAUSE; | |
1337 | } | |
1338 | ||
1da177e4 LT |
1339 | static void vortex_adbdma_stopfifo(vortex_t * vortex, int adbdma) |
1340 | { | |
1341 | stream_t *dma = &vortex->dma_adb[adbdma]; | |
1342 | ||
1343 | int this_4 = 0, this_8 = 0; | |
1344 | if (dma->fifo_status == FIFO_START) | |
1345 | vortex_fifo_setadbctrl(vortex, adbdma, dma->dma_unknown, | |
1346 | this_4, this_8, 0, 0); | |
1347 | else if (dma->fifo_status == FIFO_STOP) | |
1348 | return; | |
1349 | dma->fifo_status = FIFO_STOP; | |
1350 | dma->fifo_enabled = 0; | |
1351 | } | |
1352 | ||
1da177e4 LT |
1353 | /* WTDMA */ |
1354 | ||
1355 | #ifndef CHIP_AU8810 | |
1356 | static void vortex_wtdma_setfirstbuffer(vortex_t * vortex, int wtdma) | |
1357 | { | |
1358 | //int this_7c=dma_ctrl; | |
1359 | stream_t *dma = &vortex->dma_wt[wtdma]; | |
1360 | ||
1361 | hwwrite(vortex->mmio, VORTEX_WTDMA_CTRL + (wtdma << 2), dma->dma_ctrl); | |
1362 | } | |
1363 | ||
1364 | static void vortex_wtdma_setstartbuffer(vortex_t * vortex, int wtdma, int sb) | |
1365 | { | |
1366 | stream_t *dma = &vortex->dma_wt[wtdma]; | |
1367 | //hwwrite(vortex->mmio, VORTEX_WTDMA_START + (wtdma << 2), sb << ((0x1f-(wtdma&0xf)*2))); | |
1368 | hwwrite(vortex->mmio, VORTEX_WTDMA_START + (wtdma << 2), | |
1369 | sb << ((0xf - (wtdma & 0xf)) * 2)); | |
1370 | dma->period_real = dma->period_virt = sb; | |
1371 | } | |
1372 | ||
1373 | static void | |
1374 | vortex_wtdma_setbuffers(vortex_t * vortex, int wtdma, | |
77a23f26 | 1375 | int psize, int count) |
1da177e4 LT |
1376 | { |
1377 | stream_t *dma = &vortex->dma_wt[wtdma]; | |
1378 | ||
1379 | dma->period_bytes = psize; | |
1380 | dma->nr_periods = count; | |
1da177e4 LT |
1381 | |
1382 | dma->cfg0 = 0; | |
1383 | dma->cfg1 = 0; | |
1384 | switch (count) { | |
1385 | /* Four or more pages */ | |
1386 | default: | |
1387 | case 4: | |
1388 | dma->cfg1 |= 0x88000000 | 0x44000000 | 0x30000000 | (psize-1); | |
1389 | hwwrite(vortex->mmio, VORTEX_WTDMA_BUFBASE + (wtdma << 4) + 0xc, | |
77a23f26 | 1390 | snd_pcm_sgbuf_get_addr(dma->substream, psize * 3)); |
1da177e4 LT |
1391 | /* 3 pages */ |
1392 | case 3: | |
1393 | dma->cfg0 |= 0x12000000; | |
1394 | dma->cfg1 |= 0x80000000 | 0x40000000 | ((psize-1) << 0xc); | |
1395 | hwwrite(vortex->mmio, VORTEX_WTDMA_BUFBASE + (wtdma << 4) + 0x8, | |
77a23f26 | 1396 | snd_pcm_sgbuf_get_addr(dma->substream, psize * 2)); |
1da177e4 LT |
1397 | /* 2 pages */ |
1398 | case 2: | |
1399 | dma->cfg0 |= 0x88000000 | 0x44000000 | 0x10000000 | (psize-1); | |
1400 | hwwrite(vortex->mmio, VORTEX_WTDMA_BUFBASE + (wtdma << 4) + 0x4, | |
77a23f26 | 1401 | snd_pcm_sgbuf_get_addr(dma->substream, psize)); |
1da177e4 LT |
1402 | /* 1 page */ |
1403 | case 1: | |
1404 | dma->cfg0 |= 0x80000000 | 0x40000000 | ((psize-1) << 0xc); | |
1405 | hwwrite(vortex->mmio, VORTEX_WTDMA_BUFBASE + (wtdma << 4), | |
77a23f26 | 1406 | snd_pcm_sgbuf_get_addr(dma->substream, 0)); |
1da177e4 LT |
1407 | break; |
1408 | } | |
1409 | hwwrite(vortex->mmio, VORTEX_WTDMA_BUFCFG0 + (wtdma << 3), dma->cfg0); | |
1410 | hwwrite(vortex->mmio, VORTEX_WTDMA_BUFCFG1 + (wtdma << 3), dma->cfg1); | |
1411 | ||
1412 | vortex_wtdma_setfirstbuffer(vortex, wtdma); | |
1413 | vortex_wtdma_setstartbuffer(vortex, wtdma, 0); | |
1414 | } | |
1415 | ||
1416 | static void | |
1417 | vortex_wtdma_setmode(vortex_t * vortex, int wtdma, int ie, int fmt, int d, | |
97c67b65 | 1418 | /*int e, */ u32 offset) |
1da177e4 LT |
1419 | { |
1420 | stream_t *dma = &vortex->dma_wt[wtdma]; | |
1421 | ||
1422 | //dma->this_08 = e; | |
1423 | dma->dma_unknown = d; | |
1424 | dma->dma_ctrl = 0; | |
1425 | dma->dma_ctrl = | |
1426 | ((offset & OFFSET_MASK) | (dma->dma_ctrl & ~OFFSET_MASK)); | |
1427 | /* PCMOUT interrupt */ | |
1428 | dma->dma_ctrl = | |
1429 | (dma->dma_ctrl & ~IE_MASK) | ((ie << IE_SHIFT) & IE_MASK); | |
1430 | /* Always playback. */ | |
1431 | dma->dma_ctrl |= (1 << DIR_SHIFT); | |
1432 | /* Audio Format */ | |
1433 | dma->dma_ctrl = | |
1434 | (dma->dma_ctrl & FMT_MASK) | ((fmt << FMT_SHIFT) & FMT_MASK); | |
1435 | /* Write into hardware */ | |
1436 | hwwrite(vortex->mmio, VORTEX_WTDMA_CTRL + (wtdma << 2), dma->dma_ctrl); | |
1437 | } | |
1438 | ||
1439 | static int vortex_wtdma_bufshift(vortex_t * vortex, int wtdma) | |
1440 | { | |
1441 | stream_t *dma = &vortex->dma_wt[wtdma]; | |
1442 | int page, p, pp, delta, i; | |
1443 | ||
1444 | page = | |
b753d79c TI |
1445 | (hwread(vortex->mmio, VORTEX_WTDMA_STAT + (wtdma << 2)) |
1446 | >> WT_SUBBUF_SHIFT) & WT_SUBBUF_MASK; | |
1da177e4 LT |
1447 | if (dma->nr_periods >= 4) |
1448 | delta = (page - dma->period_real) & 3; | |
1449 | else { | |
1450 | delta = (page - dma->period_real); | |
1451 | if (delta < 0) | |
1452 | delta += dma->nr_periods; | |
1453 | } | |
1454 | if (delta == 0) | |
1455 | return 0; | |
1456 | ||
1457 | /* refresh hw page table */ | |
1458 | if (dma->nr_periods > 4) { | |
1459 | for (i = 0; i < delta; i++) { | |
1460 | /* p: audio buffer page index */ | |
1461 | p = dma->period_virt + i + 4; | |
1462 | if (p >= dma->nr_periods) | |
1463 | p -= dma->nr_periods; | |
1464 | /* pp: hardware DMA page index. */ | |
1465 | pp = dma->period_real + i; | |
1466 | if (pp >= 4) | |
1467 | pp -= 4; | |
1468 | hwwrite(vortex->mmio, | |
1469 | VORTEX_WTDMA_BUFBASE + | |
1470 | (((wtdma << 2) + pp) << 2), | |
77a23f26 TI |
1471 | snd_pcm_sgbuf_get_addr(dma->substream, |
1472 | dma->period_bytes * p)); | |
1da177e4 LT |
1473 | /* Force write thru cache. */ |
1474 | hwread(vortex->mmio, VORTEX_WTDMA_BUFBASE + | |
1475 | (((wtdma << 2) + pp) << 2)); | |
1476 | } | |
1477 | } | |
1478 | dma->period_virt += delta; | |
1479 | if (dma->period_virt >= dma->nr_periods) | |
1480 | dma->period_virt -= dma->nr_periods; | |
1481 | dma->period_real = page; | |
1482 | ||
1483 | if (delta != 1) | |
1484 | printk(KERN_WARNING "vortex: wt virt = %d, delta = %d\n", | |
1485 | dma->period_virt, delta); | |
1486 | ||
1487 | return delta; | |
1488 | } | |
1489 | ||
1490 | #if 0 | |
1491 | static void | |
1492 | vortex_wtdma_getposition(vortex_t * vortex, int wtdma, int *subbuf, int *pos) | |
1493 | { | |
1494 | int temp; | |
1495 | temp = hwread(vortex->mmio, VORTEX_WTDMA_STAT + (wtdma << 2)); | |
1496 | *subbuf = (temp >> WT_SUBBUF_SHIFT) & WT_SUBBUF_MASK; | |
1497 | *pos = temp & POS_MASK; | |
1498 | } | |
1499 | ||
1500 | static int vortex_wtdma_getcursubuffer(vortex_t * vortex, int wtdma) | |
1501 | { | |
1502 | return ((hwread(vortex->mmio, VORTEX_WTDMA_STAT + (wtdma << 2)) >> | |
1503 | POS_SHIFT) & POS_MASK); | |
1504 | } | |
1505 | #endif | |
42b16b3f | 1506 | static inline int vortex_wtdma_getlinearpos(vortex_t * vortex, int wtdma) |
1da177e4 LT |
1507 | { |
1508 | stream_t *dma = &vortex->dma_wt[wtdma]; | |
1509 | int temp; | |
1510 | ||
1511 | temp = hwread(vortex->mmio, VORTEX_WTDMA_STAT + (wtdma << 2)); | |
3fd43858 | 1512 | temp = (dma->period_virt * dma->period_bytes) + (temp & (dma->period_bytes - 1)); |
1da177e4 LT |
1513 | return temp; |
1514 | } | |
1515 | ||
1516 | static void vortex_wtdma_startfifo(vortex_t * vortex, int wtdma) | |
1517 | { | |
1518 | stream_t *dma = &vortex->dma_wt[wtdma]; | |
1519 | int this_8 = 0, this_4 = 0; | |
1520 | ||
1521 | switch (dma->fifo_status) { | |
1522 | case FIFO_START: | |
1523 | vortex_fifo_setwtvalid(vortex, wtdma, | |
1524 | dma->fifo_enabled ? 1 : 0); | |
1525 | break; | |
1526 | case FIFO_STOP: | |
1527 | this_8 = 1; | |
1528 | hwwrite(vortex->mmio, VORTEX_WTDMA_CTRL + (wtdma << 2), | |
1529 | dma->dma_ctrl); | |
1530 | vortex_fifo_setwtctrl(vortex, wtdma, dma->dma_unknown, | |
1531 | this_4, this_8, | |
1532 | dma->fifo_enabled ? 1 : 0, 0); | |
1533 | break; | |
1534 | case FIFO_PAUSE: | |
1535 | vortex_fifo_setwtctrl(vortex, wtdma, dma->dma_unknown, | |
1536 | this_4, this_8, | |
1537 | dma->fifo_enabled ? 1 : 0, 0); | |
1538 | break; | |
1539 | } | |
1540 | dma->fifo_status = FIFO_START; | |
1541 | } | |
1542 | ||
1543 | static void vortex_wtdma_resumefifo(vortex_t * vortex, int wtdma) | |
1544 | { | |
1545 | stream_t *dma = &vortex->dma_wt[wtdma]; | |
1546 | ||
1547 | int this_8 = 0, this_4 = 0; | |
1548 | switch (dma->fifo_status) { | |
1549 | case FIFO_STOP: | |
1550 | hwwrite(vortex->mmio, VORTEX_WTDMA_CTRL + (wtdma << 2), | |
1551 | dma->dma_ctrl); | |
1552 | vortex_fifo_setwtctrl(vortex, wtdma, dma->dma_unknown, | |
1553 | this_4, this_8, | |
1554 | dma->fifo_enabled ? 1 : 0, 0); | |
1555 | break; | |
1556 | case FIFO_PAUSE: | |
1557 | vortex_fifo_setwtctrl(vortex, wtdma, dma->dma_unknown, | |
1558 | this_4, this_8, | |
1559 | dma->fifo_enabled ? 1 : 0, 0); | |
1560 | break; | |
1561 | } | |
1562 | dma->fifo_status = FIFO_START; | |
1563 | } | |
1564 | ||
1565 | static void vortex_wtdma_pausefifo(vortex_t * vortex, int wtdma) | |
1566 | { | |
1567 | stream_t *dma = &vortex->dma_wt[wtdma]; | |
1568 | ||
1569 | int this_8 = 0, this_4 = 0; | |
1570 | switch (dma->fifo_status) { | |
1571 | case FIFO_START: | |
1572 | vortex_fifo_setwtctrl(vortex, wtdma, dma->dma_unknown, | |
1573 | this_4, this_8, 0, 0); | |
1574 | break; | |
1575 | case FIFO_STOP: | |
1576 | hwwrite(vortex->mmio, VORTEX_WTDMA_CTRL + (wtdma << 2), | |
1577 | dma->dma_ctrl); | |
1578 | vortex_fifo_setwtctrl(vortex, wtdma, dma->dma_unknown, | |
1579 | this_4, this_8, 0, 0); | |
1580 | break; | |
1581 | } | |
1582 | dma->fifo_status = FIFO_PAUSE; | |
1583 | } | |
1584 | ||
1585 | static void vortex_wtdma_stopfifo(vortex_t * vortex, int wtdma) | |
1586 | { | |
1587 | stream_t *dma = &vortex->dma_wt[wtdma]; | |
1588 | ||
1589 | int this_4 = 0, this_8 = 0; | |
1590 | if (dma->fifo_status == FIFO_START) | |
1591 | vortex_fifo_setwtctrl(vortex, wtdma, dma->dma_unknown, | |
1592 | this_4, this_8, 0, 0); | |
1593 | else if (dma->fifo_status == FIFO_STOP) | |
1594 | return; | |
1595 | dma->fifo_status = FIFO_STOP; | |
1596 | dma->fifo_enabled = 0; | |
1597 | } | |
1598 | ||
1599 | #endif | |
1600 | /* ADB Routes */ | |
1601 | ||
1602 | typedef int ADBRamLink; | |
1603 | static void vortex_adb_init(vortex_t * vortex) | |
1604 | { | |
1605 | int i; | |
1606 | /* it looks like we are writing more than we need to... | |
1607 | * if we write what we are supposed to it breaks things... */ | |
1608 | hwwrite(vortex->mmio, VORTEX_ADB_SR, 0); | |
1609 | for (i = 0; i < VORTEX_ADB_RTBASE_COUNT; i++) | |
1610 | hwwrite(vortex->mmio, VORTEX_ADB_RTBASE + (i << 2), | |
1611 | hwread(vortex->mmio, | |
1612 | VORTEX_ADB_RTBASE + (i << 2)) | ROUTE_MASK); | |
1613 | for (i = 0; i < VORTEX_ADB_CHNBASE_COUNT; i++) { | |
1614 | hwwrite(vortex->mmio, VORTEX_ADB_CHNBASE + (i << 2), | |
1615 | hwread(vortex->mmio, | |
1616 | VORTEX_ADB_CHNBASE + (i << 2)) | ROUTE_MASK); | |
1617 | } | |
1618 | } | |
1619 | ||
1620 | static void vortex_adb_en_sr(vortex_t * vortex, int channel) | |
1621 | { | |
1622 | hwwrite(vortex->mmio, VORTEX_ADB_SR, | |
1623 | hwread(vortex->mmio, VORTEX_ADB_SR) | (0x1 << channel)); | |
1624 | } | |
1625 | ||
1626 | static void vortex_adb_dis_sr(vortex_t * vortex, int channel) | |
1627 | { | |
1628 | hwwrite(vortex->mmio, VORTEX_ADB_SR, | |
1629 | hwread(vortex->mmio, VORTEX_ADB_SR) & ~(0x1 << channel)); | |
1630 | } | |
1631 | ||
1632 | static void | |
1633 | vortex_adb_addroutes(vortex_t * vortex, unsigned char channel, | |
1634 | ADBRamLink * route, int rnum) | |
1635 | { | |
1636 | int temp, prev, lifeboat = 0; | |
1637 | ||
1638 | if ((rnum <= 0) || (route == NULL)) | |
1639 | return; | |
1640 | /* Write last routes. */ | |
1641 | rnum--; | |
1642 | hwwrite(vortex->mmio, | |
1643 | VORTEX_ADB_RTBASE + ((route[rnum] & ADB_MASK) << 2), | |
1644 | ROUTE_MASK); | |
1645 | while (rnum > 0) { | |
1646 | hwwrite(vortex->mmio, | |
1647 | VORTEX_ADB_RTBASE + | |
1648 | ((route[rnum - 1] & ADB_MASK) << 2), route[rnum]); | |
1649 | rnum--; | |
1650 | } | |
1651 | /* Write first route. */ | |
1652 | temp = | |
1653 | hwread(vortex->mmio, | |
1654 | VORTEX_ADB_CHNBASE + (channel << 2)) & ADB_MASK; | |
1655 | if (temp == ADB_MASK) { | |
1656 | /* First entry on this channel. */ | |
1657 | hwwrite(vortex->mmio, VORTEX_ADB_CHNBASE + (channel << 2), | |
1658 | route[0]); | |
1659 | vortex_adb_en_sr(vortex, channel); | |
1660 | return; | |
1661 | } | |
1662 | /* Not first entry on this channel. Need to link. */ | |
1663 | do { | |
1664 | prev = temp; | |
1665 | temp = | |
1666 | hwread(vortex->mmio, | |
1667 | VORTEX_ADB_RTBASE + (temp << 2)) & ADB_MASK; | |
1668 | if ((lifeboat++) > ADB_MASK) { | |
1669 | printk(KERN_ERR | |
1670 | "vortex_adb_addroutes: unending route! 0x%x\n", | |
1671 | *route); | |
1672 | return; | |
1673 | } | |
1674 | } | |
1675 | while (temp != ADB_MASK); | |
1676 | hwwrite(vortex->mmio, VORTEX_ADB_RTBASE + (prev << 2), route[0]); | |
1677 | } | |
1678 | ||
1679 | static void | |
1680 | vortex_adb_delroutes(vortex_t * vortex, unsigned char channel, | |
1681 | ADBRamLink route0, ADBRamLink route1) | |
1682 | { | |
1683 | int temp, lifeboat = 0, prev; | |
1684 | ||
1685 | /* Find route. */ | |
1686 | temp = | |
1687 | hwread(vortex->mmio, | |
1688 | VORTEX_ADB_CHNBASE + (channel << 2)) & ADB_MASK; | |
1689 | if (temp == (route0 & ADB_MASK)) { | |
1690 | temp = | |
1691 | hwread(vortex->mmio, | |
1692 | VORTEX_ADB_RTBASE + ((route1 & ADB_MASK) << 2)); | |
1693 | if ((temp & ADB_MASK) == ADB_MASK) | |
1694 | vortex_adb_dis_sr(vortex, channel); | |
1695 | hwwrite(vortex->mmio, VORTEX_ADB_CHNBASE + (channel << 2), | |
1696 | temp); | |
1697 | return; | |
1698 | } | |
1699 | do { | |
1700 | prev = temp; | |
1701 | temp = | |
1702 | hwread(vortex->mmio, | |
1703 | VORTEX_ADB_RTBASE + (prev << 2)) & ADB_MASK; | |
1704 | if (((lifeboat++) > ADB_MASK) || (temp == ADB_MASK)) { | |
1705 | printk(KERN_ERR | |
1706 | "vortex_adb_delroutes: route not found! 0x%x\n", | |
1707 | route0); | |
1708 | return; | |
1709 | } | |
1710 | } | |
1711 | while (temp != (route0 & ADB_MASK)); | |
1712 | temp = hwread(vortex->mmio, VORTEX_ADB_RTBASE + (temp << 2)); | |
1713 | if ((temp & ADB_MASK) == route1) | |
1714 | temp = hwread(vortex->mmio, VORTEX_ADB_RTBASE + (temp << 2)); | |
1715 | /* Make bridge over deleted route. */ | |
1716 | hwwrite(vortex->mmio, VORTEX_ADB_RTBASE + (prev << 2), temp); | |
1717 | } | |
1718 | ||
1719 | static void | |
1720 | vortex_route(vortex_t * vortex, int en, unsigned char channel, | |
1721 | unsigned char source, unsigned char dest) | |
1722 | { | |
1723 | ADBRamLink route; | |
1724 | ||
1725 | route = ((source & ADB_MASK) << ADB_SHIFT) | (dest & ADB_MASK); | |
1726 | if (en) { | |
1727 | vortex_adb_addroutes(vortex, channel, &route, 1); | |
1728 | if ((source < (OFFSET_SRCOUT + NR_SRC)) | |
1729 | && (source >= OFFSET_SRCOUT)) | |
1730 | vortex_src_addWTD(vortex, (source - OFFSET_SRCOUT), | |
1731 | channel); | |
1732 | else if ((source < (OFFSET_MIXOUT + NR_MIXOUT)) | |
1733 | && (source >= OFFSET_MIXOUT)) | |
1734 | vortex_mixer_addWTD(vortex, | |
1735 | (source - OFFSET_MIXOUT), channel); | |
1736 | } else { | |
1737 | vortex_adb_delroutes(vortex, channel, route, route); | |
1738 | if ((source < (OFFSET_SRCOUT + NR_SRC)) | |
1739 | && (source >= OFFSET_SRCOUT)) | |
1740 | vortex_src_delWTD(vortex, (source - OFFSET_SRCOUT), | |
1741 | channel); | |
1742 | else if ((source < (OFFSET_MIXOUT + NR_MIXOUT)) | |
1743 | && (source >= OFFSET_MIXOUT)) | |
1744 | vortex_mixer_delWTD(vortex, | |
1745 | (source - OFFSET_MIXOUT), channel); | |
1746 | } | |
1747 | } | |
1748 | ||
1749 | #if 0 | |
1750 | static void | |
1751 | vortex_routes(vortex_t * vortex, int en, unsigned char channel, | |
1752 | unsigned char source, unsigned char dest0, unsigned char dest1) | |
1753 | { | |
1754 | ADBRamLink route[2]; | |
1755 | ||
1756 | route[0] = ((source & ADB_MASK) << ADB_SHIFT) | (dest0 & ADB_MASK); | |
1757 | route[1] = ((source & ADB_MASK) << ADB_SHIFT) | (dest1 & ADB_MASK); | |
1758 | ||
1759 | if (en) { | |
1760 | vortex_adb_addroutes(vortex, channel, route, 2); | |
1761 | if ((source < (OFFSET_SRCOUT + NR_SRC)) | |
1762 | && (source >= (OFFSET_SRCOUT))) | |
1763 | vortex_src_addWTD(vortex, (source - OFFSET_SRCOUT), | |
1764 | channel); | |
1765 | else if ((source < (OFFSET_MIXOUT + NR_MIXOUT)) | |
1766 | && (source >= (OFFSET_MIXOUT))) | |
1767 | vortex_mixer_addWTD(vortex, | |
1768 | (source - OFFSET_MIXOUT), channel); | |
1769 | } else { | |
1770 | vortex_adb_delroutes(vortex, channel, route[0], route[1]); | |
1771 | if ((source < (OFFSET_SRCOUT + NR_SRC)) | |
1772 | && (source >= (OFFSET_SRCOUT))) | |
1773 | vortex_src_delWTD(vortex, (source - OFFSET_SRCOUT), | |
1774 | channel); | |
1775 | else if ((source < (OFFSET_MIXOUT + NR_MIXOUT)) | |
1776 | && (source >= (OFFSET_MIXOUT))) | |
1777 | vortex_mixer_delWTD(vortex, | |
1778 | (source - OFFSET_MIXOUT), channel); | |
1779 | } | |
1780 | } | |
1781 | ||
1782 | #endif | |
1783 | /* Route two sources to same target. Sources must be of same class !!! */ | |
1784 | static void | |
1785 | vortex_routeLRT(vortex_t * vortex, int en, unsigned char ch, | |
1786 | unsigned char source0, unsigned char source1, | |
1787 | unsigned char dest) | |
1788 | { | |
1789 | ADBRamLink route[2]; | |
1790 | ||
1791 | route[0] = ((source0 & ADB_MASK) << ADB_SHIFT) | (dest & ADB_MASK); | |
1792 | route[1] = ((source1 & ADB_MASK) << ADB_SHIFT) | (dest & ADB_MASK); | |
1793 | ||
1794 | if (dest < 0x10) | |
1795 | route[1] = (route[1] & ~ADB_MASK) | (dest + 0x20); /* fifo A */ | |
1796 | ||
1797 | if (en) { | |
1798 | vortex_adb_addroutes(vortex, ch, route, 2); | |
1799 | if ((source0 < (OFFSET_SRCOUT + NR_SRC)) | |
1800 | && (source0 >= OFFSET_SRCOUT)) { | |
1801 | vortex_src_addWTD(vortex, | |
1802 | (source0 - OFFSET_SRCOUT), ch); | |
1803 | vortex_src_addWTD(vortex, | |
1804 | (source1 - OFFSET_SRCOUT), ch); | |
1805 | } else if ((source0 < (OFFSET_MIXOUT + NR_MIXOUT)) | |
1806 | && (source0 >= OFFSET_MIXOUT)) { | |
1807 | vortex_mixer_addWTD(vortex, | |
1808 | (source0 - OFFSET_MIXOUT), ch); | |
1809 | vortex_mixer_addWTD(vortex, | |
1810 | (source1 - OFFSET_MIXOUT), ch); | |
1811 | } | |
1812 | } else { | |
1813 | vortex_adb_delroutes(vortex, ch, route[0], route[1]); | |
1814 | if ((source0 < (OFFSET_SRCOUT + NR_SRC)) | |
1815 | && (source0 >= OFFSET_SRCOUT)) { | |
1816 | vortex_src_delWTD(vortex, | |
1817 | (source0 - OFFSET_SRCOUT), ch); | |
1818 | vortex_src_delWTD(vortex, | |
1819 | (source1 - OFFSET_SRCOUT), ch); | |
1820 | } else if ((source0 < (OFFSET_MIXOUT + NR_MIXOUT)) | |
1821 | && (source0 >= OFFSET_MIXOUT)) { | |
1822 | vortex_mixer_delWTD(vortex, | |
1823 | (source0 - OFFSET_MIXOUT), ch); | |
1824 | vortex_mixer_delWTD(vortex, | |
1825 | (source1 - OFFSET_MIXOUT), ch); | |
1826 | } | |
1827 | } | |
1828 | } | |
1829 | ||
1830 | /* Connection stuff */ | |
1831 | ||
1832 | // Connect adbdma to src('s). | |
1833 | static void | |
1834 | vortex_connection_adbdma_src(vortex_t * vortex, int en, unsigned char ch, | |
1835 | unsigned char adbdma, unsigned char src) | |
1836 | { | |
1837 | vortex_route(vortex, en, ch, ADB_DMA(adbdma), ADB_SRCIN(src)); | |
1838 | } | |
1839 | ||
1840 | // Connect SRC to mixin. | |
1841 | static void | |
1842 | vortex_connection_src_mixin(vortex_t * vortex, int en, | |
1843 | unsigned char channel, unsigned char src, | |
1844 | unsigned char mixin) | |
1845 | { | |
1846 | vortex_route(vortex, en, channel, ADB_SRCOUT(src), ADB_MIXIN(mixin)); | |
1847 | } | |
1848 | ||
1849 | // Connect mixin with mix output. | |
1850 | static void | |
1851 | vortex_connection_mixin_mix(vortex_t * vortex, int en, unsigned char mixin, | |
1852 | unsigned char mix, int a) | |
1853 | { | |
1854 | if (en) { | |
1855 | vortex_mix_enableinput(vortex, mix, mixin); | |
1856 | vortex_mix_setinputvolumebyte(vortex, mix, mixin, MIX_DEFIGAIN); // added to original code. | |
1857 | } else | |
1858 | vortex_mix_disableinput(vortex, mix, mixin, a); | |
1859 | } | |
1860 | ||
1861 | // Connect absolut address to mixin. | |
1862 | static void | |
1863 | vortex_connection_adb_mixin(vortex_t * vortex, int en, | |
1864 | unsigned char channel, unsigned char source, | |
1865 | unsigned char mixin) | |
1866 | { | |
1867 | vortex_route(vortex, en, channel, source, ADB_MIXIN(mixin)); | |
1868 | } | |
1869 | ||
1870 | static void | |
1871 | vortex_connection_src_adbdma(vortex_t * vortex, int en, unsigned char ch, | |
1872 | unsigned char src, unsigned char adbdma) | |
1873 | { | |
1874 | vortex_route(vortex, en, ch, ADB_SRCOUT(src), ADB_DMA(adbdma)); | |
1875 | } | |
1876 | ||
1877 | static void | |
1878 | vortex_connection_src_src_adbdma(vortex_t * vortex, int en, | |
1879 | unsigned char ch, unsigned char src0, | |
1880 | unsigned char src1, unsigned char adbdma) | |
1881 | { | |
1882 | ||
1883 | vortex_routeLRT(vortex, en, ch, ADB_SRCOUT(src0), ADB_SRCOUT(src1), | |
1884 | ADB_DMA(adbdma)); | |
1885 | } | |
1886 | ||
1887 | // mix to absolut address. | |
1888 | static void | |
1889 | vortex_connection_mix_adb(vortex_t * vortex, int en, unsigned char ch, | |
1890 | unsigned char mix, unsigned char dest) | |
1891 | { | |
1892 | vortex_route(vortex, en, ch, ADB_MIXOUT(mix), dest); | |
1893 | vortex_mix_setvolumebyte(vortex, mix, MIX_DEFOGAIN); // added to original code. | |
1894 | } | |
1895 | ||
1896 | // mixer to src. | |
1897 | static void | |
1898 | vortex_connection_mix_src(vortex_t * vortex, int en, unsigned char ch, | |
1899 | unsigned char mix, unsigned char src) | |
1900 | { | |
1901 | vortex_route(vortex, en, ch, ADB_MIXOUT(mix), ADB_SRCIN(src)); | |
1902 | vortex_mix_setvolumebyte(vortex, mix, MIX_DEFOGAIN); // added to original code. | |
1903 | } | |
1904 | ||
1905 | #if 0 | |
1906 | static void | |
1907 | vortex_connection_adbdma_src_src(vortex_t * vortex, int en, | |
1908 | unsigned char channel, | |
1909 | unsigned char adbdma, unsigned char src0, | |
1910 | unsigned char src1) | |
1911 | { | |
1912 | vortex_routes(vortex, en, channel, ADB_DMA(adbdma), | |
1913 | ADB_SRCIN(src0), ADB_SRCIN(src1)); | |
1914 | } | |
1915 | ||
1916 | // Connect two mix to AdbDma. | |
1917 | static void | |
1918 | vortex_connection_mix_mix_adbdma(vortex_t * vortex, int en, | |
1919 | unsigned char ch, unsigned char mix0, | |
1920 | unsigned char mix1, unsigned char adbdma) | |
1921 | { | |
1922 | ||
1923 | ADBRamLink routes[2]; | |
1924 | routes[0] = | |
1925 | (((mix0 + | |
1926 | OFFSET_MIXOUT) & ADB_MASK) << ADB_SHIFT) | (adbdma & ADB_MASK); | |
1927 | routes[1] = | |
1928 | (((mix1 + OFFSET_MIXOUT) & ADB_MASK) << ADB_SHIFT) | ((adbdma + | |
1929 | 0x20) & | |
1930 | ADB_MASK); | |
1931 | if (en) { | |
1932 | vortex_adb_addroutes(vortex, ch, routes, 0x2); | |
1933 | vortex_mixer_addWTD(vortex, mix0, ch); | |
1934 | vortex_mixer_addWTD(vortex, mix1, ch); | |
1935 | } else { | |
1936 | vortex_adb_delroutes(vortex, ch, routes[0], routes[1]); | |
1937 | vortex_mixer_delWTD(vortex, mix0, ch); | |
1938 | vortex_mixer_delWTD(vortex, mix1, ch); | |
1939 | } | |
1940 | } | |
1941 | #endif | |
1942 | ||
1943 | /* CODEC connect. */ | |
1944 | ||
1945 | static void | |
1946 | vortex_connect_codecplay(vortex_t * vortex, int en, unsigned char mixers[]) | |
1947 | { | |
1948 | #ifdef CHIP_AU8820 | |
1949 | vortex_connection_mix_adb(vortex, en, 0x11, mixers[0], ADB_CODECOUT(0)); | |
1950 | vortex_connection_mix_adb(vortex, en, 0x11, mixers[1], ADB_CODECOUT(1)); | |
1951 | #else | |
1952 | #if 1 | |
1953 | // Connect front channels through EQ. | |
1954 | vortex_connection_mix_adb(vortex, en, 0x11, mixers[0], ADB_EQIN(0)); | |
1955 | vortex_connection_mix_adb(vortex, en, 0x11, mixers[1], ADB_EQIN(1)); | |
1956 | /* Lower volume, since EQ has some gain. */ | |
1957 | vortex_mix_setvolumebyte(vortex, mixers[0], 0); | |
1958 | vortex_mix_setvolumebyte(vortex, mixers[1], 0); | |
1959 | vortex_route(vortex, en, 0x11, ADB_EQOUT(0), ADB_CODECOUT(0)); | |
1960 | vortex_route(vortex, en, 0x11, ADB_EQOUT(1), ADB_CODECOUT(1)); | |
1961 | ||
1962 | /* Check if reg 0x28 has SDAC bit set. */ | |
1963 | if (VORTEX_IS_QUAD(vortex)) { | |
1964 | /* Rear channel. Note: ADB_CODECOUT(0+2) and (1+2) is for AC97 modem */ | |
1965 | vortex_connection_mix_adb(vortex, en, 0x11, mixers[2], | |
1966 | ADB_CODECOUT(0 + 4)); | |
1967 | vortex_connection_mix_adb(vortex, en, 0x11, mixers[3], | |
1968 | ADB_CODECOUT(1 + 4)); | |
ee419653 | 1969 | /* printk(KERN_DEBUG "SDAC detected "); */ |
1da177e4 LT |
1970 | } |
1971 | #else | |
1972 | // Use plain direct output to codec. | |
1973 | vortex_connection_mix_adb(vortex, en, 0x11, mixers[0], ADB_CODECOUT(0)); | |
1974 | vortex_connection_mix_adb(vortex, en, 0x11, mixers[1], ADB_CODECOUT(1)); | |
1975 | #endif | |
1976 | #endif | |
1977 | } | |
1978 | ||
1979 | static void | |
1980 | vortex_connect_codecrec(vortex_t * vortex, int en, unsigned char mixin0, | |
1981 | unsigned char mixin1) | |
1982 | { | |
1983 | /* | |
1984 | Enable: 0x1, 0x1 | |
1985 | Channel: 0x11, 0x11 | |
1986 | ADB Source address: 0x48, 0x49 | |
1987 | Destination Asp4Topology_0x9c,0x98 | |
1988 | */ | |
1989 | vortex_connection_adb_mixin(vortex, en, 0x11, ADB_CODECIN(0), mixin0); | |
1990 | vortex_connection_adb_mixin(vortex, en, 0x11, ADB_CODECIN(1), mixin1); | |
1991 | } | |
1992 | ||
1993 | // Higher level ADB audio path (de)allocator. | |
1994 | ||
1995 | /* Resource manager */ | |
1996 | static int resnum[VORTEX_RESOURCE_LAST] = | |
1997 | { NR_ADB, NR_SRC, NR_MIXIN, NR_MIXOUT, NR_A3D }; | |
1998 | /* | |
1999 | Checkout/Checkin resource of given type. | |
2000 | resmap: resource map to be used. If NULL means that we want to allocate | |
2001 | a DMA resource (root of all other resources of a dma channel). | |
2002 | out: Mean checkout if != 0. Else mean Checkin resource. | |
2003 | restype: Indicates type of resource to be checked in or out. | |
2004 | */ | |
2005 | static char | |
2006 | vortex_adb_checkinout(vortex_t * vortex, int resmap[], int out, int restype) | |
2007 | { | |
2008 | int i, qty = resnum[restype], resinuse = 0; | |
2009 | ||
2010 | if (out) { | |
2011 | /* Gather used resources by all streams. */ | |
2012 | for (i = 0; i < NR_ADB; i++) { | |
2013 | resinuse |= vortex->dma_adb[i].resources[restype]; | |
2014 | } | |
2015 | resinuse |= vortex->fixed_res[restype]; | |
2016 | /* Find and take free resource. */ | |
2017 | for (i = 0; i < qty; i++) { | |
2018 | if ((resinuse & (1 << i)) == 0) { | |
2019 | if (resmap != NULL) | |
2020 | resmap[restype] |= (1 << i); | |
2021 | else | |
2022 | vortex->dma_adb[i].resources[restype] |= (1 << i); | |
ee419653 TI |
2023 | /* |
2024 | printk(KERN_DEBUG | |
2025 | "vortex: ResManager: type %d out %d\n", | |
2026 | restype, i); | |
2027 | */ | |
1da177e4 LT |
2028 | return i; |
2029 | } | |
2030 | } | |
2031 | } else { | |
2032 | if (resmap == NULL) | |
2033 | return -EINVAL; | |
2034 | /* Checkin first resource of type restype. */ | |
2035 | for (i = 0; i < qty; i++) { | |
2036 | if (resmap[restype] & (1 << i)) { | |
2037 | resmap[restype] &= ~(1 << i); | |
ee419653 TI |
2038 | /* |
2039 | printk(KERN_DEBUG | |
2040 | "vortex: ResManager: type %d in %d\n", | |
2041 | restype, i); | |
2042 | */ | |
1da177e4 LT |
2043 | return i; |
2044 | } | |
2045 | } | |
2046 | } | |
99b359ba | 2047 | printk(KERN_ERR "vortex: FATAL: ResManager: resource type %d exhausted.\n", restype); |
1da177e4 LT |
2048 | return -ENOMEM; |
2049 | } | |
2050 | ||
2051 | /* Default Connections */ | |
1da177e4 LT |
2052 | |
2053 | static void vortex_connect_default(vortex_t * vortex, int en) | |
2054 | { | |
2055 | // Connect AC97 codec. | |
2056 | vortex->mixplayb[0] = vortex_adb_checkinout(vortex, vortex->fixed_res, en, | |
2057 | VORTEX_RESOURCE_MIXOUT); | |
2058 | vortex->mixplayb[1] = vortex_adb_checkinout(vortex, vortex->fixed_res, en, | |
2059 | VORTEX_RESOURCE_MIXOUT); | |
2060 | if (VORTEX_IS_QUAD(vortex)) { | |
2061 | vortex->mixplayb[2] = vortex_adb_checkinout(vortex, vortex->fixed_res, en, | |
2062 | VORTEX_RESOURCE_MIXOUT); | |
2063 | vortex->mixplayb[3] = vortex_adb_checkinout(vortex, vortex->fixed_res, en, | |
2064 | VORTEX_RESOURCE_MIXOUT); | |
2065 | } | |
2066 | vortex_connect_codecplay(vortex, en, vortex->mixplayb); | |
2067 | ||
2068 | vortex->mixcapt[0] = vortex_adb_checkinout(vortex, vortex->fixed_res, en, | |
2069 | VORTEX_RESOURCE_MIXIN); | |
2070 | vortex->mixcapt[1] = vortex_adb_checkinout(vortex, vortex->fixed_res, en, | |
2071 | VORTEX_RESOURCE_MIXIN); | |
2072 | vortex_connect_codecrec(vortex, en, MIX_CAPT(0), MIX_CAPT(1)); | |
2073 | ||
2074 | // Connect SPDIF | |
2075 | #ifndef CHIP_AU8820 | |
2076 | vortex->mixspdif[0] = vortex_adb_checkinout(vortex, vortex->fixed_res, en, | |
2077 | VORTEX_RESOURCE_MIXOUT); | |
2078 | vortex->mixspdif[1] = vortex_adb_checkinout(vortex, vortex->fixed_res, en, | |
2079 | VORTEX_RESOURCE_MIXOUT); | |
2080 | vortex_connection_mix_adb(vortex, en, 0x14, vortex->mixspdif[0], | |
2081 | ADB_SPDIFOUT(0)); | |
2082 | vortex_connection_mix_adb(vortex, en, 0x14, vortex->mixspdif[1], | |
2083 | ADB_SPDIFOUT(1)); | |
2084 | #endif | |
2085 | // Connect WT | |
2086 | #ifndef CHIP_AU8810 | |
2087 | vortex_wt_connect(vortex, en); | |
2088 | #endif | |
2089 | // A3D (crosstalk canceler and A3D slices). AU8810 disabled for now. | |
2090 | #ifndef CHIP_AU8820 | |
2091 | vortex_Vort3D_connect(vortex, en); | |
2092 | #endif | |
2093 | // Connect I2S | |
2094 | ||
2095 | // Connect DSP interface for SQ3500 turbo (not here i think...) | |
2096 | ||
2097 | // Connect AC98 modem codec | |
2098 | ||
2099 | } | |
2100 | ||
2101 | /* | |
2102 | Allocate nr_ch pcm audio routes if dma < 0. If dma >= 0, existing routes | |
2103 | are deallocated. | |
2104 | dma: DMA engine routes to be deallocated when dma >= 0. | |
2105 | nr_ch: Number of channels to be de/allocated. | |
2106 | dir: direction of stream. Uses same values as substream->stream. | |
2107 | type: Type of audio output/source (codec, spdif, i2s, dsp, etc) | |
2108 | Return: Return allocated DMA or same DMA passed as "dma" when dma >= 0. | |
2109 | */ | |
2110 | static int | |
bb92b7c4 RY |
2111 | vortex_adb_allocroute(vortex_t *vortex, int dma, int nr_ch, int dir, |
2112 | int type, int subdev) | |
1da177e4 LT |
2113 | { |
2114 | stream_t *stream; | |
2115 | int i, en; | |
bb92b7c4 | 2116 | struct pcm_vol *p; |
1da177e4 | 2117 | |
1da177e4 LT |
2118 | if (dma >= 0) { |
2119 | en = 0; | |
2120 | vortex_adb_checkinout(vortex, | |
2121 | vortex->dma_adb[dma].resources, en, | |
2122 | VORTEX_RESOURCE_DMA); | |
2123 | } else { | |
2124 | en = 1; | |
2125 | if ((dma = | |
2126 | vortex_adb_checkinout(vortex, NULL, en, | |
2127 | VORTEX_RESOURCE_DMA)) < 0) | |
2128 | return -EBUSY; | |
2129 | } | |
2130 | ||
2131 | stream = &vortex->dma_adb[dma]; | |
2132 | stream->dma = dma; | |
2133 | stream->dir = dir; | |
2134 | stream->type = type; | |
2135 | ||
2136 | /* PLAYBACK ROUTES. */ | |
2137 | if (dir == SNDRV_PCM_STREAM_PLAYBACK) { | |
2138 | int src[4], mix[4], ch_top; | |
2139 | #ifndef CHIP_AU8820 | |
2140 | int a3d = 0; | |
2141 | #endif | |
2142 | /* Get SRC and MIXER hardware resources. */ | |
2143 | if (stream->type != VORTEX_PCM_SPDIF) { | |
2144 | for (i = 0; i < nr_ch; i++) { | |
2145 | if ((src[i] = vortex_adb_checkinout(vortex, | |
2146 | stream->resources, en, | |
2147 | VORTEX_RESOURCE_SRC)) < 0) { | |
2148 | memset(stream->resources, 0, | |
2149 | sizeof(unsigned char) * | |
2150 | VORTEX_RESOURCE_LAST); | |
2151 | return -EBUSY; | |
2152 | } | |
2153 | if (stream->type != VORTEX_PCM_A3D) { | |
2154 | if ((mix[i] = vortex_adb_checkinout(vortex, | |
2155 | stream->resources, | |
2156 | en, | |
2157 | VORTEX_RESOURCE_MIXIN)) < 0) { | |
2158 | memset(stream->resources, | |
2159 | 0, | |
2160 | sizeof(unsigned char) * VORTEX_RESOURCE_LAST); | |
2161 | return -EBUSY; | |
2162 | } | |
2163 | } | |
2164 | } | |
2165 | } | |
2166 | #ifndef CHIP_AU8820 | |
2167 | if (stream->type == VORTEX_PCM_A3D) { | |
2168 | if ((a3d = | |
2169 | vortex_adb_checkinout(vortex, | |
2170 | stream->resources, en, | |
2171 | VORTEX_RESOURCE_A3D)) < 0) { | |
2172 | memset(stream->resources, 0, | |
2173 | sizeof(unsigned char) * | |
2174 | VORTEX_RESOURCE_LAST); | |
99b359ba | 2175 | printk(KERN_ERR "vortex: out of A3D sources. Sorry\n"); |
1da177e4 LT |
2176 | return -EBUSY; |
2177 | } | |
2178 | /* (De)Initialize A3D hardware source. */ | |
2179 | vortex_Vort3D_InitializeSource(&(vortex->a3d[a3d]), en); | |
2180 | } | |
2181 | /* Make SPDIF out exclusive to "spdif" device when in use. */ | |
2182 | if ((stream->type == VORTEX_PCM_SPDIF) && (en)) { | |
2183 | vortex_route(vortex, 0, 0x14, | |
2184 | ADB_MIXOUT(vortex->mixspdif[0]), | |
2185 | ADB_SPDIFOUT(0)); | |
2186 | vortex_route(vortex, 0, 0x14, | |
2187 | ADB_MIXOUT(vortex->mixspdif[1]), | |
2188 | ADB_SPDIFOUT(1)); | |
2189 | } | |
2190 | #endif | |
2191 | /* Make playback routes. */ | |
2192 | for (i = 0; i < nr_ch; i++) { | |
2193 | if (stream->type == VORTEX_PCM_ADB) { | |
2194 | vortex_connection_adbdma_src(vortex, en, | |
2195 | src[nr_ch - 1], | |
2196 | dma, | |
2197 | src[i]); | |
2198 | vortex_connection_src_mixin(vortex, en, | |
2199 | 0x11, src[i], | |
2200 | mix[i]); | |
2201 | vortex_connection_mixin_mix(vortex, en, | |
2202 | mix[i], | |
2203 | MIX_PLAYB(i), 0); | |
2204 | #ifndef CHIP_AU8820 | |
2205 | vortex_connection_mixin_mix(vortex, en, | |
2206 | mix[i], | |
2207 | MIX_SPDIF(i % 2), 0); | |
2208 | vortex_mix_setinputvolumebyte(vortex, | |
2209 | MIX_SPDIF(i % 2), | |
2210 | mix[i], | |
2211 | MIX_DEFIGAIN); | |
2212 | #endif | |
2213 | } | |
2214 | #ifndef CHIP_AU8820 | |
2215 | if (stream->type == VORTEX_PCM_A3D) { | |
2216 | vortex_connection_adbdma_src(vortex, en, | |
2217 | src[nr_ch - 1], | |
2218 | dma, | |
2219 | src[i]); | |
2220 | vortex_route(vortex, en, 0x11, ADB_SRCOUT(src[i]), ADB_A3DIN(a3d)); | |
2221 | /* XTalk test. */ | |
2222 | //vortex_route(vortex, en, 0x11, dma, ADB_XTALKIN(i?9:4)); | |
2223 | //vortex_route(vortex, en, 0x11, ADB_SRCOUT(src[i]), ADB_XTALKIN(i?4:9)); | |
2224 | } | |
2225 | if (stream->type == VORTEX_PCM_SPDIF) | |
2226 | vortex_route(vortex, en, 0x14, | |
2227 | ADB_DMA(stream->dma), | |
2228 | ADB_SPDIFOUT(i)); | |
2229 | #endif | |
2230 | } | |
2231 | if (stream->type != VORTEX_PCM_SPDIF && stream->type != VORTEX_PCM_A3D) { | |
2232 | ch_top = (VORTEX_IS_QUAD(vortex) ? 4 : 2); | |
2233 | for (i = nr_ch; i < ch_top; i++) { | |
2234 | vortex_connection_mixin_mix(vortex, en, | |
2235 | mix[i % nr_ch], | |
2236 | MIX_PLAYB(i), 0); | |
2237 | #ifndef CHIP_AU8820 | |
2238 | vortex_connection_mixin_mix(vortex, en, | |
2239 | mix[i % nr_ch], | |
2240 | MIX_SPDIF(i % 2), | |
2241 | 0); | |
2242 | vortex_mix_setinputvolumebyte(vortex, | |
2243 | MIX_SPDIF(i % 2), | |
2244 | mix[i % nr_ch], | |
2245 | MIX_DEFIGAIN); | |
2246 | #endif | |
2247 | } | |
bb92b7c4 RY |
2248 | if (stream->type == VORTEX_PCM_ADB && en) { |
2249 | p = &vortex->pcm_vol[subdev]; | |
2250 | p->dma = dma; | |
2251 | for (i = 0; i < nr_ch; i++) | |
2252 | p->mixin[i] = mix[i]; | |
2253 | for (i = 0; i < ch_top; i++) | |
2254 | p->vol[i] = 0; | |
2255 | } | |
1da177e4 LT |
2256 | } |
2257 | #ifndef CHIP_AU8820 | |
2258 | else { | |
2259 | if (nr_ch == 1 && stream->type == VORTEX_PCM_SPDIF) | |
2260 | vortex_route(vortex, en, 0x14, | |
2261 | ADB_DMA(stream->dma), | |
2262 | ADB_SPDIFOUT(1)); | |
2263 | } | |
2264 | /* Reconnect SPDIF out when "spdif" device is down. */ | |
2265 | if ((stream->type == VORTEX_PCM_SPDIF) && (!en)) { | |
2266 | vortex_route(vortex, 1, 0x14, | |
2267 | ADB_MIXOUT(vortex->mixspdif[0]), | |
2268 | ADB_SPDIFOUT(0)); | |
2269 | vortex_route(vortex, 1, 0x14, | |
2270 | ADB_MIXOUT(vortex->mixspdif[1]), | |
2271 | ADB_SPDIFOUT(1)); | |
2272 | } | |
2273 | #endif | |
2274 | /* CAPTURE ROUTES. */ | |
2275 | } else { | |
2276 | int src[2], mix[2]; | |
2277 | ||
2278 | /* Get SRC and MIXER hardware resources. */ | |
2279 | for (i = 0; i < nr_ch; i++) { | |
2280 | if ((mix[i] = | |
2281 | vortex_adb_checkinout(vortex, | |
2282 | stream->resources, en, | |
2283 | VORTEX_RESOURCE_MIXOUT)) | |
2284 | < 0) { | |
2285 | memset(stream->resources, 0, | |
2286 | sizeof(unsigned char) * | |
2287 | VORTEX_RESOURCE_LAST); | |
2288 | return -EBUSY; | |
2289 | } | |
2290 | if ((src[i] = | |
2291 | vortex_adb_checkinout(vortex, | |
2292 | stream->resources, en, | |
2293 | VORTEX_RESOURCE_SRC)) < 0) { | |
2294 | memset(stream->resources, 0, | |
2295 | sizeof(unsigned char) * | |
2296 | VORTEX_RESOURCE_LAST); | |
2297 | return -EBUSY; | |
2298 | } | |
2299 | } | |
2300 | ||
2301 | /* Make capture routes. */ | |
2302 | vortex_connection_mixin_mix(vortex, en, MIX_CAPT(0), mix[0], 0); | |
2303 | vortex_connection_mix_src(vortex, en, 0x11, mix[0], src[0]); | |
2304 | if (nr_ch == 1) { | |
2305 | vortex_connection_mixin_mix(vortex, en, | |
2306 | MIX_CAPT(1), mix[0], 0); | |
2307 | vortex_connection_src_adbdma(vortex, en, | |
2308 | src[0], | |
2309 | src[0], dma); | |
2310 | } else { | |
2311 | vortex_connection_mixin_mix(vortex, en, | |
2312 | MIX_CAPT(1), mix[1], 0); | |
2313 | vortex_connection_mix_src(vortex, en, 0x11, mix[1], | |
2314 | src[1]); | |
2315 | vortex_connection_src_src_adbdma(vortex, en, | |
2316 | src[1], src[0], | |
2317 | src[1], dma); | |
2318 | } | |
2319 | } | |
2320 | vortex->dma_adb[dma].nr_ch = nr_ch; | |
2321 | ||
2322 | #if 0 | |
2323 | /* AC97 Codec channel setup. FIXME: this has no effect on some cards !! */ | |
2324 | if (nr_ch < 4) { | |
2325 | /* Copy stereo to rear channel (surround) */ | |
2326 | snd_ac97_write_cache(vortex->codec, | |
2327 | AC97_SIGMATEL_DAC2INVERT, | |
2328 | snd_ac97_read(vortex->codec, | |
2329 | AC97_SIGMATEL_DAC2INVERT) | |
2330 | | 4); | |
2331 | } else { | |
2332 | /* Allow separate front and rear channels. */ | |
2333 | snd_ac97_write_cache(vortex->codec, | |
2334 | AC97_SIGMATEL_DAC2INVERT, | |
2335 | snd_ac97_read(vortex->codec, | |
2336 | AC97_SIGMATEL_DAC2INVERT) | |
2337 | & ~((u32) | |
2338 | 4)); | |
2339 | } | |
2340 | #endif | |
2341 | return dma; | |
2342 | } | |
2343 | ||
2344 | /* | |
2345 | Set the SampleRate of the SRC's attached to the given DMA engine. | |
2346 | */ | |
2347 | static void | |
2348 | vortex_adb_setsrc(vortex_t * vortex, int adbdma, unsigned int rate, int dir) | |
2349 | { | |
2350 | stream_t *stream = &(vortex->dma_adb[adbdma]); | |
2351 | int i, cvrt; | |
2352 | ||
2353 | /* dir=1:play ; dir=0:rec */ | |
2354 | if (dir) | |
2355 | cvrt = SRC_RATIO(rate, 48000); | |
2356 | else | |
2357 | cvrt = SRC_RATIO(48000, rate); | |
2358 | ||
2359 | /* Setup SRC's */ | |
2360 | for (i = 0; i < NR_SRC; i++) { | |
2361 | if (stream->resources[VORTEX_RESOURCE_SRC] & (1 << i)) | |
2362 | vortex_src_setupchannel(vortex, i, cvrt, 0, 0, i, dir, 1, cvrt, dir); | |
2363 | } | |
2364 | } | |
2365 | ||
2366 | // Timer and ISR functions. | |
2367 | ||
2368 | static void vortex_settimer(vortex_t * vortex, int period) | |
2369 | { | |
2370 | //set the timer period to <period> 48000ths of a second. | |
2371 | hwwrite(vortex->mmio, VORTEX_IRQ_STAT, period); | |
2372 | } | |
2373 | ||
2374 | #if 0 | |
2375 | static void vortex_enable_timer_int(vortex_t * card) | |
2376 | { | |
2377 | hwwrite(card->mmio, VORTEX_IRQ_CTRL, | |
2378 | hwread(card->mmio, VORTEX_IRQ_CTRL) | IRQ_TIMER | 0x60); | |
2379 | } | |
2380 | ||
2381 | static void vortex_disable_timer_int(vortex_t * card) | |
2382 | { | |
2383 | hwwrite(card->mmio, VORTEX_IRQ_CTRL, | |
2384 | hwread(card->mmio, VORTEX_IRQ_CTRL) & ~IRQ_TIMER); | |
2385 | } | |
2386 | ||
2387 | #endif | |
2388 | static void vortex_enable_int(vortex_t * card) | |
2389 | { | |
2390 | // CAsp4ISR__EnableVortexInt_void_ | |
2391 | hwwrite(card->mmio, VORTEX_CTRL, | |
2392 | hwread(card->mmio, VORTEX_CTRL) | CTRL_IRQ_ENABLE); | |
2393 | hwwrite(card->mmio, VORTEX_IRQ_CTRL, | |
2394 | (hwread(card->mmio, VORTEX_IRQ_CTRL) & 0xffffefc0) | 0x24); | |
2395 | } | |
2396 | ||
2397 | static void vortex_disable_int(vortex_t * card) | |
2398 | { | |
2399 | hwwrite(card->mmio, VORTEX_CTRL, | |
2400 | hwread(card->mmio, VORTEX_CTRL) & ~CTRL_IRQ_ENABLE); | |
2401 | } | |
2402 | ||
7d12e780 | 2403 | static irqreturn_t vortex_interrupt(int irq, void *dev_id) |
1da177e4 LT |
2404 | { |
2405 | vortex_t *vortex = dev_id; | |
2406 | int i, handled; | |
2407 | u32 source; | |
2408 | ||
2409 | //check if the interrupt is ours. | |
2410 | if (!(hwread(vortex->mmio, VORTEX_STAT) & 0x1)) | |
2411 | return IRQ_NONE; | |
2412 | ||
561de31a | 2413 | // This is the Interrupt Enable flag we set before (consistency check). |
1da177e4 LT |
2414 | if (!(hwread(vortex->mmio, VORTEX_CTRL) & CTRL_IRQ_ENABLE)) |
2415 | return IRQ_NONE; | |
2416 | ||
2417 | source = hwread(vortex->mmio, VORTEX_IRQ_SOURCE); | |
2418 | // Reset IRQ flags. | |
2419 | hwwrite(vortex->mmio, VORTEX_IRQ_SOURCE, source); | |
2420 | hwread(vortex->mmio, VORTEX_IRQ_SOURCE); | |
2421 | // Is at least one IRQ flag set? | |
2422 | if (source == 0) { | |
2423 | printk(KERN_ERR "vortex: missing irq source\n"); | |
2424 | return IRQ_NONE; | |
2425 | } | |
2426 | ||
2427 | handled = 0; | |
2428 | // Attend every interrupt source. | |
2429 | if (unlikely(source & IRQ_ERR_MASK)) { | |
2430 | if (source & IRQ_FATAL) { | |
2431 | printk(KERN_ERR "vortex: IRQ fatal error\n"); | |
2432 | } | |
2433 | if (source & IRQ_PARITY) { | |
2434 | printk(KERN_ERR "vortex: IRQ parity error\n"); | |
2435 | } | |
2436 | if (source & IRQ_REG) { | |
2437 | printk(KERN_ERR "vortex: IRQ reg error\n"); | |
2438 | } | |
2439 | if (source & IRQ_FIFO) { | |
2440 | printk(KERN_ERR "vortex: IRQ fifo error\n"); | |
2441 | } | |
2442 | if (source & IRQ_DMA) { | |
2443 | printk(KERN_ERR "vortex: IRQ dma error\n"); | |
2444 | } | |
2445 | handled = 1; | |
2446 | } | |
2447 | if (source & IRQ_PCMOUT) { | |
2448 | /* ALSA period acknowledge. */ | |
2449 | spin_lock(&vortex->lock); | |
2450 | for (i = 0; i < NR_ADB; i++) { | |
2451 | if (vortex->dma_adb[i].fifo_status == FIFO_START) { | |
e9ab33d0 JK |
2452 | if (!vortex_adbdma_bufshift(vortex, i)) |
2453 | continue; | |
1da177e4 LT |
2454 | spin_unlock(&vortex->lock); |
2455 | snd_pcm_period_elapsed(vortex->dma_adb[i]. | |
2456 | substream); | |
2457 | spin_lock(&vortex->lock); | |
2458 | } | |
2459 | } | |
2460 | #ifndef CHIP_AU8810 | |
2461 | for (i = 0; i < NR_WT; i++) { | |
2462 | if (vortex->dma_wt[i].fifo_status == FIFO_START) { | |
7dd7a2fd TI |
2463 | /* FIXME: we ignore the return value from |
2464 | * vortex_wtdma_bufshift() below as the delta | |
2465 | * calculation seems not working for wavetable | |
2466 | * by some reason | |
2467 | */ | |
2468 | vortex_wtdma_bufshift(vortex, i); | |
1da177e4 LT |
2469 | spin_unlock(&vortex->lock); |
2470 | snd_pcm_period_elapsed(vortex->dma_wt[i]. | |
2471 | substream); | |
2472 | spin_lock(&vortex->lock); | |
2473 | } | |
2474 | } | |
2475 | #endif | |
2476 | spin_unlock(&vortex->lock); | |
2477 | handled = 1; | |
2478 | } | |
2479 | //Acknowledge the Timer interrupt | |
2480 | if (source & IRQ_TIMER) { | |
2481 | hwread(vortex->mmio, VORTEX_IRQ_STAT); | |
2482 | handled = 1; | |
2483 | } | |
c6b76d1f | 2484 | if ((source & IRQ_MIDI) && vortex->rmidi) { |
1da177e4 | 2485 | snd_mpu401_uart_interrupt(vortex->irq, |
7d12e780 | 2486 | vortex->rmidi->private_data); |
1da177e4 LT |
2487 | handled = 1; |
2488 | } | |
2489 | ||
2490 | if (!handled) { | |
2491 | printk(KERN_ERR "vortex: unknown irq source %x\n", source); | |
2492 | } | |
2493 | return IRQ_RETVAL(handled); | |
2494 | } | |
2495 | ||
2496 | /* Codec */ | |
2497 | ||
2498 | #define POLL_COUNT 1000 | |
2499 | static void vortex_codec_init(vortex_t * vortex) | |
2500 | { | |
2501 | int i; | |
2502 | ||
2503 | for (i = 0; i < 32; i++) { | |
2504 | /* the windows driver writes -i, so we write -i */ | |
2505 | hwwrite(vortex->mmio, (VORTEX_CODEC_CHN + (i << 2)), -i); | |
2506 | msleep(2); | |
2507 | } | |
2508 | if (0) { | |
2509 | hwwrite(vortex->mmio, VORTEX_CODEC_CTRL, 0x8068); | |
2510 | msleep(1); | |
2511 | hwwrite(vortex->mmio, VORTEX_CODEC_CTRL, 0x00e8); | |
2512 | msleep(1); | |
2513 | } else { | |
2514 | hwwrite(vortex->mmio, VORTEX_CODEC_CTRL, 0x00a8); | |
2515 | msleep(2); | |
2516 | hwwrite(vortex->mmio, VORTEX_CODEC_CTRL, 0x80a8); | |
2517 | msleep(2); | |
2518 | hwwrite(vortex->mmio, VORTEX_CODEC_CTRL, 0x80e8); | |
2519 | msleep(2); | |
2520 | hwwrite(vortex->mmio, VORTEX_CODEC_CTRL, 0x80a8); | |
2521 | msleep(2); | |
2522 | hwwrite(vortex->mmio, VORTEX_CODEC_CTRL, 0x00a8); | |
2523 | msleep(2); | |
2524 | hwwrite(vortex->mmio, VORTEX_CODEC_CTRL, 0x00e8); | |
2525 | } | |
2526 | for (i = 0; i < 32; i++) { | |
2527 | hwwrite(vortex->mmio, (VORTEX_CODEC_CHN + (i << 2)), -i); | |
2528 | msleep(5); | |
2529 | } | |
2530 | hwwrite(vortex->mmio, VORTEX_CODEC_CTRL, 0xe8); | |
2531 | msleep(1); | |
2532 | /* Enable codec channels 0 and 1. */ | |
2533 | hwwrite(vortex->mmio, VORTEX_CODEC_EN, | |
2534 | hwread(vortex->mmio, VORTEX_CODEC_EN) | EN_CODEC); | |
2535 | } | |
2536 | ||
2537 | static void | |
2fd16874 | 2538 | vortex_codec_write(struct snd_ac97 * codec, unsigned short addr, unsigned short data) |
1da177e4 LT |
2539 | { |
2540 | ||
2541 | vortex_t *card = (vortex_t *) codec->private_data; | |
2542 | unsigned int lifeboat = 0; | |
2543 | ||
2544 | /* wait for transactions to clear */ | |
2545 | while (!(hwread(card->mmio, VORTEX_CODEC_CTRL) & 0x100)) { | |
2546 | udelay(100); | |
2547 | if (lifeboat++ > POLL_COUNT) { | |
2548 | printk(KERN_ERR "vortex: ac97 codec stuck busy\n"); | |
2549 | return; | |
2550 | } | |
2551 | } | |
2552 | /* write register */ | |
2553 | hwwrite(card->mmio, VORTEX_CODEC_IO, | |
2554 | ((addr << VORTEX_CODEC_ADDSHIFT) & VORTEX_CODEC_ADDMASK) | | |
2555 | ((data << VORTEX_CODEC_DATSHIFT) & VORTEX_CODEC_DATMASK) | | |
f2b31737 SK |
2556 | VORTEX_CODEC_WRITE | |
2557 | (codec->num << VORTEX_CODEC_ID_SHIFT) ); | |
1da177e4 LT |
2558 | |
2559 | /* Flush Caches. */ | |
2560 | hwread(card->mmio, VORTEX_CODEC_IO); | |
2561 | } | |
2562 | ||
2fd16874 | 2563 | static unsigned short vortex_codec_read(struct snd_ac97 * codec, unsigned short addr) |
1da177e4 LT |
2564 | { |
2565 | ||
2566 | vortex_t *card = (vortex_t *) codec->private_data; | |
2567 | u32 read_addr, data; | |
2568 | unsigned lifeboat = 0; | |
2569 | ||
2570 | /* wait for transactions to clear */ | |
2571 | while (!(hwread(card->mmio, VORTEX_CODEC_CTRL) & 0x100)) { | |
2572 | udelay(100); | |
2573 | if (lifeboat++ > POLL_COUNT) { | |
2574 | printk(KERN_ERR "vortex: ac97 codec stuck busy\n"); | |
2575 | return 0xffff; | |
2576 | } | |
2577 | } | |
2578 | /* set up read address */ | |
f2b31737 SK |
2579 | read_addr = ((addr << VORTEX_CODEC_ADDSHIFT) & VORTEX_CODEC_ADDMASK) | |
2580 | (codec->num << VORTEX_CODEC_ID_SHIFT) ; | |
1da177e4 LT |
2581 | hwwrite(card->mmio, VORTEX_CODEC_IO, read_addr); |
2582 | ||
2583 | /* wait for address */ | |
2584 | do { | |
2585 | udelay(100); | |
2586 | data = hwread(card->mmio, VORTEX_CODEC_IO); | |
2587 | if (lifeboat++ > POLL_COUNT) { | |
2588 | printk(KERN_ERR "vortex: ac97 address never arrived\n"); | |
2589 | return 0xffff; | |
2590 | } | |
2591 | } while ((data & VORTEX_CODEC_ADDMASK) != | |
2592 | (addr << VORTEX_CODEC_ADDSHIFT)); | |
2593 | ||
2594 | /* return data. */ | |
2595 | return (u16) (data & VORTEX_CODEC_DATMASK); | |
2596 | } | |
2597 | ||
2598 | /* SPDIF support */ | |
2599 | ||
2600 | static void vortex_spdif_init(vortex_t * vortex, int spdif_sr, int spdif_mode) | |
2601 | { | |
2602 | int i, this_38 = 0, this_04 = 0, this_08 = 0, this_0c = 0; | |
2603 | ||
2604 | /* CAsp4Spdif::InitializeSpdifHardware(void) */ | |
2605 | hwwrite(vortex->mmio, VORTEX_SPDIF_FLAGS, | |
2606 | hwread(vortex->mmio, VORTEX_SPDIF_FLAGS) & 0xfff3fffd); | |
2607 | //for (i=0x291D4; i<0x29200; i+=4) | |
2608 | for (i = 0; i < 11; i++) | |
2609 | hwwrite(vortex->mmio, VORTEX_SPDIF_CFG1 + (i << 2), 0); | |
2610 | //hwwrite(vortex->mmio, 0x29190, hwread(vortex->mmio, 0x29190) | 0xc0000); | |
2611 | hwwrite(vortex->mmio, VORTEX_CODEC_EN, | |
2612 | hwread(vortex->mmio, VORTEX_CODEC_EN) | EN_SPDIF); | |
2613 | ||
2614 | /* CAsp4Spdif::ProgramSRCInHardware(enum SPDIF_SR,enum SPDIFMODE) */ | |
2615 | if (this_04 && this_08) { | |
2616 | int edi; | |
2617 | ||
2618 | i = (((0x5DC00000 / spdif_sr) + 1) >> 1); | |
2619 | if (i > 0x800) { | |
2620 | if (i < 0x1ffff) | |
2621 | edi = (i >> 1); | |
2622 | else | |
2623 | edi = 0x1ffff; | |
2624 | } else { | |
2625 | i = edi = 0x800; | |
2626 | } | |
2627 | /* this_04 and this_08 are the CASp4Src's (samplerate converters) */ | |
2628 | vortex_src_setupchannel(vortex, this_04, edi, 0, 1, | |
2629 | this_0c, 1, 0, edi, 1); | |
2630 | vortex_src_setupchannel(vortex, this_08, edi, 0, 1, | |
2631 | this_0c, 1, 0, edi, 1); | |
2632 | } | |
2633 | ||
2634 | i = spdif_sr; | |
2635 | spdif_sr |= 0x8c; | |
2636 | switch (i) { | |
2637 | case 32000: | |
2638 | this_38 &= 0xFFFFFFFE; | |
2639 | this_38 &= 0xFFFFFFFD; | |
2640 | this_38 &= 0xF3FFFFFF; | |
2641 | this_38 |= 0x03000000; /* set 32khz samplerate */ | |
2642 | this_38 &= 0xFFFFFF3F; | |
2643 | spdif_sr &= 0xFFFFFFFD; | |
2644 | spdif_sr |= 1; | |
2645 | break; | |
2646 | case 44100: | |
2647 | this_38 &= 0xFFFFFFFE; | |
2648 | this_38 &= 0xFFFFFFFD; | |
2649 | this_38 &= 0xF0FFFFFF; | |
2650 | this_38 |= 0x03000000; | |
2651 | this_38 &= 0xFFFFFF3F; | |
2652 | spdif_sr &= 0xFFFFFFFC; | |
2653 | break; | |
2654 | case 48000: | |
2655 | if (spdif_mode == 1) { | |
2656 | this_38 &= 0xFFFFFFFE; | |
2657 | this_38 &= 0xFFFFFFFD; | |
2658 | this_38 &= 0xF2FFFFFF; | |
2659 | this_38 |= 0x02000000; /* set 48khz samplerate */ | |
2660 | this_38 &= 0xFFFFFF3F; | |
2661 | } else { | |
2662 | /* J. Gordon Wolfe: I think this stuff is for AC3 */ | |
2663 | this_38 |= 0x00000003; | |
2664 | this_38 &= 0xFFFFFFBF; | |
2665 | this_38 |= 0x80; | |
2666 | } | |
2667 | spdif_sr |= 2; | |
2668 | spdif_sr &= 0xFFFFFFFE; | |
2669 | break; | |
2670 | ||
2671 | } | |
2672 | /* looks like the next 2 lines transfer a 16-bit value into 2 8-bit | |
2673 | registers. seems to be for the standard IEC/SPDIF initialization | |
2674 | stuff */ | |
2675 | hwwrite(vortex->mmio, VORTEX_SPDIF_CFG0, this_38 & 0xffff); | |
2676 | hwwrite(vortex->mmio, VORTEX_SPDIF_CFG1, this_38 >> 0x10); | |
2677 | hwwrite(vortex->mmio, VORTEX_SPDIF_SMPRATE, spdif_sr); | |
2678 | } | |
2679 | ||
2680 | /* Initialization */ | |
2681 | ||
e23e7a14 | 2682 | static int vortex_core_init(vortex_t *vortex) |
1da177e4 LT |
2683 | { |
2684 | ||
2685 | printk(KERN_INFO "Vortex: init.... "); | |
2686 | /* Hardware Init. */ | |
2687 | hwwrite(vortex->mmio, VORTEX_CTRL, 0xffffffff); | |
2688 | msleep(5); | |
2689 | hwwrite(vortex->mmio, VORTEX_CTRL, | |
2690 | hwread(vortex->mmio, VORTEX_CTRL) & 0xffdfffff); | |
2691 | msleep(5); | |
2692 | /* Reset IRQ flags */ | |
2693 | hwwrite(vortex->mmio, VORTEX_IRQ_SOURCE, 0xffffffff); | |
2694 | hwread(vortex->mmio, VORTEX_IRQ_STAT); | |
2695 | ||
2696 | vortex_codec_init(vortex); | |
2697 | ||
2698 | #ifdef CHIP_AU8830 | |
2699 | hwwrite(vortex->mmio, VORTEX_CTRL, | |
2700 | hwread(vortex->mmio, VORTEX_CTRL) | 0x1000000); | |
2701 | #endif | |
2702 | ||
2703 | /* Init audio engine. */ | |
2704 | vortex_adbdma_init(vortex); | |
2705 | hwwrite(vortex->mmio, VORTEX_ENGINE_CTRL, 0x0); //, 0xc83c7e58, 0xc5f93e58 | |
2706 | vortex_adb_init(vortex); | |
2707 | /* Init processing blocks. */ | |
2708 | vortex_fifo_init(vortex); | |
2709 | vortex_mixer_init(vortex); | |
2710 | vortex_srcblock_init(vortex); | |
2711 | #ifndef CHIP_AU8820 | |
2712 | vortex_eq_init(vortex); | |
2713 | vortex_spdif_init(vortex, 48000, 1); | |
f40b6890 | 2714 | vortex_Vort3D_enable(vortex); |
1da177e4 LT |
2715 | #endif |
2716 | #ifndef CHIP_AU8810 | |
2717 | vortex_wt_init(vortex); | |
2718 | #endif | |
2719 | // Moved to au88x0.c | |
2720 | //vortex_connect_default(vortex, 1); | |
2721 | ||
2722 | vortex_settimer(vortex, 0x90); | |
2723 | // Enable Interrupts. | |
2724 | // vortex_enable_int() must be first !! | |
2725 | // hwwrite(vortex->mmio, VORTEX_IRQ_CTRL, 0); | |
2726 | // vortex_enable_int(vortex); | |
2727 | //vortex_enable_timer_int(vortex); | |
2728 | //vortex_disable_timer_int(vortex); | |
2729 | ||
2730 | printk(KERN_INFO "done.\n"); | |
2731 | spin_lock_init(&vortex->lock); | |
2732 | ||
2733 | return 0; | |
2734 | } | |
2735 | ||
2736 | static int vortex_core_shutdown(vortex_t * vortex) | |
2737 | { | |
2738 | ||
2739 | printk(KERN_INFO "Vortex: shutdown..."); | |
2740 | #ifndef CHIP_AU8820 | |
2741 | vortex_eq_free(vortex); | |
f40b6890 | 2742 | vortex_Vort3D_disable(vortex); |
1da177e4 LT |
2743 | #endif |
2744 | //vortex_disable_timer_int(vortex); | |
2745 | vortex_disable_int(vortex); | |
2746 | vortex_connect_default(vortex, 0); | |
2747 | /* Reset all DMA fifos. */ | |
2748 | vortex_fifo_init(vortex); | |
2749 | /* Erase all audio routes. */ | |
2750 | vortex_adb_init(vortex); | |
2751 | ||
2752 | /* Disable MPU401 */ | |
2753 | //hwwrite(vortex->mmio, VORTEX_IRQ_CTRL, hwread(vortex->mmio, VORTEX_IRQ_CTRL) & ~IRQ_MIDI); | |
2754 | //hwwrite(vortex->mmio, VORTEX_CTRL, hwread(vortex->mmio, VORTEX_CTRL) & ~CTRL_MIDI_EN); | |
2755 | ||
2756 | hwwrite(vortex->mmio, VORTEX_IRQ_CTRL, 0); | |
2757 | hwwrite(vortex->mmio, VORTEX_CTRL, 0); | |
2758 | msleep(5); | |
2759 | hwwrite(vortex->mmio, VORTEX_IRQ_SOURCE, 0xffff); | |
2760 | ||
2761 | printk(KERN_INFO "done.\n"); | |
2762 | return 0; | |
2763 | } | |
2764 | ||
2765 | /* Alsa support. */ | |
2766 | ||
2767 | static int vortex_alsafmt_aspfmt(int alsafmt) | |
2768 | { | |
2769 | int fmt; | |
2770 | ||
2771 | switch (alsafmt) { | |
2772 | case SNDRV_PCM_FORMAT_U8: | |
2773 | fmt = 0x1; | |
2774 | break; | |
2775 | case SNDRV_PCM_FORMAT_MU_LAW: | |
2776 | fmt = 0x2; | |
2777 | break; | |
2778 | case SNDRV_PCM_FORMAT_A_LAW: | |
2779 | fmt = 0x3; | |
2780 | break; | |
2781 | case SNDRV_PCM_FORMAT_SPECIAL: | |
2782 | fmt = 0x4; /* guess. */ | |
2783 | break; | |
2784 | case SNDRV_PCM_FORMAT_IEC958_SUBFRAME_LE: | |
2785 | fmt = 0x5; /* guess. */ | |
2786 | break; | |
2787 | case SNDRV_PCM_FORMAT_S16_LE: | |
2788 | fmt = 0x8; | |
2789 | break; | |
2790 | case SNDRV_PCM_FORMAT_S16_BE: | |
2791 | fmt = 0x9; /* check this... */ | |
2792 | break; | |
2793 | default: | |
2794 | fmt = 0x8; | |
2795 | printk(KERN_ERR "vortex: format unsupported %d\n", alsafmt); | |
2796 | break; | |
2797 | } | |
2798 | return fmt; | |
2799 | } | |
2800 | ||
2801 | /* Some not yet useful translations. */ | |
2802 | #if 0 | |
2803 | typedef enum { | |
2804 | ASPFMTLINEAR16 = 0, /* 0x8 */ | |
2805 | ASPFMTLINEAR8, /* 0x1 */ | |
2806 | ASPFMTULAW, /* 0x2 */ | |
2807 | ASPFMTALAW, /* 0x3 */ | |
2808 | ASPFMTSPORT, /* ? */ | |
2809 | ASPFMTSPDIF, /* ? */ | |
2810 | } ASPENCODING; | |
2811 | ||
2812 | static int | |
2813 | vortex_translateformat(vortex_t * vortex, char bits, char nch, int encod) | |
2814 | { | |
2815 | int a, this_194; | |
2816 | ||
83807400 | 2817 | if ((bits != 8) && (bits != 16)) |
1da177e4 LT |
2818 | return -1; |
2819 | ||
2820 | switch (encod) { | |
2821 | case 0: | |
2822 | if (bits == 0x10) | |
2823 | a = 8; // 16 bit | |
2824 | break; | |
2825 | case 1: | |
2826 | if (bits == 8) | |
2827 | a = 1; // 8 bit | |
2828 | break; | |
2829 | case 2: | |
2830 | a = 2; // U_LAW | |
2831 | break; | |
2832 | case 3: | |
2833 | a = 3; // A_LAW | |
2834 | break; | |
2835 | } | |
2836 | switch (nch) { | |
2837 | case 1: | |
2838 | this_194 = 0; | |
2839 | break; | |
2840 | case 2: | |
2841 | this_194 = 1; | |
2842 | break; | |
2843 | case 4: | |
2844 | this_194 = 1; | |
2845 | break; | |
2846 | case 6: | |
2847 | this_194 = 1; | |
2848 | break; | |
2849 | } | |
2850 | return (a); | |
2851 | } | |
2852 | ||
2853 | static void vortex_cdmacore_setformat(vortex_t * vortex, int bits, int nch) | |
2854 | { | |
2855 | short int d, this_148; | |
2856 | ||
2857 | d = ((bits >> 3) * nch); | |
2858 | this_148 = 0xbb80 / d; | |
2859 | } | |
2860 | #endif |