pmdwin: fmgen/psg.c annotate

author	Emmanuel Gil Peyrot <linkmauve@linkmauve.fr>
date	Tue, 21 May 2013 10:29:21 +0200
parents
children	8ad174416431

rev	line source
0 c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1 // FIXME: move ugly-ass legalese somewhere where it won't be seen
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	2 // by anyone other than lawyers. (/dev/null would be ideal but sadly
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	3 // we live in an imperfect world).
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	4 /* Copyright (c) 2012/2013, Peter Barfuss
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	5 All rights reserved.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	6
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	7 Redistribution and use in source and binary forms, with or without
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	8 modification, are permitted provided that the following conditions are met:
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	9
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	10 1. Redistributions of source code must retain the above copyright notice, this
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	11 list of conditions and the following disclaimer.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	12 2. Redistributions in binary form must reproduce the above copyright notice,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	13 this list of conditions and the following disclaimer in the documentation
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	14 and/or other materials provided with the distribution.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	15
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	16 THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	17 ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	18 WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	19 DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	20 ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	21 (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	22 LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	23 ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	24 (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	25 SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. */
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	26
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	27 // Quick, somewhat hacky PSG implementation. Seems to work fine in most cases.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	28 // Known bugs: volume may still be off for a lot of samples. Importantly,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	29 // waveform volume is too quiet but setting it at the correct volume makes
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	30 // the noise volume too loud and vice-versa. I think what I have currently
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	31 // is mostly correct (I'm basing this mostly on how good Strawberry Crisis
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	32 // sounds with the given settings), but it's possible that more fine-tuning
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	33 // is needed. Apart from that, this is probably the sketchiest part of all
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	34 // of my emulator code, but then again there's a bit-exact VHDL core of
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	35 // the YM2149F/AY-3-8910, so while I do want to make this as good
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	36 // as the code in opna.c, it's the lowest-priority of all of the code here.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	37 // --bofh
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	38 #include <stdint.h>
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	39 #include <stdlib.h>
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	40 #include <string.h>
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	41 #include <math.h>
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	42 #include <unistd.h>
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	43 #include "op.h"
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	44 #include "psg.h"
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	45 #define Max(a,b) ((a>b)?a:b)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	46 #define Min(a,b) ((a<b)?a:b)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	47
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	48 // ---------------------------------------------------------------------------
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	49 // �ơ��֥�
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	50 //
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	51 int EmitTable[0x20] = { -1, };
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	52 uint enveloptable[16][64] = { 0, };
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	53
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	54 // ---------------------------------------------------------------------------
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	55 // PSG reset to power-on defaults
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	56 //
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	57 void PSGReset(PSG *psg)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	58 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	59 int i;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	60 for (i=0; i<14; i++)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	61 PSGSetReg(psg, i, 0);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	62 PSGSetReg(psg, 7, 0xff);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	63 PSGSetReg(psg, 14, 0xff);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	64 PSGSetReg(psg, 15, 0xff);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	65 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	66
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	67 // ---------------------------------------------------------------------------
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	68 // This code is strongly inspired by some random PSG emulator code I found,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	69 // and is probably not the optimal way to define periods. It is at least
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	70 // among the fastest, given that it uses the hilarious hack of using the
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	71 // integer overflow on a 32-bit unsigned integer to compute ""moduli"".
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	72 //
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	73 void PSGSetClock(PSG *psg, uint32_t clock, uint32_t rate)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	74 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	75 psg->tperiodbase = (uint32_t)((1 << toneshift ) / 4.0f * clock / rate);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	76 psg->eperiodbase = (uint32_t)((1 << envshift ) / 4.0f * clock / rate);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	77
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	78 // �ƥǡ��ι��
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	79 int tmp;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	80 tmp = ((psg->reg[0] + psg->reg[1] * 256) & 0xfff);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	81 psg->speriod[0] = tmp ? psg->tperiodbase / tmp : psg->tperiodbase;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	82 tmp = ((psg->reg[2] + psg->reg[3] * 256) & 0xfff);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	83 psg->speriod[1] = tmp ? psg->tperiodbase / tmp : psg->tperiodbase;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	84 tmp = ((psg->reg[4] + psg->reg[5] * 256) & 0xfff);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	85 psg->speriod[2] = tmp ? psg->tperiodbase / tmp : psg->tperiodbase;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	86 tmp = psg->reg[6] & 0x1f;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	87 psg->nperiod = tmp;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	88 tmp = ((psg->reg[11] + psg->reg[12] * 256) & 0xffff);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	89 psg->eperiod = tmp ? psg->eperiodbase / tmp : psg->eperiodbase * 2;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	90 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	91
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	92 // ---------------------------------------------------------------------------
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	93 // ��٥��ȷ��ơ��֥�
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	94 //
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	95 static uint8_t table3[4] = { 0, 1, -1, 0 };
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	96 void MakeEnvelopTable(void)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	97 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	98 // 0 lo 1 up 2 down 3 hi
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	99 static uint8_t table1[16*2] =
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	100 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	101 2,0, 2,0, 2,0, 2,0, 1,0, 1,0, 1,0, 1,0,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	102 2,2, 2,0, 2,1, 2,3, 1,1, 1,3, 1,2, 1,0,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	103 };
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	104 int i, j;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	105
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	106 if (!enveloptable[0][0])
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	107 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	108 uint* ptr = enveloptable[0];
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	109
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	110 for (i=0; i<16*2; i++)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	111 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	112 uint8_t v = ((table1[i] & 0x2) ? 31 : 0);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	113
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	114 for (j=0; j<32; j++)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	115 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	116 *ptr++ = EmitTable[v];
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	117 v += table3[table1[i]];
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	118 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	119 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	120 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	121 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	122
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	123 // ---------------------------------------------------------------------------
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	124 // Sets the channel output mask for the PSG device.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	125 // c is a bitvector where the 3 LSBs are set to 0 to disable a given
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	126 // PSG channel and 1 to enable it.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	127 // TODO: Possibly allow enabling tone/noise output for each channel independently?
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	128 //
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	129 void PSGSetChannelMask(PSG *psg, int c)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	130 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	131 int i;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	132 psg->mask = c;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	133 for (i=0; i<3; i++)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	134 psg->olevel[i] = psg->mask & (1 << i) ? EmitTable[(psg->reg[8+i] & 15) * 2 + 1] : 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	135 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	136
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	137 // ---------------------------------------------------------------------------
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	138 // Sets the PSG volume. It's a fairly standard dB -> internal linear scale
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	139 // conversion, followed by generating a table with volume levels.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	140 // The "magic number" 1.189207115 is just sqrt(sqrt(2))
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	141 // TODO: is this table really needed? We have fast floating-point now.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	142 //
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	143 void SetVolumePSG(PSG *psg, int volume)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	144 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	145 int i;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	146 float base = 0x4000 / 3.0f * expf((float)M_LN10*(volume / 40.0f));
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	147 for (i=31; i>=2; i--)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	148 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	149 EmitTable[i] = lrintf(base);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	150 base /= 1.189207115f;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	151 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	152 EmitTable[1] = 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	153 EmitTable[0] = 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	154 MakeEnvelopTable();
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	155
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	156 PSGSetChannelMask(psg, psg->mask);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	157 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	158
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	159 // ---------------------------------------------------------------------------
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	160 // PSG register set routine. Mostly just what you'd expect from reading the manual.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	161 // Fairly boring code overall. regnum can be 0 - 15, data can be 0x00 - 0xFF.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	162 // (This should not be surprising - the YM2149F did use an 8-bit bus, after all).
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	163 // Interesting quirk: the task of register 7 (channel enable/disable) is basically
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	164 // entirely duplicated by other registers, to the point where you can basically
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	165 // just ignore any writes to register 7 entirely. I save it here in case some
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	166 // braindead routine wants to read its value and do something based on that
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	167 // (Another curiosity: register 7 on the PSG appears to be the only register
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	168 // between both the OPNA and the PSG which is actually read from by
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	169 // pmdwin.cpp and not just written to. Amusingly enough, the only reason
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	170 // that it is ever read is so that it can then OR something with what it just read
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	171 // and then write that back to register 7. Hilarity).
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	172 // HACK ALERT: The output levels for channels 0 and 1 are increased by a factor of 4
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	173 // to make them match the actual chip in loudness, but without causing the noise channel
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	174 // to overtake everything in intensity. This is almost certainly wrong, and moreover
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	175 // it assumes that channel 2 will be playing back Speak Board effects which usually means
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	176 // drum kit only (for the most part, at least), and not being used as a separate tonal
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	177 // channel in its own right. To the best of my knowledge, this does hold for all of ZUN's
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	178 // songs, however, once you step outside that set of music, it's trivial to find
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	179 // all sorts of counterexamples to that assumption. Therefore, this should be fixed ASAP.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	180 //
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	181 void PSGSetReg(PSG *psg, uint8_t regnum, uint8_t data)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	182 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	183 if (regnum < 0x10)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	184 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	185 psg->reg[regnum] = data;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	186 switch (regnum)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	187 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	188 int tmp;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	189
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	190 case 0: // ChA Fine Tune
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	191 case 1: // ChA Coarse Tune
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	192 tmp = ((psg->reg[0] + psg->reg[1] * 256) & 0xfff);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	193 psg->speriod[0] = tmp ? psg->tperiodbase / tmp : psg->tperiodbase;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	194 break;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	195
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	196 case 2: // ChB Fine Tune
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	197 case 3: // ChB Coarse Tune
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	198 tmp = ((psg->reg[2] + psg->reg[3] * 256) & 0xfff);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	199 psg->speriod[1] = tmp ? psg->tperiodbase / tmp : psg->tperiodbase;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	200 break;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	201
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	202 case 4: // ChC Fine Tune
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	203 case 5: // ChC Coarse Tune
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	204 tmp = ((psg->reg[4] + psg->reg[5] * 256) & 0xfff);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	205 psg->speriod[2] = tmp ? psg->tperiodbase / tmp : psg->tperiodbase;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	206 break;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	207
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	208 case 6: // Noise generator control
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	209 data &= 0x1f;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	210 psg->nperiod = data;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	211 break;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	212
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	213 case 8:
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	214 psg->olevel[0] = psg->mask & 1 ? EmitTable[(data & 15) * 2 + 1] : 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	215 break;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	216
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	217 case 9:
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	218 psg->olevel[1] = psg->mask & 2 ? EmitTable[(data & 15) * 2 + 1] : 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	219 break;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	220
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	221 case 10:
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	222 psg->olevel[2] = psg->mask & 4 ? EmitTable[(data & 15) * 2 + 1] : 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	223 break;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	224
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	225 case 11: // Envelope period
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	226 case 12:
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	227 tmp = ((psg->reg[11] + psg->reg[12] * 256) & 0xffff);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	228 psg->eperiod = tmp ? psg->eperiodbase / tmp : psg->eperiodbase * 2;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	229 break;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	230
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	231 case 13: // Envelope shape
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	232 psg->ecount = 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	233 psg->envelop = enveloptable[data & 15];
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	234 break;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	235 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	236 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	237 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	238
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	239 // ---------------------------------------------------------------------------
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	240 // Init code. Set volume to 0, reset the chip, enable all channels, seed the RNG.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	241 // RNG seed lifted from MAME's YM2149F emulation routine, appears to be correct.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	242 //
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	243 void PSGInit(PSG *psg)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	244 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	245 SetVolumePSG(psg, 0);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	246 psg->rng = 14231;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	247 psg->ncount = 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	248 PSGReset(psg);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	249 psg->mask = 0x3f;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	250 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	251
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	252 // ---------------------------------------------------------------------------
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	253 // The main output routine for the PSG emulation.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	254 // dest should be an array of size nsamples, and of type Sample
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	255 // (one of int16_t, int32_t or float - any will work here without causing
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	256 // clipping/precision problems).
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	257 // Everything is implemented using some form of fixed-point arithmetic
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	258 // that currently needs no more than 32-bits for its implementation,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	259 // but I'm pretty certain that you can get by with much less than that
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	260 // and still have mostly correct-to-fully-correct emulation.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	261 //
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	262 // TODO: In the future, test the veracity of the above statement. Moreover,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	263 // if it turns out to be correct, rewrite this routine to not use more than
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	264 // the required precision. This is irrelevant for any PC newer than, well,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	265 // a 386DX/68040, but important for efficient hardware implementation.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	266 //
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	267 void PSGMix(PSG psg, Sample dest, uint32_t nsamples)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	268 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	269 uint8_t chenable[3];
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	270 uint8_t r7 = ~psg->reg[7];
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	271 int i;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	272
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	273 if ((r7 & 0x3f) \| ((psg->reg[8] \| psg->reg[9] \| psg->reg[10]) & 0x1f)) {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	274 chenable[0] = (r7 & 0x01) && (psg->speriod[0] <= (1 << toneshift));
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	275 chenable[1] = (r7 & 0x02) && (psg->speriod[1] <= (1 << toneshift));
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	276 chenable[2] = (r7 & 0x04) && (psg->speriod[2] <= (1 << toneshift));
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	277
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	278 int noise, sample;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	279 uint env;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	280 uint* p1 = ((psg->mask & 1) && (psg->reg[ 8] & 0x10)) ? &env : &psg->olevel[0];
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	281 uint* p2 = ((psg->mask & 2) && (psg->reg[ 9] & 0x10)) ? &env : &psg->olevel[1];
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	282 uint* p3 = ((psg->mask & 4) && (psg->reg[10] & 0x10)) ? &env : &psg->olevel[2];
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	283 #define SCOUNT(ch) (psg->scount[ch] >> toneshift)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	284
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	285 if (p1 != &env && p2 != &env && p3 != &env) {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	286 // �Υ��ͭ��
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	287 for (i=0; i<nsamples; i++) {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	288 psg->ncount++;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	289 if(psg->ncount >= psg->nperiod) {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	290 if(psg->rng & 1)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	291 psg->rng ^= 0x24000;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	292 psg->rng >>= 1;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	293 psg->ncount = 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	294 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	295 noise = (psg->rng & 1);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	296 sample = 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	297 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	298 int x, y, z;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	299 x = ((SCOUNT(0) & chenable[0]) \| ((r7 >> 3) & noise)) - 1; // 0 or -1
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	300 sample += (psg->olevel[0] + x) ^ x;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	301 psg->scount[0] += psg->speriod[0];
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	302 y = ((SCOUNT(1) & chenable[1]) \| ((r7 >> 4) & noise)) - 1;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	303 sample += (psg->olevel[1] + y) ^ y;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	304 psg->scount[1] += psg->speriod[1];
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	305 z = ((SCOUNT(2) & chenable[2]) \| ((r7 >> 5) & noise)) - 1;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	306 sample += (psg->olevel[2] + z) ^ z;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	307 psg->scount[2] += psg->speriod[2];
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	308 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	309 dest[0] += sample;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	310 dest += 1;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	311 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	312
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	313 // ��٥��פη׻��򤵤ܤä�Ģ��碌
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	314 psg->ecount = (psg->ecount >> 8) + (psg->eperiod >> 8) * nsamples;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	315 if (psg->ecount >= (1 << (envshift+6-8))) {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	316 if ((psg->reg[0x0d] & 0x0b) != 0x0a)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	317 psg->ecount \|= (1 << (envshift+5-8));
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	318 psg->ecount &= (1 << (envshift+6-8)) - 1;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	319 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	320 psg->ecount <<= 8;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	321 } else {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	322 // ��٥��פ��
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	323 for (i=0; i<nsamples; i++) {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	324 psg->ncount++;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	325 if(psg->ncount >= psg->nperiod) {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	326 if(psg->rng & 1)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	327 psg->rng ^= 0x24000;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	328 psg->rng >>= 1;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	329 psg->ncount = 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	330 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	331 noise = (psg->rng & 1);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	332 sample = 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	333 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	334 env = psg->envelop[psg->ecount >> envshift];
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	335 psg->ecount += psg->eperiod;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	336 if (psg->ecount >= (1 << (envshift+6))) {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	337 if ((psg->reg[0x0d] & 0x0b) != 0x0a)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	338 psg->ecount \|= (1 << (envshift+5));
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	339 psg->ecount &= (1 << (envshift+6)) - 1;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	340 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	341 int x, y, z;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	342 x = ((SCOUNT(0) & chenable[0]) \| ((r7 >> 3) & noise)) - 1; // 0 or -1
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	343 sample += (*p1 + x) ^ x;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	344 psg->scount[0] += psg->speriod[0];
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	345 y = ((SCOUNT(1) & chenable[1]) \| ((r7 >> 4) & noise)) - 1;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	346 sample += (*p2 + y) ^ y;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	347 psg->scount[1] += psg->speriod[1];
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	348 z = ((SCOUNT(2) & chenable[2]) \| ((r7 >> 5) & noise)) - 1;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	349 sample += (*p3 + z) ^ z;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	350 psg->scount[2] += psg->speriod[2];
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	351 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	352 dest[0] += sample;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	353 dest += 1;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	354 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	355 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	356 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	357 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	358

0

c55ea9478c80 Hello Gensokyo!