/* * Philips UDA1341 Audio Device Driver for S3C2410 Linux * * Copyright (C) 2002 MIZI Research, Inc. * */#include <linux/module.h>#include <linux/init.h>#include <linux/types.h>#include <linux/fs.h>#include <linux/mm.h>#include <linux/slab.h>#include <linux/delay.h>#include <linux/sched.h>#include <linux/poll.h>#include <linux/interrupt.h>#include <linux/errno.h>#include <linux/sound.h>#include <linux/soundcard.h>#include <linux/pm.h>#include <asm/uaccess.h>#include <asm/io.h>#include <asm/hardware.h>#include <asm/semaphore.h>#include <asm/dma.h>#include <asm/arch/cpu_s3c2410.h>#undef  DEBUG#ifdef DEBUG#define DPRINTK( x... )  printk( ##x )#else#define DPRINTK( x... )#endifstatic void init_s3c2410_iis_bus_rx(void);static void init_s3c2410_iis_bus_tx(void);#define DEF_VOLUME      65/* UDA1341 Register bits */#define UDA1341_ADDR		0x14#define UDA1341_REG_DATA0	(UDA1341_ADDR + 0)#define UDA1341_REG_STATUS	(UDA1341_ADDR + 2)/* status control */#define STAT0			(0x00)#define STAT0_RST               (1 << 6)#define STAT0_SC_MASK           (3 << 4)#define STAT0_SC_512FS          (0 << 4)#define STAT0_SC_384FS          (1 << 4)#define STAT0_SC_256FS          (2 << 4)#define STAT0_IF_MASK           (7 << 1)#define STAT0_IF_I2S            (0 << 1)#define STAT0_IF_LSB16          (1 << 1)#define STAT0_IF_LSB18          (2 << 1)#define STAT0_IF_LSB20          (3 << 1)#define STAT0_IF_MSB            (4 << 1)#define STAT0_IF_LSB16MSB       (5 << 1)#define STAT0_IF_LSB18MSB       (6 << 1)#define STAT0_IF_LSB20MSB       (7 << 1)#define STAT0_DC_FILTER         (1 << 0)#define STAT0_DC_NO_FILTER	(0 << 0)#define STAT1			(0x80)#define STAT1_DAC_GAIN          (1 << 6)        /* gain of DAC */#define STAT1_ADC_GAIN          (1 << 5)        /* gain of ADC */#define STAT1_ADC_POL           (1 << 4)        /* polarity of ADC */#define STAT1_DAC_POL           (1 << 3)        /* polarity of DAC */#define STAT1_DBL_SPD           (1 << 2)        /* double speed playback */#define STAT1_ADC_ON            (1 << 1)        /* ADC powered */#define STAT1_DAC_ON            (1 << 0)        /* DAC powered *//* data0 direct control */#define DATA0     		(0x00)#define DATA0_VOLUME_MASK       (0x3f)#define DATA0_VOLUME(x)         (x)#define DATA1     		(0x40)#define DATA1_BASS(x)           ((x) << 2)#define DATA1_BASS_MASK         (15 << 2)#define DATA1_TREBLE(x)         ((x))#define DATA1_TREBLE_MASK       (3)#define DATA2     		(0x80)#define DATA2_PEAKAFTER         (0x1 << 5)#define DATA2_DEEMP_NONE        (0x0 << 3)#define DATA2_DEEMP_32KHz       (0x1 << 3)#define DATA2_DEEMP_44KHz       (0x2 << 3)#define DATA2_DEEMP_48KHz       (0x3 << 3)#define DATA2_MUTE              (0x1 << 2)#define DATA2_FILTER_FLAT       (0x0 << 0)#define DATA2_FILTER_MIN        (0x1 << 0)#define DATA2_FILTER_MAX        (0x3 << 0)/* data0 extend control */#define EXTADDR(n)              (0xc0 | (n))#define EXTDATA(d)              (0xe0 | (d))#define EXT0                    0#define EXT0_CH1_GAIN(x)        (x)#define EXT1                    1#define EXT1_CH2_GAIN(x)        (x)#define EXT2                    2#define EXT2_MIC_GAIN_MASK      (7 << 2)#define EXT2_MIC_GAIN(x)        ((x) << 2)#define EXT2_MIXMODE_DOUBLEDIFF (0)#define EXT2_MIXMODE_CH1        (1)#define EXT2_MIXMODE_CH2        (2)#define EXT2_MIXMODE_MIX        (3)#define EXT4                    4#define EXT4_AGC_ENABLE         (1 << 4)#define EXT4_INPUT_GAIN_MASK    (3)#define EXT4_INPUT_GAIN(x)      ((x) & 3)#define EXT5                    5#define EXT5_INPUT_GAIN(x)      ((x) >> 2)#define EXT6                    6#define EXT6_AGC_CONSTANT_MASK  (7 << 2)#define EXT6_AGC_CONSTANT(x)    ((x) << 2)#define EXT6_AGC_LEVEL_MASK     (3)#define EXT6_AGC_LEVEL(x)       (x)#define GPIO_L3CLOCK            (GPIO_MODE_OUT | GPIO_PULLUP_DIS | GPIO_B4)#define GPIO_L3DATA             (GPIO_MODE_OUT | GPIO_PULLUP_DIS | GPIO_B3)#define GPIO_L3MODE             (GPIO_MODE_OUT | GPIO_PULLUP_DIS | GPIO_B2)#define AUDIO_NAME		"UDA1341"#define AUDIO_NAME_VERBOSE	"UDA1341 audio driver"#define AUDIO_FMT_MASK          (AFMT_S16_LE)#define AUDIO_FMT_DEFAULT       (AFMT_S16_LE)#define AUDIO_CHANNELS_DEFAULT	2#define AUDIO_RATE_DEFAULT	22050#define AUDIO_NBFRAGS_DEFAULT	8#define AUDIO_FRAGSIZE_DEFAULT	8192#define S_CLOCK_FREQ	384#define PCM_ABS(a) (a < 0 ? -a : a)typedef struct {	int size;		/* buffer size */	char *start;		/* point to actual buffer */	dma_addr_t dma_addr;	/* physical buffer address */	struct semaphore sem;	/* down before touching the buffer */	int master;		/* owner for buffer allocation, contain size when true */} audio_buf_t;typedef struct {	audio_buf_t *buffers;	/* pointer to audio buffer structures */	audio_buf_t *buf;	/* current buffer used by read/write */	u_int buf_idx;		/* index for the pointer above */	u_int fragsize;		/* fragment i.e. buffer size */	u_int nbfrags;		/* nbr of fragments */	dmach_t dma_ch;		/* DMA channel (channel2 for audio) */} audio_stream_t;static audio_stream_t output_stream;static audio_stream_t input_stream; /* input */#define NEXT_BUF(_s_,_b_) { \        (_s_)->_b_##_idx++; \        (_s_)->_b_##_idx %= (_s_)->nbfrags; \        (_s_)->_b_ = (_s_)->buffers + (_s_)->_b_##_idx; }static u_int audio_rate;static int audio_channels;static int audio_fmt;static u_int audio_fragsize;static u_int audio_nbfrags;static int audio_rd_refcount;static int audio_wr_refcount;#define audio_active		(audio_rd_refcount | audio_wr_refcount)static int audio_dev_dsp;static int audio_dev_mixer;static int audio_mix_modcnt;static int uda1341_volume;static u8 uda_sampling;static int uda1341_boost;static int mixer_igain=0x4; /* -6db*/static void uda1341_l3_address(u8 data){	int i;	int flags;	local_irq_save(flags);	write_gpio_bit(GPIO_L3MODE, 0);	write_gpio_bit(GPIO_L3DATA, 0);	write_gpio_bit(GPIO_L3CLOCK, 1);	udelay(1);		for (i = 0; i < 8; i++) {		if (data & 0x1) {			write_gpio_bit(GPIO_L3CLOCK, 0);			udelay(1);			write_gpio_bit(GPIO_L3DATA, 1);			udelay(1);			write_gpio_bit(GPIO_L3CLOCK, 1);			udelay(1);		} else {			write_gpio_bit(GPIO_L3CLOCK, 0);			udelay(1);			write_gpio_bit(GPIO_L3DATA, 0);			udelay(1);			write_gpio_bit(GPIO_L3CLOCK, 1);			udelay(1);		}		data >>= 1;	}	write_gpio_bit(GPIO_L3MODE, 1);	udelay(1);	local_irq_restore(flags);}static void uda1341_l3_data(u8 data){	int i;	int flags;	local_irq_save(flags);	write_gpio_bit(GPIO_L3MODE, 1);	udelay(1);	write_gpio_bit(GPIO_L3MODE, 0);	udelay(1);	write_gpio_bit(GPIO_L3MODE, 1);	for (i = 0; i < 8; i++) {		if (data & 0x1) {			write_gpio_bit(GPIO_L3CLOCK, 0);			udelay(1);			write_gpio_bit(GPIO_L3DATA, 1);			udelay(1);			write_gpio_bit(GPIO_L3CLOCK, 1);			udelay(1);		} else {			write_gpio_bit(GPIO_L3CLOCK, 0);			udelay(1);			write_gpio_bit(GPIO_L3DATA, 0);			udelay(1);			write_gpio_bit(GPIO_L3CLOCK, 1);			udelay(1);		}		data >>= 1;	}	write_gpio_bit(GPIO_L3MODE, 1);	write_gpio_bit(GPIO_L3MODE, 0);	udelay(1);	write_gpio_bit(GPIO_L3MODE, 1);	local_irq_restore(flags);}static void audio_clear_buf(audio_stream_t * s){    	DPRINTK("audio_clear_buf\n");	s3c2410_dma_flush_all(s->dma_ch);	if (s->buffers) {		int frag;		for (frag = 0; frag < s->nbfrags; frag++) {			if (!s->buffers[frag].master)				continue;			consistent_free(s->buffers[frag].start,					s->buffers[frag].master,					s->buffers[frag].dma_addr);		}		kfree(s->buffers);		s->buffers = NULL;	}	s->buf_idx = 0;	s->buf = NULL;}static int audio_setup_buf(audio_stream_t * s){	int frag;	int dmasize = 0;	char *dmabuf = 0;	dma_addr_t dmaphys = 0;	if (s->buffers)		return -EBUSY;	s->nbfrags = audio_nbfrags;	s->fragsize = audio_fragsize;	s->buffers = (audio_buf_t *)	    kmalloc(sizeof(audio_buf_t) * s->nbfrags, GFP_KERNEL);	if (!s->buffers)		goto err;	memset(s->buffers, 0, sizeof(audio_buf_t) * s->nbfrags);	for (frag = 0; frag < s->nbfrags; frag++) {		audio_buf_t *b = &s->buffers[frag];		if (!dmasize) {			dmasize = (s->nbfrags - frag) * s->fragsize;			do {				dmabuf = consistent_alloc(GFP_KERNEL|GFP_DMA,							  dmasize, &dmaphys);				if (!dmabuf) 				    	dmasize -= s->fragsize;			} while (!dmabuf && dmasize);			if (!dmabuf)				goto err;			b->master = dmasize;		}		b->start = dmabuf;		b->dma_addr = dmaphys;		sema_init(&b->sem, 1);		DPRINTK("buf %d: start %p dma %d\n", frag, b->start, b->dma_addr);		dmabuf += s->fragsize;		dmaphys += s->fragsize;		dmasize -= s->fragsize;	}	s->buf_idx = 0;	s->buf = &s->buffers[0];	return 0;      err:	printk(AUDIO_NAME ": unable to allocate audio memory\n ");	audio_clear_buf(s);	return -ENOMEM;}static void audio_dmaout_done_callback(void *buf_id, int size){	audio_buf_t *b = (audio_buf_t *) buf_id;		up(&b->sem);	wake_up(&b->sem.wait);}static void audio_dmain_done_callback(void *buf_id, int size){	audio_buf_t *b = (audio_buf_t *) buf_id;	  	b->size = size;	up(&b->sem);	wake_up(&b->sem.wait);		} /* using when write */static int audio_sync(struct file *file){	audio_stream_t *s = &output_stream;	audio_buf_t *b = s->buf;	DPRINTK("audio_sync\n");	if (!s->buffers)		return 0;	if (b->size != 0) {		down(&b->sem);		s3c2410_dma_queue_buffer(s->dma_ch, (void *) b,					 b->dma_addr, b->size, DMA_BUF_WR);		b->size = 0;		NEXT_BUF(s, buf);	}	b = s->buffers + ((s->nbfrags + s->buf_idx - 1) % s->nbfrags);	if (down_interruptible(&b->sem))		return -EINTR;	up(&b->sem);	return 0;}static inline int copy_from_user_mono_stereo(char *to, const char *from, int count){	u_int *dst = (u_int *)to;	const char *end = from + count;	if (verify_area(VERIFY_READ, from, count))		return -EFAULT;	if ((int)from & 0x2) {