Fixed step 2/3 of 8.33kHz.

DualTachyon · Sep 28, 2023 · cd515a4 · cd515a4
1 parent dadd182
commit cd515a4
Show file tree

Hide file tree

Showing 2 changed files with 10 additions and 2 deletions.
diff --git a/app/app.c b/app/app.c
@@ -385,9 +385,13 @@ void APP_SetFrequencyByStep(VFO_Info_t *pInfo, int8_t Step)
 	if (pInfo->StepFrequency == 833) {
 		const uint32_t Lower = LowerLimitFrequencyBandTable[pInfo->Band];
 		const uint32_t Delta = Frequency - Lower;
-		const uint32_t Base = (Delta / 2500) * 2500;
+		uint32_t Base = (Delta / 2500) * 2500;
 		const uint32_t Index = ((Delta - Base) % 2500) / 833;
 
+		if (Index == 2) {
+			Base++;
+		}
+
 		Frequency = Lower + Base + (Index * 833);
 	}
 

diff --git a/frequencies.c b/frequencies.c
@@ -123,9 +123,13 @@ uint32_t FREQUENCY_FloorToStep(uint32_t Upper, uint32_t Step, uint32_t Lower)
 
 	if (Step == 833) {
 		const uint32_t Delta = Upper - Lower;
-		const uint32_t Base = (Delta / 2500) * 2500;
+		uint32_t Base = (Delta / 2500) * 2500;
 		const uint32_t Index = ((Delta - Base) % 2500) / 833;
 
+		if (Index == 2) {
+			Base++;
+		}
+
 		return Lower + Base + (Index * 833);
 	}