Debian Codegraph @

modules/lsp-dsp-lib/include/private/dsp/arch/aarch64/asimd/pfft.h

raw
1 /*
2 * Copyright (C) 2026 Linux Studio Plugins Project <https://lsp-plug.in/>
3 * (C) 2026 Vladimir Sadovnikov <[email protected]>
4 *
5 * This file is part of lsp-dsp-lib
6 * Created on: 31 мар. 2020 г.
7 *
8 * lsp-dsp-lib is free software: you can redistribute it and/or modify
9 * it under the terms of the GNU Lesser General Public License as published by
10 * the Free Software Foundation, either version 3 of the License, or
11 * any later version.
12 *
13 * lsp-dsp-lib is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU Lesser General Public License for more details.
17 *
18 * You should have received a copy of the GNU Lesser General Public License
19 * along with lsp-dsp-lib. If not, see <https://www.gnu.org/licenses/>.
20 */
21
22 #ifndef PRIVATE_DSP_ARCH_AARCH64_ASIMD_PFFT_H_
23 #define PRIVATE_DSP_ARCH_AARCH64_ASIMD_PFFT_H_
24
25 #ifndef PRIVATE_DSP_ARCH_AARCH64_ASIMD_IMPL
26 #error "This header should not be included directly"
27 #endif /* PRIVATE_DSP_ARCH_AARCH64_ASIMD_IMPL */
28
29 #include <private/dsp/arch/aarch64/asimd/fft/const.h>
30 #include <private/dsp/arch/aarch64/asimd/fft/pscramble.h>
31 #include <private/dsp/arch/aarch64/asimd/fft/pbutterfly.h>
32
33 namespace lsp
34 {
35 namespace asimd
36 {
37 void packed_direct_fft(float *dst, const float *src, size_t rank)
38 {
39 // Check bounds
40 if (rank <= 2)
41 {
42 if (rank == 2)
43 {
44 float s0_re = src[0] + src[4];
45 float s1_re = src[0] - src[4];
46 float s0_im = src[1] + src[5];
47 float s1_im = src[1] - src[5];
48
49 float s2_re = src[2] + src[6];
50 float s3_re = src[2] - src[6];
51 float s2_im = src[3] + src[7];
52 float s3_im = src[3] - src[7];
53
54 dst[0] = s0_re + s2_re;
55 dst[1] = s0_im + s2_im;
56 dst[2] = s1_re + s3_im;
57 dst[3] = s1_im - s3_re;
58
59 dst[4] = s0_re - s2_re;
60 dst[5] = s0_im - s2_im;
61 dst[6] = s1_re - s3_im;
62 dst[7] = s1_im + s3_re;
63 }
64 else if (rank == 1)
65 {
66 // s0' = s0 + s1
67 // s1' = s0 - s1
68 float s1_re = src[2];
69 float s1_im = src[3];
70 dst[2] = src[0] - s1_re;
71 dst[3] = src[1] - s1_im;
72 dst[0] = src[0] + s1_re;
73 dst[1] = src[1] + s1_im;
74 }
75 else
76 {
77 dst[0] = src[0];
78 dst[1] = src[1];
79 }
80 return;
81 }
82
83 if (dst == src)
84 packed_scramble_self_direct(dst, rank);
85 else
86 packed_scramble_copy_direct(dst, src, rank);
87 packed_direct_butterfly_rank3(dst, 1 << (rank-3));
88
89 for (size_t i=4; i <= rank; ++i)
90 packed_direct_butterfly_rank4p(dst, i, 1 << (rank - i));
91
92 packed_unscramble_direct(dst, rank);
93 }
94
95 void packed_reverse_fft(float *dst, const float *src, size_t rank)
96 {
97 // Check bounds
98 if (rank <= 2)
99 {
100 if (rank == 2)
101 {
102 float s0_re = src[0] + src[4];
103 float s1_re = src[0] - src[4];
104 float s0_im = src[1] + src[5];
105 float s1_im = src[1] - src[5];
106
107 float s2_re = src[2] + src[6];
108 float s3_re = src[2] - src[6];
109 float s2_im = src[3] + src[7];
110 float s3_im = src[3] - src[7];
111
112 dst[0] = (s0_re + s2_re)*0.25f;
113 dst[1] = (s0_im + s2_im)*0.25f;
114 dst[2] = (s1_re - s3_im)*0.25f;
115 dst[3] = (s1_im + s3_re)*0.25f;
116
117 dst[4] = (s0_re - s2_re)*0.25f;
118 dst[5] = (s0_im - s2_im)*0.25f;
119 dst[6] = (s1_re + s3_im)*0.25f;
120 dst[7] = (s1_im - s3_re)*0.25f;
121 }
122 else if (rank == 1)
123 {
124 // s0' = s0 + s1
125 // s1' = s0 - s1
126 float s1_re = src[2];
127 float s1_im = src[3];
128 dst[2] = src[0] - s1_re;
129 dst[3] = src[1] - s1_im;
130 dst[0] = src[0] + s1_re;
131 dst[1] = src[1] + s1_im;
132 }
133 else
134 {
135 dst[0] = src[0];
136 dst[1] = src[1];
137 }
138 return;
139 }
140
141 if (dst == src)
142 packed_scramble_self_reverse(dst, rank);
143 else
144 packed_scramble_copy_reverse(dst, src, rank);
145 packed_reverse_butterfly_rank3(dst, 1 << (rank-3));
146
147 for (size_t i=4; i <= rank; ++i)
148 packed_reverse_butterfly_rank4p(dst, i, 1 << (rank - i));
149
150 packed_unscramble_reverse(dst, rank);
151 }
152 }
153 }
154
155 #endif /* PRIVATE_DSP_ARCH_AARCH64_ASIMD_PFFT_H_ */