/* Generated by XDS Modula-2 to ANSI C v4.20 translator */

#define X2C_int32
#define X2C_index32
#ifndef sdr_H_
#include "sdr.h"
#endif
#define sdr_C_
#ifndef tcpb_H_
#include "tcpb.h"
#endif
#ifndef tcp_H_
#include "tcp.h"
#endif
#ifndef osi_H_
#include "osi.h"
#endif
#include <osic.h>
#ifndef mlib_H_
#include "mlib.h"
#endif
#ifndef aprsstr_H_
#include "aprsstr.h"
#endif
#include <unistd.h>









int32_t sdr_debfd;
int32_t sdr_afcspeed;
/* rtl_tcp iq fm demodulator by OE5DXL */
#define sdr_IQBUF 65536

#define sdr_DDSMAXLEN 2048

#define sdr_AFCSPEED0 400000000
/* slower afc reaction */

#define sdr_AFCRECENTER 1024
/* pull afc to middle */

#define sdr_SSBDDSSIZE 2048

#define sdr_SSBDDSSIZE4 512

#define sdr_AFCRSSICLAMP 0.7
/* until rssi level below peak to do afc */

#define sdr_AFCRSSISPEED 0.9985
/* afc peak rssi fall speed */

#define sdr_PI 3.1415926535

#define sdr_PI2 6.283185307

#define sdr_IQLEVEL 1.5625E-2
/* correct iq level on input format */

struct Complex;


struct Complex {
   float Re;
   float Im;
};

struct Complexu8;


struct Complexu8 {
   uint8_t Re;
   uint8_t Im;
};

struct Complexi16;


struct Complexi16 {
   short Re;
   short Im;
};

struct COMPI;


struct COMPI {
   int32_t r;
   int32_t i;
};

static int32_t fd;

static char isfile;

static uint32_t audiohz;

static uint32_t rtlhz;

static uint32_t bytespersamp;

static char reconnect;

union _0;


union _0 {
   char b[65536];
   struct Complexu8 u8[32768];
   struct Complexi16 i16[32768];
   struct COMPI i32[32768];
   struct Complex f32[32768];
};

static union _0 iqbuf;

static short DDS[2048];

static float DDSR[2048];

static char url[1001];

static char port[11];

static uint32_t ddslen;

static uint32_t ddslen4;

static float SSBDDS[2048];

static float onesamp;

static float sampfrac;

static float iqlevel;

static float varbwk;


static void initdds(uint32_t size)
{
   uint32_t i;
   float d;
   uint32_t tmp;
   if (size>2047UL) size = 2048UL;
   d = X2C_DIVR(6.2831853071796f,(float)size);
   tmp = size-1UL;
   i = 0UL;
   if (i<=tmp) for (;; i++) {
      DDSR[i] = 32767.5f*osic_sin((float)i*d);
      DDS[i] = (short)(int32_t)X2C_TRUNCI(DDSR[i],X2C_min_longint,
                X2C_max_longint);
      if (i==tmp) break;
   } /* end for */
   ddslen = (uint32_t)(size-1UL);
   ddslen4 = size/4UL;
} /* end initdds() */


static void initssbdds(float dds[], uint32_t dds_len)
{
   uint32_t i;
   float d;
   uint32_t tmp;
   d = X2C_DIVR(6.2831853071796f,(float)((dds_len-1)+1UL));
   tmp = dds_len-1;
   i = 0UL;
   if (i<=tmp) for (;; i++) {
      dds[i] = osic_sin((float)i*d);
      if (i==tmp) break;
   } /* end for */
} /* end initssbdds() */

#define sdr_FG (-9)


static void iir512(sdr_pRX rx, uint32_t a, uint32_t b)
{
   uint32_t dfc;
   uint32_t ph;
   uint32_t i;
   int32_t i3;
   int32_t i2;
   int32_t i1;
   int32_t r3;
   int32_t r2;
   int32_t r1;
   int32_t ddsi;
   int32_t ddsr;
   struct COMPI x;
   struct sdr_TAP * anonym;
   struct sdr_TAP * anonym0;
   struct sdr_TAP * anonym1;
   struct sdr_TAP * anonym2;
   { /* with */
      struct sdr_TAP * anonym = &rx->tapre;
      r1 = anonym->uc1;
      r2 = anonym->uc2;
      r3 = anonym->il;
   }
   { /* with */
      struct sdr_TAP * anonym0 = &rx->tapim;
      i1 = anonym0->uc1;
      i2 = anonym0->uc2;
      i3 = anonym0->il;
   }
   ph = rx->phase;
   dfc = rx->df+(uint32_t)rx->afckhz;
   i = a;
   do {
      x = iqbuf.i32[i];
      ++i;
      ddsr = (int32_t)DDS[ph]; /* mix osz sin */
      ddsi = (int32_t)DDS[(uint32_t)((uint32_t)(ph+ddslen4)&ddslen)];
                /* mix osz cos */
      ph = (uint32_t)((uint32_t)(ph+dfc)&ddslen); /* drive mix osz */
      r1 += ((x.r*ddsr-x.i*ddsi)-r1)-r3>>9; /* mixer + lowpass i */
      r2 += r3-r2>>9;
      r3 += r1-r2>>8;
      i1 += ((x.r*ddsi+x.i*ddsr)-i1)-i3>>9; /* mixer + lowpass q */
      i2 += i3-i2>>9;
      i3 += i1-i2>>8;
   } while (i<b);
   { /* with */
      struct sdr_TAP * anonym1 = &rx->tapre;
      anonym1->uc1 = r1;
      anonym1->uc2 = r2;
      anonym1->il = r3;
      anonym1->ucr2 = (float)r2;
   }
   { /* with */
      struct sdr_TAP * anonym2 = &rx->tapim;
      anonym2->uc1 = i1;
      anonym2->uc2 = i2;
      anonym2->il = i3;
      anonym2->ucr2 = (float)i2;
   }
   rx->phase = ph;
} /* end iir512() */

