config_telem depending on FSK or BPSK

cubesatsim/cubesatsim.ino

@@ -329,11 +329,17 @@ void loop() {
 ///    }
     mode = new_mode;  // change modes if button pressed	 
     write_mode();
+	 
+    if (mode == BPSK)	 
       config_telem();
+	 
     if (new_mode != CW)
       transmit_callsign(callsign);
     sleep(0.5);
-///    config_telem();
+	 
+    if (mode == FSK)	 
+      config_telem();
+	 
     config_radio();
     if ((mode == FSK) || (mode == BPSK)) {    
       digitalWrite(LED_BUILTIN, HIGH);