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

   1 /***************************************************************************
   2  *             __________               __   ___.
   3  *   Open      \______   \ ____   ____ |  | _\_ |__   _______  ___
   4  *   Source     |       _//  _ \_/ ___\|  |/ /| __ \ /  _ \  \/  /
   5  *   Jukebox    |    |   (  <_> )  \___|    < | \_\ (  <_> > <  <
   6  *   Firmware   |____|_  /\____/ \___  >__|_ \|___  /\____/__/\_ \
   7  *                     \/            \/     \/    \/            \/
   8  * $Id$
   9  *
  10  * Copyright © 2008 Rafaël Carré
  11  *
  12  * This program is free software; you can redistribute it and/or
  13  * modify it under the terms of the GNU General Public License
  14  * as published by the Free Software Foundation; either version 2
  15  * of the License, or (at your option) any later version.
  16  *
  17  * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
  18  * KIND, either express or implied.
  19  *
  20  ****************************************************************************/
  21 #include "system.h"
  22 #include "audio.h"
  23 #include "string.h"
  24 #include "as3525.h"
  25 #include "pl081.h"
  26 #include "dma-target.h"
  27 #include "clock-target.h"
  28 #include "panic.h"
  29 #include "as3514.h"
  30 #include "audiohw.h"
  31 #include "mmu-arm.h"
  32
  33 #define MAX_TRANSFER (4*((1<<11)-1)) /* maximum data we can transfer via DMA
  34                                       * i.e. 32 bits at once (size of I2SO_DATA)
  35                                       * and the number of 32bits words has to
  36                                       * fit in 11 bits of DMA register */
  37
  38 static unsigned char *dma_start_addr;
  39 static size_t      dma_size;   /* in 4*32 bits */
  40 static void dma_callback(void);
  41 static int locked = 0;
  42
  43 /* Mask the DMA interrupt */
  44 void pcm_play_lock(void)
  45 {
  46     if(++locked == 1)
  47         VIC_INT_EN_CLEAR = INTERRUPT_DMAC;
  48 }
  49
  50 /* Unmask the DMA interrupt if enabled */
  51 void pcm_play_unlock(void)
  52 {
  53     if(--locked == 0)
  54         VIC_INT_ENABLE = INTERRUPT_DMAC;
  55 }
  56
  57 static void play_start_pcm(void)
  58 {
  59     const unsigned char* addr = dma_start_addr;
  60     size_t size = dma_size;
  61     if(size > MAX_TRANSFER)
  62         size = MAX_TRANSFER;
  63
  64     dma_size -= size;
  65     dma_start_addr += size;
  66
  67     clean_dcache_range((void*)addr, size);  /* force write back */
  68     dma_enable_channel(1, (void*)addr, (void*)I2SOUT_DATA, DMA_PERI_I2SOUT,
  69                 DMAC_FLOWCTRL_DMAC_MEM_TO_PERI, true, false, size >> 2, DMA_S1,
  70                 dma_callback);
  71 }
  72
  73 static void dma_callback(void)
  74 {
  75     if(!dma_size)
  76     {
  77         register pcm_more_callback_type get_more = pcm_callback_for_more;
  78         if(get_more)
  79             get_more(&dma_start_addr, &dma_size);
  80     }
  81
  82     if(!dma_size)
  83     {
  84         pcm_play_dma_stop();
  85         pcm_play_dma_stopped_callback();
  86     }
  87     else
  88         play_start_pcm();
  89 }
  90
  91 void pcm_play_dma_start(const void *addr, size_t size)
  92 {
  93     dma_size = size;
  94     dma_start_addr = (unsigned char*)addr;
  95
  96     dma_retain();
  97
  98     I2SOUT_CONTROL |= 1<<6; /* dma */
  99
 100     CGU_PERI |= CGU_I2SOUT_APB_CLOCK_ENABLE;
 101     CGU_AUDIO |= (1<<11);
 102
 103     play_start_pcm();
 104 }
 105
 106 void pcm_play_dma_stop(void)
 107 {
 108     dma_disable_channel(1);
 109     dma_size = 0;
 110
 111     dma_release();
 112
 113     CGU_PERI &= ~CGU_I2SOUT_APB_CLOCK_ENABLE;
 114     CGU_AUDIO &= ~(1<<11);
 115 }
 116
 117 void pcm_play_dma_pause(bool pause)
 118 {
 119     if(pause)
 120         dma_disable_channel(1);
 121     else
 122         play_start_pcm();
 123 }
 124
 125 void pcm_play_dma_init(void)
 126 {
 127     CGU_PERI |= CGU_I2SOUT_APB_CLOCK_ENABLE;
 128
 129     CGU_AUDIO = (CGU_AUDIO & ~(3<<0)) | (1<<0); /* clock source PLLA */
 130
 131     I2SOUT_CONTROL = (1<<3)  /* stereo */;
 132
 133     audiohw_preinit();
 134 }
 135
 136 void pcm_postinit(void)
 137 {
 138     audiohw_postinit();
 139 }
 140
 141 void pcm_dma_apply_settings(void)
 142 {
 143     unsigned long frequency = pcm_sampr;
 144
 145     /* TODO : use a table ? */
 146     const int divider = (((AS3525_PLLA_FREQ/128) + (frequency/2)) / frequency) - 1;
 147
 148     int cgu_audio = CGU_AUDIO;  /* read register */
 149     cgu_audio &= ~(511 << 2);   /* clear i2sout divider */
 150     cgu_audio |= divider << 2;  /* set new i2sout divider */
 151 #ifdef HAVE_RECORDING
 152     cgu_audio &= ~(511 << 14);  /* clear i2sin divider */
 153     cgu_audio |= divider << 14; /* set new i2sin divider */
 154 #endif
 155     CGU_AUDIO = cgu_audio;      /* write back register */
 156 }
 157
 158 size_t pcm_get_bytes_waiting(void)
 159 {
 160     return dma_size;
 161 }
 162
 163 const void * pcm_play_dma_get_peak_buffer(int *count)
 164 {
 165     *count = dma_size >> 2;
 166     return (const void*)dma_start_addr;
 167 }
 168
 169 #ifdef HAVE_PCM_DMA_ADDRESS
 170 void * pcm_dma_addr(void *addr)
 171 {
 172     if (addr != NULL)
 173         addr = UNCACHED_ADDR(addr);
 174     return addr;
 175 }
 176 #endif
 177
 178
 179 /****************************************************************************
 180  ** Recording DMA transfer
 181  **/
 182 #ifdef HAVE_RECORDING
 183
 184 static int rec_locked = 0;
 185 static unsigned int *rec_start_addr;
 186 static size_t      rec_size;
 187
 188
 189 void pcm_rec_lock(void)
 190 {
 191     if(++rec_locked == 1)
 192         VIC_INT_EN_CLEAR = INTERRUPT_I2SIN;
 193 }
 194
 195
 196 void pcm_rec_unlock(void)
 197 {
 198     if(--rec_locked == 0)
 199         VIC_INT_ENABLE = INTERRUPT_I2SIN;
 200 }
 201
 202
 203 void pcm_record_more(void *start, size_t size)
 204 {
 205     rec_start_addr = start;
 206     rec_size = size;
 207 }
 208
 209
 210 void pcm_rec_dma_stop(void)
 211 {
 212     VIC_INT_EN_CLEAR = INTERRUPT_I2SIN;
 213
 214     I2SOUT_CONTROL &= ~(1<<5); /* source = i2soutif fifo */
 215     CGU_AUDIO &= ~((1<<23)|(1<<11));
 216     CGU_PERI &= ~(CGU_I2SIN_APB_CLOCK_ENABLE|CGU_I2SOUT_APB_CLOCK_ENABLE);
 217 }
 218
 219
 220 void INT_I2SIN(void)
 221 {
 222     register int status;
 223     register pcm_more_callback_type2 more_ready;
 224
 225     status = I2SIN_STATUS;
 226
 227 #if 0   /* FIXME */
 228     if ( status & ((1<<6)|(1<<0)) ) /* errors */
 229         panicf("i2sin error: 0x%x = %s %s", status,
 230             (status & (1<<6)) ? "push" : "",
 231             (status & (1<<0)) ? "pop" : ""
 232         );
 233 #endif
 234
 235     while (((I2SIN_RAW_STATUS & (1<<5)) == 0) && rec_size)
 236     {
 237         /* 14 bits per sample = 1 32 bits word */
 238         *rec_start_addr++ = *I2SIN_DATA;
 239         rec_size -= 4;
 240     }
 241
 242     I2SIN_CLEAR = status;
 243
 244     if(!rec_size)
 245     {
 246         more_ready = pcm_callback_more_ready;
 247         if(!more_ready || more_ready(0) < 0)
 248         {
 249             /* Finished recording */
 250             pcm_rec_dma_stop();
 251             pcm_rec_dma_stopped_callback();
 252         }
 253     }
 254 }
 255
 256
 257 void pcm_rec_dma_start(void *addr, size_t size)
 258 {
 259     rec_start_addr = addr;
 260     rec_size = size;
 261
 262     CGU_PERI |= CGU_I2SIN_APB_CLOCK_ENABLE|CGU_I2SOUT_APB_CLOCK_ENABLE;
 263     CGU_AUDIO |= ((1<<23)|(1<<11));
 264
 265     I2SOUT_CONTROL |= 1<<5; /* source = loopback from i2sin fifo */
 266
 267     /* 14 bits samples, i2c clk src = I2SOUTIF, sdata src = AFE,
 268      * data valid at positive edge of SCLK */
 269     I2SIN_CONTROL = (1<<5) | (1<<2);
 270
 271     unsigned long tmp;
 272     while ( ( I2SIN_RAW_STATUS & ( 1<<5 ) ) == 0 )
 273         tmp = *I2SIN_DATA; /* FLUSH FIFO */
 274     I2SIN_CLEAR = (1<<6)|(1<<0);    /* push error, pop error */
 275     I2SIN_MASK =    (1<<6) | (1<<0) |
 276                     (1<<3) | (1<<2) | (1<<1); /* half full, almost full, full */
 277
 278     VIC_INT_ENABLE = INTERRUPT_I2SIN;
 279 }
 280
 281
 282 void pcm_rec_dma_close(void)
 283 {
 284     pcm_rec_dma_stop();
 285 }
 286
 287
 288 void pcm_rec_dma_init(void)
 289 {
 290     CGU_AUDIO = (CGU_AUDIO & ~(3<<12)) | (1<<12); /* clock source = PLLA */
 291     pcm_dma_apply_settings();
 292 }
 293
 294
 295 const void * pcm_rec_dma_get_peak_buffer(int *count)
 296 {
 297     const void *peak_buffer;
 298
 299     pcm_rec_lock();
 300     *count = rec_size >> 2;
 301     peak_buffer = (const void*)rec_start_addr;
 302     pcm_rec_unlock();
 303
 304     return peak_buffer;
 305 }
 306
 307 #endif /* HAVE_RECORDING */