240 lines
		
	
	
		
			6 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			240 lines
		
	
	
		
			6 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| /*
 | |
| 
 | |
| ============================================================================
 | |
| 
 | |
| SM8521 sound emulator
 | |
| by cam900
 | |
| 
 | |
| MODIFIED BY TILDEARROW
 | |
| THIS IS NOT THE ORIGINAL VERSION
 | |
| 
 | |
| This file is licensed under zlib license.
 | |
| 
 | |
| ============================================================================
 | |
| 
 | |
| zlib License
 | |
| 
 | |
| (C) 2023-present cam900 and contributors
 | |
| 
 | |
| This software is provided 'as-is', without any express or implied
 | |
| warranty.  In no event will the authors be held liable for any damages
 | |
| arising from the use of this software.
 | |
| 
 | |
| Permission is granted to anyone to use this software for any purpose,
 | |
| including commercial applications, and to alter it and redistribute it
 | |
| freely, subject to the following restrictions:
 | |
| 
 | |
| 1. The origin of this software must not be misrepresented; you must not
 | |
|    claim that you wrote the original software. If you use this software
 | |
|    in a product, an acknowledgment in the product documentation would be
 | |
|    appreciated but is not required.
 | |
| 2. Altered source versions must be plainly marked as such, and must not be
 | |
|    misrepresented as being the original software.
 | |
| 3. This notice may not be removed or altered from any source distribution.
 | |
| 
 | |
| ============================================================================
 | |
| 
 | |
| TODO:
 | |
| - needs hardware test
 | |
| 
 | |
| */
 | |
| 
 | |
| #include "sm8521.h"
 | |
| #include <stdlib.h>
 | |
| 
 | |
| enum sm8521_sgc
 | |
| {
 | |
| 	SM8521_SGC_SONDOUT = (1 << 7),
 | |
| 	SM8521_SGC_DIROUT = (1 << 3),
 | |
| 	SM8521_SGC_SG2OUT = (1 << 2),
 | |
| 	SM8521_SGC_SG1OUT = (1 << 1),
 | |
| 	SM8521_SGC_SG0OUT = (1 << 0)
 | |
| };
 | |
| 
 | |
| void sm8521_sg_wave_tick(struct sm8521_wave_t *sg, const int cycle)
 | |
| {
 | |
| 	sg->base.counter += cycle;
 | |
| 	while (sg->base.counter >= (sg->base.t + 1))
 | |
| 	{
 | |
| 		sg->addr++;
 | |
| 		sg->base.counter -= (sg->base.t + 1);
 | |
| 	}
 | |
| 	int wave = (sg->wave[(sg->addr >> 1) & 0xf] >> ((sg->addr & 1) << 2)) & 0xf;
 | |
| 	if (wave & 0x8)
 | |
| 	{
 | |
| 		wave = -(0x8 - (wave & 0x7));
 | |
| 	}
 | |
| 	sg->base.out = (wave * sg->base.level) >> 1; // scale out to 8bit
 | |
| }
 | |
| 
 | |
| void sm8521_noise_tick(struct sm8521_noise_t *noise, const int cycle)
 | |
| {
 | |
| 	noise->base.counter += cycle;
 | |
| 	while (noise->base.counter >= (noise->base.t + 1))
 | |
| 	{
 | |
|                 // unknown algorithm, but don't use rand()
 | |
| 		noise->lfsr = ( noise->lfsr>>1|(((noise->lfsr) ^ (noise->lfsr >> 5) ^ (noise->lfsr >> 8) ^ (noise->lfsr >> 13) ) & 1)<<31);
 | |
| 		noise->base.counter -= (noise->base.t + 1);
 | |
| 	}
 | |
| 	noise->base.out = (((noise->lfsr & 0x1) ? 7 : -8) * noise->base.level) >> 1; // scale out to 8bit
 | |
| }
 | |
| 
 | |
| void sm8521_sound_tick(struct sm8521_t *sm8521, const int cycle)
 | |
