Send out when address changes for random address mode

pull/46/head
Pawel Jalocha 2022-03-25 18:17:44 +00:00
rodzic bdfa3b99f8
commit 18adc25573
1 zmienionych plików z 11 dodań i 1 usunięć

Wyświetl plik

@ -123,7 +123,17 @@ void FlightProcess(void)
{ if(Parameters.Stealth) RndID_TimeToChange=60; }
else
{ if(RndID_TimeToChange==1)
{ Parameters.Address = GPS_Random^RX_Random; }
{ Parameters.Address = (GPS_Random^RX_Random)&0xFFFFFF;
Parameters.WritePOGNS(Line);
xSemaphoreTake(CONS_Mutex, portMAX_DELAY);
Format_String(CONS_UART_Write, Line);
// Format_String(CONS_UART_Write, "$POGNS,Address=0x");
// Format_Hex(CONS_UART_Write, (uint8_t)(Parameters.Address>>16));
// Format_Hex(CONS_UART_Write, (uint16_t)(Parameters.Address));
// Format_String(CONS_UART_Write, ",AddrType=");
// CONS_UART_Write('0'+Parameters.AddrType);
// Format_String(CONS_UART_Write, "\n");
xSemaphoreGive(CONS_Mutex); }
RndID_TimeToChange--; }
if(PrevInFlight==1 && InFlight==0) RndID_TimeToChange+=20;
}