0
1
mirror of https://github.com/radio95-rnt/fm95.git synced 2026-02-26 19:23:51 +01:00

add headroom option

This commit is contained in:
2025-08-06 19:56:16 +02:00
parent 07bf22e3ff
commit 7350cbcf1e
5 changed files with 23 additions and 22 deletions

View File

@@ -1,22 +1,23 @@
#include "stereo_encoder.h"
// Multiplier is the multiplier to get to 19 khz
void init_stereo_encoder(StereoEncoder* st, uint8_t multiplier, Oscillator* osc, float mono_volume, float pilot_volume, float stereo_volume) {
void init_stereo_encoder(StereoEncoder* st, uint8_t multiplier, Oscillator* osc, float audio_volume, float pilot_volume) {
st->multiplier = multiplier;
st->osc = osc;
st->mono_volume = mono_volume;
st->pilot_volume = pilot_volume;
st->stereo_volume = stereo_volume;
st->audio_volume = audio_volume;
}
float stereo_encode(StereoEncoder* st, uint8_t enabled, float left, float right) {
float mid = (left+right) * 0.5f;
if(!enabled) return mid * st->mono_volume;
if(!enabled) return mid * st->audio_volume;
float half_audio = st->audio_volume * 0.5f;
float side = (left-right) * 0.5f;
float signalx1 = get_oscillator_sin_multiplier_ni(st->osc, st->multiplier);
float signalx2 = get_oscillator_sin_multiplier_ni(st->osc, st->multiplier * 2.0f);
return (mid*st->mono_volume) + (signalx1*st->pilot_volume) + ((side*signalx2) * st->stereo_volume);
return (mid*half_audio) + (signalx1*st->pilot_volume) + ((side*signalx2) * half_audio);
}