mirror of
https://github.com/radio95-rnt/fm95.git
synced 2026-02-27 03:23:54 +01:00
update
This commit is contained in:
@@ -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;
|
||||
}
|
||||
@@ -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;
|
||||
}
|
||||
@@ -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);
|
||||
Reference in New Issue
Block a user