xref: /openbmc/linux/sound/oss/dmasound/dmasound_atari.c (revision 1ef64e670e3bc27e0c3c83810ca36e19924c35c6)
11da177e4SLinus Torvalds /*
21da177e4SLinus Torvalds  *  linux/sound/oss/dmasound/dmasound_atari.c
31da177e4SLinus Torvalds  *
41da177e4SLinus Torvalds  *  Atari TT and Falcon DMA Sound Driver
51da177e4SLinus Torvalds  *
61da177e4SLinus Torvalds  *  See linux/sound/oss/dmasound/dmasound_core.c for copyright and credits
71da177e4SLinus Torvalds  *  prior to 28/01/2001
81da177e4SLinus Torvalds  *
91da177e4SLinus Torvalds  *  28/01/2001 [0.1] Iain Sandoe
101da177e4SLinus Torvalds  *		     - added versioning
111da177e4SLinus Torvalds  *		     - put in and populated the hardware_afmts field.
121da177e4SLinus Torvalds  *             [0.2] - put in SNDCTL_DSP_GETCAPS value.
131da177e4SLinus Torvalds  *  01/02/2001 [0.3] - put in default hard/soft settings.
141da177e4SLinus Torvalds  */
151da177e4SLinus Torvalds 
161da177e4SLinus Torvalds 
171da177e4SLinus Torvalds #include <linux/module.h>
181da177e4SLinus Torvalds #include <linux/kernel.h>
191da177e4SLinus Torvalds #include <linux/init.h>
201da177e4SLinus Torvalds #include <linux/soundcard.h>
211da177e4SLinus Torvalds #include <linux/mm.h>
221da177e4SLinus Torvalds #include <linux/spinlock.h>
231da177e4SLinus Torvalds #include <linux/interrupt.h>
241da177e4SLinus Torvalds 
251da177e4SLinus Torvalds #include <asm/uaccess.h>
261da177e4SLinus Torvalds #include <asm/atariints.h>
271da177e4SLinus Torvalds #include <asm/atari_stram.h>
281da177e4SLinus Torvalds 
291da177e4SLinus Torvalds #include "dmasound.h"
301da177e4SLinus Torvalds 
311da177e4SLinus Torvalds #define DMASOUND_ATARI_REVISION 0
321da177e4SLinus Torvalds #define DMASOUND_ATARI_EDITION 3
331da177e4SLinus Torvalds 
341da177e4SLinus Torvalds extern void atari_microwire_cmd(int cmd);
351da177e4SLinus Torvalds 
361da177e4SLinus Torvalds static int is_falcon;
371da177e4SLinus Torvalds static int write_sq_ignore_int;	/* ++TeSche: used for Falcon */
381da177e4SLinus Torvalds 
391da177e4SLinus Torvalds static int expand_bal;	/* Balance factor for expanding (not volume!) */
401da177e4SLinus Torvalds static int expand_data;	/* Data for expanding */
411da177e4SLinus Torvalds 
421da177e4SLinus Torvalds 
431da177e4SLinus Torvalds /*** Translations ************************************************************/
441da177e4SLinus Torvalds 
451da177e4SLinus Torvalds 
461da177e4SLinus Torvalds /* ++TeSche: radically changed for new expanding purposes...
471da177e4SLinus Torvalds  *
481da177e4SLinus Torvalds  * These two routines now deal with copying/expanding/translating the samples
491da177e4SLinus Torvalds  * from user space into our buffer at the right frequency. They take care about
501da177e4SLinus Torvalds  * how much data there's actually to read, how much buffer space there is and
511da177e4SLinus Torvalds  * to convert samples into the right frequency/encoding. They will only work on
521da177e4SLinus Torvalds  * complete samples so it may happen they leave some bytes in the input stream
531da177e4SLinus Torvalds  * if the user didn't write a multiple of the current sample size. They both
541da177e4SLinus Torvalds  * return the number of bytes they've used from both streams so you may detect
551da177e4SLinus Torvalds  * such a situation. Luckily all programs should be able to cope with that.
561da177e4SLinus Torvalds  *
571da177e4SLinus Torvalds  * I think I've optimized anything as far as one can do in plain C, all
581da177e4SLinus Torvalds  * variables should fit in registers and the loops are really short. There's
591da177e4SLinus Torvalds  * one loop for every possible situation. Writing a more generalized and thus
601da177e4SLinus Torvalds  * parameterized loop would only produce slower code. Feel free to optimize
611da177e4SLinus Torvalds  * this in assembler if you like. :)
621da177e4SLinus Torvalds  *
631da177e4SLinus Torvalds  * I think these routines belong here because they're not yet really hardware
641da177e4SLinus Torvalds  * independent, especially the fact that the Falcon can play 16bit samples
651da177e4SLinus Torvalds  * only in stereo is hardcoded in both of them!
661da177e4SLinus Torvalds  *
671da177e4SLinus Torvalds  * ++geert: split in even more functions (one per format)
681da177e4SLinus Torvalds  */
691da177e4SLinus Torvalds 
701da177e4SLinus Torvalds static ssize_t ata_ct_law(const u_char *userPtr, size_t userCount,
711da177e4SLinus Torvalds 			  u_char frame[], ssize_t *frameUsed,
721da177e4SLinus Torvalds 			  ssize_t frameLeft);
731da177e4SLinus Torvalds static ssize_t ata_ct_s8(const u_char *userPtr, size_t userCount,
741da177e4SLinus Torvalds 			 u_char frame[], ssize_t *frameUsed,
751da177e4SLinus Torvalds 			 ssize_t frameLeft);
761da177e4SLinus Torvalds static ssize_t ata_ct_u8(const u_char *userPtr, size_t userCount,
771da177e4SLinus Torvalds 			 u_char frame[], ssize_t *frameUsed,
781da177e4SLinus Torvalds 			 ssize_t frameLeft);
791da177e4SLinus Torvalds static ssize_t ata_ct_s16be(const u_char *userPtr, size_t userCount,
801da177e4SLinus Torvalds 			    u_char frame[], ssize_t *frameUsed,
811da177e4SLinus Torvalds 			    ssize_t frameLeft);
821da177e4SLinus Torvalds static ssize_t ata_ct_u16be(const u_char *userPtr, size_t userCount,
831da177e4SLinus Torvalds 			    u_char frame[], ssize_t *frameUsed,
841da177e4SLinus Torvalds 			    ssize_t frameLeft);
851da177e4SLinus Torvalds static ssize_t ata_ct_s16le(const u_char *userPtr, size_t userCount,
861da177e4SLinus Torvalds 			    u_char frame[], ssize_t *frameUsed,
871da177e4SLinus Torvalds 			    ssize_t frameLeft);
881da177e4SLinus Torvalds static ssize_t ata_ct_u16le(const u_char *userPtr, size_t userCount,
891da177e4SLinus Torvalds 			    u_char frame[], ssize_t *frameUsed,
901da177e4SLinus Torvalds 			    ssize_t frameLeft);
911da177e4SLinus Torvalds static ssize_t ata_ctx_law(const u_char *userPtr, size_t userCount,
921da177e4SLinus Torvalds 			   u_char frame[], ssize_t *frameUsed,
931da177e4SLinus Torvalds 			   ssize_t frameLeft);
941da177e4SLinus Torvalds static ssize_t ata_ctx_s8(const u_char *userPtr, size_t userCount,
951da177e4SLinus Torvalds 			  u_char frame[], ssize_t *frameUsed,
961da177e4SLinus Torvalds 			  ssize_t frameLeft);
971da177e4SLinus Torvalds static ssize_t ata_ctx_u8(const u_char *userPtr, size_t userCount,
981da177e4SLinus Torvalds 			  u_char frame[], ssize_t *frameUsed,
991da177e4SLinus Torvalds 			  ssize_t frameLeft);
1001da177e4SLinus Torvalds static ssize_t ata_ctx_s16be(const u_char *userPtr, size_t userCount,
1011da177e4SLinus Torvalds 			     u_char frame[], ssize_t *frameUsed,
1021da177e4SLinus Torvalds 			     ssize_t frameLeft);
1031da177e4SLinus Torvalds static ssize_t ata_ctx_u16be(const u_char *userPtr, size_t userCount,
1041da177e4SLinus Torvalds 			     u_char frame[], ssize_t *frameUsed,
1051da177e4SLinus Torvalds 			     ssize_t frameLeft);
1061da177e4SLinus Torvalds static ssize_t ata_ctx_s16le(const u_char *userPtr, size_t userCount,
1071da177e4SLinus Torvalds 			     u_char frame[], ssize_t *frameUsed,
1081da177e4SLinus Torvalds 			     ssize_t frameLeft);
1091da177e4SLinus Torvalds static ssize_t ata_ctx_u16le(const u_char *userPtr, size_t userCount,
1101da177e4SLinus Torvalds 			     u_char frame[], ssize_t *frameUsed,
1111da177e4SLinus Torvalds 			     ssize_t frameLeft);
1121da177e4SLinus Torvalds 
1131da177e4SLinus Torvalds 
1141da177e4SLinus Torvalds /*** Low level stuff *********************************************************/
1151da177e4SLinus Torvalds 
1161da177e4SLinus Torvalds 
117*1ef64e67SAl Viro static void *AtaAlloc(unsigned int size, gfp_t flags);
1181da177e4SLinus Torvalds static void AtaFree(void *, unsigned int size);
1191da177e4SLinus Torvalds static int AtaIrqInit(void);
1201da177e4SLinus Torvalds #ifdef MODULE
1211da177e4SLinus Torvalds static void AtaIrqCleanUp(void);
1221da177e4SLinus Torvalds #endif /* MODULE */
1231da177e4SLinus Torvalds static int AtaSetBass(int bass);
1241da177e4SLinus Torvalds static int AtaSetTreble(int treble);
1251da177e4SLinus Torvalds static void TTSilence(void);
1261da177e4SLinus Torvalds static void TTInit(void);
1271da177e4SLinus Torvalds static int TTSetFormat(int format);
1281da177e4SLinus Torvalds static int TTSetVolume(int volume);
1291da177e4SLinus Torvalds static int TTSetGain(int gain);
1301da177e4SLinus Torvalds static void FalconSilence(void);
1311da177e4SLinus Torvalds static void FalconInit(void);
1321da177e4SLinus Torvalds static int FalconSetFormat(int format);
1331da177e4SLinus Torvalds static int FalconSetVolume(int volume);
1341da177e4SLinus Torvalds static void AtaPlayNextFrame(int index);
1351da177e4SLinus Torvalds static void AtaPlay(void);
1361da177e4SLinus Torvalds static irqreturn_t AtaInterrupt(int irq, void *dummy, struct pt_regs *fp);
1371da177e4SLinus Torvalds 
1381da177e4SLinus Torvalds /*** Mid level stuff *********************************************************/
1391da177e4SLinus Torvalds 
1401da177e4SLinus Torvalds static void TTMixerInit(void);
1411da177e4SLinus Torvalds static void FalconMixerInit(void);
1421da177e4SLinus Torvalds static int AtaMixerIoctl(u_int cmd, u_long arg);
1431da177e4SLinus Torvalds static int TTMixerIoctl(u_int cmd, u_long arg);
1441da177e4SLinus Torvalds static int FalconMixerIoctl(u_int cmd, u_long arg);
1451da177e4SLinus Torvalds static int AtaWriteSqSetup(void);
1461da177e4SLinus Torvalds static int AtaSqOpen(mode_t mode);
1471da177e4SLinus Torvalds static int TTStateInfo(char *buffer, size_t space);
1481da177e4SLinus Torvalds static int FalconStateInfo(char *buffer, size_t space);
1491da177e4SLinus Torvalds 
1501da177e4SLinus Torvalds 
1511da177e4SLinus Torvalds /*** Translations ************************************************************/
1521da177e4SLinus Torvalds 
1531da177e4SLinus Torvalds 
1541da177e4SLinus Torvalds static ssize_t ata_ct_law(const u_char *userPtr, size_t userCount,
1551da177e4SLinus Torvalds 			  u_char frame[], ssize_t *frameUsed,
1561da177e4SLinus Torvalds 			  ssize_t frameLeft)
1571da177e4SLinus Torvalds {
1581da177e4SLinus Torvalds 	char *table = dmasound.soft.format == AFMT_MU_LAW ? dmasound_ulaw2dma8
1591da177e4SLinus Torvalds 							  : dmasound_alaw2dma8;
1601da177e4SLinus Torvalds 	ssize_t count, used;
1611da177e4SLinus Torvalds 	u_char *p = &frame[*frameUsed];
1621da177e4SLinus Torvalds 
1631da177e4SLinus Torvalds 	count = min_t(unsigned long, userCount, frameLeft);
1641da177e4SLinus Torvalds 	if (dmasound.soft.stereo)
1651da177e4SLinus Torvalds 		count &= ~1;
1661da177e4SLinus Torvalds 	used = count;
1671da177e4SLinus Torvalds 	while (count > 0) {
1681da177e4SLinus Torvalds 		u_char data;
1691da177e4SLinus Torvalds 		if (get_user(data, userPtr++))
1701da177e4SLinus Torvalds 			return -EFAULT;
1711da177e4SLinus Torvalds 		*p++ = table[data];
1721da177e4SLinus Torvalds 		count--;
1731da177e4SLinus Torvalds 	}
1741da177e4SLinus Torvalds 	*frameUsed += used;
1751da177e4SLinus Torvalds 	return used;
1761da177e4SLinus Torvalds }
1771da177e4SLinus Torvalds 
1781da177e4SLinus Torvalds 
1791da177e4SLinus Torvalds static ssize_t ata_ct_s8(const u_char *userPtr, size_t userCount,
1801da177e4SLinus Torvalds 			 u_char frame[], ssize_t *frameUsed,
1811da177e4SLinus Torvalds 			 ssize_t frameLeft)
1821da177e4SLinus Torvalds {
1831da177e4SLinus Torvalds 	ssize_t count, used;
1841da177e4SLinus Torvalds 	void *p = &frame[*frameUsed];
1851da177e4SLinus Torvalds 
1861da177e4SLinus Torvalds 	count = min_t(unsigned long, userCount, frameLeft);
1871da177e4SLinus Torvalds 	if (dmasound.soft.stereo)
1881da177e4SLinus Torvalds 		count &= ~1;
1891da177e4SLinus Torvalds 	used = count;
1901da177e4SLinus Torvalds 	if (copy_from_user(p, userPtr, count))
1911da177e4SLinus Torvalds 		return -EFAULT;
1921da177e4SLinus Torvalds 	*frameUsed += used;
1931da177e4SLinus Torvalds 	return used;
1941da177e4SLinus Torvalds }
1951da177e4SLinus Torvalds 
1961da177e4SLinus Torvalds 
1971da177e4SLinus Torvalds static ssize_t ata_ct_u8(const u_char *userPtr, size_t userCount,
1981da177e4SLinus Torvalds 			 u_char frame[], ssize_t *frameUsed,
1991da177e4SLinus Torvalds 			 ssize_t frameLeft)
2001da177e4SLinus Torvalds {
2011da177e4SLinus Torvalds 	ssize_t count, used;
2021da177e4SLinus Torvalds 
2031da177e4SLinus Torvalds 	if (!dmasound.soft.stereo) {
2041da177e4SLinus Torvalds 		u_char *p = &frame[*frameUsed];
2051da177e4SLinus Torvalds 		count = min_t(unsigned long, userCount, frameLeft);
2061da177e4SLinus Torvalds 		used = count;
2071da177e4SLinus Torvalds 		while (count > 0) {
2081da177e4SLinus Torvalds 			u_char data;
2091da177e4SLinus Torvalds 			if (get_user(data, userPtr++))
2101da177e4SLinus Torvalds 				return -EFAULT;
2111da177e4SLinus Torvalds 			*p++ = data ^ 0x80;
2121da177e4SLinus Torvalds 			count--;
2131da177e4SLinus Torvalds 		}
2141da177e4SLinus Torvalds 	} else {
2151da177e4SLinus Torvalds 		u_short *p = (u_short *)&frame[*frameUsed];
2161da177e4SLinus Torvalds 		count = min_t(unsigned long, userCount, frameLeft)>>1;
2171da177e4SLinus Torvalds 		used = count*2;
2181da177e4SLinus Torvalds 		while (count > 0) {
2191da177e4SLinus Torvalds 			u_short data;
2201da177e4SLinus Torvalds 			if (get_user(data, ((u_short *)userPtr)++))
2211da177e4SLinus Torvalds 				return -EFAULT;
2221da177e4SLinus Torvalds 			*p++ = data ^ 0x8080;
2231da177e4SLinus Torvalds 			count--;
2241da177e4SLinus Torvalds 		}
2251da177e4SLinus Torvalds 	}
2261da177e4SLinus Torvalds 	*frameUsed += used;
2271da177e4SLinus Torvalds 	return used;
2281da177e4SLinus Torvalds }
2291da177e4SLinus Torvalds 
2301da177e4SLinus Torvalds 
2311da177e4SLinus Torvalds static ssize_t ata_ct_s16be(const u_char *userPtr, size_t userCount,
2321da177e4SLinus Torvalds 			    u_char frame[], ssize_t *frameUsed,
2331da177e4SLinus Torvalds 			    ssize_t frameLeft)
2341da177e4SLinus Torvalds {
2351da177e4SLinus Torvalds 	ssize_t count, used;
2361da177e4SLinus Torvalds 
2371da177e4SLinus Torvalds 	if (!dmasound.soft.stereo) {
2381da177e4SLinus Torvalds 		u_short *p = (u_short *)&frame[*frameUsed];
2391da177e4SLinus Torvalds 		count = min_t(unsigned long, userCount, frameLeft)>>1;
2401da177e4SLinus Torvalds 		used = count*2;
2411da177e4SLinus Torvalds 		while (count > 0) {
2421da177e4SLinus Torvalds 			u_short data;
2431da177e4SLinus Torvalds 			if (get_user(data, ((u_short *)userPtr)++))
2441da177e4SLinus Torvalds 				return -EFAULT;
2451da177e4SLinus Torvalds 			*p++ = data;
2461da177e4SLinus Torvalds 			*p++ = data;
2471da177e4SLinus Torvalds 			count--;
2481da177e4SLinus Torvalds 		}
2491da177e4SLinus Torvalds 		*frameUsed += used*2;
2501da177e4SLinus Torvalds 	} else {
2511da177e4SLinus Torvalds 		void *p = (u_short *)&frame[*frameUsed];
2521da177e4SLinus Torvalds 		count = min_t(unsigned long, userCount, frameLeft) & ~3;
2531da177e4SLinus Torvalds 		used = count;
2541da177e4SLinus Torvalds 		if (copy_from_user(p, userPtr, count))
2551da177e4SLinus Torvalds 			return -EFAULT;
2561da177e4SLinus Torvalds 		*frameUsed += used;
2571da177e4SLinus Torvalds 	}
2581da177e4SLinus Torvalds 	return used;
2591da177e4SLinus Torvalds }
2601da177e4SLinus Torvalds 
2611da177e4SLinus Torvalds 
2621da177e4SLinus Torvalds static ssize_t ata_ct_u16be(const u_char *userPtr, size_t userCount,
2631da177e4SLinus Torvalds 			    u_char frame[], ssize_t *frameUsed,
2641da177e4SLinus Torvalds 			    ssize_t frameLeft)
2651da177e4SLinus Torvalds {
2661da177e4SLinus Torvalds 	ssize_t count, used;
2671da177e4SLinus Torvalds 
2681da177e4SLinus Torvalds 	if (!dmasound.soft.stereo) {
2691da177e4SLinus Torvalds 		u_short *p = (u_short *)&frame[*frameUsed];
2701da177e4SLinus Torvalds 		count = min_t(unsigned long, userCount, frameLeft)>>1;
2711da177e4SLinus Torvalds 		used = count*2;
2721da177e4SLinus Torvalds 		while (count > 0) {
2731da177e4SLinus Torvalds 			u_short data;
2741da177e4SLinus Torvalds 			if (get_user(data, ((u_short *)userPtr)++))
2751da177e4SLinus Torvalds 				return -EFAULT;
2761da177e4SLinus Torvalds 			data ^= 0x8000;
2771da177e4SLinus Torvalds 			*p++ = data;
2781da177e4SLinus Torvalds 			*p++ = data;
2791da177e4SLinus Torvalds 			count--;
2801da177e4SLinus Torvalds 		}
2811da177e4SLinus Torvalds 		*frameUsed += used*2;
2821da177e4SLinus Torvalds 	} else {
2831da177e4SLinus Torvalds 		u_long *p = (u_long *)&frame[*frameUsed];
2841da177e4SLinus Torvalds 		count = min_t(unsigned long, userCount, frameLeft)>>2;
2851da177e4SLinus Torvalds 		used = count*4;
2861da177e4SLinus Torvalds 		while (count > 0) {
2871da177e4SLinus Torvalds 			u_long data;
2881da177e4SLinus Torvalds 			if (get_user(data, ((u_int *)userPtr)++))
2891da177e4SLinus Torvalds 				return -EFAULT;
2901da177e4SLinus Torvalds 			*p++ = data ^ 0x80008000;
2911da177e4SLinus Torvalds 			count--;
2921da177e4SLinus Torvalds 		}
2931da177e4SLinus Torvalds 		*frameUsed += used;
2941da177e4SLinus Torvalds 	}
2951da177e4SLinus Torvalds 	return used;
2961da177e4SLinus Torvalds }
2971da177e4SLinus Torvalds 
2981da177e4SLinus Torvalds 
2991da177e4SLinus Torvalds static ssize_t ata_ct_s16le(const u_char *userPtr, size_t userCount,
3001da177e4SLinus Torvalds 			    u_char frame[], ssize_t *frameUsed,
3011da177e4SLinus Torvalds 			    ssize_t frameLeft)
3021da177e4SLinus Torvalds {
3031da177e4SLinus Torvalds 	ssize_t count, used;
3041da177e4SLinus Torvalds 
3051da177e4SLinus Torvalds 	count = frameLeft;
3061da177e4SLinus Torvalds 	if (!dmasound.soft.stereo) {
3071da177e4SLinus Torvalds 		u_short *p = (u_short *)&frame[*frameUsed];
3081da177e4SLinus Torvalds 		count = min_t(unsigned long, userCount, frameLeft)>>1;
3091da177e4SLinus Torvalds 		used = count*2;
3101da177e4SLinus Torvalds 		while (count > 0) {
3111da177e4SLinus Torvalds 			u_short data;
3121da177e4SLinus Torvalds 			if (get_user(data, ((u_short *)userPtr)++))
3131da177e4SLinus Torvalds 				return -EFAULT;
3141da177e4SLinus Torvalds 			data = le2be16(data);
3151da177e4SLinus Torvalds 			*p++ = data;
3161da177e4SLinus Torvalds 			*p++ = data;
3171da177e4SLinus Torvalds 			count--;
3181da177e4SLinus Torvalds 		}
3191da177e4SLinus Torvalds 		*frameUsed += used*2;
3201da177e4SLinus Torvalds 	} else {
3211da177e4SLinus Torvalds 		u_long *p = (u_long *)&frame[*frameUsed];
3221da177e4SLinus Torvalds 		count = min_t(unsigned long, userCount, frameLeft)>>2;
3231da177e4SLinus Torvalds 		used = count*4;
3241da177e4SLinus Torvalds 		while (count > 0) {
3251da177e4SLinus Torvalds 			u_long data;
3261da177e4SLinus Torvalds 			if (get_user(data, ((u_int *)userPtr)++))
3271da177e4SLinus Torvalds 				return -EFAULT;
3281da177e4SLinus Torvalds 			data = le2be16dbl(data);
3291da177e4SLinus Torvalds 			*p++ = data;
3301da177e4SLinus Torvalds 			count--;
3311da177e4SLinus Torvalds 		}
3321da177e4SLinus Torvalds 		*frameUsed += used;
3331da177e4SLinus Torvalds 	}
3341da177e4SLinus Torvalds 	return used;
3351da177e4SLinus Torvalds }
3361da177e4SLinus Torvalds 
3371da177e4SLinus Torvalds 
3381da177e4SLinus Torvalds static ssize_t ata_ct_u16le(const u_char *userPtr, size_t userCount,
3391da177e4SLinus Torvalds 			    u_char frame[], ssize_t *frameUsed,
3401da177e4SLinus Torvalds 			    ssize_t frameLeft)
3411da177e4SLinus Torvalds {
3421da177e4SLinus Torvalds 	ssize_t count, used;
3431da177e4SLinus Torvalds 
3441da177e4SLinus Torvalds 	count = frameLeft;
3451da177e4SLinus Torvalds 	if (!dmasound.soft.stereo) {
3461da177e4SLinus Torvalds 		u_short *p = (u_short *)&frame[*frameUsed];
3471da177e4SLinus Torvalds 		count = min_t(unsigned long, userCount, frameLeft)>>1;
3481da177e4SLinus Torvalds 		used = count*2;
3491da177e4SLinus Torvalds 		while (count > 0) {
3501da177e4SLinus Torvalds 			u_short data;
3511da177e4SLinus Torvalds 			if (get_user(data, ((u_short *)userPtr)++))
3521da177e4SLinus Torvalds 				return -EFAULT;
3531da177e4SLinus Torvalds 			data = le2be16(data) ^ 0x8000;
3541da177e4SLinus Torvalds 			*p++ = data;
3551da177e4SLinus Torvalds 			*p++ = data;
3561da177e4SLinus Torvalds 		}
3571da177e4SLinus Torvalds 		*frameUsed += used*2;
3581da177e4SLinus Torvalds 	} else {
3591da177e4SLinus Torvalds 		u_long *p = (u_long *)&frame[*frameUsed];
3601da177e4SLinus Torvalds 		count = min_t(unsigned long, userCount, frameLeft)>>2;
3611da177e4SLinus Torvalds 		used = count;
3621da177e4SLinus Torvalds 		while (count > 0) {
3631da177e4SLinus Torvalds 			u_long data;
3641da177e4SLinus Torvalds 			if (get_user(data, ((u_int *)userPtr)++))
3651da177e4SLinus Torvalds 				return -EFAULT;
3661da177e4SLinus Torvalds 			data = le2be16dbl(data) ^ 0x80008000;
3671da177e4SLinus Torvalds 			*p++ = data;
3681da177e4SLinus Torvalds 			count--;
3691da177e4SLinus Torvalds 		}
3701da177e4SLinus Torvalds 		*frameUsed += used;
3711da177e4SLinus Torvalds 	}
3721da177e4SLinus Torvalds 	return used;
3731da177e4SLinus Torvalds }
3741da177e4SLinus Torvalds 
3751da177e4SLinus Torvalds 
3761da177e4SLinus Torvalds static ssize_t ata_ctx_law(const u_char *userPtr, size_t userCount,
3771da177e4SLinus Torvalds 			   u_char frame[], ssize_t *frameUsed,
3781da177e4SLinus Torvalds 			   ssize_t frameLeft)
3791da177e4SLinus Torvalds {
3801da177e4SLinus Torvalds 	char *table = dmasound.soft.format == AFMT_MU_LAW ? dmasound_ulaw2dma8
3811da177e4SLinus Torvalds 							  : dmasound_alaw2dma8;
3821da177e4SLinus Torvalds 	/* this should help gcc to stuff everything into registers */
3831da177e4SLinus Torvalds 	long bal = expand_bal;
3841da177e4SLinus Torvalds 	long hSpeed = dmasound.hard.speed, sSpeed = dmasound.soft.speed;
3851da177e4SLinus Torvalds 	ssize_t used, usedf;
3861da177e4SLinus Torvalds 
3871da177e4SLinus Torvalds 	used = userCount;
3881da177e4SLinus Torvalds 	usedf = frameLeft;
3891da177e4SLinus Torvalds 	if (!dmasound.soft.stereo) {
3901da177e4SLinus Torvalds 		u_char *p = &frame[*frameUsed];
3911da177e4SLinus Torvalds 		u_char data = expand_data;
3921da177e4SLinus Torvalds 		while (frameLeft) {
3931da177e4SLinus Torvalds 			u_char c;
3941da177e4SLinus Torvalds 			if (bal < 0) {
3951da177e4SLinus Torvalds 				if (!userCount)
3961da177e4SLinus Torvalds 					break;
3971da177e4SLinus Torvalds 				if (get_user(c, userPtr++))
3981da177e4SLinus Torvalds 					return -EFAULT;
3991da177e4SLinus Torvalds 				data = table[c];
4001da177e4SLinus Torvalds 				userCount--;
4011da177e4SLinus Torvalds 				bal += hSpeed;
4021da177e4SLinus Torvalds 			}
4031da177e4SLinus Torvalds 			*p++ = data;
4041da177e4SLinus Torvalds 			frameLeft--;
4051da177e4SLinus Torvalds 			bal -= sSpeed;
4061da177e4SLinus Torvalds 		}
4071da177e4SLinus Torvalds 		expand_data = data;
4081da177e4SLinus Torvalds 	} else {
4091da177e4SLinus Torvalds 		u_short *p = (u_short *)&frame[*frameUsed];
4101da177e4SLinus Torvalds 		u_short data = expand_data;
4111da177e4SLinus Torvalds 		while (frameLeft >= 2) {
4121da177e4SLinus Torvalds 			u_char c;
4131da177e4SLinus Torvalds 			if (bal < 0) {
4141da177e4SLinus Torvalds 				if (userCount < 2)
4151da177e4SLinus Torvalds 					break;
4161da177e4SLinus Torvalds 				if (get_user(c, userPtr++))
4171da177e4SLinus Torvalds 					return -EFAULT;
4181da177e4SLinus Torvalds 				data = table[c] << 8;
4191da177e4SLinus Torvalds 				if (get_user(c, userPtr++))
4201da177e4SLinus Torvalds 					return -EFAULT;
4211da177e4SLinus Torvalds 				data |= table[c];
4221da177e4SLinus Torvalds 				userCount -= 2;
4231da177e4SLinus Torvalds 				bal += hSpeed;
4241da177e4SLinus Torvalds 			}
4251da177e4SLinus Torvalds 			*p++ = data;
4261da177e4SLinus Torvalds 			frameLeft -= 2;
4271da177e4SLinus Torvalds 			bal -= sSpeed;
4281da177e4SLinus Torvalds 		}
4291da177e4SLinus Torvalds 		expand_data = data;
4301da177e4SLinus Torvalds 	}
4311da177e4SLinus Torvalds 	expand_bal = bal;
4321da177e4SLinus Torvalds 	used -= userCount;
4331da177e4SLinus Torvalds 	*frameUsed += usedf-frameLeft;
4341da177e4SLinus Torvalds 	return used;
4351da177e4SLinus Torvalds }
4361da177e4SLinus Torvalds 
4371da177e4SLinus Torvalds 
4381da177e4SLinus Torvalds static ssize_t ata_ctx_s8(const u_char *userPtr, size_t userCount,
4391da177e4SLinus Torvalds 			  u_char frame[], ssize_t *frameUsed,
4401da177e4SLinus Torvalds 			  ssize_t frameLeft)
4411da177e4SLinus Torvalds {
4421da177e4SLinus Torvalds 	/* this should help gcc to stuff everything into registers */
4431da177e4SLinus Torvalds 	long bal = expand_bal;
4441da177e4SLinus Torvalds 	long hSpeed = dmasound.hard.speed, sSpeed = dmasound.soft.speed;
4451da177e4SLinus Torvalds 	ssize_t used, usedf;
4461da177e4SLinus Torvalds 
4471da177e4SLinus Torvalds 	used = userCount;
4481da177e4SLinus Torvalds 	usedf = frameLeft;
4491da177e4SLinus Torvalds 	if (!dmasound.soft.stereo) {
4501da177e4SLinus Torvalds 		u_char *p = &frame[*frameUsed];
4511da177e4SLinus Torvalds 		u_char data = expand_data;
4521da177e4SLinus Torvalds 		while (frameLeft) {
4531da177e4SLinus Torvalds 			if (bal < 0) {
4541da177e4SLinus Torvalds 				if (!userCount)
4551da177e4SLinus Torvalds 					break;
4561da177e4SLinus Torvalds 				if (get_user(data, userPtr++))
4571da177e4SLinus Torvalds 					return -EFAULT;
4581da177e4SLinus Torvalds 				userCount--;
4591da177e4SLinus Torvalds 				bal += hSpeed;
4601da177e4SLinus Torvalds 			}
4611da177e4SLinus Torvalds 			*p++ = data;
4621da177e4SLinus Torvalds 			frameLeft--;
4631da177e4SLinus Torvalds 			bal -= sSpeed;
4641da177e4SLinus Torvalds 		}
4651da177e4SLinus Torvalds 		expand_data = data;
4661da177e4SLinus Torvalds 	} else {
4671da177e4SLinus Torvalds 		u_short *p = (u_short *)&frame[*frameUsed];
4681da177e4SLinus Torvalds 		u_short data = expand_data;
4691da177e4SLinus Torvalds 		while (frameLeft >= 2) {
4701da177e4SLinus Torvalds 			if (bal < 0) {
4711da177e4SLinus Torvalds 				if (userCount < 2)
4721da177e4SLinus Torvalds 					break;
4731da177e4SLinus Torvalds 				if (get_user(data, ((u_short *)userPtr)++))
4741da177e4SLinus Torvalds 					return -EFAULT;
4751da177e4SLinus Torvalds 				userCount -= 2;
4761da177e4SLinus Torvalds 				bal += hSpeed;
4771da177e4SLinus Torvalds 			}
4781da177e4SLinus Torvalds 			*p++ = data;
4791da177e4SLinus Torvalds 			frameLeft -= 2;
4801da177e4SLinus Torvalds 			bal -= sSpeed;
4811da177e4SLinus Torvalds 		}
4821da177e4SLinus Torvalds 		expand_data = data;
4831da177e4SLinus Torvalds 	}
4841da177e4SLinus Torvalds 	expand_bal = bal;
4851da177e4SLinus Torvalds 	used -= userCount;
4861da177e4SLinus Torvalds 	*frameUsed += usedf-frameLeft;
4871da177e4SLinus Torvalds 	return used;
4881da177e4SLinus Torvalds }
4891da177e4SLinus Torvalds 
4901da177e4SLinus Torvalds 
4911da177e4SLinus Torvalds static ssize_t ata_ctx_u8(const u_char *userPtr, size_t userCount,
4921da177e4SLinus Torvalds 			  u_char frame[], ssize_t *frameUsed,
4931da177e4SLinus Torvalds 			  ssize_t frameLeft)
4941da177e4SLinus Torvalds {
4951da177e4SLinus Torvalds 	/* this should help gcc to stuff everything into registers */
4961da177e4SLinus Torvalds 	long bal = expand_bal;
4971da177e4SLinus Torvalds 	long hSpeed = dmasound.hard.speed, sSpeed = dmasound.soft.speed;
4981da177e4SLinus Torvalds 	ssize_t used, usedf;
4991da177e4SLinus Torvalds 
5001da177e4SLinus Torvalds 	used = userCount;
5011da177e4SLinus Torvalds 	usedf = frameLeft;
5021da177e4SLinus Torvalds 	if (!dmasound.soft.stereo) {
5031da177e4SLinus Torvalds 		u_char *p = &frame[*frameUsed];
5041da177e4SLinus Torvalds 		u_char data = expand_data;
5051da177e4SLinus Torvalds 		while (frameLeft) {
5061da177e4SLinus Torvalds 			if (bal < 0) {
5071da177e4SLinus Torvalds 				if (!userCount)
5081da177e4SLinus Torvalds 					break;
5091da177e4SLinus Torvalds 				if (get_user(data, userPtr++))
5101da177e4SLinus Torvalds 					return -EFAULT;
5111da177e4SLinus Torvalds 				data ^= 0x80;
5121da177e4SLinus Torvalds 				userCount--;
5131da177e4SLinus Torvalds 				bal += hSpeed;
5141da177e4SLinus Torvalds 			}
5151da177e4SLinus Torvalds 			*p++ = data;
5161da177e4SLinus Torvalds 			frameLeft--;
5171da177e4SLinus Torvalds 			bal -= sSpeed;
5181da177e4SLinus Torvalds 		}
5191da177e4SLinus Torvalds 		expand_data = data;
5201da177e4SLinus Torvalds 	} else {
5211da177e4SLinus Torvalds 		u_short *p = (u_short *)&frame[*frameUsed];
5221da177e4SLinus Torvalds 		u_short data = expand_data;
5231da177e4SLinus Torvalds 		while (frameLeft >= 2) {
5241da177e4SLinus Torvalds 			if (bal < 0) {
5251da177e4SLinus Torvalds 				if (userCount < 2)
5261da177e4SLinus Torvalds 					break;
5271da177e4SLinus Torvalds 				if (get_user(data, ((u_short *)userPtr)++))
5281da177e4SLinus Torvalds 					return -EFAULT;
5291da177e4SLinus Torvalds 				data ^= 0x8080;
5301da177e4SLinus Torvalds 				userCount -= 2;
5311da177e4SLinus Torvalds 				bal += hSpeed;
5321da177e4SLinus Torvalds 			}
5331da177e4SLinus Torvalds 			*p++ = data;
5341da177e4SLinus Torvalds 			frameLeft -= 2;
5351da177e4SLinus Torvalds 			bal -= sSpeed;
5361da177e4SLinus Torvalds 		}
5371da177e4SLinus Torvalds 		expand_data = data;
5381da177e4SLinus Torvalds 	}
5391da177e4SLinus Torvalds 	expand_bal = bal;
5401da177e4SLinus Torvalds 	used -= userCount;
5411da177e4SLinus Torvalds 	*frameUsed += usedf-frameLeft;
5421da177e4SLinus Torvalds 	return used;
5431da177e4SLinus Torvalds }
5441da177e4SLinus Torvalds 
5451da177e4SLinus Torvalds 
5461da177e4SLinus Torvalds static ssize_t ata_ctx_s16be(const u_char *userPtr, size_t userCount,
5471da177e4SLinus Torvalds 			     u_char frame[], ssize_t *frameUsed,
5481da177e4SLinus Torvalds 			     ssize_t frameLeft)
5491da177e4SLinus Torvalds {
5501da177e4SLinus Torvalds 	/* this should help gcc to stuff everything into registers */
5511da177e4SLinus Torvalds 	long bal = expand_bal;
5521da177e4SLinus Torvalds 	long hSpeed = dmasound.hard.speed, sSpeed = dmasound.soft.speed;
5531da177e4SLinus Torvalds 	ssize_t used, usedf;
5541da177e4SLinus Torvalds 
5551da177e4SLinus Torvalds 	used = userCount;
5561da177e4SLinus Torvalds 	usedf = frameLeft;
5571da177e4SLinus Torvalds 	if (!dmasound.soft.stereo) {
5581da177e4SLinus Torvalds 		u_short *p = (u_short *)&frame[*frameUsed];
5591da177e4SLinus Torvalds 		u_short data = expand_data;
5601da177e4SLinus Torvalds 		while (frameLeft >= 4) {
5611da177e4SLinus Torvalds 			if (bal < 0) {
5621da177e4SLinus Torvalds 				if (userCount < 2)
5631da177e4SLinus Torvalds 					break;
5641da177e4SLinus Torvalds 				if (get_user(data, ((u_short *)userPtr)++))
5651da177e4SLinus Torvalds 					return -EFAULT;
5661da177e4SLinus Torvalds 				userCount -= 2;
5671da177e4SLinus Torvalds 				bal += hSpeed;
5681da177e4SLinus Torvalds 			}
5691da177e4SLinus Torvalds 			*p++ = data;
5701da177e4SLinus Torvalds 			*p++ = data;
5711da177e4SLinus Torvalds 			frameLeft -= 4;
5721da177e4SLinus Torvalds 			bal -= sSpeed;
5731da177e4SLinus Torvalds 		}
5741da177e4SLinus Torvalds 		expand_data = data;
5751da177e4SLinus Torvalds 	} else {
5761da177e4SLinus Torvalds 		u_long *p = (u_long *)&frame[*frameUsed];
5771da177e4SLinus Torvalds 		u_long data = expand_data;
5781da177e4SLinus Torvalds 		while (frameLeft >= 4) {
5791da177e4SLinus Torvalds 			if (bal < 0) {
5801da177e4SLinus Torvalds 				if (userCount < 4)
5811da177e4SLinus Torvalds 					break;
5821da177e4SLinus Torvalds 				if (get_user(data, ((u_int *)userPtr)++))
5831da177e4SLinus Torvalds 					return -EFAULT;
5841da177e4SLinus Torvalds 				userCount -= 4;
5851da177e4SLinus Torvalds 				bal += hSpeed;
5861da177e4SLinus Torvalds 			}
5871da177e4SLinus Torvalds 			*p++ = data;
5881da177e4SLinus Torvalds 			frameLeft -= 4;
5891da177e4SLinus Torvalds 			bal -= sSpeed;
5901da177e4SLinus Torvalds 		}
5911da177e4SLinus Torvalds 		expand_data = data;
5921da177e4SLinus Torvalds 	}
5931da177e4SLinus Torvalds 	expand_bal = bal;
5941da177e4SLinus Torvalds 	used -= userCount;
5951da177e4SLinus Torvalds 	*frameUsed += usedf-frameLeft;
5961da177e4SLinus Torvalds 	return used;
5971da177e4SLinus Torvalds }
5981da177e4SLinus Torvalds 
5991da177e4SLinus Torvalds 
6001da177e4SLinus Torvalds static ssize_t ata_ctx_u16be(const u_char *userPtr, size_t userCount,
6011da177e4SLinus Torvalds 			     u_char frame[], ssize_t *frameUsed,
6021da177e4SLinus Torvalds 			     ssize_t frameLeft)
6031da177e4SLinus Torvalds {
6041da177e4SLinus Torvalds 	/* this should help gcc to stuff everything into registers */
6051da177e4SLinus Torvalds 	long bal = expand_bal;
6061da177e4SLinus Torvalds 	long hSpeed = dmasound.hard.speed, sSpeed = dmasound.soft.speed;
6071da177e4SLinus Torvalds 	ssize_t used, usedf;
6081da177e4SLinus Torvalds 
6091da177e4SLinus Torvalds 	used = userCount;
6101da177e4SLinus Torvalds 	usedf = frameLeft;
6111da177e4SLinus Torvalds 	if (!dmasound.soft.stereo) {
6121da177e4SLinus Torvalds 		u_short *p = (u_short *)&frame[*frameUsed];
6131da177e4SLinus Torvalds 		u_short data = expand_data;
6141da177e4SLinus Torvalds 		while (frameLeft >= 4) {
6151da177e4SLinus Torvalds 			if (bal < 0) {
6161da177e4SLinus Torvalds 				if (userCount < 2)
6171da177e4SLinus Torvalds 					break;
6181da177e4SLinus Torvalds 				if (get_user(data, ((u_short *)userPtr)++))
6191da177e4SLinus Torvalds 					return -EFAULT;
6201da177e4SLinus Torvalds 				data ^= 0x8000;
6211da177e4SLinus Torvalds 				userCount -= 2;
6221da177e4SLinus Torvalds 				bal += hSpeed;
6231da177e4SLinus Torvalds 			}
6241da177e4SLinus Torvalds 			*p++ = data;
6251da177e4SLinus Torvalds 			*p++ = data;
6261da177e4SLinus Torvalds 			frameLeft -= 4;
6271da177e4SLinus Torvalds 			bal -= sSpeed;
6281da177e4SLinus Torvalds 		}
6291da177e4SLinus Torvalds 		expand_data = data;
6301da177e4SLinus Torvalds 	} else {
6311da177e4SLinus Torvalds 		u_long *p = (u_long *)&frame[*frameUsed];
6321da177e4SLinus Torvalds 		u_long data = expand_data;
6331da177e4SLinus Torvalds 		while (frameLeft >= 4) {
6341da177e4SLinus Torvalds 			if (bal < 0) {
6351da177e4SLinus Torvalds 				if (userCount < 4)
6361da177e4SLinus Torvalds 					break;
6371da177e4SLinus Torvalds 				if (get_user(data, ((u_int *)userPtr)++))
6381da177e4SLinus Torvalds 					return -EFAULT;
6391da177e4SLinus Torvalds 				data ^= 0x80008000;
6401da177e4SLinus Torvalds 				userCount -= 4;
6411da177e4SLinus Torvalds 				bal += hSpeed;
6421da177e4SLinus Torvalds 			}
6431da177e4SLinus Torvalds 			*p++ = data;
6441da177e4SLinus Torvalds 			frameLeft -= 4;
6451da177e4SLinus Torvalds 			bal -= sSpeed;
6461da177e4SLinus Torvalds 		}
6471da177e4SLinus Torvalds 		expand_data = data;
6481da177e4SLinus Torvalds 	}
6491da177e4SLinus Torvalds 	expand_bal = bal;
6501da177e4SLinus Torvalds 	used -= userCount;
6511da177e4SLinus Torvalds 	*frameUsed += usedf-frameLeft;
6521da177e4SLinus Torvalds 	return used;
6531da177e4SLinus Torvalds }
6541da177e4SLinus Torvalds 
6551da177e4SLinus Torvalds 
6561da177e4SLinus Torvalds static ssize_t ata_ctx_s16le(const u_char *userPtr, size_t userCount,
6571da177e4SLinus Torvalds 			     u_char frame[], ssize_t *frameUsed,
6581da177e4SLinus Torvalds 			     ssize_t frameLeft)
6591da177e4SLinus Torvalds {
6601da177e4SLinus Torvalds 	/* this should help gcc to stuff everything into registers */
6611da177e4SLinus Torvalds 	long bal = expand_bal;
6621da177e4SLinus Torvalds 	long hSpeed = dmasound.hard.speed, sSpeed = dmasound.soft.speed;
6631da177e4SLinus Torvalds 	ssize_t used, usedf;
6641da177e4SLinus Torvalds 
6651da177e4SLinus Torvalds 	used = userCount;
6661da177e4SLinus Torvalds 	usedf = frameLeft;
6671da177e4SLinus Torvalds 	if (!dmasound.soft.stereo) {
6681da177e4SLinus Torvalds 		u_short *p = (u_short *)&frame[*frameUsed];
6691da177e4SLinus Torvalds 		u_short data = expand_data;
6701da177e4SLinus Torvalds 		while (frameLeft >= 4) {
6711da177e4SLinus Torvalds 			if (bal < 0) {
6721da177e4SLinus Torvalds 				if (userCount < 2)
6731da177e4SLinus Torvalds 					break;
6741da177e4SLinus Torvalds 				if (get_user(data, ((u_short *)userPtr)++))
6751da177e4SLinus Torvalds 					return -EFAULT;
6761da177e4SLinus Torvalds 				data = le2be16(data);
6771da177e4SLinus Torvalds 				userCount -= 2;
6781da177e4SLinus Torvalds 				bal += hSpeed;
6791da177e4SLinus Torvalds 			}
6801da177e4SLinus Torvalds 			*p++ = data;
6811da177e4SLinus Torvalds 			*p++ = data;
6821da177e4SLinus Torvalds 			frameLeft -= 4;
6831da177e4SLinus Torvalds 			bal -= sSpeed;
6841da177e4SLinus Torvalds 		}
6851da177e4SLinus Torvalds 		expand_data = data;
6861da177e4SLinus Torvalds 	} else {
6871da177e4SLinus Torvalds 		u_long *p = (u_long *)&frame[*frameUsed];
6881da177e4SLinus Torvalds 		u_long data = expand_data;
6891da177e4SLinus Torvalds 		while (frameLeft >= 4) {
6901da177e4SLinus Torvalds 			if (bal < 0) {
6911da177e4SLinus Torvalds 				if (userCount < 4)
6921da177e4SLinus Torvalds 					break;
6931da177e4SLinus Torvalds 				if (get_user(data, ((u_int *)userPtr)++))
6941da177e4SLinus Torvalds 					return -EFAULT;
6951da177e4SLinus Torvalds 				data = le2be16dbl(data);
6961da177e4SLinus Torvalds 				userCount -= 4;
6971da177e4SLinus Torvalds 				bal += hSpeed;
6981da177e4SLinus Torvalds 			}
6991da177e4SLinus Torvalds 			*p++ = data;
7001da177e4SLinus Torvalds 			frameLeft -= 4;
7011da177e4SLinus Torvalds 			bal -= sSpeed;
7021da177e4SLinus Torvalds 		}
7031da177e4SLinus Torvalds 		expand_data = data;
7041da177e4SLinus Torvalds 	}
7051da177e4SLinus Torvalds 	expand_bal = bal;
7061da177e4SLinus Torvalds 	used -= userCount;
7071da177e4SLinus Torvalds 	*frameUsed += usedf-frameLeft;
7081da177e4SLinus Torvalds 	return used;
7091da177e4SLinus Torvalds }
7101da177e4SLinus Torvalds 
7111da177e4SLinus Torvalds 
7121da177e4SLinus Torvalds static ssize_t ata_ctx_u16le(const u_char *userPtr, size_t userCount,
7131da177e4SLinus Torvalds 			     u_char frame[], ssize_t *frameUsed,
7141da177e4SLinus Torvalds 			     ssize_t frameLeft)
7151da177e4SLinus Torvalds {
7161da177e4SLinus Torvalds 	/* this should help gcc to stuff everything into registers */
7171da177e4SLinus Torvalds 	long bal = expand_bal;
7181da177e4SLinus Torvalds 	long hSpeed = dmasound.hard.speed, sSpeed = dmasound.soft.speed;
7191da177e4SLinus Torvalds 	ssize_t used, usedf;
7201da177e4SLinus Torvalds 
7211da177e4SLinus Torvalds 	used = userCount;
7221da177e4SLinus Torvalds 	usedf = frameLeft;
7231da177e4SLinus Torvalds 	if (!dmasound.soft.stereo) {
7241da177e4SLinus Torvalds 		u_short *p = (u_short *)&frame[*frameUsed];
7251da177e4SLinus Torvalds 		u_short data = expand_data;
7261da177e4SLinus Torvalds 		while (frameLeft >= 4) {
7271da177e4SLinus Torvalds 			if (bal < 0) {
7281da177e4SLinus Torvalds 				if (userCount < 2)
7291da177e4SLinus Torvalds 					break;
7301da177e4SLinus Torvalds 				if (get_user(data, ((u_short *)userPtr)++))
7311da177e4SLinus Torvalds 					return -EFAULT;
7321da177e4SLinus Torvalds 				data = le2be16(data) ^ 0x8000;
7331da177e4SLinus Torvalds 				userCount -= 2;
7341da177e4SLinus Torvalds 				bal += hSpeed;
7351da177e4SLinus Torvalds 			}
7361da177e4SLinus Torvalds 			*p++ = data;
7371da177e4SLinus Torvalds 			*p++ = data;
7381da177e4SLinus Torvalds 			frameLeft -= 4;
7391da177e4SLinus Torvalds 			bal -= sSpeed;
7401da177e4SLinus Torvalds 		}
7411da177e4SLinus Torvalds 		expand_data = data;
7421da177e4SLinus Torvalds 	} else {
7431da177e4SLinus Torvalds 		u_long *p = (u_long *)&frame[*frameUsed];
7441da177e4SLinus Torvalds 		u_long data = expand_data;
7451da177e4SLinus Torvalds 		while (frameLeft >= 4) {
7461da177e4SLinus Torvalds 			if (bal < 0) {
7471da177e4SLinus Torvalds 				if (userCount < 4)
7481da177e4SLinus Torvalds 					break;
7491da177e4SLinus Torvalds 				if (get_user(data, ((u_int *)userPtr)++))
7501da177e4SLinus Torvalds 					return -EFAULT;
7511da177e4SLinus Torvalds 				data = le2be16dbl(data) ^ 0x80008000;
7521da177e4SLinus Torvalds 				userCount -= 4;
7531da177e4SLinus Torvalds 				bal += hSpeed;
7541da177e4SLinus Torvalds 			}
7551da177e4SLinus Torvalds 			*p++ = data;
7561da177e4SLinus Torvalds 			frameLeft -= 4;
7571da177e4SLinus Torvalds 			bal -= sSpeed;
7581da177e4SLinus Torvalds 		}
7591da177e4SLinus Torvalds 		expand_data = data;
7601da177e4SLinus Torvalds 	}
7611da177e4SLinus Torvalds 	expand_bal = bal;
7621da177e4SLinus Torvalds 	used -= userCount;
7631da177e4SLinus Torvalds 	*frameUsed += usedf-frameLeft;
7641da177e4SLinus Torvalds 	return used;
7651da177e4SLinus Torvalds }
7661da177e4SLinus Torvalds 
7671da177e4SLinus Torvalds 
7681da177e4SLinus Torvalds static TRANS transTTNormal = {
7691da177e4SLinus Torvalds 	.ct_ulaw	= ata_ct_law,
7701da177e4SLinus Torvalds 	.ct_alaw	= ata_ct_law,
7711da177e4SLinus Torvalds 	.ct_s8		= ata_ct_s8,
7721da177e4SLinus Torvalds 	.ct_u8		= ata_ct_u8,
7731da177e4SLinus Torvalds };
7741da177e4SLinus Torvalds 
7751da177e4SLinus Torvalds static TRANS transTTExpanding = {
7761da177e4SLinus Torvalds 	.ct_ulaw	= ata_ctx_law,
7771da177e4SLinus Torvalds 	.ct_alaw	= ata_ctx_law,
7781da177e4SLinus Torvalds 	.ct_s8		= ata_ctx_s8,
7791da177e4SLinus Torvalds 	.ct_u8		= ata_ctx_u8,
7801da177e4SLinus Torvalds };
7811da177e4SLinus Torvalds 
7821da177e4SLinus Torvalds static TRANS transFalconNormal = {
7831da177e4SLinus Torvalds 	.ct_ulaw	= ata_ct_law,
7841da177e4SLinus Torvalds 	.ct_alaw	= ata_ct_law,
7851da177e4SLinus Torvalds 	.ct_s8		= ata_ct_s8,
7861da177e4SLinus Torvalds 	.ct_u8		= ata_ct_u8,
7871da177e4SLinus Torvalds 	.ct_s16be	= ata_ct_s16be,
7881da177e4SLinus Torvalds 	.ct_u16be	= ata_ct_u16be,
7891da177e4SLinus Torvalds 	.ct_s16le	= ata_ct_s16le,
7901da177e4SLinus Torvalds 	.ct_u16le	= ata_ct_u16le
7911da177e4SLinus Torvalds };
7921da177e4SLinus Torvalds 
7931da177e4SLinus Torvalds static TRANS transFalconExpanding = {
7941da177e4SLinus Torvalds 	.ct_ulaw	= ata_ctx_law,
7951da177e4SLinus Torvalds 	.ct_alaw	= ata_ctx_law,
7961da177e4SLinus Torvalds 	.ct_s8		= ata_ctx_s8,
7971da177e4SLinus Torvalds 	.ct_u8		= ata_ctx_u8,
7981da177e4SLinus Torvalds 	.ct_s16be	= ata_ctx_s16be,
7991da177e4SLinus Torvalds 	.ct_u16be	= ata_ctx_u16be,
8001da177e4SLinus Torvalds 	.ct_s16le	= ata_ctx_s16le,
8011da177e4SLinus Torvalds 	.ct_u16le	= ata_ctx_u16le,
8021da177e4SLinus Torvalds };
8031da177e4SLinus Torvalds 
8041da177e4SLinus Torvalds 
8051da177e4SLinus Torvalds /*** Low level stuff *********************************************************/
8061da177e4SLinus Torvalds 
8071da177e4SLinus Torvalds 
8081da177e4SLinus Torvalds 
8091da177e4SLinus Torvalds /*
8101da177e4SLinus Torvalds  * Atari (TT/Falcon)
8111da177e4SLinus Torvalds  */
8121da177e4SLinus Torvalds 
813*1ef64e67SAl Viro static void *AtaAlloc(unsigned int size, gfp_t flags)
8141da177e4SLinus Torvalds {
8151da177e4SLinus Torvalds 	return atari_stram_alloc(size, "dmasound");
8161da177e4SLinus Torvalds }
8171da177e4SLinus Torvalds 
8181da177e4SLinus Torvalds static void AtaFree(void *obj, unsigned int size)
8191da177e4SLinus Torvalds {
8201da177e4SLinus Torvalds 	atari_stram_free( obj );
8211da177e4SLinus Torvalds }
8221da177e4SLinus Torvalds 
8231da177e4SLinus Torvalds static int __init AtaIrqInit(void)
8241da177e4SLinus Torvalds {
8251da177e4SLinus Torvalds 	/* Set up timer A. Timer A
8261da177e4SLinus Torvalds 	   will receive a signal upon end of playing from the sound
8271da177e4SLinus Torvalds 	   hardware. Furthermore Timer A is able to count events
8281da177e4SLinus Torvalds 	   and will cause an interrupt after a programmed number
8291da177e4SLinus Torvalds 	   of events. So all we need to keep the music playing is
8301da177e4SLinus Torvalds 	   to provide the sound hardware with new data upon
8311da177e4SLinus Torvalds 	   an interrupt from timer A. */
8321da177e4SLinus Torvalds 	mfp.tim_ct_a = 0;	/* ++roman: Stop timer before programming! */
8331da177e4SLinus Torvalds 	mfp.tim_dt_a = 1;	/* Cause interrupt after first event. */
8341da177e4SLinus Torvalds 	mfp.tim_ct_a = 8;	/* Turn on event counting. */
8351da177e4SLinus Torvalds 	/* Register interrupt handler. */
8361da177e4SLinus Torvalds 	request_irq(IRQ_MFP_TIMA, AtaInterrupt, IRQ_TYPE_SLOW, "DMA sound",
8371da177e4SLinus Torvalds 		    AtaInterrupt);
8381da177e4SLinus Torvalds 	mfp.int_en_a |= 0x20;	/* Turn interrupt on. */
8391da177e4SLinus Torvalds 	mfp.int_mk_a |= 0x20;
8401da177e4SLinus Torvalds 	return 1;
8411da177e4SLinus Torvalds }
8421da177e4SLinus Torvalds 
8431da177e4SLinus Torvalds #ifdef MODULE
8441da177e4SLinus Torvalds static void AtaIrqCleanUp(void)
8451da177e4SLinus Torvalds {
8461da177e4SLinus Torvalds 	mfp.tim_ct_a = 0;	/* stop timer */
8471da177e4SLinus Torvalds 	mfp.int_en_a &= ~0x20;	/* turn interrupt off */
8481da177e4SLinus Torvalds 	free_irq(IRQ_MFP_TIMA, AtaInterrupt);
8491da177e4SLinus Torvalds }
8501da177e4SLinus Torvalds #endif /* MODULE */
8511da177e4SLinus Torvalds 
8521da177e4SLinus Torvalds 
8531da177e4SLinus Torvalds #define TONE_VOXWARE_TO_DB(v) \
8541da177e4SLinus Torvalds 	(((v) < 0) ? -12 : ((v) > 100) ? 12 : ((v) - 50) * 6 / 25)
8551da177e4SLinus Torvalds #define TONE_DB_TO_VOXWARE(v) (((v) * 25 + ((v) > 0 ? 5 : -5)) / 6 + 50)
8561da177e4SLinus Torvalds 
8571da177e4SLinus Torvalds 
8581da177e4SLinus Torvalds static int AtaSetBass(int bass)
8591da177e4SLinus Torvalds {
8601da177e4SLinus Torvalds 	dmasound.bass = TONE_VOXWARE_TO_DB(bass);
8611da177e4SLinus Torvalds 	atari_microwire_cmd(MW_LM1992_BASS(dmasound.bass));
8621da177e4SLinus Torvalds 	return TONE_DB_TO_VOXWARE(dmasound.bass);
8631da177e4SLinus Torvalds }
8641da177e4SLinus Torvalds 
8651da177e4SLinus Torvalds 
8661da177e4SLinus Torvalds static int AtaSetTreble(int treble)
8671da177e4SLinus Torvalds {
8681da177e4SLinus Torvalds 	dmasound.treble = TONE_VOXWARE_TO_DB(treble);
8691da177e4SLinus Torvalds 	atari_microwire_cmd(MW_LM1992_TREBLE(dmasound.treble));
8701da177e4SLinus Torvalds 	return TONE_DB_TO_VOXWARE(dmasound.treble);
8711da177e4SLinus Torvalds }
8721da177e4SLinus Torvalds 
8731da177e4SLinus Torvalds 
8741da177e4SLinus Torvalds 
8751da177e4SLinus Torvalds /*
8761da177e4SLinus Torvalds  * TT
8771da177e4SLinus Torvalds  */
8781da177e4SLinus Torvalds 
8791da177e4SLinus Torvalds 
8801da177e4SLinus Torvalds static void TTSilence(void)
8811da177e4SLinus Torvalds {
8821da177e4SLinus Torvalds 	tt_dmasnd.ctrl = DMASND_CTRL_OFF;
8831da177e4SLinus Torvalds 	atari_microwire_cmd(MW_LM1992_PSG_HIGH); /* mix in PSG signal 1:1 */
8841da177e4SLinus Torvalds }
8851da177e4SLinus Torvalds 
8861da177e4SLinus Torvalds 
8871da177e4SLinus Torvalds static void TTInit(void)
8881da177e4SLinus Torvalds {
8891da177e4SLinus Torvalds 	int mode, i, idx;
8901da177e4SLinus Torvalds 	const int freq[4] = {50066, 25033, 12517, 6258};
8911da177e4SLinus Torvalds 
8921da177e4SLinus Torvalds 	/* search a frequency that fits into the allowed error range */
8931da177e4SLinus Torvalds 
8941da177e4SLinus Torvalds 	idx = -1;
8951da177e4SLinus Torvalds 	for (i = 0; i < ARRAY_SIZE(freq); i++)
8961da177e4SLinus Torvalds 		/* this isn't as much useful for a TT than for a Falcon, but
8971da177e4SLinus Torvalds 		 * then it doesn't hurt very much to implement it for a TT too.
8981da177e4SLinus Torvalds 		 */
8991da177e4SLinus Torvalds 		if ((100 * abs(dmasound.soft.speed - freq[i]) / freq[i]) < catchRadius)
9001da177e4SLinus Torvalds 			idx = i;
9011da177e4SLinus Torvalds 	if (idx > -1) {
9021da177e4SLinus Torvalds 		dmasound.soft.speed = freq[idx];
9031da177e4SLinus Torvalds 		dmasound.trans_write = &transTTNormal;
9041da177e4SLinus Torvalds 	} else
9051da177e4SLinus Torvalds 		dmasound.trans_write = &transTTExpanding;
9061da177e4SLinus Torvalds 
9071da177e4SLinus Torvalds 	TTSilence();
9081da177e4SLinus Torvalds 	dmasound.hard = dmasound.soft;
9091da177e4SLinus Torvalds 
9101da177e4SLinus Torvalds 	if (dmasound.hard.speed > 50066) {
9111da177e4SLinus Torvalds 		/* we would need to squeeze the sound, but we won't do that */
9121da177e4SLinus Torvalds 		dmasound.hard.speed = 50066;
9131da177e4SLinus Torvalds 		mode = DMASND_MODE_50KHZ;
9141da177e4SLinus Torvalds 		dmasound.trans_write = &transTTNormal;
9151da177e4SLinus Torvalds 	} else if (dmasound.hard.speed > 25033) {
9161da177e4SLinus Torvalds 		dmasound.hard.speed = 50066;
9171da177e4SLinus Torvalds 		mode = DMASND_MODE_50KHZ;
9181da177e4SLinus Torvalds 	} else if (dmasound.hard.speed > 12517) {
9191da177e4SLinus Torvalds 		dmasound.hard.speed = 25033;
9201da177e4SLinus Torvalds 		mode = DMASND_MODE_25KHZ;
9211da177e4SLinus Torvalds 	} else if (dmasound.hard.speed > 6258) {
9221da177e4SLinus Torvalds 		dmasound.hard.speed = 12517;
9231da177e4SLinus Torvalds 		mode = DMASND_MODE_12KHZ;
9241da177e4SLinus Torvalds 	} else {
9251da177e4SLinus Torvalds 		dmasound.hard.speed = 6258;
9261da177e4SLinus Torvalds 		mode = DMASND_MODE_6KHZ;
9271da177e4SLinus Torvalds 	}
9281da177e4SLinus Torvalds 
9291da177e4SLinus Torvalds 	tt_dmasnd.mode = (dmasound.hard.stereo ?
9301da177e4SLinus Torvalds 			  DMASND_MODE_STEREO : DMASND_MODE_MONO) |
9311da177e4SLinus Torvalds 		DMASND_MODE_8BIT | mode;
9321da177e4SLinus Torvalds 
9331da177e4SLinus Torvalds 	expand_bal = -dmasound.soft.speed;
9341da177e4SLinus Torvalds }
9351da177e4SLinus Torvalds 
9361da177e4SLinus Torvalds 
9371da177e4SLinus Torvalds static int TTSetFormat(int format)
9381da177e4SLinus Torvalds {
9391da177e4SLinus Torvalds 	/* TT sound DMA supports only 8bit modes */
9401da177e4SLinus Torvalds 
9411da177e4SLinus Torvalds 	switch (format) {
9421da177e4SLinus Torvalds 	case AFMT_QUERY:
9431da177e4SLinus Torvalds 		return dmasound.soft.format;
9441da177e4SLinus Torvalds 	case AFMT_MU_LAW:
9451da177e4SLinus Torvalds 	case AFMT_A_LAW:
9461da177e4SLinus Torvalds 	case AFMT_S8:
9471da177e4SLinus Torvalds 	case AFMT_U8:
9481da177e4SLinus Torvalds 		break;
9491da177e4SLinus Torvalds 	default:
9501da177e4SLinus Torvalds 		format = AFMT_S8;
9511da177e4SLinus Torvalds 	}
9521da177e4SLinus Torvalds 
9531da177e4SLinus Torvalds 	dmasound.soft.format = format;
9541da177e4SLinus Torvalds 	dmasound.soft.size = 8;
9551da177e4SLinus Torvalds 	if (dmasound.minDev == SND_DEV_DSP) {
9561da177e4SLinus Torvalds 		dmasound.dsp.format = format;
9571da177e4SLinus Torvalds 		dmasound.dsp.size = 8;
9581da177e4SLinus Torvalds 	}
9591da177e4SLinus Torvalds 	TTInit();
9601da177e4SLinus Torvalds 
9611da177e4SLinus Torvalds 	return format;
9621da177e4SLinus Torvalds }
9631da177e4SLinus Torvalds 
9641da177e4SLinus Torvalds 
9651da177e4SLinus Torvalds #define VOLUME_VOXWARE_TO_DB(v) \
9661da177e4SLinus Torvalds 	(((v) < 0) ? -40 : ((v) > 100) ? 0 : ((v) * 2) / 5 - 40)
9671da177e4SLinus Torvalds #define VOLUME_DB_TO_VOXWARE(v) ((((v) + 40) * 5 + 1) / 2)
9681da177e4SLinus Torvalds 
9691da177e4SLinus Torvalds 
9701da177e4SLinus Torvalds static int TTSetVolume(int volume)
9711da177e4SLinus Torvalds {
9721da177e4SLinus Torvalds 	dmasound.volume_left = VOLUME_VOXWARE_TO_DB(volume & 0xff);
9731da177e4SLinus Torvalds 	atari_microwire_cmd(MW_LM1992_BALLEFT(dmasound.volume_left));
9741da177e4SLinus Torvalds 	dmasound.volume_right = VOLUME_VOXWARE_TO_DB((volume & 0xff00) >> 8);
9751da177e4SLinus Torvalds 	atari_microwire_cmd(MW_LM1992_BALRIGHT(dmasound.volume_right));
9761da177e4SLinus Torvalds 	return VOLUME_DB_TO_VOXWARE(dmasound.volume_left) |
9771da177e4SLinus Torvalds 	       (VOLUME_DB_TO_VOXWARE(dmasound.volume_right) << 8);
9781da177e4SLinus Torvalds }
9791da177e4SLinus Torvalds 
9801da177e4SLinus Torvalds 
9811da177e4SLinus Torvalds #define GAIN_VOXWARE_TO_DB(v) \
9821da177e4SLinus Torvalds 	(((v) < 0) ? -80 : ((v) > 100) ? 0 : ((v) * 4) / 5 - 80)
9831da177e4SLinus Torvalds #define GAIN_DB_TO_VOXWARE(v) ((((v) + 80) * 5 + 1) / 4)
9841da177e4SLinus Torvalds 
9851da177e4SLinus Torvalds static int TTSetGain(int gain)
9861da177e4SLinus Torvalds {
9871da177e4SLinus Torvalds 	dmasound.gain = GAIN_VOXWARE_TO_DB(gain);
9881da177e4SLinus Torvalds 	atari_microwire_cmd(MW_LM1992_VOLUME(dmasound.gain));
9891da177e4SLinus Torvalds 	return GAIN_DB_TO_VOXWARE(dmasound.gain);
9901da177e4SLinus Torvalds }
9911da177e4SLinus Torvalds 
9921da177e4SLinus Torvalds 
9931da177e4SLinus Torvalds 
9941da177e4SLinus Torvalds /*
9951da177e4SLinus Torvalds  * Falcon
9961da177e4SLinus Torvalds  */
9971da177e4SLinus Torvalds 
9981da177e4SLinus Torvalds 
9991da177e4SLinus Torvalds static void FalconSilence(void)
10001da177e4SLinus Torvalds {
10011da177e4SLinus Torvalds 	/* stop playback, set sample rate 50kHz for PSG sound */
10021da177e4SLinus Torvalds 	tt_dmasnd.ctrl = DMASND_CTRL_OFF;
10031da177e4SLinus Torvalds 	tt_dmasnd.mode = DMASND_MODE_50KHZ | DMASND_MODE_STEREO | DMASND_MODE_8BIT;
10041da177e4SLinus Torvalds 	tt_dmasnd.int_div = 0; /* STE compatible divider */
10051da177e4SLinus Torvalds 	tt_dmasnd.int_ctrl = 0x0;
10061da177e4SLinus Torvalds 	tt_dmasnd.cbar_src = 0x0000; /* no matrix inputs */
10071da177e4SLinus Torvalds 	tt_dmasnd.cbar_dst = 0x0000; /* no matrix outputs */
10081da177e4SLinus Torvalds 	tt_dmasnd.dac_src = 1; /* connect ADC to DAC, disconnect matrix */
10091da177e4SLinus Torvalds 	tt_dmasnd.adc_src = 3; /* ADC Input = PSG */
10101da177e4SLinus Torvalds }
10111da177e4SLinus Torvalds 
10121da177e4SLinus Torvalds 
10131da177e4SLinus Torvalds static void FalconInit(void)
10141da177e4SLinus Torvalds {
10151da177e4SLinus Torvalds 	int divider, i, idx;
10161da177e4SLinus Torvalds 	const int freq[8] = {49170, 32780, 24585, 19668, 16390, 12292, 9834, 8195};
10171da177e4SLinus Torvalds 
10181da177e4SLinus Torvalds 	/* search a frequency that fits into the allowed error range */
10191da177e4SLinus Torvalds 
10201da177e4SLinus Torvalds 	idx = -1;
10211da177e4SLinus Torvalds 	for (i = 0; i < ARRAY_SIZE(freq); i++)
10221da177e4SLinus Torvalds 		/* if we will tolerate 3% error 8000Hz->8195Hz (2.38%) would
10231da177e4SLinus Torvalds 		 * be playable without expanding, but that now a kernel runtime
10241da177e4SLinus Torvalds 		 * option
10251da177e4SLinus Torvalds 		 */
10261da177e4SLinus Torvalds 		if ((100 * abs(dmasound.soft.speed - freq[i]) / freq[i]) < catchRadius)
10271da177e4SLinus Torvalds 			idx = i;
10281da177e4SLinus Torvalds 	if (idx > -1) {
10291da177e4SLinus Torvalds 		dmasound.soft.speed = freq[idx];
10301da177e4SLinus Torvalds 		dmasound.trans_write = &transFalconNormal;
10311da177e4SLinus Torvalds 	} else
10321da177e4SLinus Torvalds 		dmasound.trans_write = &transFalconExpanding;
10331da177e4SLinus Torvalds 
10341da177e4SLinus Torvalds 	FalconSilence();
10351da177e4SLinus Torvalds 	dmasound.hard = dmasound.soft;
10361da177e4SLinus Torvalds 
10371da177e4SLinus Torvalds 	if (dmasound.hard.size == 16) {
10381da177e4SLinus Torvalds 		/* the Falcon can play 16bit samples only in stereo */
10391da177e4SLinus Torvalds 		dmasound.hard.stereo = 1;
10401da177e4SLinus Torvalds 	}
10411da177e4SLinus Torvalds 
10421da177e4SLinus Torvalds 	if (dmasound.hard.speed > 49170) {
10431da177e4SLinus Torvalds 		/* we would need to squeeze the sound, but we won't do that */
10441da177e4SLinus Torvalds 		dmasound.hard.speed = 49170;
10451da177e4SLinus Torvalds 		divider = 1;
10461da177e4SLinus Torvalds 		dmasound.trans_write = &transFalconNormal;
10471da177e4SLinus Torvalds 	} else if (dmasound.hard.speed > 32780) {
10481da177e4SLinus Torvalds 		dmasound.hard.speed = 49170;
10491da177e4SLinus Torvalds 		divider = 1;
10501da177e4SLinus Torvalds 	} else if (dmasound.hard.speed > 24585) {
10511da177e4SLinus Torvalds 		dmasound.hard.speed = 32780;
10521da177e4SLinus Torvalds 		divider = 2;
10531da177e4SLinus Torvalds 	} else if (dmasound.hard.speed > 19668) {
10541da177e4SLinus Torvalds 		dmasound.hard.speed = 24585;
10551da177e4SLinus Torvalds 		divider = 3;
10561da177e4SLinus Torvalds 	} else if (dmasound.hard.speed > 16390) {
10571da177e4SLinus Torvalds 		dmasound.hard.speed = 19668;
10581da177e4SLinus Torvalds 		divider = 4;
10591da177e4SLinus Torvalds 	} else if (dmasound.hard.speed > 12292) {
10601da177e4SLinus Torvalds 		dmasound.hard.speed = 16390;
10611da177e4SLinus Torvalds 		divider = 5;
10621da177e4SLinus Torvalds 	} else if (dmasound.hard.speed > 9834) {
10631da177e4SLinus Torvalds 		dmasound.hard.speed = 12292;
10641da177e4SLinus Torvalds 		divider = 7;
10651da177e4SLinus Torvalds 	} else if (dmasound.hard.speed > 8195) {
10661da177e4SLinus Torvalds 		dmasound.hard.speed = 9834;
10671da177e4SLinus Torvalds 		divider = 9;
10681da177e4SLinus Torvalds 	} else {
10691da177e4SLinus Torvalds 		dmasound.hard.speed = 8195;
10701da177e4SLinus Torvalds 		divider = 11;
10711da177e4SLinus Torvalds 	}
10721da177e4SLinus Torvalds 	tt_dmasnd.int_div = divider;
10731da177e4SLinus Torvalds 
10741da177e4SLinus Torvalds 	/* Setup Falcon sound DMA for playback */
10751da177e4SLinus Torvalds 	tt_dmasnd.int_ctrl = 0x4; /* Timer A int at play end */
10761da177e4SLinus Torvalds 	tt_dmasnd.track_select = 0x0; /* play 1 track, track 1 */
10771da177e4SLinus Torvalds 	tt_dmasnd.cbar_src = 0x0001; /* DMA(25MHz) --> DAC */
10781da177e4SLinus Torvalds 	tt_dmasnd.cbar_dst = 0x0000;
10791da177e4SLinus Torvalds 	tt_dmasnd.rec_track_select = 0;
10801da177e4SLinus Torvalds 	tt_dmasnd.dac_src = 2; /* connect matrix to DAC */
10811da177e4SLinus Torvalds 	tt_dmasnd.adc_src = 0; /* ADC Input = Mic */
10821da177e4SLinus Torvalds 
10831da177e4SLinus Torvalds 	tt_dmasnd.mode = (dmasound.hard.stereo ?
10841da177e4SLinus Torvalds 			  DMASND_MODE_STEREO : DMASND_MODE_MONO) |
10851da177e4SLinus Torvalds 		((dmasound.hard.size == 8) ?
10861da177e4SLinus Torvalds 		 DMASND_MODE_8BIT : DMASND_MODE_16BIT) |
10871da177e4SLinus Torvalds 		DMASND_MODE_6KHZ;
10881da177e4SLinus Torvalds 
10891da177e4SLinus Torvalds 	expand_bal = -dmasound.soft.speed;
10901da177e4SLinus Torvalds }
10911da177e4SLinus Torvalds 
10921da177e4SLinus Torvalds 
10931da177e4SLinus Torvalds static int FalconSetFormat(int format)
10941da177e4SLinus Torvalds {
10951da177e4SLinus Torvalds 	int size;
10961da177e4SLinus Torvalds 	/* Falcon sound DMA supports 8bit and 16bit modes */
10971da177e4SLinus Torvalds 
10981da177e4SLinus Torvalds 	switch (format) {
10991da177e4SLinus Torvalds 	case AFMT_QUERY:
11001da177e4SLinus Torvalds 		return dmasound.soft.format;
11011da177e4SLinus Torvalds 	case AFMT_MU_LAW:
11021da177e4SLinus Torvalds 	case AFMT_A_LAW:
11031da177e4SLinus Torvalds 	case AFMT_U8:
11041da177e4SLinus Torvalds 	case AFMT_S8:
11051da177e4SLinus Torvalds 		size = 8;
11061da177e4SLinus Torvalds 		break;
11071da177e4SLinus Torvalds 	case AFMT_S16_BE:
11081da177e4SLinus Torvalds 	case AFMT_U16_BE:
11091da177e4SLinus Torvalds 	case AFMT_S16_LE:
11101da177e4SLinus Torvalds 	case AFMT_U16_LE:
11111da177e4SLinus Torvalds 		size = 16;
11121da177e4SLinus Torvalds 		break;
11131da177e4SLinus Torvalds 	default: /* :-) */
11141da177e4SLinus Torvalds 		size = 8;
11151da177e4SLinus Torvalds 		format = AFMT_S8;
11161da177e4SLinus Torvalds 	}
11171da177e4SLinus Torvalds 
11181da177e4SLinus Torvalds 	dmasound.soft.format = format;
11191da177e4SLinus Torvalds 	dmasound.soft.size = size;
11201da177e4SLinus Torvalds 	if (dmasound.minDev == SND_DEV_DSP) {
11211da177e4SLinus Torvalds 		dmasound.dsp.format = format;
11221da177e4SLinus Torvalds 		dmasound.dsp.size = dmasound.soft.size;
11231da177e4SLinus Torvalds 	}
11241da177e4SLinus Torvalds 
11251da177e4SLinus Torvalds 	FalconInit();
11261da177e4SLinus Torvalds 
11271da177e4SLinus Torvalds 	return format;
11281da177e4SLinus Torvalds }
11291da177e4SLinus Torvalds 
11301da177e4SLinus Torvalds 
11311da177e4SLinus Torvalds /* This is for the Falcon output *attenuation* in 1.5dB steps,
11321da177e4SLinus Torvalds  * i.e. output level from 0 to -22.5dB in -1.5dB steps.
11331da177e4SLinus Torvalds  */
11341da177e4SLinus Torvalds #define VOLUME_VOXWARE_TO_ATT(v) \
11351da177e4SLinus Torvalds 	((v) < 0 ? 15 : (v) > 100 ? 0 : 15 - (v) * 3 / 20)
11361da177e4SLinus Torvalds #define VOLUME_ATT_TO_VOXWARE(v) (100 - (v) * 20 / 3)
11371da177e4SLinus Torvalds 
11381da177e4SLinus Torvalds 
11391da177e4SLinus Torvalds static int FalconSetVolume(int volume)
11401da177e4SLinus Torvalds {
11411da177e4SLinus Torvalds 	dmasound.volume_left = VOLUME_VOXWARE_TO_ATT(volume & 0xff);
11421da177e4SLinus Torvalds 	dmasound.volume_right = VOLUME_VOXWARE_TO_ATT((volume & 0xff00) >> 8);
11431da177e4SLinus Torvalds 	tt_dmasnd.output_atten = dmasound.volume_left << 8 | dmasound.volume_right << 4;
11441da177e4SLinus Torvalds 	return VOLUME_ATT_TO_VOXWARE(dmasound.volume_left) |
11451da177e4SLinus Torvalds 	       VOLUME_ATT_TO_VOXWARE(dmasound.volume_right) << 8;
11461da177e4SLinus Torvalds }
11471da177e4SLinus Torvalds 
11481da177e4SLinus Torvalds 
11491da177e4SLinus Torvalds static void AtaPlayNextFrame(int index)
11501da177e4SLinus Torvalds {
11511da177e4SLinus Torvalds 	char *start, *end;
11521da177e4SLinus Torvalds 
11531da177e4SLinus Torvalds 	/* used by AtaPlay() if all doubts whether there really is something
11541da177e4SLinus Torvalds 	 * to be played are already wiped out.
11551da177e4SLinus Torvalds 	 */
11561da177e4SLinus Torvalds 	start = write_sq.buffers[write_sq.front];
11571da177e4SLinus Torvalds 	end = start+((write_sq.count == index) ? write_sq.rear_size
11581da177e4SLinus Torvalds 					       : write_sq.block_size);
11591da177e4SLinus Torvalds 	/* end might not be a legal virtual address. */
11601da177e4SLinus Torvalds 	DMASNDSetEnd(virt_to_phys(end - 1) + 1);
11611da177e4SLinus Torvalds 	DMASNDSetBase(virt_to_phys(start));
11621da177e4SLinus Torvalds 	/* Since only an even number of samples per frame can
11631da177e4SLinus Torvalds 	   be played, we might lose one byte here. (TO DO) */
11641da177e4SLinus Torvalds 	write_sq.front = (write_sq.front+1) % write_sq.max_count;
11651da177e4SLinus Torvalds 	write_sq.active++;
11661da177e4SLinus Torvalds 	tt_dmasnd.ctrl = DMASND_CTRL_ON | DMASND_CTRL_REPEAT;
11671da177e4SLinus Torvalds }
11681da177e4SLinus Torvalds 
11691da177e4SLinus Torvalds 
11701da177e4SLinus Torvalds static void AtaPlay(void)
11711da177e4SLinus Torvalds {
11721da177e4SLinus Torvalds 	/* ++TeSche: Note that write_sq.active is no longer just a flag but
11731da177e4SLinus Torvalds 	 * holds the number of frames the DMA is currently programmed for
11741da177e4SLinus Torvalds 	 * instead, may be 0, 1 (currently being played) or 2 (pre-programmed).
11751da177e4SLinus Torvalds 	 *
11761da177e4SLinus Torvalds 	 * Changes done to write_sq.count and write_sq.active are a bit more
11771da177e4SLinus Torvalds 	 * subtle again so now I must admit I also prefer disabling the irq
11781da177e4SLinus Torvalds 	 * here rather than considering all possible situations. But the point
11791da177e4SLinus Torvalds 	 * is that disabling the irq doesn't have any bad influence on this
11801da177e4SLinus Torvalds 	 * version of the driver as we benefit from having pre-programmed the
11811da177e4SLinus Torvalds 	 * DMA wherever possible: There's no need to reload the DMA at the
11821da177e4SLinus Torvalds 	 * exact time of an interrupt but only at some time while the
11831da177e4SLinus Torvalds 	 * pre-programmed frame is playing!
11841da177e4SLinus Torvalds 	 */
11851da177e4SLinus Torvalds 	atari_disable_irq(IRQ_MFP_TIMA);
11861da177e4SLinus Torvalds 
11871da177e4SLinus Torvalds 	if (write_sq.active == 2 ||	/* DMA is 'full' */
11881da177e4SLinus Torvalds 	    write_sq.count <= 0) {	/* nothing to do */
11891da177e4SLinus Torvalds 		atari_enable_irq(IRQ_MFP_TIMA);
11901da177e4SLinus Torvalds 		return;
11911da177e4SLinus Torvalds 	}
11921da177e4SLinus Torvalds 
11931da177e4SLinus Torvalds 	if (write_sq.active == 0) {
11941da177e4SLinus Torvalds 		/* looks like there's nothing 'in' the DMA yet, so try
11951da177e4SLinus Torvalds 		 * to put two frames into it (at least one is available).
11961da177e4SLinus Torvalds 		 */
11971da177e4SLinus Torvalds 		if (write_sq.count == 1 &&
11981da177e4SLinus Torvalds 		    write_sq.rear_size < write_sq.block_size &&
11991da177e4SLinus Torvalds 		    !write_sq.syncing) {
12001da177e4SLinus Torvalds 			/* hmmm, the only existing frame is not
12011da177e4SLinus Torvalds 			 * yet filled and we're not syncing?
12021da177e4SLinus Torvalds 			 */
12031da177e4SLinus Torvalds 			atari_enable_irq(IRQ_MFP_TIMA);
12041da177e4SLinus Torvalds 			return;
12051da177e4SLinus Torvalds 		}
12061da177e4SLinus Torvalds 		AtaPlayNextFrame(1);
12071da177e4SLinus Torvalds 		if (write_sq.count == 1) {
12081da177e4SLinus Torvalds 			/* no more frames */
12091da177e4SLinus Torvalds 			atari_enable_irq(IRQ_MFP_TIMA);
12101da177e4SLinus Torvalds 			return;
12111da177e4SLinus Torvalds 		}
12121da177e4SLinus Torvalds 		if (write_sq.count == 2 &&
12131da177e4SLinus Torvalds 		    write_sq.rear_size < write_sq.block_size &&
12141da177e4SLinus Torvalds 		    !write_sq.syncing) {
12151da177e4SLinus Torvalds 			/* hmmm, there were two frames, but the second
12161da177e4SLinus Torvalds 			 * one is not yet filled and we're not syncing?
12171da177e4SLinus Torvalds 			 */
12181da177e4SLinus Torvalds 			atari_enable_irq(IRQ_MFP_TIMA);
12191da177e4SLinus Torvalds 			return;
12201da177e4SLinus Torvalds 		}
12211da177e4SLinus Torvalds 		AtaPlayNextFrame(2);
12221da177e4SLinus Torvalds 	} else {
12231da177e4SLinus Torvalds 		/* there's already a frame being played so we may only stuff
12241da177e4SLinus Torvalds 		 * one new into the DMA, but even if this may be the last
12251da177e4SLinus Torvalds 		 * frame existing the previous one is still on write_sq.count.
12261da177e4SLinus Torvalds 		 */
12271da177e4SLinus Torvalds 		if (write_sq.count == 2 &&
12281da177e4SLinus Torvalds 		    write_sq.rear_size < write_sq.block_size &&
12291da177e4SLinus Torvalds 		    !write_sq.syncing) {
12301da177e4SLinus Torvalds 			/* hmmm, the only existing frame is not
12311da177e4SLinus Torvalds 			 * yet filled and we're not syncing?
12321da177e4SLinus Torvalds 			 */
12331da177e4SLinus Torvalds 			atari_enable_irq(IRQ_MFP_TIMA);
12341da177e4SLinus Torvalds 			return;
12351da177e4SLinus Torvalds 		}
12361da177e4SLinus Torvalds 		AtaPlayNextFrame(2);
12371da177e4SLinus Torvalds 	}
12381da177e4SLinus Torvalds 	atari_enable_irq(IRQ_MFP_TIMA);
12391da177e4SLinus Torvalds }
12401da177e4SLinus Torvalds 
12411da177e4SLinus Torvalds 
12421da177e4SLinus Torvalds static irqreturn_t AtaInterrupt(int irq, void *dummy, struct pt_regs *fp)
12431da177e4SLinus Torvalds {
12441da177e4SLinus Torvalds #if 0
12451da177e4SLinus Torvalds 	/* ++TeSche: if you should want to test this... */
12461da177e4SLinus Torvalds 	static int cnt;
12471da177e4SLinus Torvalds 	if (write_sq.active == 2)
12481da177e4SLinus Torvalds 		if (++cnt == 10) {
12491da177e4SLinus Torvalds 			/* simulate losing an interrupt */
12501da177e4SLinus Torvalds 			cnt = 0;
12511da177e4SLinus Torvalds 			return IRQ_HANDLED;
12521da177e4SLinus Torvalds 		}
12531da177e4SLinus Torvalds #endif
12541da177e4SLinus Torvalds 	spin_lock(&dmasound.lock);
12551da177e4SLinus Torvalds 	if (write_sq_ignore_int && is_falcon) {
12561da177e4SLinus Torvalds 		/* ++TeSche: Falcon only: ignore first irq because it comes
12571da177e4SLinus Torvalds 		 * immediately after starting a frame. after that, irqs come
12581da177e4SLinus Torvalds 		 * (almost) like on the TT.
12591da177e4SLinus Torvalds 		 */
12601da177e4SLinus Torvalds 		write_sq_ignore_int = 0;
12611da177e4SLinus Torvalds 		return IRQ_HANDLED;
12621da177e4SLinus Torvalds 	}
12631da177e4SLinus Torvalds 
12641da177e4SLinus Torvalds 	if (!write_sq.active) {
12651da177e4SLinus Torvalds 		/* playing was interrupted and sq_reset() has already cleared
12661da177e4SLinus Torvalds 		 * the sq variables, so better don't do anything here.
12671da177e4SLinus Torvalds 		 */
12681da177e4SLinus Torvalds 		WAKE_UP(write_sq.sync_queue);
12691da177e4SLinus Torvalds 		return IRQ_HANDLED;
12701da177e4SLinus Torvalds 	}
12711da177e4SLinus Torvalds 
12721da177e4SLinus Torvalds 	/* Probably ;) one frame is finished. Well, in fact it may be that a
12731da177e4SLinus Torvalds 	 * pre-programmed one is also finished because there has been a long
12741da177e4SLinus Torvalds 	 * delay in interrupt delivery and we've completely lost one, but
12751da177e4SLinus Torvalds 	 * there's no way to detect such a situation. In such a case the last
12761da177e4SLinus Torvalds 	 * frame will be played more than once and the situation will recover
12771da177e4SLinus Torvalds 	 * as soon as the irq gets through.
12781da177e4SLinus Torvalds 	 */
12791da177e4SLinus Torvalds 	write_sq.count--;
12801da177e4SLinus Torvalds 	write_sq.active--;
12811da177e4SLinus Torvalds 
12821da177e4SLinus Torvalds 	if (!write_sq.active) {
12831da177e4SLinus Torvalds 		tt_dmasnd.ctrl = DMASND_CTRL_OFF;
12841da177e4SLinus Torvalds 		write_sq_ignore_int = 1;
12851da177e4SLinus Torvalds 	}
12861da177e4SLinus Torvalds 
12871da177e4SLinus Torvalds 	WAKE_UP(write_sq.action_queue);
12881da177e4SLinus Torvalds 	/* At least one block of the queue is free now
12891da177e4SLinus Torvalds 	   so wake up a writing process blocked because
12901da177e4SLinus Torvalds 	   of a full queue. */
12911da177e4SLinus Torvalds 
12921da177e4SLinus Torvalds 	if ((write_sq.active != 1) || (write_sq.count != 1))
12931da177e4SLinus Torvalds 		/* We must be a bit carefully here: write_sq.count indicates the
12941da177e4SLinus Torvalds 		 * number of buffers used and not the number of frames to be
12951da177e4SLinus Torvalds 		 * played. If write_sq.count==1 and write_sq.active==1 that
12961da177e4SLinus Torvalds 		 * means the only remaining frame was already programmed
12971da177e4SLinus Torvalds 		 * earlier (and is currently running) so we mustn't call
12981da177e4SLinus Torvalds 		 * AtaPlay() here, otherwise we'll play one frame too much.
12991da177e4SLinus Torvalds 		 */
13001da177e4SLinus Torvalds 		AtaPlay();
13011da177e4SLinus Torvalds 
13021da177e4SLinus Torvalds 	if (!write_sq.active) WAKE_UP(write_sq.sync_queue);
13031da177e4SLinus Torvalds 	/* We are not playing after AtaPlay(), so there
13041da177e4SLinus Torvalds 	   is nothing to play any more. Wake up a process
13051da177e4SLinus Torvalds 	   waiting for audio output to drain. */
13061da177e4SLinus Torvalds 	spin_unlock(&dmasound.lock);
13071da177e4SLinus Torvalds 	return IRQ_HANDLED;
13081da177e4SLinus Torvalds }
13091da177e4SLinus Torvalds 
13101da177e4SLinus Torvalds 
13111da177e4SLinus Torvalds /*** Mid level stuff *********************************************************/
13121da177e4SLinus Torvalds 
13131da177e4SLinus Torvalds 
13141da177e4SLinus Torvalds /*
13151da177e4SLinus Torvalds  * /dev/mixer abstraction
13161da177e4SLinus Torvalds  */
13171da177e4SLinus Torvalds 
13181da177e4SLinus Torvalds #define RECLEVEL_VOXWARE_TO_GAIN(v)	\
13191da177e4SLinus Torvalds 	((v) < 0 ? 0 : (v) > 100 ? 15 : (v) * 3 / 20)
13201da177e4SLinus Torvalds #define RECLEVEL_GAIN_TO_VOXWARE(v)	(((v) * 20 + 2) / 3)
13211da177e4SLinus Torvalds 
13221da177e4SLinus Torvalds 
13231da177e4SLinus Torvalds static void __init TTMixerInit(void)
13241da177e4SLinus Torvalds {
13251da177e4SLinus Torvalds 	atari_microwire_cmd(MW_LM1992_VOLUME(0));
13261da177e4SLinus Torvalds 	dmasound.volume_left = 0;
13271da177e4SLinus Torvalds 	atari_microwire_cmd(MW_LM1992_BALLEFT(0));
13281da177e4SLinus Torvalds 	dmasound.volume_right = 0;
13291da177e4SLinus Torvalds 	atari_microwire_cmd(MW_LM1992_BALRIGHT(0));
13301da177e4SLinus Torvalds 	atari_microwire_cmd(MW_LM1992_TREBLE(0));
13311da177e4SLinus Torvalds 	atari_microwire_cmd(MW_LM1992_BASS(0));
13321da177e4SLinus Torvalds }
13331da177e4SLinus Torvalds 
13341da177e4SLinus Torvalds static void __init FalconMixerInit(void)
13351da177e4SLinus Torvalds {
13361da177e4SLinus Torvalds 	dmasound.volume_left = (tt_dmasnd.output_atten & 0xf00) >> 8;
13371da177e4SLinus Torvalds 	dmasound.volume_right = (tt_dmasnd.output_atten & 0xf0) >> 4;
13381da177e4SLinus Torvalds }
13391da177e4SLinus Torvalds 
13401da177e4SLinus Torvalds static int AtaMixerIoctl(u_int cmd, u_long arg)
13411da177e4SLinus Torvalds {
13421da177e4SLinus Torvalds 	int data;
13431da177e4SLinus Torvalds 	unsigned long flags;
13441da177e4SLinus Torvalds 	switch (cmd) {
13451da177e4SLinus Torvalds 	    case SOUND_MIXER_READ_SPEAKER:
13461da177e4SLinus Torvalds 		    if (is_falcon || MACH_IS_TT) {
13471da177e4SLinus Torvalds 			    int porta;
13481da177e4SLinus Torvalds 			    spin_lock_irqsave(&dmasound.lock, flags);
13491da177e4SLinus Torvalds 			    sound_ym.rd_data_reg_sel = 14;
13501da177e4SLinus Torvalds 			    porta = sound_ym.rd_data_reg_sel;
13511da177e4SLinus Torvalds 			    spin_unlock_irqrestore(&dmasound.lock, flags);
13521da177e4SLinus Torvalds 			    return IOCTL_OUT(arg, porta & 0x40 ? 0 : 100);
13531da177e4SLinus Torvalds 		    }
13541da177e4SLinus Torvalds 		    break;
13551da177e4SLinus Torvalds 	    case SOUND_MIXER_WRITE_VOLUME:
13561da177e4SLinus Torvalds 		    IOCTL_IN(arg, data);
13571da177e4SLinus Torvalds 		    return IOCTL_OUT(arg, dmasound_set_volume(data));
13581da177e4SLinus Torvalds 	    case SOUND_MIXER_WRITE_SPEAKER:
13591da177e4SLinus Torvalds 		    if (is_falcon || MACH_IS_TT) {
13601da177e4SLinus Torvalds 			    int porta;
13611da177e4SLinus Torvalds 			    IOCTL_IN(arg, data);
13621da177e4SLinus Torvalds 			    spin_lock_irqsave(&dmasound.lock, flags);
13631da177e4SLinus Torvalds 			    sound_ym.rd_data_reg_sel = 14;
13641da177e4SLinus Torvalds 			    porta = (sound_ym.rd_data_reg_sel & ~0x40) |
13651da177e4SLinus Torvalds 				    (data < 50 ? 0x40 : 0);
13661da177e4SLinus Torvalds 			    sound_ym.wd_data = porta;
13671da177e4SLinus Torvalds 			    spin_unlock_irqrestore(&dmasound.lock, flags);
13681da177e4SLinus Torvalds 			    return IOCTL_OUT(arg, porta & 0x40 ? 0 : 100);
13691da177e4SLinus Torvalds 		    }
13701da177e4SLinus Torvalds 	}
13711da177e4SLinus Torvalds 	return -EINVAL;
13721da177e4SLinus Torvalds }
13731da177e4SLinus Torvalds 
13741da177e4SLinus Torvalds 
13751da177e4SLinus Torvalds static int TTMixerIoctl(u_int cmd, u_long arg)
13761da177e4SLinus Torvalds {
13771da177e4SLinus Torvalds 	int data;
13781da177e4SLinus Torvalds 	switch (cmd) {
13791da177e4SLinus Torvalds 	    case SOUND_MIXER_READ_RECMASK:
13801da177e4SLinus Torvalds 		return IOCTL_OUT(arg, 0);
13811da177e4SLinus Torvalds 	    case SOUND_MIXER_READ_DEVMASK:
13821da177e4SLinus Torvalds 		return IOCTL_OUT(arg,
13831da177e4SLinus Torvalds 				 SOUND_MASK_VOLUME | SOUND_MASK_TREBLE | SOUND_MASK_BASS |
13841da177e4SLinus Torvalds 				 (MACH_IS_TT ? SOUND_MASK_SPEAKER : 0));
13851da177e4SLinus Torvalds 	    case SOUND_MIXER_READ_STEREODEVS:
13861da177e4SLinus Torvalds 		return IOCTL_OUT(arg, SOUND_MASK_VOLUME);
13871da177e4SLinus Torvalds 	    case SOUND_MIXER_READ_VOLUME:
13881da177e4SLinus Torvalds 		return IOCTL_OUT(arg,
13891da177e4SLinus Torvalds 				 VOLUME_DB_TO_VOXWARE(dmasound.volume_left) |
13901da177e4SLinus Torvalds 				 (VOLUME_DB_TO_VOXWARE(dmasound.volume_right) << 8));
13911da177e4SLinus Torvalds 	    case SOUND_MIXER_READ_BASS:
13921da177e4SLinus Torvalds 		return IOCTL_OUT(arg, TONE_DB_TO_VOXWARE(dmasound.bass));
13931da177e4SLinus Torvalds 	    case SOUND_MIXER_READ_TREBLE:
13941da177e4SLinus Torvalds 		return IOCTL_OUT(arg, TONE_DB_TO_VOXWARE(dmasound.treble));
13951da177e4SLinus Torvalds 	    case SOUND_MIXER_READ_OGAIN:
13961da177e4SLinus Torvalds 		return IOCTL_OUT(arg, GAIN_DB_TO_VOXWARE(dmasound.gain));
13971da177e4SLinus Torvalds 	    case SOUND_MIXER_WRITE_BASS:
13981da177e4SLinus Torvalds 		IOCTL_IN(arg, data);
13991da177e4SLinus Torvalds 		return IOCTL_OUT(arg, dmasound_set_bass(data));
14001da177e4SLinus Torvalds 	    case SOUND_MIXER_WRITE_TREBLE:
14011da177e4SLinus Torvalds 		IOCTL_IN(arg, data);
14021da177e4SLinus Torvalds 		return IOCTL_OUT(arg, dmasound_set_treble(data));
14031da177e4SLinus Torvalds 	    case SOUND_MIXER_WRITE_OGAIN:
14041da177e4SLinus Torvalds 		IOCTL_IN(arg, data);
14051da177e4SLinus Torvalds 		return IOCTL_OUT(arg, dmasound_set_gain(data));
14061da177e4SLinus Torvalds 	}
14071da177e4SLinus Torvalds 	return AtaMixerIoctl(cmd, arg);
14081da177e4SLinus Torvalds }
14091da177e4SLinus Torvalds 
14101da177e4SLinus Torvalds static int FalconMixerIoctl(u_int cmd, u_long arg)
14111da177e4SLinus Torvalds {
14121da177e4SLinus Torvalds 	int data;
14131da177e4SLinus Torvalds 	switch (cmd) {
14141da177e4SLinus Torvalds 	    case SOUND_MIXER_READ_RECMASK:
14151da177e4SLinus Torvalds 		return IOCTL_OUT(arg, SOUND_MASK_MIC);
14161da177e4SLinus Torvalds 	    case SOUND_MIXER_READ_DEVMASK:
14171da177e4SLinus Torvalds 		return IOCTL_OUT(arg, SOUND_MASK_VOLUME | SOUND_MASK_MIC | SOUND_MASK_SPEAKER);
14181da177e4SLinus Torvalds 	    case SOUND_MIXER_READ_STEREODEVS:
14191da177e4SLinus Torvalds 		return IOCTL_OUT(arg, SOUND_MASK_VOLUME | SOUND_MASK_MIC);
14201da177e4SLinus Torvalds 	    case SOUND_MIXER_READ_VOLUME:
14211da177e4SLinus Torvalds 		return IOCTL_OUT(arg,
14221da177e4SLinus Torvalds 			VOLUME_ATT_TO_VOXWARE(dmasound.volume_left) |
14231da177e4SLinus Torvalds 			VOLUME_ATT_TO_VOXWARE(dmasound.volume_right) << 8);
14241da177e4SLinus Torvalds 	    case SOUND_MIXER_READ_CAPS:
14251da177e4SLinus Torvalds 		return IOCTL_OUT(arg, SOUND_CAP_EXCL_INPUT);
14261da177e4SLinus Torvalds 	    case SOUND_MIXER_WRITE_MIC:
14271da177e4SLinus Torvalds 		IOCTL_IN(arg, data);
14281da177e4SLinus Torvalds 		tt_dmasnd.input_gain =
14291da177e4SLinus Torvalds 			RECLEVEL_VOXWARE_TO_GAIN(data & 0xff) << 4 |
14301da177e4SLinus Torvalds 			RECLEVEL_VOXWARE_TO_GAIN(data >> 8 & 0xff);
14311da177e4SLinus Torvalds 		/* fall thru, return set value */
14321da177e4SLinus Torvalds 	    case SOUND_MIXER_READ_MIC:
14331da177e4SLinus Torvalds 		return IOCTL_OUT(arg,
14341da177e4SLinus Torvalds 			RECLEVEL_GAIN_TO_VOXWARE(tt_dmasnd.input_gain >> 4 & 0xf) |
14351da177e4SLinus Torvalds 			RECLEVEL_GAIN_TO_VOXWARE(tt_dmasnd.input_gain & 0xf) << 8);
14361da177e4SLinus Torvalds 	}
14371da177e4SLinus Torvalds 	return AtaMixerIoctl(cmd, arg);
14381da177e4SLinus Torvalds }
14391da177e4SLinus Torvalds 
14401da177e4SLinus Torvalds static int AtaWriteSqSetup(void)
14411da177e4SLinus Torvalds {
14421da177e4SLinus Torvalds 	write_sq_ignore_int = 0;
14431da177e4SLinus Torvalds 	return 0 ;
14441da177e4SLinus Torvalds }
14451da177e4SLinus Torvalds 
14461da177e4SLinus Torvalds static int AtaSqOpen(mode_t mode)
14471da177e4SLinus Torvalds {
14481da177e4SLinus Torvalds 	write_sq_ignore_int = 1;
14491da177e4SLinus Torvalds 	return 0 ;
14501da177e4SLinus Torvalds }
14511da177e4SLinus Torvalds 
14521da177e4SLinus Torvalds static int TTStateInfo(char *buffer, size_t space)
14531da177e4SLinus Torvalds {
14541da177e4SLinus Torvalds 	int len = 0;
14551da177e4SLinus Torvalds 	len += sprintf(buffer+len, "\tvol left  %ddB [-40...  0]\n",
14561da177e4SLinus Torvalds 		       dmasound.volume_left);
14571da177e4SLinus Torvalds 	len += sprintf(buffer+len, "\tvol right %ddB [-40...  0]\n",
14581da177e4SLinus Torvalds 		       dmasound.volume_right);
14591da177e4SLinus Torvalds 	len += sprintf(buffer+len, "\tbass      %ddB [-12...+12]\n",
14601da177e4SLinus Torvalds 		       dmasound.bass);
14611da177e4SLinus Torvalds 	len += sprintf(buffer+len, "\ttreble    %ddB [-12...+12]\n",
14621da177e4SLinus Torvalds 		       dmasound.treble);
14631da177e4SLinus Torvalds 	if (len >= space) {
14641da177e4SLinus Torvalds 		printk(KERN_ERR "dmasound_atari: overflowed state buffer alloc.\n") ;
14651da177e4SLinus Torvalds 		len = space ;
14661da177e4SLinus Torvalds 	}
14671da177e4SLinus Torvalds 	return len;
14681da177e4SLinus Torvalds }
14691da177e4SLinus Torvalds 
14701da177e4SLinus Torvalds static int FalconStateInfo(char *buffer, size_t space)
14711da177e4SLinus Torvalds {
14721da177e4SLinus Torvalds 	int len = 0;
14731da177e4SLinus Torvalds 	len += sprintf(buffer+len, "\tvol left  %ddB [-22.5 ... 0]\n",
14741da177e4SLinus Torvalds 		       dmasound.volume_left);
14751da177e4SLinus Torvalds 	len += sprintf(buffer+len, "\tvol right %ddB [-22.5 ... 0]\n",
14761da177e4SLinus Torvalds 		       dmasound.volume_right);
14771da177e4SLinus Torvalds 	if (len >= space) {
14781da177e4SLinus Torvalds 		printk(KERN_ERR "dmasound_atari: overflowed state buffer alloc.\n") ;
14791da177e4SLinus Torvalds 		len = space ;
14801da177e4SLinus Torvalds 	}
14811da177e4SLinus Torvalds 	return len;
14821da177e4SLinus Torvalds }
14831da177e4SLinus Torvalds 
14841da177e4SLinus Torvalds 
14851da177e4SLinus Torvalds /*** Machine definitions *****************************************************/
14861da177e4SLinus Torvalds 
14871da177e4SLinus Torvalds static SETTINGS def_hard_falcon = {
14881da177e4SLinus Torvalds 	.format		= AFMT_S8,
14891da177e4SLinus Torvalds 	.stereo		= 0,
14901da177e4SLinus Torvalds 	.size		= 8,
14911da177e4SLinus Torvalds 	.speed		= 8195
14921da177e4SLinus Torvalds } ;
14931da177e4SLinus Torvalds 
14941da177e4SLinus Torvalds static SETTINGS def_hard_tt = {
14951da177e4SLinus Torvalds 	.format	= AFMT_S8,
14961da177e4SLinus Torvalds 	.stereo	= 0,
14971da177e4SLinus Torvalds 	.size	= 8,
14981da177e4SLinus Torvalds 	.speed	= 12517
14991da177e4SLinus Torvalds } ;
15001da177e4SLinus Torvalds 
15011da177e4SLinus Torvalds static SETTINGS def_soft = {
15021da177e4SLinus Torvalds 	.format	= AFMT_U8,
15031da177e4SLinus Torvalds 	.stereo	= 0,
15041da177e4SLinus Torvalds 	.size	= 8,
15051da177e4SLinus Torvalds 	.speed	= 8000
15061da177e4SLinus Torvalds } ;
15071da177e4SLinus Torvalds 
15081da177e4SLinus Torvalds static MACHINE machTT = {
15091da177e4SLinus Torvalds 	.name		= "Atari",
15101da177e4SLinus Torvalds 	.name2		= "TT",
15111da177e4SLinus Torvalds 	.owner		= THIS_MODULE,
15121da177e4SLinus Torvalds 	.dma_alloc	= AtaAlloc,
15131da177e4SLinus Torvalds 	.dma_free	= AtaFree,
15141da177e4SLinus Torvalds 	.irqinit	= AtaIrqInit,
15151da177e4SLinus Torvalds #ifdef MODULE
15161da177e4SLinus Torvalds 	.irqcleanup	= AtaIrqCleanUp,
15171da177e4SLinus Torvalds #endif /* MODULE */
15181da177e4SLinus Torvalds 	.init		= TTInit,
15191da177e4SLinus Torvalds 	.silence	= TTSilence,
15201da177e4SLinus Torvalds 	.setFormat	= TTSetFormat,
15211da177e4SLinus Torvalds 	.setVolume	= TTSetVolume,
15221da177e4SLinus Torvalds 	.setBass	= AtaSetBass,
15231da177e4SLinus Torvalds 	.setTreble	= AtaSetTreble,
15241da177e4SLinus Torvalds 	.setGain	= TTSetGain,
15251da177e4SLinus Torvalds 	.play		= AtaPlay,
15261da177e4SLinus Torvalds 	.mixer_init	= TTMixerInit,
15271da177e4SLinus Torvalds 	.mixer_ioctl	= TTMixerIoctl,
15281da177e4SLinus Torvalds 	.write_sq_setup	= AtaWriteSqSetup,
15291da177e4SLinus Torvalds 	.sq_open	= AtaSqOpen,
15301da177e4SLinus Torvalds 	.state_info	= TTStateInfo,
15311da177e4SLinus Torvalds 	.min_dsp_speed	= 6258,
15321da177e4SLinus Torvalds 	.version	= ((DMASOUND_ATARI_REVISION<<8) | DMASOUND_ATARI_EDITION),
15331da177e4SLinus Torvalds 	.hardware_afmts	= AFMT_S8,  /* h'ware-supported formats *only* here */
15341da177e4SLinus Torvalds 	.capabilities	=  DSP_CAP_BATCH	/* As per SNDCTL_DSP_GETCAPS */
15351da177e4SLinus Torvalds };
15361da177e4SLinus Torvalds 
15371da177e4SLinus Torvalds static MACHINE machFalcon = {
15381da177e4SLinus Torvalds 	.name		= "Atari",
15391da177e4SLinus Torvalds 	.name2		= "FALCON",
15401da177e4SLinus Torvalds 	.dma_alloc	= AtaAlloc,
15411da177e4SLinus Torvalds 	.dma_free	= AtaFree,
15421da177e4SLinus Torvalds 	.irqinit	= AtaIrqInit,
15431da177e4SLinus Torvalds #ifdef MODULE
15441da177e4SLinus Torvalds 	.irqcleanup	= AtaIrqCleanUp,
15451da177e4SLinus Torvalds #endif /* MODULE */
15461da177e4SLinus Torvalds 	.init		= FalconInit,
15471da177e4SLinus Torvalds 	.silence	= FalconSilence,
15481da177e4SLinus Torvalds 	.setFormat	= FalconSetFormat,
15491da177e4SLinus Torvalds 	.setVolume	= FalconSetVolume,
15501da177e4SLinus Torvalds 	.setBass	= AtaSetBass,
15511da177e4SLinus Torvalds 	.setTreble	= AtaSetTreble,
15521da177e4SLinus Torvalds 	.play		= AtaPlay,
15531da177e4SLinus Torvalds 	.mixer_init	= FalconMixerInit,
15541da177e4SLinus Torvalds 	.mixer_ioctl	= FalconMixerIoctl,
15551da177e4SLinus Torvalds 	.write_sq_setup	= AtaWriteSqSetup,
15561da177e4SLinus Torvalds 	.sq_open	= AtaSqOpen,
15571da177e4SLinus Torvalds 	.state_info	= FalconStateInfo,
15581da177e4SLinus Torvalds 	.min_dsp_speed	= 8195,
15591da177e4SLinus Torvalds 	.version	= ((DMASOUND_ATARI_REVISION<<8) | DMASOUND_ATARI_EDITION),
15601da177e4SLinus Torvalds 	.hardware_afmts	= (AFMT_S8 | AFMT_S16_BE), /* h'ware-supported formats *only* here */
15611da177e4SLinus Torvalds 	.capabilities	=  DSP_CAP_BATCH	/* As per SNDCTL_DSP_GETCAPS */
15621da177e4SLinus Torvalds };
15631da177e4SLinus Torvalds 
15641da177e4SLinus Torvalds 
15651da177e4SLinus Torvalds /*** Config & Setup **********************************************************/
15661da177e4SLinus Torvalds 
15671da177e4SLinus Torvalds 
15681da177e4SLinus Torvalds static int __init dmasound_atari_init(void)
15691da177e4SLinus Torvalds {
15701da177e4SLinus Torvalds 	if (MACH_IS_ATARI && ATARIHW_PRESENT(PCM_8BIT)) {
15711da177e4SLinus Torvalds 	    if (ATARIHW_PRESENT(CODEC)) {
15721da177e4SLinus Torvalds 		dmasound.mach = machFalcon;
15731da177e4SLinus Torvalds 		dmasound.mach.default_soft = def_soft ;
15741da177e4SLinus Torvalds 		dmasound.mach.default_hard = def_hard_falcon ;
15751da177e4SLinus Torvalds 		is_falcon = 1;
15761da177e4SLinus Torvalds 	    } else if (ATARIHW_PRESENT(MICROWIRE)) {
15771da177e4SLinus Torvalds 		dmasound.mach = machTT;
15781da177e4SLinus Torvalds 		dmasound.mach.default_soft = def_soft ;
15791da177e4SLinus Torvalds 		dmasound.mach.default_hard = def_hard_tt ;
15801da177e4SLinus Torvalds 		is_falcon = 0;
15811da177e4SLinus Torvalds 	    } else
15821da177e4SLinus Torvalds 		return -ENODEV;
15831da177e4SLinus Torvalds 	    if ((mfp.int_en_a & mfp.int_mk_a & 0x20) == 0)
15841da177e4SLinus Torvalds 		return dmasound_init();
15851da177e4SLinus Torvalds 	    else {
15861da177e4SLinus Torvalds 		printk("DMA sound driver: Timer A interrupt already in use\n");
15871da177e4SLinus Torvalds 		return -EBUSY;
15881da177e4SLinus Torvalds 	    }
15891da177e4SLinus Torvalds 	}
15901da177e4SLinus Torvalds 	return -ENODEV;
15911da177e4SLinus Torvalds }
15921da177e4SLinus Torvalds 
15931da177e4SLinus Torvalds static void __exit dmasound_atari_cleanup(void)
15941da177e4SLinus Torvalds {
15951da177e4SLinus Torvalds 	dmasound_deinit();
15961da177e4SLinus Torvalds }
15971da177e4SLinus Torvalds 
15981da177e4SLinus Torvalds module_init(dmasound_atari_init);
15991da177e4SLinus Torvalds module_exit(dmasound_atari_cleanup);
16001da177e4SLinus Torvalds MODULE_LICENSE("GPL");
1601