#define sdr_FG0 (-8)


static void iir256(sdr_pRX rx, uint32_t a, uint32_t b)
{
   uint32_t dfc;
   uint32_t ph;
   uint32_t i;
   int32_t i3;
   int32_t i2;
   int32_t i1;
   int32_t r3;
   int32_t r2;
   int32_t r1;
   int32_t ddsi;
   int32_t ddsr;
   struct COMPI x;
   struct sdr_TAP * anonym;
   struct sdr_TAP * anonym0;
   struct sdr_TAP * anonym1;
   struct sdr_TAP * anonym2;
   { /* with */
      struct sdr_TAP * anonym = &rx->tapre;
      r1 = anonym->uc1;
      r2 = anonym->uc2;
      r3 = anonym->il;
   }
   { /* with */
      struct sdr_TAP * anonym0 = &rx->tapim;
      i1 = anonym0->uc1;
      i2 = anonym0->uc2;
      i3 = anonym0->il;
   }
   ph = rx->phase;
   dfc = rx->df+(uint32_t)rx->afckhz;
   i = a;
   do {
      x = iqbuf.i32[i];
      ++i;
      ddsr = (int32_t)DDS[ph]; /* mix osz sin */
      ddsi = (int32_t)DDS[(uint32_t)((uint32_t)(ph+ddslen4)&ddslen)];
                /* mix osz cos */
      ph = (uint32_t)((uint32_t)(ph+dfc)&ddslen); /* drive mix osz */
      r1 += ((x.r*ddsr-x.i*ddsi)-r1)-r3>>8; /* mixer + lowpass i */
      r2 += r3-r2>>8;
      r3 += r1-r2>>7;
      i1 += ((x.r*ddsi+x.i*ddsr)-i1)-i3>>8; /* mixer + lowpass q */
      i2 += i3-i2>>8;
      i3 += i1-i2>>7;
   } while (i<b);
   { /* with */
      struct sdr_TAP * anonym1 = &rx->tapre;
      anonym1->uc1 = r1;
      anonym1->uc2 = r2;
      anonym1->il = r3;
      anonym1->ucr2 = (float)r2;
   }
   { /* with */
      struct sdr_TAP * anonym2 = &rx->tapim;
      anonym2->uc1 = i1;
      anonym2->uc2 = i2;
      anonym2->il = i3;
      anonym2->ucr2 = (float)i2;
   }
   rx->phase = ph;
} /* end iir256() */

#define sdr_FG1 (-7)


static void iir128(sdr_pRX rx, uint32_t a, uint32_t b)
{
   uint32_t dfc;
   uint32_t ph;
   uint32_t i;
   int32_t i3;
   int32_t i2;
   int32_t i1;
   int32_t r3;
   int32_t r2;
   int32_t r1;
   int32_t ddsi;
   int32_t ddsr;
   struct COMPI x;
   struct sdr_TAP * anonym;
   struct sdr_TAP * anonym0;
   struct sdr_TAP * anonym1;
   struct sdr_TAP * anonym2;
   { /* with */
      struct sdr_TAP * anonym = &rx->tapre;
      r1 = anonym->uc1;
      r2 = anonym->uc2;
      r3 = anonym->il;
   }
   { /* with */
      struct sdr_TAP * anonym0 = &rx->tapim;
      i1 = anonym0->uc1;
      i2 = anonym0->uc2;
      i3 = anonym0->il;
   }
   ph = rx->phase;
   dfc = rx->df+(uint32_t)rx->afckhz;
   i = a;
   do {
      x = iqbuf.i32[i];
      ++i;
      ddsr = (int32_t)DDS[ph]; /* mix osz sin */
      ddsi = (int32_t)DDS[(uint32_t)((uint32_t)(ph+ddslen4)&ddslen)];
                /* mix osz cos */
      ph = (uint32_t)((uint32_t)(ph+dfc)&ddslen); /* drive mix osz */
      r1 += ((x.r*ddsr-x.i*ddsi)-r1)-r3>>7; /* mixer + lowpass i */
      r2 += r3-r2>>7;
      r3 += r1-r2>>6;
      i1 += ((x.r*ddsi+x.i*ddsr)-i1)-i3>>7; /* mixer + lowpass q */
      i2 += i3-i2>>7;
      i3 += i1-i2>>6;
   } while (i<b);
   { /* with */
      struct sdr_TAP * anonym1 = &rx->tapre;
      anonym1->uc1 = r1;
      anonym1->uc2 = r2;
      anonym1->il = r3;
      anonym1->ucr2 = (float)r2;
   }
   { /* with */
      struct sdr_TAP * anonym2 = &rx->tapim;
      anonym2->uc1 = i1;
      anonym2->uc2 = i2;
      anonym2->il = i3;
      anonym2->ucr2 = (float)i2;
   }
   rx->phase = ph;
} /* end iir128() */

#define sdr_FG2 (-6)


