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");
 |