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

   1 /***************************************************************************
   2  *             __________               __   ___.
   3  *   Open      \______   \ ____   ____ |  | _\_ |__   _______  ___
   4  *   Source     |       _//  _ \_/ ___\|  |/ /| __ \ /  _ \  \/  /
   5  *   Jukebox    |    |   (  <_> )  \___|    < | \_\ (  <_> > <  <
   6  *   Firmware   |____|_  /\____/ \___  >__|_ \|___  /\____/__/\_ \
   7  *                     \/            \/     \/    \/            \/
   8  * $Id$
   9  *
  10  * Copyright © 2008-2009 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     CGU_PERI |= CGU_I2SOUT_APB_CLOCK_ENABLE;
  97     CGU_AUDIO |= (1<<11);
  98
  99     dma_retain();
 100
 101     play_start_pcm();
 102 }
 103
 104 void pcm_play_dma_stop(void)
 105 {
 106     dma_disable_channel(1);
 107     dma_size = 0;
 108
 109     dma_release();
 110
 111     CGU_PERI &= ~CGU_I2SOUT_APB_CLOCK_ENABLE;
 112     CGU_AUDIO &= ~(1<<11);
 113 }
 114
 115 void pcm_play_dma_pause(bool pause)
 116 {
 117     if(pause)
 118         dma_disable_channel(1);
 119     else
 120         play_start_pcm();
 121 }
 122
 123 void pcm_play_dma_init(void)
 124 {
 125     CGU_PERI |= CGU_I2SOUT_APB_CLOCK_ENABLE;
 126
 127     I2SOUT_CONTROL = (1<<6)|(1<<3)  /* enable dma, stereo */;
 128
 129     audiohw_preinit();
 130 }
 131
 132 void pcm_postinit(void)
 133 {
 134     audiohw_postinit();
 135 }
 136
 137 void pcm_dma_apply_settings(void)
 138 {
 139     unsigned long frequency = pcm_sampr;
 140
 141     /* TODO : use a table ? */
 142     const int divider = ((AS3525_MCLK_FREQ/128) + (frequency/2)) / frequency;
 143
 144     int cgu_audio = CGU_AUDIO;  /* read register */
 145     cgu_audio &= ~(3 << 0);     /* clear i2sout MCLK_SEL */
 146     cgu_audio |=  (AS3525_MCLK_SEL << 0);  /* set i2sout MCLK_SEL */
 147     cgu_audio &= ~(511 << 2);   /* clear i2sout divider */
 148     cgu_audio |= (divider - 1) << 2;  /* set new i2sout divider */
 149     CGU_AUDIO = cgu_audio;      /* write back register */
 150 }
 151
 152 size_t pcm_get_bytes_waiting(void)
 153 {
 154     return dma_size;
 155 }
 156
 157 const void * pcm_play_dma_get_peak_buffer(int *count)
 158 {
 159     *count = dma_size >> 2;
 160     return (const void*)dma_start_addr;
 161 }
 162
 163 #ifdef HAVE_PCM_DMA_ADDRESS
 164 void * pcm_dma_addr(void *addr)
 165 {
 166     if (addr != NULL)
 167         addr = UNCACHED_ADDR(addr);
 168     return addr;
 169 }
 170 #endif
 171
 172
 173 /****************************************************************************
 174  ** Recording DMA transfer
 175  **/
 176 #ifdef HAVE_RECORDING
 177 #define I2SIN_RECORDING_MASK ( I2SIN_MASK_POER | I2SIN_MASK_PUER | \
 178             I2SIN_MASK_POHF | I2SIN_MASK_POAF | I2SIN_MASK_POF )
 179
 180 static int rec_locked = 0;
 181 static unsigned int *rec_start_addr;
 182 static size_t      rec_size;
 183
 184 void pcm_rec_lock(void)
 185 {
 186     if(++rec_locked == 1) {
 187         int vic_state = disable_irq_save();
 188         VIC_INT_EN_CLEAR = INTERRUPT_I2SIN;
 189         I2SIN_MASK = 0;
 190         restore_irq( vic_state );
 191     }
 192 }
 193
 194 void pcm_rec_unlock(void)
 195 {
 196     if(--rec_locked == 0) {
 197         int vic_state = disable_irq_save();
 198         VIC_INT_ENABLE = INTERRUPT_I2SIN;
 199         I2SIN_MASK = I2SIN_RECORDING_MASK;
 200         restore_irq( vic_state );
 201     }
 202 }
 203
 204
 205 void pcm_rec_dma_record_more(void *start, size_t size)
 206 {
 207     rec_start_addr = start;
 208     rec_size = size;
 209 }
 210
 211
 212 void pcm_rec_dma_stop(void)
 213 {
 214     int vic_state = disable_irq_save();
 215     VIC_INT_EN_CLEAR = INTERRUPT_I2SIN;
 216     I2SIN_MASK = 0;
 217     restore_irq( vic_state );
 218
 219     I2SOUT_CONTROL &= ~(1<<5); /* source = i2soutif fifo */
 220     CGU_AUDIO &= ~((1<<23)|(1<<11));
 221     CGU_PERI &= ~(CGU_I2SIN_APB_CLOCK_ENABLE|CGU_I2SOUT_APB_CLOCK_ENABLE);
 222 }
 223
 224
 225 void INT_I2SIN(void)
 226 {
 227     register int status;
 228     register pcm_more_callback_type2 more_ready;
 229
 230     status = I2SIN_STATUS;
 231
 232     if ( status & ((1<<6)|(1<<0)) ) /* errors */
 233         panicf("i2sin error: 0x%x = %s %s", status,
 234             (status & (1<<6)) ? "push" : "",
 235             (status & (1<<0)) ? "pop" : ""
 236         );
 237
 238     /* called at half full so it's safe to pull 16 FIFO reads in one chunk */
 239     if( rec_size >= 16*4 )
 240     {
 241         /* unrolled loop */
 242         *rec_start_addr++ = *I2SIN_DATA;
 243         *rec_start_addr++ = *I2SIN_DATA;
 244         *rec_start_addr++ = *I2SIN_DATA;
 245         *rec_start_addr++ = *I2SIN_DATA;
 246
 247         *rec_start_addr++ = *I2SIN_DATA;
 248         *rec_start_addr++ = *I2SIN_DATA;
 249         *rec_start_addr++ = *I2SIN_DATA;
 250         *rec_start_addr++ = *I2SIN_DATA;
 251
 252         *rec_start_addr++ = *I2SIN_DATA;
 253         *rec_start_addr++ = *I2SIN_DATA;
 254         *rec_start_addr++ = *I2SIN_DATA;
 255         *rec_start_addr++ = *I2SIN_DATA;
 256
 257         *rec_start_addr++ = *I2SIN_DATA;
 258         *rec_start_addr++ = *I2SIN_DATA;
 259         *rec_start_addr++ = *I2SIN_DATA;
 260         *rec_start_addr++ = *I2SIN_DATA;
 261
 262         rec_size -= 16*4; /* 16x4byte reads */
 263     }
 264
 265     /* read out any odd samples left */
 266     while (((I2SIN_RAW_STATUS & (1<<5)) == 0) && rec_size)
 267     {
 268         /* 14 bits per sample = 1 32 bits word */
 269         *rec_start_addr++ = *I2SIN_DATA;
 270         rec_size -= 4;
 271     }
 272
 273     I2SIN_CLEAR = status;
 274
 275     if(!rec_size)
 276     {
 277         more_ready = pcm_callback_more_ready;
 278         if(!more_ready || more_ready(0) < 0)
 279         {
 280             /* Finished recording */
 281             pcm_rec_dma_stop();
 282             pcm_rec_dma_stopped_callback();
 283         }
 284     }
 285 }
 286
 287
 288 void pcm_rec_dma_start(void *addr, size_t size)
 289 {
 290     rec_start_addr = addr;
 291     rec_size = size;
 292
 293     CGU_PERI |= CGU_I2SIN_APB_CLOCK_ENABLE|CGU_I2SOUT_APB_CLOCK_ENABLE;
 294     CGU_AUDIO |= ((1<<23)|(1<<11));
 295
 296     I2SOUT_CONTROL |= 1<<5; /* source = loopback from i2sin fifo */
 297
 298     /* 14 bits samples, i2c clk src = I2SOUTIF, sdata src = AFE,
 299      * data valid at positive edge of SCLK */
 300     I2SIN_CONTROL = (1<<5) | (1<<2);
 301
 302     unsigned long tmp;
 303     while ( ( I2SIN_RAW_STATUS & ( 1<<5 ) ) == 0 )
 304         tmp = *I2SIN_DATA; /* FLUSH FIFO */
 305     I2SIN_CLEAR = (1<<6)|(1<<0);    /* push error, pop error */
 306     I2SIN_MASK = I2SIN_RECORDING_MASK;
 307
 308     VIC_INT_ENABLE = INTERRUPT_I2SIN;
 309 }
 310
 311
 312 void pcm_rec_dma_close(void)
 313 {
 314     pcm_rec_dma_stop();
 315 }
 316
 317
 318 void pcm_rec_dma_init(void)
 319 {
 320     unsigned long frequency = pcm_sampr;
 321
 322     /* TODO : use a table ? */
 323     const int divider = ((AS3525_MCLK_FREQ/128) + (frequency/2)) / frequency;
 324
 325     int cgu_audio = CGU_AUDIO;  /* read register */
 326     cgu_audio &= ~(3 << 12);    /* clear i2sin MCLK_SEL */
 327     cgu_audio |=  (AS3525_MCLK_SEL << 12);  /* set i2sin MCLK_SEL */
 328     cgu_audio &= ~(511 << 14);  /* clear i2sin divider */
 329     cgu_audio |= (divider - 1) << 14; /* set new i2sin divider */
 330     CGU_AUDIO = cgu_audio;      /* write back register */
 331 }
 332
 333
 334 const void * pcm_rec_dma_get_peak_buffer(void)
 335 {
 336     return (const void*)rec_start_addr;
 337 }
 338
 339 #endif /* HAVE_RECORDING */