n_resample.c
3.52 KB
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
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
/*====================================================================
*
* Copyright 1993, Silicon Graphics, Inc.
* All Rights Reserved.
*
* This is UNPUBLISHED PROPRIETARY SOURCE CODE of Silicon Graphics,
* Inc.; the contents of this file may not be disclosed to third
* parties, copied or duplicated in any form, in whole or in part,
* without the prior written permission of Silicon Graphics, Inc.
*
* RESTRICTED RIGHTS LEGEND:
* Use, duplication or disclosure by the Government is subject to
* restrictions as set forth in subdivision (c)(1)(ii) of the Rights
* in Technical Data and Computer Software clause at DFARS
* 252.227-7013, and/or in similar or successor clauses in the FAR,
* DOD or NASA FAR Supplement. Unpublished - rights reserved under the
* Copyright Laws of the United States.
*====================================================================*/
#include "n_synthInternals.h"
#include <os.h>
#ifdef AUD_PROFILE
extern u32 cnt_index, resampler_num, resampler_cnt, resampler_max, resampler_min, lastCnt[];
#endif
/***********************************************************************
* Resampler filter public interfaces
***********************************************************************/
Acmd *n_alResamplePull(N_PVoice *e, s16 *outp, Acmd *p)
{
Acmd *ptr = p;
s16 inp;
s32 inCount;
s32 incr;
f32 finCount;
#ifdef AUD_PROFILE
lastCnt[++cnt_index] = osGetCount();
#endif
#ifndef N_MICRO
inp = AL_DECODER_OUT;
#else
inp = N_AL_DECODER_OUT;
#endif
/*
* check if resampler is required
*/
if (e->rs_upitch) {
ptr = n_alAdpcmPull(e, &inp, FIXED_SAMPLE, p);
aDMEMMove(ptr++, inp, *outp , FIXED_SAMPLE<<1);
} else {
/*
* clip to maximum allowable pitch
* FIXME: should we check for some minimum as well?
*/
if (e->rs_ratio > MAX_RATIO) e->rs_ratio = MAX_RATIO;
/*
* quantize the pitch
*/
e->rs_ratio = (s32)(e->rs_ratio * UNITY_PITCH);
e->rs_ratio = e->rs_ratio / UNITY_PITCH;
/*
* determine how many samples to generate
*/
finCount = e->rs_delta + (e->rs_ratio * (f32)FIXED_SAMPLE);
inCount = (s32) finCount;
e->rs_delta = finCount - (f32)inCount;
/*
* ask all filters upstream from us to build their command
* lists.
*/
ptr = n_alAdpcmPull(e, &inp,inCount, p);
/*
* construct our portion of the command list
*/
incr = (s32)(e->rs_ratio * UNITY_PITCH);
#ifndef N_MICRO
aSetBuffer(ptr++, 0, inp , *outp, FIXED_SAMPLE<<1);
aResample(ptr++, e->rs_first, incr, osVirtualToPhysical(e->rs_state));
#else
#include "n_resample_add01.c"
#endif
e->rs_first = 0;
}
#ifdef AUD_PROFILE
PROFILE_AUD(resampler_num, resampler_cnt, resampler_max, resampler_min);
#endif
return ptr;
}
s32 n_alResampleParam(N_PVoice *filter, s32 paramID, void *param)
{
N_PVoice *r = filter;
union {
f32 f;
s32 i;
} data;
switch (paramID) {
#if 0
case (AL_FILTER_RESET):
r->rs_delta = 0.0;
r->rs_first = 1;
r->rs_upitch = 0;
n_alLoadParam(filter, AL_FILTER_RESET, 0);
break;
case (AL_FILTER_START):
n_alLoadParam(filter, AL_FILTER_START, 0);
break;
case (AL_FILTER_SET_PITCH):
data.i = (s32) param;
r->rs_ratio = data.f;
break;
case (AL_FILTER_SET_UNITY_PITCH):
r->rs_upitch = 1;
break;
#endif
default:
n_alLoadParam(filter, paramID, param);
break;
}
return 0;
}