1 files changed, 92 insertions, 10 deletions

diff --git a/firmware/target/arm/as3525/pcm-as3525.c b/firmware/target/arm/as3525/pcm-as3525.c
index d91450c9cf..0386cc3336 100644
--- a/firmware/target/arm/as3525/pcm-as3525.c
+++ b/firmware/target/arm/as3525/pcm-as3525.c
@@ -21,58 +21,140 @@
 #include "system.h"
 #include "audio.h"
 #include "string.h"
-
-/* TODO */
-
+#include "as3525.h"
+#include "pl081.h"
+#include "dma-target.h"
+#include "clock-target.h"
+#include "panic.h"
+#include "as3514.h"
+#include "audiohw.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;
 }
 
-void pcm_play_dma_start(const void *addr, size_t size)
+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;
+
+    if((unsigned int)dma_start_addr & 3)
+        panicf("unaligned pointer!");
+
+    dma_size -= size;
+    dma_start_addr += size;
+
+    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);
 }
 
-void pcm_play_dma_stop(void)
+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();
+    else
+        play_start_pcm();
 }
 
-void pcm_play_dma_pause(bool pause)
+void pcm_play_dma_start(const void *addr, size_t size)
 {
+    dma_size = size;
+    dma_start_addr = (unsigned char*)addr;
+
+    play_start_pcm();
 }
 
-unsigned long physical_address(void *p)
+void pcm_play_dma_stop(void)
+{
+    dma_disable_channel(1);
+    dma_size = 0;
+}
+
+void pcm_play_dma_pause(bool pause)
 {
-    return 0;
+    if(pause)
+        dma_disable_channel(1);
+    else
+        play_start_pcm();
 }
 
 void pcm_play_dma_init(void)
 {
+    CGU_PERI |= CGU_I2SOUT_APB_CLOCK_ENABLE;
+
+    /* enable I2SO_MCLK, clock source PLLA, minimal frequency */
+    CGU_AUDIO |= (1<<11) | (511<<2) | (1<<0);
+
+    I2SOUT_CONTROL |= (1<<6) ;  /* enable dma */
+    I2SOUT_CONTROL |= (1<<3) ;  /* stereo */
+    I2SOUT_CONTROL &= ~(1<<2);  /* 16 bit samples */
+
+    audiohw_preinit();
 }
 
 void pcm_postinit(void)
 {
+    audiohw_postinit();
+    pcm_apply_settings();
 }
 
 void pcm_set_frequency(unsigned int frequency)
 {
+    const int divider = (((AS3525_PLLA_FREQ/128) + (frequency/2)) / frequency) - 1;
+    if(divider < 0 || divider > 511)
+        panicf("unsupported frequency %d", frequency);
+
+    CGU_AUDIO &= ~(((511 ^ divider) << 2) /* I2SOUT */
+            /*| ((511 ^ divider) << 14) */ /* I2SIN */
+            );
+
+    pcm_curr_sampr = frequency;
 }
 
 void pcm_apply_settings(void)
 {
+    pcm_set_frequency(HW_SAMPR_DEFAULT);
 }
 
 size_t pcm_get_bytes_waiting(void)
 {
-    return 0;
+    return dma_size;
 }
 
 const void * pcm_play_dma_get_peak_buffer(int *count)
 {
-    return NULL;
+    *count = dma_size >> 2;
+    return (const void*)dma_start_addr;
 }