static void iir64(sdr_pRX rx, uint32_t a, uint32_t b)
{
   uint32_t dfc;
   uint32_t ph;
   uint32_t i;
   int32_t i3;
   int32_t i2;
   int32_t i1;
   int32_t r3;
   int32_t r2;
   int32_t r1;
   int32_t ddsi;
   int32_t ddsr;
   struct COMPI x;
   struct sdr_TAP * anonym;
   struct sdr_TAP * anonym0;
   struct sdr_TAP * anonym1;
   struct sdr_TAP * anonym2;
   { /* with */
      struct sdr_TAP * anonym = &rx->tapre;
      r1 = anonym->uc1;
      r2 = anonym->uc2;
      r3 = anonym->il;
   }
   { /* with */
      struct sdr_TAP * anonym0 = &rx->tapim;
      i1 = anonym0->uc1;
      i2 = anonym0->uc2;
      i3 = anonym0->il;
   }
   ph = rx->phase;
   dfc = rx->df+(uint32_t)rx->afckhz;
   i = a;
   do {
      x = iqbuf.i32[i];
      ++i;
      ddsr = (int32_t)DDS[ph]; /* mix osz sin */
      ddsi = (int32_t)DDS[(uint32_t)((uint32_t)(ph+ddslen4)&ddslen)];
                /* mix osz cos */
      ph = (uint32_t)((uint32_t)(ph+dfc)&ddslen); /* drive mix osz */
      r1 += ((x.r*ddsr-x.i*ddsi)-r1)-r3>>6; /* mixer + lowpass i */
      r2 += r3-r2>>6;
      r3 += r1-r2>>5;
      i1 += ((x.r*ddsi+x.i*ddsr)-i1)-i3>>6; /* mixer + lowpass q */
      i2 += i3-i2>>6;
      i3 += i1-i2>>5;
   } while (i<b);
   { /* with */
      struct sdr_TAP * anonym1 = &rx->tapre;
      anonym1->uc1 = r1;
      anonym1->uc2 = r2;
      anonym1->il = r3;
      anonym1->ucr2 = (float)r2;
   }
   { /* with */
      struct sdr_TAP * anonym2 = &rx->tapim;
      anonym2->uc1 = i1;
      anonym2->uc2 = i2;
      anonym2->il = i3;
      anonym2->ucr2 = (float)i2;
   }
   rx->phase = ph;
} /* end iir64() */

#define sdr_FG3 (-5)


static void iir32(sdr_pRX rx, uint32_t a, uint32_t b)
{
   uint32_t dfc;
   uint32_t ph;
   uint32_t i;
   int32_t i3;
   int32_t i2;
   int32_t i1;
   int32_t r3;
   int32_t r2;
   int32_t r1;
   int32_t ddsi;
   int32_t ddsr;
   struct COMPI x;
   struct sdr_TAP * anonym;
   struct sdr_TAP * anonym0;
   struct sdr_TAP * anonym1;
   struct sdr_TAP * anonym2;
   { /* with */
      struct sdr_TAP * anonym = &rx->tapre;
      r1 = anonym->uc1;
      r2 = anonym->uc2;
      r3 = anonym->il;
   }
   { /* with */
      struct sdr_TAP * anonym0 = &rx->tapim;
      i1 = anonym0->uc1;
      i2 = anonym0->uc2;
      i3 = anonym0->il;
   }
   ph = rx->phase;
   dfc = rx->df+(uint32_t)rx->afckhz;
   i = a;
   do {
      x = iqbuf.i32[i];
      ++i;
      ddsr = (int32_t)DDS[ph]; /* mix osz sin */
      ddsi = (int32_t)DDS[(uint32_t)((uint32_t)(ph+ddslen4)&ddslen)];
                /* mix osz cos */
      ph = (uint32_t)((uint32_t)(ph+dfc)&ddslen); /* drive mix osz */
      r1 += ((x.r*ddsr-x.i*ddsi)-r1)-r3>>5; /* mixer + lowpass i */
      r2 += r3-r2>>5;
      r3 += r1-r2>>4;
      i1 += ((x.r*ddsi+x.i*ddsr)-i1)-i3>>5; /* mixer + lowpass q */
      i2 += i3-i2>>5;
      i3 += i1-i2>>4;
   } while (i<b);
   { /* with */
      struct sdr_TAP * anonym1 = &rx->tapre;
      anonym1->uc1 = r1;
      anonym1->uc2 = r2;
      anonym1->il = r3;
      anonym1->ucr2 = (float)r2;
   }
   { /* with */
      struct sdr_TAP * anonym2 = &rx->tapim;
      anonym2->uc1 = i1;
      anonym2->uc2 = i2;
      anonym2->il = i3;
      anonym2->ucr2 = (float)i2;
   }
   rx->phase = ph;
} /* end iir32() */

#define sdr_FG4 (-4)


static void iir16(sdr_pRX rx, uint32_t a, uint32_t b)
{
   uint32_t dfc;
   uint32_t ph;
   uint32_t i;
   int32_t i3;
   int32_t i2;
   int32_t i1;
   int32_t r3;
   int32_t r2;
   int32_t r1;
   int32_t ddsi;
   int32_t ddsr;
   struct COMPI x;
   struct sdr_TAP * anonym;
   struct sdr_TAP * anonym0;
   struct sdr_TAP * anonym1;
   struct sdr_TAP * anonym2;
   { /* with */
      struct sdr_TAP * anonym = &rx->tapre;
      r1 = anonym->uc1;
      r2 = anonym->uc2;
      r3 = anonym->il;
   }
   { /* with */
      struct sdr_TAP * anonym0 = &rx->tapim;
      i1 = anonym0->uc1;
      i2 = anonym0->uc2;
      i3 = anonym0->il;
   }
   ph = rx->phase;
   dfc = rx->df+(uint32_t)rx->afckhz;
   i = a;
   do {
      x = iqbuf.i32[i];
      ++i;
      ddsr = (int32_t)DDS[ph]; /* mix osz sin */
      ddsi = (int32_t)DDS[(uint32_t)((uint32_t)(ph+ddslen4)&ddslen)];
                /* mix osz cos */
      ph = (uint32_t)((uint32_t)(ph+dfc)&ddslen); /* drive mix osz */
      r1 += ((x.r*ddsr-x.i*ddsi)-r1)-r3>>4; /* mixer + lowpass i */
      r2 += r3-r2>>4;
      r3 += r1-r2>>3;
      i1 += ((x.r*ddsi+x.i*ddsr)-i1)-i3>>4; /* mixer + lowpass q */
      i2 += i3-i2>>4;
      i3 += i1-i2>>3;
   } while (i<b);
   { /* with */
      struct sdr_TAP * anonym1 = &rx->tapre;
      anonym1->uc1 = r1;
      anonym1->uc2 = r2;
      anonym1->il = r3;
      anonym1->ucr2 = (float)r2;
   }
   { /* with */
      struct sdr_TAP * anonym2 = &rx->tapim;
      anonym2->uc1 = i1;
      anonym2->uc2 = i2;
      anonym2->il = i3;
      anonym2->ucr2 = (float)i2;
   }
   rx->phase = ph;
} /* end iir16() */

