From f40bfc9267b13b54e6379dfe7539447662879d24 Mon Sep 17 00:00:00 2001 From: Sean Bartell Date: Sat, 25 Jun 2011 21:32:25 -0400 Subject: Add codecs to librbcodec. MIME-Version: 1.0 Content-Type: text/plain; charset=UTF-8 Content-Transfer-Encoding: 8bit Change-Id: Id7f4717d51ed02d67cb9f9cb3c0ada4a81843f97 Reviewed-on: http://gerrit.rockbox.org/137 Reviewed-by: Nils Wallménius Tested-by: Nils Wallménius --- lib/rbcodec/codecs/libgme/emuadpcm.c | 297 +++++++++++++++++++++++++++++++++++ 1 file changed, 297 insertions(+) create mode 100644 lib/rbcodec/codecs/libgme/emuadpcm.c (limited to 'lib/rbcodec/codecs/libgme/emuadpcm.c') diff --git a/lib/rbcodec/codecs/libgme/emuadpcm.c b/lib/rbcodec/codecs/libgme/emuadpcm.c new file mode 100644 index 0000000000..b426a74de5 --- /dev/null +++ b/lib/rbcodec/codecs/libgme/emuadpcm.c @@ -0,0 +1,297 @@ +/* + * This file is based on: + * Y8950Adpcm.cc -- Y8950 ADPCM emulator from the openMSX team + * ported to c by gama + * + * The openMSX version is based on: + * emuadpcm.c -- Y8950 ADPCM emulator written by Mitsutaka Okazaki 2001 + * heavily rewritten to fit openMSX structure + */ + +#include + +#include "emuadpcm.h" +#include "emu8950.h" + +// Relative volume between ADPCM part and FM part, +// value experimentally found by Manuel Bilderbeek +const int ADPCM_VOLUME = 356; + +// Bitmask for register 0x07 +static const int R07_RESET = 0x01; +//static const int R07 = 0x02;. // not used +//static const int R07 = 0x04;. // not used +const int R07_SP_OFF = 0x08; +const int R07_REPEAT = 0x10; +const int R07_MEMORY_DATA = 0x20; +const int R07_REC = 0x40; +const int R07_START = 0x80; + +//Bitmask for register 0x08 +const int R08_ROM = 0x01; +const int R08_64K = 0x02; +const int R08_DA_AD = 0x04; +const int R08_SAMPL = 0x08; +//const int R08 = 0x10;. // not used +//const int R08 = 0x20;. // not used +const int R08_NOTE_SET = 0x40; +const int R08_CSM = 0x80; + +const int DMAX = 0x6000; +const int DMIN = 0x7F; +const int DDEF = 0x7F; + +const int DECODE_MAX = 32767; +const int DECODE_MIN = -32768; + +#define GETA_BITS 14 +#define MAX_STEP (1<<(16+GETA_BITS)) + + +//**************************************************// +// // +// Helper functions // +// // +//**************************************************// + +static int CLAP(int min, int x, int max) +{ + return (x < min) ? min : ((max < x) ? max : x); +} + +//**********************************************************// +// // +// Y8950Adpcm // +// // +//**********************************************************// + + +void ADPCM_init(struct Y8950Adpcm* this_, struct Y8950* y8950_, byte* ramBank, int sampleRam) + +{ + this_->y8950 = y8950_; + this_->ramBank = ramBank; + this_->ramSize = sampleRam; + memset(this_->ramBank, 0xFF, this_->ramSize); + this_->volume = 0; +} + +void restart(struct Y8950Adpcm* this_); +void ADPCM_reset(struct Y8950Adpcm* this_) +{ + this_->playing = false; + this_->startAddr = 0; + this_->stopAddr = 7; + this_->memPntr = 0; + this_->delta = 0; + this_->step = 0; + this_->addrMask = (1 << 19) - 1; + this_->reg7 = 0; + this_->reg15 = 0; + ADPCM_writeReg(this_, 0x12, 255); // volume + restart(this_); +} + +void ADPCM_setSampleRate(struct Y8950Adpcm* this_, int sr, int clk) +{ + this_->sampleRate = sr; + this_->clockRate = clk; +} + +bool ADPCM_muted(struct Y8950Adpcm* this_) +{ + return (!this_->playing) || (this_->reg7 & R07_SP_OFF); +} + +//**************************************************// +// // +// I/O Ctrl // +// // +//**************************************************// + +void restart(struct Y8950Adpcm* this_) +{ + this_->playAddr = this_->startAddr & this_->addrMask; + this_->nowStep = MAX_STEP - this_->step; + this_->out = this_->output = 0; + this_->diff = DDEF; + this_->nextLeveling = 0; + this_->sampleStep = 0; + this_->volumeWStep = (int)((long long)this_->volume * this_->step / MAX_STEP); +} + +void ADPCM_writeReg(struct Y8950Adpcm* this_, byte rg, byte data) +{ + switch (rg) { + case 0x07: // START/REC/MEM DATA/REPEAT/SP-OFF/-/-/RESET + this_->reg7 = data; + if (this_->reg7 & R07_RESET) { + this_->playing = false; + } else if (data & R07_START) { + this_->playing = true; + restart(this_); + } + break; + + case 0x08: // CSM/KEY BOARD SPLIT/-/-/SAMPLE/DA AD/64K/ROM + this_->romBank = data & R08_ROM; + this_->addrMask = data & R08_64K ? (1<<17)-1 : (1<<19)-1; + break; + + case 0x09: // START ADDRESS (L) + this_->startAddr = (this_->startAddr & 0x7F800) | (data << 3); + this_->memPntr = 0; + break; + case 0x0A: // START ADDRESS (H) + this_->startAddr = (this_->startAddr & 0x007F8) | (data << 11); + this_->memPntr = 0; + break; + + case 0x0B: // STOP ADDRESS (L) + this_->stopAddr = (this_->stopAddr & 0x7F807) | (data << 3); + break; + case 0x0C: // STOP ADDRESS (H) + this_->stopAddr = (this_->stopAddr & 0x007FF) | (data << 11); + break; + + + case 0x0F: // ADPCM-DATA + // TODO check this + //if ((reg7 & R07_REC) && (reg7 & R07_MEMORY_DATA)) { + { + int tmp = ((this_->startAddr + this_->memPntr) & this_->addrMask) / 2; + tmp = (tmp < this_->ramSize) ? tmp : (tmp & (this_->ramSize - 1)); + if (!this_->romBank) { + this_->ramBank[tmp] = data; + } + //PRT_DEBUG("Y8950Adpcm: mem " << tmp << " " << (int)data); + this_->memPntr += 2; + if ((this_->startAddr + this_->memPntr) > this_->stopAddr) { + OPL_setStatus(this_->y8950, STATUS_EOS); + } + } + OPL_setStatus(this_->y8950, STATUS_BUF_RDY); + break; + + case 0x10: // DELTA-N (L) + this_->delta = (this_->delta & 0xFF00) | data; + this_->step = rate_adjust(this_->delta<sampleRate, this_->clockRate); + this_->volumeWStep = (int)((long long)this_->volume * this_->step / MAX_STEP); + break; + case 0x11: // DELTA-N (H) + this_->delta = (this_->delta & 0x00FF) | (data << 8); + this_->step = rate_adjust(this_->delta<sampleRate, this_->clockRate); + this_->volumeWStep = (int)((long long)this_->volume * this_->step / MAX_STEP); + break; + + case 0x12: { // ENVELOP CONTROL + int oldVol = this_->volume; + this_->volume = (data * ADPCM_VOLUME) >> 8; + if (oldVol != 0) { + this_->output = (int)(((long long)this_->output * this_->volume) / oldVol); + this_->sampleStep = (int)(((long long)this_->sampleStep * this_->volume) / oldVol); + } + this_->volumeWStep = (int)((long long)this_->volume * this_->step / MAX_STEP); + break; + } + case 0x0D: // PRESCALE (L) + case 0x0E: // PRESCALE (H) + case 0x15: // DAC-DATA (bit9-2) + case 0x16: // (bit1-0) + case 0x17: // (exponent) + case 0x1A: // PCM-DATA + // not implemented + break; + } +} + +byte ADPCM_readReg(struct Y8950Adpcm* this_, byte rg) +{ + byte result; + switch (rg) { + case 0x0F: { // ADPCM-DATA + // TODO don't advance pointer when playing??? + int adr = ((this_->startAddr + this_->memPntr) & this_->addrMask) / 2; + if (this_->romBank || (adr >= this_->ramSize)) { + result = 0xFF; + } else { + result = this_->ramBank[adr]; + } + this_->memPntr += 2; + if ((this_->startAddr + this_->memPntr) > this_->stopAddr) { + OPL_setStatus(this_->y8950, STATUS_EOS); + } + break; + } + case 0x13: // TODO check + result = this_->out & 0xFF; + break; + case 0x14: // TODO check + result = this_->out / 256; + break; + default: + result = 255; + } + //PRT_DEBUG("Y8950Adpcm: read "<<(int)rg<<" "<<(int)result); + return result; +} + +int ADPCM_calcSample(struct Y8950Adpcm* this_) +{ + // This table values are from ymdelta.c by Tatsuyuki Satoh. + static const int F1[16] = { 1, 3, 5, 7, 9, 11, 13, 15, + -1, -3, -5, -7, -9, -11, -13, -15}; + static const int F2[16] = {57, 57, 57, 57, 77, 102, 128, 153, + 57, 57, 57, 57, 77, 102, 128, 153}; + + if (ADPCM_muted(this_)) { + return 0; + } + this_->nowStep += this_->step; + if (this_->nowStep >= MAX_STEP) { + int nowLeveling; + do { + this_->nowStep -= MAX_STEP; + unsigned long val; + if (!(this_->playAddr & 1)) { + // n-th nibble + int tmp = this_->playAddr / 2; + if (this_->romBank || (tmp >= this_->ramSize)) { + this_->reg15 = 0xFF; + } else { + this_->reg15 = this_->ramBank[tmp]; + } + val = this_->reg15 >> 4; + } else { + // (n+1)-th nibble + val = this_->reg15 & 0x0F; + } + int prevOut = this_->out; + this_->out = CLAP(DECODE_MIN, this_->out + (this_->diff * F1[val]) / 8, + DECODE_MAX); + this_->diff = CLAP(DMIN, (this_->diff * F2[val]) / 64, DMAX); + int deltaNext = this_->out - prevOut; + nowLeveling = this_->nextLeveling; + this_->nextLeveling = prevOut + deltaNext / 2; + + this_->playAddr++; + if (this_->playAddr > this_->stopAddr) { + if (this_->reg7 & R07_REPEAT) { + restart(this_); + } else { + this_->playing = false; + //y8950.setStatus(Y8950::STATUS_EOS); + } + } + } while (this_->nowStep >= MAX_STEP); + this_->sampleStep = (this_->nextLeveling - nowLeveling) * this_->volumeWStep; + this_->output = nowLeveling * this_->volume; + + /* TODO: Used fixed point math here */ + #if !defined(ROCKBOX) + this_->output += (int)(((long long)this_->sampleStep * this_->nowStep) / this_->step); + #endif + } + this_->output += this_->sampleStep; + return this_->output >> 12; +} -- cgit v1.2.3