-
Notifications
You must be signed in to change notification settings - Fork 29
/
detect.h
306 lines (251 loc) · 10.2 KB
/
detect.h
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
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
/*
Copyright (C) 2017 Gonzalo José Carracedo Carballal
This program is free software: you can redistribute it and/or modify
it under the terms of the GNU Lesser General Public License as
published by the Free Software Foundation, either version 3 of the
License, or (at your option) any later version.
This program is distributed in the hope that it will be useful, but
WITHOUT ANY WARRANTY; without even the implied warranty of
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
GNU Lesser General Public License for more details.
You should have received a copy of the GNU Lesser General Public
License along with this program. If not, see
<http://www.gnu.org/licenses/>
*/
#ifndef _SIGUTILS_DETECT_H
#define _SIGUTILS_DETECT_H
#include "sigutils.h"
#include "ncqo.h"
#include "iir.h"
#include "softtune.h"
#ifdef __cplusplus
# ifdef __clang__
# pragma clang diagnostic push
# pragma clang diagnostic ignored "-Wreturn-type-c-linkage"
# endif // __clang__
extern "C" {
#endif /* __cplusplus */
#define SU_CHANNEL_DETECTOR_MIN_MAJORITY_AGE 0 /* in FFT runs */
#define SU_CHANNEL_DETECTOR_MIN_SNR SU_ADDSFX(6.) /* in DBs */
#define SU_CHANNEL_DETECTOR_MIN_BW SU_ADDSFX(10.) /* in Hz */
#define SU_CHANNEL_DETECTOR_ALPHA SU_ADDSFX(1e-2)
#define SU_CHANNEL_DETECTOR_BETA SU_ADDSFX(1e-3)
#define SU_CHANNEL_DETECTOR_GAMMA SU_ADDSFX(.5)
#define SU_CHANNEL_MAX_AGE 40 /* In FFT runs */
#define SU_CHANNEL_DETECTOR_PEAK_PSD_ALPHA SU_ADDSFX(.25)
#define SU_CHANNEL_DETECTOR_DC_ALPHA SU_ADDSFX(.1)
#define SU_CHANNEL_DETECTOR_AVG_TIME_WINDOW SU_ADDSFX(10.) /* In seconds */
#define SU_CHANNEL_IS_VALID(cp) \
((cp)->age > SU_CHANNEL_DETECTOR_MIN_MAJORITY_AGE \
&& (cp)->snr > SU_CHANNEL_DETECTOR_MIN_SNR \
&& (cp)->bw > SU_CHANNEL_DETECTOR_MIN_BW)
#define SU_CHANNEL_DETECTOR_IDX2ABS_FREQ(detector, i) \
SU_NORM2ABS_FREQ( \
(detector)->params.samp_rate * (detector)->params.decimation, \
2 * (SUFLOAT) (i) / (SUFLOAT) (detector)->params.window_size)
struct sigutils_peak_detector {
unsigned int size;
SUFLOAT thr2; /* In sigmas */
/* State */
SUFLOAT *history;
unsigned int p;
unsigned int count;
SUFLOAT accum; /* Scaled mean */
SUFLOAT inv_size; /* 1. / size */
};
typedef struct sigutils_peak_detector su_peak_detector_t;
#define su_peak_detector_INITIALIZER \
{ \
0, /* size */ \
0, /* thr2 */ \
NULL, /* history */ \
0, /* p */ \
0, /* count */ \
0, /* accum */ \
0, /* inv_size */ \
}
enum sigutils_channel_detector_mode {
SU_CHANNEL_DETECTOR_MODE_SPECTRUM, /* Spectrum only mode */
SU_CHANNEL_DETECTOR_MODE_DISCOVERY, /* Discover channels */
SU_CHANNEL_DETECTOR_MODE_AUTOCORRELATION, /* To find baudrate */
SU_CHANNEL_DETECTOR_MODE_NONLINEAR_DIFF, /* To find baudrate (alt.) */
SU_CHANNEL_DETECTOR_MODE_ORDER_ESTIMATION /* To find constellation size */
};
enum sigutils_channel_detector_window {
SU_CHANNEL_DETECTOR_WINDOW_NONE, /* Rectangular window */
SU_CHANNEL_DETECTOR_WINDOW_HAMMING, /* Hamming window */
SU_CHANNEL_DETECTOR_WINDOW_HANN, /* Hann window */
SU_CHANNEL_DETECTOR_WINDOW_FLAT_TOP, /* Flat-top window */
SU_CHANNEL_DETECTOR_WINDOW_BLACKMANN_HARRIS, /* Blackmann-Harris window */
};
struct sigutils_channel_detector_params {
enum sigutils_channel_detector_mode mode;
SUSCOUNT samp_rate; /* Sample rate */
SUSCOUNT window_size; /* Window size == FFT bins */
SUFLOAT fc; /* Center frequency */
SUSCOUNT decimation; /* Decimation */
SUFLOAT bw; /* Low-pass filter bandwidth (in Hz) */
SUSCOUNT max_order; /* Max constellation order */
SUBOOL tune; /* Signal needs to be tuned to a channel */
/* Detector parameters */
enum sigutils_channel_detector_window window; /* Window function */
SUFLOAT alpha; /* PSD averaging ratio */
SUFLOAT beta; /* PSD upper and lower levels averaging ratio */
SUFLOAT gamma; /* Noise level update ratio */
SUFLOAT snr; /* Minimum SNR to detect channels (linear) */
SUSCOUNT max_age; /* Max channel age */
/* Peak detector parameters */
SUSCOUNT pd_size; /* PD samples */
SUFLOAT pd_thres; /* PD threshold, in sigmas */
SUFLOAT pd_signif; /* Minimum significance, in dB */
};
#define sigutils_channel_detector_params_INITIALIZER \
{ \
SU_CHANNEL_DETECTOR_MODE_SPECTRUM, /* Mode */ \
8000, /* samp_rate */ \
8192, /* window_size */ \
SU_ADDSFX(0.0), /* fc */ \
1, /* decimation */ \
SU_ADDSFX(0.0), /* bw */ \
8, /* max_order */ \
SU_FALSE, /* tune */ \
SU_CHANNEL_DETECTOR_WINDOW_BLACKMANN_HARRIS, /* window */ \
SU_CHANNEL_DETECTOR_ALPHA, /* alpha */ \
SU_CHANNEL_DETECTOR_BETA, /* beta */ \
SU_CHANNEL_DETECTOR_GAMMA, /* gamma */ \
SU_ADDSFX(2.), /* snr */ \
SU_CHANNEL_MAX_AGE, /* max_age */ \
10, /* pd_samples */ \
SU_ADDSFX(2.), /* pd_thres */ \
SU_ADDSFX(10.) /* pd_signif */ \
}
#define sigutils_channel_INITIALIZER \
{ \
0, /* fc */ \
0, /* f_lo */ \
0, /* f_li */ \
0, /* bw */ \
0, /* snr */ \
0, /* S0 */ \
0, /* N0 */ \
0, /* ft */ \
0, /* age */ \
0, /* present */ \
}
struct sigutils_channel_detector {
/* Common members */
struct sigutils_channel_detector_params params;
su_softtuner_t tuner;
SUCOMPLEX *tuner_buf;
SUSCOUNT ptr; /* Sample in window */
SUBOOL fft_issued;
SUSCOUNT next_to_window;
unsigned int iters;
unsigned int chan_age;
SU_FFTW(_complex) *window_func;
SU_FFTW(_complex) *window;
SU_FFTW(_plan) fft_plan;
SU_FFTW(_complex) *fft;
SUSCOUNT req_samples; /* Number of required samples for detection */
union {
SUFLOAT *spect; /* Used only if mode == DISCOVERY, NONLINEAR_DIFF */
SUFLOAT *acorr; /* Used only if mode == AUTOCORRELATION */
void *_r_alloc; /* Generic allocation */
};
/* Channel detector members */
SU_FFTW(_plan) fft_plan_rev;
SU_FFTW(_complex) *ifft;
SUFLOAT *spmax;
SUFLOAT *spmin;
SUFLOAT N0; /* Detected noise floor */
SUCOMPLEX dc; /* Detected DC component */
PTR_LIST(struct sigutils_channel, channel);
/* Baudrate estimator members */
SUFLOAT baud; /* Detected baudrate */
SUCOMPLEX prev; /* Used by nonlinear diff */
su_peak_detector_t pd; /* Peak detector used by nonlinear diff */
};
typedef struct sigutils_channel_detector su_channel_detector_t;
SUINLINE void
su_channel_detector_rewind(su_channel_detector_t *cd)
{
cd->ptr = 0;
cd->iters = 0;
}
SUINLINE unsigned int
su_channel_detector_get_iters(const su_channel_detector_t *cd)
{
return cd->iters;
}
SUINLINE SUCOMPLEX
su_channel_detector_get_dc(const su_channel_detector_t *cd)
{
return cd->dc;
}
SUINLINE SUSCOUNT
su_channel_detector_get_fs(const su_channel_detector_t *cd)
{
return cd->params.samp_rate;
}
SUINLINE SUBOOL
su_channel_detector_get_window_ptr(const su_channel_detector_t *cd)
{
return cd->ptr;
}
SUINLINE SUFLOAT
su_channel_detector_get_baud(const su_channel_detector_t *cd)
{
return cd->baud;
}
SUINLINE SUFLOAT
su_channel_detector_get_window_size(const su_channel_detector_t *cd)
{
return cd->params.window_size;
}
/**************************** Peak detector API *****************************/
SUBOOL su_peak_detector_init(
su_peak_detector_t *pd,
unsigned int size,
SUFLOAT thres);
int su_peak_detector_feed(su_peak_detector_t *pd, SUFLOAT x);
void su_peak_detector_finalize(su_peak_detector_t *pd);
/************************** Channel detector API ****************************/
su_channel_detector_t *su_channel_detector_new(
const struct sigutils_channel_detector_params *params);
SUBOOL su_channel_detector_set_params(
su_channel_detector_t *detector,
const struct sigutils_channel_detector_params *params);
SUSCOUNT su_channel_detector_get_req_samples(
const su_channel_detector_t *detector);
void su_channel_detector_destroy(su_channel_detector_t *detector);
SUBOOL su_channel_detector_feed(
su_channel_detector_t *detector,
SUCOMPLEX x);
SUBOOL su_channel_detector_exec_fft(su_channel_detector_t *detector);
SUSCOUNT su_channel_detector_feed_bulk(
su_channel_detector_t *detector,
const SUCOMPLEX *signal,
SUSCOUNT size);
void su_channel_detector_get_channel_list(
const su_channel_detector_t *detector,
struct sigutils_channel ***channel_list,
unsigned int *channel_count);
void su_channel_params_adjust(struct sigutils_channel_detector_params *params);
void su_channel_params_adjust_to_channel(
struct sigutils_channel_detector_params *params,
const struct sigutils_channel *channel);
struct sigutils_channel *su_channel_dup(const struct sigutils_channel *channel);
void su_channel_destroy(struct sigutils_channel *channel);
struct sigutils_channel *su_channel_detector_lookup_channel(
const su_channel_detector_t *detector,
SUFLOAT fc);
struct sigutils_channel *su_channel_detector_lookup_valid_channel(
const su_channel_detector_t *detector,
SUFLOAT fc);
#ifdef __cplusplus
# ifdef __clang__
# pragma clang diagnostic pop
# endif // __clang__
}
#endif /* __cplusplus */
#endif /* _SIGUTILS_DETECT_H */