satdump/src-testing/main.cpp
2024-08-17 09:30:20 +02:00

133 lines
No EOL
4.1 KiB
C++

/**********************************************************************
* This file is used for testing random stuff without running the
* whole of SatDump, which comes in handy for debugging individual
* elements before putting them all together in modules...
*
* If you are an user, ignore this file which will not be built by
* default, and if you're a developper in need of doing stuff here...
* Go ahead!
*
* Don't judge the code you might see in there! :)
**********************************************************************/
#include "logger.h"
#include "common/dsp/complex.h"
#include "common/ndsp/block.h"
#include <unistd.h>
#include "common/ndsp/io/file_source.h"
#include "common/ndsp/utils/agc.h"
#include "common/ndsp/filter/fir.h"
#include "common/ndsp/pll/costas_loop.h"
#include "common/ndsp/clock/clock_recovery_mm.h"
#include "common/dsp/filter/firdes.h"
#include <fstream>
int main(int argc, char *argv[])
{
initLogger();
// std::shared_ptr<NaFiFo> fifo1 = std::make_shared<NaFiFo>();
// ndsp::buf::init_nafifo_stdbuf<complex_t>(fifo1, 2, 30000);
ndsp::FileSource source;
ndsp::Agc<complex_t> agc;
ndsp::FIRFilter<complex_t> rrc_filter;
ndsp::CostasLoop costas;
ndsp::ClockRecoveryMM<complex_t> clock_reco;
source.d_buffer_size = 30000;
source.d_file = argv[1];
source.d_type = dsp::BasebandType::CF_32;
agc.d_gain = 1.0;
agc.d_max_gain = 65536;
agc.d_reference = 1.0;
agc.d_rate = 1e-4;
rrc_filter.d_taps = dsp::firdes::root_raised_cosine(1.0, 6e6, 2333333, 0.35, 31);
costas.d_order = 4;
costas.d_loop_bw = 0.005;
costas.d_freq_limit = 1;
clock_reco.d_omega = 6e6 / 2333333;
clock_reco.d_omega_gain = pow(8.7e-3, 2) / 4.0;
clock_reco.d_mu = 0.5f;
clock_reco.d_mu_gain = 8.7e-3;
clock_reco.d_omega_relative_limit = 0.005f;
agc.set_input(0, source.get_output(0));
rrc_filter.set_input(0, agc.get_output(0));
costas.set_input(0, rrc_filter.get_output(0));
clock_reco.set_input(0, costas.get_output(0));
source.start();
agc.start();
rrc_filter.start();
costas.start();
clock_reco.start();
bool should_run = true;
std::ofstream data_ou(argv[2], std::ios::binary);
std::thread thread_rx([&clock_reco, &data_ou]()
{
while (!clock_reco.outputs[0]->read())
{
auto *wbuf = (ndsp::buf::StdBuf<complex_t> *)clock_reco.outputs[0]->read_buf();
// for (int i = 0; i < wbuf->cnt; i++)
// printf("%f, ", wbuf->dat[i]);
// printf("\n");
#if 0
data_ou.write((char*)wbuf->dat, wbuf->cnt * sizeof(complex_t));
#else
for(int i = 0; i < wbuf->cnt; i++) {
int _i = wbuf->dat[i].real * 100.0;
int _q = wbuf->dat[i].imag * 100.0;
if(_i > 127)
_i = 127;
else if(_i < -127)
_i = -127;
if(_q > 127)
_q = 127;
else if(_q < -127)
_q = -127;
int8_t ci = _i;
int8_t cq = _q;
data_ou.write((char*)&ci, 1);
data_ou.write((char*)&cq, 1);
}
#endif
clock_reco.outputs[0]->flush();
} });
// sleep(2);
while (!source.eof())
{
sleep(1);
printf("%f \n", (double)source.position() / (double)source.filesize());
}
logger->info("Stopping blocks!");
source.stop();
agc.stop();
rrc_filter.stop();
costas.stop();
clock_reco.stop();
logger->info("Blocks stopped!");
if (thread_rx.joinable())
thread_rx.join();
}