mirror of
https://github.com/radio95-rnt/fm95.git
synced 2026-02-27 03:23:54 +01:00
add MonoPass (great name)
This commit is contained in:
@@ -41,6 +41,9 @@ Has a fine quality, but as it goes for 12 khz fm signals
|
|||||||
# StereoSCAMod
|
# StereoSCAMod
|
||||||
Stereo SCA, like normal SCA but encodes L-R onto 80 khz, only demodulator of this right now is gnu radio
|
Stereo SCA, like normal SCA but encodes L-R onto 80 khz, only demodulator of this right now is gnu radio
|
||||||
|
|
||||||
|
# MonoPass
|
||||||
|
want to keep mono for a reason but have the lpf and preemphasis, do so
|
||||||
|
|
||||||
# How to compile?
|
# How to compile?
|
||||||
To compile you need `cmake` and `libpulse-dev`, if you have those then do these commands:
|
To compile you need `cmake` and `libpulse-dev`, if you have those then do these commands:
|
||||||
```
|
```
|
||||||
|
|||||||
162
src/mono_passthrough.c
Normal file
162
src/mono_passthrough.c
Normal file
@@ -0,0 +1,162 @@
|
|||||||
|
#include <stdio.h>
|
||||||
|
#include <pulse/simple.h>
|
||||||
|
#include <pulse/error.h>
|
||||||
|
#include <stdlib.h>
|
||||||
|
#include <math.h>
|
||||||
|
#include <stdint.h>
|
||||||
|
#include <signal.h>
|
||||||
|
#include <string.h>
|
||||||
|
|
||||||
|
#include "../lib/constants.h"
|
||||||
|
#include "../lib/filters.h"
|
||||||
|
|
||||||
|
#include "options.h"
|
||||||
|
|
||||||
|
#define SAMPLE_RATE 16000
|
||||||
|
|
||||||
|
#define INPUT_DEVICE "real_real_tx_audio_input.monitor"
|
||||||
|
#define OUTPUT_DEVICE "alsa_output.platform-soc_sound.stereo-fallback"
|
||||||
|
#define BUFFER_SIZE 512
|
||||||
|
#define CLIPPER_THRESHOLD 0.525 // Adjust this as needed
|
||||||
|
|
||||||
|
#define MONO_VOLUME 0.6f // L+R Signal
|
||||||
|
|
||||||
|
#ifdef PREEMPHASIS
|
||||||
|
#define PREEMPHASIS_TAU 0.00005 // 50 microseconds, use 0.000075 if in america
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#ifdef LPF
|
||||||
|
#define LPF_CUTOFF 15000
|
||||||
|
#endif
|
||||||
|
|
||||||
|
volatile sig_atomic_t to_run = 1;
|
||||||
|
|
||||||
|
float clip(float sample) {
|
||||||
|
if (sample > CLIPPER_THRESHOLD) {
|
||||||
|
return CLIPPER_THRESHOLD; // Clip to the upper threshold
|
||||||
|
} else if (sample < -CLIPPER_THRESHOLD) {
|
||||||
|
return -CLIPPER_THRESHOLD; // Clip to the lower threshold
|
||||||
|
} else {
|
||||||
|
return sample; // No clipping
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
static void stop(int signum) {
|
||||||
|
(void)signum;
|
||||||
|
printf("\nReceived stop signal. Cleaning up...\n");
|
||||||
|
to_run = 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
int main() {
|
||||||
|
printf("MonoPass : Mono filter for FM made by radio95 (with help of ChatGPT and Claude, thanks!)\n");
|
||||||
|
// Define formats and buffer atributes
|
||||||
|
pa_sample_spec audio_format = {
|
||||||
|
.format = PA_SAMPLE_FLOAT32NE, //Float32 NE, or Float32 Native Endian, the float in c uses the endianess of your pc, or native endian, and float is float32, and double is float64
|
||||||
|
.channels = 1,
|
||||||
|
.rate = SAMPLE_RATE // Same sample rate makes it easy, leave the resampling to pipewire, it should know better
|
||||||
|
};
|
||||||
|
|
||||||
|
pa_buffer_attr input_buffer_atr = {
|
||||||
|
.maxlength = buffer_maxlength,
|
||||||
|
.fragsize = buffer_tlength_fragsize
|
||||||
|
};
|
||||||
|
pa_buffer_attr output_buffer_atr = {
|
||||||
|
.maxlength = buffer_maxlength,
|
||||||
|
.tlength = buffer_tlength_fragsize,
|
||||||
|
.prebuf = buffer_prebuf
|
||||||
|
};
|
||||||
|
|
||||||
|
printf("Connecting to input device... (%s)\n", INPUT_DEVICE);
|
||||||
|
|
||||||
|
pa_simple *input_device = pa_simple_new(
|
||||||
|
NULL,
|
||||||
|
"MonoPass",
|
||||||
|
PA_STREAM_RECORD,
|
||||||
|
INPUT_DEVICE,
|
||||||
|
"Audio Input",
|
||||||
|
&audio_format,
|
||||||
|
NULL,
|
||||||
|
&input_buffer_atr,
|
||||||
|
NULL
|
||||||
|
);
|
||||||
|
if (!input_device) {
|
||||||
|
fprintf(stderr, "Error: cannot open input device.\n");
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
printf("Connecting to output device... (%s)\n", OUTPUT_DEVICE);
|
||||||
|
|
||||||
|
pa_simple *output_device = pa_simple_new(
|
||||||
|
NULL,
|
||||||
|
"MonoPass",
|
||||||
|
PA_STREAM_PLAYBACK,
|
||||||
|
OUTPUT_DEVICE,
|
||||||
|
"Audio",
|
||||||
|
&audio_format,
|
||||||
|
NULL,
|
||||||
|
&output_buffer_atr,
|
||||||
|
NULL
|
||||||
|
);
|
||||||
|
if (!output_device) {
|
||||||
|
fprintf(stderr, "Error: cannot open output device.\n");
|
||||||
|
pa_simple_free(input_device);
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
#ifdef PREEMPHASIS
|
||||||
|
Emphasis preemp;
|
||||||
|
init_emphasis(&preemp, PREEMPHASIS_TAU, SAMPLE_RATE);
|
||||||
|
#endif
|
||||||
|
#ifdef LPF
|
||||||
|
LowPassFilter lpf;
|
||||||
|
init_low_pass_filter(&lpf, LPF_CUTOFF, SAMPLE_RATE);
|
||||||
|
#endif
|
||||||
|
|
||||||
|
signal(SIGINT, stop);
|
||||||
|
signal(SIGTERM, stop);
|
||||||
|
|
||||||
|
int pulse_error;
|
||||||
|
float input[BUFFER_SIZE]; // Input from device, interleaved stereo
|
||||||
|
float mpx[BUFFER_SIZE]; // MPX, this goes to the output
|
||||||
|
while (to_run) {
|
||||||
|
if (pa_simple_read(input_device, input, sizeof(input), &pulse_error) < 0) {
|
||||||
|
fprintf(stderr, "Error reading from input device: %s\n", pa_strerror(pulse_error));
|
||||||
|
to_run = 0;
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
|
||||||
|
for (int i = 0; i < BUFFER_SIZE; i++) {
|
||||||
|
float in = input[i];
|
||||||
|
|
||||||
|
#ifdef PREEMPHASIS
|
||||||
|
#ifdef LPF
|
||||||
|
float lowpassed = apply_low_pass_filter(&lpf, in);
|
||||||
|
float preemphasized = apply_pre_emphasis(&preemp, lowpassed);
|
||||||
|
float current_input = clip(preemphasized);
|
||||||
|
#else
|
||||||
|
float preemphasized = apply_pre_emphasis(&preemp, in);
|
||||||
|
float current_input = clip(preemphasized);
|
||||||
|
#endif
|
||||||
|
#else
|
||||||
|
#ifdef LPF
|
||||||
|
float lowpassed = apply_low_pass_filter(&lpf, in);
|
||||||
|
float current_input = clip(lowpassed);
|
||||||
|
#else
|
||||||
|
float current_input = clip(in);
|
||||||
|
#endif
|
||||||
|
#endif
|
||||||
|
|
||||||
|
mpx[i] = current_input * MONO_VOLUME;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (pa_simple_write(output_device, mpx, sizeof(mpx), &pulse_error) < 0) {
|
||||||
|
fprintf(stderr, "Error writing to output device: %s\n", pa_strerror(pulse_error));
|
||||||
|
to_run = 0;
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
printf("Cleaning up...\n");
|
||||||
|
pa_simple_free(input_device);
|
||||||
|
pa_simple_free(output_device);
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
Reference in New Issue
Block a user