#define sdr_FG5 (-3)


static void iir8(sdr_pRX rx, uint32_t a, uint32_t b)
{
   uint32_t dfc;
   uint32_t ph;
   uint32_t i;
   int32_t i3;
   int32_t i2;
   int32_t i1;
   int32_t r3;
   int32_t r2;
   int32_t r1;
   int32_t ddsi;
   int32_t ddsr;
   struct COMPI x;
   struct sdr_TAP * anonym;
   struct sdr_TAP * anonym0;
   struct sdr_TAP * anonym1;
   struct sdr_TAP * anonym2;
   { /* with */
      struct sdr_TAP * anonym = &rx->tapre;
      r1 = anonym->uc1;
      r2 = anonym->uc2;
      r3 = anonym->il;
   }
   { /* with */
      struct sdr_TAP * anonym0 = &rx->tapim;
      i1 = anonym0->uc1;
      i2 = anonym0->uc2;
      i3 = anonym0->il;
   }
   ph = rx->phase;
   dfc = (uint32_t)((uint32_t)(rx->df+(uint32_t)rx->afckhz)&ddslen);
   i = a;
   do {
      x = iqbuf.i32[i];
      ++i;
      ddsr = (int32_t)DDS[ph]; /* mix osz sin */
      ddsi = (int32_t)DDS[(uint32_t)((uint32_t)(ph+ddslen4)&ddslen)];
                /* mix osz cos */
      ph = (uint32_t)((uint32_t)(ph+dfc)&ddslen); /* drive mix osz */
      r1 += ((x.r*ddsr-x.i*ddsi)-r1)-r3>>3; /* mixer + lowpass i */
      r2 += r3-r2>>3;
      r3 += r1-r2>>2;
      i1 += ((x.r*ddsi+x.i*ddsr)-i1)-i3>>3; /* mixer + lowpass q */
      i2 += i3-i2>>3;
      i3 += i1-i2>>2;
   } while (i<b);
   { /* with */
      struct sdr_TAP * anonym1 = &rx->tapre;
      anonym1->uc1 = r1;
      anonym1->uc2 = r2;
      anonym1->il = r3;
      anonym1->ucr2 = (float)r2;
   }
   { /* with */
      struct sdr_TAP * anonym2 = &rx->tapim;
      anonym2->uc1 = i1;
      anonym2->uc2 = i2;
      anonym2->il = i3;
      anonym2->ucr2 = (float)i2;
   }
   rx->phase = ph;
} /* end iir8() */

#define sdr_FG6 128


static void iirvar(sdr_pRX rx, uint32_t a, uint32_t b, float bw)
/* variable bandwidth */
{
   uint32_t dfc;
   uint32_t ph;
   uint32_t i;
   float ddsi;
   float ddsr;
   float bw2;
   float i3;
   float i2;
   float i1;
   float r3;
   float r2;
   float r1;
   float xi;
   float xr;
   struct sdr_TAP * anonym;
   struct sdr_TAP * anonym0;
   struct sdr_TAP * anonym1;
   struct sdr_TAP * anonym2;
   { /* with */
      struct sdr_TAP * anonym = &rx->tapre;
      r1 = anonym->ucr1;
      r2 = anonym->ucr2;
      r3 = anonym->ilr;
   }
   { /* with */
      struct sdr_TAP * anonym0 = &rx->tapim;
      i1 = anonym0->ucr1;
      i2 = anonym0->ucr2;
      i3 = anonym0->ilr;
   }
   ph = rx->phase;
   dfc = rx->df+(uint32_t)rx->afckhz;
   i = a;
   bw2 = bw*2.0f;
   do {
      xr = (float)iqbuf.i32[i].r;
      xi = (float)iqbuf.i32[i].i;
      ++i;
      ddsr = DDSR[ph]; /* mix osz sin */
      ddsi = DDSR[(uint32_t)((uint32_t)(ph+ddslen4)&ddslen)];
                /* mix osz cos */
      ph = (uint32_t)((uint32_t)(ph+dfc)&ddslen); /* drive mix osz */
      r1 = r1+(((xr*ddsr-xi*ddsi)-r1)-r3)*bw; /* mixer + lowpass i */
      r2 = r2+(r3-r2)*bw;
      r3 = r3+(r1-r2)*bw2;
      i1 = i1+(((xr*ddsi+xi*ddsr)-i1)-i3)*bw; /* mixer + lowpass q */
      i2 = i2+(i3-i2)*bw;
      i3 = i3+(i1-i2)*bw2;
   } while (i<b);
   { /* with */
      struct sdr_TAP * anonym1 = &rx->tapre;
      anonym1->ucr1 = r1;
      anonym1->ucr2 = r2;
      anonym1->ilr = r3;
      anonym1->ucr2 = r2;
   }
   { /* with */
      struct sdr_TAP * anonym2 = &rx->tapim;
      anonym2->ucr1 = i1;
      anonym2->ucr2 = i2;
      anonym2->ilr = i3;
      anonym2->ucr2 = i2;
   }
   rx->phase = ph;
} /* end iirvar() */

#define sdr_FG7 128


