root / hw / marvell_88w8618_audio.c @ 3c619b59
History | View | Annotate | Download (7.1 kB)
1 | ef07b491 | Andrzej Zaborowski | /*
|
---|---|---|---|
2 | ef07b491 | Andrzej Zaborowski | * Marvell 88w8618 audio emulation extracted from
|
3 | ef07b491 | Andrzej Zaborowski | * Marvell MV88w8618 / Freecom MusicPal emulation.
|
4 | ef07b491 | Andrzej Zaborowski | *
|
5 | ef07b491 | Andrzej Zaborowski | * Copyright (c) 2008 Jan Kiszka
|
6 | ef07b491 | Andrzej Zaborowski | *
|
7 | ef07b491 | Andrzej Zaborowski | * This code is licenced under the GNU GPL v2.
|
8 | ef07b491 | Andrzej Zaborowski | */
|
9 | ef07b491 | Andrzej Zaborowski | #include "sysbus.h" |
10 | ef07b491 | Andrzej Zaborowski | #include "hw.h" |
11 | ef07b491 | Andrzej Zaborowski | #include "i2c.h" |
12 | ef07b491 | Andrzej Zaborowski | #include "sysbus.h" |
13 | ef07b491 | Andrzej Zaborowski | #include "audio/audio.h" |
14 | ef07b491 | Andrzej Zaborowski | |
15 | ef07b491 | Andrzej Zaborowski | #define MP_AUDIO_SIZE 0x00001000 |
16 | ef07b491 | Andrzej Zaborowski | |
17 | ef07b491 | Andrzej Zaborowski | /* Audio register offsets */
|
18 | ef07b491 | Andrzej Zaborowski | #define MP_AUDIO_PLAYBACK_MODE 0x00 |
19 | ef07b491 | Andrzej Zaborowski | #define MP_AUDIO_CLOCK_DIV 0x18 |
20 | ef07b491 | Andrzej Zaborowski | #define MP_AUDIO_IRQ_STATUS 0x20 |
21 | ef07b491 | Andrzej Zaborowski | #define MP_AUDIO_IRQ_ENABLE 0x24 |
22 | ef07b491 | Andrzej Zaborowski | #define MP_AUDIO_TX_START_LO 0x28 |
23 | ef07b491 | Andrzej Zaborowski | #define MP_AUDIO_TX_THRESHOLD 0x2C |
24 | ef07b491 | Andrzej Zaborowski | #define MP_AUDIO_TX_STATUS 0x38 |
25 | ef07b491 | Andrzej Zaborowski | #define MP_AUDIO_TX_START_HI 0x40 |
26 | ef07b491 | Andrzej Zaborowski | |
27 | ef07b491 | Andrzej Zaborowski | /* Status register and IRQ enable bits */
|
28 | ef07b491 | Andrzej Zaborowski | #define MP_AUDIO_TX_HALF (1 << 6) |
29 | ef07b491 | Andrzej Zaborowski | #define MP_AUDIO_TX_FULL (1 << 7) |
30 | ef07b491 | Andrzej Zaborowski | |
31 | ef07b491 | Andrzej Zaborowski | /* Playback mode bits */
|
32 | ef07b491 | Andrzej Zaborowski | #define MP_AUDIO_16BIT_SAMPLE (1 << 0) |
33 | ef07b491 | Andrzej Zaborowski | #define MP_AUDIO_PLAYBACK_EN (1 << 7) |
34 | ef07b491 | Andrzej Zaborowski | #define MP_AUDIO_CLOCK_24MHZ (1 << 9) |
35 | ef07b491 | Andrzej Zaborowski | #define MP_AUDIO_MONO (1 << 14) |
36 | ef07b491 | Andrzej Zaborowski | |
37 | ef07b491 | Andrzej Zaborowski | #ifdef HAS_AUDIO
|
38 | ef07b491 | Andrzej Zaborowski | typedef struct mv88w8618_audio_state { |
39 | ef07b491 | Andrzej Zaborowski | SysBusDevice busdev; |
40 | ef07b491 | Andrzej Zaborowski | qemu_irq irq; |
41 | ef07b491 | Andrzej Zaborowski | uint32_t playback_mode; |
42 | ef07b491 | Andrzej Zaborowski | uint32_t status; |
43 | ef07b491 | Andrzej Zaborowski | uint32_t irq_enable; |
44 | ef07b491 | Andrzej Zaborowski | unsigned long phys_buf; |
45 | ef07b491 | Andrzej Zaborowski | uint32_t target_buffer; |
46 | ef07b491 | Andrzej Zaborowski | unsigned int threshold; |
47 | ef07b491 | Andrzej Zaborowski | unsigned int play_pos; |
48 | ef07b491 | Andrzej Zaborowski | unsigned int last_free; |
49 | ef07b491 | Andrzej Zaborowski | uint32_t clock_div; |
50 | ef07b491 | Andrzej Zaborowski | DeviceState *wm; |
51 | ef07b491 | Andrzej Zaborowski | } mv88w8618_audio_state; |
52 | ef07b491 | Andrzej Zaborowski | |
53 | ef07b491 | Andrzej Zaborowski | static void mv88w8618_audio_callback(void *opaque, int free_out, int free_in) |
54 | ef07b491 | Andrzej Zaborowski | { |
55 | ef07b491 | Andrzej Zaborowski | mv88w8618_audio_state *s = opaque; |
56 | ef07b491 | Andrzej Zaborowski | int16_t *codec_buffer; |
57 | ef07b491 | Andrzej Zaborowski | int8_t buf[4096];
|
58 | ef07b491 | Andrzej Zaborowski | int8_t *mem_buffer; |
59 | ef07b491 | Andrzej Zaborowski | int pos, block_size;
|
60 | ef07b491 | Andrzej Zaborowski | |
61 | ef07b491 | Andrzej Zaborowski | if (!(s->playback_mode & MP_AUDIO_PLAYBACK_EN))
|
62 | ef07b491 | Andrzej Zaborowski | return;
|
63 | ef07b491 | Andrzej Zaborowski | |
64 | ef07b491 | Andrzej Zaborowski | if (s->playback_mode & MP_AUDIO_16BIT_SAMPLE)
|
65 | ef07b491 | Andrzej Zaborowski | free_out <<= 1;
|
66 | ef07b491 | Andrzej Zaborowski | |
67 | ef07b491 | Andrzej Zaborowski | if (!(s->playback_mode & MP_AUDIO_MONO))
|
68 | ef07b491 | Andrzej Zaborowski | free_out <<= 1;
|
69 | ef07b491 | Andrzej Zaborowski | |
70 | ef07b491 | Andrzej Zaborowski | block_size = s->threshold / 2;
|
71 | ef07b491 | Andrzej Zaborowski | if (free_out - s->last_free < block_size)
|
72 | ef07b491 | Andrzej Zaborowski | return;
|
73 | ef07b491 | Andrzej Zaborowski | |
74 | ef07b491 | Andrzej Zaborowski | if (block_size > 4096) |
75 | ef07b491 | Andrzej Zaborowski | return;
|
76 | ef07b491 | Andrzej Zaborowski | |
77 | ef07b491 | Andrzej Zaborowski | cpu_physical_memory_read(s->target_buffer + s->play_pos, (void *)buf,
|
78 | ef07b491 | Andrzej Zaborowski | block_size); |
79 | ef07b491 | Andrzej Zaborowski | mem_buffer = buf; |
80 | ef07b491 | Andrzej Zaborowski | if (s->playback_mode & MP_AUDIO_16BIT_SAMPLE) {
|
81 | ef07b491 | Andrzej Zaborowski | if (s->playback_mode & MP_AUDIO_MONO) {
|
82 | ef07b491 | Andrzej Zaborowski | codec_buffer = wm8750_dac_buffer(s->wm, block_size >> 1);
|
83 | ef07b491 | Andrzej Zaborowski | for (pos = 0; pos < block_size; pos += 2) { |
84 | ef07b491 | Andrzej Zaborowski | *codec_buffer++ = *(int16_t *)mem_buffer; |
85 | ef07b491 | Andrzej Zaborowski | *codec_buffer++ = *(int16_t *)mem_buffer; |
86 | ef07b491 | Andrzej Zaborowski | mem_buffer += 2;
|
87 | ef07b491 | Andrzej Zaborowski | } |
88 | ef07b491 | Andrzej Zaborowski | } else
|
89 | ef07b491 | Andrzej Zaborowski | memcpy(wm8750_dac_buffer(s->wm, block_size >> 2),
|
90 | ef07b491 | Andrzej Zaborowski | (uint32_t *)mem_buffer, block_size); |
91 | ef07b491 | Andrzej Zaborowski | } else {
|
92 | ef07b491 | Andrzej Zaborowski | if (s->playback_mode & MP_AUDIO_MONO) {
|
93 | ef07b491 | Andrzej Zaborowski | codec_buffer = wm8750_dac_buffer(s->wm, block_size); |
94 | ef07b491 | Andrzej Zaborowski | for (pos = 0; pos < block_size; pos++) { |
95 | ef07b491 | Andrzej Zaborowski | *codec_buffer++ = cpu_to_le16(256 * *mem_buffer);
|
96 | ef07b491 | Andrzej Zaborowski | *codec_buffer++ = cpu_to_le16(256 * *mem_buffer++);
|
97 | ef07b491 | Andrzej Zaborowski | } |
98 | ef07b491 | Andrzej Zaborowski | } else {
|
99 | ef07b491 | Andrzej Zaborowski | codec_buffer = wm8750_dac_buffer(s->wm, block_size >> 1);
|
100 | ef07b491 | Andrzej Zaborowski | for (pos = 0; pos < block_size; pos += 2) { |
101 | ef07b491 | Andrzej Zaborowski | *codec_buffer++ = cpu_to_le16(256 * *mem_buffer++);
|
102 | ef07b491 | Andrzej Zaborowski | *codec_buffer++ = cpu_to_le16(256 * *mem_buffer++);
|
103 | ef07b491 | Andrzej Zaborowski | } |
104 | ef07b491 | Andrzej Zaborowski | } |
105 | ef07b491 | Andrzej Zaborowski | } |
106 | ef07b491 | Andrzej Zaborowski | wm8750_dac_commit(s->wm); |
107 | ef07b491 | Andrzej Zaborowski | |
108 | ef07b491 | Andrzej Zaborowski | s->last_free = free_out - block_size; |
109 | ef07b491 | Andrzej Zaborowski | |
110 | ef07b491 | Andrzej Zaborowski | if (s->play_pos == 0) { |
111 | ef07b491 | Andrzej Zaborowski | s->status |= MP_AUDIO_TX_HALF; |
112 | ef07b491 | Andrzej Zaborowski | s->play_pos = block_size; |
113 | ef07b491 | Andrzej Zaborowski | } else {
|
114 | ef07b491 | Andrzej Zaborowski | s->status |= MP_AUDIO_TX_FULL; |
115 | ef07b491 | Andrzej Zaborowski | s->play_pos = 0;
|
116 | ef07b491 | Andrzej Zaborowski | } |
117 | ef07b491 | Andrzej Zaborowski | |
118 | ef07b491 | Andrzej Zaborowski | if (s->status & s->irq_enable)
|
119 | ef07b491 | Andrzej Zaborowski | qemu_irq_raise(s->irq); |
120 | ef07b491 | Andrzej Zaborowski | } |
121 | ef07b491 | Andrzej Zaborowski | |
122 | ef07b491 | Andrzej Zaborowski | static void mv88w8618_audio_clock_update(mv88w8618_audio_state *s) |
123 | ef07b491 | Andrzej Zaborowski | { |
124 | ef07b491 | Andrzej Zaborowski | int rate;
|
125 | ef07b491 | Andrzej Zaborowski | |
126 | ef07b491 | Andrzej Zaborowski | if (s->playback_mode & MP_AUDIO_CLOCK_24MHZ)
|
127 | ef07b491 | Andrzej Zaborowski | rate = 24576000 / 64; /* 24.576MHz */ |
128 | ef07b491 | Andrzej Zaborowski | else
|
129 | ef07b491 | Andrzej Zaborowski | rate = 11289600 / 64; /* 11.2896MHz */ |
130 | ef07b491 | Andrzej Zaborowski | |
131 | ef07b491 | Andrzej Zaborowski | rate /= ((s->clock_div >> 8) & 0xff) + 1; |
132 | ef07b491 | Andrzej Zaborowski | |
133 | ef07b491 | Andrzej Zaborowski | wm8750_set_bclk_in(s->wm, rate); |
134 | ef07b491 | Andrzej Zaborowski | } |
135 | ef07b491 | Andrzej Zaborowski | |
136 | ef07b491 | Andrzej Zaborowski | static uint32_t mv88w8618_audio_read(void *opaque, target_phys_addr_t offset) |
137 | ef07b491 | Andrzej Zaborowski | { |
138 | ef07b491 | Andrzej Zaborowski | mv88w8618_audio_state *s = opaque; |
139 | ef07b491 | Andrzej Zaborowski | |
140 | ef07b491 | Andrzej Zaborowski | switch (offset) {
|
141 | ef07b491 | Andrzej Zaborowski | case MP_AUDIO_PLAYBACK_MODE:
|
142 | ef07b491 | Andrzej Zaborowski | return s->playback_mode;
|
143 | ef07b491 | Andrzej Zaborowski | |
144 | ef07b491 | Andrzej Zaborowski | case MP_AUDIO_CLOCK_DIV:
|
145 | ef07b491 | Andrzej Zaborowski | return s->clock_div;
|
146 | ef07b491 | Andrzej Zaborowski | |
147 | ef07b491 | Andrzej Zaborowski | case MP_AUDIO_IRQ_STATUS:
|
148 | ef07b491 | Andrzej Zaborowski | return s->status;
|
149 | ef07b491 | Andrzej Zaborowski | |
150 | ef07b491 | Andrzej Zaborowski | case MP_AUDIO_IRQ_ENABLE:
|
151 | ef07b491 | Andrzej Zaborowski | return s->irq_enable;
|
152 | ef07b491 | Andrzej Zaborowski | |
153 | ef07b491 | Andrzej Zaborowski | case MP_AUDIO_TX_STATUS:
|
154 | ef07b491 | Andrzej Zaborowski | return s->play_pos >> 2; |
155 | ef07b491 | Andrzej Zaborowski | |
156 | ef07b491 | Andrzej Zaborowski | default:
|
157 | ef07b491 | Andrzej Zaborowski | return 0; |
158 | ef07b491 | Andrzej Zaborowski | } |
159 | ef07b491 | Andrzej Zaborowski | } |
160 | ef07b491 | Andrzej Zaborowski | |
161 | ef07b491 | Andrzej Zaborowski | static void mv88w8618_audio_write(void *opaque, target_phys_addr_t offset, |
162 | ef07b491 | Andrzej Zaborowski | uint32_t value) |
163 | ef07b491 | Andrzej Zaborowski | { |
164 | ef07b491 | Andrzej Zaborowski | mv88w8618_audio_state *s = opaque; |
165 | ef07b491 | Andrzej Zaborowski | |
166 | ef07b491 | Andrzej Zaborowski | switch (offset) {
|
167 | ef07b491 | Andrzej Zaborowski | case MP_AUDIO_PLAYBACK_MODE:
|
168 | ef07b491 | Andrzej Zaborowski | if (value & MP_AUDIO_PLAYBACK_EN &&
|
169 | ef07b491 | Andrzej Zaborowski | !(s->playback_mode & MP_AUDIO_PLAYBACK_EN)) { |
170 | ef07b491 | Andrzej Zaborowski | s->status = 0;
|
171 | ef07b491 | Andrzej Zaborowski | s->last_free = 0;
|
172 | ef07b491 | Andrzej Zaborowski | s->play_pos = 0;
|
173 | ef07b491 | Andrzej Zaborowski | } |
174 | ef07b491 | Andrzej Zaborowski | s->playback_mode = value; |
175 | ef07b491 | Andrzej Zaborowski | mv88w8618_audio_clock_update(s); |
176 | ef07b491 | Andrzej Zaborowski | break;
|
177 | ef07b491 | Andrzej Zaborowski | |
178 | ef07b491 | Andrzej Zaborowski | case MP_AUDIO_CLOCK_DIV:
|
179 | ef07b491 | Andrzej Zaborowski | s->clock_div = value; |
180 | ef07b491 | Andrzej Zaborowski | s->last_free = 0;
|
181 | ef07b491 | Andrzej Zaborowski | s->play_pos = 0;
|
182 | ef07b491 | Andrzej Zaborowski | mv88w8618_audio_clock_update(s); |
183 | ef07b491 | Andrzej Zaborowski | break;
|
184 | ef07b491 | Andrzej Zaborowski | |
185 | ef07b491 | Andrzej Zaborowski | case MP_AUDIO_IRQ_STATUS:
|
186 | ef07b491 | Andrzej Zaborowski | s->status &= ~value; |
187 | ef07b491 | Andrzej Zaborowski | break;
|
188 | ef07b491 | Andrzej Zaborowski | |
189 | ef07b491 | Andrzej Zaborowski | case MP_AUDIO_IRQ_ENABLE:
|
190 | ef07b491 | Andrzej Zaborowski | s->irq_enable = value; |
191 | ef07b491 | Andrzej Zaborowski | if (s->status & s->irq_enable)
|
192 | ef07b491 | Andrzej Zaborowski | qemu_irq_raise(s->irq); |
193 | ef07b491 | Andrzej Zaborowski | break;
|
194 | ef07b491 | Andrzej Zaborowski | |
195 | ef07b491 | Andrzej Zaborowski | case MP_AUDIO_TX_START_LO:
|
196 | ef07b491 | Andrzej Zaborowski | s->phys_buf = (s->phys_buf & 0xFFFF0000) | (value & 0xFFFF); |
197 | ef07b491 | Andrzej Zaborowski | s->target_buffer = s->phys_buf; |
198 | ef07b491 | Andrzej Zaborowski | s->play_pos = 0;
|
199 | ef07b491 | Andrzej Zaborowski | s->last_free = 0;
|
200 | ef07b491 | Andrzej Zaborowski | break;
|
201 | ef07b491 | Andrzej Zaborowski | |
202 | ef07b491 | Andrzej Zaborowski | case MP_AUDIO_TX_THRESHOLD:
|
203 | ef07b491 | Andrzej Zaborowski | s->threshold = (value + 1) * 4; |
204 | ef07b491 | Andrzej Zaborowski | break;
|
205 | ef07b491 | Andrzej Zaborowski | |
206 | ef07b491 | Andrzej Zaborowski | case MP_AUDIO_TX_START_HI:
|
207 | ef07b491 | Andrzej Zaborowski | s->phys_buf = (s->phys_buf & 0xFFFF) | (value << 16); |
208 | ef07b491 | Andrzej Zaborowski | s->target_buffer = s->phys_buf; |
209 | ef07b491 | Andrzej Zaborowski | s->play_pos = 0;
|
210 | ef07b491 | Andrzej Zaborowski | s->last_free = 0;
|
211 | ef07b491 | Andrzej Zaborowski | break;
|
212 | ef07b491 | Andrzej Zaborowski | } |
213 | ef07b491 | Andrzej Zaborowski | } |
214 | ef07b491 | Andrzej Zaborowski | |
215 | ef07b491 | Andrzej Zaborowski | static void mv88w8618_audio_reset(void *opaque) |
216 | ef07b491 | Andrzej Zaborowski | { |
217 | ef07b491 | Andrzej Zaborowski | mv88w8618_audio_state *s = opaque; |
218 | ef07b491 | Andrzej Zaborowski | |
219 | ef07b491 | Andrzej Zaborowski | s->playback_mode = 0;
|
220 | ef07b491 | Andrzej Zaborowski | s->status = 0;
|
221 | ef07b491 | Andrzej Zaborowski | s->irq_enable = 0;
|
222 | ef07b491 | Andrzej Zaborowski | } |
223 | ef07b491 | Andrzej Zaborowski | |
224 | d60efc6b | Blue Swirl | static CPUReadMemoryFunc * const mv88w8618_audio_readfn[] = { |
225 | ef07b491 | Andrzej Zaborowski | mv88w8618_audio_read, |
226 | ef07b491 | Andrzej Zaborowski | mv88w8618_audio_read, |
227 | ef07b491 | Andrzej Zaborowski | mv88w8618_audio_read |
228 | ef07b491 | Andrzej Zaborowski | }; |
229 | ef07b491 | Andrzej Zaborowski | |
230 | d60efc6b | Blue Swirl | static CPUWriteMemoryFunc * const mv88w8618_audio_writefn[] = { |
231 | ef07b491 | Andrzej Zaborowski | mv88w8618_audio_write, |
232 | ef07b491 | Andrzej Zaborowski | mv88w8618_audio_write, |
233 | ef07b491 | Andrzej Zaborowski | mv88w8618_audio_write |
234 | ef07b491 | Andrzej Zaborowski | }; |
235 | ef07b491 | Andrzej Zaborowski | |
236 | 81a322d4 | Gerd Hoffmann | static int mv88w8618_audio_init(SysBusDevice *dev) |
237 | ef07b491 | Andrzej Zaborowski | { |
238 | ef07b491 | Andrzej Zaborowski | mv88w8618_audio_state *s = FROM_SYSBUS(mv88w8618_audio_state, dev); |
239 | ef07b491 | Andrzej Zaborowski | int iomemtype;
|
240 | ef07b491 | Andrzej Zaborowski | |
241 | ef07b491 | Andrzej Zaborowski | sysbus_init_irq(dev, &s->irq); |
242 | ef07b491 | Andrzej Zaborowski | |
243 | ef07b491 | Andrzej Zaborowski | wm8750_data_req_set(s->wm, mv88w8618_audio_callback, s); |
244 | ef07b491 | Andrzej Zaborowski | |
245 | ef07b491 | Andrzej Zaborowski | iomemtype = cpu_register_io_memory(mv88w8618_audio_readfn, |
246 | ef07b491 | Andrzej Zaborowski | mv88w8618_audio_writefn, s); |
247 | ef07b491 | Andrzej Zaborowski | sysbus_init_mmio(dev, MP_AUDIO_SIZE, iomemtype); |
248 | ef07b491 | Andrzej Zaborowski | |
249 | ef07b491 | Andrzej Zaborowski | qemu_register_reset(mv88w8618_audio_reset, s); |
250 | 81a322d4 | Gerd Hoffmann | |
251 | 81a322d4 | Gerd Hoffmann | return 0; |
252 | ef07b491 | Andrzej Zaborowski | } |
253 | ef07b491 | Andrzej Zaborowski | |
254 | ef07b491 | Andrzej Zaborowski | static SysBusDeviceInfo mv88w8618_audio_info = {
|
255 | ef07b491 | Andrzej Zaborowski | .init = mv88w8618_audio_init, |
256 | ef07b491 | Andrzej Zaborowski | .qdev.name = "mv88w8618_audio",
|
257 | ef07b491 | Andrzej Zaborowski | .qdev.size = sizeof(mv88w8618_audio_state),
|
258 | ef07b491 | Andrzej Zaborowski | .qdev.props = (Property[]) { |
259 | ef07b491 | Andrzej Zaborowski | { |
260 | ef07b491 | Andrzej Zaborowski | .name = "wm8750",
|
261 | ef07b491 | Andrzej Zaborowski | .info = &qdev_prop_ptr, |
262 | ef07b491 | Andrzej Zaborowski | .offset = offsetof(mv88w8618_audio_state, wm), |
263 | ef07b491 | Andrzej Zaborowski | }, |
264 | ef07b491 | Andrzej Zaborowski | {/* end of list */}
|
265 | ef07b491 | Andrzej Zaborowski | } |
266 | ef07b491 | Andrzej Zaborowski | }; |
267 | ef07b491 | Andrzej Zaborowski | #endif
|
268 | ef07b491 | Andrzej Zaborowski | |
269 | ef07b491 | Andrzej Zaborowski | static void mv88w8618_register_devices(void) |
270 | ef07b491 | Andrzej Zaborowski | { |
271 | ef07b491 | Andrzej Zaborowski | #ifdef HAS_AUDIO
|
272 | ef07b491 | Andrzej Zaborowski | sysbus_register_withprop(&mv88w8618_audio_info); |
273 | ef07b491 | Andrzej Zaborowski | #endif
|
274 | ef07b491 | Andrzej Zaborowski | } |
275 | ef07b491 | Andrzej Zaborowski | |
276 | ef07b491 | Andrzej Zaborowski | device_init(mv88w8618_register_devices) |