Fix calculation of mag^2.
This commit is contained in:
@ -56,7 +56,7 @@ void rx_test() {
|
|||||||
|
|
||||||
volatile uint32_t buffer[4096];
|
volatile uint32_t buffer[4096];
|
||||||
uint32_t i = 0;
|
uint32_t i = 0;
|
||||||
int16_t magsq;
|
uint32_t magsq;
|
||||||
int8_t sigi, sigq;
|
int8_t sigi, sigq;
|
||||||
|
|
||||||
sgpio_cpld_stream_enable();
|
sgpio_cpld_stream_enable();
|
||||||
@ -71,11 +71,7 @@ void rx_test() {
|
|||||||
/* find the magnitude squared */
|
/* find the magnitude squared */
|
||||||
sigi = buffer[i & 4095] & 0xff;
|
sigi = buffer[i & 4095] & 0xff;
|
||||||
sigq = (buffer[i & 4095] >> 8) & 0xff;
|
sigq = (buffer[i & 4095] >> 8) & 0xff;
|
||||||
magsq = sigi * sigq;
|
magsq = sigi * sigi + sigq * sigq;
|
||||||
if ((uint16_t)magsq & 0x8000) {
|
|
||||||
magsq ^= 0xffff;
|
|
||||||
magsq++;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* illuminate LED3 only when magsq exceeds threshold */
|
/* illuminate LED3 only when magsq exceeds threshold */
|
||||||
if (magsq > 0x3c00)
|
if (magsq > 0x3c00)
|
||||||
|
Reference in New Issue
Block a user