static void iirvarf4(sdr_pRX rx, uint32_t a, uint32_t b, float bw)
/* variable bandwidth */
{
   uint32_t dfc;
   uint32_t ph;
   uint32_t i;
   float ddsi;
   float ddsr;
   float bw2;
   float i3;
   float i2;
   float i1;
   float r3;
   float r2;
   float r1;
   struct Complex x;
   struct sdr_TAP * anonym;
   struct sdr_TAP * anonym0;
   struct sdr_TAP * anonym1;
   struct sdr_TAP * anonym2;
   { /* with */
      struct sdr_TAP * anonym = &rx->tapre;
      r1 = anonym->ucr1;
      r2 = anonym->ucr2;
      r3 = anonym->ilr;
   }
   { /* with */
      struct sdr_TAP * anonym0 = &rx->tapim;
      i1 = anonym0->ucr1;
      i2 = anonym0->ucr2;
      i3 = anonym0->ilr;
   }
   ph = rx->phase;
   dfc = rx->df+(uint32_t)rx->afckhz;
   i = a;
   bw2 = bw*2.0f;
   do {
      x = iqbuf.f32[i];
      ++i;
      ddsr = DDSR[ph]; /* mix osz sin */
      ddsi = DDSR[(uint32_t)((uint32_t)(ph+ddslen4)&ddslen)];
                /* mix osz cos */
      ph = (uint32_t)((uint32_t)(ph+dfc)&ddslen); /* drive mix osz */
      r1 = r1+(((x.Re*ddsr-x.Im*ddsi)-r1)-r3)*bw; /* mixer + lowpass i */
      r2 = r2+(r3-r2)*bw;
      r3 = r3+(r1-r2)*bw2;
      i1 = i1+(((x.Re*ddsi+x.Im*ddsr)-i1)-i3)*bw; /* mixer + lowpass q */
      i2 = i2+(i3-i2)*bw;
      i3 = i3+(i1-i2)*bw2;
   } while (i<b);
   { /* with */
      struct sdr_TAP * anonym1 = &rx->tapre;
      anonym1->ucr1 = r1;
      anonym1->ucr2 = r2;
      anonym1->ilr = r3;
      anonym1->ucr2 = r2;
   }
   { /* with */
      struct sdr_TAP * anonym2 = &rx->tapim;
      anonym2->ucr1 = i1;
      anonym2->ucr2 = i2;
      anonym2->ilr = i3;
      anonym2->ucr2 = i2;
   }
   rx->phase = ph;
} /* end iirvarf4() */


static void mkfir(float fg, float gain, uint32_t flen,
                float fir[], uint32_t fir_len)
{
   uint32_t m;
   uint32_t i;
   float l;
   float w;
   float u;
   uint32_t tmp;
   w = 6.283185307f*fg;
   m = flen/2UL;
   fir[m] = 1.0f;
   tmp = flen/2UL;
   i = 1UL;
   if (i<=tmp) for (;; i++) {
      u = (float)i*w;
      u = X2C_DIVR(osic_sin(u),u);
      if (m+i<flen) fir[m+i] = u;
      fir[m-i] = u;
      if (i==tmp) break;
   } /* end for */
   u = X2C_DIVR(2.0f,(float)(flen-1UL));
   l = 0.0f;
   tmp = flen-1UL;
   i = 0UL;
   if (i<=tmp) for (;; i++) {
      /* hamming */
      fir[i] = fir[i]*(0.54f+0.46f*osic_cos(3.1415926535f*((float)
                i*u-1.0f)));
      l = l+fir[i];
      if (i==tmp) break;
   } /* end for */
   l = X2C_DIVR(gain,l);
   tmp = flen-1UL;
   i = 0UL;
   if (i<=tmp) for (;; i++) {
      fir[i] = fir[i]*l; /* gain correction */
      if (i==tmp) break;
   } /* end for */
/*FOR i:=0 TO flen-1 DO WrFixed(fir[i], 4,1); WrStr(" ") END; */
/*WrStrLn("");WrFixed(fg, 4,1);WrStrLn(""); */
} /* end mkfir() */

#define sdr_MINTAB 4

#define sdr_MINF 0.001


extern void sdr_genfir(float fg, float gain, uint32_t tablen,
                sdr_pFIR * f)
{
   uint32_t i;
   char on;
   on = tablen>=4UL && fg>0.001f;
   if (*f==0) {
      if (on) osic_alloc((char * *)f, sizeof(struct sdr_FIR));
   }
   else if (!on) {
      osic_free((char * *)f, sizeof(struct sdr_FIR));
                /* remove filter */
      *f = 0;
   }
   if (*f && ((*f)->lastlen!=tablen || (*f)->fg!=fg)) {
      /* parameters changed */
      (*f)->fg = fg;
      (*f)->lastlen = tablen;
      i = 2048UL;
      if (tablen>2048UL) tablen = 2048UL;
      tablen = ((tablen+3UL)/4UL)*4UL-1UL;
      (*f)->len = tablen;
      (*f)->halfband = 0UL;
      if ((float)fabs(fg-0.5f)<0.001f) {
         fg = 0.5f;
         (*f)->halfband = tablen/2UL;
      }
      (*f)->wp = 0UL;
      mkfir(fg*0.5f, gain, tablen, (*f)->tab, 2048ul);
   }
/*
FOR i:=0 TO tablen-1 DO WrFixed(f^.tab[i], 4,1); WrStr(" ") END;
WrStrLn("");WrFixed(f^.tab[f^.halfband], 4,1); WrStrLn("");
                WrInt(f^.halfband,1);WrStrLn("=half");
*/
} /* end genfir() */


