CubicSDR/src/modules/modem/analog/ModemLSB.cpp

#include "ModemLSB.h"

ModemLSB::ModemLSB() : ModemAnalog() {
    // half band filter used for side-band elimination
    demodAM_LSB = ampmodem_create(0.25, 0.25, LIQUID_AMPMODEM_LSB, 1);
    // options
    float fc = 0.25f;         // filter cutoff frequency
    float ft = 0.05f;         // filter transition
    float As = 90.0f;         // stop-band attenuation [dB]
    float mu = 0.5f;          // fractional timing offset
    
    // estimate required filter length and generate filter
    unsigned int h_len = estimate_req_filter_len(ft,As);
    float *h = (float *) malloc(h_len * sizeof(float));
    liquid_firdes_kaiser(h_len,fc,As,mu,h);
    ssbFilt = firfilt_crcf_create(h,h_len);
    ssbShift = nco_crcf_create(LIQUID_NCO);
    nco_crcf_set_frequency(ssbShift,  (2.0 * M_PI) * 0.25);
	free(h);
}

Modem *ModemLSB::factory() {
    return new ModemLSB;
}

std::string ModemLSB::getName() {
    return "LSB";
}

ModemLSB::~ModemLSB() {
    firfilt_crcf_destroy(ssbFilt);
    nco_crcf_destroy(ssbShift);
    ampmodem_destroy(demodAM_LSB);
}

int ModemLSB::checkSampleRate(long long sampleRate, int /* audioSampleRate */) {
    if (sampleRate < MIN_BANDWIDTH) {
        return MIN_BANDWIDTH;
    }
    if (sampleRate % 2 == 0) {
        return sampleRate;
    }
    return sampleRate+1;
}

int ModemLSB::getDefaultSampleRate() {
    return 5400;
}

void ModemLSB::demodulate(ModemKit *kit, ModemIQData *input, AudioThreadInput *audioOut) {
    ModemKitAnalog *akit = (ModemKitAnalog *)kit;
    
    initOutputBuffers(akit,input);
    
    if (!bufSize) {
        input->decRefCount();
        return;
    }
    
    liquid_float_complex x;
    for (int i = 0; i < bufSize; i++) { // Reject upper band
        nco_crcf_step(ssbShift);
        nco_crcf_mix_up(ssbShift, input->data[i], &x);
        firfilt_crcf_push(ssbFilt, x);
        firfilt_crcf_execute(ssbFilt, &x);
        ampmodem_demodulate(demodAM_LSB, x, &demodOutputData[i]);
    }
    
    buildAudioOutput(akit, audioOut, true);
}