/sound.c

https://github.com/zodttd/gameboy4iphone · C · 483 lines · 410 code · 48 blank · 25 comment · 82 complexity · e323a1384883b7f5642399b39ea4241d MD5 · raw file 

    

  1. #include "defs.h"

    2. 

  2. #include "pcm.h"

    3. 

  3. #include "sound.h"

    4. 

  4. #include "cpu.h"

    5. 

  5. #include "hw.h"

    6. 

  6. #include "regs.h"

    7. 

  7. #include "rc.h"

    8. 

  8. #include "noise.h"

    9. 

  9. 

    10. 

  10. 

    11. 

  11. const static byte dmgwave[16] =

    12. 

  12. {

    13. 

  13. 	0xac, 0xdd, 0xda, 0x48,

    14. 

  14. 	0x36, 0x02, 0xcf, 0x16,

    15. 

  15. 	0x2c, 0x04, 0xe5, 0x2c,

    16. 

  16. 	0xac, 0xdd, 0xda, 0x48

    17. 

  17. };

    18. 

  18. 

    19. 

  19. const static byte cgbwave[16] =

    20. 

  20. {

    21. 

  21. 	0x00, 0xff, 0x00, 0xff,

    22. 

  22. 	0x00, 0xff, 0x00, 0xff,

    23. 

  23. 	0x00, 0xff, 0x00, 0xff,

    24. 

  24. 	0x00, 0xff, 0x00, 0xff,

    25. 

  25. };

    26. 

  26. 

    27. 

  27. const static byte sqwave[4][8] =

    28. 

  28. {

    29. 

  29. 	{  0, 0,-1, 0, 0, 0, 0, 0 },

    30. 

  30. 	{  0,-1,-1, 0, 0, 0, 0, 0 },

    31. 

  31. 	{ -1,-1,-1,-1, 0, 0, 0, 0 },

    32. 

  32. 	{ -1, 0, 0,-1,-1,-1,-1,-1 }

    33. 

  33. };

    34. 

  34. 

    35. 

  35. const static int freqtab[8] =

    36. 

  36. {

    37. 

  37. 	(1<<14)*2,

    38. 

  38. 	(1<<14),

    39. 

  39. 	(1<<14)/2,

    40. 

  40. 	(1<<14)/3,

    41. 

  41. 	(1<<14)/4,

    42. 

  42. 	(1<<14)/5,

    43. 

  43. 	(1<<14)/6,

    44. 

  44. 	(1<<14)/7

    45. 

  45. };

    46. 

  46. 

    47. 

  47. struct snd snd;

    48. 

  48. 

    49. 

  49. #define RATE (snd.rate)

    50. 

  50. #define WAVE (snd.wave) /* ram.hi+0x30 */

    51. 

  51. #define S1 (snd.ch[0])

    52. 

  52. #define S2 (snd.ch[1])

    53. 

  53. #define S3 (snd.ch[2])

    54. 

  54. #define S4 (snd.ch[3])

    55. 

  55. 

    56. 

  56. rcvar_t sound_exports[] =

    57. 

  57. {

    58. 

  58. 	RCV_END

    59. 

  59. };

    60. 

  60. 

    61. 

  61. 

    62. 

  62. static void s1_freq_d(int d)

    63. 

  63. {

    64. 

  64. 	if (RATE > (d<<4)) S1.freq = 0;

    65. 

  65. 	else S1.freq = (RATE << 17)/d;

    66. 

  66. }

    67. 

  67. 

    68. 

  68. static void s1_freq()

    69. 

  69. {

    70. 

  70. 	s1_freq_d(2048 - (((R_NR14&7)<<8) + R_NR13));

    71. 

  71. }

    72. 

  72. 

    73. 

  73. static void s2_freq()

    74. 

  74. {

    75. 

  75. 	int d = 2048 - (((R_NR24&7)<<8) + R_NR23);

    76. 

  76. 	if (RATE > (d<<4)) S2.freq = 0;

    77. 

  77. 	else S2.freq = (RATE << 17)/d;

    78. 

  78. }

    79. 

  79. 

    80. 

  80. static void s3_freq()

    81. 

  81. {

    82. 

  82. 	int d = 2048 - (((R_NR34&7)<<8) + R_NR33);

    83. 

  83. 	if (RATE > (d<<3)) S3.freq = 0;

    84. 

  84. 	else S3.freq = (RATE << 21)/d;

    85. 

  85. }

    86. 

  86. 

    87. 

  87. static void s4_freq()

    88. 

  88. {

    89. 

  89. 	S4.freq = (freqtab[R_NR43&7] >> (R_NR43 >> 4)) * RATE;

    90. 

  90. 	if (S4.freq >> 18) S4.freq = 1<<18;

    91. 

  91. }

    92. 

  92. 

    93. 

  93. void sound_dirty()

    94. 

  94. {

    95. 

  95. 	S1.swlen = ((R_NR10>>4) & 7) << 14;

    96. 

  96. 	S1.len = (64-(R_NR11&63)) << 13;

    97. 

  97. 	S1.envol = R_NR12 >> 4;

    98. 

  98. 	S1.endir = (R_NR12>>3) & 1;

    99. 

  99. 	S1.endir |= S1.endir - 1;

    100. 

  100. 	S1.enlen = (R_NR12 & 7) << 15;

    101. 

  101. 	s1_freq();

    102. 

  102. 	S2.len = (64-(R_NR21&63)) << 13;

    103. 

  103. 	S2.envol = R_NR22 >> 4;

    104. 

  104. 	S2.endir = (R_NR22>>3) & 1;

    105. 

  105. 	S2.endir |= S2.endir - 1;

    106. 

  106. 	S2.enlen = (R_NR22 & 7) << 15;

    107. 

  107. 	s2_freq();

    108. 

  108. 	S3.len = (256-R_NR31) << 20;

    109. 

  109. 	s3_freq();

    110. 

  110. 	S4.len = (64-(R_NR41&63)) << 13;

    111. 

  111. 	S4.envol = R_NR42 >> 4;

    112. 

  112. 	S4.endir = (R_NR42>>3) & 1;

    113. 

  113. 	S4.endir |= S4.endir - 1;

    114. 

  114. 	S4.enlen = (R_NR42 & 7) << 15;

    115. 

  115. 	s4_freq();

    116. 

  116. }

    117. 

  117. 

    118. 

  118. void sound_off()

    119. 

  119. {

    120. 

  120. 	memset(&S1, 0, sizeof S1);

    121. 

  121. 	memset(&S2, 0, sizeof S2);

    122. 

  122. 	memset(&S3, 0, sizeof S3);

    123. 

  123. 	memset(&S4, 0, sizeof S4);

    124. 

  124. 	R_NR10 = 0x80;

    125. 

  125. 	R_NR11 = 0xBF;

    126. 

  126. 	R_NR12 = 0xF3;

    127. 

  127. 	R_NR14 = 0xBF;

    128. 

  128. 	R_NR21 = 0x3F;

    129. 

  129. 	R_NR22 = 0x00;

    130. 

  130. 	R_NR24 = 0xBF;

    131. 

  131. 	R_NR30 = 0x7F;

    132. 

  132. 	R_NR31 = 0xFF;

    133. 

  133. 	R_NR32 = 0x9F;

    134. 

  134. 	R_NR33 = 0xBF;

    135. 

  135. 	R_NR41 = 0xFF;

    136. 

  136. 	R_NR42 = 0x00;

    137. 

  137. 	R_NR43 = 0x00;

    138. 

  138. 	R_NR44 = 0xBF;

    139. 

  139. 	R_NR50 = 0x77;

    140. 

  140. 	R_NR51 = 0xF3;

    141. 

  141. 	R_NR52 = 0xF1;

    142. 

  142. 	sound_dirty();

    143. 

  143. }

    144. 

  144. 

    145. 

  145. void sound_reset()

    146. 

  146. {

    147. 

  147. 	memset(&snd, 0, sizeof snd);

    148. 

  148. 	if (pcm.hz) snd.rate = (1<<21) / pcm.hz;

    149. 

  149. 	else snd.rate = 0;

    150. 

  150. 	memcpy(WAVE, hw.cgb ? cgbwave : dmgwave, 16);

    151. 

  151. 	memcpy(ram.hi+0x30, WAVE, 16);

    152. 

  152. 	sound_off();

    153. 

  153. }

    154. 

  154. 

    155. 

  155. 

    156. 

  156. void sound_mix(short *sndbuf,int len)

    157. 

  157. {

    158. 

  158. 	int s, l, r, f, n;

    159. 

  159. 

    160. 

  160. //       if (!RATE || cpu.snd < RATE) return;

    161. 

  161. 

    162. 

  162. //       for (; cpu.snd >= RATE; cpu.snd -= RATE)

    163. 

  163.        while(len--)

    164. 

  164. 	{

    165. 

  165. 		l = r = 0;

    166. 

  166. 

    167. 

  167. 		if (S1.on)

    168. 

  168. 		{

    169. 

  169. 			s = sqwave[R_NR11>>6][(S1.pos>>18)&7] & S1.envol;

    170. 

  170. 			S1.pos += S1.freq;

    171. 

  171. 			if ((R_NR14 & 64) && ((S1.cnt += RATE) >= S1.len))

    172. 

  172. 				S1.on = 0;

    173. 

  173. 			if (S1.enlen && (S1.encnt += RATE) >= S1.enlen)

    174. 

  174. 			{

    175. 

  175. 				S1.encnt -= S1.enlen;

    176. 

  176. 				S1.envol += S1.endir;

    177. 

  177. 				if (S1.envol < 0) S1.envol = 0;

    178. 

  178. 				if (S1.envol > 15) S1.envol = 15;

    179. 

  179. 			}

    180. 

  180. 			if (S1.swlen && (S1.swcnt += RATE) >= S1.swlen)

    181. 

  181. 			{

    182. 

  182. 				S1.swcnt -= S1.swlen;

    183. 

  183. 				f = S1.swfreq;

    184. 

  184. 				n = (R_NR10 & 7);

    185. 

  185. 				if (R_NR10 & 8) f -= (f >> n);

    186. 

  186. 				else f += (f >> n);

    187. 

  187. 				if (f > 2047)

    188. 

  188. 					S1.on = 0;

    189. 

  189. 				else

    190. 

  190. 				{

    191. 

  191. 					S1.swfreq = f;

    192. 

  192. 					R_NR13 = f;

    193. 

  193. 					R_NR14 = (R_NR14 & 0xF8) | (f>>8);

    194. 

  194. 					s1_freq_d(2048 - f);

    195. 

  195. 				}

    196. 

  196. 			}

    197. 

  197. 			s <<= 2;

    198. 

  198. 			if (R_NR51 & 1) r += s;

    199. 

  199. 			if (R_NR51 & 16) l += s;

    200. 

  200. 		}

    201. 

  201. 

    202. 

  202. 		if (S2.on)

    203. 

  203. 		{

    204. 

  204. 			s = sqwave[R_NR21>>6][(S2.pos>>18)&7] & S2.envol;

    205. 

  205. 			S2.pos += S2.freq;

    206. 

  206. 			if ((R_NR24 & 64) && ((S2.cnt += RATE) >= S2.len))

    207. 

  207. 				S2.on = 0;

    208. 

  208. 			if (S2.enlen && (S2.encnt += RATE) >= S2.enlen)

    209. 

  209. 			{

    210. 

  210. 				S2.encnt -= S2.enlen;

    211. 

  211. 				S2.envol += S2.endir;

    212. 

  212. 				if (S2.envol < 0) S2.envol = 0;

    213. 

  213. 				if (S2.envol > 15) S2.envol = 15;

    214. 

  214. 			}

    215. 

  215. 			s <<= 2;

    216. 

  216. 			if (R_NR51 & 2) r += s;

    217. 

  217. 			if (R_NR51 & 32) l += s;

    218. 

  218. 		}

    219. 

  219. 

    220. 

  220. 		if (S3.on)

    221. 

  221. 		{

    222. 

  222. 			s = WAVE[(S3.pos>>22) & 15];

    223. 

  223. 			if (S3.pos & (1<<21)) s &= 15;

    224. 

  224. 			else s >>= 4;

    225. 

  225. 			s -= 8;

    226. 

  226. 			S3.pos += S3.freq;

    227. 

  227. 			if ((R_NR34 & 64) && ((S3.cnt += RATE) >= S3.len))

    228. 

  228. 				S3.on = 0;

    229. 

  229. 			if (R_NR32 & 96) s <<= (3 - ((R_NR32>>5)&3));

    230. 

  230. 			else s = 0;

    231. 

  231. 			if (R_NR51 & 4) r += s;

    232. 

  232. 			if (R_NR51 & 64) l += s;

    233. 

  233. 		}

    234. 

  234. 

    235. 

  235. 		if (S4.on)

    236. 

  236. 		{

    237. 

  237. 			if (R_NR43 & 8) s = 1 & (noise7[

    238. 

  238. 				(S4.pos>>20)&15] >> (7-((S4.pos>>17)&7)));

    239. 

  239. 			else s = 1 & (noise15[

    240. 

  240. 				(S4.pos>>20)&4095] >> (7-((S4.pos>>17)&7)));

    241. 

  241. 			s = (-s) & S4.envol;

    242. 

  242. 			S4.pos += S4.freq;

    243. 

  243. 			if ((R_NR44 & 64) && ((S4.cnt += RATE) >= S4.len))

    244. 

  244. 				S4.on = 0;

    245. 

  245. 			if (S4.enlen && (S4.encnt += RATE) >= S4.enlen)

    246. 

  246. 			{

    247. 

  247. 				S4.encnt -= S4.enlen;

    248. 

  248. 				S4.envol += S4.endir;

    249. 

  249. 				if (S4.envol < 0) S4.envol = 0;

    250. 

  250. 				if (S4.envol > 15) S4.envol = 15;

    251. 

  251. 			}

    252. 

  252. 			s += s << 1;

    253. 

  253. 			if (R_NR51 & 8) r += s;

    254. 

  254. 			if (R_NR51 & 128) l += s;

    255. 

  255. 		}

    256. 

  256. 

    257. 

  257. 		l *= (R_NR50 & 0x07);

    258. 

  258. 		r *= ((R_NR50 & 0x70)>>4);

    259. 

  259. 		//l /= 16;

    260. 

  260. 		//r /= 16;

    261. 

  261. 

    262. 

  262. 		if (l > 511) l = 511;

    263. 

  263. 		else if (l < -512) l = -512;

    264. 

  264. 		if (r > 511) r = 511;

    265. 

  265. 		else if (r < -512) r = -512;

    266. 

  266. 

    267. 

  267. 		//l *= 128;

    268. 

  268. 		//r *= 128;

    269. 

  269. 

    270. 

  270. 		//if (l > 32767) l = 32767;

    271. 

  271. 		//else if (l < -32768) l = -32768;

    272. 

  272. 		//if (r > 32767) r = 32767;

    273. 

  273. 		//else if (r < -32768) r = -32768;

    274. 

  274. 

    275. 

  275. 

    276. 

  276. /*		if (pcm.buf)

    277. 

  277. 		{

    278. 

  278.                      if (pcm.pos >= pcm.len)

    279. 

  279.                             pcm_submit();

    280. 

  280. 			if (pcm.stereo)

    281. 

  281. 			{

    282. 

  282. 				pcm.buf[pcm.pos++] = l+128;

    283. 

  283. 				pcm.buf[pcm.pos++] = r+128;

    284. 

  284. 

    285. 

  285. 			}

    286. 

  286.                      else   pcm.buf[pcm.pos++] = ((l+r)>>1)+128;

    287. 

  287.               }*/

    288. 

  288.         if (sndbuf)

    289. 

  289. 		{

    290. 

  290. 			if (pcm.stereo)

    291. 

  291. 			{

    292. 

  292. 				*sndbuf++ = l * 64; //+128;

    293. 

  293. 				*sndbuf++ = r * 64; //+128;

    294. 

  294. 			}

    295. 

  295.             else *sndbuf++ = ((l+r)/2) * 64; //+128;

    296. 

  296.         }

    297. 

  297. 	}

    298. 

  298. 	R_NR52 = (R_NR52&0xf0) | S1.on | (S2.on<<1) | (S3.on<<2) | (S4.on<<3);

    299. 

  299. }

    300. 

  300. 

    301. 

  301. 

    302. 

  302. 

    303. 

  303. byte sound_read(byte r)

    304. 

  304. {

    305. 

  305. //       sound_mix(); //gp32

    306. 

  306. 	/* printf("read %02X: %02X\n", r, REG(r)); */

    307. 

  307. 	return REG(r);

    308. 

  308. }

    309. 

  309. 

    310. 

  310. void s1_init()

    311. 

  311. {

    312. 

  312. 	S1.swcnt = 0;

    313. 

  313. 	S1.swfreq = ((R_NR14&7)<<8) + R_NR13;

    314. 

  314. 	S1.envol = R_NR12 >> 4;

    315. 

  315. 	S1.endir = (R_NR12>>3) & 1;

    316. 

  316. 	S1.endir |= S1.endir - 1;

    317. 

  317. 	S1.enlen = (R_NR12 & 7) << 15;

    318. 

  318. 	if (!S1.on) S1.pos = 0;

    319. 

  319. 	S1.on = 1;

    320. 

  320. 	S1.cnt = 0;

    321. 

  321. 	S1.encnt = 0;

    322. 

  322. }

    323. 

  323. 

    324. 

  324. void s2_init()

    325. 

  325. {

    326. 

  326. 	S2.envol = R_NR22 >> 4;

    327. 

  327. 	S2.endir = (R_NR22>>3) & 1;

    328. 

  328. 	S2.endir |= S2.endir - 1;

    329. 

  329. 	S2.enlen = (R_NR22 & 7) << 15;

    330. 

  330. 	if (!S2.on) S2.pos = 0;

    331. 

  331. 	S2.on = 1;

    332. 

  332. 	S2.cnt = 0;

    333. 

  333. 	S2.encnt = 0;

    334. 

  334. }

    335. 

  335. 

    336. 

  336. void s3_init()

    337. 

  337. {

    338. 

  338. 	int i;

    339. 

  339. 	if (!S3.on) S3.pos = 0;

    340. 

  340. 	S3.cnt = 0;

    341. 

  341. 	S3.on = R_NR30 >> 7;

    342. 

  342. 	if (S3.on) for (i = 0; i < 16; i++)

    343. 

  343. 		ram.hi[i+0x30] = 0x13 ^ ram.hi[i+0x31];

    344. 

  344. }

    345. 

  345. 

    346. 

  346. void s4_init()

    347. 

  347. {

    348. 

  348. 	S4.envol = R_NR42 >> 4;

    349. 

  349. 	S4.endir = (R_NR42>>3) & 1;

    350. 

  350. 	S4.endir |= S4.endir - 1;

    351. 

  351. 	S4.enlen = (R_NR42 & 7) << 15;

    352. 

  352. 	S4.on = 1;

    353. 

  353. 	S4.pos = 0;

    354. 

  354. 	S4.cnt = 0;

    355. 

  355. 	S4.encnt = 0;

    356. 

  356. }

    357. 

  357. 

    358. 

  358. 

    359. 

  359. void sound_write(byte r, byte b)

    360. 

  360. {

    361. 

  361. #if 0

    362. 

  362. 	static void *timer;

    363. 

  363. 	if (!timer) timer = sys_timer();

    364. 

  364. 	printf("write %02X: %02X @ %d\n", r, b, sys_elapsed(timer));

    365. 

  365. #endif

    366. 

  366. 

    367. 

  367. 	if (!(R_NR52 & 128) && r != RI_NR52) return;

    368. 

  368. 	if ((r & 0xF0) == 0x30)

    369. 

  369. 	{

    370. 

  370.               if (S3.on) ;//sound_mix(); //gp32

    371. 

  371. 		if (!S3.on)

    372. 

  372. 			WAVE[r-0x30] = ram.hi[r] = b;

    373. 

  373. 		return;

    374. 

  374. 	}

    375. 

  375.        //sound_mix(); //gp32

    376. 

  376. 	switch (r)

    377. 

  377. 	{

    378. 

  378. 	case RI_NR10:

    379. 

  379. 		R_NR10 = b;

    380. 

  380. 		S1.swlen = ((R_NR10>>4) & 7) << 14;

    381. 

  381. 		S1.swfreq = ((R_NR14&7)<<8) + R_NR13;

    382. 

  382. 		break;

    383. 

  383. 	case RI_NR11:

    384. 

  384. 		R_NR11 = b;

    385. 

  385. 		S1.len = (64-(R_NR11&63)) << 13;

    386. 

  386. 		break;

    387. 

  387. 	case RI_NR12:

    388. 

  388. 		R_NR12 = b;

    389. 

  389. 		S1.envol = R_NR12 >> 4;

    390. 

  390. 		S1.endir = (R_NR12>>3) & 1;

    391. 

  391. 		S1.endir |= S1.endir - 1;

    392. 

  392. 		S1.enlen = (R_NR12 & 7) << 15;

    393. 

  393. 		break;

    394. 

  394. 	case RI_NR13:

    395. 

  395. 		R_NR13 = b;

    396. 

  396. 		s1_freq();

    397. 

  397. 		break;

    398. 

  398. 	case RI_NR14:

    399. 

  399. 		R_NR14 = b;

    400. 

  400. 		s1_freq();

    401. 

  401. 		if (b & 128) s1_init();

    402. 

  402. 		break;

    403. 

  403. 	case RI_NR21:

    404. 

  404. 		R_NR21 = b;

    405. 

  405. 		S2.len = (64-(R_NR21&63)) << 13;

    406. 

  406. 		break;

    407. 

  407. 	case RI_NR22:

    408. 

  408. 		R_NR22 = b;

    409. 

  409. 		S2.envol = R_NR22 >> 4;

    410. 

  410. 		S2.endir = (R_NR22>>3) & 1;

    411. 

  411. 		S2.endir |= S2.endir - 1;

    412. 

  412. 		S2.enlen = (R_NR22 & 7) << 15;

    413. 

  413. 		break;

    414. 

  414. 	case RI_NR23:

    415. 

  415. 		R_NR23 = b;

    416. 

  416. 		s2_freq();

    417. 

  417. 		break;

    418. 

  418. 	case RI_NR24:

    419. 

  419. 		R_NR24 = b;

    420. 

  420. 		s2_freq();

    421. 

  421. 		if (b & 128) s2_init();

    422. 

  422. 		break;

    423. 

  423. 	case RI_NR30:

    424. 

  424. 		R_NR30 = b;

    425. 

  425. 		if (!(b & 128)) S3.on = 0;

    426. 

  426. 		break;

    427. 

  427. 	case RI_NR31:

    428. 

  428. 		R_NR31 = b;

    429. 

  429. 		S3.len = (256-R_NR31) << 13;

    430. 

  430. 		break;

    431. 

  431. 	case RI_NR32:

    432. 

  432. 		R_NR32 = b;

    433. 

  433. 		break;

    434. 

  434. 	case RI_NR33:

    435. 

  435. 		R_NR33 = b;

    436. 

  436. 		s3_freq();

    437. 

  437. 		break;

    438. 

  438. 	case RI_NR34:

    439. 

  439. 		R_NR34 = b;

    440. 

  440. 		s3_freq();

    441. 

  441. 		if (b & 128) s3_init();

    442. 

  442. 		break;

    443. 

  443. 	case RI_NR41:

    444. 

  444. 		R_NR41 = b;

    445. 

  445. 		S4.len = (64-(R_NR41&63)) << 13;

    446. 

  446. 		break;

    447. 

  447. 	case RI_NR42:

    448. 

  448. 		R_NR42 = b;

    449. 

  449. 		S4.envol = R_NR42 >> 4;

    450. 

  450. 		S4.endir = (R_NR42>>3) & 1;

    451. 

  451. 		S4.endir |= S4.endir - 1;

    452. 

  452. 		S4.enlen = (R_NR42 & 7) << 15;

    453. 

  453. 		break;

    454. 

  454. 	case RI_NR43:

    455. 

  455. 		R_NR43 = b;

    456. 

  456. 		s4_freq();

    457. 

  457. 		break;

    458. 

  458. 	case RI_NR44:

    459. 

  459. 		R_NR44 = b;

    460. 

  460. 		if (b & 128) s4_init();

    461. 

  461. 		break;

    462. 

  462. 	case RI_NR50:

    463. 

  463. 		R_NR50 = b;

    464. 

  464. 		break;

    465. 

  465. 	case RI_NR51:

    466. 

  466. 		R_NR51 = b;

    467. 

  467. 		break;

    468. 

  468. 	case RI_NR52:

    469. 

  469. 		R_NR52 = b;

    470. 

  470. 		if (!(R_NR52 & 128))

    471. 

  471. 			sound_off();

    472. 

  472. 		break;

    473. 

  473. 	default:

    474. 

  474. 		return;

    475. 

  475. 	}

    476. 

  476. }
    477.