diff options
Diffstat (limited to 'firmware/target/arm/tms320dm320/dsp/main.c')
-rw-r--r-- | firmware/target/arm/tms320dm320/dsp/main.c | 145 |
1 files changed, 145 insertions, 0 deletions
diff --git a/firmware/target/arm/tms320dm320/dsp/main.c b/firmware/target/arm/tms320dm320/dsp/main.c new file mode 100644 index 0000000000..6ba001db2f --- /dev/null +++ b/firmware/target/arm/tms320dm320/dsp/main.c | |||
@@ -0,0 +1,145 @@ | |||
1 | /*************************************************************************** | ||
2 | * __________ __ ___. | ||
3 | * Open \______ \ ____ ____ | | _\_ |__ _______ ___ | ||
4 | * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / | ||
5 | * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < | ||
6 | * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ | ||
7 | * \/ \/ \/ \/ \/ | ||
8 | * $Id$ | ||
9 | * | ||
10 | * Copyright (C) 2008 by Catalin Patulea | ||
11 | * | ||
12 | * All files in this archive are subject to the GNU General Public License. | ||
13 | * See the file COPYING in the source tree root for full license agreement. | ||
14 | * | ||
15 | * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY | ||
16 | * KIND, either express or implied. | ||
17 | * | ||
18 | ****************************************************************************/ | ||
19 | |||
20 | #include "registers.h" | ||
21 | #include "arm.h" | ||
22 | #include "ipc.h" | ||
23 | #include "dma.h" | ||
24 | #include "audio.h" | ||
25 | #include <math.h> | ||
26 | |||
27 | void main(void) { | ||
28 | register int i; | ||
29 | register signed short *p; | ||
30 | |||
31 | TCR = 1 << 4; /* Stop the timer. */ | ||
32 | IMR = 0xffff; /* Unmask all interrupts. */ | ||
33 | IFR = IFR; /* Clear all pending interrupts. */ | ||
34 | asm(" rsbx INTM"); /* Globally enable interrupts. */ | ||
35 | |||
36 | audiohw_init(); | ||
37 | |||
38 | dma_init(); | ||
39 | |||
40 | audiohw_postinit(); | ||
41 | |||
42 | #if 0 | ||
43 | for (i = 0; i < 32; i++) | ||
44 | { | ||
45 | double ratio = ((double)i)/32.0; | ||
46 | double rad = 3.0*3.141592*ratio; | ||
47 | double normal = sin(rad); | ||
48 | double scaled = 32767.0*(normal); | ||
49 | data[2*i + 0] = -(signed short)scaled; | ||
50 | data[2*i + 1] = (signed short)scaled; | ||
51 | } | ||
52 | |||
53 | debugf("starting write"); | ||
54 | |||
55 | i = 0; | ||
56 | p = data; | ||
57 | SPSA0 = 0x01; | ||
58 | for (;;) { | ||
59 | while ((SPSD0 & (1 << 1)) == 0); | ||
60 | DXR20 = *p++; // left channel | ||
61 | DXR10 = *p++; // right channel | ||
62 | if (++i == 32) | ||
63 | { | ||
64 | p = data; | ||
65 | i = 0; | ||
66 | } | ||
67 | } | ||
68 | #endif | ||
69 | debugf("DSP inited..."); | ||
70 | |||
71 | for (;;) { | ||
72 | asm(" IDLE 1"); | ||
73 | asm(" NOP"); | ||
74 | } | ||
75 | } | ||
76 | |||
77 | /* Obsoleted/testing snippets: */ | ||
78 | #ifdef REMAP_VECTORS | ||
79 | /* Remap vectors to 0x3F80 (set in linker.cmd). */ | ||
80 | PMST = (PMST & 0x7f) | 0x3F80; | ||
81 | |||
82 | /* Make sure working interrupts aren't a fluke. */ | ||
83 | memset((unsigned short *)0x7f80, 0, 0x80); | ||
84 | #endif | ||
85 | |||
86 | #ifdef DATA_32_SINE | ||
87 | for (i = 0; i < 32; i++) { | ||
88 | double ratio = ((double)i)/32.0; | ||
89 | double rad = 3.0*3.141592*ratio; | ||
90 | double normal = sin(rad); | ||
91 | double scaled = 32767.0*(normal); | ||
92 | data[2*i + 0] = -(signed short)scaled; | ||
93 | data[2*i + 1] = (signed short)scaled; | ||
94 | } | ||
95 | #endif | ||
96 | |||
97 | #ifdef MANUAL_TRANSFER | ||
98 | register signed short *p; | ||
99 | |||
100 | debugf("starting write"); | ||
101 | |||
102 | i = 0; | ||
103 | p = data; | ||
104 | SPSA0 = 0x01; | ||
105 | for (;;) { | ||
106 | while ((SPSD0 & (1 << 1)) == 0); | ||
107 | DXR20 = *p++; // left channel | ||
108 | DXR10 = *p++; // right channel | ||
109 | if (++i == 32) { | ||
110 | p = data; | ||
111 | i = 0; | ||
112 | } | ||
113 | } | ||
114 | #endif | ||
115 | |||
116 | #ifdef INIT_MSG | ||
117 | /* Copy codec init data (before debugf, which clobbers status). */ | ||
118 | if (status.msg != MSG_INIT) { | ||
119 | debugf("No init message (%04x: %04x %04x %04x %04x instead)", | ||
120 | (unsigned short)&status, | ||
121 | ((unsigned short *)&status)[0], | ||
122 | ((unsigned short *)&status)[1], | ||
123 | ((unsigned short *)&status)[2], | ||
124 | ((unsigned short *)&status)[3]); | ||
125 | return; | ||
126 | } | ||
127 | |||
128 | memcpy(&init, (void *)&status.payload.init, sizeof(init)); | ||
129 | #endif | ||
130 | |||
131 | #ifdef IPC_SIZES | ||
132 | debugf("sizeof(ipc_message)=%uw offset(ipc_message.payload)=%uw", | ||
133 | sizeof(struct ipc_message), (int)&((struct ipc_message*)0)->payload); | ||
134 | #endif | ||
135 | |||
136 | #ifdef VERBOSE_INIT | ||
137 | debugf("codec started with PCM at SDRAM offset %04x:%04x", | ||
138 | sdem_addrh, sdem_addrl); | ||
139 | #endif | ||
140 | |||
141 | #ifdef SPIKE_DATA | ||
142 | for (i = 0; i < 0x2000; i++) { | ||
143 | data[2*i ] = data[2*i+1] = ((i % 32) == 0) * 32767; | ||
144 | } | ||
145 | #endif | ||