static void dofir(struct Complex * u, sdr_pFIR fir, char flt)
{
   uint32_t j;
   uint32_t i;
   float t;
   struct sdr_FIR * anonym;
   { /* with */
      struct sdr_FIR * anonym = fir;
      anonym->re[anonym->wp] = u->Re;
      anonym->im[anonym->wp] = u->Im;
      ++anonym->wp;
      if (flt) {
         j = 0UL;
         if (anonym->halfband>0UL) {
            i = (anonym->wp+anonym->halfband)%anonym->len;
            t = anonym->tab[anonym->halfband];
            u->Re = anonym->re[i]*t;
            u->Im = anonym->im[i]*t;
            i = anonym->wp;
            while (i<anonym->len) {
               t = anonym->tab[j];
               u->Re = u->Re+anonym->re[i]*t;
               u->Im = u->Im+anonym->im[i]*t;
               j += 2UL;
               i += 2UL;
            }
            i = i%anonym->len;
            while (i<anonym->wp) {
               t = anonym->tab[j];
               u->Re = u->Re+anonym->re[i]*t;
               u->Im = u->Im+anonym->im[i]*t;
               j += 2UL;
               i += 2UL;
            }
         }
         else {
            u->Re = 0.0f;
            u->Im = 0.0f;
            i = anonym->wp;
            while (i<anonym->len) {
               t = anonym->tab[j];
               u->Re = u->Re+anonym->re[i]*t;
               u->Im = u->Im+anonym->im[i]*t;
               ++j;
               ++i;
            }
            i = 0UL;
            while (i<anonym->wp) {
               t = anonym->tab[j];
               u->Re = u->Re+anonym->re[i]*t;
               u->Im = u->Im+anonym->im[i]*t;
               ++j;
               ++i;
            }
         }
      }
      anonym->wp = anonym->wp%anonym->len;
   }
} /* end dofir() */


static void ssbiir(struct sdr_SSBTAP * tap, float fg, float fgq,
                float * u)
{
   struct sdr_SSBTAP * anonym;
   { /* with */
      struct sdr_SSBTAP * anonym = tap;
      anonym->uc1 = (anonym->uc1+(*u-anonym->uc1)*fg)-anonym->il;
      anonym->uc2 = (anonym->uc2+anonym->il)-anonym->il2;
      anonym->uc3 = (anonym->uc3+anonym->il2)-anonym->uc3*fg;
      anonym->il = anonym->il+(anonym->uc1-anonym->uc2)*fgq;
      anonym->il2 = anonym->il2+(anonym->uc2-anonym->uc3)*fgq;
      *u = anonym->uc3;
   }
} /* end ssbiir() */


static void rotvector(struct Complex * v, float rr, float ri)
{
   float t;
   t = v->Re*rr-v->Im*ri;
   v->Im = v->Re*ri+v->Im*rr;
   v->Re = t;
} /* end rotvector() */


static short getsamp(sdr_pRX rx, char notfirst)
{
   struct Complex abs0;
   struct Complex u;
   float af;
   float w;
   float l;
   float lev;
   u.Re = rx->tapre.ucr2;
   u.Im = rx->tapim.ucr2;
   /* fine shift rest of full 1khz */
   if (rx->fine>0UL) {
      rx->fracphase = (uint32_t)((uint32_t)(rx->fracphase+rx->fine)
                &0x7FFUL);
      rotvector(&u, SSBDDS[rx->fracphase],
                SSBDDS[(uint32_t)((uint32_t)(rx->fracphase+512UL)
                &0x7FFUL)]);
   }
   /* fine shift rest of full 1khz */
   if (rx->modulation=='s') {
      /* ssb */
      /* additional IF fir */
      ssbiir(&rx->ssbre, rx->ssbfg, rx->ssbfgq, &u.Re);
      ssbiir(&rx->ssbim, rx->ssbfg, rx->ssbfgq, &u.Im);
      /* additional IF fir */
      /* rssi */
      lev = 1.0f+u.Re*u.Re+u.Im*u.Im;
      l = lev-rx->rssi;
      if (l>=0.0f) l = l*0.1f;
      else l = l*rx->agcspeed;
      rx->rssi = rx->rssi+l;
      /* rssi */
      /* ssb */
      rx->bfophase = (uint32_t)((uint32_t)(rx->bfophase+rx->bfo)&0x7FFUL)
                ;
      af = X2C_DIVR((u.Re*SSBDDS[rx->bfophase]-u.Im*SSBDDS[(uint32_t)
                ((uint32_t)(rx->bfophase+512UL)&0x7FFUL)])*25000.0f,
                osic_sqrt(rx->rssi));
   }
   else if (rx->modulation=='S') {
      /* ssb */
      /* AM FM */
      /* scan squelch */
      lev = u.Re*u.Re+u.Im*u.Im;
      if (notfirst) rx->sqsum = rx->sqsum+(float)fabs(rx->lastlev-lev);
      else {
         rx->sqsum = 0.0f;
         rx->rssi = 0.0f;
      }
      rx->rssi = rx->rssi+lev; /* sum levels */
      rx->lastlev = lev;
      /* scan squelch */
      af = osic_sqrt(lev)*0.01f;
   }
   else {
      if (rx->fir) dofir(&u, rx->fir, 1);
      /* rssi */
      lev = 1.0f+u.Re*u.Re+u.Im*u.Im;
      l = lev-rx->rssi;
      rx->rssi = rx->rssi+l*0.001f;
      /* rssi */
      /* complex to phase */
      abs0.Re = (float)fabs(u.Re);
      abs0.Im = (float)fabs(u.Im);
      if (abs0.Im>abs0.Re) {
         if (abs0.Im>0.0f) w = X2C_DIVR(abs0.Re,abs0.Im);
         else w = 0.0f;
         w = 1.5707963267949f-(w*1.055f-w*w*0.267f); /* arctan */
      }
      else {
         if (abs0.Re>0.0f) w = X2C_DIVR(abs0.Im,abs0.Re);
         else w = 0.0f;
         w = w*1.055f-w*w*0.267f;
      }
      if (u.Re<0.0f) w = 3.1415926535898f-w;
      if (u.Im<0.0f) w = -w;
      /* complex to phase */
      /* phase highpass make FM */
      af = w-rx->w1;
      rx->w1 = w;
      if (af>3.1415926535898f) af = af-6.2831853071796f;
      if (af<(-3.1415926535898f)) af = af+6.2831853071796f;
      /* phase highpass make FM */
      if (rx->modulation=='a') {
         /* am squelch */
         if (rx->squelch) {
            if (notfirst) rx->sqsum = rx->sqsum+(float)fabs(rx->a1-af);
            rx->a1 = af;
         }
         /* am squelch */
         /* am demod */
         lev = osic_sqrt(lev); /* amplitude */
         af = lev-rx->lastlev; /* - median aplitude */
         rx->lastlev = rx->lastlev+af*0.001f;
         af = (X2C_DIVR(af,rx->lastlev))*32000.0f; /* agc */
      }
      else {
         /* am demod */
         /* fm squelch */
         if (rx->squelch) {
            if (notfirst) {
               rx->sqsum = rx->sqsum+X2C_DIVR((float)fabs(rx->lastlev-lev)
                ,rx->lastlev+lev);
            }
            rx->lastlev = lev;
         }
         /* fm squelch */
         af = af*7.9577471545948E+3f;
      }
   }
   if (af>32000.0f) af = 32000.0f;
   else if (af<(-3.2E+4f)) af = (-3.2E+4f);
   return (short)X2C_TRUNCI(af,-32768,32767);
} /* end getsamp() */

