0
1
mirror of https://github.com/radio95-rnt/fm95.git synced 2026-02-27 03:23:54 +01:00

i give up

This commit is contained in:
2025-03-22 21:13:15 +01:00
parent e190a21aea
commit 24a2b02fd7
3 changed files with 4 additions and 53 deletions

View File

@@ -12,36 +12,4 @@ float apply_preemphasis(ResistorCapacitor *filter, float sample) {
float hard_clip(float sample, float threshold) {
return fmaxf(-threshold, fminf(threshold, sample));
}
void init_pll(PLL *pll, float reference_frequency, float target_frequency, float sample_rate) {
pll->reference_frequency = reference_frequency;
pll->target_frequency = target_frequency;
pll->multiplier = target_frequency / reference_frequency;
pll->sample_rate = sample_rate;
pll->phase_error = 0.0f;
pll->loop_filter = 0.0f;
pll->vco_phase = 0.0f;
pll->vco_frequency = target_frequency;
pll->loop_gain = 0.01f;
pll->filter_coefficient = 0.1f;
}
float update_pll(PLL *pll, float reference_signal) {
float vco_divided_phase = fmodf(pll->vco_phase / pll->multiplier, M_2PI);
float reference_phase = acosf(reference_signal); // Extract phase from reference signal
pll->phase_error = sinf(reference_phase - vco_divided_phase);
pll->loop_filter = pll->loop_filter * (1.0f - pll->filter_coefficient) +
pll->phase_error * pll->filter_coefficient * pll->loop_gain;
pll->vco_frequency = pll->target_frequency + pll->loop_filter;
float phase_increment = (M_2PI * pll->vco_frequency) / pll->sample_rate;
pll->vco_phase = fmodf(pll->vco_phase + phase_increment, M_2PI * pll->multiplier);
return sinf(pll->vco_phase);
}

View File

@@ -14,21 +14,4 @@ typedef struct
void init_preemphasis(ResistorCapacitor *filter, float tau, float sample_rate);
float apply_preemphasis(ResistorCapacitor *filter, float sample);
float hard_clip(float sample, float threshold);
typedef struct {
float phase_error;
float loop_filter;
float vco_phase;
float vco_frequency;
float reference_frequency;
float target_frequency;
float multiplier;
float sample_rate;
float loop_gain;
float filter_coefficient;
} PLL;
void init_pll(PLL *pll, float reference_frequency, float target_frequency, float sample_rate);
float update_pll(PLL *pll, float reference_signal);
float hard_clip(float sample, float threshold);