root/experimental/components/Demodulator/src/DemodulatorDSP.cpp @ 3996

/****************************************************************************

Copyright 2007 Virginia Polytechnic Institute and State University

This file is part of the OSSIE Demodulator.

OSSIE Demodulator is free software; you can redistribute it and/or modify
it under the terms of the GNU General Public License as published by
the Free Software Foundation; either version 2 of the License, or
(at your option) any later version.

OSSIE Demodulator is distributed in the hope that it will be useful,
but WITHOUT ANY WARRANTY; without even the implied warranty of
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
GNU General Public License for more details.

You should have received a copy of the GNU General Public License
along with OSSIE Demodulator; if not, write to the Free Software
Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA

****************************************************************************/


#include <iostream>
#include "DemodulatorDSP.h"
#include <math.h>

// Default constructor
DemodulatorDSP::DemodulatorDSP()
{
    bitsPerSymbol = 1;
    Demodulate = &DemodulateBPSK;
    state_i = 0;
    state_q = 0;
}

// Destructor
DemodulatorDSP::~DemodulatorDSP()
{
}

// Set modulation scheme
void DemodulatorDSP::SetModulationScheme( ModulationScheme _ms )
{
    switch ( _ms ) {
    case MOD_BPSK:
        Demodulate = &DemodulateBPSK;
        bitsPerSymbol = 1;
        break;
    case MOD_QPSK:
        Demodulate = &DemodulateQPSK;
        bitsPerSymbol = 2;
        break;
    case MOD_8PSK:
        Demodulate = &Demodulate8PSK;
        bitsPerSymbol = 3;
        break;
    case MOD_16QAM:
        Demodulate = &Demodulate16QAM;
        bitsPerSymbol = 4;
        break;
    case MOD_4PAM:
        Demodulate = &Demodulate4PAM;
        bitsPerSymbol = 2;
        break;
    case MOD_DBPSK:
        state_i = 0;
        state_q = 0;
        Demodulate = &DemodulateBPSK;
        bitsPerSymbol = 1;
        break;
    case MOD_DQPSK:
        state_i = 0;
        state_q = 0;
        Demodulate = &DemodulateQPSK;
        bitsPerSymbol = 2;
        break;
    case MOD_D8PSK:
        state_i = 0;
        state_q = 0;
        Demodulate = &Demodulate8PSK;
        bitsPerSymbol = 3;
        break;
    default:
        std::cerr << "ERROR: DemodulatorDSP::SetModulationScheme(): "
                  << "unknown mod. scheme " << _ms << std::endl;
        std::cerr << "  => Using BPSK instead" << std::endl;
        SetModulationScheme( MOD_BPSK );
        //throw 0;
    }
    
    mod_scheme = _ms;
}

///
void DemodulatorDSP::DemodulateSequence(
        short * I_in,
        short * Q_in, 
        unsigned int N_in, 
        char * bits_out)
{
    unsigned int j(0);
    for (unsigned int i=0; i<N_in; i++) {
        Demodulate(I_in[i], Q_in[i], bits_out+j);
        j += bitsPerSymbol;
    }
}


//
void DemodulateBPSK(
    short & I_in,
    short & Q_in,
    char * bits_out)
{
    bits_out[0] = ( I_in > 0 ) ? BIT1 : BIT0;
}

//
void DemodulateQPSK(
    short & I_in,
    short & Q_in,
    char * bits_out)
{
    bits_out[0] = ( I_in > 0 ) ? BIT1 : BIT0;
    bits_out[1] = ( Q_in > 0 ) ? BIT1 : BIT0;
}

//
void Demodulate8PSK(
    short & I_in,
    short & Q_in,
    char * bits_out)
{
    std::cerr << "ERROR: Demodulate8PSK not yet supported!" << std::endl;
    throw 0;
}

//
void Demodulate16QAM(
    short & I_in,
    short & Q_in,
    char * bits_out)
{
    std::cerr << "ERROR: Demodulate16QAM not yet supported!" << std::endl;
    throw 0;
}

//
void Demodulate4PAM(
    short & I_in,
    short & Q_in,
    char * bits_out)
{
    std::cerr << "ERROR: Demodulate4PAM not yet supported!" << std::endl;
    throw 0;
}