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:
@@ -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);
|
||||
}
|
||||
@@ -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);
|
||||
Reference in New Issue
Block a user