1 files changed, 33 insertions, 3 deletions

diff --git a/software/rda1846dongle/rda1846dongle.c b/software/rda1846dongle/rda1846dongle.c
index 618b7ea..4bc4c2f 100644
--- a/software/rda1846dongle/rda1846dongle.c
+++ b/software/rda1846dongle/rda1846dongle.c
@@ -41,13 +41,43 @@
 
 #include "rda1846.h"
 
-void handle_cmd(uint8_t cmd)
+#define DEFAULT_FREQ 145900
+int32_t current_freq_kHz = DEFAULT_FREQ;
+
+static int32_t print_actual_freq(void)
+{
+  int32_t f = rda1846_get_freq_kHz();
+  if(f < 0)
+    printf("actual frequency: NaN MHz");
+  else
+    printf("actual frequency: %d.%03d MHz", (uint16_t)(f / 1000), (uint16_t)(f % 1000));
+  return f;
+}
+
+static void update_current_freq(void)
+{
+  printf("setting frequency to %d.%03d MHz .. ", (uint16_t)(current_freq_kHz / 1000),
+                                                 (uint16_t)(current_freq_kHz % 1000));
+  if(rda1846_set_freq_kHz(current_freq_kHz))
+    printf("error\r\n");
+  else
+    printf("ok\r\n");
+
+  current_freq_kHz = print_actual_freq();
+  if(current_freq_kHz < 0) 
+    current_freq_kHz = DEFAULT_FREQ;
+}
+
+static void handle_cmd(uint8_t cmd)
 {
   switch(cmd) {
   case '0': led_off(); break;
   case '1': led_on(); break;
   case 't': led_toggle(); break;
   case 'r': reset2bootloader(); break;
+  case 'f': print_actual_freq(); break;
+  case '+': current_freq_kHz+=500; update_current_freq(); break;
+  case '-': current_freq_kHz-=500; update_current_freq(); break;
   default: printf("error\r\n"); return;
   }
   printf("ok\r\n");
@@ -61,10 +91,10 @@ int main(void)
   cpu_init();
   led_init();
   usbio_init();
+  sei();
 
   rda1846_init();
-
-  sei();
+  rda1846_set_freq_kHz(current_freq_kHz);
 
   for(;;) {
     int16_t BytesReceived = usbio_bytes_received();