#define sdr_M 32767.0


static void getiq(sdr_pRX rx, short * i, short * q,
                char dofilt)
{
   struct Complex u;
   u.Re = rx->tapre.ucr2*iqlevel;
   u.Im = rx->tapim.ucr2*iqlevel;
   if (rx->fir) dofir(&u, rx->fir, dofilt);
   if (dofilt) {
      if (u.Re>32767.0f) u.Re = 32767.0f;
      else if (u.Re<(-3.2767E+4f)) u.Re = (-3.2767E+4f);
      if (u.Im>32767.0f) u.Im = 32767.0f;
      else if (u.Im<(-3.2767E+4f)) u.Im = (-3.2767E+4f);
      *i = (short)X2C_TRUNCI(u.Re,-32768,32767);
      *q = (short)X2C_TRUNCI(u.Im,-32768,32767);
   }
} /* end getiq() */

#define sdr_FINESTEP 1024


extern int32_t sdr_getsdr(uint32_t samps, sdr_pRX rx[],
                uint32_t rx_len)
{
   uint32_t inbytes;
   uint32_t insamps;
   uint32_t inwords;
   uint32_t wssb;
   uint32_t ws;
   uint32_t b;
   uint32_t a;
   uint32_t r;
   uint32_t s;
   int32_t res;
   int32_t u;
   float allsamp;
   struct sdr_RX * anonym;
   struct sdr_RX * anonym0;
   uint32_t tmp;
   if (reconnect && fd<0L) {
      if (isfile) fd = osi_OpenRead(url, 1001ul);
      else {
         usleep(1000000UL);
         fd = connecttob(url, port);
      }
   }
   if (fd>=0L) {
      if (samps>32767UL) samps = 32767UL;
      allsamp = sampfrac+onesamp*(float)samps;
      insamps = (uint32_t)X2C_TRUNCC(allsamp,0UL,X2C_max_longcard);
      inwords = insamps*2UL;
      inbytes = insamps*bytespersamp;
      if (isfile) {
         a = 0UL;
         do {
            res = read(fd, (char *) &iqbuf.b[a], inbytes-a);
            if (res<=0L) {
               osic_Close(fd);
               fd = -1L;
               return -1L;
            }
            a += (uint32_t)res;
         } while (a<inbytes);
      }
      else if (readsockb(fd, (char *) &iqbuf, (int32_t)inbytes)<0L) {
         /* connect lost */
         osic_Close(fd);
         fd = -1L;
         return -1L;
      }
      if (sdr_debfd>=0L) {
         osi_WrBin(sdr_debfd, (char *) &iqbuf, sizeof(union _0)/1u,
                inbytes);
      }
      if (bytespersamp==2UL) {
         for (a = insamps-1UL;; a--) {
            iqbuf.i32[a].r = (int32_t)iqbuf.u8[a].Re-127L;
            iqbuf.i32[a].i = (int32_t)iqbuf.u8[a].Im-127L;
            if (a==0UL) break;
         } /* end for */
      }
      else if (bytespersamp==4UL) {
         for (a = insamps-1UL;; a--) {
            iqbuf.i32[a].r = (int32_t)iqbuf.i16[a].Re;
            iqbuf.i32[a].i = (int32_t)iqbuf.i16[a].Im;
            if (a==0UL) break;
         } /* end for */
      }
      a = 0UL;
      tmp = samps-1UL;
      s = 0UL;
      if (s<=tmp) for (;; s++) {
         r = 0UL;
         b = (uint32_t)X2C_TRUNCC(sampfrac+onesamp*(float)(s+1UL),0UL,
                X2C_max_longcard);
         while (rx[r]) {
            { /* with */
               struct sdr_RX * anonym = rx[r];
               ws = anonym->width;
               if (anonym->modulation=='s') {
                  wssb = (anonym->width*5UL)/4UL;
                  ws = 3000UL;
                  while (ws<wssb) ws = ws*2UL;
                  /*WrInt(ws, 0);WrStrLn(" ws"); */
                  anonym->ssbfg = X2C_DIVR((float)anonym->width,
                (float)audiohz);
                  anonym->ssbfgq = anonym->ssbfg*anonym->ssbfg*2.0f;
                  anonym->bfo = ((uint32_t)labs(anonym->maxafc)*2048UL)
                /audiohz;
                  if (anonym->maxafc>0L) anonym->bfo = 2048UL-anonym->bfo;
                  /*WrInt(bfo, 0);WrStrLn(" bfo"); */
                  anonym->fine = (anonym->dffrac*2048UL)/audiohz;
                  if (anonym->agc>0UL) {
                     anonym->agcspeed = X2C_DIVR(0.2f,(float)anonym->agc);
                  }
                  else anonym->agcspeed = 0.00025f;
               }
               else {
                  anonym->fine = 0UL;
                  anonym->agcspeed = 0.001f;
               }
               if (bytespersamp==8UL) {
                  iirvarf4(rx[r], a, b, (float)anonym->width*varbwk);
               }
               else {
                  if (rtlhz<2048000UL) {
                     ws = ws*2UL;
                  }
                  if (ws==3000UL) iir512(rx[r], a, b);
                  else if (ws==6000UL) iir256(rx[r], a, b);
                  else if (ws==12000UL) iir128(rx[r], a, b);
                  else if (ws==24000UL) iir64(rx[r], a, b);
                  else if (ws==48000UL) iir32(rx[r], a, b);
                  else if (ws==96000UL) iir16(rx[r], a, b);
                  else if (ws==192000UL) iir8(rx[r], a, b);
                  else iirvar(rx[r], a, b, (float)ws*6.7934782608696E-7f);
               }
               if (anonym->modulation=='i') {
                  if (anonym->qsamples) {
                     getiq(rx[r], &anonym->samples[s], &anonym->qsamples[s],
                1); /* full rate iq */
                  }
                  else {
                     getiq(rx[r], &anonym->samples[s],
                &anonym->samples[s+1UL], !(s&1)); /* half rate iq */
                  }
               }
               else {
                  u = (int32_t)getsamp(rx[r], s>0UL);
                  anonym->samples[s] = (short)u;
                  if (anonym->afcrun) anonym->median = anonym->median+u;
               }
            }
            ++r;
         }
         a = b;
         if (s==tmp) break;
      } /* end for */
      sampfrac = allsamp-(float)insamps;
      /*AFC */
      r = 0UL;
      while (rx[r]) {
         { /* with */
            struct sdr_RX * anonym0 = rx[r];
            anonym0->afcrun = 0;
            if (anonym0->modulation=='f' && anonym0->maxafc>0L) {
               if (anonym0->afcrssi<anonym0->rssi) {
                  anonym0->afcrssi = anonym0->rssi; /* peak level rssi */
               }
               else anonym0->afcrssi = anonym0->afcrssi*0.9985f;
               if (anonym0->afcrssi*0.7f<anonym0->rssi) {
                  /* near peak rssi so let afc work */
                  anonym0->median = anonym0->median-(anonym0->afckhz*(int32_t)
                samps*1024L)/anonym0->maxafc; /* weak pull to middle */
                  if (anonym0->median>sdr_afcspeed) {
                     ++anonym0->afckhz;
                     if (anonym0->afckhz>anonym0->maxafc) {
                        anonym0->afckhz = anonym0->maxafc;
                     }
                     anonym0->median = 0L;
                  }
                  else if (anonym0->median<-sdr_afcspeed) {
                     --anonym0->afckhz;
                     if (anonym0->afckhz<-anonym0->maxafc) {
                        anonym0->afckhz = -anonym0->maxafc;
                     }
                     anonym0->median = 0L;
                  }
                  anonym0->afcrun = 1;
               }
            }
         }
         /* low rssi so freeze afc */
         /*WrInt(ORD(afcrun),1); */
         ++r;
      }
      /*AFC */
      return (int32_t)samps;
   }
   else return -1L;
   return 0;
} /* end getsdr() */


