2023-02-08 18:12:00 +01:00
|
|
|
/* Hilbert function */
|
|
|
|
|
/* SPDX-FileCopyrightText: Copyright © 2021 Wim Taymans */
|
|
|
|
|
/* SPDX-License-Identifier: MIT */
|
2021-03-09 21:07:37 +01:00
|
|
|
|
|
|
|
|
#ifndef HILBERT_H
|
|
|
|
|
#define HILBERT_H
|
|
|
|
|
|
|
|
|
|
#include <errno.h>
|
|
|
|
|
#include <stddef.h>
|
|
|
|
|
#include <math.h>
|
|
|
|
|
|
2025-05-27 09:06:08 +01:00
|
|
|
#ifdef __cplusplus
|
|
|
|
|
extern "C" {
|
|
|
|
|
#endif
|
2024-06-18 15:41:12 +02:00
|
|
|
|
2021-03-09 21:07:37 +01:00
|
|
|
static inline void blackman_window(float *taps, int n_taps)
|
|
|
|
|
{
|
|
|
|
|
int n;
|
|
|
|
|
for (n = 0; n < n_taps; n++) {
|
2024-06-18 15:41:12 +02:00
|
|
|
float w = 2.0f * (float)M_PI * n / (n_taps-1);
|
2024-06-18 12:17:56 +02:00
|
|
|
taps[n] = 0.3635819f - 0.4891775f * cosf(w)
|
|
|
|
|
+ 0.1365995f * cosf(2 * w) - 0.0106411f * cosf(3 * w);
|
2021-03-09 21:07:37 +01:00
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static inline int hilbert_generate(float *taps, int n_taps)
|
|
|
|
|
{
|
|
|
|
|
int i;
|
|
|
|
|
|
|
|
|
|
if ((n_taps & 1) == 0)
|
|
|
|
|
return -EINVAL;
|
|
|
|
|
|
|
|
|
|
for (i = 0; i < n_taps; i++) {
|
|
|
|
|
int k = -(n_taps / 2) + i;
|
|
|
|
|
if (k & 1) {
|
2024-06-18 15:41:12 +02:00
|
|
|
float pk = (float)M_PI * k;
|
2021-03-09 21:07:37 +01:00
|
|
|
taps[i] *= (1.0f - cosf(pk)) / pk;
|
|
|
|
|
} else {
|
|
|
|
|
taps[i] = 0.0f;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
return 0;
|
|
|
|
|
}
|
|
|
|
|
|
2024-10-15 12:14:57 +02:00
|
|
|
static inline void reverse_taps(float *taps, int n_taps)
|
|
|
|
|
{
|
|
|
|
|
int i;
|
|
|
|
|
for (i = 0; i < n_taps/2; i++)
|
|
|
|
|
SPA_SWAP(taps[i], taps[n_taps-1-i]);
|
|
|
|
|
}
|
|
|
|
|
|
2021-03-09 21:07:37 +01:00
|
|
|
#ifdef __cplusplus
|
|
|
|
|
} /* extern "C" */
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
#endif /* HILBERT_H */
|