/*  patchpanel.c

This file is part of a program that implements a Software-Defined Radio.

Copyright (C) 2013 Warren Pratt, NR0V
Copyright (C) 2024 Edouard Griffiths, F4EXB Adapted to SDRangel

This program 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.

This program 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 this program; if not, write to the Free Software
Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301, USA.

The author can be reached by email at

warren@wpratt.com

*/

#include "comm.hpp"
#include "patchpanel.hpp"
#include "RXA.hpp"
#include "TXA.hpp"

namespace WDSP {

PANEL::PANEL(
    int _run,
    int _size,
    float* _in,
    float* _out,
    double _gain1,
    double _gain2I,
    double _gain2Q,
    int _inselect,
    int _copy
) :
    run(_run),
    size(_size),
    in(_in),
    out(_out),
    gain1(_gain1),
    gain2I(_gain2I),
    gain2Q(_gain2Q),
    inselect(_inselect),
    copy(_copy)
{
}

void PANEL::flush()
{
}

void PANEL::execute()
{
    int i;
    double I, Q;
    double gainI = gain1 * gain2I;
    double gainQ = gain1 * gain2Q;
    // inselect is either 0(neither), 1(Q), 2(I), or 3(both)
    switch (copy)
    {
    case 0: // no copy
        for (i = 0; i < size; i++)
        {
            I = in[2 * i + 0] * (inselect >> 1);
            Q = in[2 * i + 1] * (inselect &  1);
            out[2 * i + 0] = gainI * I;
            out[2 * i + 1] = gainQ * Q;
        }
        break;
    case 1: // copy I to Q (then Q == I)
        for (i = 0; i < size; i++)
        {
            I = in[2 * i + 0] * (inselect >> 1);
            Q = I;
            out[2 * i + 0] = gainI * I;
            out[2 * i + 1] = gainQ * Q;
        }
        break;
    case 2: // copy Q to I (then I == Q)
        for (i = 0; i < size; i++)
        {
            Q = in[2 * i + 1] * (inselect &  1);
            I = Q;
            out[2 * i + 0] = gainI * I;
            out[2 * i + 1] = gainQ * Q;
        }
        break;
    case 3: // reverse (I=>Q and Q=>I)
        for (i = 0; i < size; i++)
        {
            Q = in[2 * i + 0] * (inselect >> 1);
            I = in[2 * i + 1] * (inselect &  1);
            out[2 * i + 0] = gainI * I;
            out[2 * i + 1] = gainQ * Q;
        }
        break;
    }
}

void PANEL::setBuffers(float* _in, float* _out)
{
    in = _in;
    out = _out;
}

void PANEL::setSamplerate(int)
{
}

void PANEL::setSize(int _size)
{
    size = _size;
}

/********************************************************************************************************
*                                                                                                       *
*                                           RXA Properties                                              *
*                                                                                                       *
********************************************************************************************************/

void PANEL::setRun(int _run)
{
    run = _run;
}

void PANEL::setSelect(int _select)
{
    inselect = _select;
}

void PANEL::setGain1(double _gain)
{
    gain1 = _gain;
}

void PANEL::setGain2(double _gainI, double _gainQ)
{
    gain2I = _gainI;
    gain2Q = _gainQ;
}

void PANEL::setPan(double _pan)
{
    double gain1, gain2;

    if (_pan <= 0.5)
    {
        gain1 = 1.0;
        gain2 = sin (_pan * PI);
    }
    else
    {
        gain1 = sin (_pan * PI);
        gain2 = 1.0;
    }

    gain2I = gain1;
    gain2Q = gain2;
}

void PANEL::setCopy(int _copy)
{
    copy = _copy;
}

void PANEL::setBinaural(int _bin)
{
    copy = 1 - _bin;
}

/********************************************************************************************************
*                                                                                                       *
*                                           TXA Properties                                              *
*                                                                                                       *
********************************************************************************************************/

void PANEL::setSelectTx(int _select)
{
    if (_select == 1)
        copy = 3;
    else
        copy = 0;

    inselect = _select;
}

} // namespace WDSP