extern void sdr_setparm(uint32_t num, uint32_t value)
{
   int32_t res;
   char tbuf[5];
   tbuf[0U] = (char)num;
   tbuf[1U] = (char)(value/16777216UL);
   tbuf[2U] = (char)(value/65536UL&255UL);
   tbuf[3U] = (char)(value/256UL&255UL);
   tbuf[4U] = (char)(value&255UL);
   res = sendsock(fd, tbuf, 5L);
} /* end setparm() */


extern char sdr_startsdr(char ip[], uint32_t ip_len,
                char tport[], uint32_t tport_len, uint32_t inhz,
                uint32_t outhz, char reconn, uint32_t format)
{
   aprsstr_Assign(url, 1001ul, ip, ip_len);
   aprsstr_Assign(port, 11ul, tport, tport_len);
   reconnect = reconn;
   bytespersamp = 2UL;
   iqlevel = 1.5625E-2f;
   if (format==2UL) {
      bytespersamp = 4UL;
      iqlevel = 6.103515625E-5f;
   }
   if (inhz>0UL) rtlhz = inhz;
   if (format==4UL) {
      if (rtlhz<1000000UL || rtlhz>3000000UL) return 0;
      bytespersamp = 8UL;
      iqlevel = 2.0f;
      varbwk = X2C_DIVR(1.3913043478261f,(float)rtlhz);
   }
   else if (rtlhz!=1024000UL && (rtlhz<2048000UL || rtlhz>2500000UL)) {
      return 0;
   }
   if (outhz>0UL) audiohz = outhz;
   onesamp = X2C_DIVR((float)rtlhz,(float)audiohz);
                /* sample reduction */
   sampfrac = 0.0f;
   isfile = port[0U]=='0' && port[1U]==0;
   if (fd<0L) {
      if (isfile) fd = osi_OpenRead(url, 1001ul);
      else fd = connecttob(url, port);
   }
   if (fd>=0L) {
      if (!isfile && format==1UL) sdr_setparm(2UL, rtlhz);
      if (inhz>=2048000UL) initdds(2048UL);
      else initdds(1024UL);
      initssbdds(SSBDDS, 2048ul);
   }
   return fd>=0L;
} /* end startsdr() */


extern void sdr_BEGIN(void)
{
   static int sdr_init = 0;
   if (sdr_init) return;
   sdr_init = 1;
   if (sizeof(sdr_AUDIOSAMPLE)!=131072) X2C_ASSERT(0);
   aprsstr_BEGIN();
   osi_BEGIN();
   fd = -1L;
   sdr_debfd = -1L;
   reconnect = 0;
   rtlhz = 2048000UL;
   audiohz = 16000UL;
   sdr_afcspeed = 400000000L;
}