0
1
mirror of https://github.com/radio95-rnt/fm95.git synced 2026-02-27 03:23:54 +01:00
This commit is contained in:
2025-03-01 12:06:59 +01:00
parent 7d1ee4ae50
commit 8c9f6464b8
5 changed files with 33 additions and 183 deletions

View File

@@ -77,45 +77,4 @@ float hard_clip(float sample, float threshold) {
} else {
return sample; // No clipping
}
}
void init_delay_line(DelayLine *delay_line, int max_delay) {
delay_line->buffer = (float *)calloc(max_delay, sizeof(float));
delay_line->size = max_delay;
delay_line->write_idx = 0;
delay_line->read_idx = 0;
delay_line->delay = 0;
}
void set_delay_line(DelayLine *delay_line, int new_delay) {
if (new_delay >= delay_line->size) {
new_delay = delay_line->size - 1;
}
if (new_delay < 0) {
new_delay = 0;
}
delay_line->delay = new_delay;
delay_line->read_idx = (delay_line->write_idx - new_delay + delay_line->size) % delay_line->size;
}
float delay_line(DelayLine *delay_line, float in) {
float out;
// Read the delayed sample
out = delay_line->buffer[delay_line->read_idx];
// Write the new sample
delay_line->buffer[delay_line->write_idx] = in;
// Update indices
delay_line->write_idx = (delay_line->write_idx + 1) % delay_line->size;
delay_line->read_idx = (delay_line->read_idx + 1) % delay_line->size;
return out;
}
void exit_delay_line(DelayLine *delay_line) {
free(delay_line->buffer);
delay_line->buffer = NULL;
}

View File

@@ -1,43 +0,0 @@
#include "hilbert.h"
void compute_hilbert_coeffs(float* coeffs, int taps) {
int mid = taps / 2;
for (int i = 0; i < taps; i++) {
if ((i - mid) % 2 == 0) {
coeffs[i] = 0.0f;
} else {
coeffs[i] = 2.0f / (M_PI * (i - mid));
}
}
}
// Initialize the Hilbert transformer
void init_hilbert(HilbertTransformer* filter) {
compute_hilbert_coeffs(filter->coeffs, HILBERT_TAPS);
memset(filter->delay, 0, sizeof(filter->delay));
filter->index = 0;
}
// Apply the Hilbert transformer
void apply_hilbert(HilbertTransformer* filter, float input, float* inphase, float* quadrature) {
// Insert the new sample into the circular buffer
filter->delay[filter->index] = input;
// Compute the in-phase and quadrature components
float i_sum = 0.0f; // In-phase (0-degree output)
float q_sum = 0.0f; // Quadrature (90-degree output)
int coeff_index = 0;
for (int i = filter->index; coeff_index < HILBERT_TAPS; coeff_index++) {
i_sum += filter->delay[i] * (coeff_index == HILBERT_TAPS / 2 ? 1.0f : 0.0f);
q_sum += filter->delay[i] * filter->coeffs[coeff_index];
i = (i > 0) ? i - 1 : HILBERT_TAPS - 1;
}
// Update the index for the next sample
filter->index = (filter->index + 1) % HILBERT_TAPS;
*inphase = i_sum;
*quadrature = q_sum;
}

View File

@@ -1,17 +0,0 @@
#pragma once
#include <stdlib.h>
#include <string.h>
#include "constants.h"
#include <math.h>
#define HILBERT_TAPS 95
typedef struct {
float coeffs[HILBERT_TAPS];
float delay[HILBERT_TAPS];
int index;
} HilbertTransformer;
void init_hilbert(HilbertTransformer* filter);
void apply_hilbert(HilbertTransformer* filter, float input, float* inphase, float* quadrature);