move config_telem up in change mode

cubesatsim/cubesatsim.ino

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