| {
 | |
| 	int out = 0;
 | |
| 	if (sm8521->sgc & SM8521_SGC_SONDOUT)
 | |
| 	{
 | |
| 		if (sm8521->sgc & SM8521_SGC_DIROUT)
 | |
| 		{
 | |
| 			out = sm8521->sgda - 0x80;
 | |
| 		}
 | |
| 		else
 | |
| 		{
 | |
| 			if (sm8521->sgc & SM8521_SGC_SG0OUT)
 | |
| 			{
 | |
| 				sm8521_sg_wave_tick(&sm8521->sg[0], cycle);
 | |
| 				out += sm8521->sg[0].base.out;
 | |
| 			}
 | |
| 			if (sm8521->sgc & SM8521_SGC_SG1OUT)
 | |
| 			{
 | |
| 				sm8521_sg_wave_tick(&sm8521->sg[1], cycle);
 | |
| 				out += sm8521->sg[1].base.out;
 | |
| 			}
 | |
| 			if (sm8521->sgc & SM8521_SGC_SG2OUT)
 | |
| 			{
 | |
| 				sm8521_noise_tick(&sm8521->noise, cycle);
 | |
| 				out += sm8521->noise.base.out;
 | |
| 			}
 | |
| 			out = (out < -0x80) ? -0x80 : ((out > 0x7f) ? 0x7f : out); // clamp
 | |
| 		}
 | |
| 	}
 | |
| 	sm8521->out = out;
 | |
| }
 | |
| 
 | |
| void sm8521_reset(struct sm8521_t *sm8521)
 | |
| {
 | |
| 	for (int i = 0; i < 2; i++)
 | |
| 	{
 | |
| 		sm8521->sg[i].base.t = 0;
 | |
| 		sm8521->sg[i].base.level = 0;
 | |
| 		sm8521->sg[i].base.out = 0;
 | |
| 		sm8521->sg[i].base.counter = 0;
 | |
| 		sm8521->sg[i].addr = 0;
 | |
| 		for (int j = 0; j < 16; j++)
 | |
| 		{
 | |
| 			sm8521->sg[i].wave[j] = 0;
 | |
| 		}
 | |
| 	}
 | |
| 	sm8521->noise.base.t = 0;
 | |
| 	sm8521->noise.base.level = 0;
 | |
| 	sm8521->noise.base.out = 0;
 | |
| 	sm8521->noise.base.counter = 0;
 | |
| 	sm8521->noise.lfsr = 0x89abcdef;
 | |
| 	sm8521->out = 0;
 | |
| 	sm8521->sgda = 0;
 | |
| 	sm8521->sgc = 0;
 | |
| }
 | |
| 
 | |
| unsigned char sm8521_read(struct sm8521_t *sm8521, const unsigned char a)
 | |
| {
 | |
| 	if ((a & 0xe0) == 0x60)
 | |
| 	{
 | |
| 		if ((a & 0x10) && (!(sm8521->sgc & SM8521_SGC_SG1OUT))) // 0x70-0x7f SG1W0-15
 | |
| 		{
 | |
| 			return sm8521->sg[1].wave[a & 0xf];
 | |
| 		}
 | |
| 		else if ((!(a & 0x10)) && (!(sm8521->sgc & SM8521_SGC_SG0OUT))) // 0x60-0x6f SG0W0-15
 | |
| 		{
 | |
| 			return sm8521->sg[0].wave[a & 0xf];
 | |
| 		}
 | |
| 		return 0;
 | |
| 	}
 | |
| 	switch (a)
 | |
| 	{
 | |
| 		case 0x40: // SGC
 | |
| 			return sm8521->sgc;
 | |
| 			break;
 | |
| 		case 0x42: // SG0L
 | |
| 			return sm8521->sg[0].base.level & 0x1f;
 | |
| 			break;
 | |
| 		case 0x44: // SG1L
 | |
| 			return sm8521->sg[1].base.level & 0x1f;
 | |
| 			break;
 | |
| 		case 0x46: // SG0TH
 | |
| 			return (sm8521->sg[0].base.t >> 8) & 0xf;
 | |
| 			break;
 | |
| 		case 0x47: // SG0TL
 | |
| 			return sm8521->sg[0].base.t & 0xff;
 | |
| 			break;
 | |
| 		case 0x48: // SG1TH
 | |
| 			return (sm8521->sg[1].base.t >> 8) & 0xf;
 | |
| 			break;
 | |
| 		case 0x49: // SG1TL
 | |
| 			return sm8521->sg[1].base.t & 0x0ff;
 | |
| 			break;
 | |
| 		case 0x4a: // SG2L
 | |
| 			return sm8521->noise.base.level & 0x1f;
 | |
| 			break;
 | |
| 		case 0x4c: // SG2TH
 | |
| 			return (sm8521->noise.base.t >> 8) & 0xf;
 | |
| 			break;
 | |
| 		case 0x4d: // SG2TL
 | |
| 			return sm8521->noise.base.t & 0xff;
 | |
| 			break;
 | |
| 		default:
 | |
| 			return 0;
 | |
| 			break;
 | |
| 	}
 | |
| }
 | |
