 1efddcc981
			
		
	
	
	1efddcc981
	
	
	
		
			
			Add a spin_unlock missing on the error path. The semantic match that finds this problem is as follows: (http://coccinelle.lip6.fr/) // <smpl> @@ expression E1; @@ * spin_lock(E1,...); <+... when != E1 if (...) { ... when != E1 * return ...; } ...+> * spin_unlock(E1,...); // </smpl> Signed-off-by: Julia Lawall <julia@diku.dk> Signed-off-by: Takashi Iwai <tiwai@suse.de>
		
			
				
	
	
		
			1620 lines
		
	
	
	
		
			42 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			1620 lines
		
	
	
	
		
			42 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
| /*
 | |
|  *  linux/sound/oss/dmasound/dmasound_atari.c
 | |
|  *
 | |
|  *  Atari TT and Falcon DMA Sound Driver
 | |
|  *
 | |
|  *  See linux/sound/oss/dmasound/dmasound_core.c for copyright and credits
 | |
|  *  prior to 28/01/2001
 | |
|  *
 | |
|  *  28/01/2001 [0.1] Iain Sandoe
 | |
|  *		     - added versioning
 | |
|  *		     - put in and populated the hardware_afmts field.
 | |
|  *             [0.2] - put in SNDCTL_DSP_GETCAPS value.
 | |
|  *  01/02/2001 [0.3] - put in default hard/soft settings.
 | |
|  */
 | |
| 
 | |
| 
 | |
| #include <linux/module.h>
 | |
| #include <linux/kernel.h>
 | |
| #include <linux/init.h>
 | |
| #include <linux/soundcard.h>
 | |
| #include <linux/mm.h>
 | |
| #include <linux/spinlock.h>
 | |
| #include <linux/interrupt.h>
 | |
| 
 | |
| #include <asm/uaccess.h>
 | |
| #include <asm/atariints.h>
 | |
| #include <asm/atari_stram.h>
 | |
| 
 | |
| #include "dmasound.h"
 | |
| 
 | |
| #define DMASOUND_ATARI_REVISION 0
 | |
| #define DMASOUND_ATARI_EDITION 3
 | |
| 
 | |
| extern void atari_microwire_cmd(int cmd);
 | |
| 
 | |
| static int is_falcon;
 | |
| static int write_sq_ignore_int;	/* ++TeSche: used for Falcon */
 | |
| 
 | |
| static int expand_bal;	/* Balance factor for expanding (not volume!) */
 | |
| static int expand_data;	/* Data for expanding */
 | |
| 
 | |
| 
 | |
| /*** Translations ************************************************************/
 | |
| 
 | |
| 
 | |
| /* ++TeSche: radically changed for new expanding purposes...
 | |
|  *
 | |
|  * These two routines now deal with copying/expanding/translating the samples
 | |
|  * from user space into our buffer at the right frequency. They take care about
 | |
|  * how much data there's actually to read, how much buffer space there is and
 | |
|  * to convert samples into the right frequency/encoding. They will only work on
 | |
|  * complete samples so it may happen they leave some bytes in the input stream
 | |
|  * if the user didn't write a multiple of the current sample size. They both
 | |
|  * return the number of bytes they've used from both streams so you may detect
 | |
|  * such a situation. Luckily all programs should be able to cope with that.
 | |
|  *
 | |
|  * I think I've optimized anything as far as one can do in plain C, all
 | |
|  * variables should fit in registers and the loops are really short. There's
 | |
|  * one loop for every possible situation. Writing a more generalized and thus
 | |
|  * parameterized loop would only produce slower code. Feel free to optimize
 | |
|  * this in assembler if you like. :)
 | |
|  *
 | |
|  * I think these routines belong here because they're not yet really hardware
 | |
|  * independent, especially the fact that the Falcon can play 16bit samples
 | |
|  * only in stereo is hardcoded in both of them!
 | |
|  *
 | |
|  * ++geert: split in even more functions (one per format)
 | |
|  */
 | |
| 
 | |
| static ssize_t ata_ct_law(const u_char __user *userPtr, size_t userCount,
 | |
| 			  u_char frame[], ssize_t *frameUsed,
 | |
| 			  ssize_t frameLeft);
 | |
| static ssize_t ata_ct_s8(const u_char __user *userPtr, size_t userCount,
 | |
| 			 u_char frame[], ssize_t *frameUsed,
 | |
| 			 ssize_t frameLeft);
 | |
| static ssize_t ata_ct_u8(const u_char __user *userPtr, size_t userCount,
 | |
| 			 u_char frame[], ssize_t *frameUsed,
 | |
| 			 ssize_t frameLeft);
 | |
| static ssize_t ata_ct_s16be(const u_char __user *userPtr, size_t userCount,
 | |
| 			    u_char frame[], ssize_t *frameUsed,
 | |
| 			    ssize_t frameLeft);
 | |
| static ssize_t ata_ct_u16be(const u_char __user *userPtr, size_t userCount,
 | |
| 			    u_char frame[], ssize_t *frameUsed,
 | |
| 			    ssize_t frameLeft);
 | |
| static ssize_t ata_ct_s16le(const u_char __user *userPtr, size_t userCount,
 | |
| 			    u_char frame[], ssize_t *frameUsed,
 | |
| 			    ssize_t frameLeft);
 | |
| static ssize_t ata_ct_u16le(const u_char __user *userPtr, size_t userCount,
 | |
| 			    u_char frame[], ssize_t *frameUsed,
 | |
| 			    ssize_t frameLeft);
 | |
| static ssize_t ata_ctx_law(const u_char __user *userPtr, size_t userCount,
 | |
| 			   u_char frame[], ssize_t *frameUsed,
 | |
| 			   ssize_t frameLeft);
 | |
| static ssize_t ata_ctx_s8(const u_char __user *userPtr, size_t userCount,
 | |
| 			  u_char frame[], ssize_t *frameUsed,
 | |
| 			  ssize_t frameLeft);
 | |
| static ssize_t ata_ctx_u8(const u_char __user *userPtr, size_t userCount,
 | |
| 			  u_char frame[], ssize_t *frameUsed,
 | |
| 			  ssize_t frameLeft);
 | |
| static ssize_t ata_ctx_s16be(const u_char __user *userPtr, size_t userCount,
 | |
| 			     u_char frame[], ssize_t *frameUsed,
 | |
| 			     ssize_t frameLeft);
 | |
| static ssize_t ata_ctx_u16be(const u_char __user *userPtr, size_t userCount,
 | |
| 			     u_char frame[], ssize_t *frameUsed,
 | |
| 			     ssize_t frameLeft);
 | |
| static ssize_t ata_ctx_s16le(const u_char __user *userPtr, size_t userCount,
 | |
| 			     u_char frame[], ssize_t *frameUsed,
 | |
| 			     ssize_t frameLeft);
 | |
| static ssize_t ata_ctx_u16le(const u_char __user *userPtr, size_t userCount,
 | |
| 			     u_char frame[], ssize_t *frameUsed,
 | |
| 			     ssize_t frameLeft);
 | |
| 
 | |
| 
 | |
| /*** Low level stuff *********************************************************/
 | |
| 
 | |
| 
 | |
| static void *AtaAlloc(unsigned int size, gfp_t flags);
 | |
| static void AtaFree(void *, unsigned int size);
 | |
| static int AtaIrqInit(void);
 | |
| #ifdef MODULE
 | |
| static void AtaIrqCleanUp(void);
 | |
| #endif /* MODULE */
 | |
| static int AtaSetBass(int bass);
 | |
| static int AtaSetTreble(int treble);
 | |
| static void TTSilence(void);
 | |
| static void TTInit(void);
 | |
| static int TTSetFormat(int format);
 | |
| static int TTSetVolume(int volume);
 | |
| static int TTSetGain(int gain);
 | |
| static void FalconSilence(void);
 | |
| static void FalconInit(void);
 | |
| static int FalconSetFormat(int format);
 | |
| static int FalconSetVolume(int volume);
 | |
| static void AtaPlayNextFrame(int index);
 | |
| static void AtaPlay(void);
 | |
| static irqreturn_t AtaInterrupt(int irq, void *dummy);
 | |
| 
 | |
| /*** Mid level stuff *********************************************************/
 | |
| 
 | |
| static void TTMixerInit(void);
 | |
| static void FalconMixerInit(void);
 | |
| static int AtaMixerIoctl(u_int cmd, u_long arg);
 | |
| static int TTMixerIoctl(u_int cmd, u_long arg);
 | |
| static int FalconMixerIoctl(u_int cmd, u_long arg);
 | |
| static int AtaWriteSqSetup(void);
 | |
| static int AtaSqOpen(fmode_t mode);
 | |
| static int TTStateInfo(char *buffer, size_t space);
 | |
| static int FalconStateInfo(char *buffer, size_t space);
 | |
| 
 | |
| 
 | |
| /*** Translations ************************************************************/
 | |
| 
 | |
| 
 | |
| static ssize_t ata_ct_law(const u_char __user *userPtr, size_t userCount,
 | |
| 			  u_char frame[], ssize_t *frameUsed,
 | |
| 			  ssize_t frameLeft)
 | |
| {
 | |
| 	char *table = dmasound.soft.format == AFMT_MU_LAW ? dmasound_ulaw2dma8
 | |
| 							  : dmasound_alaw2dma8;
 | |
| 	ssize_t count, used;
 | |
| 	u_char *p = &frame[*frameUsed];
 | |
| 
 | |
| 	count = min_t(unsigned long, userCount, frameLeft);
 | |
| 	if (dmasound.soft.stereo)
 | |
| 		count &= ~1;
 | |
| 	used = count;
 | |
| 	while (count > 0) {
 | |
| 		u_char data;
 | |
| 		if (get_user(data, userPtr++))
 | |
| 			return -EFAULT;
 | |
| 		*p++ = table[data];
 | |
| 		count--;
 | |
| 	}
 | |
| 	*frameUsed += used;
 | |
| 	return used;
 | |
| }
 | |
| 
 | |
| 
 | |
| static ssize_t ata_ct_s8(const u_char __user *userPtr, size_t userCount,
 | |
| 			 u_char frame[], ssize_t *frameUsed,
 | |
| 			 ssize_t frameLeft)
 | |
| {
 | |
| 	ssize_t count, used;
 | |
| 	void *p = &frame[*frameUsed];
 | |
| 
 | |
| 	count = min_t(unsigned long, userCount, frameLeft);
 | |
| 	if (dmasound.soft.stereo)
 | |
| 		count &= ~1;
 | |
| 	used = count;
 | |
| 	if (copy_from_user(p, userPtr, count))
 | |
| 		return -EFAULT;
 | |
| 	*frameUsed += used;
 | |
| 	return used;
 | |
| }
 | |
| 
 | |
| 
 | |
| static ssize_t ata_ct_u8(const u_char __user *userPtr, size_t userCount,
 | |
| 			 u_char frame[], ssize_t *frameUsed,
 | |
| 			 ssize_t frameLeft)
 | |
| {
 | |
| 	ssize_t count, used;
 | |
| 
 | |
| 	if (!dmasound.soft.stereo) {
 | |
| 		u_char *p = &frame[*frameUsed];
 | |
| 		count = min_t(unsigned long, userCount, frameLeft);
 | |
| 		used = count;
 | |
| 		while (count > 0) {
 | |
| 			u_char data;
 | |
| 			if (get_user(data, userPtr++))
 | |
| 				return -EFAULT;
 | |
| 			*p++ = data ^ 0x80;
 | |
| 			count--;
 | |
| 		}
 | |
| 	} else {
 | |
| 		u_short *p = (u_short *)&frame[*frameUsed];
 | |
| 		count = min_t(unsigned long, userCount, frameLeft)>>1;
 | |
| 		used = count*2;
 | |
| 		while (count > 0) {
 | |
| 			u_short data;
 | |
| 			if (get_user(data, (u_short __user *)userPtr))
 | |
| 				return -EFAULT;
 | |
| 			userPtr += 2;
 | |
| 			*p++ = data ^ 0x8080;
 | |
| 			count--;
 | |
| 		}
 | |
| 	}
 | |
| 	*frameUsed += used;
 | |
| 	return used;
 | |
| }
 | |
| 
 | |
| 
 | |
| static ssize_t ata_ct_s16be(const u_char __user *userPtr, size_t userCount,
 | |
| 			    u_char frame[], ssize_t *frameUsed,
 | |
| 			    ssize_t frameLeft)
 | |
| {
 | |
| 	ssize_t count, used;
 | |
| 
 | |
| 	if (!dmasound.soft.stereo) {
 | |
| 		u_short *p = (u_short *)&frame[*frameUsed];
 | |
| 		count = min_t(unsigned long, userCount, frameLeft)>>1;
 | |
| 		used = count*2;
 | |
| 		while (count > 0) {
 | |
| 			u_short data;
 | |
| 			if (get_user(data, (u_short __user *)userPtr))
 | |
| 				return -EFAULT;
 | |
| 			userPtr += 2;
 | |
| 			*p++ = data;
 | |
| 			*p++ = data;
 | |
| 			count--;
 | |
| 		}
 | |
| 		*frameUsed += used*2;
 | |
| 	} else {
 | |
| 		void *p = (u_short *)&frame[*frameUsed];
 | |
| 		count = min_t(unsigned long, userCount, frameLeft) & ~3;
 | |
| 		used = count;
 | |
| 		if (copy_from_user(p, userPtr, count))
 | |
| 			return -EFAULT;
 | |
| 		*frameUsed += used;
 | |
| 	}
 | |
| 	return used;
 | |
| }
 | |
| 
 | |
| 
 | |
| static ssize_t ata_ct_u16be(const u_char __user *userPtr, size_t userCount,
 | |
| 			    u_char frame[], ssize_t *frameUsed,
 | |
| 			    ssize_t frameLeft)
 | |
| {
 | |
| 	ssize_t count, used;
 | |
| 
 | |
| 	if (!dmasound.soft.stereo) {
 | |
| 		u_short *p = (u_short *)&frame[*frameUsed];
 | |
| 		count = min_t(unsigned long, userCount, frameLeft)>>1;
 | |
| 		used = count*2;
 | |
| 		while (count > 0) {
 | |
| 			u_short data;
 | |
| 			if (get_user(data, (u_short __user *)userPtr))
 | |
| 				return -EFAULT;
 | |
| 			userPtr += 2;
 | |
| 			data ^= 0x8000;
 | |
| 			*p++ = data;
 | |
| 			*p++ = data;
 | |
| 			count--;
 | |
| 		}
 | |
| 		*frameUsed += used*2;
 | |
| 	} else {
 | |
| 		u_long *p = (u_long *)&frame[*frameUsed];
 | |
| 		count = min_t(unsigned long, userCount, frameLeft)>>2;
 | |
| 		used = count*4;
 | |
| 		while (count > 0) {
 | |
| 			u_int data;
 | |
| 			if (get_user(data, (u_int __user *)userPtr))
 | |
| 				return -EFAULT;
 | |
| 			userPtr += 4;
 | |
| 			*p++ = data ^ 0x80008000;
 | |
| 			count--;
 | |
| 		}
 | |
| 		*frameUsed += used;
 | |
| 	}
 | |
| 	return used;
 | |
| }
 | |
| 
 | |
| 
 | |
| static ssize_t ata_ct_s16le(const u_char __user *userPtr, size_t userCount,
 | |
| 			    u_char frame[], ssize_t *frameUsed,
 | |
| 			    ssize_t frameLeft)
 | |
| {
 | |
| 	ssize_t count, used;
 | |
| 
 | |
| 	count = frameLeft;
 | |
| 	if (!dmasound.soft.stereo) {
 | |
| 		u_short *p = (u_short *)&frame[*frameUsed];
 | |
| 		count = min_t(unsigned long, userCount, frameLeft)>>1;
 | |
| 		used = count*2;
 | |
| 		while (count > 0) {
 | |
| 			u_short data;
 | |
| 			if (get_user(data, (u_short __user *)userPtr))
 | |
| 				return -EFAULT;
 | |
| 			userPtr += 2;
 | |
| 			data = le2be16(data);
 | |
| 			*p++ = data;
 | |
| 			*p++ = data;
 | |
| 			count--;
 | |
| 		}
 | |
| 		*frameUsed += used*2;
 | |
| 	} else {
 | |
| 		u_long *p = (u_long *)&frame[*frameUsed];
 | |
| 		count = min_t(unsigned long, userCount, frameLeft)>>2;
 | |
| 		used = count*4;
 | |
| 		while (count > 0) {
 | |
| 			u_long data;
 | |
| 			if (get_user(data, (u_int __user *)userPtr))
 | |
| 				return -EFAULT;
 | |
| 			userPtr += 4;
 | |
| 			data = le2be16dbl(data);
 | |
| 			*p++ = data;
 | |
| 			count--;
 | |
| 		}
 | |
| 		*frameUsed += used;
 | |
| 	}
 | |
| 	return used;
 | |
| }
 | |
| 
 | |
| 
 | |
| static ssize_t ata_ct_u16le(const u_char __user *userPtr, size_t userCount,
 | |
| 			    u_char frame[], ssize_t *frameUsed,
 | |
| 			    ssize_t frameLeft)
 | |
| {
 | |
| 	ssize_t count, used;
 | |
| 
 | |
| 	count = frameLeft;
 | |
| 	if (!dmasound.soft.stereo) {
 | |
| 		u_short *p = (u_short *)&frame[*frameUsed];
 | |
| 		count = min_t(unsigned long, userCount, frameLeft)>>1;
 | |
| 		used = count*2;
 | |
| 		while (count > 0) {
 | |
| 			u_short data;
 | |
| 			if (get_user(data, (u_short __user *)userPtr))
 | |
| 				return -EFAULT;
 | |
| 			userPtr += 2;
 | |
| 			data = le2be16(data) ^ 0x8000;
 | |
| 			*p++ = data;
 | |
| 			*p++ = data;
 | |
| 		}
 | |
| 		*frameUsed += used*2;
 | |
| 	} else {
 | |
| 		u_long *p = (u_long *)&frame[*frameUsed];
 | |
| 		count = min_t(unsigned long, userCount, frameLeft)>>2;
 | |
| 		used = count;
 | |
| 		while (count > 0) {
 | |
| 			u_long data;
 | |
| 			if (get_user(data, (u_int __user *)userPtr))
 | |
| 				return -EFAULT;
 | |
| 			userPtr += 4;
 | |
| 			data = le2be16dbl(data) ^ 0x80008000;
 | |
| 			*p++ = data;
 | |
| 			count--;
 | |
| 		}
 | |
| 		*frameUsed += used;
 | |
| 	}
 | |
| 	return used;
 | |
| }
 | |
| 
 | |
| 
 | |
| static ssize_t ata_ctx_law(const u_char __user *userPtr, size_t userCount,
 | |
| 			   u_char frame[], ssize_t *frameUsed,
 | |
| 			   ssize_t frameLeft)
 | |
| {
 | |
| 	char *table = dmasound.soft.format == AFMT_MU_LAW ? dmasound_ulaw2dma8
 | |
| 							  : dmasound_alaw2dma8;
 | |
| 	/* this should help gcc to stuff everything into registers */
 | |
| 	long bal = expand_bal;
 | |
| 	long hSpeed = dmasound.hard.speed, sSpeed = dmasound.soft.speed;
 | |
| 	ssize_t used, usedf;
 | |
| 
 | |
| 	used = userCount;
 | |
| 	usedf = frameLeft;
 | |
| 	if (!dmasound.soft.stereo) {
 | |
| 		u_char *p = &frame[*frameUsed];
 | |
| 		u_char data = expand_data;
 | |
| 		while (frameLeft) {
 | |
| 			u_char c;
 | |
| 			if (bal < 0) {
 | |
| 				if (!userCount)
 | |
| 					break;
 | |
| 				if (get_user(c, userPtr++))
 | |
| 					return -EFAULT;
 | |
| 				data = table[c];
 | |
| 				userCount--;
 | |
| 				bal += hSpeed;
 | |
| 			}
 | |
| 			*p++ = data;
 | |
| 			frameLeft--;
 | |
| 			bal -= sSpeed;
 | |
| 		}
 | |
| 		expand_data = data;
 | |
| 	} else {
 | |
| 		u_short *p = (u_short *)&frame[*frameUsed];
 | |
| 		u_short data = expand_data;
 | |
| 		while (frameLeft >= 2) {
 | |
| 			u_char c;
 | |
| 			if (bal < 0) {
 | |
| 				if (userCount < 2)
 | |
| 					break;
 | |
| 				if (get_user(c, userPtr++))
 | |
| 					return -EFAULT;
 | |
| 				data = table[c] << 8;
 | |
| 				if (get_user(c, userPtr++))
 | |
| 					return -EFAULT;
 | |
| 				data |= table[c];
 | |
| 				userCount -= 2;
 | |
| 				bal += hSpeed;
 | |
| 			}
 | |
| 			*p++ = data;
 | |
| 			frameLeft -= 2;
 | |
| 			bal -= sSpeed;
 | |
| 		}
 | |
| 		expand_data = data;
 | |
| 	}
 | |
| 	expand_bal = bal;
 | |
| 	used -= userCount;
 | |
| 	*frameUsed += usedf-frameLeft;
 | |
| 	return used;
 | |
| }
 | |
| 
 | |
| 
 | |
| static ssize_t ata_ctx_s8(const u_char __user *userPtr, size_t userCount,
 | |
| 			  u_char frame[], ssize_t *frameUsed,
 | |
| 			  ssize_t frameLeft)
 | |
| {
 | |
| 	/* this should help gcc to stuff everything into registers */
 | |
| 	long bal = expand_bal;
 | |
| 	long hSpeed = dmasound.hard.speed, sSpeed = dmasound.soft.speed;
 | |
| 	ssize_t used, usedf;
 | |
| 
 | |
| 	used = userCount;
 | |
| 	usedf = frameLeft;
 | |
| 	if (!dmasound.soft.stereo) {
 | |
| 		u_char *p = &frame[*frameUsed];
 | |
| 		u_char data = expand_data;
 | |
| 		while (frameLeft) {
 | |
| 			if (bal < 0) {
 | |
| 				if (!userCount)
 | |
| 					break;
 | |
| 				if (get_user(data, userPtr++))
 | |
| 					return -EFAULT;
 | |
| 				userCount--;
 | |
| 				bal += hSpeed;
 | |
| 			}
 | |
| 			*p++ = data;
 | |
| 			frameLeft--;
 | |
| 			bal -= sSpeed;
 | |
| 		}
 | |
| 		expand_data = data;
 | |
| 	} else {
 | |
| 		u_short *p = (u_short *)&frame[*frameUsed];
 | |
| 		u_short data = expand_data;
 | |
| 		while (frameLeft >= 2) {
 | |
| 			if (bal < 0) {
 | |
| 				if (userCount < 2)
 | |
| 					break;
 | |
| 				if (get_user(data, (u_short __user *)userPtr))
 | |
| 					return -EFAULT;
 | |
| 				userPtr += 2;
 | |
| 				userCount -= 2;
 | |
| 				bal += hSpeed;
 | |
| 			}
 | |
| 			*p++ = data;
 | |
| 			frameLeft -= 2;
 | |
| 			bal -= sSpeed;
 | |
| 		}
 | |
| 		expand_data = data;
 | |
| 	}
 | |
| 	expand_bal = bal;
 | |
| 	used -= userCount;
 | |
| 	*frameUsed += usedf-frameLeft;
 | |
| 	return used;
 | |
| }
 | |
| 
 | |
| 
 | |
| static ssize_t ata_ctx_u8(const u_char __user *userPtr, size_t userCount,
 | |
| 			  u_char frame[], ssize_t *frameUsed,
 | |
| 			  ssize_t frameLeft)
 | |
| {
 | |
| 	/* this should help gcc to stuff everything into registers */
 | |
| 	long bal = expand_bal;
 | |
| 	long hSpeed = dmasound.hard.speed, sSpeed = dmasound.soft.speed;
 | |
| 	ssize_t used, usedf;
 | |
| 
 | |
| 	used = userCount;
 | |
| 	usedf = frameLeft;
 | |
| 	if (!dmasound.soft.stereo) {
 | |
| 		u_char *p = &frame[*frameUsed];
 | |
| 		u_char data = expand_data;
 | |
| 		while (frameLeft) {
 | |
| 			if (bal < 0) {
 | |
| 				if (!userCount)
 | |
| 					break;
 | |
| 				if (get_user(data, userPtr++))
 | |
| 					return -EFAULT;
 | |
| 				data ^= 0x80;
 | |
| 				userCount--;
 | |
| 				bal += hSpeed;
 | |
| 			}
 | |
| 			*p++ = data;
 | |
| 			frameLeft--;
 | |
| 			bal -= sSpeed;
 | |
| 		}
 | |
| 		expand_data = data;
 | |
| 	} else {
 | |
| 		u_short *p = (u_short *)&frame[*frameUsed];
 | |
| 		u_short data = expand_data;
 | |
| 		while (frameLeft >= 2) {
 | |
| 			if (bal < 0) {
 | |
| 				if (userCount < 2)
 | |
| 					break;
 | |
| 				if (get_user(data, (u_short __user *)userPtr))
 | |
| 					return -EFAULT;
 | |
| 				userPtr += 2;
 | |
| 				data ^= 0x8080;
 | |
| 				userCount -= 2;
 | |
| 				bal += hSpeed;
 | |
| 			}
 | |
| 			*p++ = data;
 | |
| 			frameLeft -= 2;
 | |
| 			bal -= sSpeed;
 | |
| 		}
 | |
| 		expand_data = data;
 | |
| 	}
 | |
| 	expand_bal = bal;
 | |
| 	used -= userCount;
 | |
| 	*frameUsed += usedf-frameLeft;
 | |
| 	return used;
 | |
| }
 | |
| 
 | |
| 
 | |
| static ssize_t ata_ctx_s16be(const u_char __user *userPtr, size_t userCount,
 | |
| 			     u_char frame[], ssize_t *frameUsed,
 | |
| 			     ssize_t frameLeft)
 | |
| {
 | |
| 	/* this should help gcc to stuff everything into registers */
 | |
| 	long bal = expand_bal;
 | |
| 	long hSpeed = dmasound.hard.speed, sSpeed = dmasound.soft.speed;
 | |
| 	ssize_t used, usedf;
 | |
| 
 | |
| 	used = userCount;
 | |
| 	usedf = frameLeft;
 | |
| 	if (!dmasound.soft.stereo) {
 | |
| 		u_short *p = (u_short *)&frame[*frameUsed];
 | |
| 		u_short data = expand_data;
 | |
| 		while (frameLeft >= 4) {
 | |
| 			if (bal < 0) {
 | |
| 				if (userCount < 2)
 | |
| 					break;
 | |
| 				if (get_user(data, (u_short __user *)userPtr))
 | |
| 					return -EFAULT;
 | |
| 				userPtr += 2;
 | |
| 				userCount -= 2;
 | |
| 				bal += hSpeed;
 | |
| 			}
 | |
| 			*p++ = data;
 | |
| 			*p++ = data;
 | |
| 			frameLeft -= 4;
 | |
| 			bal -= sSpeed;
 | |
| 		}
 | |
| 		expand_data = data;
 | |
| 	} else {
 | |
| 		u_long *p = (u_long *)&frame[*frameUsed];
 | |
| 		u_long data = expand_data;
 | |
| 		while (frameLeft >= 4) {
 | |
| 			if (bal < 0) {
 | |
| 				if (userCount < 4)
 | |
| 					break;
 | |
| 				if (get_user(data, (u_int __user *)userPtr))
 | |
| 					return -EFAULT;
 | |
| 				userPtr += 4;
 | |
| 				userCount -= 4;
 | |
| 				bal += hSpeed;
 | |
| 			}
 | |
| 			*p++ = data;
 | |
| 			frameLeft -= 4;
 | |
| 			bal -= sSpeed;
 | |
| 		}
 | |
| 		expand_data = data;
 | |
| 	}
 | |
| 	expand_bal = bal;
 | |
| 	used -= userCount;
 | |
| 	*frameUsed += usedf-frameLeft;
 | |
| 	return used;
 | |
| }
 | |
| 
 | |
| 
 | |
| static ssize_t ata_ctx_u16be(const u_char __user *userPtr, size_t userCount,
 | |
| 			     u_char frame[], ssize_t *frameUsed,
 | |
| 			     ssize_t frameLeft)
 | |
| {
 | |
| 	/* this should help gcc to stuff everything into registers */
 | |
| 	long bal = expand_bal;
 | |
| 	long hSpeed = dmasound.hard.speed, sSpeed = dmasound.soft.speed;
 | |
| 	ssize_t used, usedf;
 | |
| 
 | |
| 	used = userCount;
 | |
| 	usedf = frameLeft;
 | |
| 	if (!dmasound.soft.stereo) {
 | |
| 		u_short *p = (u_short *)&frame[*frameUsed];
 | |
| 		u_short data = expand_data;
 | |
| 		while (frameLeft >= 4) {
 | |
| 			if (bal < 0) {
 | |
| 				if (userCount < 2)
 | |
| 					break;
 | |
| 				if (get_user(data, (u_short __user *)userPtr))
 | |
| 					return -EFAULT;
 | |
| 				userPtr += 2;
 | |
| 				data ^= 0x8000;
 | |
| 				userCount -= 2;
 | |
| 				bal += hSpeed;
 | |
| 			}
 | |
| 			*p++ = data;
 | |
| 			*p++ = data;
 | |
| 			frameLeft -= 4;
 | |
| 			bal -= sSpeed;
 | |
| 		}
 | |
| 		expand_data = data;
 | |
| 	} else {
 | |
| 		u_long *p = (u_long *)&frame[*frameUsed];
 | |
| 		u_long data = expand_data;
 | |
| 		while (frameLeft >= 4) {
 | |
| 			if (bal < 0) {
 | |
| 				if (userCount < 4)
 | |
| 					break;
 | |
| 				if (get_user(data, (u_int __user *)userPtr))
 | |
| 					return -EFAULT;
 | |
| 				userPtr += 4;
 | |
| 				data ^= 0x80008000;
 | |
| 				userCount -= 4;
 | |
| 				bal += hSpeed;
 | |
| 			}
 | |
| 			*p++ = data;
 | |
| 			frameLeft -= 4;
 | |
| 			bal -= sSpeed;
 | |
| 		}
 | |
| 		expand_data = data;
 | |
| 	}
 | |
| 	expand_bal = bal;
 | |
| 	used -= userCount;
 | |
| 	*frameUsed += usedf-frameLeft;
 | |
| 	return used;
 | |
| }
 | |
| 
 | |
| 
 | |
| static ssize_t ata_ctx_s16le(const u_char __user *userPtr, size_t userCount,
 | |
| 			     u_char frame[], ssize_t *frameUsed,
 | |
| 			     ssize_t frameLeft)
 | |
| {
 | |
| 	/* this should help gcc to stuff everything into registers */
 | |
| 	long bal = expand_bal;
 | |
| 	long hSpeed = dmasound.hard.speed, sSpeed = dmasound.soft.speed;
 | |
| 	ssize_t used, usedf;
 | |
| 
 | |
| 	used = userCount;
 | |
| 	usedf = frameLeft;
 | |
| 	if (!dmasound.soft.stereo) {
 | |
| 		u_short *p = (u_short *)&frame[*frameUsed];
 | |
| 		u_short data = expand_data;
 | |
| 		while (frameLeft >= 4) {
 | |
| 			if (bal < 0) {
 | |
| 				if (userCount < 2)
 | |
| 					break;
 | |
| 				if (get_user(data, (u_short __user *)userPtr))
 | |
| 					return -EFAULT;
 | |
| 				userPtr += 2;
 | |
| 				data = le2be16(data);
 | |
| 				userCount -= 2;
 | |
| 				bal += hSpeed;
 | |
| 			}
 | |
| 			*p++ = data;
 | |
| 			*p++ = data;
 | |
| 			frameLeft -= 4;
 | |
| 			bal -= sSpeed;
 | |
| 		}
 | |
| 		expand_data = data;
 | |
| 	} else {
 | |
| 		u_long *p = (u_long *)&frame[*frameUsed];
 | |
| 		u_long data = expand_data;
 | |
| 		while (frameLeft >= 4) {
 | |
| 			if (bal < 0) {
 | |
| 				if (userCount < 4)
 | |
| 					break;
 | |
| 				if (get_user(data, (u_int __user *)userPtr))
 | |
| 					return -EFAULT;
 | |
| 				userPtr += 4;
 | |
| 				data = le2be16dbl(data);
 | |
| 				userCount -= 4;
 | |
| 				bal += hSpeed;
 | |
| 			}
 | |
| 			*p++ = data;
 | |
| 			frameLeft -= 4;
 | |
| 			bal -= sSpeed;
 | |
| 		}
 | |
| 		expand_data = data;
 | |
| 	}
 | |
| 	expand_bal = bal;
 | |
| 	used -= userCount;
 | |
| 	*frameUsed += usedf-frameLeft;
 | |
| 	return used;
 | |
| }
 | |
| 
 | |
| 
 | |
| static ssize_t ata_ctx_u16le(const u_char __user *userPtr, size_t userCount,
 | |
| 			     u_char frame[], ssize_t *frameUsed,
 | |
| 			     ssize_t frameLeft)
 | |
| {
 | |
| 	/* this should help gcc to stuff everything into registers */
 | |
| 	long bal = expand_bal;
 | |
| 	long hSpeed = dmasound.hard.speed, sSpeed = dmasound.soft.speed;
 | |
| 	ssize_t used, usedf;
 | |
| 
 | |
| 	used = userCount;
 | |
| 	usedf = frameLeft;
 | |
| 	if (!dmasound.soft.stereo) {
 | |
| 		u_short *p = (u_short *)&frame[*frameUsed];
 | |
| 		u_short data = expand_data;
 | |
| 		while (frameLeft >= 4) {
 | |
| 			if (bal < 0) {
 | |
| 				if (userCount < 2)
 | |
| 					break;
 | |
| 				if (get_user(data, (u_short __user *)userPtr))
 | |
| 					return -EFAULT;
 | |
| 				userPtr += 2;
 | |
| 				data = le2be16(data) ^ 0x8000;
 | |
| 				userCount -= 2;
 | |
| 				bal += hSpeed;
 | |
| 			}
 | |
| 			*p++ = data;
 | |
| 			*p++ = data;
 | |
| 			frameLeft -= 4;
 | |
| 			bal -= sSpeed;
 | |
| 		}
 | |
| 		expand_data = data;
 | |
| 	} else {
 | |
| 		u_long *p = (u_long *)&frame[*frameUsed];
 | |
| 		u_long data = expand_data;
 | |
| 		while (frameLeft >= 4) {
 | |
| 			if (bal < 0) {
 | |
| 				if (userCount < 4)
 | |
| 					break;
 | |
| 				if (get_user(data, (u_int __user *)userPtr))
 | |
| 					return -EFAULT;
 | |
| 				userPtr += 4;
 | |
| 				data = le2be16dbl(data) ^ 0x80008000;
 | |
| 				userCount -= 4;
 | |
| 				bal += hSpeed;
 | |
| 			}
 | |
| 			*p++ = data;
 | |
| 			frameLeft -= 4;
 | |
| 			bal -= sSpeed;
 | |
| 		}
 | |
| 		expand_data = data;
 | |
| 	}
 | |
| 	expand_bal = bal;
 | |
| 	used -= userCount;
 | |
| 	*frameUsed += usedf-frameLeft;
 | |
| 	return used;
 | |
| }
 | |
| 
 | |
| 
 | |
| static TRANS transTTNormal = {
 | |
| 	.ct_ulaw	= ata_ct_law,
 | |
| 	.ct_alaw	= ata_ct_law,
 | |
| 	.ct_s8		= ata_ct_s8,
 | |
| 	.ct_u8		= ata_ct_u8,
 | |
| };
 | |
| 
 | |
| static TRANS transTTExpanding = {
 | |
| 	.ct_ulaw	= ata_ctx_law,
 | |
| 	.ct_alaw	= ata_ctx_law,
 | |
| 	.ct_s8		= ata_ctx_s8,
 | |
| 	.ct_u8		= ata_ctx_u8,
 | |
| };
 | |
| 
 | |
| static TRANS transFalconNormal = {
 | |
| 	.ct_ulaw	= ata_ct_law,
 | |
| 	.ct_alaw	= ata_ct_law,
 | |
| 	.ct_s8		= ata_ct_s8,
 | |
| 	.ct_u8		= ata_ct_u8,
 | |
| 	.ct_s16be	= ata_ct_s16be,
 | |
| 	.ct_u16be	= ata_ct_u16be,
 | |
| 	.ct_s16le	= ata_ct_s16le,
 | |
| 	.ct_u16le	= ata_ct_u16le
 | |
| };
 | |
| 
 | |
| static TRANS transFalconExpanding = {
 | |
| 	.ct_ulaw	= ata_ctx_law,
 | |
| 	.ct_alaw	= ata_ctx_law,
 | |
| 	.ct_s8		= ata_ctx_s8,
 | |
| 	.ct_u8		= ata_ctx_u8,
 | |
| 	.ct_s16be	= ata_ctx_s16be,
 | |
| 	.ct_u16be	= ata_ctx_u16be,
 | |
| 	.ct_s16le	= ata_ctx_s16le,
 | |
| 	.ct_u16le	= ata_ctx_u16le,
 | |
| };
 | |
| 
 | |
| 
 | |
| /*** Low level stuff *********************************************************/
 | |
| 
 | |
| 
 | |
| 
 | |
| /*
 | |
|  * Atari (TT/Falcon)
 | |
|  */
 | |
| 
 | |
| static void *AtaAlloc(unsigned int size, gfp_t flags)
 | |
| {
 | |
| 	return atari_stram_alloc(size, "dmasound");
 | |
| }
 | |
| 
 | |
| static void AtaFree(void *obj, unsigned int size)
 | |
| {
 | |
| 	atari_stram_free( obj );
 | |
| }
 | |
| 
 | |
| static int __init AtaIrqInit(void)
 | |
| {
 | |
| 	/* Set up timer A. Timer A
 | |
| 	   will receive a signal upon end of playing from the sound
 | |
| 	   hardware. Furthermore Timer A is able to count events
 | |
| 	   and will cause an interrupt after a programmed number
 | |
| 	   of events. So all we need to keep the music playing is
 | |
| 	   to provide the sound hardware with new data upon
 | |
| 	   an interrupt from timer A. */
 | |
| 	st_mfp.tim_ct_a = 0;	/* ++roman: Stop timer before programming! */
 | |
| 	st_mfp.tim_dt_a = 1;	/* Cause interrupt after first event. */
 | |
| 	st_mfp.tim_ct_a = 8;	/* Turn on event counting. */
 | |
| 	/* Register interrupt handler. */
 | |
| 	if (request_irq(IRQ_MFP_TIMA, AtaInterrupt, IRQ_TYPE_SLOW, "DMA sound",
 | |
| 			AtaInterrupt))
 | |
| 		return 0;
 | |
| 	st_mfp.int_en_a |= 0x20;	/* Turn interrupt on. */
 | |
| 	st_mfp.int_mk_a |= 0x20;
 | |
| 	return 1;
 | |
| }
 | |
| 
 | |
| #ifdef MODULE
 | |
| static void AtaIrqCleanUp(void)
 | |
| {
 | |
| 	st_mfp.tim_ct_a = 0;		/* stop timer */
 | |
| 	st_mfp.int_en_a &= ~0x20;	/* turn interrupt off */
 | |
| 	free_irq(IRQ_MFP_TIMA, AtaInterrupt);
 | |
| }
 | |
| #endif /* MODULE */
 | |
| 
 | |
| 
 | |
| #define TONE_VOXWARE_TO_DB(v) \
 | |
| 	(((v) < 0) ? -12 : ((v) > 100) ? 12 : ((v) - 50) * 6 / 25)
 | |
| #define TONE_DB_TO_VOXWARE(v) (((v) * 25 + ((v) > 0 ? 5 : -5)) / 6 + 50)
 | |
| 
 | |
| 
 | |
| static int AtaSetBass(int bass)
 | |
| {
 | |
| 	dmasound.bass = TONE_VOXWARE_TO_DB(bass);
 | |
| 	atari_microwire_cmd(MW_LM1992_BASS(dmasound.bass));
 | |
| 	return TONE_DB_TO_VOXWARE(dmasound.bass);
 | |
| }
 | |
| 
 | |
| 
 | |
| static int AtaSetTreble(int treble)
 | |
| {
 | |
| 	dmasound.treble = TONE_VOXWARE_TO_DB(treble);
 | |
| 	atari_microwire_cmd(MW_LM1992_TREBLE(dmasound.treble));
 | |
| 	return TONE_DB_TO_VOXWARE(dmasound.treble);
 | |
| }
 | |
| 
 | |
| 
 | |
| 
 | |
| /*
 | |
|  * TT
 | |
|  */
 | |
| 
 | |
| 
 | |
| static void TTSilence(void)
 | |
| {
 | |
| 	tt_dmasnd.ctrl = DMASND_CTRL_OFF;
 | |
| 	atari_microwire_cmd(MW_LM1992_PSG_HIGH); /* mix in PSG signal 1:1 */
 | |
| }
 | |
| 
 | |
| 
 | |
| static void TTInit(void)
 | |
| {
 | |
| 	int mode, i, idx;
 | |
| 	const int freq[4] = {50066, 25033, 12517, 6258};
 | |
| 
 | |
| 	/* search a frequency that fits into the allowed error range */
 | |
| 
 | |
| 	idx = -1;
 | |
| 	for (i = 0; i < ARRAY_SIZE(freq); i++)
 | |
| 		/* this isn't as much useful for a TT than for a Falcon, but
 | |
| 		 * then it doesn't hurt very much to implement it for a TT too.
 | |
| 		 */
 | |
| 		if ((100 * abs(dmasound.soft.speed - freq[i]) / freq[i]) < catchRadius)
 | |
| 			idx = i;
 | |
| 	if (idx > -1) {
 | |
| 		dmasound.soft.speed = freq[idx];
 | |
| 		dmasound.trans_write = &transTTNormal;
 | |
| 	} else
 | |
| 		dmasound.trans_write = &transTTExpanding;
 | |
| 
 | |
| 	TTSilence();
 | |
| 	dmasound.hard = dmasound.soft;
 | |
| 
 | |
| 	if (dmasound.hard.speed > 50066) {
 | |
| 		/* we would need to squeeze the sound, but we won't do that */
 | |
| 		dmasound.hard.speed = 50066;
 | |
| 		mode = DMASND_MODE_50KHZ;
 | |
| 		dmasound.trans_write = &transTTNormal;
 | |
| 	} else if (dmasound.hard.speed > 25033) {
 | |
| 		dmasound.hard.speed = 50066;
 | |
| 		mode = DMASND_MODE_50KHZ;
 | |
| 	} else if (dmasound.hard.speed > 12517) {
 | |
| 		dmasound.hard.speed = 25033;
 | |
| 		mode = DMASND_MODE_25KHZ;
 | |
| 	} else if (dmasound.hard.speed > 6258) {
 | |
| 		dmasound.hard.speed = 12517;
 | |
| 		mode = DMASND_MODE_12KHZ;
 | |
| 	} else {
 | |
| 		dmasound.hard.speed = 6258;
 | |
| 		mode = DMASND_MODE_6KHZ;
 | |
| 	}
 | |
| 
 | |
| 	tt_dmasnd.mode = (dmasound.hard.stereo ?
 | |
| 			  DMASND_MODE_STEREO : DMASND_MODE_MONO) |
 | |
| 		DMASND_MODE_8BIT | mode;
 | |
| 
 | |
| 	expand_bal = -dmasound.soft.speed;
 | |
| }
 | |
| 
 | |
| 
 | |
| static int TTSetFormat(int format)
 | |
| {
 | |
| 	/* TT sound DMA supports only 8bit modes */
 | |
| 
 | |
| 	switch (format) {
 | |
| 	case AFMT_QUERY:
 | |
| 		return dmasound.soft.format;
 | |
| 	case AFMT_MU_LAW:
 | |
| 	case AFMT_A_LAW:
 | |
| 	case AFMT_S8:
 | |
| 	case AFMT_U8:
 | |
| 		break;
 | |
| 	default:
 | |
| 		format = AFMT_S8;
 | |
| 	}
 | |
| 
 | |
| 	dmasound.soft.format = format;
 | |
| 	dmasound.soft.size = 8;
 | |
| 	if (dmasound.minDev == SND_DEV_DSP) {
 | |
| 		dmasound.dsp.format = format;
 | |
| 		dmasound.dsp.size = 8;
 | |
| 	}
 | |
| 	TTInit();
 | |
| 
 | |
| 	return format;
 | |
| }
 | |
| 
 | |
| 
 | |
| #define VOLUME_VOXWARE_TO_DB(v) \
 | |
| 	(((v) < 0) ? -40 : ((v) > 100) ? 0 : ((v) * 2) / 5 - 40)
 | |
| #define VOLUME_DB_TO_VOXWARE(v) ((((v) + 40) * 5 + 1) / 2)
 | |
| 
 | |
| 
 | |
| static int TTSetVolume(int volume)
 | |
| {
 | |
| 	dmasound.volume_left = VOLUME_VOXWARE_TO_DB(volume & 0xff);
 | |
| 	atari_microwire_cmd(MW_LM1992_BALLEFT(dmasound.volume_left));
 | |
| 	dmasound.volume_right = VOLUME_VOXWARE_TO_DB((volume & 0xff00) >> 8);
 | |
| 	atari_microwire_cmd(MW_LM1992_BALRIGHT(dmasound.volume_right));
 | |
| 	return VOLUME_DB_TO_VOXWARE(dmasound.volume_left) |
 | |
| 	       (VOLUME_DB_TO_VOXWARE(dmasound.volume_right) << 8);
 | |
| }
 | |
| 
 | |
| 
 | |
| #define GAIN_VOXWARE_TO_DB(v) \
 | |
| 	(((v) < 0) ? -80 : ((v) > 100) ? 0 : ((v) * 4) / 5 - 80)
 | |
| #define GAIN_DB_TO_VOXWARE(v) ((((v) + 80) * 5 + 1) / 4)
 | |
| 
 | |
| static int TTSetGain(int gain)
 | |
| {
 | |
| 	dmasound.gain = GAIN_VOXWARE_TO_DB(gain);
 | |
| 	atari_microwire_cmd(MW_LM1992_VOLUME(dmasound.gain));
 | |
| 	return GAIN_DB_TO_VOXWARE(dmasound.gain);
 | |
| }
 | |
| 
 | |
| 
 | |
| 
 | |
| /*
 | |
|  * Falcon
 | |
|  */
 | |
| 
 | |
| 
 | |
| static void FalconSilence(void)
 | |
| {
 | |
| 	/* stop playback, set sample rate 50kHz for PSG sound */
 | |
| 	tt_dmasnd.ctrl = DMASND_CTRL_OFF;
 | |
| 	tt_dmasnd.mode = DMASND_MODE_50KHZ | DMASND_MODE_STEREO | DMASND_MODE_8BIT;
 | |
| 	tt_dmasnd.int_div = 0; /* STE compatible divider */
 | |
| 	tt_dmasnd.int_ctrl = 0x0;
 | |
| 	tt_dmasnd.cbar_src = 0x0000; /* no matrix inputs */
 | |
| 	tt_dmasnd.cbar_dst = 0x0000; /* no matrix outputs */
 | |
| 	tt_dmasnd.dac_src = 1; /* connect ADC to DAC, disconnect matrix */
 | |
| 	tt_dmasnd.adc_src = 3; /* ADC Input = PSG */
 | |
| }
 | |
| 
 | |
| 
 | |
| static void FalconInit(void)
 | |
| {
 | |
| 	int divider, i, idx;
 | |
| 	const int freq[8] = {49170, 32780, 24585, 19668, 16390, 12292, 9834, 8195};
 | |
| 
 | |
| 	/* search a frequency that fits into the allowed error range */
 | |
| 
 | |
| 	idx = -1;
 | |
| 	for (i = 0; i < ARRAY_SIZE(freq); i++)
 | |
| 		/* if we will tolerate 3% error 8000Hz->8195Hz (2.38%) would
 | |
| 		 * be playable without expanding, but that now a kernel runtime
 | |
| 		 * option
 | |
| 		 */
 | |
| 		if ((100 * abs(dmasound.soft.speed - freq[i]) / freq[i]) < catchRadius)
 | |
| 			idx = i;
 | |
| 	if (idx > -1) {
 | |
| 		dmasound.soft.speed = freq[idx];
 | |
| 		dmasound.trans_write = &transFalconNormal;
 | |
| 	} else
 | |
| 		dmasound.trans_write = &transFalconExpanding;
 | |
| 
 | |
| 	FalconSilence();
 | |
| 	dmasound.hard = dmasound.soft;
 | |
| 
 | |
| 	if (dmasound.hard.size == 16) {
 | |
| 		/* the Falcon can play 16bit samples only in stereo */
 | |
| 		dmasound.hard.stereo = 1;
 | |
| 	}
 | |
| 
 | |
| 	if (dmasound.hard.speed > 49170) {
 | |
| 		/* we would need to squeeze the sound, but we won't do that */
 | |
| 		dmasound.hard.speed = 49170;
 | |
| 		divider = 1;
 | |
| 		dmasound.trans_write = &transFalconNormal;
 | |
| 	} else if (dmasound.hard.speed > 32780) {
 | |
| 		dmasound.hard.speed = 49170;
 | |
| 		divider = 1;
 | |
| 	} else if (dmasound.hard.speed > 24585) {
 | |
| 		dmasound.hard.speed = 32780;
 | |
| 		divider = 2;
 | |
| 	} else if (dmasound.hard.speed > 19668) {
 | |
| 		dmasound.hard.speed = 24585;
 | |
| 		divider = 3;
 | |
| 	} else if (dmasound.hard.speed > 16390) {
 | |
| 		dmasound.hard.speed = 19668;
 | |
| 		divider = 4;
 | |
| 	} else if (dmasound.hard.speed > 12292) {
 | |
| 		dmasound.hard.speed = 16390;
 | |
| 		divider = 5;
 | |
| 	} else if (dmasound.hard.speed > 9834) {
 | |
| 		dmasound.hard.speed = 12292;
 | |
| 		divider = 7;
 | |
| 	} else if (dmasound.hard.speed > 8195) {
 | |
| 		dmasound.hard.speed = 9834;
 | |
| 		divider = 9;
 | |
| 	} else {
 | |
| 		dmasound.hard.speed = 8195;
 | |
| 		divider = 11;
 | |
| 	}
 | |
| 	tt_dmasnd.int_div = divider;
 | |
| 
 | |
| 	/* Setup Falcon sound DMA for playback */
 | |
| 	tt_dmasnd.int_ctrl = 0x4; /* Timer A int at play end */
 | |
| 	tt_dmasnd.track_select = 0x0; /* play 1 track, track 1 */
 | |
| 	tt_dmasnd.cbar_src = 0x0001; /* DMA(25MHz) --> DAC */
 | |
| 	tt_dmasnd.cbar_dst = 0x0000;
 | |
| 	tt_dmasnd.rec_track_select = 0;
 | |
| 	tt_dmasnd.dac_src = 2; /* connect matrix to DAC */
 | |
| 	tt_dmasnd.adc_src = 0; /* ADC Input = Mic */
 | |
| 
 | |
| 	tt_dmasnd.mode = (dmasound.hard.stereo ?
 | |
| 			  DMASND_MODE_STEREO : DMASND_MODE_MONO) |
 | |
| 		((dmasound.hard.size == 8) ?
 | |
| 		 DMASND_MODE_8BIT : DMASND_MODE_16BIT) |
 | |
| 		DMASND_MODE_6KHZ;
 | |
| 
 | |
| 	expand_bal = -dmasound.soft.speed;
 | |
| }
 | |
| 
 | |
| 
 | |
| static int FalconSetFormat(int format)
 | |
| {
 | |
| 	int size;
 | |
| 	/* Falcon sound DMA supports 8bit and 16bit modes */
 | |
| 
 | |
| 	switch (format) {
 | |
| 	case AFMT_QUERY:
 | |
| 		return dmasound.soft.format;
 | |
| 	case AFMT_MU_LAW:
 | |
| 	case AFMT_A_LAW:
 | |
| 	case AFMT_U8:
 | |
| 	case AFMT_S8:
 | |
| 		size = 8;
 | |
| 		break;
 | |
| 	case AFMT_S16_BE:
 | |
| 	case AFMT_U16_BE:
 | |
| 	case AFMT_S16_LE:
 | |
| 	case AFMT_U16_LE:
 | |
| 		size = 16;
 | |
| 		break;
 | |
| 	default: /* :-) */
 | |
| 		size = 8;
 | |
| 		format = AFMT_S8;
 | |
| 	}
 | |
| 
 | |
| 	dmasound.soft.format = format;
 | |
| 	dmasound.soft.size = size;
 | |
| 	if (dmasound.minDev == SND_DEV_DSP) {
 | |
| 		dmasound.dsp.format = format;
 | |
| 		dmasound.dsp.size = dmasound.soft.size;
 | |
| 	}
 | |
| 
 | |
| 	FalconInit();
 | |
| 
 | |
| 	return format;
 | |
| }
 | |
| 
 | |
| 
 | |
| /* This is for the Falcon output *attenuation* in 1.5dB steps,
 | |
|  * i.e. output level from 0 to -22.5dB in -1.5dB steps.
 | |
|  */
 | |
| #define VOLUME_VOXWARE_TO_ATT(v) \
 | |
| 	((v) < 0 ? 15 : (v) > 100 ? 0 : 15 - (v) * 3 / 20)
 | |
| #define VOLUME_ATT_TO_VOXWARE(v) (100 - (v) * 20 / 3)
 | |
| 
 | |
| 
 | |
| static int FalconSetVolume(int volume)
 | |
| {
 | |
| 	dmasound.volume_left = VOLUME_VOXWARE_TO_ATT(volume & 0xff);
 | |
| 	dmasound.volume_right = VOLUME_VOXWARE_TO_ATT((volume & 0xff00) >> 8);
 | |
| 	tt_dmasnd.output_atten = dmasound.volume_left << 8 | dmasound.volume_right << 4;
 | |
| 	return VOLUME_ATT_TO_VOXWARE(dmasound.volume_left) |
 | |
| 	       VOLUME_ATT_TO_VOXWARE(dmasound.volume_right) << 8;
 | |
| }
 | |
| 
 | |
| 
 | |
| static void AtaPlayNextFrame(int index)
 | |
| {
 | |
| 	char *start, *end;
 | |
| 
 | |
| 	/* used by AtaPlay() if all doubts whether there really is something
 | |
| 	 * to be played are already wiped out.
 | |
| 	 */
 | |
| 	start = write_sq.buffers[write_sq.front];
 | |
| 	end = start+((write_sq.count == index) ? write_sq.rear_size
 | |
| 					       : write_sq.block_size);
 | |
| 	/* end might not be a legal virtual address. */
 | |
| 	DMASNDSetEnd(virt_to_phys(end - 1) + 1);
 | |
| 	DMASNDSetBase(virt_to_phys(start));
 | |
| 	/* Since only an even number of samples per frame can
 | |
| 	   be played, we might lose one byte here. (TO DO) */
 | |
| 	write_sq.front = (write_sq.front+1) % write_sq.max_count;
 | |
| 	write_sq.active++;
 | |
| 	tt_dmasnd.ctrl = DMASND_CTRL_ON | DMASND_CTRL_REPEAT;
 | |
| }
 | |
| 
 | |
| 
 | |
| static void AtaPlay(void)
 | |
| {
 | |
| 	/* ++TeSche: Note that write_sq.active is no longer just a flag but
 | |
| 	 * holds the number of frames the DMA is currently programmed for
 | |
| 	 * instead, may be 0, 1 (currently being played) or 2 (pre-programmed).
 | |
| 	 *
 | |
| 	 * Changes done to write_sq.count and write_sq.active are a bit more
 | |
| 	 * subtle again so now I must admit I also prefer disabling the irq
 | |
| 	 * here rather than considering all possible situations. But the point
 | |
| 	 * is that disabling the irq doesn't have any bad influence on this
 | |
| 	 * version of the driver as we benefit from having pre-programmed the
 | |
| 	 * DMA wherever possible: There's no need to reload the DMA at the
 | |
| 	 * exact time of an interrupt but only at some time while the
 | |
| 	 * pre-programmed frame is playing!
 | |
| 	 */
 | |
| 	atari_disable_irq(IRQ_MFP_TIMA);
 | |
| 
 | |
| 	if (write_sq.active == 2 ||	/* DMA is 'full' */
 | |
| 	    write_sq.count <= 0) {	/* nothing to do */
 | |
| 		atari_enable_irq(IRQ_MFP_TIMA);
 | |
| 		return;
 | |
| 	}
 | |
| 
 | |
| 	if (write_sq.active == 0) {
 | |
| 		/* looks like there's nothing 'in' the DMA yet, so try
 | |
| 		 * to put two frames into it (at least one is available).
 | |
| 		 */
 | |
| 		if (write_sq.count == 1 &&
 | |
| 		    write_sq.rear_size < write_sq.block_size &&
 | |
| 		    !write_sq.syncing) {
 | |
| 			/* hmmm, the only existing frame is not
 | |
| 			 * yet filled and we're not syncing?
 | |
| 			 */
 | |
| 			atari_enable_irq(IRQ_MFP_TIMA);
 | |
| 			return;
 | |
| 		}
 | |
| 		AtaPlayNextFrame(1);
 | |
| 		if (write_sq.count == 1) {
 | |
| 			/* no more frames */
 | |
| 			atari_enable_irq(IRQ_MFP_TIMA);
 | |
| 			return;
 | |
| 		}
 | |
| 		if (write_sq.count == 2 &&
 | |
| 		    write_sq.rear_size < write_sq.block_size &&
 | |
| 		    !write_sq.syncing) {
 | |
| 			/* hmmm, there were two frames, but the second
 | |
| 			 * one is not yet filled and we're not syncing?
 | |
| 			 */
 | |
| 			atari_enable_irq(IRQ_MFP_TIMA);
 | |
| 			return;
 | |
| 		}
 | |
| 		AtaPlayNextFrame(2);
 | |
| 	} else {
 | |
| 		/* there's already a frame being played so we may only stuff
 | |
| 		 * one new into the DMA, but even if this may be the last
 | |
| 		 * frame existing the previous one is still on write_sq.count.
 | |
| 		 */
 | |
| 		if (write_sq.count == 2 &&
 | |
| 		    write_sq.rear_size < write_sq.block_size &&
 | |
| 		    !write_sq.syncing) {
 | |
| 			/* hmmm, the only existing frame is not
 | |
| 			 * yet filled and we're not syncing?
 | |
| 			 */
 | |
| 			atari_enable_irq(IRQ_MFP_TIMA);
 | |
| 			return;
 | |
| 		}
 | |
| 		AtaPlayNextFrame(2);
 | |
| 	}
 | |
| 	atari_enable_irq(IRQ_MFP_TIMA);
 | |
| }
 | |
| 
 | |
| 
 | |
| static irqreturn_t AtaInterrupt(int irq, void *dummy)
 | |
| {
 | |
| #if 0
 | |
| 	/* ++TeSche: if you should want to test this... */
 | |
| 	static int cnt;
 | |
| 	if (write_sq.active == 2)
 | |
| 		if (++cnt == 10) {
 | |
| 			/* simulate losing an interrupt */
 | |
| 			cnt = 0;
 | |
| 			return IRQ_HANDLED;
 | |
| 		}
 | |
| #endif
 | |
| 	spin_lock(&dmasound.lock);
 | |
| 	if (write_sq_ignore_int && is_falcon) {
 | |
| 		/* ++TeSche: Falcon only: ignore first irq because it comes
 | |
| 		 * immediately after starting a frame. after that, irqs come
 | |
| 		 * (almost) like on the TT.
 | |
| 		 */
 | |
| 		write_sq_ignore_int = 0;
 | |
| 		goto out;
 | |
| 	}
 | |
| 
 | |
| 	if (!write_sq.active) {
 | |
| 		/* playing was interrupted and sq_reset() has already cleared
 | |
| 		 * the sq variables, so better don't do anything here.
 | |
| 		 */
 | |
| 		WAKE_UP(write_sq.sync_queue);
 | |
| 		goto out;
 | |
| 	}
 | |
| 
 | |
| 	/* Probably ;) one frame is finished. Well, in fact it may be that a
 | |
| 	 * pre-programmed one is also finished because there has been a long
 | |
| 	 * delay in interrupt delivery and we've completely lost one, but
 | |
| 	 * there's no way to detect such a situation. In such a case the last
 | |
| 	 * frame will be played more than once and the situation will recover
 | |
| 	 * as soon as the irq gets through.
 | |
| 	 */
 | |
| 	write_sq.count--;
 | |
| 	write_sq.active--;
 | |
| 
 | |
| 	if (!write_sq.active) {
 | |
| 		tt_dmasnd.ctrl = DMASND_CTRL_OFF;
 | |
| 		write_sq_ignore_int = 1;
 | |
| 	}
 | |
| 
 | |
| 	WAKE_UP(write_sq.action_queue);
 | |
| 	/* At least one block of the queue is free now
 | |
| 	   so wake up a writing process blocked because
 | |
| 	   of a full queue. */
 | |
| 
 | |
| 	if ((write_sq.active != 1) || (write_sq.count != 1))
 | |
| 		/* We must be a bit carefully here: write_sq.count indicates the
 | |
| 		 * number of buffers used and not the number of frames to be
 | |
| 		 * played. If write_sq.count==1 and write_sq.active==1 that
 | |
| 		 * means the only remaining frame was already programmed
 | |
| 		 * earlier (and is currently running) so we mustn't call
 | |
| 		 * AtaPlay() here, otherwise we'll play one frame too much.
 | |
| 		 */
 | |
| 		AtaPlay();
 | |
| 
 | |
| 	if (!write_sq.active) WAKE_UP(write_sq.sync_queue);
 | |
| 	/* We are not playing after AtaPlay(), so there
 | |
| 	   is nothing to play any more. Wake up a process
 | |
| 	   waiting for audio output to drain. */
 | |
| out:
 | |
| 	spin_unlock(&dmasound.lock);
 | |
| 	return IRQ_HANDLED;
 | |
| }
 | |
| 
 | |
| 
 | |
| /*** Mid level stuff *********************************************************/
 | |
| 
 | |
| 
 | |
| /*
 | |
|  * /dev/mixer abstraction
 | |
|  */
 | |
| 
 | |
| #define RECLEVEL_VOXWARE_TO_GAIN(v)	\
 | |
| 	((v) < 0 ? 0 : (v) > 100 ? 15 : (v) * 3 / 20)
 | |
| #define RECLEVEL_GAIN_TO_VOXWARE(v)	(((v) * 20 + 2) / 3)
 | |
| 
 | |
| 
 | |
| static void __init TTMixerInit(void)
 | |
| {
 | |
| 	atari_microwire_cmd(MW_LM1992_VOLUME(0));
 | |
| 	dmasound.volume_left = 0;
 | |
| 	atari_microwire_cmd(MW_LM1992_BALLEFT(0));
 | |
| 	dmasound.volume_right = 0;
 | |
| 	atari_microwire_cmd(MW_LM1992_BALRIGHT(0));
 | |
| 	atari_microwire_cmd(MW_LM1992_TREBLE(0));
 | |
| 	atari_microwire_cmd(MW_LM1992_BASS(0));
 | |
| }
 | |
| 
 | |
| static void __init FalconMixerInit(void)
 | |
| {
 | |
| 	dmasound.volume_left = (tt_dmasnd.output_atten & 0xf00) >> 8;
 | |
| 	dmasound.volume_right = (tt_dmasnd.output_atten & 0xf0) >> 4;
 | |
| }
 | |
| 
 | |
| static int AtaMixerIoctl(u_int cmd, u_long arg)
 | |
| {
 | |
| 	int data;
 | |
| 	unsigned long flags;
 | |
| 	switch (cmd) {
 | |
| 	    case SOUND_MIXER_READ_SPEAKER:
 | |
| 		    if (is_falcon || MACH_IS_TT) {
 | |
| 			    int porta;
 | |
| 			    spin_lock_irqsave(&dmasound.lock, flags);
 | |
| 			    sound_ym.rd_data_reg_sel = 14;
 | |
| 			    porta = sound_ym.rd_data_reg_sel;
 | |
| 			    spin_unlock_irqrestore(&dmasound.lock, flags);
 | |
| 			    return IOCTL_OUT(arg, porta & 0x40 ? 0 : 100);
 | |
| 		    }
 | |
| 		    break;
 | |
| 	    case SOUND_MIXER_WRITE_VOLUME:
 | |
| 		    IOCTL_IN(arg, data);
 | |
| 		    return IOCTL_OUT(arg, dmasound_set_volume(data));
 | |
| 	    case SOUND_MIXER_WRITE_SPEAKER:
 | |
| 		    if (is_falcon || MACH_IS_TT) {
 | |
| 			    int porta;
 | |
| 			    IOCTL_IN(arg, data);
 | |
| 			    spin_lock_irqsave(&dmasound.lock, flags);
 | |
| 			    sound_ym.rd_data_reg_sel = 14;
 | |
| 			    porta = (sound_ym.rd_data_reg_sel & ~0x40) |
 | |
| 				    (data < 50 ? 0x40 : 0);
 | |
| 			    sound_ym.wd_data = porta;
 | |
| 			    spin_unlock_irqrestore(&dmasound.lock, flags);
 | |
| 			    return IOCTL_OUT(arg, porta & 0x40 ? 0 : 100);
 | |
| 		    }
 | |
| 	}
 | |
| 	return -EINVAL;
 | |
| }
 | |
| 
 | |
| 
 | |
| static int TTMixerIoctl(u_int cmd, u_long arg)
 | |
| {
 | |
| 	int data;
 | |
| 	switch (cmd) {
 | |
| 	    case SOUND_MIXER_READ_RECMASK:
 | |
| 		return IOCTL_OUT(arg, 0);
 | |
| 	    case SOUND_MIXER_READ_DEVMASK:
 | |
| 		return IOCTL_OUT(arg,
 | |
| 				 SOUND_MASK_VOLUME | SOUND_MASK_TREBLE | SOUND_MASK_BASS |
 | |
| 				 (MACH_IS_TT ? SOUND_MASK_SPEAKER : 0));
 | |
| 	    case SOUND_MIXER_READ_STEREODEVS:
 | |
| 		return IOCTL_OUT(arg, SOUND_MASK_VOLUME);
 | |
| 	    case SOUND_MIXER_READ_VOLUME:
 | |
| 		return IOCTL_OUT(arg,
 | |
| 				 VOLUME_DB_TO_VOXWARE(dmasound.volume_left) |
 | |
| 				 (VOLUME_DB_TO_VOXWARE(dmasound.volume_right) << 8));
 | |
| 	    case SOUND_MIXER_READ_BASS:
 | |
| 		return IOCTL_OUT(arg, TONE_DB_TO_VOXWARE(dmasound.bass));
 | |
| 	    case SOUND_MIXER_READ_TREBLE:
 | |
| 		return IOCTL_OUT(arg, TONE_DB_TO_VOXWARE(dmasound.treble));
 | |
| 	    case SOUND_MIXER_READ_OGAIN:
 | |
| 		return IOCTL_OUT(arg, GAIN_DB_TO_VOXWARE(dmasound.gain));
 | |
| 	    case SOUND_MIXER_WRITE_BASS:
 | |
| 		IOCTL_IN(arg, data);
 | |
| 		return IOCTL_OUT(arg, dmasound_set_bass(data));
 | |
| 	    case SOUND_MIXER_WRITE_TREBLE:
 | |
| 		IOCTL_IN(arg, data);
 | |
| 		return IOCTL_OUT(arg, dmasound_set_treble(data));
 | |
| 	    case SOUND_MIXER_WRITE_OGAIN:
 | |
| 		IOCTL_IN(arg, data);
 | |
| 		return IOCTL_OUT(arg, dmasound_set_gain(data));
 | |
| 	}
 | |
| 	return AtaMixerIoctl(cmd, arg);
 | |
| }
 | |
| 
 | |
| static int FalconMixerIoctl(u_int cmd, u_long arg)
 | |
| {
 | |
| 	int data;
 | |
| 	switch (cmd) {
 | |
| 	    case SOUND_MIXER_READ_RECMASK:
 | |
| 		return IOCTL_OUT(arg, SOUND_MASK_MIC);
 | |
| 	    case SOUND_MIXER_READ_DEVMASK:
 | |
| 		return IOCTL_OUT(arg, SOUND_MASK_VOLUME | SOUND_MASK_MIC | SOUND_MASK_SPEAKER);
 | |
| 	    case SOUND_MIXER_READ_STEREODEVS:
 | |
| 		return IOCTL_OUT(arg, SOUND_MASK_VOLUME | SOUND_MASK_MIC);
 | |
| 	    case SOUND_MIXER_READ_VOLUME:
 | |
| 		return IOCTL_OUT(arg,
 | |
| 			VOLUME_ATT_TO_VOXWARE(dmasound.volume_left) |
 | |
| 			VOLUME_ATT_TO_VOXWARE(dmasound.volume_right) << 8);
 | |
| 	    case SOUND_MIXER_READ_CAPS:
 | |
| 		return IOCTL_OUT(arg, SOUND_CAP_EXCL_INPUT);
 | |
| 	    case SOUND_MIXER_WRITE_MIC:
 | |
| 		IOCTL_IN(arg, data);
 | |
| 		tt_dmasnd.input_gain =
 | |
| 			RECLEVEL_VOXWARE_TO_GAIN(data & 0xff) << 4 |
 | |
| 			RECLEVEL_VOXWARE_TO_GAIN(data >> 8 & 0xff);
 | |
| 		/* fall thru, return set value */
 | |
| 	    case SOUND_MIXER_READ_MIC:
 | |
| 		return IOCTL_OUT(arg,
 | |
| 			RECLEVEL_GAIN_TO_VOXWARE(tt_dmasnd.input_gain >> 4 & 0xf) |
 | |
| 			RECLEVEL_GAIN_TO_VOXWARE(tt_dmasnd.input_gain & 0xf) << 8);
 | |
| 	}
 | |
| 	return AtaMixerIoctl(cmd, arg);
 | |
| }
 | |
| 
 | |
| static int AtaWriteSqSetup(void)
 | |
| {
 | |
| 	write_sq_ignore_int = 0;
 | |
| 	return 0 ;
 | |
| }
 | |
| 
 | |
| static int AtaSqOpen(fmode_t mode)
 | |
| {
 | |
| 	write_sq_ignore_int = 1;
 | |
| 	return 0 ;
 | |
| }
 | |
| 
 | |
| static int TTStateInfo(char *buffer, size_t space)
 | |
| {
 | |
| 	int len = 0;
 | |
| 	len += sprintf(buffer+len, "\tvol left  %ddB [-40...  0]\n",
 | |
| 		       dmasound.volume_left);
 | |
| 	len += sprintf(buffer+len, "\tvol right %ddB [-40...  0]\n",
 | |
| 		       dmasound.volume_right);
 | |
| 	len += sprintf(buffer+len, "\tbass      %ddB [-12...+12]\n",
 | |
| 		       dmasound.bass);
 | |
| 	len += sprintf(buffer+len, "\ttreble    %ddB [-12...+12]\n",
 | |
| 		       dmasound.treble);
 | |
| 	if (len >= space) {
 | |
| 		printk(KERN_ERR "dmasound_atari: overflowed state buffer alloc.\n") ;
 | |
| 		len = space ;
 | |
| 	}
 | |
| 	return len;
 | |
| }
 | |
| 
 | |
| static int FalconStateInfo(char *buffer, size_t space)
 | |
| {
 | |
| 	int len = 0;
 | |
| 	len += sprintf(buffer+len, "\tvol left  %ddB [-22.5 ... 0]\n",
 | |
| 		       dmasound.volume_left);
 | |
| 	len += sprintf(buffer+len, "\tvol right %ddB [-22.5 ... 0]\n",
 | |
| 		       dmasound.volume_right);
 | |
| 	if (len >= space) {
 | |
| 		printk(KERN_ERR "dmasound_atari: overflowed state buffer alloc.\n") ;
 | |
| 		len = space ;
 | |
| 	}
 | |
| 	return len;
 | |
| }
 | |
| 
 | |
| 
 | |
| /*** Machine definitions *****************************************************/
 | |
| 
 | |
| static SETTINGS def_hard_falcon = {
 | |
| 	.format		= AFMT_S8,
 | |
| 	.stereo		= 0,
 | |
| 	.size		= 8,
 | |
| 	.speed		= 8195
 | |
| } ;
 | |
| 
 | |
| static SETTINGS def_hard_tt = {
 | |
| 	.format	= AFMT_S8,
 | |
| 	.stereo	= 0,
 | |
| 	.size	= 8,
 | |
| 	.speed	= 12517
 | |
| } ;
 | |
| 
 | |
| static SETTINGS def_soft = {
 | |
| 	.format	= AFMT_U8,
 | |
| 	.stereo	= 0,
 | |
| 	.size	= 8,
 | |
| 	.speed	= 8000
 | |
| } ;
 | |
| 
 | |
| static __initdata MACHINE machTT = {
 | |
| 	.name		= "Atari",
 | |
| 	.name2		= "TT",
 | |
| 	.owner		= THIS_MODULE,
 | |
| 	.dma_alloc	= AtaAlloc,
 | |
| 	.dma_free	= AtaFree,
 | |
| 	.irqinit	= AtaIrqInit,
 | |
| #ifdef MODULE
 | |
| 	.irqcleanup	= AtaIrqCleanUp,
 | |
| #endif /* MODULE */
 | |
| 	.init		= TTInit,
 | |
| 	.silence	= TTSilence,
 | |
| 	.setFormat	= TTSetFormat,
 | |
| 	.setVolume	= TTSetVolume,
 | |
| 	.setBass	= AtaSetBass,
 | |
| 	.setTreble	= AtaSetTreble,
 | |
| 	.setGain	= TTSetGain,
 | |
| 	.play		= AtaPlay,
 | |
| 	.mixer_init	= TTMixerInit,
 | |
| 	.mixer_ioctl	= TTMixerIoctl,
 | |
| 	.write_sq_setup	= AtaWriteSqSetup,
 | |
| 	.sq_open	= AtaSqOpen,
 | |
| 	.state_info	= TTStateInfo,
 | |
| 	.min_dsp_speed	= 6258,
 | |
| 	.version	= ((DMASOUND_ATARI_REVISION<<8) | DMASOUND_ATARI_EDITION),
 | |
| 	.hardware_afmts	= AFMT_S8,  /* h'ware-supported formats *only* here */
 | |
| 	.capabilities	=  DSP_CAP_BATCH	/* As per SNDCTL_DSP_GETCAPS */
 | |
| };
 | |
| 
 | |
| static __initdata MACHINE machFalcon = {
 | |
| 	.name		= "Atari",
 | |
| 	.name2		= "FALCON",
 | |
| 	.dma_alloc	= AtaAlloc,
 | |
| 	.dma_free	= AtaFree,
 | |
| 	.irqinit	= AtaIrqInit,
 | |
| #ifdef MODULE
 | |
| 	.irqcleanup	= AtaIrqCleanUp,
 | |
| #endif /* MODULE */
 | |
| 	.init		= FalconInit,
 | |
| 	.silence	= FalconSilence,
 | |
| 	.setFormat	= FalconSetFormat,
 | |
| 	.setVolume	= FalconSetVolume,
 | |
| 	.setBass	= AtaSetBass,
 | |
| 	.setTreble	= AtaSetTreble,
 | |
| 	.play		= AtaPlay,
 | |
| 	.mixer_init	= FalconMixerInit,
 | |
| 	.mixer_ioctl	= FalconMixerIoctl,
 | |
| 	.write_sq_setup	= AtaWriteSqSetup,
 | |
| 	.sq_open	= AtaSqOpen,
 | |
| 	.state_info	= FalconStateInfo,
 | |
| 	.min_dsp_speed	= 8195,
 | |
| 	.version	= ((DMASOUND_ATARI_REVISION<<8) | DMASOUND_ATARI_EDITION),
 | |
| 	.hardware_afmts	= (AFMT_S8 | AFMT_S16_BE), /* h'ware-supported formats *only* here */
 | |
| 	.capabilities	=  DSP_CAP_BATCH	/* As per SNDCTL_DSP_GETCAPS */
 | |
| };
 | |
| 
 | |
| 
 | |
| /*** Config & Setup **********************************************************/
 | |
| 
 | |
| 
 | |
| static int __init dmasound_atari_init(void)
 | |
| {
 | |
| 	if (MACH_IS_ATARI && ATARIHW_PRESENT(PCM_8BIT)) {
 | |
| 	    if (ATARIHW_PRESENT(CODEC)) {
 | |
| 		dmasound.mach = machFalcon;
 | |
| 		dmasound.mach.default_soft = def_soft ;
 | |
| 		dmasound.mach.default_hard = def_hard_falcon ;
 | |
| 		is_falcon = 1;
 | |
| 	    } else if (ATARIHW_PRESENT(MICROWIRE)) {
 | |
| 		dmasound.mach = machTT;
 | |
| 		dmasound.mach.default_soft = def_soft ;
 | |
| 		dmasound.mach.default_hard = def_hard_tt ;
 | |
| 		is_falcon = 0;
 | |
| 	    } else
 | |
| 		return -ENODEV;
 | |
| 	    if ((st_mfp.int_en_a & st_mfp.int_mk_a & 0x20) == 0)
 | |
| 		return dmasound_init();
 | |
| 	    else {
 | |
| 		printk("DMA sound driver: Timer A interrupt already in use\n");
 | |
| 		return -EBUSY;
 | |
| 	    }
 | |
| 	}
 | |
| 	return -ENODEV;
 | |
| }
 | |
| 
 | |
| static void __exit dmasound_atari_cleanup(void)
 | |
| {
 | |
| 	dmasound_deinit();
 | |
| }
 | |
| 
 | |
| module_init(dmasound_atari_init);
 | |
| module_exit(dmasound_atari_cleanup);
 | |
| MODULE_LICENSE("GPL");
 |