#include <linux/module.h>#include <linux/device.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/dma.h>#include <asm/arch/regs-gpio.h>#include <asm/arch/regs-iis.h>#include <asm/hardware/clock.h>#include <asm/arch/regs-clock.h>#include <linux/dma-mapping.h>#include <asm/dma-mapping.h>#include <asm/arch/hardware.h>#include <asm/arch/map.h>#include <asm/arch/S3C2410.h>#define PFX "s3c2410-uda1341-superlp: "#define MAX_DMA_CHANNELS 0/* The S3C2410 has four internal DMA channels. */#define MAX_S3C2410_DMA_CHANNELS S3C2410_DMA_CHANNELS#define DMA_CH0 0#define DMA_CH1 1#define DMA_CH2 2#define DMA_CH3 3#define DMA_BUF_WR 1#define DMA_BUF_RD 0#define dma_wrreg(chan, reg, val) writel((val), (chan)->regs + (reg))static struct clk *iis_clock;static void __iomem *iis_base;static struct s3c2410_dma_client s3c2410iis_dma_out= {.name = "I2SSDO",};static struct s3c2410_dma_client s3c2410iis_dma_in = {.name = "I2SSDI",};#ifdef DEBUG#define DPRINTK printk#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 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 44100#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) */u_int dma_ok;} 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;unsigned long flags;local_irq_save(flags);// write_gpio_bit(GPIO_L3MODE, 0);s3c2410_gpio_setpin(S3C2410_GPB2,0);// write_gpio_bit(GPIO_L3CLOCK, 1);s3c2410_gpio_setpin(S3C2410_GPB4,1);udelay(1);for (i = 0; i < 8; i++) {if (data & 0x1) {s3c2410_gpio_setpin(S3C2410_GPB4,0);s3c2410_gpio_setpin(S3C2410_GPB3,1);udelay(1);s3c2410_gpio_setpin(S3C2410_GPB4,1);} else {s3c2410_gpio_setpin(S3C2410_GPB4,0);s3c2410_gpio_setpin(S3C2410_GPB3,0);udelay(1);s3c2410_gpio_setpin(S3C2410_GPB4,1);}data >>= 1;}s3c2410_gpio_setpin(S3C2410_GPB2,1);s3c2410_gpio_setpin(S3C2410_GPB4,1);local_irq_restore(flags);}static void uda1341_l3_data(u8 data){int i;unsigned long flags;local_irq_save(flags);udelay(1);for (i = 0; i < 8; i++) {if (data & 0x1) {s3c2410_gpio_setpin(S3C2410_GPB4,0);s3c2410_gpio_setpin(S3C2410_GPB3,1);udelay(1);s3c2410_gpio_setpin(S3C2410_GPB4,1);} else {s3c2410_gpio_setpin(S3C2410_GPB4,0);s3c2410_gpio_setpin(S3C2410_GPB3,0);udelay(1);s3c2410_gpio_setpin(S3C2410_GPB4,1);}data >>= 1;}local_irq_restore(flags);}static void audio_clear_buf(audio_stream_t * s){DPRINTK("audio_clear_buf\n");if(s->dma_ok) s3c2410_dma_ctrl(s->dma_ch, S3C2410_DMAOP_FLUSH);if (s->buffers) {int frag;for (frag = 0; frag < s->nbfrags; frag++) {if (!s->buffers[frag].master)continue;dma_free_coherent(NULL,s->buffers[frag].master,s->buffers[frag].start,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 = dma_alloc_coherent(NULL, dmasize, &dmaphys, GFP_KERNEL|GFP_DMA);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(s3c2410_dma_chan_t *ch, void *buf, int size,s3c2410_dma_buffresult_t result){audio_buf_t *b = (audio_buf_t *) buf;up(&b->sem);wake_up(&b->sem.wait);}static void audio_dmain_done_callback(s3c2410_dma_chan_t *ch, void *buf, int size,s3c2410_dma_buffresult_t result){audio_buf_t *b = (audio_buf_t *) buf;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_enqueue(s->dma_ch, (void *) b, b->dma_addr, b->size);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 (access_ok(VERIFY_READ, from, count))return -EFAULT;if ((int)from & 0x2) {u_int v;__get_user(v, (const u_short *)from); from += 2;*dst++ = v | (v << 16);}while (from < end-2) {u_int v, x, y;__get_user(v, (const u_int *)from); from += 4;x = v << 16;x |= x >> 16;y = v >> 16;y |= y << 16;*dst++ = x;*dst++ = y;}if (from < end) {u_int v;__get_user(v, (const u_short *)from);*dst = v | (v << 16);}return 0;}static ssize_t smdk2410_audio_write(struct file *file, const char *buffer,