1 /***************************************************************************
3 * Open \______ \ ____ ____ | | _\_ |__ _______ ___
4 * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
5 * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
6 * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
10 * Copyright (C) 2006 by Tomek Malesinski
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.
17 * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
18 * KIND, either express or implied.
20 ****************************************************************************/
25 #define DMA_BUF_SAMPLES 0x100
27 short __attribute__((section(".dmabuf"))) dma_buf_left
[DMA_BUF_SAMPLES
];
28 short __attribute__((section(".dmabuf"))) dma_buf_right
[DMA_BUF_SAMPLES
];
30 unsigned short* p IBSS_ATTR
;
31 size_t p_size IBSS_ATTR
;
33 void pcm_play_lock(void)
37 void pcm_play_unlock(void)
41 void pcm_play_dma_start(const void *addr
, size_t size
)
43 p
= (unsigned short*)addr
;
47 void pcm_play_dma_stop(void)
51 void pcm_play_dma_pause(bool pause
)
56 static inline void fill_dma_buf(int offset
)
60 l
= dma_buf_left
+ offset
;
61 lend
= l
+ DMA_BUF_SAMPLES
/ 2;
62 r
= dma_buf_right
+ offset
;
64 if (pcm_playing
&& !pcm_paused
)
69 unsigned short *tmp_p
;
70 count
= MIN(p_size
/ 4, (size_t)(lend
- l
));
82 asm("ldmia %0!, {r0, r1, r2, r3}\n\t"
84 "orr r4, r4, r1, lsl #16\n\t"
86 "orr r5, r5, r3, lsl #16\n\t"
87 "stmia %1!, {r4, r5}\n\t"
89 "orr r4, r4, r0, lsr #16\n\t"
91 "orr r5, r5, r2, lsr #16\n\t"
93 : "+r" (tmp_p
), "+r" (l
), "+r" (r
)
95 : "r0", "r1", "r2", "r3", "r4", "r5", "memory");
107 else if (pcm_callback_for_more
)
108 pcm_callback_for_more((unsigned char**)&p
,
113 pcm_play_dma_stopped_callback();
118 memset(l
, 0, sizeof(short) * (lend
- l
));
119 memset(r
, 0, sizeof(short) * (lend
- l
));
123 static void audio_irq(void)
125 unsigned long st
= DMAINTSTAT
& ~DMAINTEN
;
127 for (i
= 0; i
< 2; i
++)
130 fill_dma_buf((i
== 1) ? 0 : DMA_BUF_SAMPLES
/ 2);
135 unsigned long physical_address(void *p
)
137 unsigned long adr
= (unsigned long)p
;
138 return (MMUBLOCK((adr
>> 21) & 0xf) << 21) | (adr
& ((1 << 21) - 1));
145 memset(dma_buf_left
, 0, sizeof(dma_buf_left
));
146 memset(dma_buf_right
, 0, sizeof(dma_buf_right
));
148 for (i
= 0; i
< 8; i
++)
158 DMAINTSTAT
= 0xc000ffff;
159 DMAINTEN
= 0xc000ffff;
161 DMASRC(0) = physical_address(dma_buf_left
);
162 DMADEST(0) = 0x80200280;
167 DMASRC(1) = physical_address(dma_buf_right
);
168 DMADEST(1) = 0x80200284;
173 irq_set_int_handler(0x1b, audio_irq
);
174 irq_enable_int(0x1b);
183 void pcm_postinit(void)
188 void pcm_dma_apply_settings(void)
192 size_t pcm_get_bytes_waiting(void)
197 const void * pcm_play_dma_get_peak_buffer(int *count
)
199 unsigned long addr
= (unsigned long)p
;
202 return (void *)((addr
+ 2) & ~3);