sound/pci/au88x0/au88x0_synth.c - kernel/msm-4.9 - Gitiles

 /*
  *  This program is free software; you can redistribute it and/or modify
  *  it under the terms of the GNU General Public License as published by
  *  the Free Software Foundation; either version 2 of the License, or
  *  (at your option) any later version.
  *
  *  This program is distributed in the hope that it will be useful,
  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  *  GNU Library General Public License for more details.
  *
  *  You should have received a copy of the GNU General Public License
  *  along with this program; if not, write to the Free Software
  *  Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
  */

 /*
  * Someday its supposed to make use of the WT DMA engine
  * for a Wavetable synthesizer.
  */

 #include "au88x0.h"
 #include "au88x0_wt.h"

 static void vortex_fifo_setwtvalid(vortex_t * vortex, int fifo, int en);
 static void vortex_connection_adb_mixin(vortex_t * vortex, int en,
 					unsigned char channel,
 					unsigned char source,
 					unsigned char mixin);
 static void vortex_connection_mixin_mix(vortex_t * vortex, int en,
 					unsigned char mixin,
 					unsigned char mix, int a);
 static void vortex_fifo_wtinitialize(vortex_t * vortex, int fifo, int j);
 static int vortex_wt_SetReg(vortex_t * vortex, unsigned char reg, int wt,
 			    u32 val);

 /* WT */

 /* Put 2 WT channels together for one stereo interlaced channel. */
 static void vortex_wt_setstereo(vortex_t * vortex, u32 wt, u32 stereo)
 {
 	int temp;

 	//temp = hwread(vortex->mmio, 0x80 + ((wt >> 0x5)<< 0xf) + (((wt & 0x1f) >> 1) << 2));
 	temp = hwread(vortex->mmio, WT_STEREO(wt));
 	temp = (temp & 0xfe) | (stereo & 1);
 	//hwwrite(vortex->mmio, 0x80 + ((wt >> 0x5)<< 0xf) + (((wt & 0x1f) >> 1) << 2), temp);
 	hwwrite(vortex->mmio, WT_STEREO(wt), temp);
 }

 /* Join to mixdown route. */
 static void vortex_wt_setdsout(vortex_t * vortex, u32 wt, int en)
 {
 	int temp;

 	/* There is one DSREG register for each bank (32 voices each). */
 	temp = hwread(vortex->mmio, WT_DSREG((wt >= 0x20) ? 1 : 0));
 	if (en)
 		temp |= (1 << (wt & 0x1f));
 	else
 		temp &= (1 << ~(wt & 0x1f));
 	hwwrite(vortex->mmio, WT_DSREG((wt >= 0x20) ? 1 : 0), temp);
 }

 /* Setup WT route. */
 static int vortex_wt_allocroute(vortex_t * vortex, int wt, int nr_ch)
 {
 	wt_voice_t *voice = &(vortex->wt_voice[wt]);
 	int temp;

 	//FIXME: WT audio routing.
 	if (nr_ch) {
 		vortex_fifo_wtinitialize(vortex, wt, 1);
 		vortex_fifo_setwtvalid(vortex, wt, 1);
 		vortex_wt_setstereo(vortex, wt, nr_ch - 1);
 	} else
 		vortex_fifo_setwtvalid(vortex, wt, 0);

 	/* Set mixdown mode. */
 	vortex_wt_setdsout(vortex, wt, 1);
 	/* Set other parameter registers. */
 	hwwrite(vortex->mmio, WT_SRAMP(0), 0x880000);
 	//hwwrite(vortex->mmio, WT_GMODE(0), 0xffffffff);
 #ifdef CHIP_AU8830
 	hwwrite(vortex->mmio, WT_SRAMP(1), 0x880000);
 	//hwwrite(vortex->mmio, WT_GMODE(1), 0xffffffff);
 #endif
 	hwwrite(vortex->mmio, WT_PARM(wt, 0), 0);
 	hwwrite(vortex->mmio, WT_PARM(wt, 1), 0);
 	hwwrite(vortex->mmio, WT_PARM(wt, 2), 0);

 	temp = hwread(vortex->mmio, WT_PARM(wt, 3));
 	printk(KERN_DEBUG "vortex: WT PARM3: %x\n", temp);
 	//hwwrite(vortex->mmio, WT_PARM(wt, 3), temp);

 	hwwrite(vortex->mmio, WT_DELAY(wt, 0), 0);
 	hwwrite(vortex->mmio, WT_DELAY(wt, 1), 0);
 	hwwrite(vortex->mmio, WT_DELAY(wt, 2), 0);
 	hwwrite(vortex->mmio, WT_DELAY(wt, 3), 0);

 	printk(KERN_DEBUG "vortex: WT GMODE: %x\n", hwread(vortex->mmio, WT_GMODE(wt)));

 	hwwrite(vortex->mmio, WT_PARM(wt, 2), 0xffffffff);
 	hwwrite(vortex->mmio, WT_PARM(wt, 3), 0xcff1c810);

 	voice->parm0 = voice->parm1 = 0xcfb23e2f;
 	hwwrite(vortex->mmio, WT_PARM(wt, 0), voice->parm0);
 	hwwrite(vortex->mmio, WT_PARM(wt, 1), voice->parm1);
 	printk(KERN_DEBUG "vortex: WT GMODE 2 : %x\n", hwread(vortex->mmio, WT_GMODE(wt)));
 	return 0;
 }


 static void vortex_wt_connect(vortex_t * vortex, int en)
 {
 	int i, ii, mix;

 #define NR_WTROUTES 6
 #ifdef CHIP_AU8830
 #define NR_WTBLOCKS 2
 #else
 #define NR_WTBLOCKS 1
 #endif

 	for (i = 0; i < NR_WTBLOCKS; i++) {
 		for (ii = 0; ii < NR_WTROUTES; ii++) {
 			mix =
 			    vortex_adb_checkinout(vortex,
 						  vortex->fixed_res, en,
 						  VORTEX_RESOURCE_MIXIN);
 			vortex->mixwt[(i * NR_WTROUTES) + ii] = mix;

 			vortex_route(vortex, en, 0x11,
 				     ADB_WTOUT(i, ii + 0x20), ADB_MIXIN(mix));

 			vortex_connection_mixin_mix(vortex, en, mix,
 						    vortex->mixplayb[ii % 2], 0);
 			if (VORTEX_IS_QUAD(vortex))
 				vortex_connection_mixin_mix(vortex, en,
 							    mix,
 							    vortex->mixplayb[2 +
 								     (ii % 2)], 0);
 		}
 	}
 	for (i = 0; i < NR_WT; i++) {
 		hwwrite(vortex->mmio, WT_RUN(i), 1);
 	}
 }

 /* Read WT Register */
 #if 0
 static int vortex_wt_GetReg(vortex_t * vortex, char reg, int wt)
 {
 	//int eax, esi;

 	if (reg == 4) {
 		return hwread(vortex->mmio, WT_PARM(wt, 3));
 	}
 	if (reg == 7) {
 		return hwread(vortex->mmio, WT_GMODE(wt));
 	}

 	return 0;
 }

 /* WT hardware abstraction layer generic register interface. */
 static int
 vortex_wt_SetReg2(vortex_t * vortex, unsigned char reg, int wt,
 		  u16 val)
 {
 	/*
 	   int eax, edx;

 	   if (wt >= NR_WT)  // 0x40 -> NR_WT
 	   return 0;

 	   if ((reg - 0x20) > 0) {
 	   if ((reg - 0x21) != 0)
 	   return 0;
 	   eax = ((((b & 0xff) << 0xb) + (edx & 0xff)) << 4) + 0x208; // param 2
 	   } else {
 	   eax = ((((b & 0xff) << 0xb) + (edx & 0xff)) << 4) + 0x20a; // param 3
 	   }
 	   hwwrite(vortex->mmio, eax, c);
 	 */
 	return 1;
 }

 /*public: static void __thiscall CWTHal::SetReg(unsigned char,int,unsigned long) */
 #endif
 static int
 vortex_wt_SetReg(vortex_t * vortex, unsigned char reg, int wt,
 		 u32 val)
 {
 	int ecx;

 	if ((reg == 5) || ((reg >= 7) && (reg <= 10)) || (reg == 0xc)) {
 		if (wt >= (NR_WT / NR_WT_PB)) {
 			printk
 			    ("vortex: WT SetReg: bank out of range. reg=0x%x, wt=%d\n",
 			     reg, wt);
 			return 0;
 		}
 	} else {
 		if (wt >= NR_WT) {
 			printk(KERN_ERR "vortex: WT SetReg: voice out of range\n");
 			return 0;
 		}
 	}
 	if (reg > 0xc)
 		return 0;

 	switch (reg) {
 		/* Voice specific parameters */
 	case 0:		/* running */
 		//printk("vortex: WT SetReg(0x%x) = 0x%08x\n", WT_RUN(wt), (int)val);
 		hwwrite(vortex->mmio, WT_RUN(wt), val);
 		return 0xc;
 		break;
 	case 1:		/* param 0 */
 		//printk("vortex: WT SetReg(0x%x) = 0x%08x\n", WT_PARM(wt,0), (int)val);
 		hwwrite(vortex->mmio, WT_PARM(wt, 0), val);
 		return 0xc;
 		break;
 	case 2:		/* param 1 */
 		//printk("vortex: WT SetReg(0x%x) = 0x%08x\n", WT_PARM(wt,1), (int)val);
 		hwwrite(vortex->mmio, WT_PARM(wt, 1), val);
 		return 0xc;
 		break;
 	case 3:		/* param 2 */
 		//printk("vortex: WT SetReg(0x%x) = 0x%08x\n", WT_PARM(wt,2), (int)val);
 		hwwrite(vortex->mmio, WT_PARM(wt, 2), val);
 		return 0xc;
 		break;
 	case 4:		/* param 3 */
 		//printk("vortex: WT SetReg(0x%x) = 0x%08x\n", WT_PARM(wt,3), (int)val);
 		hwwrite(vortex->mmio, WT_PARM(wt, 3), val);
 		return 0xc;
 		break;
 	case 6:		/* mute */
 		//printk("vortex: WT SetReg(0x%x) = 0x%08x\n", WT_MUTE(wt), (int)val);
 		hwwrite(vortex->mmio, WT_MUTE(wt), val);
 		return 0xc;
 		break;
 	case 0xb:
 		{		/* delay */
 			//printk("vortex: WT SetReg(0x%x) = 0x%08x\n", WT_DELAY(wt,0), (int)val);
 			hwwrite(vortex->mmio, WT_DELAY(wt, 3), val);
 			hwwrite(vortex->mmio, WT_DELAY(wt, 2), val);
 			hwwrite(vortex->mmio, WT_DELAY(wt, 1), val);
 			hwwrite(vortex->mmio, WT_DELAY(wt, 0), val);
 			return 0xc;
 		}
 		break;
 		/* Global WT block parameters */
 	case 5:		/* sramp */
 		ecx = WT_SRAMP(wt);
 		break;
 	case 8:		/* aramp */
 		ecx = WT_ARAMP(wt);
 		break;
 	case 9:		/* mramp */
 		ecx = WT_MRAMP(wt);
 		break;
 	case 0xa:		/* ctrl */
 		ecx = WT_CTRL(wt);
 		break;
 	case 0xc:		/* ds_reg */
 		ecx = WT_DSREG(wt);
 		break;
 	default:
 		return 0;
 		break;
 	}
 	//printk("vortex: WT SetReg(0x%x) = 0x%08x\n", ecx, (int)val);
 	hwwrite(vortex->mmio, ecx, val);
 	return 1;
 }

 static void vortex_wt_init(vortex_t * vortex)
 {
 	u32 var4, var8, varc, var10 = 0, edi;

 	var10 &= 0xFFFFFFE3;
 	var10 |= 0x22;
 	var10 &= 0xFFFFFEBF;
 	var10 |= 0x80;
 	var10 |= 0x200;
 	var10 &= 0xfffffffe;
 	var10 &= 0xfffffbff;
 	var10 |= 0x1800;
 	// var10 = 0x1AA2
 	var4 = 0x10000000;
 	varc = 0x00830000;
 	var8 = 0x00830000;

 	/* Init Bank registers. */
 	for (edi = 0; edi < (NR_WT / NR_WT_PB); edi++) {
 		vortex_wt_SetReg(vortex, 0xc, edi, 0);	/* ds_reg */
 		vortex_wt_SetReg(vortex, 0xa, edi, var10);	/* ctrl  */
 		vortex_wt_SetReg(vortex, 0x9, edi, var4);	/* mramp */
 		vortex_wt_SetReg(vortex, 0x8, edi, varc);	/* aramp */
 		vortex_wt_SetReg(vortex, 0x5, edi, var8);	/* sramp */
 	}
 	/* Init Voice registers. */
 	for (edi = 0; edi < NR_WT; edi++) {
 		vortex_wt_SetReg(vortex, 0x4, edi, 0);	/* param 3 0x20c */
 		vortex_wt_SetReg(vortex, 0x3, edi, 0);	/* param 2 0x208 */
 		vortex_wt_SetReg(vortex, 0x2, edi, 0);	/* param 1 0x204 */
 		vortex_wt_SetReg(vortex, 0x1, edi, 0);	/* param 0 0x200 */
 		vortex_wt_SetReg(vortex, 0xb, edi, 0);	/* delay 0x400 - 0x40c */
 	}
 	var10 |= 1;
 	for (edi = 0; edi < (NR_WT / NR_WT_PB); edi++)
 		vortex_wt_SetReg(vortex, 0xa, edi, var10);	/* ctrl */
 }

 /* Extract of CAdbTopology::SetVolume(struct _ASPVOLUME *) */
 #if 0
 static void vortex_wt_SetVolume(vortex_t * vortex, int wt, int vol[])
 {
 	wt_voice_t *voice = &(vortex->wt_voice[wt]);
 	int ecx = vol[1], eax = vol[0];

 	/* This is pure guess */
 	voice->parm0 &= 0xff00ffff;
 	voice->parm0 |= (vol[0] & 0xff) << 0x10;
 	voice->parm1 &= 0xff00ffff;
 	voice->parm1 |= (vol[1] & 0xff) << 0x10;

 	/* This is real */
 	hwwrite(vortex, WT_PARM(wt, 0), voice->parm0);
 	hwwrite(vortex, WT_PARM(wt, 1), voice->parm0);

 	if (voice->this_1D0 & 4) {
 		eax >>= 8;
 		ecx = eax;
 		if (ecx < 0x80)
 			ecx = 0x7f;
 		voice->parm3 &= 0xFFFFC07F;
 		voice->parm3 |= (ecx & 0x7f) << 7;
 		voice->parm3 &= 0xFFFFFF80;
 		voice->parm3 |= (eax & 0x7f);
 	} else {
 		voice->parm3 &= 0xFFE03FFF;
 		voice->parm3 |= (eax & 0xFE00) << 5;
 	}

 	hwwrite(vortex, WT_PARM(wt, 3), voice->parm3);
 }

 /* Extract of CAdbTopology::SetFrequency(unsigned long arg_0) */
 static void vortex_wt_SetFrequency(vortex_t * vortex, int wt, unsigned int sr)
 {
 	wt_voice_t *voice = &(vortex->wt_voice[wt]);
 	u32 eax, edx;

 	//FIXME: 64 bit operation.
 	eax = ((sr << 0xf) * 0x57619F1) & 0xffffffff;
 	edx = (((sr << 0xf) * 0x57619F1)) >> 0x20;

 	edx >>= 0xa;
 	edx <<= 1;
 	if (edx) {
 		if (edx & 0x0FFF80000)
 			eax = 0x7fff;
 		else {
 			edx <<= 0xd;
 			eax = 7;
 			while ((edx & 0x80000000) == 0) {
 				edx <<= 1;
 				eax--;
 				if (eax == 0)
 					break;
 			}
 			if (eax)
 				edx <<= 1;
 			eax <<= 0xc;
 			edx >>= 0x14;
 			eax |= edx;
 		}
 	} else
 		eax = 0;
 	voice->parm0 &= 0xffff0001;
 	voice->parm0 |= (eax & 0x7fff) << 1;
 	voice->parm1 = voice->parm0 | 1;
 	// Wt: this_1D4
 	//AuWt::WriteReg((ulong)(this_1DC<<4)+0x200, (ulong)this_1E4);
 	//AuWt::WriteReg((ulong)(this_1DC<<4)+0x204, (ulong)this_1E8);
 	hwwrite(vortex->mmio, WT_PARM(wt, 0), voice->parm0);
 	hwwrite(vortex->mmio, WT_PARM(wt, 1), voice->parm1);
 }
 #endif

 /* End of File */
	/*
	* This program is free software; you can redistribute it and/or modify
	* it under the terms of the GNU General Public License as published by
	* the Free Software Foundation; either version 2 of the License, or
	* (at your option) any later version.
	*
	* This program is distributed in the hope that it will be useful,
	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	* GNU Library General Public License for more details.
	*
	* You should have received a copy of the GNU General Public License
	* along with this program; if not, write to the Free Software
	* Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
	*/

	/*
	* Someday its supposed to make use of the WT DMA engine
	* for a Wavetable synthesizer.
	*/

	#include "au88x0.h"
	#include "au88x0_wt.h"

	static void vortex_fifo_setwtvalid(vortex_t * vortex, int fifo, int en);
	static void vortex_connection_adb_mixin(vortex_t * vortex, int en,
	unsigned char channel,
	unsigned char source,
	unsigned char mixin);
	static void vortex_connection_mixin_mix(vortex_t * vortex, int en,
	unsigned char mixin,
	unsigned char mix, int a);
	static void vortex_fifo_wtinitialize(vortex_t * vortex, int fifo, int j);
	static int vortex_wt_SetReg(vortex_t * vortex, unsigned char reg, int wt,
	u32 val);

	/* WT */

	/* Put 2 WT channels together for one stereo interlaced channel. */
	static void vortex_wt_setstereo(vortex_t * vortex, u32 wt, u32 stereo)
	{
	int temp;

	//temp = hwread(vortex->mmio, 0x80 + ((wt >> 0x5)<< 0xf) + (((wt & 0x1f) >> 1) << 2));
	temp = hwread(vortex->mmio, WT_STEREO(wt));
	temp = (temp & 0xfe) \| (stereo & 1);
	//hwwrite(vortex->mmio, 0x80 + ((wt >> 0x5)<< 0xf) + (((wt & 0x1f) >> 1) << 2), temp);
	hwwrite(vortex->mmio, WT_STEREO(wt), temp);
	}

	/* Join to mixdown route. */
	static void vortex_wt_setdsout(vortex_t * vortex, u32 wt, int en)
	{
	int temp;

	/* There is one DSREG register for each bank (32 voices each). */
	temp = hwread(vortex->mmio, WT_DSREG((wt >= 0x20) ? 1 : 0));
	if (en)
	temp \|= (1 << (wt & 0x1f));
	else
	temp &= (1 << ~(wt & 0x1f));
	hwwrite(vortex->mmio, WT_DSREG((wt >= 0x20) ? 1 : 0), temp);
	}

	/* Setup WT route. */
	static int vortex_wt_allocroute(vortex_t * vortex, int wt, int nr_ch)
	{
	wt_voice_t *voice = &(vortex->wt_voice[wt]);
	int temp;

	//FIXME: WT audio routing.
	if (nr_ch) {
	vortex_fifo_wtinitialize(vortex, wt, 1);
	vortex_fifo_setwtvalid(vortex, wt, 1);
	vortex_wt_setstereo(vortex, wt, nr_ch - 1);
	} else
	vortex_fifo_setwtvalid(vortex, wt, 0);

	/* Set mixdown mode. */
	vortex_wt_setdsout(vortex, wt, 1);
	/* Set other parameter registers. */
	hwwrite(vortex->mmio, WT_SRAMP(0), 0x880000);
	//hwwrite(vortex->mmio, WT_GMODE(0), 0xffffffff);
	#ifdef CHIP_AU8830
	hwwrite(vortex->mmio, WT_SRAMP(1), 0x880000);
	//hwwrite(vortex->mmio, WT_GMODE(1), 0xffffffff);
	#endif
	hwwrite(vortex->mmio, WT_PARM(wt, 0), 0);
	hwwrite(vortex->mmio, WT_PARM(wt, 1), 0);
	hwwrite(vortex->mmio, WT_PARM(wt, 2), 0);

	temp = hwread(vortex->mmio, WT_PARM(wt, 3));
	printk(KERN_DEBUG "vortex: WT PARM3: %x\n", temp);
	//hwwrite(vortex->mmio, WT_PARM(wt, 3), temp);

	hwwrite(vortex->mmio, WT_DELAY(wt, 0), 0);
	hwwrite(vortex->mmio, WT_DELAY(wt, 1), 0);
	hwwrite(vortex->mmio, WT_DELAY(wt, 2), 0);
	hwwrite(vortex->mmio, WT_DELAY(wt, 3), 0);

	printk(KERN_DEBUG "vortex: WT GMODE: %x\n", hwread(vortex->mmio, WT_GMODE(wt)));

	hwwrite(vortex->mmio, WT_PARM(wt, 2), 0xffffffff);
	hwwrite(vortex->mmio, WT_PARM(wt, 3), 0xcff1c810);

	voice->parm0 = voice->parm1 = 0xcfb23e2f;
	hwwrite(vortex->mmio, WT_PARM(wt, 0), voice->parm0);
	hwwrite(vortex->mmio, WT_PARM(wt, 1), voice->parm1);
	printk(KERN_DEBUG "vortex: WT GMODE 2 : %x\n", hwread(vortex->mmio, WT_GMODE(wt)));
	return 0;
	}


	static void vortex_wt_connect(vortex_t * vortex, int en)
	{
	int i, ii, mix;

	#define NR_WTROUTES 6
	#ifdef CHIP_AU8830
	#define NR_WTBLOCKS 2
	#else
	#define NR_WTBLOCKS 1
	#endif

	for (i = 0; i < NR_WTBLOCKS; i++) {
	for (ii = 0; ii < NR_WTROUTES; ii++) {
	mix =
	vortex_adb_checkinout(vortex,
	vortex->fixed_res, en,
	VORTEX_RESOURCE_MIXIN);
	vortex->mixwt[(i * NR_WTROUTES) + ii] = mix;

	vortex_route(vortex, en, 0x11,
	ADB_WTOUT(i, ii + 0x20), ADB_MIXIN(mix));

	vortex_connection_mixin_mix(vortex, en, mix,
	vortex->mixplayb[ii % 2], 0);
	if (VORTEX_IS_QUAD(vortex))
	vortex_connection_mixin_mix(vortex, en,
	mix,
	vortex->mixplayb[2 +
	(ii % 2)], 0);
	}
	}
	for (i = 0; i < NR_WT; i++) {
	hwwrite(vortex->mmio, WT_RUN(i), 1);
	}
	}

	/* Read WT Register */
	#if 0
	static int vortex_wt_GetReg(vortex_t * vortex, char reg, int wt)
	{
	//int eax, esi;

	if (reg == 4) {
	return hwread(vortex->mmio, WT_PARM(wt, 3));
	}
	if (reg == 7) {
	return hwread(vortex->mmio, WT_GMODE(wt));
	}

	return 0;
	}

	/* WT hardware abstraction layer generic register interface. */
	static int
	vortex_wt_SetReg2(vortex_t * vortex, unsigned char reg, int wt,
	u16 val)
	{
	/*
	int eax, edx;

	if (wt >= NR_WT) // 0x40 -> NR_WT
	return 0;

	if ((reg - 0x20) > 0) {
	if ((reg - 0x21) != 0)
	return 0;
	eax = ((((b & 0xff) << 0xb) + (edx & 0xff)) << 4) + 0x208; // param 2
	} else {
	eax = ((((b & 0xff) << 0xb) + (edx & 0xff)) << 4) + 0x20a; // param 3
	}
	hwwrite(vortex->mmio, eax, c);
	*/
	return 1;
	}

	/public: static void __thiscall CWTHal::SetReg(unsigned char,int,unsigned long) /
	#endif
	static int
	vortex_wt_SetReg(vortex_t * vortex, unsigned char reg, int wt,
	u32 val)
	{
	int ecx;

	if ((reg == 5) \|\| ((reg >= 7) && (reg <= 10)) \|\| (reg == 0xc)) {
	if (wt >= (NR_WT / NR_WT_PB)) {
	printk
	("vortex: WT SetReg: bank out of range. reg=0x%x, wt=%d\n",
	reg, wt);
	return 0;
	}
	} else {
	if (wt >= NR_WT) {
	printk(KERN_ERR "vortex: WT SetReg: voice out of range\n");
	return 0;
	}
	}
	if (reg > 0xc)
	return 0;

	switch (reg) {
	/* Voice specific parameters */
	case 0: /* running */
	//printk("vortex: WT SetReg(0x%x) = 0x%08x\n", WT_RUN(wt), (int)val);
	hwwrite(vortex->mmio, WT_RUN(wt), val);
	return 0xc;
	break;
	case 1: /* param 0 */
	//printk("vortex: WT SetReg(0x%x) = 0x%08x\n", WT_PARM(wt,0), (int)val);
	hwwrite(vortex->mmio, WT_PARM(wt, 0), val);
	return 0xc;
	break;
	case 2: /* param 1 */
	//printk("vortex: WT SetReg(0x%x) = 0x%08x\n", WT_PARM(wt,1), (int)val);
	hwwrite(vortex->mmio, WT_PARM(wt, 1), val);
	return 0xc;
	break;
	case 3: /* param 2 */
	//printk("vortex: WT SetReg(0x%x) = 0x%08x\n", WT_PARM(wt,2), (int)val);
	hwwrite(vortex->mmio, WT_PARM(wt, 2), val);
	return 0xc;
	break;
	case 4: /* param 3 */
	//printk("vortex: WT SetReg(0x%x) = 0x%08x\n", WT_PARM(wt,3), (int)val);
	hwwrite(vortex->mmio, WT_PARM(wt, 3), val);
	return 0xc;
	break;
	case 6: /* mute */
	//printk("vortex: WT SetReg(0x%x) = 0x%08x\n", WT_MUTE(wt), (int)val);
	hwwrite(vortex->mmio, WT_MUTE(wt), val);
	return 0xc;
	break;
	case 0xb:
	{ /* delay */
	//printk("vortex: WT SetReg(0x%x) = 0x%08x\n", WT_DELAY(wt,0), (int)val);
	hwwrite(vortex->mmio, WT_DELAY(wt, 3), val);
	hwwrite(vortex->mmio, WT_DELAY(wt, 2), val);
	hwwrite(vortex->mmio, WT_DELAY(wt, 1), val);
	hwwrite(vortex->mmio, WT_DELAY(wt, 0), val);
	return 0xc;
	}
	break;
	/* Global WT block parameters */
	case 5: /* sramp */
	ecx = WT_SRAMP(wt);
	break;
	case 8: /* aramp */
	ecx = WT_ARAMP(wt);
	break;
	case 9: /* mramp */
	ecx = WT_MRAMP(wt);
	break;
	case 0xa: /* ctrl */
	ecx = WT_CTRL(wt);
	break;
	case 0xc: /* ds_reg */
	ecx = WT_DSREG(wt);
	break;
	default:
	return 0;
	break;
	}
	//printk("vortex: WT SetReg(0x%x) = 0x%08x\n", ecx, (int)val);
	hwwrite(vortex->mmio, ecx, val);
	return 1;
	}

	static void vortex_wt_init(vortex_t * vortex)
	{
	u32 var4, var8, varc, var10 = 0, edi;

	var10 &= 0xFFFFFFE3;
	var10 \|= 0x22;
	var10 &= 0xFFFFFEBF;
	var10 \|= 0x80;
	var10 \|= 0x200;
	var10 &= 0xfffffffe;
	var10 &= 0xfffffbff;
	var10 \|= 0x1800;
	// var10 = 0x1AA2
	var4 = 0x10000000;
	varc = 0x00830000;
	var8 = 0x00830000;

	/* Init Bank registers. */
	for (edi = 0; edi < (NR_WT / NR_WT_PB); edi++) {
	vortex_wt_SetReg(vortex, 0xc, edi, 0); /* ds_reg */
	vortex_wt_SetReg(vortex, 0xa, edi, var10); /* ctrl */
	vortex_wt_SetReg(vortex, 0x9, edi, var4); /* mramp */
	vortex_wt_SetReg(vortex, 0x8, edi, varc); /* aramp */
	vortex_wt_SetReg(vortex, 0x5, edi, var8); /* sramp */
	}
	/* Init Voice registers. */
	for (edi = 0; edi < NR_WT; edi++) {
	vortex_wt_SetReg(vortex, 0x4, edi, 0); /* param 3 0x20c */
	vortex_wt_SetReg(vortex, 0x3, edi, 0); /* param 2 0x208 */
	vortex_wt_SetReg(vortex, 0x2, edi, 0); /* param 1 0x204 */
	vortex_wt_SetReg(vortex, 0x1, edi, 0); /* param 0 0x200 */
	vortex_wt_SetReg(vortex, 0xb, edi, 0); /* delay 0x400 - 0x40c */
	}
	var10 \|= 1;
	for (edi = 0; edi < (NR_WT / NR_WT_PB); edi++)
	vortex_wt_SetReg(vortex, 0xa, edi, var10); /* ctrl */
	}

	/* Extract of CAdbTopology::SetVolume(struct _ASPVOLUME ) /
	#if 0
	static void vortex_wt_SetVolume(vortex_t * vortex, int wt, int vol[])
	{
	wt_voice_t *voice = &(vortex->wt_voice[wt]);
	int ecx = vol[1], eax = vol[0];

	/* This is pure guess */
	voice->parm0 &= 0xff00ffff;
	voice->parm0 \|= (vol[0] & 0xff) << 0x10;
	voice->parm1 &= 0xff00ffff;
	voice->parm1 \|= (vol[1] & 0xff) << 0x10;

	/* This is real */
	hwwrite(vortex, WT_PARM(wt, 0), voice->parm0);
	hwwrite(vortex, WT_PARM(wt, 1), voice->parm0);

	if (voice->this_1D0 & 4) {
	eax >>= 8;
	ecx = eax;
	if (ecx < 0x80)
	ecx = 0x7f;
	voice->parm3 &= 0xFFFFC07F;
	voice->parm3 \|= (ecx & 0x7f) << 7;
	voice->parm3 &= 0xFFFFFF80;
	voice->parm3 \|= (eax & 0x7f);
	} else {
	voice->parm3 &= 0xFFE03FFF;
	voice->parm3 \|= (eax & 0xFE00) << 5;
	}

	hwwrite(vortex, WT_PARM(wt, 3), voice->parm3);
	}

	/* Extract of CAdbTopology::SetFrequency(unsigned long arg_0) */
	static void vortex_wt_SetFrequency(vortex_t * vortex, int wt, unsigned int sr)
	{
	wt_voice_t *voice = &(vortex->wt_voice[wt]);
	u32 eax, edx;

	//FIXME: 64 bit operation.
	eax = ((sr << 0xf) * 0x57619F1) & 0xffffffff;
	edx = (((sr << 0xf) * 0x57619F1)) >> 0x20;

	edx >>= 0xa;
	edx <<= 1;
	if (edx) {
	if (edx & 0x0FFF80000)
	eax = 0x7fff;
	else {
	edx <<= 0xd;
	eax = 7;
	while ((edx & 0x80000000) == 0) {
	edx <<= 1;
	eax--;
	if (eax == 0)
	break;
	}
	if (eax)
	edx <<= 1;
	eax <<= 0xc;
	edx >>= 0x14;
	eax \|= edx;
	}
	} else
	eax = 0;
	voice->parm0 &= 0xffff0001;
	voice->parm0 \|= (eax & 0x7fff) << 1;
	voice->parm1 = voice->parm0 \| 1;
	// Wt: this_1D4
	//AuWt::WriteReg((ulong)(this_1DC<<4)+0x200, (ulong)this_1E4);
	//AuWt::WriteReg((ulong)(this_1DC<<4)+0x204, (ulong)this_1E8);
	hwwrite(vortex->mmio, WT_PARM(wt, 0), voice->parm0);
	hwwrite(vortex->mmio, WT_PARM(wt, 1), voice->parm1);
	}
	#endif

	/* End of File */