pmdwin: fmgen/opna.c annotate

annotate fmgen/opna.c @ 4:c8875256b767

Use stdio for console output, update usage, and use sensible exit values.

author	Emmanuel Gil Peyrot <linkmauve@linkmauve.fr>
date	Tue, 21 May 2013 12:10:27 +0200
parents	c55ea9478c80
children

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 #include <stdint.h>
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	28 #include <math.h>
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	29 #include <unistd.h>
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	30 #include "op.h"
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	31 #include "psg.h"
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	32 #include "opna.h"
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	33 static const uint8_t notetab[128] =
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	34 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	35 0, 0, 0, 0, 0, 0, 0, 1, 2, 3, 3, 3, 3, 3, 3, 3,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	36 4, 4, 4, 4, 4, 4, 4, 5, 6, 7, 7, 7, 7, 7, 7, 7,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	37 8, 8, 8, 8, 8, 8, 8, 9, 10, 11, 11, 11, 11, 11, 11, 11,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	38 12, 12, 12, 12, 12, 12, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	39 16, 16, 16, 16, 16, 16, 16, 17, 18, 19, 19, 19, 19, 19, 19, 19,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	40 20, 20, 20, 20, 20, 20, 20, 21, 22, 23, 23, 23, 23, 23, 23, 23,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	41 24, 24, 24, 24, 24, 24, 24, 25, 26, 27, 27, 27, 27, 27, 27, 27,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	42 28, 28, 28, 28, 28, 28, 28, 29, 30, 31, 31, 31, 31, 31, 31, 31,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	43 };
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	44
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	45 static const int8_t dttab[256] =
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	46 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	47 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	48 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	49 0, 0, 0, 0, 2, 2, 2, 2, 2, 2, 2, 2, 4, 4, 4, 4,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	50 4, 6, 6, 6, 8, 8, 8, 10, 10, 12, 12, 14, 16, 16, 16, 16,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	51 2, 2, 2, 2, 4, 4, 4, 4, 4, 6, 6, 6, 8, 8, 8, 10,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	52 10, 12, 12, 14, 16, 16, 18, 20, 22, 24, 26, 28, 32, 32, 32, 32,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	53 4, 4, 4, 4, 4, 6, 6, 6, 8, 8, 8, 10, 10, 12, 12, 14,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	54 16, 16, 18, 20, 22, 24, 26, 28, 32, 34, 38, 40, 44, 44, 44, 44,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	55 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	56 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	57 0, 0, 0, 0, -2, -2, -2, -2, -2, -2, -2, -2, -4, -4, -4, -4,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	58 -4, -6, -6, -6, -8, -8, -8,-10,-10,-12,-12,-14,-16,-16,-16,-16,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	59 -2, -2, -2, -2, -4, -4, -4, -4, -4, -6, -6, -6, -8, -8, -8,-10,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	60 -10,-12,-12,-14,-16,-16,-18,-20,-22,-24,-26,-28,-32,-32,-32,-32,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	61 -4, -4, -4, -4, -4, -6, -6, -6, -8, -8, -8,-10,-10,-12,-12,-14,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	62 -16,-16,-18,-20,-22,-24,-26,-28,-32,-34,-38,-40,-44,-44,-44,-44,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	63 };
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	64
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	65 static uint8_t gaintab[64] = {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	66 0xff, 0xea, 0xd7, 0xc5, 0xb5, 0xa6, 0x98, 0x8b, 0x80, 0x75, 0x6c, 0x63, 0x5a, 0x53, 0x4c, 0x46,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	67 0x40, 0x3b, 0x36, 0x31, 0x2d, 0x2a, 0x26, 0x23, 0x20, 0x1d, 0x1b, 0x19, 0x17, 0x15, 0x13, 0x12,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	68 0x10, 0x0f, 0x0e, 0x0c, 0x0b, 0x0a, 0x0a, 0x09, 0x08, 0x07, 0x07, 0x06, 0x06, 0x05, 0x05, 0x04,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	69 0x04, 0x04, 0x03, 0x03, 0x03, 0x03, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x01, 0x01, 0x01, 0x01,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	70 };
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	71
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	72 // sinf(M_PI(2i+1)/1024.0f), i=0,...,511.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	73 // Should make this twice as large (so a duplicate of the top 512, but with the other half of the
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	74 // interval [0,2*M_PI], therefore the negative of the first half), and then get rid of the
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	75 // silly hack in Sinetable(). However, I'm not actually sure which will use less gates on an FPGA,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	76 // and there's really no speed difference on any machine newer than a 6502, probably.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	77 static uint16_t sinetable[512] = {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	78 0x1, 0x2, 0x4, 0x5, 0x7, 0x9, 0xa, 0xc, 0xd, 0xf, 0x10, 0x12, 0x14, 0x15, 0x17, 0x18,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	79 0x1a, 0x1b, 0x1d, 0x1f, 0x20, 0x22, 0x23, 0x25, 0x26, 0x28, 0x29, 0x2b, 0x2d, 0x2e, 0x30, 0x31,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	80 0x33, 0x34, 0x36, 0x37, 0x39, 0x3a, 0x3c, 0x3d, 0x3f, 0x40, 0x42, 0x44, 0x45, 0x47, 0x48, 0x4a,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	81 0x4b, 0x4d, 0x4e, 0x50, 0x51, 0x53, 0x54, 0x56, 0x57, 0x58, 0x5a, 0x5b, 0x5d, 0x5e, 0x60, 0x61,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	82 0x63, 0x64, 0x66, 0x67, 0x68, 0x6a, 0x6b, 0x6d, 0x6e, 0x70, 0x71, 0x72, 0x74, 0x75, 0x77, 0x78,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	83 0x79, 0x7b, 0x7c, 0x7d, 0x7f, 0x80, 0x82, 0x83, 0x84, 0x86, 0x87, 0x88, 0x8a, 0x8b, 0x8c, 0x8e,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	84 0x8f, 0x90, 0x91, 0x93, 0x94, 0x95, 0x97, 0x98, 0x99, 0x9a, 0x9c, 0x9d, 0x9e, 0x9f, 0xa1, 0xa2,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	85 0xa3, 0xa4, 0xa5, 0xa7, 0xa8, 0xa9, 0xaa, 0xab, 0xad, 0xae, 0xaf, 0xb0, 0xb1, 0xb2, 0xb3, 0xb4,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	86 0xb6, 0xb7, 0xb8, 0xb9, 0xba, 0xbb, 0xbc, 0xbd, 0xbe, 0xbf, 0xc0, 0xc1, 0xc2, 0xc3, 0xc4, 0xc5,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	87 0xc6, 0xc7, 0xc8, 0xc9, 0xca, 0xcb, 0xcc, 0xcd, 0xce, 0xcf, 0xd0, 0xd1, 0xd2, 0xd3, 0xd4, 0xd4,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	88 0xd5, 0xd6, 0xd7, 0xd8, 0xd9, 0xda, 0xda, 0xdb, 0xdc, 0xdd, 0xde, 0xde, 0xdf, 0xe0, 0xe1, 0xe1,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	89 0xe2, 0xe3, 0xe4, 0xe4, 0xe5, 0xe6, 0xe6, 0xe7, 0xe8, 0xe8, 0xe9, 0xea, 0xea, 0xeb, 0xec, 0xec,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	90 0xed, 0xed, 0xee, 0xef, 0xef, 0xf0, 0xf0, 0xf1, 0xf1, 0xf2, 0xf2, 0xf3, 0xf3, 0xf4, 0xf4, 0xf5,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	91 0xf5, 0xf6, 0xf6, 0xf7, 0xf7, 0xf7, 0xf8, 0xf8, 0xf9, 0xf9, 0xf9, 0xfa, 0xfa, 0xfa, 0xfb, 0xfb,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	92 0xfb, 0xfc, 0xfc, 0xfc, 0xfc, 0xfd, 0xfd, 0xfd, 0xfd, 0xfe, 0xfe, 0xfe, 0xfe, 0xfe, 0xff, 0xff,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	93 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0x100, 0x100, 0x100, 0x100, 0x100, 0x100, 0x100, 0x100, 0x100, 0x100,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	94 0x100, 0x100, 0x100, 0x100, 0x100, 0x100, 0x100, 0x100, 0x100, 0x100, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	95 0xff, 0xff, 0xfe, 0xfe, 0xfe, 0xfe, 0xfe, 0xfd, 0xfd, 0xfd, 0xfd, 0xfc, 0xfc, 0xfc, 0xfc, 0xfb,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	96 0xfb, 0xfb, 0xfa, 0xfa, 0xfa, 0xf9, 0xf9, 0xf9, 0xf8, 0xf8, 0xf7, 0xf7, 0xf7, 0xf6, 0xf6, 0xf5,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	97 0xf5, 0xf4, 0xf4, 0xf3, 0xf3, 0xf2, 0xf2, 0xf1, 0xf1, 0xf0, 0xf0, 0xef, 0xef, 0xee, 0xed, 0xed,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	98 0xec, 0xec, 0xeb, 0xea, 0xea, 0xe9, 0xe8, 0xe8, 0xe7, 0xe6, 0xe6, 0xe5, 0xe4, 0xe4, 0xe3, 0xe2,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	99 0xe1, 0xe1, 0xe0, 0xdf, 0xde, 0xde, 0xdd, 0xdc, 0xdb, 0xda, 0xda, 0xd9, 0xd8, 0xd7, 0xd6, 0xd5,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	100 0xd4, 0xd4, 0xd3, 0xd2, 0xd1, 0xd0, 0xcf, 0xce, 0xcd, 0xcc, 0xcb, 0xca, 0xc9, 0xc8, 0xc7, 0xc6,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	101 0xc5, 0xc4, 0xc3, 0xc2, 0xc1, 0xc0, 0xbf, 0xbe, 0xbd, 0xbc, 0xbb, 0xba, 0xb9, 0xb8, 0xb7, 0xb6,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	102 0xb4, 0xb3, 0xb2, 0xb1, 0xb0, 0xaf, 0xae, 0xad, 0xab, 0xaa, 0xa9, 0xa8, 0xa7, 0xa5, 0xa4, 0xa3,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	103 0xa2, 0xa1, 0x9f, 0x9e, 0x9d, 0x9c, 0x9a, 0x99, 0x98, 0x97, 0x95, 0x94, 0x93, 0x91, 0x90, 0x8f,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	104 0x8e, 0x8c, 0x8b, 0x8a, 0x88, 0x87, 0x86, 0x84, 0x83, 0x82, 0x80, 0x7f, 0x7d, 0x7c, 0x7b, 0x79,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	105 0x78, 0x77, 0x75, 0x74, 0x72, 0x71, 0x70, 0x6e, 0x6d, 0x6b, 0x6a, 0x68, 0x67, 0x66, 0x64, 0x63,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	106 0x61, 0x60, 0x5e, 0x5d, 0x5b, 0x5a, 0x58, 0x57, 0x56, 0x54, 0x53, 0x51, 0x50, 0x4e, 0x4d, 0x4b,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	107 0x4a, 0x48, 0x47, 0x45, 0x44, 0x42, 0x40, 0x3f, 0x3d, 0x3c, 0x3a, 0x39, 0x37, 0x36, 0x34, 0x33,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	108 0x31, 0x30, 0x2e, 0x2d, 0x2b, 0x29, 0x28, 0x26, 0x25, 0x23, 0x22, 0x20, 0x1f, 0x1d, 0x1b, 0x1a,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	109 0x18, 0x17, 0x15, 0x14, 0x12, 0x10, 0xf, 0xd, 0xc, 0xa, 0x9, 0x7, 0x6, 0x4, 0x2, 0x1,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	110 };
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 static uint8_t tablemade = false;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	113 static uint8_t cltab[512];
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	114 static uint32_t tltab[FM_TLENTS];
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	115 static uint32_t lfotab[8];
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	116 static const uint8_t fbtab[8] = { 31, 7, 6, 5, 4, 3, 2, 1 };
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	117
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	118 /* Amplitude/Phase modulation tables. */
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	119 static const float pms[8] = { 0, 1/720., 2/720., 3/720., 4/720., 6/720., 12/720., 24/720. }; // OPNA
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	120 static const uint8_t amt[4] = { 29, 4, 2, 1 }; // OPNA
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	121 static int pmtable[8][FM_LFOENTS];
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	122 uint8_t aml, pml;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	123 int pmv;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	124
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	125 // ---------------------------------------------------------------------------
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	126 static inline void LFO(OPNA *opna)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	127 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	128 uint8_t c = (opna->lfocount >> FM_LFOCBITS) & 0xff;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	129 opna->lfocount += opna->lfodcount;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	130 if (c < 0x40) pml = c * 2 + 0x80;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	131 else if (c < 0xc0) pml = 0x7f - (c - 0x40) * 2 + 0x80;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	132 else pml = (c - 0xc0) * 2;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	133 if (c < 0x80) aml = (c << 1);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	134 else aml = ~(c << 1);
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 // Magic. No, really.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	139 // In reality this just initialises some tables used by everything else,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	140 // that are dependent on both the chip clock and the "DAC" samplerate.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	141 // The hilarious thing though is that this is really the only place where
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	142 // the chip clock value gets actually used, and even then it's indirectly
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	143 // via the ratio parameter.
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 static uint32_t currentratio = ~0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	146 static float rr;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	147 static uint32_t ratetable[64];
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	148 static void MakeTimeTable(uint32_t ratio)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	149 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	150 int h, l;
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 if (ratio != currentratio)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	153 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	154 currentratio = ratio;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	155 // PG Part
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	156 rr = (float)ratio / (1 << (2 + FM_RATIOBITS - FM_PGBITS));
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 // EG
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	159 for (h=1; h<16; h++)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	160 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	161 for (l=0; l<4; l++)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	162 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	163 int m = h == 15 ? 8 : l+4;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	164 ratetable[h*4+l] =
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	165 ((ratio << (FM_EGBITS - 3 - FM_RATIOBITS)) << Min(h, 11)) * m;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	166 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	167 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	168 ratetable[0] = ratetable[1] = ratetable[2] = ratetable[3] = 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	169 ratetable[5] = ratetable[4], ratetable[7] = ratetable[6];
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	170 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	171 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	172
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	173 static void SetEGRate(FMOperator *op, uint r)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	174 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	175 op->egstepd = ratetable[r];
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	176 op->egtransa = Limit(15 - (r>>2), 4, 1);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	177 op->egtransd = 16 >> op->egtransa;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	178 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	179
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	180 // Standard operator init routine. Zeros out some more stuff
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	181 // than OperatorReset() does, then calls OperatorReset().
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 void OperatorInit(FMOperator *op)
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 // EG Part
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	186 op->ar = op->dr = op->sr = op->rr = op->ksr = 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	187 op->ams = 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	188 op->mute = false;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	189 op->keyon = false;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	190
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	191 // PG Part
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	192 op->multiple = 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	193 op->detune = 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	194
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	195 // LFO
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	196 op->ms = 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	197
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	198 OperatorReset(op);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	199 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	200
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	201 // Standard operator reset routine. Init EG/PG to defaults,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	202 // clear any stored samples, then force a reinit of EG/PG
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	203 // in OperatorPrepare() below by setting paramchanged to 1.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	204 //
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	205 void OperatorReset(FMOperator *op)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	206 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	207 // EG part
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	208 op->tl = op->tll = 127;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	209 op->eglevel = 0xff;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	210 op->eglvnext = 0x100;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	211 SetEGRate(op, 0);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	212 op->phase = off;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	213 op->egstep = 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	214
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	215 // PG part
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	216 op->pgcount = 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	217
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	218 // OP part
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	219 op->out = op->out2 = 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	220 op->paramchanged = true;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	221 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	222
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	223 // Init EG, PG.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	224 // PG init is trivial, simply set pgdcount (phase counter increment)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	225 // based on multiple, detune and bn.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	226 // See Pages 24-26 of the OPNA manual for details.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	227 // EG init is your standard ADSR state machine. Should (hopefully!)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	228 // be self-explanatory, especially if you've ever seen a software implementation
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	229 // of ADSR before (seriously, they're all the damn same).
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 void OperatorPrepare(FMOperator *op)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	232 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	233 if (op->paramchanged)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	234 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	235 uint8_t l = ((op->multiple) ? 2*op->multiple : 1);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	236 op->paramchanged = false;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	237 // PG Part
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	238 op->pgdcount = (op->dp + dttab[op->detune + op->bn]) * (uint32_t)(l * rr);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	239 op->pgdcountl = op->pgdcount >> 11;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	240
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	241 // EG Part
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	242 op->ksr = op->bn >> (3-op->ks);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	243
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	244 switch (op->phase)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	245 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	246 case attack:
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	247 SetEGRate(op, op->ar ? Min(63, op->ar+op->ksr) : 0);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	248 break;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	249 case decay:
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	250 SetEGRate(op, op->dr ? Min(63, op->dr+op->ksr) : 0);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	251 op->eglvnext = op->sl * 8;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	252 break;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	253 case sustain:
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	254 SetEGRate(op, op->sr ? Min(63, op->sr+op->ksr) : 0);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	255 break;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	256 case release:
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	257 SetEGRate(op, Min(63, op->rr+op->ksr));
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	258 break;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	259 case next: // temporal
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	260 break;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	261 case off: // temporal
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	262 break;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	263 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	264 // LFO
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	265 op->ams = (op->amon ? (op->ms >> 4) & 3 : 0);
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 }
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 // FIXME: Rename. "Phase" here refers to ADSR DFA state,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	270 // not PG/sine table phase. Also, yeah, this does the
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	271 // ADSR DFA state transitions.
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 static void ShiftPhase(FMOperator *op, EGPhase nextphase)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	274 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	275 switch (nextphase)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	276 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	277 case attack: // Attack Phase
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	278 op->tl = op->tll;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	279 if ((op->ar+op->ksr) < 62) {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	280 SetEGRate(op, op->ar ? Min(63, op->ar+op->ksr) : 0);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	281 op->phase = attack;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	282 break;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	283 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	284 case decay: // Decay Phase
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	285 if (op->sl) {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	286 op->eglevel = 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	287 op->eglvnext = op->sl*8;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	288 SetEGRate(op, op->dr ? Min(63, op->dr+op->ksr) : 0);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	289 op->phase = decay;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	290 break;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	291 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	292 case sustain: // Sustain Phase
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	293 op->eglevel = op->sl*8;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	294 op->eglvnext = 0x100;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	295 SetEGRate(op, op->sr ? Min(63, op->sr+op->ksr) : 0);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	296 op->phase = sustain;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	297 break;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	298
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	299 case release: // Release Phase
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	300 if (op->phase == attack \|\| (op->eglevel < 0x100/* && phase != off*/)) {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	301 op->eglvnext = 0x100;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	302 SetEGRate(op, Min(63, op->rr+op->ksr));
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	303 op->phase = release;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	304 break;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	305 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	306 case off: // off
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	307 default:
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	308 op->eglevel = 0xff;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	309 op->eglvnext = 0x100;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	310 SetEGRate(op, 0);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	311 op->phase = off;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	312 break;
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 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	315
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	316 // Block/F-Num
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	317 static inline void SetFNum(FMOperator *op, uint f)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	318 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	319 op->dp = (f & 2047) << ((f >> 11) & 7);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	320 op->bn = notetab[(f >> 7) & 127];
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	321 op->paramchanged = true;
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
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	324 // Clock the EG for one operator.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	325 // Essentially just a call to ShiftPhase,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	326 // but decrements the output EG level if starting
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	327 // from the attack phase, otherwise incrementing it.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	328 // Should probably integrate the special case for attack
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	329 // from ShiftPhase() directly into here at some point.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	330 void EGCalc(FMOperator *op)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	331 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	332 op->egstep += 3L << (11 + FM_EGBITS);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	333 if (op->phase == attack)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	334 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	335 op->eglevel -= 1 + (op->eglevel >> op->egtransa);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	336 if (op->eglevel <= 0)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	337 ShiftPhase(op, decay);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	338 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	339 else
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 op->eglevel += op->egtransd;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	342 if (op->eglevel >= op->eglvnext)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	343 ShiftPhase(op, (EGPhase)(op->phase+1));
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	344 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	345 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	346
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	347 // KeyOn, hopefully obvious.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	348 static void KeyOn(FMOperator *op)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	349 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	350 if (!op->keyon) {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	351 op->keyon = true;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	352 if (op->phase == off \|\| op->phase == release) {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	353 ShiftPhase(op, attack);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	354 op->out = op->out2 = 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	355 op->pgcount = 0;
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 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	359
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	360 // KeyOff, hopefully obvious.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	361 static void KeyOff(FMOperator *op)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	362 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	363 if (op->keyon) {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	364 op->keyon = false;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	365 ShiftPhase(op, release);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	366 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	367 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	368
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	369 // PG uses 9 bits, with the table itsself using another 10 bits.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	370 // The top bits are the actually relevant ones, given that the PG increment will basically set
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	371 // the lowest few bits to nonsense.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	372 // The hack there that checks for bit 10 in the right place and if yes, does some strange xor magic
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	373 // makes the value of Sine() negative if we're in the top half of the [0,2*M_PI] interval.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	374 // It is, of course, one/two's complement specific, but I have yet to hear of an integer arithmetic implementation
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	375 // on any modern machine that isn't at least one of those two. (In fact, I think they're all two's complement, even).
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	376 #define Sine(s) sinetable[((s) >> (20+FM_PGBITS-FM_OPSINBITS))&(FM_OPSINENTS/2-1)]^(-(((s) & 0x10000000) >> 27))
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	377 //#define LogToLin(x) cltab[x]
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	378
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	379 static inline uint32_t LogToLin(uint32_t x) {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	380 if(x >= 1024) {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	381 return 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	382 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	383 return cltab[x];
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	384 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	385
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	386 // PG clock routine.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	387 // Does this really need to be in its own function anymore?
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	388 // It's literally just a trivial increment of a counter now, nothing more.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	389 // Its output, btw, is 2^(20+PGBITS) / cycle, with PGBITS=9 in this implementation.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	390 static inline uint32_t PGCalc(FMOperator *op)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	391 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	392 uint32_t ret = op->pgcount;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	393 op->pgcount += op->pgdcount;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	394 return ret;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	395 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	396
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	397 // Same as above, but with PM if enabled.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	398 // Same comments as above apply.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	399 static inline uint32_t PGCalcL(FMOperator *op)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	400 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	401 uint32_t ret = op->pgcount;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	402 op->pgcount += op->pgdcount + ((op->pgdcountl * pmv) >> 5);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	403 return ret;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	404 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	405
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	406 // Clock one FM operator. Does a lookup in the sine table
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	407 // for the waveform to output, possibly frequency-modulating
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	408 // that with the contents of in, then clocks the Phase Generator
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	409 // for that operator, stores the output sample and returns.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	410 // Should probably integrate PGCalc() into this function,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	411 // at some point at least.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	412 static inline int32_t Calc(FMOperator *op, int32_t in)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	413 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	414 int32_t tmp = Sine(op->pgcount + (in << 7));
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	415 PGCalc(op);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	416 op->out = op->egout*tmp;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	417 return op->out;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	418 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	419
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	420 // Version of the above that gets used when the chip-internal LFO
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	421 // is enabled. Basically identical to the above, except with more Vibrato.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	422 static inline int32_t CalcL(FMOperator *op, int32_t in)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	423 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	424 int32_t tmp = Sine(op->pgcount + (in << 7));
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	425 PGCalcL(op);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	426 op->out = op->egout*tmp;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	427 return op->out;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	428 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	429
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	430 // Clock operator 0. OP0 is special as it does not take an input from
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	431 // another operator, rather it can frequency-modulate itsself via the
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	432 // fb parameter (which specifies feedback amount). This is incredibly
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	433 // useful, and makes it possible to define a lot more instruments
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	434 // for the OPNA than you'd be able to otherwise.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	435 #define FM_PRECISEFEEDBACK 1
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	436 static inline void CalcFB(FMOperator *op, uint fb)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	437 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	438 int32_t tmp;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	439 int32_t in = op->out + op->out2;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	440 op->out2 = op->out;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	441 if (FM_PRECISEFEEDBACK && fb == 31)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	442 tmp = Sine(op->pgcount);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	443 else
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	444 tmp = Sine(op->pgcount + ((in << 6) >> fb));
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	445
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	446 PGCalc(op);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	447 op->out = op->egout*tmp;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	448 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	449
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	450 // Version of the above, but with 100% as much LFO as the above.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	451 // See comment above CalcL() for details/explanation.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	452 static inline void CalcFBL(FMOperator *op, uint fb)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	453 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	454 int32_t tmp;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	455 int32_t in = op->out + op->out2;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	456 op->out2 = op->out;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	457
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	458 if (FM_PRECISEFEEDBACK && fb == 31)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	459 tmp = Sine(op->pgcount);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	460 else
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	461 tmp = Sine(op->pgcount + ((in << 6) >> fb));
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	462
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	463 PGCalcL(op);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	464 op->out = op->egout*tmp;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	465 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	466
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	467 // ---------------------------------------------------------------------------
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	468 // 4-op Channel
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	469 // Sets the "algorithm", i.e. the connections between individual operators
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	470 // in a channel. See Page 22 of the manual for pretty drawings of all of the
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	471 // different algorithms supported by the OPNA.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	472 //
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	473 static void SetAlgorithm(Channel4 *ch4, uint algo)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	474 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	475 static const uint8_t table1[8][6] =
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	476 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	477 { 0, 1, 1, 2, 2, 3 }, { 1, 0, 0, 1, 1, 2 },
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	478 { 1, 1, 1, 0, 0, 2 }, { 0, 1, 2, 1, 1, 2 },
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	479 { 0, 1, 2, 2, 2, 1 }, { 0, 1, 0, 1, 0, 1 },
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	480 { 0, 1, 2, 1, 2, 1 }, { 1, 0, 1, 0, 1, 0 },
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	481 };
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	482
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	483 ch4->idx[0] = table1[algo][0]; // in[0];
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	484 ch4->idx[1] = table1[algo][2]; // in[1];
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	485 ch4->idx[2] = table1[algo][4]; // in[2];
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	486 ch4->idx[3] = table1[algo][1]; // out[0];
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	487 ch4->idx[4] = table1[algo][3]; // out[1];
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	488 ch4->idx[5] = table1[algo][5]; // out[2];
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	489 ch4->op[0].out2 = ch4->op[0].out = 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	490 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	491
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	492 static inline void Ch4Init(Channel4 *ch4)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	493 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	494 int i;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	495 for(i=0; i<4; i++) {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	496 OperatorInit(&ch4->op[i]);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	497 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	498 SetAlgorithm(ch4, 0);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	499 ch4->pms = pmtable[0];
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	500 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	501
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	502 // Reinit all operators on a given channel if paramchanged=true
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	503 // for that channel, set the PM table for that channel, then determine
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	504 // if there is any output from this channel, based on:
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	505 // - mute state of each operator
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	506 // - keyon state of each operator
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	507 // - AM (Tremolo) enable for each operator.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	508 // Bit 0 of the return value is set if there is any output,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	509 // Bit 1 is set if tremolo is enabled for any of the operators on this
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	510 // channel.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	511 static inline int Ch4Prepare(Channel4 *ch4)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	512 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	513 OperatorPrepare(&ch4->op[0]);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	514 OperatorPrepare(&ch4->op[1]);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	515 OperatorPrepare(&ch4->op[2]);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	516 OperatorPrepare(&ch4->op[3]);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	517
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	518 ch4->pms = pmtable[ch4->op[0].ms & 7];
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	519 if(ch4->op[0].mute && ch4->op[1].mute && ch4->op[2].mute && ch4->op[3].mute) return 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	520 int key = (IsOn(&ch4->op[0]) \| IsOn(&ch4->op[1]) \| IsOn(&ch4->op[2]) \| IsOn(&ch4->op[3])) ? 1 : 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	521 int lfo = ch4->op[0].ms & (ch4->op[0].amon \| ch4->op[1].amon \| ch4->op[2].amon \| ch4->op[3].amon ? 0x37 : 7) ? 2 : 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	522 return key \| lfo;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	523 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	524
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	525 // Clock one channel. Clocks all the Envelope Generators in parallel
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	526 // (well, okay, in sequence, but a hardware implementation should
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	527 // clock them in parallel as they are completely independent tasks,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	528 // all that is important is that you don't execute Calc{L,FB,FBL}
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	529 // until all of the EGs are done clocking - but that should be, again,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	530 // straightforward to implement in hardware).
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	531 //
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	532 int32_t Ch4Calc(Channel4 *ch4)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	533 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	534 int i;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	535 ch4->buf[1] = ch4->buf[2] = ch4->buf[3] = 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	536 for(i=0; i<4; i++) {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	537 if ((ch4->op[i].egstep -= ch4->op[i].egstepd) < 0)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	538 EGCalc(&ch4->op[i]);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	539 ch4->op[i].egout = LogToLin(ch4->op[i].eglevel)*gaintab[ch4->op[i].tl];
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	540 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	541
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	542 ch4->buf[0] = ch4->op[0].out; CalcFB(&ch4->op[0], ch4->fb);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	543 ch4->buf[ch4->idx[3]] += Calc(&ch4->op[1], ch4->buf[ch4->idx[0]]);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	544 ch4->buf[ch4->idx[4]] += Calc(&ch4->op[2], ch4->buf[ch4->idx[1]]);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	545 int o = ch4->op[3].out;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	546 Calc(&ch4->op[3], ch4->buf[ch4->idx[2]]);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	547 return ((ch4->buf[ch4->idx[5]] + o) >> 8);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	548 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	549
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	550 // Same as above, but with LFO. Should see if I can merge the two somehow and just set
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	551 // a flag whenever I want to mix in Vibrato/Tremolo effects. Also, this code is basically
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	552 // completely untested, due to the surprising difficulty of finding test samples that
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	553 // actually use the chip-internal LFO. (And if you've somehow found one of those,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	554 // now try also finding a good-quality recording of it being played back on the chip
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	555 // itsself. I should go ask the folks at soundshock.se or something, come to think of it).
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	556 //
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	557 int32_t Ch4CalcL(Channel4 *ch4)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	558 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	559 int i;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	560 pmv = ch4->pms[pml];
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	561 ch4->buf[1] = ch4->buf[2] = ch4->buf[3] = 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	562 for(i=0; i<4; i++) {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	563 if ((ch4->op[i].egstep -= ch4->op[i].egstepd) < 0)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	564 EGCalc(&ch4->op[i]);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	565 ch4->op[i].egout = (LogToLin(ch4->op[i].eglevel + (aml >> amt[ch4->op[i].ams]))*gaintab[ch4->op[i].tl]);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	566 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	567
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	568 ch4->buf[0] = ch4->op[0].out; CalcFBL(&ch4->op[0], ch4->fb);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	569 ch4->buf[ch4->idx[3]] += CalcL(&ch4->op[1], ch4->buf[ch4->idx[0]]);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	570 ch4->buf[ch4->idx[4]] += CalcL(&ch4->op[2], ch4->buf[ch4->idx[1]]);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	571 int o = ch4->op[3].out;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	572 CalcL(&ch4->op[3], ch4->buf[ch4->idx[2]]);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	573 return ((ch4->buf[ch4->idx[5]] + o) >> 8);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	574 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	575
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	576 // This essentially initializes a couple constant tables
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	577 // and chip-specific parameters based on what the chip clock and "DAC" samplerate
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	578 // were set to in OPNAInit(). psgrate is always equal to the user-requested samplerate,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	579 // whereas rate is only equal to that in the interpolation=false case, otherwise
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	580 // it's set to whatever value is needed to downsample 55466Hz to the user-requested
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	581 // samplerate, which will (almost?) always be either 44100Hz or 48000Hz.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	582 // TODO: better-quality resampling may be of use here, possibly.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	583 //
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	584 static void SetPrescaler(OPNA *opna, uint32_t p)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	585 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	586 static const char table[3][2] = { { 6, 4 }, { 3, 2 }, { 2, 1 } };
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	587 static const uint8_t table2[8] = { 109, 78, 72, 68, 63, 45, 9, 6 };
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	588 // 512
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	589 if (opna->prescale != p)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	590 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	591 opna->prescale = p;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	592 uint32_t i, fmclock = opna->clock / table[p][0] / 12;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	593
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	594 if (opna->interpolation) {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	595 opna->rate = fmclock * 2;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	596 do {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	597 opna->rate >>= 1;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	598 opna->mpratio = opna->psgrate * 16384 / opna->rate;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	599 } while (opna->mpratio <= 8192);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	600 } else {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	601 opna->rate = opna->psgrate;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	602 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	603 uint32_t ratio = ((fmclock << FM_RATIOBITS) + opna->rate/2) / opna->rate;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	604 opna->timer_step = (int32_t)(1000000.0f * 65536.0f/fmclock);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	605 MakeTimeTable(ratio);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	606 PSGSetClock(&opna->psg, opna->clock / table[p][1], opna->psgrate);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	607
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	608 for (i=0; i<8; i++) {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	609 lfotab[i] = (ratio << (1+FM_LFOCBITS-FM_RATIOBITS)) / table2[i];
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	610 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	611 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	612 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	613
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	614 static inline void RebuildTimeTable(OPNA *opna)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	615 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	616 int p = opna->prescale;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	617 opna->prescale = -1;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	618 SetPrescaler(opna, p);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	619 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	620
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	621 // Set volume. Just a dB->internal linear scale conversion here, nothing more.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	622 //
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	623 void SetVolumeFM(OPNA *opna, int db)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	624 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	625 db = Min(db, 20);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	626 if (db > -192)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	627 opna->fmvolume = lrintf(16384.0f * expf((float)M_LN10*(db / 40.0f)));
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	628 else
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	629 opna->fmvolume = 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	630 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	631
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	632 // Chip-internal TimerA() handler. All it does is implement CSM, i.e.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	633 // channel 3 will get keyed on and off whenever the TimerA() interrupt fires.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	634 // To the best of my knowledge, CSM was intended to be used to implement
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	635 // primitive formant synthesis (which Yamaha later repackaged in a much more
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	636 // elaborate and featured implementation in their FS1R), and used by
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	637 // approximately nobody. It's also been removed from the YMF288/OPN3.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	638 //
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	639 static void TimerA(OPNA *opna)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	640 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	641 int i;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	642 if (opna->regtc & 0x80)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	643 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	644 for(i=0; i<4; i++)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	645 KeyOn(&opna->csmch->op[i]);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	646 for(i=0; i<4; i++)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	647 KeyOff(&opna->csmch->op[i]);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	648 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	649 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	650
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	651 // ---------------------------------------------------------------------------
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	652 // Clock timers. TimerA has a resolution of 9 microseconds (assuming standard
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	653 // chip clockspeed of 8MHz, which all of this code of course does), and
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	654 // on the Speak Board for the PC-9801 is used only for the purpose of sound effects.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	655 // TimerB, on the other hand, has a resolution of 144 microseconds, and is basically
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	656 // used as the main chip clock. Also, binding "sound-effects" to TimerB (needed as
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	657 // ZUN uses the sound-effects feature to implement PSG percussion) results in tiny
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	658 // changes to the output file, precisely none of them audible, making TimerA
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	659 // all but useless in this case. Note that TimerA is also used internally in the chip
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	660 // to implement CSM-mode (see comment above).
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	661 //
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	662 uint8_t OPNATimerCount(OPNA *opna, int32_t us)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	663 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	664 uint8_t event = 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	665
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	666 if (opna->timera_count) {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	667 opna->timera_count -= us << 16;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	668 if (opna->timera_count <= 0) {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	669 event = 1;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	670 TimerA(opna);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	671
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	672 while (opna->timera_count <= 0)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	673 opna->timera_count += opna->timera;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	674
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	675 if (opna->regtc & 4) {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	676 if (!(opna->status & 1)) {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	677 opna->status \|= 1;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	678 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	679 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	680 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	681 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	682 if (opna->timerb_count) {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	683 opna->timerb_count -= us << 12;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	684 if (opna->timerb_count <= 0) {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	685 event = 1;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	686 while (opna->timerb_count <= 0)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	687 opna->timerb_count += opna->timerb;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	688
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	689 if (opna->regtc & 8) {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	690 if (!(opna->status & 2)) {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	691 opna->status \|= 2;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	692 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	693 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	694 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	695 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	696 return event;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	697 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	698
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	699 // Rhythm source samples. pcm_s8 (not u8!), and found in rhythmdata.h,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	700 // which is included in rhythmdata.c in order to keep the size of the
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	701 // object file that you get from compiling this file at a reasonable size,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	702 // for debugging/testing/sanity purposes.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	703 //
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	704 extern const unsigned char* rhythmdata[6];
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	705 static const unsigned int rhythmdatalen[6] = {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	706 9013, 10674, 66610, 7259, 18562, 3042
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	707 };
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	708
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	709 // ---------------------------------------------------------------------------
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	710 // Main chip init routine.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	711 // c is the chip clock, which should never be set to anything other than 8MHz.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	712 // r is the chip samplerate, set to 44100 typically.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	713 // ipflag - if true, ignore the value of r, clock the "DAC" at the OPNA-internal
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	714 // samplerate of 55466Hz, then downsample to whatever the actual value of r is.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	715 //
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	716 uint8_t OPNAInit(OPNA *opna, uint c, uint r, uint8_t ipflag)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	717 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	718 int i;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	719 opna->devmask = 0x7;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	720 opna->prescale = 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	721 opna->rate = 44100;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	722 opna->mixl = 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	723 opna->mixdelta = 16383;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	724 opna->interpolation = false;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	725
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	726 MakeTable();
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	727 for (i=0; i<6; i++) {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	728 Ch4Init(&opna->ch[i]);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	729 opna->rhythm[i].sample = 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	730 opna->rhythm[i].pos = 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	731 opna->rhythm[i].size = 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	732 opna->rhythm[i].volume = 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	733 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	734 opna->rhythmtvol = 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	735 opna->csmch = &opna->ch[2];
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	736 for (i=0; i<6; i++)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	737 opna->rhythm[i].pos = ~0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	738
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	739 for (i=0; i<6; i++)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	740 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	741 uint8_t file_buf = (uint8_t)0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	742 uint32_t fsize;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	743 file_buf = (uint8_t*)rhythmdata[i];
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	744 fsize = rhythmdatalen[i];
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	745 file_buf += 44;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	746 fsize -= 44;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	747 fsize /= 2;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	748 opna->rhythm[i].sample = (int8_t*)file_buf;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	749 opna->rhythm[i].rate = 44100;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	750 opna->rhythm[i].step = opna->rhythm[i].rate * 1024 / opna->rate;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	751 opna->rhythm[i].pos = opna->rhythm[i].size = fsize * 1024;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	752 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	753
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	754 c /= 2;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	755 opna->clock = c;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	756 if (!OPNASetRate(opna, r, ipflag))
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	757 return false;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	758 RebuildTimeTable(opna);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	759 OPNAReset(opna);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	760 PSGInit(&opna->psg);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	761
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	762 SetVolumeFM(opna, 0);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	763 SetVolumePSG(&opna->psg, 0);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	764 OPNASetChannelMask(opna, ~0);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	765 for (i=0; i<6; i++)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	766 SetVolumeRhythm(opna, 0, 0);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	767 return true;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	768 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	769
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	770 // ---------------------------------------------------------------------------
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	771 // Reset chip. Your standard routine, basically zeros everything in sight.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	772 //
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	773 void OPNAReset(OPNA *opna)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	774 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	775 int i, j;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	776
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	777 opna->status = 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	778 SetPrescaler(opna, 0);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	779 opna->timera_count = 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	780 opna->timerb_count = 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	781 PSGReset(&opna->psg);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	782 opna->reg29 = 0x1f;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	783 opna->rhythmkey = 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	784 for (i=0x20; i<0x28; i++) OPNASetReg(opna, i, 0);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	785 for (i=0x30; i<0xc0; i++) OPNASetReg(opna, i, 0);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	786 for (i=0x130; i<0x1c0; i++) OPNASetReg(opna, i, 0);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	787 for (i=0x100; i<0x110; i++) OPNASetReg(opna, i, 0);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	788 for (i=0x10; i<0x20; i++) OPNASetReg(opna, i, 0);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	789 for (i=0; i<6; i++)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	790 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	791 opna->pan[i] = 3;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	792 for(j=0; j<4; j++)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	793 OperatorReset(&opna->ch[i].op[j]);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	794 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	795
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	796 opna->statusnext = 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	797 opna->lfocount = 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	798 opna->status = 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	799 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	800
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	801 // ---------------------------------------------------------------------------
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	802 // Change OPNA "DAC" samplerate.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	803 // r and ipflag are as in OPNAInit(), above.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	804 //
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	805 uint8_t OPNASetRate(OPNA *opna, uint r, uint8_t ipflag)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	806 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	807 int i, j;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	808 opna->interpolation = ipflag;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	809 opna->psgrate = r;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	810 RebuildTimeTable(opna);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	811 opna->lfodcount = opna->reg22 & 0x08 ? lfotab[opna->reg22 & 7] : 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	812
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	813 for (i=0; i<6; i++) {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	814 for (j=0; j<4; j++)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	815 opna->ch[i].op[j].paramchanged = true;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	816 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	817 for (i=0; i<6; i++) {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	818 opna->rhythm[i].step = opna->rhythm[i].rate * 1024 / r;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	819 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	820 return true;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	821 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	822
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	823 // ---------------------------------------------------------------------------
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	824 // Set OPNA channel mask. The 6 LSBs of mask are 0 to disable that FM channel,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	825 // and 1 to enable it. The next 3 LSBs are passed to PSGSetChannelMask() to,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	826 // well, set the PSG channel mask (which behaves the same way: 0 disables
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	827 // a given channel and 1 enables it).
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	828 //
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	829 void OPNASetChannelMask(OPNA *opna, uint mask)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	830 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	831 int i, j;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	832 for (i=0; i<6; i++) {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	833 for (j=0; j<4; j++) {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	834 opna->ch[i].op[j].mute = (!(mask & (1 << i)));
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	835 opna->ch[i].op[j].paramchanged = true;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	836 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	837 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	838 PSGSetChannelMask(&opna->psg, (mask >> 6));
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	839 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	840
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	841 // ---------------------------------------------------------------------------
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	842 // Main OPNA register-set routine. Really long and boring switch-case.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	843 // Basically taken directly from the manual - the only parts of the spec
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	844 // that were even the least bit tricky to implement were the f-number tables,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	845 // everything else is basically obvious.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	846 //
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	847 void OPNASetReg(OPNA *opna, uint addr, uint data)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	848 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	849 uint j, _dp = 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	850 int c = addr & 3;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	851 switch (addr)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	852 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	853 uint modified;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	854 uint tmp;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	855
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	856 // Timer -----------------------------------------------------------------
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	857 case 0x24: case 0x25:
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	858 opna->regta[addr & 1] = (uint8_t)data;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	859 tmp = (opna->regta[0] << 2) + (opna->regta[1] & 3);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	860 opna->timera = (1024-tmp) * opna->timer_step;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	861 break;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	862
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	863 case 0x26:
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	864 opna->timerb = (256-data) * opna->timer_step;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	865 break;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	866
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	867 case 0x27:
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	868 tmp = opna->regtc ^ data;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	869 opna->regtc = (uint8_t)data;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	870 if (data & 0x10)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	871 opna->status &= ~1;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	872 if (data & 0x20)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	873 opna->status &= ~2;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	874 if (tmp & 0x01)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	875 opna->timera_count = (data & 1) ? opna->timera : 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	876 if (tmp & 0x02)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	877 opna->timerb_count = (data & 2) ? opna->timerb : 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	878 break;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	879
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	880 // Misc ------------------------------------------------------------------
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	881 case 0x28: // Key On/Off
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	882 if ((data & 3) < 3)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	883 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	884 uint32_t key = (data >> 4);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	885 c = (data & 3) + (data & 4 ? 3 : 0);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	886 if (key & 0x1) KeyOn(&opna->ch[c].op[0]); else KeyOff(&opna->ch[c].op[0]);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	887 if (key & 0x2) KeyOn(&opna->ch[c].op[1]); else KeyOff(&opna->ch[c].op[1]);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	888 if (key & 0x4) KeyOn(&opna->ch[c].op[2]); else KeyOff(&opna->ch[c].op[2]);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	889 if (key & 0x8) KeyOn(&opna->ch[c].op[3]); else KeyOff(&opna->ch[c].op[3]);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	890 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	891 break;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	892
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	893 // Status Mask -----------------------------------------------------------
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	894 case 0x29:
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	895 opna->reg29 = data;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	896 break;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	897
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	898 // Prescaler -------------------------------------------------------------
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	899 case 0x2d: case 0x2e: case 0x2f:
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	900 SetPrescaler(opna, (addr-0x2d));
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	901 break;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	902
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	903 // F-Number --------------------------------------------------------------
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	904 case 0x1a0: case 0x1a1: case 0x1a2:
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	905 c += 3;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	906 case 0xa0: case 0xa1: case 0xa2:
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	907 opna->fnum[c] = data + opna->fnum2[c] * 0x100;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	908 _dp = (opna->fnum[c] & 2047) << ((opna->fnum[c] >> 11) & 7);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	909 for(j=0; j<4; j++) {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	910 opna->ch[c].op[j].dp = _dp;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	911 opna->ch[c].op[j].bn = notetab[(opna->fnum[c] >> 7) & 127];
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	912 opna->ch[c].op[j].paramchanged = true;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	913 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	914 break;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	915
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	916 case 0x1a4: case 0x1a5: case 0x1a6:
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	917 c += 3;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	918 case 0xa4 : case 0xa5: case 0xa6:
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	919 opna->fnum2[c] = (uint8_t)data;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	920 break;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	921
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	922 case 0xa8: case 0xa9: case 0xaa:
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	923 opna->fnum3[c] = data + opna->fnum2[c+6] * 0x100;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	924 break;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	925
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	926 case 0xac : case 0xad: case 0xae:
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	927 opna->fnum2[c+6] = (uint8_t)data;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	928 break;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	929
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	930 // Algorithm -------------------------------------------------------------
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	931 case 0x1b0: case 0x1b1: case 0x1b2:
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	932 c += 3;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	933 case 0xb0: case 0xb1: case 0xb2:
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	934 opna->ch[c].fb = fbtab[((data >> 3) & 7)];
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	935 SetAlgorithm(&opna->ch[c], data & 7);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	936 break;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	937
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	938 case 0x1b4: case 0x1b5: case 0x1b6:
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	939 c += 3;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	940 case 0xb4: case 0xb5: case 0xb6:
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	941 opna->pan[c] = (data >> 6) & 3;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	942 for(j=0; j<4; j++) {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	943 opna->ch[c].op[j].ms = data;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	944 opna->ch[c].op[j].paramchanged = true;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	945 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	946 break;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	947
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	948 // Rhythm ----------------------------------------------------------------
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	949 case 0x10: // DM/KEYON
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	950 if (!(data & 0x80)) // KEY ON
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	951 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	952 opna->rhythmkey \|= data & 0x3f;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	953 if (data & 0x01) opna->rhythm[0].pos = 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	954 if (data & 0x02) opna->rhythm[1].pos = 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	955 if (data & 0x04) opna->rhythm[2].pos = 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	956 if (data & 0x08) opna->rhythm[3].pos = 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	957 if (data & 0x10) opna->rhythm[4].pos = 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	958 if (data & 0x20) opna->rhythm[5].pos = 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	959 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	960 else
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	961 { // DUMP
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	962 opna->rhythmkey &= ~data;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	963 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	964 break;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	965
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	966 case 0x11:
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	967 opna->rhythmtl = ~data & 63;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	968 break;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	969
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	970 case 0x18: // Bass Drum
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	971 case 0x19: // Snare Drum
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	972 case 0x1a: // Top Cymbal
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	973 case 0x1b: // Hihat
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	974 case 0x1c: // Tom-tom
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	975 case 0x1d: // Rim shot
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	976 opna->rhythm[addr & 7].pan = (data >> 6) & 3;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	977 opna->rhythm[addr & 7].level = ~data & 31;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	978 break;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	979
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	980 // LFO -------------------------------------------------------------------
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	981 case 0x22:
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	982 modified = opna->reg22 ^ data;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	983 opna->reg22 = data;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	984 if (modified & 0x8)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	985 opna->lfocount = 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	986 opna->lfodcount = opna->reg22 & 8 ? lfotab[opna->reg22 & 7] : 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	987 break;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	988
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	989 // PSG -------------------------------------------------------------------
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	990 case 0: case 1: case 2: case 3: case 4: case 5: case 6: case 7:
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	991 case 8: case 9: case 10: case 11: case 12: case 13: case 14: case 15:
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	992 PSGSetReg(&opna->psg, addr, data);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	993 break;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	994
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	995 // ADSR ------------------------------------------------------------------
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	996 default:
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	997 if (c < 3)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	998 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	999 if (addr & 0x100)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1000 c += 3;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1001 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1002 uint8_t slottable[4] = { 0, 2, 1, 3 };
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1003 uint32_t slot = slottable[(addr >> 2) & 3];
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1004 FMOperator* op = &opna->ch[c].op[slot];
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1005
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1006 switch ((addr >> 4) & 15)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1007 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1008 case 3: // 30-3E DT/MULTI
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1009 op->detune = (((data >> 4) & 0x07) * 0x20);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1010 op->multiple = (data & 0x0f);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1011 op->paramchanged = 1;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1012 break;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1013
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1014 case 4: // 40-4E TL
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1015 if(!((opna->regtc & 0x80) && (opna->csmch == &opna->ch[c]))) {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1016 op->tl = (data & 0x7f);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1017 op->paramchanged = 1;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1018 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1019 op->tll = (data & 0x7f);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1020 break;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1021
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1022 case 5: // 50-5E KS/AR
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1023 op->ks = ((data >> 6) & 3);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1024 op->ar = ((data & 0x1f) * 2);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1025 op->paramchanged = 1;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1026 break;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1027
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1028 case 6: // 60-6E DR/AMON
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1029 op->dr = ((data & 0x1f) * 2);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1030 op->amon = ((data & 0x80) != 0);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1031 op->paramchanged = 1;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1032 break;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1033
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1034 case 7: // 70-7E SR
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1035 op->sr = ((data & 0x1f) * 2);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1036 op->paramchanged = 1;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1037 break;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1038
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1039 case 8: // 80-8E SL/RR
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1040 op->sl = (((data >> 4) & 15) * 4);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1041 op->rr = ((data & 0x0f) * 4 + 2);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1042 op->paramchanged = 1;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1043 break;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1044
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1045 case 9: // 90-9E SSG-EC
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1046 op->ssgtype = (data & 0x0f);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1047 break;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1048 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1049 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1050 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1051 break;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1052 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1053 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1054
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1055 // ---------------------------------------------------------------------------
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1056 // Read OPNA register. Pointless. Only SSG registers can be read, and of those
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1057 // the only one anyone seems to be interested in reading is register 7,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1058 // which as I explain in detail in psg.c, is completely superfluous.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1059 //
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1060 uint OPNAGetReg(OPNA *opna, uint addr)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1061 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1062 if (addr < 0x10)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1063 return PSGGetReg(&opna->psg, addr);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1064 if (addr == 0xff)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1065 return 1;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1066 return 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1067 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1068
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1069 // ---------------------------------------------------------------------------
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1070
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1071 static inline void MixSubSL(Channel4 ch[6], int activech, int32_t *dest)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1072 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1073 if (activech & 0x001) (*dest = Ch4CalcL(&ch[0]));
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1074 if (activech & 0x004) (*dest += Ch4CalcL(&ch[1]));
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1075 if (activech & 0x010) (*dest += Ch4CalcL(&ch[2]));
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1076 if (activech & 0x040) (*dest += Ch4CalcL(&ch[3]));
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1077 if (activech & 0x100) (*dest += Ch4CalcL(&ch[4]));
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1078 if (activech & 0x400) (*dest += Ch4CalcL(&ch[5]));
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1079 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1080
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1081 static inline void MixSubS(Channel4 ch[6], int activech, int32_t *dest)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1082 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1083 if (activech & 0x001) (*dest = Ch4Calc(&ch[0]));
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1084 if (activech & 0x004) (*dest += Ch4Calc(&ch[1]));
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1085 if (activech & 0x010) (*dest += Ch4Calc(&ch[2]));
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1086 if (activech & 0x040) (*dest += Ch4Calc(&ch[3]));
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1087 if (activech & 0x100) (*dest += Ch4Calc(&ch[4]));
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1088 if (activech & 0x400) (*dest += Ch4Calc(&ch[5]));
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1089 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1090
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1091 // ---------------------------------------------------------------------------
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1092 // Mix FM channels and output. Mix6 runs at user-specified samplerate,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1093 // Mix6I runs at the chip samplerate of 55466Hz and then downsamples
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1094 // to the user-specified samplerate. It is an open problem as to determining
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1095 // if one of these sounds better than the other.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1096 //
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1097 #define IStoSample(s) ((Limit((s) >> 2, 0xffff, -0xffff) * opna->fmvolume) >> 14)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1098 //#define IStoSample(s) ((((s) >> 3) * fmvolume) >> 14)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1099
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1100 static void Mix6(OPNA opna, Sample buffer, uint32_t nsamples, int activech)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1101 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1102 Sample* limit = buffer + nsamples;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1103 Sample* dest;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1104 // Mix
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1105 int32_t ibuf;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1106
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1107 for (dest = buffer; dest < limit; dest+=1)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1108 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1109 ibuf = 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1110 if (activech & 0xaaa)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1111 LFO(opna), MixSubSL(opna->ch, activech, &ibuf);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1112 else
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1113 MixSubS(opna->ch, activech, &ibuf);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1114 dest[0] += IStoSample(ibuf);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1115 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1116 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1117
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1118 // ---------------------------------------------------------------------------
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1119 // See comment above Mix6(), above.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1120 //
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1121 static void Mix6I(OPNA opna, Sample buffer, uint32_t nsamples, int activech)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1122 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1123 // Mix
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1124 int32_t ibuf;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1125
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1126 int32_t delta = opna->mixdelta;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1127 Sample* limit = buffer + nsamples;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1128 Sample *dest;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1129 if (opna->mpratio < 16384)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1130 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1131 for (dest = buffer; dest < limit; dest+=1)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1132 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1133 int32_t l, d;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1134 while (delta > 0)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1135 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1136 ibuf = 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1137 if (activech & 0xaaa)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1138 LFO(opna), MixSubSL(opna->ch, activech, &ibuf);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1139 else
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1140 MixSubS(opna->ch, activech, &ibuf);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1141
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1142 l = IStoSample(ibuf);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1143 d = Min(opna->mpratio, delta);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1144 opna->mixl += l * d;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1145 delta -= opna->mpratio;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1146 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1147 dest[0] += (opna->mixl >> 14);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1148 opna->mixl = l * (16384-d);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1149 delta += 16384;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1150 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1151 } else {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1152 int impr = 16384 * 16384 / opna->mpratio;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1153 for (dest = buffer; dest < limit; dest+=1)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1154 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1155 if (delta < 0)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1156 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1157 delta += 16384;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1158 opna->mixl = opna->mixl1;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1159
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1160 ibuf = 0;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1161 if (activech & 0xaaa)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1162 LFO(opna), MixSubSL(opna->ch, activech, &ibuf);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1163 else
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1164 MixSubS(opna->ch, activech, &ibuf);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1165
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1166 opna->mixl1 = IStoSample(ibuf);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1167 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1168 int32_t l = (delta * opna->mixl + (16384 - delta) * opna->mixl1) / 16384;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1169 dest[0] += l;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1170 delta -= impr;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1171 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1172 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1173 opna->mixdelta = delta;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1174 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1175
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1176 // ---------------------------------------------------------------------------
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1177 // Main FM output routine. Clocks all of the operators on the chip, then mixes
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1178 // together the output using one of Mix6() or Mix6I() above, and then outputs
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1179 // the result to OPNAMix, which is what the calling routine will actually use.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1180 // buffer should be a pointer to a buffer of type Sample (int32_t in this
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1181 // implementation, though another used float and in principle int16_t should
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1182 // be sufficient), and be of size at least equal to nsamples.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1183 //
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1184 static void FMMix(OPNA opna, Sample buffer, uint32_t nsamples)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1185 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1186 uint j;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1187 if (opna->fmvolume > 0)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1188 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1189 // Set F-Number
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1190 if (!(opna->regtc & 0xc0)) {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1191 uint _dp = (opna->fnum[opna->csmch-opna->ch] & 2047) << ((opna->fnum[opna->csmch-opna->ch] >> 11) & 7);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1192 for(j=0; j<4; j++) {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1193 opna->csmch->op[j].dp = _dp;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1194 opna->csmch->op[j].bn = notetab[(opna->fnum[opna->csmch-opna->ch] >> 7) & 127];
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1195 opna->csmch->op[j].paramchanged = true;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1196 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1197 } else {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1198 SetFNum(&opna->csmch->op[0], opna->fnum3[1]); SetFNum(&opna->csmch->op[1], opna->fnum3[2]);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1199 SetFNum(&opna->csmch->op[2], opna->fnum3[0]); SetFNum(&opna->csmch->op[3], opna->fnum[2]);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1200 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1201
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1202 int act = (((Ch4Prepare(&opna->ch[2]) << 2) \| Ch4Prepare(&opna->ch[1])) << 2) \| Ch4Prepare(&opna->ch[0]);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1203 if (opna->reg29 & 0x80)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1204 act \|= (Ch4Prepare(&opna->ch[3]) \| ((Ch4Prepare(&opna->ch[4]) \| (Ch4Prepare(&opna->ch[5]) << 2)) << 2)) << 6;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1205 if (!(opna->reg22 & 0x08))
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1206 act &= 0x555;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1207
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1208 if (act & 0x555)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1209 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1210 if (opna->interpolation)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1211 Mix6I(opna, buffer, nsamples, act);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1212 else
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1213 Mix6(opna, buffer, nsamples, act);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1214 } else {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1215 opna->mixl = 0, opna->mixdelta = 16383;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1216 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1217 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1218 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1219
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1220 // ---------------------------------------------------------------------------
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1221 // Mix Rhythm generator output. Boring, just takes the PCM samples,
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1222 // multiplies them by the volume set for that rhythm sample, and then outputs
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1223 // the appropriate length of sample for that given samplerate to buffer.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1224 // The same restrictions on buffer as in FMMix() above apply.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1225 //
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1226 static void RhythmMix(OPNA opna, Sample buffer, uint32_t count)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1227 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1228 int i;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1229 Sample *dest;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1230 if (opna->rhythmtvol < 128 && opna->rhythm[0].sample && (opna->rhythmkey & 0x3f))
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1231 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1232 Sample* limit = buffer + count;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1233 for (i=0; i<6; i++)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1234 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1235 Rhythm *r = &opna->rhythm[i];
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1236 if ((opna->rhythmkey & (1 << i)) && r->level >= 0)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1237 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1238 int db = Limit(opna->rhythmtl+r->level+r->volume, 95, -31);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1239 int vol = tltab[FM_TLPOS + db];
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1240
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1241 for (dest = buffer; dest<limit && r->pos < r->size; dest+=1)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1242 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1243 int sample = ((r->sample[r->pos / 1024] << 8) * vol) >> 12;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1244 r->pos += r->step;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1245 dest[0] += sample;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1246 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1247 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1248 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1249 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1250 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1251
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1252 // ---------------------------------------------------------------------------
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1253 // Main OPNA output routine. See FMMix(), RhythmMix() above and PSGMix()
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1254 // in psg.c for details.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1255 //
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1256 void OPNAMix(OPNA opna, Sample buffer, uint32_t nsamples)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1257 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1258 if(opna->devmask & 1) FMMix(opna, buffer, nsamples);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1259 if(opna->devmask & 2) PSGMix(&opna->psg, buffer, nsamples);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1260 if(opna->devmask & 4) RhythmMix(opna, buffer, nsamples);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1261 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1262
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1263 // ---------------------------------------------------------------------------
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1264 // Table setup/generation routines.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1265 // FIXME: unify cltab/tltab and then hardcode the result, it's tiny enough
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1266 // that we don't really need to bother with runtime init for it.
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1267 //
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1268 void MakeTable(void) {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1269 int i, j;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1270 if (tablemade)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1271 return;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1272
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1273 tablemade = true;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1274 for (i=-FM_TLPOS; i<FM_TLENTS-FM_TLPOS; i++)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1275 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1276 tltab[FM_TLPOS + i] = (uint32_t)(4096.0f * expf((float)M_LN2(i -16.0f / FM_TLENTS)))-1;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1277 // LOG2("tltab[%4d] = 0x%.4x\n", i, tltab[FM_TLPOS+i]);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1278 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1279 for (i=0; i<512; i++)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1280 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1281 int c = (int)(((1 << 8) - 1) * expf((float)M_LN2*(-i / 64.0f)));
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1282 #if 1
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1283 // ÀºÅÙÍÞÀ©
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1284 // c += 1 << 3;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1285 // c &= ~1 << 3;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1286 for (j=16; j>11; j--)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1287 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1288 if ((1 << j) & c)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1289 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1290 c &= ((1 << 11) - 1) << (j - 10);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1291 break;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1292 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1293 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1294 #endif
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1295 cltab[i] = c;
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1296 // LOG2("cltab[%4d2] = %6d\n", i, cltab[i2]);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1297 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1298 // 3 6, 12 30 60 240 420 / 720
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1299 // 1.000963
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1300 // lfofref[level * max * wave];
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1301 // pre = lfofref[level][pms * wave >> 8];
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1302 for (i=0; i<8; i++)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1303 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1304 float pmb = pms[i];
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1305 for (j=0; j<FM_LFOENTS; j++)
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1306 {
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1307 pmtable[i][j] =
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1308 (int)(0x10000 * (expf((float)M_LN2(pmb (2*j - FM_LFOENTS+1) / (FM_LFOENTS-1)) - 1)));
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1309 // LOG4("pmtable[%d][%.2x] = %5d ", i, j, pmtable[i][j]);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1310 // LOG1(" %7.2f\n", log(1. + pmtable[i][j] / 65536.) / log(2) * 1200);
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1311 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1312 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1313 }
c55ea9478c80 Hello Gensokyo! Emmanuel Gil Peyrot <linkmauve@linkmauve.fr> parents: diff changeset	1314

Mercurial > pmdwin

annotate fmgen/opna.c @ 4:c8875256b767