mirror of
https://github.com/f4exb/sdrangel.git
synced 2024-11-13 20:01:46 -05:00
262 lines
7.2 KiB
C++
262 lines
7.2 KiB
C++
/* snb.h
|
|
|
|
This file is part of a program that implements a Software-Defined Radio.
|
|
|
|
Copyright (C) 2015, 2016 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
|
|
|
|
*/
|
|
|
|
#ifndef wdsp_snba_h
|
|
#define wdsp_snba_h
|
|
|
|
#include "export.h"
|
|
|
|
namespace WDSP {
|
|
|
|
class RESAMPLE;
|
|
class RXA;
|
|
|
|
class WDSP_API SNBA
|
|
{
|
|
public:
|
|
int run;
|
|
double* in;
|
|
double* out;
|
|
int inrate;
|
|
int internalrate;
|
|
int bsize;
|
|
int xsize;
|
|
int ovrlp;
|
|
int incr;
|
|
int iasize;
|
|
int iainidx;
|
|
int iaoutidx;
|
|
double* inaccum;
|
|
double* xbase;
|
|
double* xaux;
|
|
int nsamps;
|
|
int oasize;
|
|
int oainidx;
|
|
int oaoutidx;
|
|
int init_oaoutidx;
|
|
double* outaccum;
|
|
|
|
int resamprun;
|
|
int isize;
|
|
RESAMPLE *inresamp;
|
|
RESAMPLE *outresamp;
|
|
double* inbuff;
|
|
double* outbuff;
|
|
struct _exec
|
|
{
|
|
int asize;
|
|
double* a;
|
|
double* v;
|
|
int* detout;
|
|
double* savex;
|
|
double* xHout;
|
|
int* unfixed;
|
|
int npasses;
|
|
} exec;
|
|
struct _det
|
|
{
|
|
double k1;
|
|
double k2;
|
|
int b;
|
|
int pre;
|
|
int post;
|
|
double* vp;
|
|
double* vpwr;
|
|
} sdet;
|
|
struct _scan
|
|
{
|
|
double pmultmin;
|
|
} scan;
|
|
struct _wrk
|
|
{
|
|
int xHat_a1rows_max;
|
|
int xHat_a2cols_max;
|
|
double* xHat_r;
|
|
double* xHat_ATAI;
|
|
double* xHat_A1;
|
|
double* xHat_A2;
|
|
double* xHat_P1;
|
|
double* xHat_P2;
|
|
double* trI_y;
|
|
double* trI_v;
|
|
double* dR_z;
|
|
double* asolve_r;
|
|
double* asolve_z;
|
|
} wrk;
|
|
double out_low_cut;
|
|
double out_high_cut;
|
|
|
|
static SNBA* create_snba (
|
|
int run,
|
|
double* in,
|
|
double* out,
|
|
int inrate,
|
|
int internalrate,
|
|
int bsize,
|
|
int ovrlp,
|
|
int xsize,
|
|
int asize,
|
|
int npasses,
|
|
double k1,
|
|
double k2,
|
|
int b,
|
|
int pre,
|
|
int post,
|
|
double pmultmin,
|
|
double out_low_cut,
|
|
double out_high_cut
|
|
);
|
|
static void destroy_snba (SNBA *d);
|
|
static void flush_snba (SNBA *d);
|
|
static void xsnba (SNBA *d);
|
|
static void setBuffers_snba (SNBA *a, double* in, double* out);
|
|
static void setSamplerate_snba (SNBA *a, int rate);
|
|
static void setSize_snba (SNBA *a, int size);
|
|
// RXA
|
|
static void SetSNBAOutputBandwidth (RXA& rxa, double flow, double fhigh);
|
|
static void SetSNBARun (RXA& rxa, int run);
|
|
static void SetSNBAovrlp (RXA& rxa, int ovrlp);
|
|
static void SetSNBAasize (RXA& rxa, int size);
|
|
static void SetSNBAnpasses (RXA& rxa, int npasses);
|
|
static void SetSNBAk1 (RXA& rxa, double k1);
|
|
static void SetSNBAk2 (RXA& rxa, double k2);
|
|
static void SetSNBAbridge (RXA& rxa, int bridge);
|
|
static void SetSNBApresamps (RXA& rxa, int presamps);
|
|
static void SetSNBApostsamps (RXA& rxa, int postsamps);
|
|
static void SetSNBApmultmin (RXA& rxa, double pmultmin);
|
|
|
|
private:
|
|
static void calc_snba (SNBA *d);
|
|
static void decalc_snba (SNBA *d);
|
|
static void ATAc0 (int n, int nr, double* A, double* r);
|
|
static void multA1TA2(double* a1, double* a2, int m, int n, int q, double* c);
|
|
static void multXKE(double* a, double* xk, int m, int q, int p, double* vout);
|
|
static void multAv(double* a, double* v, int m, int q, double* vout);
|
|
static void xHat(
|
|
int xusize,
|
|
int asize,
|
|
double* xk,
|
|
double* a,
|
|
double* xout,
|
|
double* r,
|
|
double* ATAI,
|
|
double* A1,
|
|
double* A2,
|
|
double* P1,
|
|
double* P2,
|
|
double* trI_y,
|
|
double* trI_v,
|
|
double* dR_z
|
|
);
|
|
static void invf(int xsize, int asize, double* a, double* x, double* v);
|
|
static void det(SNBA *d, int asize, double* v, int* detout);
|
|
static int scanFrame(
|
|
int xsize,
|
|
int pval,
|
|
double pmultmin,
|
|
int* det,
|
|
int* bimp,
|
|
int* limp,
|
|
int* befimp,
|
|
int* aftimp,
|
|
int* p_opt,
|
|
int* next
|
|
);
|
|
static void execFrame(SNBA *d, double* x);
|
|
};
|
|
|
|
|
|
class NBP;
|
|
class NOTCHDB;
|
|
|
|
class WDSP_API BPSNBA
|
|
{
|
|
public:
|
|
int run; // run the filter
|
|
int run_notches; // use the notches, vs straight bandpass
|
|
int position; // position in the processing pipeline
|
|
int size; // buffer size
|
|
int nc; // number of filter coefficients
|
|
int mp; // minimum phase flag
|
|
double* in; // input buffer
|
|
double* out; // output buffer
|
|
int rate; // sample rate
|
|
double* buff; // internal buffer
|
|
NBP *bpsnba; // pointer to the notched bandpass filter, nbp
|
|
double f_low; // low cutoff frequency
|
|
double f_high; // high cutoff frequency
|
|
double abs_low_freq; // lowest positive freq supported by SNB
|
|
double abs_high_freq; // highest positive freq supported by SNG
|
|
int wintype; // filter window type
|
|
double gain; // filter gain
|
|
int autoincr; // use auto increment for notch width
|
|
int maxpb; // maximum passband segments supported
|
|
NOTCHDB* ptraddr; // pointer to address of NOTCH DATABASE
|
|
|
|
static BPSNBA* create_bpsnba (
|
|
int run,
|
|
int run_notches,
|
|
int position,
|
|
int size,
|
|
int nc,
|
|
int mp,
|
|
double* in,
|
|
double* out,
|
|
int rate,
|
|
double abs_low_freq,
|
|
double abs_high_freq,
|
|
double f_low,
|
|
double f_high,
|
|
int wintype,
|
|
double gain,
|
|
int autoincr,
|
|
int maxpb,
|
|
NOTCHDB* ptraddr
|
|
);
|
|
static void destroy_bpsnba (BPSNBA *a);
|
|
static void flush_bpsnba (BPSNBA *a);
|
|
static void setBuffers_bpsnba (BPSNBA *a, double* in, double* out);
|
|
static void setSamplerate_bpsnba (BPSNBA *a, int rate);
|
|
static void setSize_bpsnba (BPSNBA *a, int size);
|
|
static void xbpsnbain (BPSNBA *a, int position);
|
|
static void xbpsnbaout (BPSNBA *a, int position);
|
|
static void recalc_bpsnba_filter (BPSNBA *a, int update);
|
|
// RXA
|
|
static void BPSNBASetNC (RXA& rxa, int nc);
|
|
static void BPSNBASetMP (RXA& rxa, int mp);
|
|
static void bpsnbaCheck (RXA& rxa, int mode, int notch_run);
|
|
static void bpsnbaSet (RXA& rxa);
|
|
|
|
private:
|
|
static void calc_bpsnba (BPSNBA *a);
|
|
static void decalc_bpsnba (BPSNBA *a);
|
|
};
|
|
|
|
} // namespace WDSP
|
|
|
|
#endif
|