librpitx/app/testrpitx.cpp
2020-11-02 10:46:19 +00:00

748 lines
16 KiB
C++

#include <unistd.h>
#include "../src/librpitx.h"
#include <unistd.h>
#include "stdio.h"
#include <cstring>
#include <signal.h>
bool running = true;
/*int
gcd ( int a, int b )
{
int c;
while ( a != 0 ) {
c = a; a = b%a; b = c;
}
return b;
}*/
uint64_t gcd(uint64_t x, uint64_t y)
{
return y == 0 ? x : gcd(y, x % y);
}
uint64_t lcm(uint64_t x, uint64_t y)
{
return x * y / gcd(x, y);
}
void SimpleTest(uint64_t Freq)
{
generalgpio genpio;
fprintf(stderr, "GPIOPULL =%x\n", genpio.gpioreg[GPPUDCLK0]);
#define PULL_OFF 0
#define PULL_DOWN 1
#define PULL_UP 2
genpio.gpioreg[GPPUD] = 1; //PULL_DOWN;
usleep(150);
genpio.gpioreg[GPPUDCLK0] = (1 << 4); //GPIO CLK is GPIO 4
usleep(150);
genpio.gpioreg[GPPUDCLK0] = (0); //GPIO CLK is GPIO 4
//genpio.setpulloff(4);
padgpio pad;
pad.setlevel(7);
clkgpio clk;
clk.print_clock_tree();
clk.SetPllNumber(clk_pllc, 0);
//clk.SetAdvancedPllMode(true);
//clk.SetPLLMasterLoop(0,4,0);
//clk.Setppm(+7.7);
clk.SetCenterFrequency(Freq, 1000);
double freqresolution = clk.GetFrequencyResolution();
double RealFreq = clk.GetRealFrequency(0);
fprintf(stderr, "Frequency resolution=%f Error freq=%f\n", freqresolution, RealFreq);
int Deviation = 0;
clk.SetFrequency(000);
clk.enableclk(4);
usleep(100);
//clk.SetClkDivFrac(100,0); // If mash!=0 update doesnt seem to work
int count = 0;
while (running)
{
//clk.SetMasterMultFrac(44,(1<<count));
//uint32_t N=(1<<18);
uint32_t N = (1 << 13) * count;
//clk.SetMasterMultFrac(34,N);
printf("count =%d gcd%d spurious%f N=%x %f\n", count, lcm(N, 1 << 20), (double)gcd(1 << 20, N) * 19.2e6 / (double)(1 << 20), N, N / (float)(1 << 20));
count = (count + 1) % 128;
//usleep(10000000);
int a = getc(stdin);
static int Ki = 4, Kp = 0, Ka = 0;
Kp = Kp + 1;
if (Kp > 15)
{
Kp = 0;
Ki = Ki + 1;
}
//Ki=Ki+1;
if (Ki > 11)
{
Ki = 4;
Ka++;
}
Ki = Kp;
clk.SetClkDivFrac(count, count);
//clk.SetPLLMasterLoop(Ki,4,Ka);
//clk.SetPLLMasterLoop(2,4,0);
//clk.SetPLLMasterLoop(3,4,0); //best one
//printf("Ki=%d :Kp %d Ka %d\n ",Ki,Kp,Ka);
/*clk.SetFrequency(000);
sleep(5);
clk.SetFrequency(freqresolution);
sleep(5);*/
}
/*
for(int i=0;i<100000;i+=1)
{
clk.SetFrequency(0);
usleep(1000);
}*/
clk.disableclk(4);
}
void SimpleTestDMA(uint64_t Freq)
{
int SR = 200000;
int FifoSize = 4096;
ngfmdmasync ngfmtest(Freq, SR, 14, FifoSize);
for (int i = 0; running;)
{
//usleep(10);
usleep(FifoSize * 1000000.0 * 3.0 / (4.0 * SR));
int Available = ngfmtest.GetBufferAvailable();
if (Available > FifoSize / 2)
{
int Index = ngfmtest.GetUserMemIndex();
//printf("GetIndex=%d\n",Index);
for (int j = 0; j < Available; j++)
{
//ngfmtest.SetFrequencySample(Index,((i%10000)>5000)?1000:0);
ngfmtest.SetFrequencySample(Index + j, (i % SR) / 10.0);
i++;
}
}
}
fprintf(stderr, "End\n");
ngfmtest.stop();
}
void SimpleTestFileIQ(uint64_t Freq)
{
FILE *iqfile = NULL;
iqfile = fopen("../ssbtest.iq", "rb");
if (iqfile == NULL)
printf("input file issue\n");
#define IQBURST 1280
bool stereo = true;
int SR = 48000;
int FifoSize = 512;
iqdmasync iqtest(Freq, SR, 14, FifoSize, MODE_IQ);
short IQBuffer[IQBURST * 2];
std::complex<float> CIQBuffer[IQBURST];
while (running)
{
int nbread = fread(IQBuffer, sizeof(short), IQBURST * 2, iqfile);
if (nbread > 0)
{
for (int i = 0; i < nbread / 2; i++)
{
CIQBuffer[i] = std::complex<float>(IQBuffer[i * 2] / 32768.0, IQBuffer[i * 2 + 1] / 32768.0);
}
iqtest.SetIQSamples(CIQBuffer, nbread / 2, 1);
}
else
{
printf("End of file\n");
fseek(iqfile, 0, SEEK_SET);
}
}
iqtest.stop();
}
void SimpleTestbpsk(uint64_t Freq)
{
clkgpio clk;
clk.print_clock_tree();
int SR = 250000;
int FifoSize = 10000;
int NumberofPhase = 2;
phasedmasync biphase(Freq, SR, NumberofPhase, 14, FifoSize);
padgpio pad;
pad.setlevel(7);
int lastphase = 0;
#define BURST_SIZE 100
int PhaseBuffer[BURST_SIZE];
while (running)
{
for (int i = 0; i < BURST_SIZE; i++)
{
int phase = (rand() % NumberofPhase);
PhaseBuffer[i] = phase;
}
biphase.SetPhaseSamples(PhaseBuffer, BURST_SIZE);
}
biphase.stop();
}
void SimpleTestSerial()
{
bool stereo = true;
int SR = 10000;
int FifoSize = 1024;
bool dualoutput = true;
serialdmasync testserial(SR, 14, FifoSize, dualoutput);
while (running)
{
usleep(10);
int Available = testserial.GetBufferAvailable();
if (Available > 256)
{
int Index = testserial.GetUserMemIndex();
for (int i = 0; i < Available; i++)
{
testserial.SetSample(Index + i, i);
}
}
}
testserial.stop();
}
void SimpleTestAm(uint64_t Freq)
{
FILE *audiofile = NULL;
audiofile = fopen("../ssbaudio48.wav", "rb");
if (audiofile == NULL)
printf("input file issue\n");
bool Stereo = true;
int SR = 48000;
int FifoSize = 512;
amdmasync amtest(Freq, SR, 14, FifoSize);
short AudioBuffer[128 * 2];
while (running)
{
//usleep(FifoSize*1000000.0*1.0/(8.0*SR));
usleep(100);
int Available = amtest.GetBufferAvailable();
if (Available > 256)
{
int Index = amtest.GetUserMemIndex();
int nbread = fread(AudioBuffer, sizeof(short), 128 * 2, audiofile);
if (nbread > 0)
{
for (int i = 0; i < nbread / 2; i++)
{
if (!Stereo)
{
float x = ((AudioBuffer[i * 2] / 32768.0) + (AudioBuffer[i * 2 + 1] / 32768.0)) / 4.0;
amtest.SetAmSample(Index + i, x);
}
else
{
float x = ((AudioBuffer[i] / 32768.0) / 2.0) * 8.0;
amtest.SetAmSample(Index + i, x);
}
}
}
else
{
printf("End of file\n");
fseek(audiofile, 0, SEEK_SET);
//break;
}
}
}
amtest.stop();
}
void SimpleTestOOK(uint64_t Freq)
{
int SR = 10; //10 HZ
int FifoSize = 21; //24
ookburst ook(Freq, SR, 14, FifoSize,100);
unsigned char TabSymbol[FifoSize] = {0, 1, 0, 1, 0, 1, 0, 1, 0, 0, 1, 1, 0, 0, 1, 1, 0, 1, 0, 1, 0};
ook.SetSymbols(TabSymbol, FifoSize);
}
void SimpleTestOOKTiming(uint64_t Freq)
{
// 300ms max message
ookbursttiming ooksender(Freq, 300000);
ookbursttiming::SampleOOKTiming Message[100];
for (size_t i = 0; i < 10; i += 2)
{
Message[i].value = 1;
Message[i].duration = 5000;
Message[i + 1].value = 0;
Message[i + 1].duration = 15000;
}
ooksender.SendMessage(Message, 10);
}
uint8_t SetCRC8(uint8_t *addr)
{
char nibble[8];
for (size_t i = 0; i < 4; i++)
{
nibble[i * 2] = 0;
nibble[i * 2 + 1] = 0;
for (int j = 0; j < 4; j++)
{
nibble[i * 2] |= addr[i * 8 + j] << (j);
nibble[i * 2 + 1] |= addr[i * 8 + j + 4] << (j);
}
fprintf(stderr, "nibble[%d]=%x\nnibble[%d]=%x\n", i * 2, nibble[i * 2], i * 2 + 1, nibble[i * 2 + 1]);
}
int8_t checksumcalc = 0;
if ((nibble[2] & 0x6) != 6)
{ // temperature packet
fprintf(stderr, "Temp\n");
checksumcalc = (0xf - nibble[0] - nibble[1] - nibble[2] - nibble[3] - nibble[4] - nibble[5] - nibble[6] - nibble[7]) & 0xf;
}
else
{
if ((nibble[3] & 0x7) == 3)
{ // Rain packet
fprintf(stderr, "Rain\n");
checksumcalc = (0x7 + nibble[0] + nibble[1] + nibble[2] + nibble[3] + nibble[4] + nibble[5] + nibble[6] + nibble[7]) & 0xf;
}
else
{ // Wind packet
fprintf(stderr, "wind\n");
checksumcalc = (0xf - nibble[0] - nibble[1] - nibble[2] - nibble[3] - nibble[4] - nibble[5] - nibble[6] - nibble[7]) & 0xf;
}
}
for (size_t i = 0; i < 4; i++)
{
addr[32 + i] = (checksumcalc >> (i)) & 1;
}
fprintf(stderr, "CRC=%x", checksumcalc);
return checksumcalc;
}
void AlectoOOK(uint64_t Freq)
{
// 30ms max message
ookbursttiming ooksender(Freq, 1200000);
ookbursttiming::SampleOOKTiming Message[50 * 6 * 2]; // 46 exactly * 6 times
ookbursttiming::SampleOOKTiming pulse;
pulse.value = 1;
pulse.duration = 450; //468
ookbursttiming::SampleOOKTiming Sync;
Sync.value = 0;
Sync.duration = 9000; //8956
ookbursttiming::SampleOOKTiming Zero;
Zero.value = 0;
Zero.duration = 2000; //2016
ookbursttiming::SampleOOKTiming One;
One.value = 0;
One.duration = 4000;
size_t n = 0;
//Widn average
unsigned char AlectoProtocol[] = {0, 0, 0, 1, 0, 1, 0, 1, 0, 1, 1, 0, 1, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 1, 0, 1, 0};
// Wind gust direction
unsigned char AlectoProtocol1[] = {0, 0, 0, 1, 0, 1, 0, 1, 0, 1, 1, 0, 1, 1, 1, 1, 0, 0, 0, 0, 1, 1, 1, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0};
// Temperature
unsigned char AlectoProtocolT[] = {0, 0, 0, 1, 0, 1, 0, 1, 0, 0, 0, 0, 1, 0, 1, 0, 0, 1, 1, 1, 0, 0, 0, 0, 1, 0, 0, 0, 0, 1, 0, 0, 1, 1, 1, 0};
//ID
/*AlectoProtocol[0]=1;
unsigned char LowBattery=0;
AlectoProtocol[8]=LowBattery;
AlectoProtocol[9]=1;//Wind
AlectoProtocol[10]=1;//Wind
*/
//AlectoProtocol[11] = 1; //Button generated
//AlectoProtocol[28] = 1; //Wind
//AlectoProtocol1[28] = 1; //Wind
//CheckSum n8 = ( 0xf - n0 - n1 - n2 - n3 - n4 - n5 - n6 - n7 ) & 0xf
for (size_t h = 0; h < 6; h++)
{
int direction = h * 45;
for (size_t i = 0; i < 9; i++)
{
AlectoProtocol1[15 + i] = (direction >> (i)) & 0x1;
}
int Speed = h * 10;
Speed = Speed / 0.2;
for (size_t i = 0; i < 8; i++)
{
AlectoProtocol[24 + i] = (direction >> (i)) & 0x1;
AlectoProtocol1[24 + i] = (direction >> (i)) & 0x1;
}
SetCRC8(AlectoProtocol1);
SetCRC8(AlectoProtocol);
n = 0;
for (size_t i = 0; i < 8; i++)
{
Message[n++] = pulse;
Message[n++] = One;
}
Message[n++] = pulse;
Message[n++] = Sync;
for (size_t k = 0; k < 6; k++)
{
for (size_t i = 0; i < 36; i++)
{
Message[n++] = pulse;
if (k % 2 == 0)
{
if (AlectoProtocol[i] == 0)
Message[n++] = Zero;
else
Message[n++] = One;
}
else
{
if (AlectoProtocol1[i] == 0)
Message[n++] = Zero;
else
Message[n++] = One;
}
//Message[n++]=(AlectoProtocol[i]==0)?Zero:One;
}
if (k < 5) // Not last one
{
for (size_t i = 0; i < 4; i++)
{
Message[n++] = pulse;
Message[n++] = Sync;
}
}
}
Message[n++] = pulse;
Message[n++] = Sync;
Message[n++] = pulse;
fprintf(stderr, "N=%d\n", n);
ooksender.SendMessage(Message, n);
sleep(2);
int Temperature = h * 100 + 200;
for (size_t i = 0; i < 12; i++)
{
AlectoProtocolT[12 + i] = (Temperature >> (i)) & 0x1;
}
//AlectoProtocolT[11] = 1;
//AlectoProtocolT[8] = 1;
SetCRC8(AlectoProtocolT);
fprintf(stderr, "Temperature sending\n");
n = 0;
for (size_t i = 0; i < 8; i++)
{
Message[n++] = pulse;
Message[n++] = One;
}
Message[n++] = pulse;
Message[n++] = Sync;
for (size_t k = 0; k < 6; k++)
{
for (size_t i = 0; i < 36; i++)
{
Message[n++] = pulse;
if (AlectoProtocolT[i] == 0)
Message[n++] = Zero;
else
Message[n++] = One;
}
if (k < 5) // Not last one
{
//for (size_t i = 0; i < 4; i++)
{
Message[n++] = pulse;
Message[n++] = Sync;
}
}
}
Message[n++] = pulse;
Message[n++] = Sync;
Message[n++] = pulse;
ooksender.SendMessage(Message, n);
//sleep(5);
sleep(2);
}
}
void RfSwitchOOK(uint64_t Freq)
{
/*
* From http://elektronikforumet.com/wiki/index.php/RF_Protokoll_-_Proove_self_learning
* Proove packet structure (32 bits):
* HHHH HHHH HHHH HHHH HHHH HHHH HHGO CCEE
* H = The first 26 bits are transmitter unique codes, and it is this code that the receiver “learns” to recognize.
* G = Group code. Set to 0 for on, 1 for off.
* O = On/Off bit. Set to 0 for on, 1 for off.
* C = Channel bits.
* E = Unit bits. Device to be turned on or off. Unit #1 = 00, #2 = 01, #3 = 10.
* Physical layer.
* Every bit in the packets structure is sent as two physical bits.
* Where the second bit is the inverse of the first, i.e. 0 -> 01 and 1 -> 10.
* Example: 10101110 is sent as 1001100110101001
* The sent packet length is thus 64 bits.
* A message is made up by a Sync bit followed by the Packet bits and ended by a Pause bit.
* Every message is repeated four times.
* */
ookbursttiming ooksender(Freq, 1200000);
ookbursttiming::SampleOOKTiming Message[50 * 6 * 2];
ookbursttiming::SampleOOKTiming pulse;
pulse.value = 1;
pulse.duration = 200; //468
ookbursttiming::SampleOOKTiming Sync;
Sync.value = 0;
Sync.duration = 10700; //8956
ookbursttiming::SampleOOKTiming Zero;
Zero.value = 0;
Zero.duration = 1300; //2016
ookbursttiming::SampleOOKTiming One;
One.value = 0;
One.duration = 300;
ookbursttiming::SampleOOKTiming preamble;
preamble.value = 0;
preamble.duration = 2600;
unsigned int ID = 32288767;
ID = ID << 6;
unsigned char MessageTx[4];
int group = 1;
int Channel = 3;
int unit = 2;
int power = 1;
ookbursttiming::SampleOOKTiming MessageOOK[200];
for (int times = 0; times < 20; times++)
{
power = times % 2;
for (int i = 0; i < 4; i++)
MessageTx[i] = ID >> (8 * (3 - i));
MessageTx[3] |= (group & 0x1) << 5;
MessageTx[3] |= (~power & 0x1) << 4;
MessageTx[3] |= (Channel & 0x3) << 2;
MessageTx[3] |= (unit & 0x3);
for (int i = 0; i < 2; i++)
{
int n = 0;
MessageOOK[n++] = pulse;
MessageOOK[n++] = preamble;
for (int j = 0; j < 4; j++)
{
for (int k = 0; k < 8; k++)
{
if (((MessageTx[j] >> (7 - k)) & 1) == 0)
{
MessageOOK[n++] = pulse;
MessageOOK[n++] = Zero;
MessageOOK[n++] = pulse;
MessageOOK[n++] = One;
}
else
{
MessageOOK[n++] = pulse;
MessageOOK[n++] = One;
MessageOOK[n++] = pulse;
MessageOOK[n++] = Zero;
}
}
}
MessageOOK[n++] = pulse;
MessageOOK[n++] = Sync;
ooksender.SendMessage(MessageOOK, n);
}
usleep(100000);
}
}
void SimpleTestBurstFsk(uint64_t Freq)
{
//int SR=40625;
int SR = 1000;
float Deviation = 2000;
int FifoSize = 21;
fskburst fsktest(Freq, SR, Deviation, 14, FifoSize);
unsigned char TabSymbol[FifoSize] = {0, 1, 0, 1, 0, 1, 0, 1, 0, 0, 1, 1, 0, 0, 1, 1, 0, 1, 0, 1, 0};
//while(running)
{
fsktest.SetSymbols(TabSymbol, FifoSize);
}
fsktest.stop();
}
void SimpleTestAtv(uint64_t Freq)
{
//int SR = 1000000;
int SR = 1000000;
int FifoSize = 625 * 52;
unsigned char samples[FifoSize];
atv atvtest(Freq, SR, 14, 625);
atvtest.start();
enum {patern_grey,patern_square,patern_move,patern_point};
int Mode=patern_move;
bool random_patern=true;
for(int frame=0;running;frame++)
{
int x,y;
y=rand()%625;
x=rand()%52;
if((frame%50==0)&&(random_patern))
Mode=rand()%(patern_point+1);
for(int i=0;i<625;i++)
{
for (int j = 0; j < 52; j++)
{
switch(Mode)
{
case patern_grey:
{
samples[i*52+j]=255*(j/52.0);
}
break;
case patern_square:
{
if(i%64<(frame%64))
samples[i*52+j]=(j%16<8)?255*(j/52.0):255*(1-(j/52.0));
else
samples[i*52+j]=(j%16<8)?255:0;
}
break;
case patern_move:
{
samples[i*52+j]=((i+j*frame)%255);
}
break;
case patern_point:
{
if((i==y)&&(j==x))
samples[i*52+j]=255;
else
samples[i*52+j]=0;
}
break;
}
}
}
//atvtest.SetTvSamples(samples,FifoSize/4);
atvtest.SetFrame(samples,625);
usleep(40000);
}
}
void info(void)
{
clkgpio clk;
clk.print_clock_tree();
}
static void
terminate(int num)
{
running = false;
fprintf(stderr, "Caught signal - Terminating\n");
}
int main(int argc, char *argv[])
{
uint64_t Freq = 144200000;
if (argc > 1)
Freq = atof(argv[1]);
for (int i = 0; i < 64; i++)
{
struct sigaction sa;
std::memset(&sa, 0, sizeof(sa));
sa.sa_handler = terminate;
sigaction(i, &sa, NULL);
}
dbg_setlevel(1);
//SimpleTest(Freq);
//SimpleTestbpsk(Freq);
//SimpleTestFileIQ(Freq);
//SimpleTestDMA(Freq);
//SimpleTestAm(Freq);
//SimpleTestOOK(Freq);
//SimpleTestBurstFsk(Freq);
//SimpleTestOOKTiming(Freq);
//AlectoOOK(Freq);
//RfSwitchOOK(Freq);
//SimpleTestbpsk(Freq);
//SimpleTestAtv(Freq);
info();
}