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

   1 /***************************************************************************
   2  *             __________               __   ___.
   3  *   Open      \______   \ ____   ____ |  | _\_ |__   _______  ___
   4  *   Source     |       _//  _ \_/ ___\|  |/ /| __ \ /  _ \  \/  /
   5  *   Jukebox    |    |   (  <_> )  \___|    < | \_\ (  <_> > <  <
   6  *   Firmware   |____|_  /\____/ \___  >__|_ \|___  /\____/__/\_ \
   7  *                     \/            \/     \/    \/            \/
   8  * $Id$
   9  *
  10  * Copyright (C) 2006 by Tomek Malesinski
  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
  25 #define DMA_BUF_SAMPLES 0x100
  26
  27 short __attribute__((section(".dmabuf"))) dma_buf_left[DMA_BUF_SAMPLES];
  28 short __attribute__((section(".dmabuf"))) dma_buf_right[DMA_BUF_SAMPLES];
  29
  30 unsigned short* p IBSS_ATTR;
  31 size_t p_size IBSS_ATTR;
  32
  33 void pcm_play_lock(void)
  34 {
  35 }
  36
  37 void pcm_play_unlock(void)
  38 {
  39 }
  40
  41 void pcm_play_dma_start(const void *addr, size_t size)
  42 {
  43     p = (unsigned short*)addr;
  44     p_size = size;
  45 }
  46
  47 void pcm_play_dma_stop(void)
  48 {
  49 }
  50
  51 void pcm_play_dma_pause(bool pause)
  52 {
  53     (void)pause;
  54 }
  55
  56 static inline void fill_dma_buf(int offset)
  57 {
  58     short *l, *r, *lend;
  59
  60     l = dma_buf_left + offset;
  61     lend = l + DMA_BUF_SAMPLES / 2;
  62     r = dma_buf_right + offset;
  63
  64     if (pcm_playing && !pcm_paused)
  65     {
  66         do
  67         {
  68             int count;
  69             unsigned short *tmp_p;
  70             count = MIN(p_size / 4, (size_t)(lend - l));
  71             tmp_p = p;
  72             p_size -= count * 4;
  73
  74             if ((int)l & 3)
  75             {
  76                 *l++ = *tmp_p++;
  77                 *r++ = *tmp_p++;
  78                 count--;
  79             }
  80             while (count >= 4)
  81             {
  82                 asm("ldmia %0!, {r0, r1, r2, r3}\n\t"
  83                     "and   r4, r0, %3\n\t"
  84                     "orr   r4, r4, r1, lsl #16\n\t"
  85                     "and   r5, r2, %3\n\t"
  86                     "orr   r5, r5, r3, lsl #16\n\t"
  87                     "stmia %1!, {r4, r5}\n\t"
  88                     "bic   r4, r1, %3\n\t"
  89                     "orr   r4, r4, r0, lsr #16\n\t"
  90                     "bic   r5, r3, %3\n\t"
  91                     "orr   r5, r5, r2, lsr #16\n\t"
  92                     "stmia %2!, {r4, r5}"
  93                     : "+r" (tmp_p), "+r" (l), "+r" (r)
  94                     : "r" (0xffff)
  95                     : "r0", "r1", "r2", "r3", "r4", "r5", "memory");
  96                 count -= 4;
  97             }
  98             while (count > 0)
  99             {
 100                 *l++ = *tmp_p++;
 101                 *r++ = *tmp_p++;
 102                 count--;
 103             }
 104             p = tmp_p;
 105             if (l >= lend)
 106                 return;
 107             else if (pcm_callback_for_more)
 108                 pcm_callback_for_more((unsigned char**)&p,
 109                                   &p_size);
 110         }
 111         while (p_size);
 112
 113         pcm_play_dma_stopped_callback();
 114     }
 115
 116     if (l < lend)
 117     {
 118         memset(l, 0, sizeof(short) * (lend - l));
 119         memset(r, 0, sizeof(short) * (lend - l));
 120     }
 121 }
 122
 123 static void audio_irq(void)
 124 {
 125     unsigned long st = DMAINTSTAT & ~DMAINTEN;
 126     int i;
 127     for (i = 0; i < 2; i++)
 128         if (st & (1 << i))
 129         {
 130             fill_dma_buf((i == 1) ? 0 : DMA_BUF_SAMPLES / 2);
 131             DMAINTSTAT = 1 << i;
 132         }
 133 }
 134
 135 unsigned long physical_address(void *p)
 136 {
 137     unsigned long adr = (unsigned long)p;
 138     return (MMUBLOCK((adr >> 21) & 0xf) << 21) | (adr & ((1 << 21) - 1));
 139 }
 140
 141 void pcm_init(void)
 142 {
 143     int i;
 144
 145     memset(dma_buf_left, 0, sizeof(dma_buf_left));
 146     memset(dma_buf_right, 0, sizeof(dma_buf_right));
 147
 148     for (i = 0; i < 8; i++)
 149     {
 150         DMASRC(i) = 0;
 151         DMADEST(i) = 0;
 152         DMALEN(i) = 0x1ffff;
 153         DMAR0C(i) = 0;
 154         DMAR10(i) = 0;
 155         DMAR1C(i) = 0;
 156     }
 157
 158     DMAINTSTAT = 0xc000ffff;
 159     DMAINTEN = 0xc000ffff;
 160
 161     DMASRC(0) = physical_address(dma_buf_left);
 162     DMADEST(0) = 0x80200280;
 163     DMALEN(0) = 0xff;
 164     DMAR1C(0) = 0;
 165     DMAR0C(0) = 0x40408;
 166
 167     DMASRC(1) = physical_address(dma_buf_right);
 168     DMADEST(1) = 0x80200284;
 169     DMALEN(1) = 0xff;
 170     DMAR1C(1) = 0;
 171     DMAR0C(1) = 0x40409;
 172
 173     irq_set_int_handler(0x1b, audio_irq);
 174     irq_enable_int(0x1b);
 175
 176     DMAINTSTAT = 1;
 177     DMAINTSTAT = 2;
 178     DMAINTEN &= ~3;
 179     DMAR10(0) |= 1;
 180     DMAR10(1) |= 1;
 181 }
 182
 183 void pcm_postinit(void)
 184 {
 185     audiohw_postinit();
 186 }
 187
 188 void pcm_dma_apply_settings(void)
 189 {
 190 }
 191
 192 size_t pcm_get_bytes_waiting(void)
 193 {
 194     return p_size & ~3;
 195 }
 196
 197 const void * pcm_play_dma_get_peak_buffer(int *count)
 198 {
 199     unsigned long addr = (unsigned long)p;
 200     size_t cnt = p_size;
 201     *count = cnt >> 2;
 202     return (void *)((addr + 2) & ~3);
 203 }