allow limited z80 vdp access
[picodrive.git] / pico / sound / sound.c
CommitLineData
cff531af 1/*\r
2 * PicoDrive\r
3 * (c) Copyright Dave, 2004\r
4 * (C) notaz, 2006-2009\r
5 *\r
6 * This work is licensed under the terms of MAME license.\r
7 * See COPYING file in the top-level directory.\r
8 */\r
cc68a136 9\r
10#include <string.h>\r
cc68a136 11#include "ym2612.h"\r
12#include "sn76496.h"\r
efcba75f 13#include "../pico_int.h"\r
e71fae1f 14#include "../cd/cue.h"\r
4f265db7 15#include "mix.h"\r
cc68a136 16\r
9c9cda8c 17#define SIMPLE_WRITE_SOUND 0\r
18\r
4a32f01f 19void (*PsndMix_32_to_16l)(short *dest, int *src, int count) = mix_32_to_16l_stereo;\r
20\r
4f265db7 21// master int buffer to mix to\r
02da059d 22static int PsndBuffer[2*(44100+100)/50];\r
cc68a136 23\r
cc68a136 24// dac\r
4b9c5888 25static unsigned short dac_info[312+4]; // pppppppp ppppllll, p - pos in buff, l - length to write for this sample\r
cc68a136 26\r
c9e1affc 27// cdda output buffer\r
28short cdda_out_buffer[2*1152];\r
29\r
cc68a136 30// for Pico\r
31int PsndRate=0;\r
32int PsndLen=0; // number of mono samples, multiply by 2 for stereo\r
7a93adeb 33int PsndLen_exc_add=0; // this is for non-integer sample counts per line, eg. 22050/60\r
34int PsndLen_exc_cnt=0;\r
4b9c5888 35int PsndDacLine=0;\r
cc68a136 36short *PsndOut=NULL; // PCM data buffer\r
37\r
4b9c5888 38// timers\r
48dc74f2 39int timer_a_next_oflow, timer_a_step; // in z80 cycles\r
40int timer_b_next_oflow, timer_b_step;\r
4b9c5888 41\r
cc68a136 42// sn76496\r
43extern int *sn76496_regs;\r
44\r
45\r
eff55556 46static void dac_recalculate(void)\r
cc68a136 47{\r
48 int i, dac_cnt, pos, len, lines = Pico.m.pal ? 312 : 262, mid = Pico.m.pal ? 68 : 93;\r
49\r
43e6eaad 50 if (PsndLen <= lines)\r
51 {\r
cc68a136 52 // shrinking algo\r
7a93adeb 53 dac_cnt = -PsndLen;\r
cc68a136 54 len=1; pos=0;\r
55 dac_info[225] = 1;\r
56\r
43e6eaad 57 for(i=226; i != 225; i++)\r
58 {\r
cc68a136 59 if (i >= lines) i = 0;\r
60 len = 0;\r
61 if(dac_cnt < 0) {\r
62 len=1;\r
63 pos++;\r
64 dac_cnt += lines;\r
65 }\r
66 dac_cnt -= PsndLen;\r
67 dac_info[i] = (pos<<4)|len;\r
68 }\r
43e6eaad 69 }\r
70 else\r
71 {\r
cc68a136 72 // stretching\r
7a93adeb 73 dac_cnt = PsndLen;\r
cc68a136 74 pos=0;\r
43e6eaad 75 for(i = 225; i != 224; i++)\r
76 {\r
cc68a136 77 if (i >= lines) i = 0;\r
78 len=0;\r
79 while(dac_cnt >= 0) {\r
80 dac_cnt -= lines;\r
81 len++;\r
82 }\r
4f265db7 83 if (i == mid) // midpoint\r
cc68a136 84 while(pos+len < PsndLen/2) {\r
85 dac_cnt -= lines;\r
86 len++;\r
87 }\r
88 dac_cnt += PsndLen;\r
89 dac_info[i] = (pos<<4)|len;\r
90 pos+=len;\r
91 }\r
92 // last sample\r
93 for(len = 0, i = pos; i < PsndLen; i++) len++;\r
7a93adeb 94 if (PsndLen_exc_add) len++;\r
cc68a136 95 dac_info[224] = (pos<<4)|len;\r
96 }\r
538a6098 97 mid = (dac_info[lines-1] & 0xfff0) + ((dac_info[lines-1] & 0xf) << 4);\r
4b9c5888 98 for (i = lines; i < sizeof(dac_info) / sizeof(dac_info[0]); i++)\r
538a6098 99 dac_info[i] = mid;\r
7a93adeb 100 //for(i=len=0; i < lines; i++) {\r
101 // printf("%03i : %03i : %i\n", i, dac_info[i]>>4, dac_info[i]&0xf);\r
102 // len+=dac_info[i]&0xf;\r
103 //}\r
104 //printf("rate is %i, len %f\n", PsndRate, (double)PsndRate/(Pico.m.pal ? 50.0 : 60.0));\r
105 //printf("len total: %i, last pos: %i\n", len, pos);\r
106 //exit(8);\r
cc68a136 107}\r
108\r
109\r
9d917eea 110PICO_INTERNAL void PsndReset(void)\r
cc68a136 111{\r
af37bca8 112 // PsndRerate calls YM2612Init, which also resets\r
9d917eea 113 PsndRerate(0);\r
af37bca8 114 timers_reset();\r
cc68a136 115}\r
116\r
117\r
118// to be called after changing sound rate or chips\r
9d917eea 119void PsndRerate(int preserve_state)\r
cc68a136 120{\r
5f8c85be 121 void *state = NULL;\r
7a93adeb 122 int target_fps = Pico.m.pal ? 50 : 60;\r
cc68a136 123\r
7a93adeb 124 if (preserve_state) {\r
d8afe7b8 125 state = malloc(0x204);\r
5f8c85be 126 if (state == NULL) return;\r
d8afe7b8 127 ym2612_pack_state();\r
128 memcpy(state, YM2612GetRegs(), 0x204);\r
7a93adeb 129 }\r
cc68a136 130 YM2612Init(Pico.m.pal ? OSC_PAL/7 : OSC_NTSC/7, PsndRate);\r
7a93adeb 131 if (preserve_state) {\r
132 // feed it back it's own registers, just like after loading state\r
d8afe7b8 133 memcpy(YM2612GetRegs(), state, 0x204);\r
453d2a6e 134 ym2612_unpack_state();\r
7a93adeb 135 }\r
cc68a136 136\r
7a93adeb 137 if (preserve_state) memcpy(state, sn76496_regs, 28*4); // remember old state\r
cc68a136 138 SN76496_init(Pico.m.pal ? OSC_PAL/15 : OSC_NTSC/15, PsndRate);\r
7a93adeb 139 if (preserve_state) memcpy(sn76496_regs, state, 28*4); // restore old state\r
cc68a136 140\r
5f8c85be 141 if (state)\r
142 free(state);\r
143\r
cc68a136 144 // calculate PsndLen\r
7a93adeb 145 PsndLen=PsndRate / target_fps;\r
146 PsndLen_exc_add=((PsndRate - PsndLen*target_fps)<<16) / target_fps;\r
147 PsndLen_exc_cnt=0;\r
cc68a136 148\r
149 // recalculate dac info\r
150 dac_recalculate();\r
4f265db7 151\r
7a93adeb 152 // clear all buffers\r
153 memset32(PsndBuffer, 0, sizeof(PsndBuffer)/4);\r
c9e1affc 154 memset(cdda_out_buffer, 0, sizeof(cdda_out_buffer));\r
7a93adeb 155 if (PsndOut)\r
9d917eea 156 PsndClear();\r
4a32f01f 157\r
158 // set mixer\r
602133e1 159 PsndMix_32_to_16l = (PicoOpt & POPT_EN_STEREO) ? mix_32_to_16l_stereo : mix_32_to_16_mono;\r
ed367a3f 160\r
161 if (PicoAHW & PAHW_PICO)\r
162 PicoReratePico();\r
cc68a136 163}\r
164\r
165\r
4b9c5888 166PICO_INTERNAL void PsndDoDAC(int line_to)\r
cc68a136 167{\r
4b9c5888 168 int pos, pos1, len;\r
169 int dout = ym2612.dacout;\r
170 int line_from = PsndDacLine;\r
4f265db7 171\r
9b5713af 172 if (line_to >= 312)\r
173 line_to = 311;\r
174\r
4b9c5888 175 PsndDacLine = line_to + 1;\r
4f265db7 176\r
4b9c5888 177 pos =dac_info[line_from]>>4;\r
178 pos1=dac_info[line_to];\r
179 len = ((pos1>>4)-pos) + (pos1&0xf);\r
4f265db7 180 if (!len) return;\r
181\r
4b9c5888 182 if (PicoOpt & POPT_EN_STEREO) {\r
4f265db7 183 short *d = PsndOut + pos*2;\r
4b9c5888 184 for (; len > 0; len--, d+=2) *d = dout;\r
185 } else {\r
186 short *d = PsndOut + pos;\r
187 for (; len > 0; len--, d++) *d = dout;\r
cc68a136 188 }\r
4f265db7 189}\r
cc68a136 190\r
c9e1affc 191// cdda\r
c9e1affc 192static void cdda_raw_update(int *buffer, int length)\r
193{\r
02da059d 194 int ret, cdda_bytes, mult = 1;\r
c9e1affc 195\r
196 cdda_bytes = length*4;\r
02da059d 197 if (PsndRate <= 22050 + 100) mult = 2;\r
198 if (PsndRate < 22050 - 100) mult = 4;\r
199 cdda_bytes *= mult;\r
c9e1affc 200\r
274fcc35 201 ret = pm_read(cdda_out_buffer, cdda_bytes, Pico_mcd->cdda_stream);\r
c9e1affc 202 if (ret < cdda_bytes) {\r
203 memset((char *)cdda_out_buffer + ret, 0, cdda_bytes - ret);\r
274fcc35 204 Pico_mcd->cdda_stream = NULL;\r
c9e1affc 205 return;\r
206 }\r
207\r
208 // now mix\r
02da059d 209 switch (mult) {\r
210 case 1: mix_16h_to_32(buffer, cdda_out_buffer, length*2); break;\r
211 case 2: mix_16h_to_32_s1(buffer, cdda_out_buffer, length*2); break;\r
212 case 4: mix_16h_to_32_s2(buffer, cdda_out_buffer, length*2); break;\r
c9e1affc 213 }\r
214}\r
215\r
274fcc35 216void cdda_start_play(int lba_base, int lba_offset, int lb_len)\r
c9e1affc 217{\r
274fcc35 218 if (Pico_mcd->cdda_type == CT_MP3)\r
c9e1affc 219 {\r
220 int pos1024 = 0;\r
221\r
c9e1affc 222 if (lba_offset)\r
274fcc35 223 pos1024 = lba_offset * 1024 / lb_len;\r
c9e1affc 224\r
274fcc35 225 mp3_start_play(Pico_mcd->cdda_stream, pos1024);\r
c9e1affc 226 return;\r
227 }\r
228\r
274fcc35 229 pm_seek(Pico_mcd->cdda_stream, (lba_base + lba_offset) * 2352, SEEK_SET);\r
230 if (Pico_mcd->cdda_type == CT_WAV)\r
0bccafeb 231 {\r
232 // skip headers, assume it's 44kHz stereo uncompressed\r
274fcc35 233 pm_seek(Pico_mcd->cdda_stream, 44, SEEK_CUR);\r
0bccafeb 234 }\r
c9e1affc 235}\r
236\r
cc68a136 237\r
9d917eea 238PICO_INTERNAL void PsndClear(void)\r
4f265db7 239{\r
7a93adeb 240 int len = PsndLen;\r
241 if (PsndLen_exc_add) len++;\r
602133e1 242 if (PicoOpt & POPT_EN_STEREO)\r
88b3d7c1 243 memset32((int *) PsndOut, 0, len); // assume PsndOut to be aligned\r
244 else {\r
245 short *out = PsndOut;\r
b8a1c09a 246 if ((long)out & 2) { *out++ = 0; len--; }\r
88b3d7c1 247 memset32((int *) out, 0, len/2);\r
248 if (len & 1) out[len-1] = 0;\r
249 }\r
cc68a136 250}\r
251\r
252\r
7b3f44c6 253static int PsndRender(int offset, int length)\r
cc68a136 254{\r
85f8e929 255 int buf32_updated = 0;\r
4f265db7 256 int *buf32 = PsndBuffer+offset;\r
cc68a136 257 int stereo = (PicoOpt & 8) >> 3;\r
33be04ca 258\r
cc68a136 259 offset <<= stereo;\r
260\r
f6c49d38 261 pprof_start(sound);\r
262\r
03a265e5 263#if !SIMPLE_WRITE_SOUND\r
7a93adeb 264 if (offset == 0) { // should happen once per frame\r
265 // compensate for float part of PsndLen\r
266 PsndLen_exc_cnt += PsndLen_exc_add;\r
267 if (PsndLen_exc_cnt >= 0x10000) {\r
268 PsndLen_exc_cnt -= 0x10000;\r
269 length++;\r
270 }\r
271 }\r
03a265e5 272#endif\r
7a93adeb 273\r
cc68a136 274 // PSG\r
602133e1 275 if (PicoOpt & POPT_EN_PSG)\r
cc68a136 276 SN76496Update(PsndOut+offset, length, stereo);\r
277\r
ef4eb506 278 if (PicoAHW & PAHW_PICO) {\r
279 PicoPicoPCMUpdate(PsndOut+offset, length, stereo);\r
280 return length;\r
281 }\r
282\r
cc68a136 283 // Add in the stereo FM buffer\r
602133e1 284 if (PicoOpt & POPT_EN_FM) {\r
85f8e929 285 buf32_updated = YM2612UpdateOne(buf32, length, stereo, 1);\r
3ec29f01 286 } else\r
fa1e5e29 287 memset32(buf32, 0, length<<stereo);\r
85f8e929 288\r
289//printf("active_chs: %02x\n", buf32_updated);\r
e743be20 290 (void)buf32_updated;\r
4f265db7 291\r
7a93adeb 292 // CD: PCM sound\r
33be04ca 293 if (PicoAHW & PAHW_MCD) {\r
294 pcd_pcm_update(buf32, length, stereo);\r
85f8e929 295 //buf32_updated = 1;\r
296 }\r
4f265db7 297\r
7a93adeb 298 // CD: CDDA audio\r
da42200b 299 // CD mode, cdda enabled, not data track, CDC is reading\r
274fcc35 300 if ((PicoAHW & PAHW_MCD) && (PicoOpt & POPT_EN_MCD_CDDA)\r
301 && Pico_mcd->cdda_stream != NULL\r
302 && !(Pico_mcd->s68k_regs[0x36] & 1))\r
c9e1affc 303 {\r
304 // note: only 44, 22 and 11 kHz supported, with forced stereo\r
274fcc35 305 if (Pico_mcd->cdda_type == CT_MP3)\r
c9e1affc 306 mp3_update(buf32, length, stereo);\r
307 else\r
308 cdda_raw_update(buf32, length);\r
309 }\r
4f265db7 310\r
db1d3564 311 if ((PicoAHW & PAHW_32X) && (PicoOpt & POPT_EN_PWM))\r
312 p32x_pwm_update(buf32, length, stereo);\r
313\r
4f265db7 314 // convert + limit to normal 16bit output\r
4a32f01f 315 PsndMix_32_to_16l(PsndOut+offset, buf32, length);\r
cc68a136 316\r
f6c49d38 317 pprof_end(sound);\r
318\r
7a93adeb 319 return length;\r
cc68a136 320}\r
321\r
7b3f44c6 322// to be called on 224 or line_sample scanlines only\r
323PICO_INTERNAL void PsndGetSamples(int y)\r
324{\r
325#if SIMPLE_WRITE_SOUND\r
326 if (y != 224) return;\r
327 PsndRender(0, PsndLen);\r
a4edca53 328 if (PicoWriteSound)\r
329 PicoWriteSound(PsndLen * ((PicoOpt & POPT_EN_STEREO) ? 4 : 2));\r
7b3f44c6 330 PsndClear();\r
331#else\r
332 static int curr_pos = 0;\r
333\r
334 if (y == 224)\r
335 {\r
336 if (emustatus & 2)\r
337 curr_pos += PsndRender(curr_pos, PsndLen-PsndLen/2);\r
338 else curr_pos = PsndRender(0, PsndLen);\r
a4edca53 339 if (emustatus & 1)\r
340 emustatus |= 2;\r
341 else emustatus &= ~2;\r
342 if (PicoWriteSound)\r
343 PicoWriteSound(curr_pos * ((PicoOpt & POPT_EN_STEREO) ? 4 : 2));\r
7b3f44c6 344 // clear sound buffer\r
345 PsndClear();\r
346 }\r
347 else if (emustatus & 3) {\r
348 emustatus|= 2;\r
349 emustatus&=~1;\r
350 curr_pos = PsndRender(0, PsndLen/2);\r
351 }\r
352#endif\r
353}\r
354\r
2ec9bec5 355PICO_INTERNAL void PsndGetSamplesMS(void)\r
356{\r
2ec9bec5 357 int stereo = (PicoOpt & 8) >> 3;\r
358 int length = PsndLen;\r
359\r
360#if !SIMPLE_WRITE_SOUND\r
361 // compensate for float part of PsndLen\r
362 PsndLen_exc_cnt += PsndLen_exc_add;\r
363 if (PsndLen_exc_cnt >= 0x10000) {\r
364 PsndLen_exc_cnt -= 0x10000;\r
365 length++;\r
366 }\r
367#endif\r
368\r
369 // PSG\r
370 if (PicoOpt & POPT_EN_PSG)\r
371 SN76496Update(PsndOut, length, stereo);\r
372\r
19954be1 373 // upmix to "stereo" if needed\r
374 if (stereo) {\r
8a19f430 375 int i, *p;\r
376 for (i = length, p = (void *)PsndOut; i > 0; i--, p++)\r
19954be1 377 *p |= *p << 16;\r
378 }\r
2ec9bec5 379\r
380 if (PicoWriteSound != NULL)\r
a4edca53 381 PicoWriteSound(length * ((PicoOpt & POPT_EN_STEREO) ? 4 : 2));\r
2ec9bec5 382 PsndClear();\r
383}\r
384\r