mirror
/
usdx-kamocat
kopia lustrzana https://github.com/kamocat/uSDX
1
0
Forkuj 0
Kod Zgłoszenia Projekty Wydania Wiki Aktywność

Unwrapped the phase to remove discontinuities

chibios
Marshal Horn 2020-07-22 08:45:17 -07:00
rodzic 9c5011542d
commit 048e851c47
1 zmienionych plików z 10 dodań i 2 usunięć
Pokaż statystyki Ściągnij plik aktualizacji Ściągnij plik porównania Expand all files Collapse all files

12
code/radio/ssb.c
Wyświetl plik

@ -44,7 +44,8 @@ msg_t ssb_rx(mailbox_t * inbox, enum radio_mode * mode){
msg_t ssb_tx(mailbox_t * inbox, enum radio_mode * mode, struct synth * txclk){
union complex c;
const int len = 32;
const uint8_t len = 32;
const uint8_t mask = len-1;
const int sample_rate = 5000;
int16_t raw[len];
int16_t phase[len];
@ -59,9 +60,16 @@ msg_t ssb_tx(mailbox_t * inbox, enum radio_mode * mode, struct synth * txclk){
int16_t imag = hilbert32(raw, i)>>16;
if(LSB==*mode)
imag=-imag;
uint8_t j = (i-16)&31; // Match group delay of Hilbert transform
uint8_t j = (i-16)&mask; // Match group delay of Hilbert transform
int16_t real = raw[j]; //TODO: Match frequency response of Hilbert transform
phase[i]=arctan3(imag, real);
// Unwrap the phase
j = (i-1)&mask;
if( (phase[i]-phase[j]) > 180 )
phase[i] -=360;
else if( (phase[i]-phase[j]) < 180 )
phase[i] +=360;
// Calculate outputs
int16_t amp=magn(imag, real);
int32_t freq = diff32(phase,i);
freq *= sample_rate;