Added remaining known BK1080 features.

ArtrixTech · Aug 27, 2023 · f5af8df · f5af8df
1 parent e8a0cd3
commit f5af8df
Show file tree

Hide file tree

Showing 4 changed files with 12 additions and 3 deletions.
diff --git a/driver/bk1080.c b/driver/bk1080.c
@@ -19,6 +19,7 @@
 #include "driver/gpio.h"
 #include "driver/i2c.h"
 #include "driver/system.h"
+#include "misc.h"
 
 #define ARRAY_SIZE(a) (sizeof(a) / sizeof(a[0]))
 
@@ -102,3 +103,10 @@ void BK1080_SetFrequency(uint16_t Frequency)
 	BK1080_WriteRegister(BK1080_REG_03_CHANNEL, (Frequency - 760) | 0x8000);
 }
 
+void BK1080_GetFrequencyDeviation(uint16_t Frequency)
+{
+	g_20000362 = Frequency;
+	// Doubts whether this register is signed or not
+	gFM_FrequencyDeviation = (int16_t)BK1080_ReadRegister(BK1080_REG_07) / 16;
+}
+
diff --git a/driver/bk1080.h b/driver/bk1080.h
@@ -26,6 +26,7 @@ uint16_t BK1080_ReadRegister(BK1080_Register_t Register);
 void BK1080_WriteRegister(BK1080_Register_t Register, uint16_t Value);
 void BK1080_Mute(bool Mute);
 void BK1080_SetFrequency(uint16_t Frequency);
+void BK1080_GetFrequencyDeviation(uint16_t Frequency);
 
 #endif
 
diff --git a/misc.c b/misc.c
@@ -170,8 +170,8 @@ volatile bool gSystickFlag11;
 
 volatile uint16_t ScanPauseDelayIn10msec;
 
-// This probably should be signed! But Ghidra disgrees
-uint16_t gFM_FrequencyDeviation;
+// Doubts about whether this should be signed or not.
+int16_t gFM_FrequencyDeviation;
 
 uint16_t gCurrentRSSI;
 

diff --git a/misc.h b/misc.h
@@ -178,7 +178,7 @@ extern volatile bool gSystickFlag11;
 
 extern volatile uint16_t ScanPauseDelayIn10msec;
 
-extern uint16_t gFM_FrequencyDeviation;
+extern int16_t gFM_FrequencyDeviation;
 
 extern uint16_t gCurrentRSSI;