BRNSystems/brnQuanFW
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases 2 Wiki Activity

FIX #151: Use aviation channels to frequency conversion scheme for 8.33 step rounding

Browse Source
This commit is contained in:
Krzysiek Egzmont
2023-11-27 01:43:36 +01:00
parent 07588853e4
commit 9f22e8a9df
1 changed files with 5 additions and 11 deletions
Download Patch File Download Diff File Expand all files Collapse all files

16
frequencies.c
View File

@@ -116,23 +116,17 @@ uint8_t FREQUENCY_CalculateOutputPower(uint8_t TxpLow, uint8_t TxpMid, uint8_t T
return TxpMid; return TxpMid;
} }
static int32_t rnd(int32_t freq, uint16_t step)
{
if(step == 1)
return freq;
return (freq + (step + 1) / 2) / step * step;
}
uint32_t FREQUENCY_RoundToStep(uint32_t freq, uint16_t step) uint32_t FREQUENCY_RoundToStep(uint32_t freq, uint16_t step)
{ {
if(step == 833) { if(step == 833) {
uint32_t base = freq/2500*2500; uint32_t base = freq/2500*2500;
int f = rnd(freq - base, step); int chno = (freq - base) / 700; // convert entered aviation 8.33Khz channel number scheme to actual frequency.
int x = f / step; return base + (chno * 833) + (chno == 3);
return base + f + (x == 3);
} }
if(step == 1)
return rnd(freq, step); return freq;
return (freq + (step + 1) / 2) / step * step;
} }
int TX_freq_check(const uint32_t Frequency) int TX_freq_check(const uint32_t Frequency)