| void sm8521_write(struct sm8521_t *sm8521, const unsigned char a, const unsigned char d)
 | |
| {
 | |
| 	if ((a & 0xe0) == 0x60)
 | |
| 	{
 | |
| 		if ((a & 0x10) && (!(sm8521->sgc & SM8521_SGC_SG1OUT))) // 0x70-0x7f SG1W0-15
 | |
| 		{
 | |
| 			sm8521->sg[1].wave[a & 0xf] = d;
 | |
| 		}
 | |
| 		else if ((!(a & 0x10)) && (!(sm8521->sgc & SM8521_SGC_SG0OUT))) // 0x60-0x6f SG0W0-15
 | |
| 		{
 | |
| 			sm8521->sg[0].wave[a & 0xf] = d;
 | |
| 		}
 | |
| 		return;
 | |
| 	}
 | |
| 	switch (a)
 | |
| 	{
 | |
| 		case 0x40: // SGC
 | |
| 			sm8521->sgc = d;
 | |
| 			break;
 | |
| 		case 0x42: // SG0L
 | |
| 			sm8521->sg[0].base.level = d & 0x1f;
 | |
| 			break;
 | |
| 		case 0x44: // SG1L
 | |
| 			sm8521->sg[1].base.level = d & 0x1f;
 | |
| 			break;
 | |
| 		case 0x46: // SG0TH
 | |
| 			sm8521->sg[0].base.t = (sm8521->sg[0].base.t & 0x0ff) | ((d << 8) & 0xf00);
 | |
| 			break;
 | |
| 		case 0x47: // SG0TL
 | |
| 			sm8521->sg[0].base.t = (sm8521->sg[0].base.t & 0xf00) | (d & 0x0ff);
 | |
| 			break;
 | |
| 		case 0x48: // SG1TH
 | |
| 			sm8521->sg[1].base.t = (sm8521->sg[1].base.t & 0x0ff) | ((d << 8) & 0xf00);
 | |
| 			break;
 | |
| 		case 0x49: // SG1TL
 | |
| 			sm8521->sg[1].base.t = (sm8521->sg[1].base.t & 0xf00) | (d & 0x0ff);
 | |
| 			break;
 | |
| 		case 0x4a: // SG2L
 | |
| 			sm8521->noise.base.level = d & 0x1f;
 | |
| 			break;
 | |
| 		case 0x4c: // SG2TH
 | |
| 			sm8521->noise.base.t = (sm8521->noise.base.t & 0x0ff) | ((d << 8) & 0xf00);
 | |
| 			break;
 | |
| 		case 0x4d: // SG2TL
 | |
| 			sm8521->noise.base.t = (sm8521->noise.base.t & 0xf00) | (d & 0x0ff);
 | |
| 			break;
 | |
| 		case 0x4e: // SGDA
 | |
| 			sm8521->sgda = d;
 | |
| 			break;
 | |
| 	}
 | |
| }
 | 
