rockbox/firmware/target/arm/as3525/pcm-as3525.c

/***************************************************************************
 *             __________               __   ___.
 *   Open      \______   \ ____   ____ |  | _\_ |__   _______  ___
 *   Source     |       _//  _ \_/ ___\|  |/ /| __ \ /  _ \  \/  /
 *   Jukebox    |    |   (  <_> )  \___|    < | \_\ (  <_> > <  <
 *   Firmware   |____|_  /\____/ \___  >__|_ \|___  /\____/__/\_ \
 *                     \/            \/     \/    \/            \/
 * $Id$
 *
 * Copyright © 2008 Rafaël Carré
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License
 * as published by the Free Software Foundation; either version 2
 * of the License, or (at your option) any later version.
 *
 * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
 * KIND, either express or implied.
 *
 ****************************************************************************/
#include "system.h"
#include "audio.h"
#include "string.h"
#include "as3525.h"
#include "pl081.h"
#include "dma-target.h"
#include "clock-target.h"
#include "panic.h"
#include "as3514.h"
#include "audiohw.h"
#include "mmu-arm.h"

#define MAX_TRANSFER (4*((1<<11)-1)) /* maximum data we can transfer via DMA
                                      * i.e. 32 bits at once (size of I2SO_DATA)
                                      * and the number of 32bits words has to
                                      * fit in 11 bits of DMA register */

static unsigned char *dma_start_addr;
static size_t      dma_size;   /* in 4*32 bits */
static void dma_callback(void);
static int locked = 0;

/* Mask the DMA interrupt */
void pcm_play_lock(void)
{
    if(++locked == 1)
        VIC_INT_EN_CLEAR = INTERRUPT_DMAC;
}

/* Unmask the DMA interrupt if enabled */
void pcm_play_unlock(void)
{
    if(--locked == 0)
        VIC_INT_ENABLE = INTERRUPT_DMAC;
}

static void play_start_pcm(void)
{
    const unsigned char* addr = dma_start_addr;
    size_t size = dma_size;
    if(size > MAX_TRANSFER)
        size = MAX_TRANSFER;

    dma_size -= size;
    dma_start_addr += size;

    clean_dcache_range((void*)addr, size);  /* force write back */
    dma_enable_channel(1, (void*)addr, (void*)I2SOUT_DATA, DMA_PERI_I2SOUT,
                DMAC_FLOWCTRL_DMAC_MEM_TO_PERI, true, false, size >> 2, DMA_S1,
                dma_callback);
}

static void dma_callback(void)
{
    if(!dma_size)
    {
        register pcm_more_callback_type get_more = pcm_callback_for_more;
        if(get_more)
            get_more(&dma_start_addr, &dma_size);
    }

    if(!dma_size)
    {
        pcm_play_dma_stop();
        pcm_play_dma_stopped_callback();
    }
    else
        play_start_pcm();
}

void pcm_play_dma_start(const void *addr, size_t size)
{
    dma_size = size;
    dma_start_addr = (unsigned char*)addr;

    dma_retain();

    I2SOUT_CONTROL |= 1<<6; /* dma */

    CGU_PERI |= CGU_I2SOUT_APB_CLOCK_ENABLE;
    CGU_AUDIO |= (1<<11);

    play_start_pcm();
}

void pcm_play_dma_stop(void)
{
    dma_disable_channel(1);
    dma_size = 0;

    dma_release();

    CGU_PERI &= ~CGU_I2SOUT_APB_CLOCK_ENABLE;
    CGU_AUDIO &= ~(1<<11);
}

void pcm_play_dma_pause(bool pause)
{
    if(pause)
        dma_disable_channel(1);
    else
        play_start_pcm();
}

void pcm_play_dma_init(void)
{
    CGU_PERI |= CGU_I2SOUT_APB_CLOCK_ENABLE;

    CGU_AUDIO = (CGU_AUDIO & ~(3<<0)) | (1<<0); /* clock source PLLA */

    I2SOUT_CONTROL = (1<<3)  /* stereo */;

    audiohw_preinit();
}

void pcm_postinit(void)
{
    audiohw_postinit();
}

void pcm_dma_apply_settings(void)
{
    unsigned long frequency = pcm_sampr;

    /* TODO : use a table ? */
    const int divider = (((AS3525_PLLA_FREQ/128) + (frequency/2)) / frequency) - 1;

    int cgu_audio = CGU_AUDIO;  /* read register */
    cgu_audio &= ~(511 << 2);   /* clear i2sout divider */
    cgu_audio |= divider << 2;  /* set new i2sout divider */
#ifdef HAVE_RECORDING
    cgu_audio &= ~(511 << 14);  /* clear i2sin divider */
    cgu_audio |= divider << 14; /* set new i2sin divider */
#endif
    CGU_AUDIO = cgu_audio;      /* write back register */
}

