summaryrefslogtreecommitdiff
path: root/src/nw4r/snd/snd_adpcm.cpp
blob: 04f7d55a7b1dcb8c56ee54a124669143ca964ca7 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
#include "nw4r/snd/snd_adpcm.h"

/* Original source:
 * kiwi515/ogws
 * src/nw4r/snd/snd_adpcm.cpp
 */

/*******************************************************************************
 * headers
 */

#include <climits>

#include "common.h"

#include <rvl/AX/AXVPB.h> // AXPBADPCM

/*******************************************************************************
 * functions
 */

namespace nw4r { namespace snd { namespace detail {

s16 DecodeDspAdpcm(AXPBADPCM *adpcm, byte_t bits)
{
	s16 yn1 = static_cast<s16>(adpcm->yn1);
	s16 yn2 = static_cast<s16>(adpcm->yn2);

	s16 scale = 1 << (adpcm->pred_scale & 0x0f);
	s16 bits2 = bits << 12;
	u16 index = adpcm->pred_scale >> 4;

	s16 coef0 = adpcm->a[index][0];
	s16 coef1 = adpcm->a[index][1];

	s32 sample = coef0 * yn1;
	sample += coef1 * yn2;
	sample += scale * (bits2 >> 1);
	sample >>= 10;
	sample += 1;
	sample >>= 1;

	if (sample > SHRT_MAX)
		sample = SHRT_MAX;
	else if (sample < SHRT_MIN)
		sample = SHRT_MIN;

	adpcm->yn2 = adpcm->yn1;
	adpcm->yn1 = sample;

	return sample;
}

}}} // namespace nw4r::snd::detail