X-Git-Url: https://notaz.gp2x.de/cgi-bin/gitweb.cgi?a=blobdiff_plain;f=Pico%2Fsound%2Fsound.c;h=ab6b7e1c38ae08c3242ad952feb9afa1c5de356b;hb=453d2a6edadbd6a0977b76eba14961006c907f01;hp=64e172a07c3710875ea213b5d603f40cc9ce39dd;hpb=03a265e5ebabff7adbb4f97387f81e9b0428dbee;p=picodrive.git diff --git a/Pico/sound/sound.c b/Pico/sound/sound.c index 64e172a..ab6b7e1 100644 --- a/Pico/sound/sound.c +++ b/Pico/sound/sound.c @@ -21,15 +21,23 @@ void (*PsndMix_32_to_16l)(short *dest, int *src, int count) = mix_32_to_16l_ster static int PsndBuffer[2*44100/50]; // dac -static unsigned short dac_info[312]; // pppppppp ppppllll, p - pos in buff, l - length to write for this sample +static unsigned short dac_info[312+4]; // pppppppp ppppllll, p - pos in buff, l - length to write for this sample + +// cdda output buffer +short cdda_out_buffer[2*1152]; // for Pico int PsndRate=0; int PsndLen=0; // number of mono samples, multiply by 2 for stereo int PsndLen_exc_add=0; // this is for non-integer sample counts per line, eg. 22050/60 int PsndLen_exc_cnt=0; +int PsndDacLine=0; short *PsndOut=NULL; // PCM data buffer +// timers +int timer_a_next_oflow, timer_a_step, timer_a_offset; // in z80 cycles +int timer_b_next_oflow, timer_b_step, timer_b_offset; + // sn76496 extern int *sn76496_regs; @@ -38,13 +46,15 @@ static void dac_recalculate(void) { int i, dac_cnt, pos, len, lines = Pico.m.pal ? 312 : 262, mid = Pico.m.pal ? 68 : 93; - if(PsndLen <= lines) { + if (PsndLen <= lines) + { // shrinking algo dac_cnt = -PsndLen; len=1; pos=0; dac_info[225] = 1; - for(i=226; i != 225; i++) { + for(i=226; i != 225; i++) + { if (i >= lines) i = 0; len = 0; if(dac_cnt < 0) { @@ -55,11 +65,14 @@ static void dac_recalculate(void) dac_cnt -= PsndLen; dac_info[i] = (pos<<4)|len; } - } else { + } + else + { // stretching dac_cnt = PsndLen; pos=0; - for(i = 225; i != 224; i++) { + for(i = 225; i != 224; i++) + { if (i >= lines) i = 0; len=0; while(dac_cnt >= 0) { @@ -80,6 +93,9 @@ static void dac_recalculate(void) if (PsndLen_exc_add) len++; dac_info[224] = (pos<<4)|len; } + mid = (dac_info[lines-1] & 0xfff0) + ((dac_info[lines-1] & 0xf) << 4); + for (i = lines; i < sizeof(dac_info) / sizeof(dac_info[0]); i++) + dac_info[i] = mid; //for(i=len=0; i < lines; i++) { // printf("%03i : %03i : %i\n", i, dac_info[i]>>4, dac_info[i]&0xf); // len+=dac_info[i]&0xf; @@ -97,7 +113,7 @@ PICO_INTERNAL void PsndReset(void) // also clear the internal registers+addr line ym2612_regs = YM2612GetRegs(); memset(ym2612_regs, 0, 0x200+4); - z80startCycle = z80stopCycle = 0; + timers_reset(); PsndRerate(0); } @@ -110,25 +126,23 @@ void PsndRerate(int preserve_state) int target_fps = Pico.m.pal ? 50 : 60; // not all rates are supported in MCD mode due to mp3 decoder limitations - if (PicoMCD & 1) { + if (PicoAHW & PAHW_MCD) { if (PsndRate != 11025 && PsndRate != 22050 && PsndRate != 44100) PsndRate = 22050; - PicoOpt |= 8; // force stereo + PicoOpt |= POPT_EN_STEREO; // force stereo } if (preserve_state) { state = malloc(0x200); if (state == NULL) return; memcpy(state, YM2612GetRegs(), 0x200); - if ((PicoMCD & 1) && Pico_mcd->m.audio_track) - Pico_mcd->m.audio_offset = mp3_get_offset(); } YM2612Init(Pico.m.pal ? OSC_PAL/7 : OSC_NTSC/7, PsndRate); if (preserve_state) { // feed it back it's own registers, just like after loading state memcpy(YM2612GetRegs(), state, 0x200); - YM2612PicoStateLoad(); - if ((PicoMCD & 1) && Pico_mcd->m.audio_track) - mp3_start_play(Pico_mcd->TOC.Tracks[Pico_mcd->m.audio_track].F, Pico_mcd->m.audio_offset); + ym2612_unpack_state(); + if ((PicoAHW & PAHW_MCD) && !(Pico_mcd->s68k_regs[0x36] & 1) && (Pico_mcd->scd.Status_CDC & 1)) + cdda_start_play(); } if (preserve_state) memcpy(state, sn76496_regs, 28*4); // remember old state @@ -146,56 +160,42 @@ void PsndRerate(int preserve_state) // recalculate dac info dac_recalculate(); - if (PicoMCD & 1) + if (PicoAHW & PAHW_MCD) pcm_set_rate(PsndRate); // clear all buffers memset32(PsndBuffer, 0, sizeof(PsndBuffer)/4); + memset(cdda_out_buffer, 0, sizeof(cdda_out_buffer)); if (PsndOut) PsndClear(); // set mixer - PsndMix_32_to_16l = (PicoOpt & 8) ? mix_32_to_16l_stereo : mix_32_to_16_mono; + PsndMix_32_to_16l = (PicoOpt & POPT_EN_STEREO) ? mix_32_to_16l_stereo : mix_32_to_16_mono; + + if (PicoAHW & PAHW_PICO) + PicoReratePico(); } -// This is called once per raster (aka line), but not necessarily for every line -PICO_INTERNAL void Psnd_timers_and_dac(int raster) +PICO_INTERNAL void PsndDoDAC(int line_to) { - int pos, len; - int do_dac = PsndOut && (PicoOpt&1) && *ym2612_dacen; -// int do_pcm = PsndOut && (PicoMCD&1) && (PicoOpt&0x400); + int pos, pos1, len; + int dout = ym2612.dacout; + int line_from = PsndDacLine; - // Our raster lasts 63.61323/64.102564 microseconds (NTSC/PAL) - YM2612PicoTick(1); + PsndDacLine = line_to + 1; - if (!do_dac /*&& !do_pcm*/) return; - - pos=dac_info[raster], len=pos&0xf; + pos =dac_info[line_from]>>4; + pos1=dac_info[line_to]; + len = ((pos1>>4)-pos) + (pos1&0xf); if (!len) return; - pos>>=4; - - if (do_dac) { + if (PicoOpt & POPT_EN_STEREO) { short *d = PsndOut + pos*2; - int dout = *ym2612_dacout; - if(PicoOpt&8) { - // some manual loop unrolling here :) - d[0] = dout; - if (len > 1) { - d[2] = dout; - if (len > 2) - d[4] = dout; - } - } else { - short *d = PsndOut + pos; - d[0] = dout; - if (len > 1) { - d[1] = dout; - if (len > 2) - d[2] = dout; - } - } + for (; len > 0; len--, d+=2) *d = dout; + } else { + short *d = PsndOut + pos; + for (; len > 0; len--, d++) *d = dout; } #if 0 @@ -207,12 +207,87 @@ PICO_INTERNAL void Psnd_timers_and_dac(int raster) #endif } +// cdda +static pm_file *cdda_stream = NULL; + +static void cdda_raw_update(int *buffer, int length) +{ + int ret, cdda_bytes; + if (cdda_stream == NULL) return; + + cdda_bytes = length*4; + if (PsndRate <= 22050) cdda_bytes *= 2; + if (PsndRate < 22050) cdda_bytes *= 2; + + ret = pm_read(cdda_out_buffer, cdda_bytes, cdda_stream); + if (ret < cdda_bytes) { + memset((char *)cdda_out_buffer + ret, 0, cdda_bytes - ret); + cdda_stream = NULL; + return; + } + + // now mix + switch (PsndRate) { + case 44100: mix_16h_to_32(buffer, cdda_out_buffer, length*2); break; + case 22050: mix_16h_to_32_s1(buffer, cdda_out_buffer, length*2); break; + case 11025: mix_16h_to_32_s2(buffer, cdda_out_buffer, length*2); break; + } +} + +PICO_INTERNAL void cdda_start_play(void) +{ + int lba_offset, index, lba_length, i; + + elprintf(EL_STATUS, "cdda play track #%i", Pico_mcd->scd.Cur_Track); + + index = Pico_mcd->scd.Cur_Track - 1; + + lba_offset = Pico_mcd->scd.Cur_LBA - Track_to_LBA(index + 1); + if (lba_offset < 0) lba_offset = 0; + lba_offset += Pico_mcd->TOC.Tracks[index].Offset; + + // find the actual file for this track + for (i = index; i >= 0; i--) + if (Pico_mcd->TOC.Tracks[i].F != NULL) break; + + if (Pico_mcd->TOC.Tracks[i].F == NULL) { + elprintf(EL_STATUS|EL_ANOMALY, "no track?!"); + return; + } + + if (Pico_mcd->TOC.Tracks[i].ftype == TYPE_MP3) + { + int pos1024 = 0; + + lba_length = Pico_mcd->TOC.Tracks[i].Length; + for (i++; i < Pico_mcd->TOC.Last_Track; i++) { + if (Pico_mcd->TOC.Tracks[i].F != NULL) break; + lba_length += Pico_mcd->TOC.Tracks[i].Length; + } + + if (lba_offset) + pos1024 = lba_offset * 1024 / lba_length; + + mp3_start_play(Pico_mcd->TOC.Tracks[index].F, pos1024); + return; + } + + cdda_stream = Pico_mcd->TOC.Tracks[i].F; + PicoCDBufferFlush(); // buffering relies on fp not being touched + pm_seek(cdda_stream, lba_offset * 2352, SEEK_SET); + if (Pico_mcd->TOC.Tracks[i].ftype == TYPE_WAV) + { + // skip headers, assume it's 44kHz stereo uncompressed + pm_seek(cdda_stream, 44, SEEK_CUR); + } +} + PICO_INTERNAL void PsndClear(void) { int len = PsndLen; if (PsndLen_exc_add) len++; - if (PicoOpt & 8) + if (PicoOpt & POPT_EN_STEREO) memset32((int *) PsndOut, 0, len); // assume PsndOut to be aligned else { short *out = PsndOut; @@ -229,7 +304,8 @@ PICO_INTERNAL int PsndRender(int offset, int length) int *buf32 = PsndBuffer+offset; int stereo = (PicoOpt & 8) >> 3; // emulating CD && PCM option enabled && PCM chip on && have enabled channels - int do_pcm = (PicoMCD&1) && (PicoOpt&0x400) && (Pico_mcd->pcm.control & 0x80) && Pico_mcd->pcm.enabled; + int do_pcm = (PicoAHW & PAHW_MCD) && (PicoOpt&POPT_EN_MCD_PCM) && + (Pico_mcd->pcm.control & 0x80) && Pico_mcd->pcm.enabled; offset <<= stereo; #if !SIMPLE_WRITE_SOUND @@ -244,11 +320,16 @@ PICO_INTERNAL int PsndRender(int offset, int length) #endif // PSG - if (PicoOpt & 2) + if (PicoOpt & POPT_EN_PSG) SN76496Update(PsndOut+offset, length, stereo); + if (PicoAHW & PAHW_PICO) { + PicoPicoPCMUpdate(PsndOut+offset, length, stereo); + return length; + } + // Add in the stereo FM buffer - if (PicoOpt & 1) { + if (PicoOpt & POPT_EN_FM) { buf32_updated = YM2612UpdateOne(buf32, length, stereo, 1); } else memset32(buf32, 0, length<s68k_regs[0x36] & 1) && (Pico_mcd->scd.Status_CDC & 1)) - mp3_update(buf32, length, stereo); + if ((PicoAHW & PAHW_MCD) && (PicoOpt & POPT_EN_MCD_CDDA) && + !(Pico_mcd->s68k_regs[0x36] & 1) && (Pico_mcd->scd.Status_CDC & 1)) + { + // note: only 44, 22 and 11 kHz supported, with forced stereo + int index = Pico_mcd->scd.Cur_Track - 1; + + if (Pico_mcd->TOC.Tracks[index].ftype == TYPE_MP3) + mp3_update(buf32, length, stereo); + else + cdda_raw_update(buf32, length); + } // convert + limit to normal 16bit output PsndMix_32_to_16l(PsndOut+offset, buf32, length); @@ -273,6 +363,9 @@ PICO_INTERNAL int PsndRender(int offset, int length) } +// ----------------------------------------------------------------- +// z80 stuff + #if defined(_USE_MZ80)