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
|
#ifndef __M_FIXED_H__
#define __M_FIXED_H__
#ifdef ROCKBOX
#include "plugin.h"
#endif
typedef int t_sample;
#define t_fixed int
#define fix1 18 /* (18) number of bits after comma */
#define fixfac ((float)(1<<fix1)) /* float factor (for scaling ftofix ..) */
/* fixed point multiplication and division */
#if defined(ROCKBOX) && !defined(SIMULATOR)
#if defined(CPU_ARM)
#define mult(A,B) \
({ \
t_fixed lo; \
t_fixed hi; \
asm volatile ( \
"smull %[lo], %[hi], %[x], %[y] \n\t" /* multiply */ \
"mov %[lo], %[lo], lsr %[shr] \n\t" /* lo >>= fix1 */ \
"orr %[lo], %[lo], %[hi], lsl %[shl]" /* lo |= (hi << (32-fix1)) */ \
: [lo]"=&r"(lo), [hi]"=&r"(hi) \
: [x]"r"(A), [y]"r"(B), [shr]"r"(fix1), [shl]"r"(32-fix1)); \
lo; \
})
#define idiv(a,b) ((((long long) (a) )<<fix1)/(long long) (b) )
#else /* CPU_... */
#define mult(a,b) (long long)(((long long) (a) * (long long) (b))>>fix1)
#define idiv(a,b) ((((long long) (a) )<<fix1)/(long long) (b) )
#endif /* CPU_... */
#else /* ROCKBOX && !SIMULATOR */
#define mult(a,b) (long long)(((long long) (a) * (long long) (b))>>fix1)
#define idiv(a,b) ((((long long) (a) )<<fix1)/(long long) (b) )
#endif /* ROCKBOX && !SIMULATOR */
/* conversion macros */
#define itofix(a) ((a) << fix1)
#define ftofix(a) ((t_fixed)( (a) *(double)fixfac + 0.5))
#define fixtof(a) ((double) (a) * 1./(fixfac-0.5))
#define fixtoi(a) ((a) >>fix1)
/* Not working !! */
#define fnum(a) ( (a) >>(fix1-16))
#define ffrac(a) (0)
/* mapping of fft functions */
#ifdef FIXEDPOINT
#define mayer_realifft imayer_realifft
#define mayer_realfft imayer_realfft
#define mayer_fft imayer_fft
#define mayer_ifft imayer_ifft
#endif
#ifdef FIXEDPOINT
#define SCALE16(x) (x>>(fix1-15))
#define SCALE32(x) (x<<(32-fix1))
#define INVSCALE16(x) (x<<8)
#else
#define SCALE16(x) (32767.*x)
#define SCALE32(x) (2147483648.*x)
#define INVSCALE16(x) ((float)3.051850e-05*x)
#endif
#endif
|