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.
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.
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.
18 * Someday its supposed to make use of the WT DMA engine
19 * for a Wavetable synthesizer.
23 #include "au88x0_wt.h"
25 static void vortex_fifo_setwtvalid(vortex_t * vortex, int fifo, int en);
26 static void vortex_connection_adb_mixin(vortex_t * vortex, int en,
27 unsigned char channel,
30 static void vortex_connection_mixin_mix(vortex_t * vortex, int en,
32 unsigned char mix, int a);
33 static void vortex_fifo_wtinitialize(vortex_t * vortex, int fifo, int j);
34 static int vortex_wt_SetReg(vortex_t * vortex, unsigned char reg, int wt,
39 static void vortex_wt_setstereo(vortex_t * vortex, u32 wt, u32 stereo)
43 //temp = hwread(vortex->mmio, 0x80 + ((wt >> 0x5)<< 0xf) + (((wt & 0x1f) >> 1) << 2));
44 temp = hwread(vortex->mmio, WT_STEREO(wt));
45 temp = (temp & 0xfe) | (stereo & 1);
46 //hwwrite(vortex->mmio, 0x80 + ((wt >> 0x5)<< 0xf) + (((wt & 0x1f) >> 1) << 2), temp);
47 hwwrite(vortex->mmio, WT_STEREO(wt), temp);
50 static void vortex_wt_setdsout(vortex_t * vortex, u32 wt, int en)
54 /* There is one DSREG register for each bank (32 voices each). */
55 temp = hwread(vortex->mmio, WT_DSREG((wt >= 0x20) ? 1 : 0));
57 temp |= (1 << (wt & 0x1f));
59 temp &= (1 << ~(wt & 0x1f));
60 hwwrite(vortex->mmio, WT_DSREG((wt >= 0x20) ? 1 : 0), temp);
63 // WT routing is still a mistery.
64 static int vortex_wt_allocroute(vortex_t * vortex, int wt, int nr_ch)
66 wt_voice_t *voice = &(vortex->wt_voice[wt]);
69 //FIXME: WT audio routing.
71 vortex_fifo_wtinitialize(vortex, wt, 2);
72 vortex_fifo_setwtvalid(vortex, wt, 1);
73 vortex_wt_setstereo(vortex, wt, nr_ch - 1);
75 vortex_fifo_setwtvalid(vortex, wt, 0);
77 vortex_wt_setdsout(vortex, wt, 0);
78 hwwrite(vortex->mmio, WT_SRAMP(0), 0x880000);
79 //hwwrite(vortex->mmio, WT_GMODE(0), 0xffffffff);
81 hwwrite(vortex->mmio, WT_SRAMP(1), 0x880000);
82 //hwwrite(vortex->mmio, WT_GMODE(1), 0xffffffff);
84 hwwrite(vortex->mmio, WT_PARM(wt, 0), 0);
85 hwwrite(vortex->mmio, WT_PARM(wt, 1), 0);
86 hwwrite(vortex->mmio, WT_PARM(wt, 2), 0);
88 temp = hwread(vortex->mmio, WT_PARM(wt, 3));
89 printk("vortex: WT PARM3: %x\n", temp);
90 hwwrite(vortex->mmio, WT_PARM(wt, 3), temp);
92 hwwrite(vortex->mmio, WT_DELAY(wt, 0), 0);
93 hwwrite(vortex->mmio, WT_DELAY(wt, 1), 0);
94 hwwrite(vortex->mmio, WT_DELAY(wt, 2), 0);
95 hwwrite(vortex->mmio, WT_DELAY(wt, 3), 0);
97 printk("vortex: WT GMODE: %x\n", hwread(vortex->mmio, WT_GMODE(wt)));
99 hwwrite(vortex->mmio, WT_PARM(wt, 2), 0xffffffff);
100 hwwrite(vortex->mmio, WT_PARM(wt, 3), 0xcff1c810);
102 voice->parm0 = voice->parm1 = 0xcfb23e2f;
103 hwwrite(vortex->mmio, WT_PARM(wt, 0), voice->parm0);
104 hwwrite(vortex->mmio, WT_PARM(wt, 1), voice->parm1);
105 printk("vortex: WT GMODE 2 : %x\n", hwread(vortex->mmio, WT_GMODE(wt)));
109 static void vortex_wt_connect(vortex_t * vortex, int en)
113 #define NR_WTROUTES 6
115 #define NR_WTBLOCKS 2
117 #define NR_WTBLOCKS 1
120 for (i = 0; i < NR_WTBLOCKS; i++) {
121 for (ii = 0; ii < NR_WTROUTES; ii++) {
123 vortex_adb_checkinout(vortex,
124 vortex->fixed_res, en,
125 VORTEX_RESOURCE_MIXIN);
126 vortex->mixwt[(i * NR_WTROUTES) + ii] = mix;
128 vortex_route(vortex, en, 0x11,
129 ADB_WTOUT(i, ii + 0x20), ADB_MIXIN(mix));
131 vortex_connection_mixin_mix(vortex, en, mix,
132 vortex->mixplayb[ii %
134 if (VORTEX_IS_QUAD(vortex))
135 vortex_connection_mixin_mix(vortex, en,
143 for (i = 0; i < NR_WT; i++) {
144 hwwrite(vortex->mmio, WT_RUN(i), 1);
148 /* Read WT Register */
150 static int vortex_wt_GetReg(vortex_t * vortex, char reg, int wt)
155 return hwread(vortex->mmio, WT_PARM(wt, 3));
158 return hwread(vortex->mmio, WT_GMODE(wt));
164 /* WT hardware abstraction layer generic register interface. */
166 vortex_wt_SetReg2(vortex_t * vortex, unsigned char reg, int wt,
172 if (wt >= NR_WT) // 0x40 -> NR_WT
175 if ((reg - 0x20) > 0) {
176 if ((reg - 0x21) != 0)
178 eax = ((((b & 0xff) << 0xb) + (edx & 0xff)) << 4) + 0x208; // param 2
180 eax = ((((b & 0xff) << 0xb) + (edx & 0xff)) << 4) + 0x20a; // param 3
182 hwwrite(vortex->mmio, eax, c);
187 /*public: static void __thiscall CWTHal::SetReg(unsigned char,int,unsigned long) */
190 vortex_wt_SetReg(vortex_t * vortex, unsigned char reg, int wt,
195 if ((reg == 5) || ((reg >= 7) && (reg <= 10)) || (reg == 0xc)) {
196 if (wt >= (NR_WT / NR_WT_PB)) {
198 ("vortex: WT SetReg: bank out of range. reg=0x%x, wt=%d\n",
204 printk("vortex: WT SetReg: voice out of range\n");
212 /* Voice specific parameters */
213 case 0: /* running */
214 //printk("vortex: WT SetReg(0x%x) = 0x%08x\n", WT_RUN(wt), (int)val);
215 hwwrite(vortex->mmio, WT_RUN(wt), val);
218 case 1: /* param 0 */
219 //printk("vortex: WT SetReg(0x%x) = 0x%08x\n", WT_PARM(wt,0), (int)val);
220 hwwrite(vortex->mmio, WT_PARM(wt, 0), val);
223 case 2: /* param 1 */
224 //printk("vortex: WT SetReg(0x%x) = 0x%08x\n", WT_PARM(wt,1), (int)val);
225 hwwrite(vortex->mmio, WT_PARM(wt, 1), val);
228 case 3: /* param 2 */
229 //printk("vortex: WT SetReg(0x%x) = 0x%08x\n", WT_PARM(wt,2), (int)val);
230 hwwrite(vortex->mmio, WT_PARM(wt, 2), val);
233 case 4: /* param 3 */
234 //printk("vortex: WT SetReg(0x%x) = 0x%08x\n", WT_PARM(wt,3), (int)val);
235 hwwrite(vortex->mmio, WT_PARM(wt, 3), val);
239 //printk("vortex: WT SetReg(0x%x) = 0x%08x\n", WT_MUTE(wt), (int)val);
240 hwwrite(vortex->mmio, WT_MUTE(wt), val);
245 //printk("vortex: WT SetReg(0x%x) = 0x%08x\n", WT_DELAY(wt,0), (int)val);
246 hwwrite(vortex->mmio, WT_DELAY(wt, 3), val);
247 hwwrite(vortex->mmio, WT_DELAY(wt, 2), val);
248 hwwrite(vortex->mmio, WT_DELAY(wt, 1), val);
249 hwwrite(vortex->mmio, WT_DELAY(wt, 0), val);
253 /* Global WT block parameters */
266 case 0xc: /* ds_reg */
273 //printk("vortex: WT SetReg(0x%x) = 0x%08x\n", ecx, (int)val);
274 hwwrite(vortex->mmio, ecx, val);
278 static void vortex_wt_init(vortex_t * vortex)
280 int var4, var8, varc, var10 = 0, edi;
295 /* Init Bank registers. */
296 for (edi = 0; edi < (NR_WT / NR_WT_PB); edi++) {
297 vortex_wt_SetReg(vortex, 0xc, edi, 0); /* ds_reg */
298 vortex_wt_SetReg(vortex, 0xa, edi, var10); /* ctrl */
299 vortex_wt_SetReg(vortex, 0x9, edi, var4); /* mramp */
300 vortex_wt_SetReg(vortex, 0x8, edi, varc); /* aramp */
301 vortex_wt_SetReg(vortex, 0x5, edi, var8); /* sramp */
303 /* Init Voice registers. */
304 for (edi = 0; edi < NR_WT; edi++) {
305 vortex_wt_SetReg(vortex, 0x4, edi, 0); /* param 3 0x20c */
306 vortex_wt_SetReg(vortex, 0x3, edi, 0); /* param 2 0x208 */
307 vortex_wt_SetReg(vortex, 0x2, edi, 0); /* param 1 0x204 */
308 vortex_wt_SetReg(vortex, 0x1, edi, 0); /* param 0 0x200 */
309 vortex_wt_SetReg(vortex, 0xb, edi, 0); /* delay 0x400 - 0x40c */
312 for (edi = 0; edi < (NR_WT / NR_WT_PB); edi++)
313 vortex_wt_SetReg(vortex, 0xa, edi, var10); /* ctrl */
316 /* Extract of CAdbTopology::SetVolume(struct _ASPVOLUME *) */
318 static void vortex_wt_SetVolume(vortex_t * vortex, int wt, int vol[])
320 wt_voice_t *voice = &(vortex->wt_voice[wt]);
321 int ecx = vol[1], eax = vol[0];
323 /* This is pure guess */
324 voice->parm0 &= 0xff00ffff;
325 voice->parm0 |= (vol[0] & 0xff) << 0x10;
326 voice->parm1 &= 0xff00ffff;
327 voice->parm1 |= (vol[1] & 0xff) << 0x10;
330 hwwrite(vortex, WT_PARM(wt, 0), voice->parm0);
331 hwwrite(vortex, WT_PARM(wt, 1), voice->parm0);
333 if (voice->this_1D0 & 4) {
338 voice->parm3 &= 0xFFFFC07F;
339 voice->parm3 |= (ecx & 0x7f) << 7;
340 voice->parm3 &= 0xFFFFFF80;
341 voice->parm3 |= (eax & 0x7f);
343 voice->parm3 &= 0xFFE03FFF;
344 voice->parm3 |= (eax & 0xFE00) << 5;
347 hwwrite(vortex, WT_PARM(wt, 3), voice->parm3);
350 /* Extract of CAdbTopology::SetFrequency(unsigned long arg_0) */
351 static void vortex_wt_SetFrequency(vortex_t * vortex, int wt, unsigned int sr)
353 wt_voice_t *voice = &(vortex->wt_voice[wt]);
356 //FIXME: 64 bit operation.
357 eax = ((sr << 0xf) * 0x57619F1) & 0xffffffff;
358 edx = (((sr << 0xf) * 0x57619F1)) >> 0x20;
363 if (edx & 0x0FFF80000)
368 while ((edx & 0x80000000) == 0) {
382 voice->parm0 &= 0xffff0001;
383 voice->parm0 |= (eax & 0x7fff) << 1;
384 voice->parm1 = voice->parm0 | 1;
386 //AuWt::WriteReg((ulong)(this_1DC<<4)+0x200, (ulong)this_1E4);
387 //AuWt::WriteReg((ulong)(this_1DC<<4)+0x204, (ulong)this_1E8);
388 hwwrite(vortex->mmio, WT_PARM(wt, 0), voice->parm0);
389 hwwrite(vortex->mmio, WT_PARM(wt, 1), voice->parm1);