size_t pcm_get_bytes_waiting(void)
{
    return dma_size;
}

const void * pcm_play_dma_get_peak_buffer(int *count)
{
    *count = dma_size >> 2;
    return (const void*)dma_start_addr;
}

#ifdef HAVE_PCM_DMA_ADDRESS
void * pcm_dma_addr(void *addr)
{
    if (addr != NULL)
        addr = UNCACHED_ADDR(addr);
    return addr;
}
#endif


/****************************************************************************
 ** Recording DMA transfer
 **/
#ifdef HAVE_RECORDING

static int rec_locked = 0;
static unsigned int *rec_start_addr;
static size_t      rec_size;


void pcm_rec_lock(void)
{
    if(++rec_locked == 1)
        VIC_INT_EN_CLEAR = INTERRUPT_I2SIN;
}


void pcm_rec_unlock(void)
{
    if(--rec_locked == 0)
        VIC_INT_ENABLE = INTERRUPT_I2SIN;
}


void pcm_record_more(void *start, size_t size)
{
    rec_start_addr = start;
    rec_size = size;
}


void pcm_rec_dma_stop(void)
{
    VIC_INT_EN_CLEAR = INTERRUPT_I2SIN;

    I2SOUT_CONTROL &= ~(1<<5); /* source = i2soutif fifo */
    CGU_AUDIO &= ~((1<<23)|(1<<11));
    CGU_PERI &= ~(CGU_I2SIN_APB_CLOCK_ENABLE|CGU_I2SOUT_APB_CLOCK_ENABLE);
}


void INT_I2SIN(void)
{
    register int status;
    register pcm_more_callback_type2 more_ready;

    status = I2SIN_STATUS;

#if 0   /* FIXME */
    if ( status & ((1<<6)|(1<<0)) ) /* errors */
        panicf("i2sin error: 0x%x = %s %s", status,
            (status & (1<<6)) ? "push" : "",
            (status & (1<<0)) ? "pop" : ""
        );
#endif

    while (((I2SIN_RAW_STATUS & (1<<5)) == 0) && rec_size)
    {
        /* 14 bits per sample = 1 32 bits word */
        *rec_start_addr++ = *I2SIN_DATA;
        rec_size -= 4;
    }

    I2SIN_CLEAR = status;

    if(!rec_size)
    {
        more_ready = pcm_callback_more_ready;
        if(!more_ready || more_ready(0) < 0)
        {
            /* Finished recording */
            pcm_rec_dma_stop();
            pcm_rec_dma_stopped_callback();
        }
    }
}


void pcm_rec_dma_start(void *addr, size_t size)
{
    rec_start_addr = addr;
    rec_size = size;

    CGU_PERI |= CGU_I2SIN_APB_CLOCK_ENABLE|CGU_I2SOUT_APB_CLOCK_ENABLE;
    CGU_AUDIO |= ((1<<23)|(1<<11));

    I2SOUT_CONTROL |= 1<<5; /* source = loopback from i2sin fifo */

    /* 14 bits samples, i2c clk src = I2SOUTIF, sdata src = AFE,
     * data valid at positive edge of SCLK */
    I2SIN_CONTROL = (1<<5) | (1<<2);

    unsigned long tmp;
    while ( ( I2SIN_RAW_STATUS & ( 1<<5 ) ) == 0 )
        tmp = *I2SIN_DATA; /* FLUSH FIFO */
    I2SIN_CLEAR = (1<<6)|(1<<0);    /* push error, pop error */
    I2SIN_MASK =    (1<<6) | (1<<0) |
                    (1<<3) | (1<<2) | (1<<1); /* half full, almost full, full */

    VIC_INT_ENABLE = INTERRUPT_I2SIN;
}


void pcm_rec_dma_close(void)
{
    pcm_rec_dma_stop();
}


void pcm_rec_dma_init(void)
{
    CGU_AUDIO = (CGU_AUDIO & ~(3<<12)) | (1<<12); /* clock source = PLLA */
    pcm_dma_apply_settings();
}


const void * pcm_rec_dma_get_peak_buffer(int *count)
{
    const void *peak_buffer;

    pcm_rec_lock();
    *count = rec_size >> 2;
    peak_buffer = (const void*)rec_start_addr;
    pcm_rec_unlock();

    return peak_buffer;
}

#endif /* HAVE_RECORDING */